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){ 2936201dbadSMatthias Ringwald *mtu = 0; 29440faeb84SMilanka Ringwald return status; 29540faeb84SMilanka Ringwald } 2967d2258b3SMilanka Ringwald 2975cf1669fSMatthias Ringwald if ((gatt_client->mtu_state == MTU_EXCHANGED) || (gatt_client->mtu_state == MTU_AUTO_EXCHANGE_DISABLED)){ 2985cf1669fSMatthias Ringwald *mtu = gatt_client->mtu; 2997d2258b3SMilanka Ringwald return ERROR_CODE_SUCCESS; 3003deb3ec6SMatthias Ringwald } 3013deb3ec6SMatthias Ringwald *mtu = ATT_DEFAULT_MTU; 302616edd56SMatthias Ringwald return GATT_CLIENT_IN_WRONG_STATE; 3033deb3ec6SMatthias Ringwald } 3043deb3ec6SMatthias Ringwald 3059228fd32SMatthias Ringwald static uint8_t *gatt_client_reserve_request_buffer(gatt_client_t *gatt_client) { 3067627a0deSMatthias Ringwald switch (gatt_client->bearer_type){ 3077627a0deSMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC 3087627a0deSMatthias Ringwald case ATT_BEARER_UNENHANCED_CLASSIC: 3097627a0deSMatthias Ringwald #endif 3107627a0deSMatthias Ringwald case ATT_BEARER_UNENHANCED_LE: 3119228fd32SMatthias Ringwald l2cap_reserve_packet_buffer(); 3129228fd32SMatthias Ringwald return l2cap_get_outgoing_buffer(); 3137627a0deSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 3147627a0deSMatthias Ringwald case ATT_BEARER_ENHANCED_LE: 3157627a0deSMatthias Ringwald return gatt_client->eatt_storage_buffer; 3167627a0deSMatthias Ringwald #endif 3177627a0deSMatthias Ringwald default: 3187627a0deSMatthias Ringwald btstack_unreachable(); 3197627a0deSMatthias Ringwald break; 3207627a0deSMatthias Ringwald } 3217627a0deSMatthias Ringwald return NULL; 3229228fd32SMatthias Ringwald } 3239228fd32SMatthias Ringwald 3243deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 3256e7b444cSMatthias Ringwald static uint8_t gatt_client_send(gatt_client_t * gatt_client, uint16_t len){ 32646012949SMatthias Ringwald switch (gatt_client->bearer_type){ 32746012949SMatthias Ringwald case ATT_BEARER_UNENHANCED_LE: 3286e7b444cSMatthias Ringwald return l2cap_send_prepared_connectionless(gatt_client->con_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL, len); 32946012949SMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC 33046012949SMatthias Ringwald case ATT_BEARER_UNENHANCED_CLASSIC: 33146012949SMatthias Ringwald return l2cap_send_prepared(gatt_client->l2cap_cid, len); 33246012949SMatthias Ringwald #endif 3337627a0deSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 3347627a0deSMatthias Ringwald case ATT_BEARER_ENHANCED_LE: 3357627a0deSMatthias Ringwald return l2cap_send(gatt_client->l2cap_cid, gatt_client->eatt_storage_buffer, len); 3367627a0deSMatthias Ringwald #endif 33746012949SMatthias Ringwald default: 33846012949SMatthias Ringwald btstack_unreachable(); 33946012949SMatthias Ringwald return ERROR_CODE_HARDWARE_FAILURE; 34046012949SMatthias Ringwald } 3413deb3ec6SMatthias Ringwald } 3423deb3ec6SMatthias Ringwald 3433deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 3446e7b444cSMatthias Ringwald static uint8_t att_confirmation(gatt_client_t * gatt_client) { 3459228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 3466e7b444cSMatthias Ringwald 3476e7b444cSMatthias Ringwald request[0] = ATT_HANDLE_VALUE_CONFIRMATION; 3486e7b444cSMatthias Ringwald 3496e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 1); 3506e7b444cSMatthias Ringwald } 3516e7b444cSMatthias Ringwald 3526e7b444cSMatthias Ringwald // precondition: can_send_packet_now == TRUE 3536e7b444cSMatthias Ringwald static uint8_t att_find_information_request(gatt_client_t *gatt_client, uint8_t request_type, uint16_t start_handle, 3546e7b444cSMatthias Ringwald uint16_t end_handle) { 3559228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 3566e7b444cSMatthias Ringwald 3573deb3ec6SMatthias Ringwald request[0] = request_type; 358f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, start_handle); 359f8fbdce0SMatthias Ringwald little_endian_store_16(request, 3, end_handle); 3603deb3ec6SMatthias Ringwald 3616e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 5); 3623deb3ec6SMatthias Ringwald } 3633deb3ec6SMatthias Ringwald 3643deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 3656e7b444cSMatthias Ringwald static uint8_t 3666e7b444cSMatthias Ringwald att_find_by_type_value_request(gatt_client_t *gatt_client, uint8_t request_type, uint16_t attribute_group_type, 3676e7b444cSMatthias Ringwald uint16_t start_handle, uint16_t end_handle, uint8_t *value, uint16_t value_size) { 3689228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 3693deb3ec6SMatthias Ringwald request[0] = request_type; 3709228fd32SMatthias Ringwald 371f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, start_handle); 372f8fbdce0SMatthias Ringwald little_endian_store_16(request, 3, end_handle); 373f8fbdce0SMatthias Ringwald little_endian_store_16(request, 5, attribute_group_type); 3746535961aSMatthias Ringwald (void)memcpy(&request[7], value, value_size); 3753deb3ec6SMatthias Ringwald 3766e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 7u + value_size); 3773deb3ec6SMatthias Ringwald } 3783deb3ec6SMatthias Ringwald 3793deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 3806e7b444cSMatthias Ringwald static uint8_t 3816e7b444cSMatthias Ringwald att_read_by_type_or_group_request_for_uuid16(gatt_client_t *gatt_client, uint8_t request_type, uint16_t uuid16, 3826e7b444cSMatthias Ringwald uint16_t start_handle, uint16_t end_handle) { 3839228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 3846e7b444cSMatthias Ringwald 3853deb3ec6SMatthias Ringwald request[0] = request_type; 386f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, start_handle); 387f8fbdce0SMatthias Ringwald little_endian_store_16(request, 3, end_handle); 388f8fbdce0SMatthias Ringwald little_endian_store_16(request, 5, uuid16); 3893deb3ec6SMatthias Ringwald 3906e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 7); 3913deb3ec6SMatthias Ringwald } 3923deb3ec6SMatthias Ringwald 3933deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 3946e7b444cSMatthias Ringwald static uint8_t 3956e7b444cSMatthias Ringwald att_read_by_type_or_group_request_for_uuid128(gatt_client_t *gatt_client, uint8_t request_type, const uint8_t *uuid128, 3966e7b444cSMatthias Ringwald uint16_t start_handle, uint16_t end_handle) { 3979228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 3986e7b444cSMatthias Ringwald 3993deb3ec6SMatthias Ringwald request[0] = request_type; 400f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, start_handle); 401f8fbdce0SMatthias Ringwald little_endian_store_16(request, 3, end_handle); 4029c80e4ccSMatthias Ringwald reverse_128(uuid128, &request[5]); 4033deb3ec6SMatthias Ringwald 4046e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 21); 4053deb3ec6SMatthias Ringwald } 4063deb3ec6SMatthias Ringwald 4073deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 4086e7b444cSMatthias Ringwald static uint8_t att_read_request(gatt_client_t *gatt_client, uint8_t request_type, uint16_t attribute_handle) { 4099228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 4106e7b444cSMatthias Ringwald 4113deb3ec6SMatthias Ringwald request[0] = request_type; 412f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, attribute_handle); 4133deb3ec6SMatthias Ringwald 4146e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 3); 4153deb3ec6SMatthias Ringwald } 4163deb3ec6SMatthias Ringwald 4173deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 4186e7b444cSMatthias Ringwald static uint8_t att_read_blob_request(gatt_client_t *gatt_client, uint8_t request_type, uint16_t attribute_handle, 4196e7b444cSMatthias Ringwald uint16_t value_offset) { 4209228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 4219228fd32SMatthias Ringwald 4223deb3ec6SMatthias Ringwald request[0] = request_type; 423f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, attribute_handle); 424f8fbdce0SMatthias Ringwald little_endian_store_16(request, 3, value_offset); 4253deb3ec6SMatthias Ringwald 4266e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 5); 4273deb3ec6SMatthias Ringwald } 4283deb3ec6SMatthias Ringwald 4296e7b444cSMatthias Ringwald static uint8_t 430f125a8efSMatthias Ringwald att_read_multiple_request_with_opcode(gatt_client_t *gatt_client, uint16_t num_value_handles, uint16_t *value_handles, uint8_t opcode) { 4319228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 4329228fd32SMatthias Ringwald 433f125a8efSMatthias Ringwald request[0] = opcode; 4349228fd32SMatthias Ringwald uint16_t i; 4359228fd32SMatthias Ringwald uint16_t offset = 1; 4363deb3ec6SMatthias Ringwald for (i=0;i<num_value_handles;i++){ 437f8fbdce0SMatthias Ringwald little_endian_store_16(request, offset, value_handles[i]); 4383deb3ec6SMatthias Ringwald offset += 2; 4393deb3ec6SMatthias Ringwald } 44025b7c058SMilanka Ringwald 4416e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, offset); 4423deb3ec6SMatthias Ringwald } 4433deb3ec6SMatthias Ringwald 444f125a8efSMatthias Ringwald static uint8_t 445f125a8efSMatthias Ringwald att_read_multiple_request(gatt_client_t *gatt_client, uint16_t num_value_handles, uint16_t *value_handles) { 446f125a8efSMatthias Ringwald return att_read_multiple_request_with_opcode(gatt_client, num_value_handles, value_handles, ATT_READ_MULTIPLE_REQUEST); 447f125a8efSMatthias Ringwald } 448f125a8efSMatthias Ringwald 449f125a8efSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 450f125a8efSMatthias Ringwald static uint8_t 451f125a8efSMatthias Ringwald att_read_multiple_variable_request(gatt_client_t *gatt_client, uint16_t num_value_handles, uint16_t *value_handles) { 452f125a8efSMatthias Ringwald return att_read_multiple_request_with_opcode(gatt_client, num_value_handles, value_handles, ATT_READ_MULTIPLE_VARIABLE_REQ); 453f125a8efSMatthias Ringwald } 454f125a8efSMatthias Ringwald #endif 455f125a8efSMatthias Ringwald 4567a766ebfSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 4573deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 4586e7b444cSMatthias Ringwald static uint8_t att_signed_write_request(gatt_client_t *gatt_client, uint16_t request_type, uint16_t attribute_handle, 4596e7b444cSMatthias Ringwald uint16_t value_length, uint8_t *value, uint32_t sign_counter, uint8_t sgn[8]) { 4609228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 4619228fd32SMatthias Ringwald 4623deb3ec6SMatthias Ringwald request[0] = request_type; 463f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, attribute_handle); 4646535961aSMatthias Ringwald (void)memcpy(&request[3], value, value_length); 465f8fbdce0SMatthias Ringwald little_endian_store_32(request, 3 + value_length, sign_counter); 4669c80e4ccSMatthias Ringwald reverse_64(sgn, &request[3 + value_length + 4]); 46725b7c058SMilanka Ringwald 4686e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 3 + value_length + 12); 4693deb3ec6SMatthias Ringwald } 4707a766ebfSMatthias Ringwald #endif 4713deb3ec6SMatthias Ringwald 4723deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 4736e7b444cSMatthias Ringwald static uint8_t 4746e7b444cSMatthias Ringwald att_write_request(gatt_client_t *gatt_client, uint8_t request_type, uint16_t attribute_handle, uint16_t value_length, 4756e7b444cSMatthias Ringwald uint8_t *value) { 4769228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 4779228fd32SMatthias Ringwald 4783deb3ec6SMatthias Ringwald request[0] = request_type; 479f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, attribute_handle); 4806535961aSMatthias Ringwald (void)memcpy(&request[3], value, value_length); 4813deb3ec6SMatthias Ringwald 4826e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 3u + value_length); 4833deb3ec6SMatthias Ringwald } 4843deb3ec6SMatthias Ringwald 4853deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 4866e7b444cSMatthias Ringwald static uint8_t att_execute_write_request(gatt_client_t *gatt_client, uint8_t request_type, uint8_t execute_write) { 4879228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 4889228fd32SMatthias Ringwald 4893deb3ec6SMatthias Ringwald request[0] = request_type; 4903deb3ec6SMatthias Ringwald request[1] = execute_write; 49125b7c058SMilanka Ringwald 4926e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 2); 4933deb3ec6SMatthias Ringwald } 4943deb3ec6SMatthias Ringwald 4953deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 4966e7b444cSMatthias Ringwald static uint8_t att_prepare_write_request(gatt_client_t *gatt_client, uint8_t request_type, uint16_t attribute_handle, 4976e7b444cSMatthias Ringwald uint16_t value_offset, uint16_t blob_length, uint8_t *value) { 4989228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 4999228fd32SMatthias Ringwald 5003deb3ec6SMatthias Ringwald request[0] = request_type; 501f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, attribute_handle); 502f8fbdce0SMatthias Ringwald little_endian_store_16(request, 3, value_offset); 5036535961aSMatthias Ringwald (void)memcpy(&request[5], &value[value_offset], blob_length); 5043deb3ec6SMatthias Ringwald 5056e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 5u + blob_length); 5063deb3ec6SMatthias Ringwald } 5073deb3ec6SMatthias Ringwald 5086e7b444cSMatthias Ringwald static uint8_t att_exchange_mtu_request(gatt_client_t *gatt_client) { 5099228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 5109228fd32SMatthias Ringwald 5113deb3ec6SMatthias Ringwald request[0] = ATT_EXCHANGE_MTU_REQUEST; 5129228fd32SMatthias Ringwald uint16_t mtu = l2cap_max_le_mtu(); 513f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, mtu); 51425b7c058SMilanka Ringwald 5156e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 3); 5163deb3ec6SMatthias Ringwald } 5173deb3ec6SMatthias Ringwald 5185cf1669fSMatthias Ringwald static uint16_t write_blob_length(gatt_client_t * gatt_client){ 519dda77937SMatthias Ringwald uint16_t max_blob_length = gatt_client->mtu - 5u; 5205cf1669fSMatthias Ringwald if (gatt_client->attribute_offset >= gatt_client->attribute_length) { 5213deb3ec6SMatthias Ringwald return 0; 5223deb3ec6SMatthias Ringwald } 5235cf1669fSMatthias Ringwald uint16_t rest_length = gatt_client->attribute_length - gatt_client->attribute_offset; 5243deb3ec6SMatthias Ringwald if (max_blob_length > rest_length){ 5253deb3ec6SMatthias Ringwald return rest_length; 5263deb3ec6SMatthias Ringwald } 5273deb3ec6SMatthias Ringwald return max_blob_length; 5283deb3ec6SMatthias Ringwald } 5293deb3ec6SMatthias Ringwald 5305cf1669fSMatthias Ringwald static void send_gatt_services_request(gatt_client_t *gatt_client){ 5316e7b444cSMatthias Ringwald att_read_by_type_or_group_request_for_uuid16(gatt_client, ATT_READ_BY_GROUP_TYPE_REQUEST, 5326e7b444cSMatthias Ringwald gatt_client->uuid16, gatt_client->start_group_handle, 5336e7b444cSMatthias Ringwald gatt_client->end_group_handle); 5343deb3ec6SMatthias Ringwald } 5353deb3ec6SMatthias Ringwald 5365cf1669fSMatthias Ringwald static void send_gatt_by_uuid_request(gatt_client_t *gatt_client, uint16_t attribute_group_type){ 53752377058SMatthias Ringwald if (gatt_client->uuid16 != 0u){ 5383deb3ec6SMatthias Ringwald uint8_t uuid16[2]; 5395cf1669fSMatthias Ringwald little_endian_store_16(uuid16, 0, gatt_client->uuid16); 5406e7b444cSMatthias Ringwald att_find_by_type_value_request(gatt_client, ATT_FIND_BY_TYPE_VALUE_REQUEST, attribute_group_type, 5416e7b444cSMatthias Ringwald gatt_client->start_group_handle, gatt_client->end_group_handle, uuid16, 2); 5423deb3ec6SMatthias Ringwald return; 5433deb3ec6SMatthias Ringwald } 5443deb3ec6SMatthias Ringwald uint8_t uuid128[16]; 5455cf1669fSMatthias Ringwald reverse_128(gatt_client->uuid128, uuid128); 5466e7b444cSMatthias Ringwald att_find_by_type_value_request(gatt_client, ATT_FIND_BY_TYPE_VALUE_REQUEST, attribute_group_type, 5476e7b444cSMatthias Ringwald gatt_client->start_group_handle, gatt_client->end_group_handle, uuid128, 16); 5483deb3ec6SMatthias Ringwald } 5493deb3ec6SMatthias Ringwald 5505cf1669fSMatthias Ringwald static void send_gatt_services_by_uuid_request(gatt_client_t *gatt_client){ 5515cf1669fSMatthias Ringwald send_gatt_by_uuid_request(gatt_client, GATT_PRIMARY_SERVICE_UUID); 5523deb3ec6SMatthias Ringwald } 5533deb3ec6SMatthias Ringwald 5545cf1669fSMatthias Ringwald static void send_gatt_included_service_uuid_request(gatt_client_t *gatt_client){ 5556e7b444cSMatthias Ringwald att_read_request(gatt_client, ATT_READ_REQUEST, gatt_client->query_start_handle); 5563deb3ec6SMatthias Ringwald } 5573deb3ec6SMatthias Ringwald 5585cf1669fSMatthias Ringwald static void send_gatt_included_service_request(gatt_client_t *gatt_client){ 5596e7b444cSMatthias Ringwald att_read_by_type_or_group_request_for_uuid16(gatt_client, ATT_READ_BY_TYPE_REQUEST, 5606e7b444cSMatthias Ringwald GATT_INCLUDE_SERVICE_UUID, gatt_client->start_group_handle, 5616e7b444cSMatthias Ringwald gatt_client->end_group_handle); 5623deb3ec6SMatthias Ringwald } 5633deb3ec6SMatthias Ringwald 5645cf1669fSMatthias Ringwald static void send_gatt_characteristic_request(gatt_client_t *gatt_client){ 5656e7b444cSMatthias Ringwald att_read_by_type_or_group_request_for_uuid16(gatt_client, ATT_READ_BY_TYPE_REQUEST, 5666e7b444cSMatthias Ringwald GATT_CHARACTERISTICS_UUID, gatt_client->start_group_handle, 5676e7b444cSMatthias Ringwald gatt_client->end_group_handle); 5683deb3ec6SMatthias Ringwald } 5693deb3ec6SMatthias Ringwald 5705cf1669fSMatthias Ringwald static void send_gatt_characteristic_descriptor_request(gatt_client_t *gatt_client){ 5716e7b444cSMatthias Ringwald att_find_information_request(gatt_client, ATT_FIND_INFORMATION_REQUEST, gatt_client->start_group_handle, 5726e7b444cSMatthias Ringwald gatt_client->end_group_handle); 5733deb3ec6SMatthias Ringwald } 5743deb3ec6SMatthias Ringwald 5755cf1669fSMatthias Ringwald static void send_gatt_read_characteristic_value_request(gatt_client_t *gatt_client){ 5766e7b444cSMatthias Ringwald att_read_request(gatt_client, ATT_READ_REQUEST, gatt_client->attribute_handle); 5773deb3ec6SMatthias Ringwald } 5783deb3ec6SMatthias Ringwald 5795cf1669fSMatthias Ringwald static void send_gatt_read_by_type_request(gatt_client_t * gatt_client){ 58052377058SMatthias Ringwald if (gatt_client->uuid16 != 0u){ 5816e7b444cSMatthias Ringwald att_read_by_type_or_group_request_for_uuid16(gatt_client, ATT_READ_BY_TYPE_REQUEST, 5826e7b444cSMatthias Ringwald gatt_client->uuid16, gatt_client->start_group_handle, 5836e7b444cSMatthias Ringwald gatt_client->end_group_handle); 5843deb3ec6SMatthias Ringwald } else { 5856e7b444cSMatthias Ringwald att_read_by_type_or_group_request_for_uuid128(gatt_client, ATT_READ_BY_TYPE_REQUEST, 5866e7b444cSMatthias Ringwald gatt_client->uuid128, gatt_client->start_group_handle, 5876e7b444cSMatthias Ringwald gatt_client->end_group_handle); 5883deb3ec6SMatthias Ringwald } 5893deb3ec6SMatthias Ringwald } 5903deb3ec6SMatthias Ringwald 5915cf1669fSMatthias Ringwald static void send_gatt_read_blob_request(gatt_client_t *gatt_client){ 59230952227SMilanka Ringwald if (gatt_client->attribute_offset == 0){ 5936e7b444cSMatthias Ringwald att_read_request(gatt_client, ATT_READ_REQUEST, gatt_client->attribute_handle); 59430952227SMilanka Ringwald } else { 5956e7b444cSMatthias Ringwald att_read_blob_request(gatt_client, ATT_READ_BLOB_REQUEST, gatt_client->attribute_handle, 5966e7b444cSMatthias Ringwald gatt_client->attribute_offset); 5973deb3ec6SMatthias Ringwald } 59830952227SMilanka Ringwald } 5993deb3ec6SMatthias Ringwald 6005cf1669fSMatthias Ringwald static void send_gatt_read_multiple_request(gatt_client_t * gatt_client){ 6016e7b444cSMatthias Ringwald att_read_multiple_request(gatt_client, gatt_client->read_multiple_handle_count, gatt_client->read_multiple_handles); 6023deb3ec6SMatthias Ringwald } 6033deb3ec6SMatthias Ringwald 604f125a8efSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 605f125a8efSMatthias Ringwald static void send_gatt_read_multiple_variable_request(gatt_client_t * gatt_client){ 606f125a8efSMatthias Ringwald att_read_multiple_variable_request(gatt_client, gatt_client->read_multiple_handle_count, gatt_client->read_multiple_handles); 607f125a8efSMatthias Ringwald } 608f125a8efSMatthias Ringwald #endif 609f125a8efSMatthias Ringwald 6105cf1669fSMatthias Ringwald static void send_gatt_write_attribute_value_request(gatt_client_t * gatt_client){ 6116e7b444cSMatthias Ringwald att_write_request(gatt_client, ATT_WRITE_REQUEST, gatt_client->attribute_handle, gatt_client->attribute_length, 6126e7b444cSMatthias Ringwald gatt_client->attribute_value); 6133deb3ec6SMatthias Ringwald } 6143deb3ec6SMatthias Ringwald 6155cf1669fSMatthias Ringwald static void send_gatt_write_client_characteristic_configuration_request(gatt_client_t * gatt_client){ 6166e7b444cSMatthias Ringwald att_write_request(gatt_client, ATT_WRITE_REQUEST, gatt_client->client_characteristic_configuration_handle, 2, 6176e7b444cSMatthias Ringwald gatt_client->client_characteristic_configuration_value); 6183deb3ec6SMatthias Ringwald } 6193deb3ec6SMatthias Ringwald 6205cf1669fSMatthias Ringwald static void send_gatt_prepare_write_request(gatt_client_t * gatt_client){ 6216e7b444cSMatthias Ringwald att_prepare_write_request(gatt_client, ATT_PREPARE_WRITE_REQUEST, gatt_client->attribute_handle, 6226e7b444cSMatthias Ringwald gatt_client->attribute_offset, write_blob_length(gatt_client), 6236e7b444cSMatthias Ringwald gatt_client->attribute_value); 6243deb3ec6SMatthias Ringwald } 6253deb3ec6SMatthias Ringwald 6265cf1669fSMatthias Ringwald static void send_gatt_execute_write_request(gatt_client_t * gatt_client){ 6276e7b444cSMatthias Ringwald att_execute_write_request(gatt_client, ATT_EXECUTE_WRITE_REQUEST, 1); 6283deb3ec6SMatthias Ringwald } 6293deb3ec6SMatthias Ringwald 6305cf1669fSMatthias Ringwald static void send_gatt_cancel_prepared_write_request(gatt_client_t * gatt_client){ 6316e7b444cSMatthias Ringwald att_execute_write_request(gatt_client, ATT_EXECUTE_WRITE_REQUEST, 0); 6323deb3ec6SMatthias Ringwald } 6333deb3ec6SMatthias Ringwald 634abdc9fb5SMatthias Ringwald #ifndef ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY 6355cf1669fSMatthias Ringwald static void send_gatt_read_client_characteristic_configuration_request(gatt_client_t * gatt_client){ 6366e7b444cSMatthias Ringwald att_read_by_type_or_group_request_for_uuid16(gatt_client, ATT_READ_BY_TYPE_REQUEST, 6376e7b444cSMatthias Ringwald GATT_CLIENT_CHARACTERISTICS_CONFIGURATION, 6386e7b444cSMatthias Ringwald gatt_client->start_group_handle, gatt_client->end_group_handle); 6393deb3ec6SMatthias Ringwald } 640abdc9fb5SMatthias Ringwald #endif 6413deb3ec6SMatthias Ringwald 6425cf1669fSMatthias Ringwald static void send_gatt_read_characteristic_descriptor_request(gatt_client_t * gatt_client){ 6436e7b444cSMatthias Ringwald att_read_request(gatt_client, ATT_READ_REQUEST, gatt_client->attribute_handle); 6443deb3ec6SMatthias Ringwald } 6453deb3ec6SMatthias Ringwald 6467a766ebfSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 6475cf1669fSMatthias Ringwald static void send_gatt_signed_write_request(gatt_client_t * gatt_client, uint32_t sign_counter){ 6486e7b444cSMatthias Ringwald att_signed_write_request(gatt_client, ATT_SIGNED_WRITE_COMMAND, gatt_client->attribute_handle, 6496e7b444cSMatthias Ringwald gatt_client->attribute_length, gatt_client->attribute_value, sign_counter, 6506e7b444cSMatthias Ringwald gatt_client->cmac); 6513deb3ec6SMatthias Ringwald } 6527a766ebfSMatthias Ringwald #endif 6533deb3ec6SMatthias Ringwald 6543deb3ec6SMatthias Ringwald static uint16_t get_last_result_handle_from_service_list(uint8_t * packet, uint16_t size){ 65539ac9711SMatthias Ringwald if (size < 2) return 0xffff; 6563deb3ec6SMatthias Ringwald uint8_t attr_length = packet[1]; 65739ac9711SMatthias Ringwald if ((2 + attr_length) > size) return 0xffff; 6584ea43905SMatthias Ringwald return little_endian_read_16(packet, size - attr_length + 2u); 6593deb3ec6SMatthias Ringwald } 6603deb3ec6SMatthias Ringwald 6613deb3ec6SMatthias Ringwald static uint16_t get_last_result_handle_from_characteristics_list(uint8_t * packet, uint16_t size){ 66239ac9711SMatthias Ringwald if (size < 2) return 0xffff; 6633deb3ec6SMatthias Ringwald uint8_t attr_length = packet[1]; 66439ac9711SMatthias Ringwald if ((2 + attr_length) > size) return 0xffff; 6654ea43905SMatthias Ringwald return little_endian_read_16(packet, size - attr_length + 3u); 6663deb3ec6SMatthias Ringwald } 6673deb3ec6SMatthias Ringwald 6683deb3ec6SMatthias Ringwald static uint16_t get_last_result_handle_from_included_services_list(uint8_t * packet, uint16_t size){ 66939ac9711SMatthias Ringwald if (size < 2) return 0xffff; 6703deb3ec6SMatthias Ringwald uint8_t attr_length = packet[1]; 67139ac9711SMatthias Ringwald if ((2 + attr_length) > size) return 0xffff; 672f8fbdce0SMatthias Ringwald return little_endian_read_16(packet, size - attr_length); 6733deb3ec6SMatthias Ringwald } 6743deb3ec6SMatthias Ringwald 675842492f0SMatthias Ringwald #ifdef ENABLE_GATT_CLIENT_SERVICE_CHANGED 67658e8c9f5SMatthias Ringwald static void gatt_client_service_emit_event(gatt_client_t * gatt_client, uint8_t * event, uint16_t size){ 67758e8c9f5SMatthias Ringwald btstack_linked_list_iterator_t it; 67858e8c9f5SMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client_service_changed_handler); 67958e8c9f5SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)) { 68058e8c9f5SMatthias Ringwald btstack_packet_callback_registration_t *callback = (btstack_packet_callback_registration_t *) btstack_linked_list_iterator_next(&it); 68158e8c9f5SMatthias Ringwald (*callback->callback)(HCI_EVENT_PACKET, (uint16_t) gatt_client->con_handle, event, size); 68258e8c9f5SMatthias Ringwald } 68358e8c9f5SMatthias Ringwald } 68458e8c9f5SMatthias Ringwald 68558e8c9f5SMatthias Ringwald static void 68658e8c9f5SMatthias Ringwald gatt_client_service_emit_database_hash(gatt_client_t *gatt_client, const uint8_t *value, uint16_t value_len) { 68758e8c9f5SMatthias Ringwald if (value_len == 16){ 68858e8c9f5SMatthias Ringwald uint8_t event[21]; 68958e8c9f5SMatthias Ringwald hci_event_builder_context_t context; 69058e8c9f5SMatthias Ringwald hci_event_builder_init(&context, event, sizeof(event), HCI_EVENT_GATTSERVICE_META, GATTSERVICE_SUBEVENT_GATT_DATABASE_HASH); 69158e8c9f5SMatthias Ringwald hci_event_builder_add_con_handle(&context, gatt_client->con_handle); 69258e8c9f5SMatthias Ringwald hci_event_builder_add_bytes(&context, value, 16); 69358e8c9f5SMatthias Ringwald gatt_client_service_emit_event(gatt_client, event, hci_event_builder_get_length(&context)); 69458e8c9f5SMatthias Ringwald } 69558e8c9f5SMatthias Ringwald } 69658e8c9f5SMatthias Ringwald 69758e8c9f5SMatthias Ringwald static void 69858e8c9f5SMatthias Ringwald gatt_client_service_emit_service_changed(gatt_client_t *gatt_client, const uint8_t *value, uint16_t value_len) { 69958e8c9f5SMatthias Ringwald if (value_len == 4){ 70058e8c9f5SMatthias Ringwald uint8_t event[9]; 70158e8c9f5SMatthias Ringwald hci_event_builder_context_t context; 70258e8c9f5SMatthias Ringwald hci_event_builder_init(&context, event, sizeof(event), HCI_EVENT_GATTSERVICE_META, GATTSERVICE_SUBEVENT_GATT_SERVICE_CHANGED); 70358e8c9f5SMatthias Ringwald hci_event_builder_add_con_handle(&context, gatt_client->con_handle); 70458e8c9f5SMatthias Ringwald hci_event_builder_add_bytes(&context, value, 4); 70558e8c9f5SMatthias Ringwald gatt_client_service_emit_event(gatt_client, event, hci_event_builder_get_length(&context)); 70658e8c9f5SMatthias Ringwald } 70758e8c9f5SMatthias Ringwald } 70858e8c9f5SMatthias Ringwald 709d9ced76fSMatthias Ringwald static void gatt_client_service_packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size){ 710e2c98440SMatthias Ringwald UNUSED(channel); // ok: handling own l2cap events 711e2c98440SMatthias Ringwald UNUSED(size); // ok: there is no channel 712e2c98440SMatthias Ringwald 713d9ced76fSMatthias Ringwald hci_con_handle_t con_handle; 714d9ced76fSMatthias Ringwald gatt_client_t *gatt_client; 715d9ced76fSMatthias Ringwald gatt_client_service_t service; 716d9ced76fSMatthias Ringwald gatt_client_characteristic_t characteristic; 717d9ced76fSMatthias Ringwald switch (packet_type) { 718d9ced76fSMatthias Ringwald case HCI_EVENT_PACKET: 719d9ced76fSMatthias Ringwald switch (hci_event_packet_get_type(packet)) { 720d9ced76fSMatthias Ringwald case GATT_EVENT_SERVICE_QUERY_RESULT: 721d9ced76fSMatthias Ringwald con_handle = gatt_event_service_query_result_get_handle(packet); 722d9ced76fSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(con_handle); 723d9ced76fSMatthias Ringwald btstack_assert(gatt_client != NULL); 724d9ced76fSMatthias Ringwald btstack_assert(gatt_client->gatt_service_state == GATT_CLIENT_SERVICE_DISCOVER_W4_DONE); 725d9ced76fSMatthias Ringwald gatt_event_service_query_result_get_service(packet, &service); 726d9ced76fSMatthias Ringwald gatt_client->gatt_service_start_group_handle = service.start_group_handle; 727d9ced76fSMatthias Ringwald gatt_client->gatt_service_end_group_handle = service.end_group_handle; 728d9ced76fSMatthias Ringwald break; 729d9ced76fSMatthias Ringwald case GATT_EVENT_CHARACTERISTIC_QUERY_RESULT: 730d9ced76fSMatthias Ringwald con_handle = gatt_event_characteristic_query_result_get_handle(packet); 731d9ced76fSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(con_handle); 732d9ced76fSMatthias Ringwald btstack_assert(gatt_client != NULL); 733d9ced76fSMatthias Ringwald btstack_assert(gatt_client->gatt_service_state == GATT_CLIENT_SERVICE_DISCOVER_CHARACTERISTICS_W4_DONE); 734d9ced76fSMatthias Ringwald gatt_event_characteristic_query_result_get_characteristic(packet, &characteristic); 735d9ced76fSMatthias Ringwald switch (characteristic.uuid16){ 736d9ced76fSMatthias Ringwald case ORG_BLUETOOTH_CHARACTERISTIC_GATT_SERVICE_CHANGED: 737d9ced76fSMatthias Ringwald gatt_client->gatt_service_changed_value_handle = characteristic.value_handle; 738d9ced76fSMatthias Ringwald gatt_client->gatt_service_changed_end_handle = characteristic.end_handle; 739d9ced76fSMatthias Ringwald break; 740d9ced76fSMatthias Ringwald case ORG_BLUETOOTH_CHARACTERISTIC_DATABASE_HASH: 741d9ced76fSMatthias Ringwald gatt_client->gatt_service_database_hash_value_handle = characteristic.value_handle; 742d9ced76fSMatthias Ringwald gatt_client->gatt_service_database_hash_end_handle = characteristic.end_handle; 743d9ced76fSMatthias Ringwald break; 744d9ced76fSMatthias Ringwald default: 745d9ced76fSMatthias Ringwald break; 746d9ced76fSMatthias Ringwald } 747d9ced76fSMatthias Ringwald break; 748d9ced76fSMatthias Ringwald case GATT_EVENT_CHARACTERISTIC_VALUE_QUERY_RESULT: 749d9ced76fSMatthias Ringwald con_handle = gatt_event_characteristic_value_query_result_get_handle(packet); 750d9ced76fSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(con_handle); 751d9ced76fSMatthias Ringwald btstack_assert(gatt_client != NULL); 752d9ced76fSMatthias Ringwald btstack_assert(gatt_client->gatt_service_state == GATT_CLIENT_SERVICE_DATABASE_HASH_READ_W4_DONE); 75358e8c9f5SMatthias Ringwald gatt_client_service_emit_database_hash(gatt_client, 75458e8c9f5SMatthias Ringwald gatt_event_characteristic_value_query_result_get_value(packet), 75558e8c9f5SMatthias Ringwald gatt_event_characteristic_value_query_result_get_value_length(packet)); 756d9ced76fSMatthias Ringwald break; 757d9ced76fSMatthias Ringwald case GATT_EVENT_QUERY_COMPLETE: 758d9ced76fSMatthias Ringwald con_handle = gatt_event_query_complete_get_handle(packet); 759d9ced76fSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(con_handle); 760d9ced76fSMatthias Ringwald btstack_assert(gatt_client != NULL); 761d9ced76fSMatthias Ringwald switch (gatt_client->gatt_service_state) { 762d9ced76fSMatthias Ringwald case GATT_CLIENT_SERVICE_DISCOVER_W4_DONE: 763d9ced76fSMatthias Ringwald gatt_client->gatt_service_state = GATT_CLIENT_SERVICE_DISCOVER_CHARACTERISTICS_W2_SEND; 764d9ced76fSMatthias Ringwald break; 765d9ced76fSMatthias Ringwald case GATT_CLIENT_SERVICE_DISCOVER_CHARACTERISTICS_W4_DONE: 766d9ced76fSMatthias Ringwald gatt_client->gatt_service_state = GATT_CLIENT_SERVICE_SERVICE_CHANGED_WRITE_CCCD_W2_SEND; 767d9ced76fSMatthias Ringwald break; 768d9ced76fSMatthias Ringwald case GATT_CLIENT_SERVICE_SERVICE_CHANGED_WRITE_CCCD_W4_DONE: 769d9ced76fSMatthias Ringwald gatt_client->gatt_service_state = GATT_CLIENT_SERVICE_DATABASE_HASH_READ_W2_SEND; 770d9ced76fSMatthias Ringwald break; 771d9ced76fSMatthias Ringwald case GATT_CLIENT_SERVICE_DATABASE_HASH_READ_W4_DONE: 772d9ced76fSMatthias Ringwald gatt_client->gatt_service_state = GATT_CLIENT_SERVICE_DATABASE_HASH_WRITE_CCCD_W2_SEND; 773d9ced76fSMatthias Ringwald break; 774d9ced76fSMatthias Ringwald case GATT_CLIENT_SERVICE_DATABASE_HASH_WRITE_CCCD_W4_DONE: 775d9ced76fSMatthias Ringwald gatt_client->gatt_service_state = GATT_CLIENT_SERVICE_DONE; 776d9ced76fSMatthias Ringwald break; 777d9ced76fSMatthias Ringwald default: 778d9ced76fSMatthias Ringwald btstack_unreachable(); 779d9ced76fSMatthias Ringwald break; 780d9ced76fSMatthias Ringwald } 781d9ced76fSMatthias Ringwald break; 782d9ced76fSMatthias Ringwald default: 783d9ced76fSMatthias Ringwald break; 784d9ced76fSMatthias Ringwald } 785d9ced76fSMatthias Ringwald break; 786d9ced76fSMatthias Ringwald default: 787d9ced76fSMatthias Ringwald break; 788d9ced76fSMatthias Ringwald } 789d9ced76fSMatthias Ringwald } 790842492f0SMatthias Ringwald #endif 791d9ced76fSMatthias Ringwald 79253e9c18fSMatthias Ringwald static void gatt_client_notify_can_send_query(gatt_client_t * gatt_client){ 79319c614acSMatthias Ringwald 79419c614acSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 79519c614acSMatthias Ringwald // if eatt is ready, notify all clients that can send a query 79619c614acSMatthias Ringwald if (gatt_client->eatt_state == GATT_CLIENT_EATT_READY){ 79719c614acSMatthias Ringwald btstack_linked_list_iterator_t it; 79819c614acSMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client->eatt_clients); 79919c614acSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 80019c614acSMatthias Ringwald gatt_client_t * client = (gatt_client_t *) btstack_linked_list_iterator_next(&it); 801052dc82aSMatthias Ringwald if (client->state == P_READY){ 80219c614acSMatthias Ringwald // call callback 80319c614acSMatthias Ringwald btstack_context_callback_registration_t * callback = (btstack_context_callback_registration_t *) btstack_linked_list_pop(&gatt_client->query_requests); 80419c614acSMatthias Ringwald if (callback == NULL) { 80519c614acSMatthias Ringwald return; 80619c614acSMatthias Ringwald } 80719c614acSMatthias Ringwald (*callback->callback)(callback->context); 80819c614acSMatthias Ringwald } 80919c614acSMatthias Ringwald } 81019c614acSMatthias Ringwald return; 81119c614acSMatthias Ringwald } 81219c614acSMatthias Ringwald #endif 81319c614acSMatthias Ringwald 814842492f0SMatthias Ringwald while (gatt_client->state == P_READY){ 815842492f0SMatthias Ringwald bool query_sent = false; 816842492f0SMatthias Ringwald UNUSED(query_sent); 817842492f0SMatthias Ringwald 818842492f0SMatthias Ringwald #ifdef ENABLE_GATT_CLIENT_SERVICE_CHANGED 819d9ced76fSMatthias Ringwald uint8_t status = ERROR_CODE_SUCCESS; 820d9ced76fSMatthias Ringwald gatt_client_service_t gatt_service; 821d9ced76fSMatthias Ringwald gatt_client_characteristic_t characteristic; 822d9ced76fSMatthias Ringwald switch (gatt_client->gatt_service_state){ 823d9ced76fSMatthias Ringwald case GATT_CLIENT_SERVICE_DISCOVER_W2_SEND: 824d9ced76fSMatthias Ringwald gatt_client->gatt_service_state = GATT_CLIENT_SERVICE_DISCOVER_W4_DONE; 825d9ced76fSMatthias Ringwald status = gatt_client_discover_primary_services_by_uuid16(&gatt_client_service_packet_handler, 826d9ced76fSMatthias Ringwald gatt_client->con_handle, 827d9ced76fSMatthias Ringwald ORG_BLUETOOTH_SERVICE_GENERIC_ATTRIBUTE); 828d9ced76fSMatthias Ringwald query_sent = true; 829d9ced76fSMatthias Ringwald break; 830d9ced76fSMatthias Ringwald case GATT_CLIENT_SERVICE_DISCOVER_CHARACTERISTICS_W2_SEND: 831d9ced76fSMatthias Ringwald if (gatt_client->gatt_service_start_group_handle != 0){ 832d9ced76fSMatthias Ringwald gatt_client->gatt_service_state = GATT_CLIENT_SERVICE_DISCOVER_CHARACTERISTICS_W4_DONE; 833d9ced76fSMatthias Ringwald gatt_service.start_group_handle = gatt_client->gatt_service_start_group_handle; 834d9ced76fSMatthias Ringwald gatt_service.end_group_handle = gatt_client->gatt_service_end_group_handle; 835d9ced76fSMatthias Ringwald status = gatt_client_discover_characteristics_for_service(&gatt_client_service_packet_handler, gatt_client->con_handle, &gatt_service); 836d9ced76fSMatthias Ringwald query_sent = true; 837d9ced76fSMatthias Ringwald break; 838d9ced76fSMatthias Ringwald } 839d9ced76fSMatthias Ringwald 840d9ced76fSMatthias Ringwald /* fall through */ 841d9ced76fSMatthias Ringwald 842d9ced76fSMatthias Ringwald case GATT_CLIENT_SERVICE_SERVICE_CHANGED_WRITE_CCCD_W2_SEND: 843d9ced76fSMatthias Ringwald if (gatt_client->gatt_service_changed_value_handle != 0){ 844d9ced76fSMatthias Ringwald gatt_client->gatt_service_state = GATT_CLIENT_SERVICE_SERVICE_CHANGED_WRITE_CCCD_W4_DONE; 845d9ced76fSMatthias Ringwald characteristic.value_handle = gatt_client->gatt_service_changed_value_handle; 846d9ced76fSMatthias Ringwald characteristic.end_handle = gatt_client->gatt_service_changed_end_handle; 847d9ced76fSMatthias Ringwald // we assume good case. We cannot do much otherwise 848d9ced76fSMatthias Ringwald characteristic.properties = ATT_PROPERTY_INDICATE; 849d9ced76fSMatthias Ringwald status = gatt_client_write_client_characteristic_configuration(&gatt_client_service_packet_handler, 850d9ced76fSMatthias Ringwald gatt_client->con_handle, &characteristic, 851d9ced76fSMatthias Ringwald GATT_CLIENT_CHARACTERISTICS_CONFIGURATION_INDICATION); 852d9ced76fSMatthias Ringwald query_sent = true; 853d9ced76fSMatthias Ringwald break; 854d9ced76fSMatthias Ringwald } 855d9ced76fSMatthias Ringwald 856d9ced76fSMatthias Ringwald /* fall through */ 857d9ced76fSMatthias Ringwald 858d9ced76fSMatthias Ringwald case GATT_CLIENT_SERVICE_DATABASE_HASH_READ_W2_SEND: 859d9ced76fSMatthias Ringwald if (gatt_client->gatt_service_database_hash_value_handle != 0){ 860d9ced76fSMatthias Ringwald gatt_client->gatt_service_state = GATT_CLIENT_SERVICE_DATABASE_HASH_READ_W4_DONE; 861d9ced76fSMatthias Ringwald status = gatt_client_read_value_of_characteristics_by_uuid16(&gatt_client_service_packet_handler, 862d9ced76fSMatthias Ringwald gatt_client->con_handle, 863d9ced76fSMatthias Ringwald 0x0001, 0xffff, ORG_BLUETOOTH_CHARACTERISTIC_DATABASE_HASH); 864d9ced76fSMatthias Ringwald query_sent = true; 865d9ced76fSMatthias Ringwald break; 866d9ced76fSMatthias Ringwald } 867d9ced76fSMatthias Ringwald 868d9ced76fSMatthias Ringwald /* fall through */ 869d9ced76fSMatthias Ringwald 870d9ced76fSMatthias Ringwald case GATT_CLIENT_SERVICE_DATABASE_HASH_WRITE_CCCD_W2_SEND: 871d9ced76fSMatthias Ringwald if (gatt_client->gatt_service_database_hash_value_handle != 0) { 872d9ced76fSMatthias Ringwald gatt_client->gatt_service_state = GATT_CLIENT_SERVICE_DATABASE_HASH_WRITE_CCCD_W4_DONE; 873d9ced76fSMatthias Ringwald characteristic.value_handle = gatt_client->gatt_service_database_hash_value_handle; 874d9ced76fSMatthias Ringwald characteristic.end_handle = gatt_client->gatt_service_database_hash_end_handle; 875d9ced76fSMatthias Ringwald // we assume good case. We cannot do much otherwise 876d9ced76fSMatthias Ringwald characteristic.properties = ATT_PROPERTY_INDICATE; 877d9ced76fSMatthias Ringwald status = gatt_client_write_client_characteristic_configuration(&gatt_client_service_packet_handler, 878d9ced76fSMatthias Ringwald gatt_client->con_handle, 879d9ced76fSMatthias Ringwald &characteristic, 880d9ced76fSMatthias Ringwald GATT_CLIENT_CHARACTERISTICS_CONFIGURATION_INDICATION); 881d9ced76fSMatthias Ringwald query_sent = true; 882d9ced76fSMatthias Ringwald break; 883d9ced76fSMatthias Ringwald } 884d9ced76fSMatthias Ringwald 885d9ced76fSMatthias Ringwald // DONE 886d9ced76fSMatthias Ringwald gatt_client->gatt_service_state = GATT_CLIENT_SERVICE_DONE; 887d9ced76fSMatthias Ringwald break; 888d9ced76fSMatthias Ringwald default: 889d9ced76fSMatthias Ringwald break; 890d9ced76fSMatthias Ringwald } 891d9ced76fSMatthias Ringwald btstack_assert(status == ERROR_CODE_SUCCESS); 892d9ced76fSMatthias Ringwald UNUSED(status); 893d9ced76fSMatthias Ringwald if (query_sent){ 894d9ced76fSMatthias Ringwald continue; 895d9ced76fSMatthias Ringwald } 896842492f0SMatthias Ringwald #endif 897d9ced76fSMatthias Ringwald 89826166ecfSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 899d9ced76fSMatthias Ringwald query_sent = gatt_client_le_enhanced_handle_can_send_query(gatt_client); 90026166ecfSMatthias Ringwald if (query_sent){ 90126166ecfSMatthias Ringwald continue; 90226166ecfSMatthias Ringwald } 90326166ecfSMatthias Ringwald #endif 90453e9c18fSMatthias Ringwald btstack_context_callback_registration_t * callback = (btstack_context_callback_registration_t *) btstack_linked_list_pop(&gatt_client->query_requests); 90509834412SMatthias Ringwald if (callback == NULL) { 90609834412SMatthias Ringwald return; 90753e9c18fSMatthias Ringwald } 90809834412SMatthias Ringwald (*callback->callback)(callback->context); 90953e9c18fSMatthias Ringwald } 91053e9c18fSMatthias Ringwald } 91153e9c18fSMatthias Ringwald 91223d583b8SMatthias Ringwald // test if notification/indication should be delivered to application (BLESA) 91323d583b8SMatthias Ringwald static bool gatt_client_accept_server_message(gatt_client_t *gatt_client) { 91423d583b8SMatthias Ringwald // ignore messages until re-encryption is complete 91523d583b8SMatthias Ringwald if (gap_reconnect_security_setup_active(gatt_client->con_handle)) return false; 91623d583b8SMatthias Ringwald 91723d583b8SMatthias Ringwald // after that ignore if bonded but not encrypted 91823d583b8SMatthias Ringwald return !gap_bonded(gatt_client->con_handle) || (gap_encryption_key_size(gatt_client->con_handle) > 0); 91923d583b8SMatthias Ringwald } 92023d583b8SMatthias Ringwald 9219c662c9bSMatthias Ringwald static void emit_event_new(btstack_packet_handler_t callback, uint8_t * packet, uint16_t size){ 9229c662c9bSMatthias Ringwald if (!callback) return; 9239da9850bSMatthias Ringwald hci_dump_btstack_event(packet, size); 9249c662c9bSMatthias Ringwald (*callback)(HCI_EVENT_PACKET, 0, packet, size); 9253deb3ec6SMatthias Ringwald } 9263deb3ec6SMatthias Ringwald 927711e6c80SMatthias Ringwald static void emit_event_to_registered_listeners(hci_con_handle_t con_handle, uint16_t attribute_handle, uint8_t * packet, uint16_t size){ 928665d90f2SMatthias Ringwald btstack_linked_list_iterator_t it; 9299c662c9bSMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client_value_listeners); 930665d90f2SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 93186c38559SMatthias Ringwald gatt_client_notification_t * notification = (gatt_client_notification_t*) btstack_linked_list_iterator_next(&it); 932b3f03c84SMatthias Ringwald if ((notification->con_handle != GATT_CLIENT_ANY_CONNECTION) && (notification->con_handle != con_handle)) continue; 933b3f03c84SMatthias Ringwald if ((notification->attribute_handle != GATT_CLIENT_ANY_VALUE_HANDLE) && (notification->attribute_handle != attribute_handle)) continue; 93486c38559SMatthias Ringwald (*notification->callback)(HCI_EVENT_PACKET, 0, packet, size); 9353deb3ec6SMatthias Ringwald } 9363deb3ec6SMatthias Ringwald } 9373deb3ec6SMatthias Ringwald 9385cf1669fSMatthias Ringwald static void emit_gatt_complete_event(gatt_client_t * gatt_client, uint8_t att_status){ 93988371317SMatthias Ringwald // @format H122 94088371317SMatthias Ringwald uint8_t packet[9]; 9416a88036eSMatthias Ringwald hci_event_builder_context_t context; 9426a88036eSMatthias Ringwald hci_event_builder_init(&context, packet, sizeof(packet), GATT_EVENT_QUERY_COMPLETE, 0); 9436a88036eSMatthias Ringwald hci_event_builder_add_con_handle(&context, gatt_client->con_handle); 94488371317SMatthias Ringwald hci_event_builder_add_16(&context, gatt_client->service_id); 94588371317SMatthias Ringwald hci_event_builder_add_16(&context, gatt_client->connection_id); 9466a88036eSMatthias Ringwald hci_event_builder_add_08(&context, att_status); 9476a88036eSMatthias Ringwald emit_event_new(gatt_client->callback, packet, hci_event_builder_get_length(&context)); 9483deb3ec6SMatthias Ringwald } 9493deb3ec6SMatthias Ringwald 950045d700dSDavid 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){ 951521f5820SMatthias Ringwald // @format H22X 952521f5820SMatthias Ringwald uint8_t packet[28]; 953c668d4cfSMatthias Ringwald hci_event_builder_context_t context; 954c668d4cfSMatthias Ringwald hci_event_builder_init(&context, packet, sizeof(packet), GATT_EVENT_SERVICE_QUERY_RESULT, 0); 955c668d4cfSMatthias Ringwald hci_event_builder_add_con_handle(&context, gatt_client->con_handle); 956521f5820SMatthias Ringwald hci_event_builder_add_16(&context, gatt_client->service_id); 957521f5820SMatthias Ringwald hci_event_builder_add_16(&context, gatt_client->connection_id); 958c668d4cfSMatthias Ringwald hci_event_builder_add_16(&context, start_group_handle); 959c668d4cfSMatthias Ringwald hci_event_builder_add_16(&context, end_group_handle); 960c668d4cfSMatthias Ringwald hci_event_builder_add_128(&context, uuid128); 961c668d4cfSMatthias Ringwald emit_event_new(gatt_client->callback, packet, hci_event_builder_get_length(&context)); 9623deb3ec6SMatthias Ringwald } 9633deb3ec6SMatthias Ringwald 964045d700dSDavid 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){ 965d578995fSMatthias Ringwald // @format H22X 966d578995fSMatthias Ringwald uint8_t packet[30]; 967d8ef101dSMatthias Ringwald hci_event_builder_context_t context; 968d8ef101dSMatthias Ringwald hci_event_builder_init(&context, packet, sizeof(packet), GATT_EVENT_INCLUDED_SERVICE_QUERY_RESULT, 0); 969d8ef101dSMatthias Ringwald hci_event_builder_add_con_handle(&context, gatt_client->con_handle); 970d578995fSMatthias Ringwald hci_event_builder_add_16(&context, gatt_client->service_id); 971d578995fSMatthias Ringwald hci_event_builder_add_16(&context, gatt_client->connection_id); 972d8ef101dSMatthias Ringwald hci_event_builder_add_16(&context, include_handle); 973d8ef101dSMatthias Ringwald hci_event_builder_add_16(&context, start_group_handle); 974d8ef101dSMatthias Ringwald hci_event_builder_add_16(&context, end_group_handle); 975d8ef101dSMatthias Ringwald hci_event_builder_add_128(&context, uuid128); 976d8ef101dSMatthias Ringwald emit_event_new(gatt_client->callback, packet, hci_event_builder_get_length(&context)); 9773deb3ec6SMatthias Ringwald } 9783deb3ec6SMatthias Ringwald 9795cf1669fSMatthias 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, 980045d700dSDavid Lechner uint16_t properties, const uint8_t * uuid128){ 981185497a5SMatthias Ringwald // @format H22Y 982185497a5SMatthias Ringwald uint8_t packet[32]; 983b5a7d6a2SMatthias Ringwald hci_event_builder_context_t context; 984b5a7d6a2SMatthias Ringwald hci_event_builder_init(&context, packet, sizeof(packet), GATT_EVENT_CHARACTERISTIC_QUERY_RESULT, 0); 985b5a7d6a2SMatthias Ringwald hci_event_builder_add_con_handle(&context, gatt_client->con_handle); 986185497a5SMatthias Ringwald hci_event_builder_add_16(&context, gatt_client->service_id); 987185497a5SMatthias Ringwald hci_event_builder_add_16(&context, gatt_client->connection_id); 988b5a7d6a2SMatthias Ringwald hci_event_builder_add_16(&context, start_handle); 989b5a7d6a2SMatthias Ringwald hci_event_builder_add_16(&context, value_handle); 990b5a7d6a2SMatthias Ringwald hci_event_builder_add_16(&context, end_handle); 991b5a7d6a2SMatthias Ringwald hci_event_builder_add_16(&context, properties); 992b5a7d6a2SMatthias Ringwald hci_event_builder_add_128(&context, uuid128); 993b5a7d6a2SMatthias Ringwald emit_event_new(gatt_client->callback, packet, hci_event_builder_get_length(&context)); 9943deb3ec6SMatthias Ringwald } 9953deb3ec6SMatthias Ringwald 9963deb3ec6SMatthias Ringwald static void emit_gatt_all_characteristic_descriptors_result_event( 997045d700dSDavid Lechner gatt_client_t * gatt_client, uint16_t descriptor_handle, const uint8_t * uuid128){ 9985a6c9e2aSMatthias Ringwald // @format H22Z 9995a6c9e2aSMatthias Ringwald uint8_t packet[26]; 10001cfd1613SMatthias Ringwald hci_event_builder_context_t context; 10011cfd1613SMatthias Ringwald hci_event_builder_init(&context, packet, sizeof(packet), GATT_EVENT_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY_RESULT, 0); 10021cfd1613SMatthias Ringwald hci_event_builder_add_con_handle(&context, gatt_client->con_handle); 10035a6c9e2aSMatthias Ringwald hci_event_builder_add_16(&context, gatt_client->service_id); 10045a6c9e2aSMatthias Ringwald hci_event_builder_add_16(&context, gatt_client->connection_id); 10051cfd1613SMatthias Ringwald hci_event_builder_add_16(&context, descriptor_handle); 10061cfd1613SMatthias Ringwald hci_event_builder_add_128(&context, uuid128); 10071cfd1613SMatthias Ringwald emit_event_new(gatt_client->callback, packet, hci_event_builder_get_length(&context)); 10083deb3ec6SMatthias Ringwald } 10093deb3ec6SMatthias Ringwald 10105cf1669fSMatthias Ringwald static void emit_gatt_mtu_exchanged_result_event(gatt_client_t * gatt_client, uint16_t new_mtu){ 10118f37572aSJakob Krantz // @format H2 10128f37572aSJakob Krantz uint8_t packet[6]; 10138f37572aSJakob Krantz packet[0] = GATT_EVENT_MTU; 10144ea43905SMatthias Ringwald packet[1] = sizeof(packet) - 2u; 10155cf1669fSMatthias Ringwald little_endian_store_16(packet, 2, gatt_client->con_handle); 10168f37572aSJakob Krantz little_endian_store_16(packet, 4, new_mtu); 10175cf1669fSMatthias Ringwald att_dispatch_client_mtu_exchanged(gatt_client->con_handle, new_mtu); 10185cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, sizeof(packet)); 10198f37572aSJakob Krantz } 102023d583b8SMatthias Ringwald 102123d583b8SMatthias Ringwald // helper 102223d583b8SMatthias Ringwald static void gatt_client_handle_transaction_complete(gatt_client_t *gatt_client, uint8_t att_status) { 1023052dc82aSMatthias Ringwald gatt_client->state = P_READY; 102423d583b8SMatthias Ringwald gatt_client_timeout_stop(gatt_client); 102523d583b8SMatthias Ringwald emit_gatt_complete_event(gatt_client, att_status); 102623d583b8SMatthias Ringwald gatt_client_notify_can_send_query(gatt_client); 102723d583b8SMatthias Ringwald } 102823d583b8SMatthias Ringwald 102923d583b8SMatthias Ringwald // @return packet pointer 1030f6a28e25SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite HCI + L2CAP packet headers + 4 pre_buffer bytes 1031f6a28e25SMatthias Ringwald #define CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE 12 10328450fbf5SMatthias Ringwald static uint8_t * 10338450fbf5SMatthias Ringwald setup_characteristic_value_packet(const gatt_client_t *gatt_client, uint8_t type, uint16_t attribute_handle, 103401e6dd7fSMatthias Ringwald uint8_t *value, uint16_t length, uint16_t service_id, uint16_t connection_id) { 103523d583b8SMatthias Ringwald #ifdef FUZZING_BUILD_MODE_UNSAFE_FOR_PRODUCTION 103623d583b8SMatthias Ringwald // copy value into test packet for testing 103723d583b8SMatthias Ringwald static uint8_t packet[1000]; 1038f51e6883SMatthias Ringwald memcpy(&packet[CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE], value, length); 103923d583b8SMatthias Ringwald #else 104023d583b8SMatthias Ringwald // before the value inside the ATT PDU 104123d583b8SMatthias Ringwald uint8_t * packet = value - CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE; 104223d583b8SMatthias Ringwald #endif 104323d583b8SMatthias Ringwald packet[0] = type; 104423d583b8SMatthias Ringwald packet[1] = CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE - 2 + length; 10458450fbf5SMatthias Ringwald little_endian_store_16(packet, 2, gatt_client->con_handle); 104601e6dd7fSMatthias Ringwald little_endian_store_16(packet, 4, service_id); 104701e6dd7fSMatthias Ringwald little_endian_store_16(packet, 6, connection_id); 1048f6a28e25SMatthias Ringwald little_endian_store_16(packet, 8, attribute_handle); 1049f6a28e25SMatthias Ringwald little_endian_store_16(packet, 10, length); 105023d583b8SMatthias Ringwald return packet; 105123d583b8SMatthias Ringwald } 105223d583b8SMatthias Ringwald 105323d583b8SMatthias Ringwald // @return packet pointer 1054b641e2afSMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite HCI + L2CAP packet headers + 6 pre_buffer bytes 1055b641e2afSMatthias Ringwald #define LONG_CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE 14 1056f51e6883SMatthias Ringwald 1057f51e6883SMatthias Ringwald // L2CAP Header (4) + ACL Header (4) => 8 bytes 1058f51e6883SMatthias Ringwald #if !defined(HCI_INCOMING_PRE_BUFFER_SIZE) || ((HCI_INCOMING_PRE_BUFFER_SIZE < LONG_CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE - 8)) 1059f51e6883SMatthias Ringwald #error "Long Characteristic reads requires HCI_INCOMING_PRE_BUFFER_SIZE >= 2" 1060f51e6883SMatthias Ringwald #endif 1061f51e6883SMatthias Ringwald 10623e78e462SMatthias Ringwald static uint8_t * 10633e78e462SMatthias Ringwald setup_long_characteristic_value_packet(const gatt_client_t *gatt_client, uint8_t type, uint16_t attribute_handle, 10643e78e462SMatthias Ringwald uint16_t offset, uint8_t *value, uint16_t length) { 106523d583b8SMatthias Ringwald #ifdef FUZZING_BUILD_MODE_UNSAFE_FOR_PRODUCTION 106623d583b8SMatthias Ringwald // avoid using pre ATT headers. 1067464b6e7bSMatthias Ringwald // copy value into test packet for testing 1068464b6e7bSMatthias Ringwald static uint8_t packet[1000]; 1069464b6e7bSMatthias Ringwald memcpy(&packet[LONG_CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE], value, length); 1070464b6e7bSMatthias Ringwald #else 107123d583b8SMatthias Ringwald // before the value inside the ATT PDU 107223d583b8SMatthias Ringwald uint8_t * packet = value - LONG_CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE; 1073464b6e7bSMatthias Ringwald #endif 107423d583b8SMatthias Ringwald packet[0] = type; 107523d583b8SMatthias Ringwald packet[1] = LONG_CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE - 2 + length; 10763e78e462SMatthias Ringwald little_endian_store_16(packet, 2, gatt_client->con_handle); 1077b641e2afSMatthias Ringwald little_endian_store_16(packet, 4, gatt_client->service_id); 1078b641e2afSMatthias Ringwald little_endian_store_16(packet, 6, gatt_client->connection_id); 1079b641e2afSMatthias Ringwald little_endian_store_16(packet, 8, attribute_handle); 1080b641e2afSMatthias Ringwald little_endian_store_16(packet, 10, offset); 1081b641e2afSMatthias Ringwald little_endian_store_16(packet, 12, length); 108223d583b8SMatthias Ringwald return packet; 108323d583b8SMatthias Ringwald } 108423d583b8SMatthias Ringwald 1085f7a42e72SMatthias Ringwald #if (LONG_CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE > CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE) 1086f7a42e72SMatthias Ringwald #define REPORT_PREBUFFER_HEADER LONG_CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE 1087f7a42e72SMatthias Ringwald #else 1088f7a42e72SMatthias Ringwald #define REPORT_PREBUFFER_HEADER CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE 1089f7a42e72SMatthias Ringwald #endif 1090f7a42e72SMatthias Ringwald 10918f37572aSJakob Krantz /// 10925cf1669fSMatthias Ringwald static void report_gatt_services(gatt_client_t * gatt_client, uint8_t * packet, uint16_t size){ 109339ac9711SMatthias Ringwald if (size < 2) return; 10943deb3ec6SMatthias Ringwald uint8_t attr_length = packet[1]; 10954ea43905SMatthias Ringwald uint8_t uuid_length = attr_length - 4u; 10963deb3ec6SMatthias Ringwald 10973deb3ec6SMatthias Ringwald int i; 109839ac9711SMatthias Ringwald for (i = 2; (i+attr_length) <= size; i += attr_length){ 1099f8fbdce0SMatthias Ringwald uint16_t start_group_handle = little_endian_read_16(packet,i); 1100f8fbdce0SMatthias Ringwald uint16_t end_group_handle = little_endian_read_16(packet,i+2); 11013deb3ec6SMatthias Ringwald uint8_t uuid128[16]; 11023deb3ec6SMatthias Ringwald uint16_t uuid16 = 0; 11033deb3ec6SMatthias Ringwald 11044ea43905SMatthias Ringwald if (uuid_length == 2u){ 1105f8fbdce0SMatthias Ringwald uuid16 = little_endian_read_16(packet, i+4); 1106e1a125dfSMatthias Ringwald uuid_add_bluetooth_prefix((uint8_t*) &uuid128, uuid16); 110739ac9711SMatthias Ringwald } else if (uuid_length == 16u) { 11089c80e4ccSMatthias Ringwald reverse_128(&packet[i+4], uuid128); 110939ac9711SMatthias Ringwald } else { 111039ac9711SMatthias Ringwald return; 11113deb3ec6SMatthias Ringwald } 11125cf1669fSMatthias Ringwald emit_gatt_service_query_result_event(gatt_client, start_group_handle, end_group_handle, uuid128); 11133deb3ec6SMatthias Ringwald } 11143deb3ec6SMatthias Ringwald } 11153deb3ec6SMatthias Ringwald 111623d583b8SMatthias 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){ 11173deb3ec6SMatthias Ringwald uint8_t uuid128[16]; 11183deb3ec6SMatthias Ringwald uint16_t uuid16 = 0; 11194ea43905SMatthias Ringwald if (uuid_length == 2u){ 1120f8fbdce0SMatthias Ringwald uuid16 = little_endian_read_16(uuid, 0); 1121e1a125dfSMatthias Ringwald uuid_add_bluetooth_prefix((uint8_t*) uuid128, uuid16); 11224ea43905SMatthias Ringwald } else if (uuid_length == 16u){ 11239c80e4ccSMatthias Ringwald reverse_128(uuid, uuid128); 1124d73c9dbeSMilanka Ringwald } else { 1125d73c9dbeSMilanka Ringwald return; 11263deb3ec6SMatthias Ringwald } 11273deb3ec6SMatthias Ringwald 11285cf1669fSMatthias Ringwald if (gatt_client->filter_with_uuid && (memcmp(gatt_client->uuid128, uuid128, 16) != 0)) return; 11293deb3ec6SMatthias Ringwald 11305cf1669fSMatthias Ringwald gatt_client->characteristic_properties = properties; 11315cf1669fSMatthias Ringwald gatt_client->characteristic_start_handle = start_handle; 11325cf1669fSMatthias Ringwald gatt_client->attribute_handle = value_handle; 11333deb3ec6SMatthias Ringwald 11345cf1669fSMatthias Ringwald if (gatt_client->filter_with_uuid) return; 11353deb3ec6SMatthias Ringwald 11365cf1669fSMatthias Ringwald gatt_client->uuid16 = uuid16; 11375cf1669fSMatthias Ringwald (void)memcpy(gatt_client->uuid128, uuid128, 16); 11383deb3ec6SMatthias Ringwald } 11393deb3ec6SMatthias Ringwald 114023d583b8SMatthias Ringwald static void report_gatt_characteristic_end_found(gatt_client_t * gatt_client, uint16_t end_handle){ 11413deb3ec6SMatthias Ringwald // TODO: stop searching if filter and uuid found 11423deb3ec6SMatthias Ringwald 11435cf1669fSMatthias Ringwald if (!gatt_client->characteristic_start_handle) return; 11443deb3ec6SMatthias Ringwald 11455cf1669fSMatthias Ringwald emit_gatt_characteristic_query_result_event(gatt_client, gatt_client->characteristic_start_handle, gatt_client->attribute_handle, 11465cf1669fSMatthias Ringwald end_handle, gatt_client->characteristic_properties, gatt_client->uuid128); 11473deb3ec6SMatthias Ringwald 11485cf1669fSMatthias Ringwald gatt_client->characteristic_start_handle = 0; 11493deb3ec6SMatthias Ringwald } 11503deb3ec6SMatthias Ringwald 115123d583b8SMatthias Ringwald 11525cf1669fSMatthias Ringwald static void report_gatt_characteristics(gatt_client_t * gatt_client, uint8_t * packet, uint16_t size){ 11534ea43905SMatthias Ringwald if (size < 2u) return; 11543deb3ec6SMatthias Ringwald uint8_t attr_length = packet[1]; 11554ea43905SMatthias Ringwald if ((attr_length != 7u) && (attr_length != 21u)) return; 11564ea43905SMatthias Ringwald uint8_t uuid_length = attr_length - 5u; 11573deb3ec6SMatthias Ringwald int i; 11584ea43905SMatthias Ringwald for (i = 2u; (i + attr_length) <= size; i += attr_length){ 1159f8fbdce0SMatthias Ringwald uint16_t start_handle = little_endian_read_16(packet, i); 11603deb3ec6SMatthias Ringwald uint8_t properties = packet[i+2]; 1161f8fbdce0SMatthias Ringwald uint16_t value_handle = little_endian_read_16(packet, i+3); 116223d583b8SMatthias Ringwald report_gatt_characteristic_end_found(gatt_client, start_handle - 1u); 116323d583b8SMatthias Ringwald report_gatt_characteristic_start_found(gatt_client, start_handle, properties, value_handle, &packet[i + 5], 116423d583b8SMatthias Ringwald uuid_length); 11653deb3ec6SMatthias Ringwald } 11663deb3ec6SMatthias Ringwald } 11673deb3ec6SMatthias Ringwald 11685cf1669fSMatthias Ringwald static void report_gatt_included_service_uuid16(gatt_client_t * gatt_client, uint16_t include_handle, uint16_t uuid16){ 11693deb3ec6SMatthias Ringwald uint8_t normalized_uuid128[16]; 1170e1a125dfSMatthias Ringwald uuid_add_bluetooth_prefix(normalized_uuid128, uuid16); 11715cf1669fSMatthias Ringwald emit_gatt_included_service_query_result_event(gatt_client, include_handle, gatt_client->query_start_handle, 11725cf1669fSMatthias Ringwald gatt_client->query_end_handle, normalized_uuid128); 11733deb3ec6SMatthias Ringwald } 11743deb3ec6SMatthias Ringwald 1175045d700dSDavid Lechner static void report_gatt_included_service_uuid128(gatt_client_t * gatt_client, uint16_t include_handle, const uint8_t * uuid128){ 11765cf1669fSMatthias Ringwald emit_gatt_included_service_query_result_event(gatt_client, include_handle, gatt_client->query_start_handle, 11775cf1669fSMatthias Ringwald gatt_client->query_end_handle, uuid128); 11783deb3ec6SMatthias Ringwald } 11793deb3ec6SMatthias Ringwald 1180*d03dbc9cSMatthias Ringwald static void report_gatt_characteristic_value_change(gatt_client_t *gatt_client, uint8_t event_type, uint16_t value_handle, uint8_t *value, int length) { 1181*d03dbc9cSMatthias Ringwald uint8_t * packet = setup_characteristic_value_packet(gatt_client, event_type, value_handle, 1182*d03dbc9cSMatthias Ringwald value, length, 0, 0); 1183*d03dbc9cSMatthias Ringwald emit_event_to_registered_listeners(gatt_client->con_handle, value_handle, packet, CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE + length); 1184*d03dbc9cSMatthias Ringwald } 1185*d03dbc9cSMatthias Ringwald 11863deb3ec6SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite parts of the HCI/L2CAP/ATT packet (4/4/3) bytes 11870fde3c5eSMatthias Ringwald static void report_gatt_notification(gatt_client_t *gatt_client, uint16_t value_handle, uint8_t *value, int length) { 11880fde3c5eSMatthias Ringwald if (!gatt_client_accept_server_message(gatt_client)) return; 1189*d03dbc9cSMatthias Ringwald report_gatt_characteristic_value_change(gatt_client, GATT_EVENT_NOTIFICATION, value_handle, value, length); 11903deb3ec6SMatthias Ringwald } 11913deb3ec6SMatthias Ringwald 11923deb3ec6SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite parts of the HCI/L2CAP/ATT packet (4/4/3) bytes 11930fde3c5eSMatthias Ringwald static void report_gatt_indication(gatt_client_t *gatt_client, uint16_t value_handle, uint8_t *value, int length) { 11940fde3c5eSMatthias Ringwald if (!gatt_client_accept_server_message(gatt_client)) return; 1195842492f0SMatthias Ringwald #ifdef ENABLE_GATT_CLIENT_SERVICE_CHANGED 119658e8c9f5SMatthias Ringwald // Directly Handle GATT Service Changed and Database Hash indications 119758e8c9f5SMatthias Ringwald if (value_handle == gatt_client->gatt_service_database_hash_value_handle){ 119858e8c9f5SMatthias Ringwald gatt_client_service_emit_database_hash(gatt_client, value, length); 119958e8c9f5SMatthias Ringwald } 120058e8c9f5SMatthias Ringwald if (value_handle == gatt_client->gatt_service_changed_value_handle){ 120158e8c9f5SMatthias Ringwald gatt_client_service_emit_service_changed(gatt_client, value, length); 120258e8c9f5SMatthias Ringwald } 1203842492f0SMatthias Ringwald #endif 1204*d03dbc9cSMatthias Ringwald report_gatt_characteristic_value_change(gatt_client, GATT_EVENT_INDICATION, value_handle, value, length); 12053deb3ec6SMatthias Ringwald } 12063deb3ec6SMatthias Ringwald 12073deb3ec6SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite parts of the HCI/L2CAP/ATT packet (4/4/3) bytes 12085cf1669fSMatthias Ringwald static void report_gatt_characteristic_value(gatt_client_t * gatt_client, uint16_t attribute_handle, uint8_t * value, uint16_t length){ 12098450fbf5SMatthias Ringwald uint8_t * packet = setup_characteristic_value_packet( 121001e6dd7fSMatthias Ringwald gatt_client, GATT_EVENT_CHARACTERISTIC_VALUE_QUERY_RESULT, attribute_handle, value, length, gatt_client->service_id, gatt_client->connection_id); 121123d583b8SMatthias Ringwald emit_event_new(gatt_client->callback, packet, CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE + length); 12123deb3ec6SMatthias Ringwald } 12133deb3ec6SMatthias Ringwald 12143deb3ec6SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite parts of the HCI/L2CAP/ATT packet (4/4/3) bytes 12155cf1669fSMatthias 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){ 12163e78e462SMatthias Ringwald uint8_t * packet = setup_long_characteristic_value_packet(gatt_client, 12173e78e462SMatthias Ringwald GATT_EVENT_LONG_CHARACTERISTIC_VALUE_QUERY_RESULT, 12183e78e462SMatthias Ringwald attribute_handle, value_offset, 12193e78e462SMatthias Ringwald blob, blob_length); 122023d583b8SMatthias Ringwald emit_event_new(gatt_client->callback, packet, blob_length + LONG_CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE); 12213deb3ec6SMatthias Ringwald } 12223deb3ec6SMatthias Ringwald 12235cf1669fSMatthias 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){ 12249ec2630cSMatthias Ringwald UNUSED(value_offset); 12258450fbf5SMatthias Ringwald uint8_t * packet = setup_characteristic_value_packet(gatt_client, GATT_EVENT_CHARACTERISTIC_DESCRIPTOR_QUERY_RESULT, 12268450fbf5SMatthias Ringwald descriptor_handle, value, 122701e6dd7fSMatthias Ringwald value_length, gatt_client->service_id, gatt_client->connection_id); 12285cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, value_length + 8u); 12293deb3ec6SMatthias Ringwald } 12303deb3ec6SMatthias Ringwald 12315cf1669fSMatthias 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){ 12323e78e462SMatthias Ringwald uint8_t * packet = setup_long_characteristic_value_packet(gatt_client, 12333e78e462SMatthias Ringwald GATT_EVENT_LONG_CHARACTERISTIC_DESCRIPTOR_QUERY_RESULT, 12343e78e462SMatthias Ringwald descriptor_handle, value_offset, 12353e78e462SMatthias Ringwald blob, blob_length); 123623d583b8SMatthias Ringwald emit_event_new(gatt_client->callback, packet, blob_length + LONG_CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE); 12373deb3ec6SMatthias Ringwald } 12383deb3ec6SMatthias Ringwald 12395cf1669fSMatthias Ringwald static void report_gatt_all_characteristic_descriptors(gatt_client_t * gatt_client, uint8_t * packet, uint16_t size, uint16_t pair_size){ 12403deb3ec6SMatthias Ringwald int i; 12414ea43905SMatthias Ringwald for (i = 0u; (i + pair_size) <= size; i += pair_size){ 1242f8fbdce0SMatthias Ringwald uint16_t descriptor_handle = little_endian_read_16(packet,i); 12433deb3ec6SMatthias Ringwald uint8_t uuid128[16]; 12443deb3ec6SMatthias Ringwald uint16_t uuid16 = 0; 12454ea43905SMatthias Ringwald if (pair_size == 4u){ 1246f8fbdce0SMatthias Ringwald uuid16 = little_endian_read_16(packet,i+2); 1247e1a125dfSMatthias Ringwald uuid_add_bluetooth_prefix(uuid128, uuid16); 12483deb3ec6SMatthias Ringwald } else { 12499c80e4ccSMatthias Ringwald reverse_128(&packet[i+2], uuid128); 12503deb3ec6SMatthias Ringwald } 12515cf1669fSMatthias Ringwald emit_gatt_all_characteristic_descriptors_result_event(gatt_client, descriptor_handle, uuid128); 12523deb3ec6SMatthias Ringwald } 12533deb3ec6SMatthias Ringwald 12543deb3ec6SMatthias Ringwald } 12553deb3ec6SMatthias Ringwald 125652377058SMatthias Ringwald static bool is_query_done(gatt_client_t * gatt_client, uint16_t last_result_handle){ 12575cf1669fSMatthias Ringwald return last_result_handle >= gatt_client->end_group_handle; 12583deb3ec6SMatthias Ringwald } 12593deb3ec6SMatthias Ringwald 12605cf1669fSMatthias Ringwald static void trigger_next_query(gatt_client_t * gatt_client, uint16_t last_result_handle, gatt_client_state_t next_query_state){ 12615cf1669fSMatthias Ringwald if (is_query_done(gatt_client, last_result_handle)){ 1262526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 12633deb3ec6SMatthias Ringwald return; 12643deb3ec6SMatthias Ringwald } 12653deb3ec6SMatthias Ringwald // next 12665cf1669fSMatthias Ringwald gatt_client->start_group_handle = last_result_handle + 1u; 1267052dc82aSMatthias Ringwald gatt_client->state = next_query_state; 12683deb3ec6SMatthias Ringwald } 12693deb3ec6SMatthias Ringwald 12705cf1669fSMatthias Ringwald static void trigger_next_included_service_query(gatt_client_t * gatt_client, uint16_t last_result_handle){ 12715cf1669fSMatthias Ringwald trigger_next_query(gatt_client, last_result_handle, P_W2_SEND_INCLUDED_SERVICE_QUERY); 12723deb3ec6SMatthias Ringwald } 12733deb3ec6SMatthias Ringwald 12745cf1669fSMatthias Ringwald static void trigger_next_service_query(gatt_client_t * gatt_client, uint16_t last_result_handle){ 12755cf1669fSMatthias Ringwald trigger_next_query(gatt_client, last_result_handle, P_W2_SEND_SERVICE_QUERY); 12763deb3ec6SMatthias Ringwald } 12773deb3ec6SMatthias Ringwald 12785cf1669fSMatthias Ringwald static void trigger_next_service_by_uuid_query(gatt_client_t * gatt_client, uint16_t last_result_handle){ 12795cf1669fSMatthias Ringwald trigger_next_query(gatt_client, last_result_handle, P_W2_SEND_SERVICE_WITH_UUID_QUERY); 12803deb3ec6SMatthias Ringwald } 12813deb3ec6SMatthias Ringwald 12825cf1669fSMatthias Ringwald static void trigger_next_characteristic_query(gatt_client_t * gatt_client, uint16_t last_result_handle){ 12835cf1669fSMatthias Ringwald if (is_query_done(gatt_client, last_result_handle)){ 12843deb3ec6SMatthias Ringwald // report last characteristic 128523d583b8SMatthias Ringwald report_gatt_characteristic_end_found(gatt_client, gatt_client->end_group_handle); 12863deb3ec6SMatthias Ringwald } 12875cf1669fSMatthias Ringwald trigger_next_query(gatt_client, last_result_handle, P_W2_SEND_ALL_CHARACTERISTICS_OF_SERVICE_QUERY); 12883deb3ec6SMatthias Ringwald } 12893deb3ec6SMatthias Ringwald 12905cf1669fSMatthias Ringwald static void trigger_next_characteristic_descriptor_query(gatt_client_t * gatt_client, uint16_t last_result_handle){ 12915cf1669fSMatthias Ringwald trigger_next_query(gatt_client, last_result_handle, P_W2_SEND_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY); 12923deb3ec6SMatthias Ringwald } 12933deb3ec6SMatthias Ringwald 12945cf1669fSMatthias Ringwald static void trigger_next_read_by_type_query(gatt_client_t * gatt_client, uint16_t last_result_handle){ 12955cf1669fSMatthias Ringwald trigger_next_query(gatt_client, last_result_handle, P_W2_SEND_READ_BY_TYPE_REQUEST); 12963deb3ec6SMatthias Ringwald } 12973deb3ec6SMatthias Ringwald 12985cf1669fSMatthias 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){ 12995cf1669fSMatthias Ringwald gatt_client->attribute_offset += write_blob_length(gatt_client); 13005cf1669fSMatthias Ringwald uint16_t next_blob_length = write_blob_length(gatt_client); 13013deb3ec6SMatthias Ringwald 13024ea43905SMatthias Ringwald if (next_blob_length == 0u){ 1303052dc82aSMatthias Ringwald gatt_client->state = done_state; 13043deb3ec6SMatthias Ringwald return; 13053deb3ec6SMatthias Ringwald } 1306052dc82aSMatthias Ringwald gatt_client->state = next_query_state; 13073deb3ec6SMatthias Ringwald } 13083deb3ec6SMatthias Ringwald 13095cf1669fSMatthias Ringwald static void trigger_next_blob_query(gatt_client_t * gatt_client, gatt_client_state_t next_query_state, uint16_t received_blob_length){ 13103deb3ec6SMatthias Ringwald 1311dda77937SMatthias Ringwald uint16_t max_blob_length = gatt_client->mtu - 1u; 13123deb3ec6SMatthias Ringwald if (received_blob_length < max_blob_length){ 1313526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 13143deb3ec6SMatthias Ringwald return; 13153deb3ec6SMatthias Ringwald } 13163deb3ec6SMatthias Ringwald 13175cf1669fSMatthias Ringwald gatt_client->attribute_offset += received_blob_length; 1318052dc82aSMatthias Ringwald gatt_client->state = next_query_state; 13193deb3ec6SMatthias Ringwald } 13203deb3ec6SMatthias Ringwald 132123d583b8SMatthias 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){ 132223d583b8SMatthias Ringwald notification->callback = callback; 132323d583b8SMatthias Ringwald notification->con_handle = con_handle; 132423d583b8SMatthias Ringwald if (characteristic == NULL){ 132523d583b8SMatthias Ringwald notification->attribute_handle = GATT_CLIENT_ANY_VALUE_HANDLE; 132623d583b8SMatthias Ringwald } else { 132723d583b8SMatthias Ringwald notification->attribute_handle = characteristic->value_handle; 132823d583b8SMatthias Ringwald } 132923d583b8SMatthias Ringwald btstack_linked_list_add(&gatt_client_value_listeners, (btstack_linked_item_t*) notification); 133023d583b8SMatthias Ringwald } 133123d583b8SMatthias Ringwald 133223d583b8SMatthias Ringwald void gatt_client_stop_listening_for_characteristic_value_updates(gatt_client_notification_t * notification){ 133323d583b8SMatthias Ringwald btstack_linked_list_remove(&gatt_client_value_listeners, (btstack_linked_item_t*) notification); 133423d583b8SMatthias Ringwald } 13353deb3ec6SMatthias Ringwald 133662f7b41dSMatthias Ringwald static bool is_value_valid(gatt_client_t *gatt_client, uint8_t *packet, uint16_t size){ 1337f8fbdce0SMatthias Ringwald uint16_t attribute_handle = little_endian_read_16(packet, 1); 1338f8fbdce0SMatthias Ringwald uint16_t value_offset = little_endian_read_16(packet, 3); 13393deb3ec6SMatthias Ringwald 134062f7b41dSMatthias Ringwald if (gatt_client->attribute_handle != attribute_handle) return false; 134162f7b41dSMatthias Ringwald if (gatt_client->attribute_offset != value_offset) return false; 13425cf1669fSMatthias Ringwald return memcmp(&gatt_client->attribute_value[gatt_client->attribute_offset], &packet[5], size - 5u) == 0u; 13433deb3ec6SMatthias Ringwald } 13443deb3ec6SMatthias Ringwald 13450038504eSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 134692a7335eSMatthias Ringwald static void gatt_client_run_for_client_start_signed_write(gatt_client_t *gatt_client) { 134792a7335eSMatthias Ringwald sm_key_t csrk; 134892a7335eSMatthias Ringwald le_device_db_local_csrk_get(gatt_client->le_device_index, csrk); 134992a7335eSMatthias Ringwald uint32_t sign_counter = le_device_db_local_counter_get(gatt_client->le_device_index); 1350052dc82aSMatthias Ringwald gatt_client->state = P_W4_CMAC_RESULT; 135192a7335eSMatthias 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); 135292a7335eSMatthias Ringwald } 13530038504eSMatthias Ringwald #endif 135492a7335eSMatthias Ringwald 135592a7335eSMatthias Ringwald // returns true if packet was sent 13561979f09cSMatthias Ringwald static bool gatt_client_run_for_gatt_client(gatt_client_t * gatt_client){ 13573deb3ec6SMatthias Ringwald 1358e4d159baSMatthias Ringwald // wait until re-encryption is complete 13591979f09cSMatthias Ringwald if (gap_reconnect_security_setup_active(gatt_client->con_handle)) return false; 1360d1e1a57fSMatthias Ringwald 1361e4d159baSMatthias Ringwald // wait until re-encryption is complete 13621979f09cSMatthias Ringwald if (gatt_client->reencryption_active) return false; 13636c124bc2SMatthias Ringwald 136411279da7SMatthias Ringwald // wait until pairing complete (either reactive authentication or due to required security level) 13651979f09cSMatthias Ringwald if (gatt_client->wait_for_authentication_complete) return false; 136611279da7SMatthias Ringwald 1367052dc82aSMatthias Ringwald bool client_request_pending = gatt_client->state != P_READY; 1368fd14b205SMatthias Ringwald 13691aa9e3e8SMatthias Ringwald // verify security level for Mandatory Authentication over LE 137046012949SMatthias Ringwald bool check_security; 137146012949SMatthias Ringwald switch (gatt_client->bearer_type){ 137246012949SMatthias Ringwald case ATT_BEARER_UNENHANCED_LE: 137346012949SMatthias Ringwald check_security = true; 137446012949SMatthias Ringwald break; 137546012949SMatthias Ringwald default: 13769ced96e1SMatthias Ringwald check_security = false; 137746012949SMatthias Ringwald break; 13789ced96e1SMatthias Ringwald } 13799ced96e1SMatthias Ringwald if (client_request_pending && (gatt_client_required_security_level > gatt_client->security_level) && check_security){ 13801dfae9c7SMatthias Ringwald log_info("Trigger pairing, current security level %u, required %u\n", gatt_client->security_level, gatt_client_required_security_level); 13812197dbafSMatthias Ringwald gatt_client->wait_for_authentication_complete = true; 138211279da7SMatthias Ringwald // set att error code for pairing failure based on required level 138311279da7SMatthias Ringwald switch (gatt_client_required_security_level){ 138411279da7SMatthias Ringwald case LEVEL_4: 138511279da7SMatthias Ringwald case LEVEL_3: 138611279da7SMatthias Ringwald gatt_client->pending_error_code = ATT_ERROR_INSUFFICIENT_AUTHENTICATION; 138711279da7SMatthias Ringwald break; 138811279da7SMatthias Ringwald default: 138911279da7SMatthias Ringwald gatt_client->pending_error_code = ATT_ERROR_INSUFFICIENT_ENCRYPTION; 139011279da7SMatthias Ringwald break; 139111279da7SMatthias Ringwald } 139211279da7SMatthias Ringwald sm_request_pairing(gatt_client->con_handle); 139311279da7SMatthias Ringwald // sm probably just sent a pdu 13941979f09cSMatthias Ringwald return true; 139511279da7SMatthias Ringwald } 1396f4b33574SMatthias Ringwald 13975cf1669fSMatthias Ringwald switch (gatt_client->mtu_state) { 1398544128c3SMatthias Ringwald case SEND_MTU_EXCHANGE: 13995cf1669fSMatthias Ringwald gatt_client->mtu_state = SENT_MTU_EXCHANGE; 14006e7b444cSMatthias Ringwald att_exchange_mtu_request(gatt_client); 14011979f09cSMatthias Ringwald return true; 14023deb3ec6SMatthias Ringwald case SENT_MTU_EXCHANGE: 14031979f09cSMatthias Ringwald return false; 14043deb3ec6SMatthias Ringwald default: 14053deb3ec6SMatthias Ringwald break; 14063deb3ec6SMatthias Ringwald } 14073deb3ec6SMatthias Ringwald 14085cf1669fSMatthias Ringwald if (gatt_client->send_confirmation){ 140952377058SMatthias Ringwald gatt_client->send_confirmation = false; 14106e7b444cSMatthias Ringwald att_confirmation(gatt_client); 14111979f09cSMatthias Ringwald return true; 14123deb3ec6SMatthias Ringwald } 14133deb3ec6SMatthias Ringwald 14143deb3ec6SMatthias Ringwald // check MTU for writes 1415052dc82aSMatthias Ringwald switch (gatt_client->state){ 14163deb3ec6SMatthias Ringwald case P_W2_SEND_WRITE_CHARACTERISTIC_VALUE: 14173deb3ec6SMatthias Ringwald case P_W2_SEND_WRITE_CHARACTERISTIC_DESCRIPTOR: 1418dda77937SMatthias Ringwald if (gatt_client->attribute_length <= (gatt_client->mtu - 3u)) break; 1419dda77937SMatthias Ringwald log_error("gatt_client_run: value len %u > MTU %u - 3\n", gatt_client->attribute_length,gatt_client->mtu); 1420526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_INVALID_ATTRIBUTE_VALUE_LENGTH); 14211979f09cSMatthias Ringwald return false; 14223deb3ec6SMatthias Ringwald default: 14233deb3ec6SMatthias Ringwald break; 14243deb3ec6SMatthias Ringwald } 14253deb3ec6SMatthias Ringwald 14260038504eSMatthias Ringwald bool packet_sent = true; 14270038504eSMatthias Ringwald bool done = true; 1428052dc82aSMatthias Ringwald switch (gatt_client->state){ 14293deb3ec6SMatthias Ringwald case P_W2_SEND_SERVICE_QUERY: 1430052dc82aSMatthias Ringwald gatt_client->state = P_W4_SERVICE_QUERY_RESULT; 14315cf1669fSMatthias Ringwald send_gatt_services_request(gatt_client); 14320038504eSMatthias Ringwald break; 14333deb3ec6SMatthias Ringwald 14343deb3ec6SMatthias Ringwald case P_W2_SEND_SERVICE_WITH_UUID_QUERY: 1435052dc82aSMatthias Ringwald gatt_client->state = P_W4_SERVICE_WITH_UUID_RESULT; 14365cf1669fSMatthias Ringwald send_gatt_services_by_uuid_request(gatt_client); 14370038504eSMatthias Ringwald break; 14383deb3ec6SMatthias Ringwald 14393deb3ec6SMatthias Ringwald case P_W2_SEND_ALL_CHARACTERISTICS_OF_SERVICE_QUERY: 1440052dc82aSMatthias Ringwald gatt_client->state = P_W4_ALL_CHARACTERISTICS_OF_SERVICE_QUERY_RESULT; 14415cf1669fSMatthias Ringwald send_gatt_characteristic_request(gatt_client); 14420038504eSMatthias Ringwald break; 14433deb3ec6SMatthias Ringwald 14443deb3ec6SMatthias Ringwald case P_W2_SEND_CHARACTERISTIC_WITH_UUID_QUERY: 1445052dc82aSMatthias Ringwald gatt_client->state = P_W4_CHARACTERISTIC_WITH_UUID_QUERY_RESULT; 14465cf1669fSMatthias Ringwald send_gatt_characteristic_request(gatt_client); 14470038504eSMatthias Ringwald break; 14483deb3ec6SMatthias Ringwald 14493deb3ec6SMatthias Ringwald case P_W2_SEND_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY: 1450052dc82aSMatthias Ringwald gatt_client->state = P_W4_CHARACTERISTIC_WITH_UUID_QUERY_RESULT; 14515cf1669fSMatthias Ringwald send_gatt_characteristic_descriptor_request(gatt_client); 14520038504eSMatthias Ringwald break; 14533deb3ec6SMatthias Ringwald 14543deb3ec6SMatthias Ringwald case P_W2_SEND_INCLUDED_SERVICE_QUERY: 1455052dc82aSMatthias Ringwald gatt_client->state = P_W4_INCLUDED_SERVICE_QUERY_RESULT; 14565cf1669fSMatthias Ringwald send_gatt_included_service_request(gatt_client); 14570038504eSMatthias Ringwald break; 14583deb3ec6SMatthias Ringwald 14593deb3ec6SMatthias Ringwald case P_W2_SEND_INCLUDED_SERVICE_WITH_UUID_QUERY: 1460052dc82aSMatthias Ringwald gatt_client->state = P_W4_INCLUDED_SERVICE_UUID_WITH_QUERY_RESULT; 14615cf1669fSMatthias Ringwald send_gatt_included_service_uuid_request(gatt_client); 14620038504eSMatthias Ringwald break; 14633deb3ec6SMatthias Ringwald 14643deb3ec6SMatthias Ringwald case P_W2_SEND_READ_CHARACTERISTIC_VALUE_QUERY: 1465052dc82aSMatthias Ringwald gatt_client->state = P_W4_READ_CHARACTERISTIC_VALUE_RESULT; 14665cf1669fSMatthias Ringwald send_gatt_read_characteristic_value_request(gatt_client); 14670038504eSMatthias Ringwald break; 14683deb3ec6SMatthias Ringwald 14693deb3ec6SMatthias Ringwald case P_W2_SEND_READ_BLOB_QUERY: 1470052dc82aSMatthias Ringwald gatt_client->state = P_W4_READ_BLOB_RESULT; 14715cf1669fSMatthias Ringwald send_gatt_read_blob_request(gatt_client); 14720038504eSMatthias Ringwald break; 14733deb3ec6SMatthias Ringwald 14743deb3ec6SMatthias Ringwald case P_W2_SEND_READ_BY_TYPE_REQUEST: 1475052dc82aSMatthias Ringwald gatt_client->state = P_W4_READ_BY_TYPE_RESPONSE; 14765cf1669fSMatthias Ringwald send_gatt_read_by_type_request(gatt_client); 14770038504eSMatthias Ringwald break; 14783deb3ec6SMatthias Ringwald 14793deb3ec6SMatthias Ringwald case P_W2_SEND_READ_MULTIPLE_REQUEST: 1480052dc82aSMatthias Ringwald gatt_client->state = P_W4_READ_MULTIPLE_RESPONSE; 14815cf1669fSMatthias Ringwald send_gatt_read_multiple_request(gatt_client); 14820038504eSMatthias Ringwald break; 14833deb3ec6SMatthias Ringwald 1484f125a8efSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 1485f125a8efSMatthias Ringwald case P_W2_SEND_READ_MULTIPLE_VARIABLE_REQUEST: 1486052dc82aSMatthias Ringwald gatt_client->state = P_W4_READ_MULTIPLE_VARIABLE_RESPONSE; 1487f125a8efSMatthias Ringwald send_gatt_read_multiple_variable_request(gatt_client); 1488f125a8efSMatthias Ringwald break; 1489f125a8efSMatthias Ringwald #endif 1490f125a8efSMatthias Ringwald 14913deb3ec6SMatthias Ringwald case P_W2_SEND_WRITE_CHARACTERISTIC_VALUE: 1492052dc82aSMatthias Ringwald gatt_client->state = P_W4_WRITE_CHARACTERISTIC_VALUE_RESULT; 14935cf1669fSMatthias Ringwald send_gatt_write_attribute_value_request(gatt_client); 14940038504eSMatthias Ringwald break; 14953deb3ec6SMatthias Ringwald 14963deb3ec6SMatthias Ringwald case P_W2_PREPARE_WRITE: 1497052dc82aSMatthias Ringwald gatt_client->state = P_W4_PREPARE_WRITE_RESULT; 14985cf1669fSMatthias Ringwald send_gatt_prepare_write_request(gatt_client); 14990038504eSMatthias Ringwald break; 15003deb3ec6SMatthias Ringwald 15013deb3ec6SMatthias Ringwald case P_W2_PREPARE_WRITE_SINGLE: 1502052dc82aSMatthias Ringwald gatt_client->state = P_W4_PREPARE_WRITE_SINGLE_RESULT; 15035cf1669fSMatthias Ringwald send_gatt_prepare_write_request(gatt_client); 15040038504eSMatthias Ringwald break; 15053deb3ec6SMatthias Ringwald 15063deb3ec6SMatthias Ringwald case P_W2_PREPARE_RELIABLE_WRITE: 1507052dc82aSMatthias Ringwald gatt_client->state = P_W4_PREPARE_RELIABLE_WRITE_RESULT; 15085cf1669fSMatthias Ringwald send_gatt_prepare_write_request(gatt_client); 15090038504eSMatthias Ringwald break; 15103deb3ec6SMatthias Ringwald 15113deb3ec6SMatthias Ringwald case P_W2_EXECUTE_PREPARED_WRITE: 1512052dc82aSMatthias Ringwald gatt_client->state = P_W4_EXECUTE_PREPARED_WRITE_RESULT; 15135cf1669fSMatthias Ringwald send_gatt_execute_write_request(gatt_client); 15140038504eSMatthias Ringwald break; 15153deb3ec6SMatthias Ringwald 15163deb3ec6SMatthias Ringwald case P_W2_CANCEL_PREPARED_WRITE: 1517052dc82aSMatthias Ringwald gatt_client->state = P_W4_CANCEL_PREPARED_WRITE_RESULT; 15185cf1669fSMatthias Ringwald send_gatt_cancel_prepared_write_request(gatt_client); 15190038504eSMatthias Ringwald break; 15203deb3ec6SMatthias Ringwald 15213deb3ec6SMatthias Ringwald case P_W2_CANCEL_PREPARED_WRITE_DATA_MISMATCH: 1522052dc82aSMatthias Ringwald gatt_client->state = P_W4_CANCEL_PREPARED_WRITE_DATA_MISMATCH_RESULT; 15235cf1669fSMatthias Ringwald send_gatt_cancel_prepared_write_request(gatt_client); 15240038504eSMatthias Ringwald break; 15253deb3ec6SMatthias Ringwald 1526abdc9fb5SMatthias Ringwald #ifdef ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY 1527abdc9fb5SMatthias Ringwald case P_W2_SEND_FIND_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY: 1528abdc9fb5SMatthias Ringwald // use Find Information 15295cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_FIND_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY_RESULT; 15305cf1669fSMatthias Ringwald send_gatt_characteristic_descriptor_request(gatt_client); 1531abdc9fb5SMatthias Ringwald #else 15323deb3ec6SMatthias Ringwald case P_W2_SEND_READ_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY: 1533abdc9fb5SMatthias Ringwald // Use Read By Type 1534052dc82aSMatthias Ringwald gatt_client->state = P_W4_READ_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY_RESULT; 15355cf1669fSMatthias Ringwald send_gatt_read_client_characteristic_configuration_request(gatt_client); 1536abdc9fb5SMatthias Ringwald #endif 15370038504eSMatthias Ringwald break; 15383deb3ec6SMatthias Ringwald 15393deb3ec6SMatthias Ringwald case P_W2_SEND_READ_CHARACTERISTIC_DESCRIPTOR_QUERY: 1540052dc82aSMatthias Ringwald gatt_client->state = P_W4_READ_CHARACTERISTIC_DESCRIPTOR_RESULT; 15415cf1669fSMatthias Ringwald send_gatt_read_characteristic_descriptor_request(gatt_client); 15420038504eSMatthias Ringwald break; 15433deb3ec6SMatthias Ringwald 15443deb3ec6SMatthias Ringwald case P_W2_SEND_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_QUERY: 1545052dc82aSMatthias Ringwald gatt_client->state = P_W4_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_RESULT; 15465cf1669fSMatthias Ringwald send_gatt_read_blob_request(gatt_client); 15470038504eSMatthias Ringwald break; 15483deb3ec6SMatthias Ringwald 15493deb3ec6SMatthias Ringwald case P_W2_SEND_WRITE_CHARACTERISTIC_DESCRIPTOR: 1550052dc82aSMatthias Ringwald gatt_client->state = P_W4_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT; 15515cf1669fSMatthias Ringwald send_gatt_write_attribute_value_request(gatt_client); 15520038504eSMatthias Ringwald break; 15533deb3ec6SMatthias Ringwald 15543deb3ec6SMatthias Ringwald case P_W2_WRITE_CLIENT_CHARACTERISTIC_CONFIGURATION: 1555052dc82aSMatthias Ringwald gatt_client->state = P_W4_CLIENT_CHARACTERISTIC_CONFIGURATION_RESULT; 15565cf1669fSMatthias Ringwald send_gatt_write_client_characteristic_configuration_request(gatt_client); 15570038504eSMatthias Ringwald break; 15583deb3ec6SMatthias Ringwald 15593deb3ec6SMatthias Ringwald case P_W2_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR: 1560052dc82aSMatthias Ringwald gatt_client->state = P_W4_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT; 15615cf1669fSMatthias Ringwald send_gatt_prepare_write_request(gatt_client); 15620038504eSMatthias Ringwald break; 15633deb3ec6SMatthias Ringwald 15643deb3ec6SMatthias Ringwald case P_W2_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR: 1565052dc82aSMatthias Ringwald gatt_client->state = P_W4_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT; 15665cf1669fSMatthias Ringwald send_gatt_execute_write_request(gatt_client); 15670038504eSMatthias Ringwald break; 15683deb3ec6SMatthias Ringwald 15697a766ebfSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 1570793cf6ceSMatthias Ringwald case P_W4_IDENTITY_RESOLVING: 15715cf1669fSMatthias Ringwald log_info("P_W4_IDENTITY_RESOLVING - state %x", sm_identity_resolving_state(gatt_client->con_handle)); 15725cf1669fSMatthias Ringwald switch (sm_identity_resolving_state(gatt_client->con_handle)){ 1573793cf6ceSMatthias Ringwald case IRK_LOOKUP_SUCCEEDED: 15745cf1669fSMatthias Ringwald gatt_client->le_device_index = sm_le_device_index(gatt_client->con_handle); 1575052dc82aSMatthias Ringwald gatt_client->state = P_W4_CMAC_READY; 157692a7335eSMatthias Ringwald if (sm_cmac_ready()){ 157792a7335eSMatthias Ringwald gatt_client_run_for_client_start_signed_write(gatt_client); 157892a7335eSMatthias Ringwald } 1579793cf6ceSMatthias Ringwald break; 1580793cf6ceSMatthias Ringwald case IRK_LOOKUP_FAILED: 1581526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_BONDING_INFORMATION_MISSING); 158292a7335eSMatthias Ringwald break; 1583793cf6ceSMatthias Ringwald default: 158492a7335eSMatthias Ringwald break; 1585793cf6ceSMatthias Ringwald } 15860038504eSMatthias Ringwald packet_sent = false; 15870038504eSMatthias Ringwald break; 1588793cf6ceSMatthias Ringwald 15893deb3ec6SMatthias Ringwald case P_W4_CMAC_READY: 15903deb3ec6SMatthias Ringwald if (sm_cmac_ready()){ 159192a7335eSMatthias Ringwald gatt_client_run_for_client_start_signed_write(gatt_client); 15923deb3ec6SMatthias Ringwald } 15930038504eSMatthias Ringwald packet_sent = false; 15940038504eSMatthias Ringwald break; 15953deb3ec6SMatthias Ringwald 15963deb3ec6SMatthias Ringwald case P_W2_SEND_SIGNED_WRITE: { 15974c7c987fSMatthias Ringwald gatt_client->state = P_W4_SEND_SIGNED_WRITE_DONE; 15983deb3ec6SMatthias Ringwald // bump local signing counter 15995cf1669fSMatthias Ringwald uint32_t sign_counter = le_device_db_local_counter_get(gatt_client->le_device_index); 16005cf1669fSMatthias Ringwald le_device_db_local_counter_set(gatt_client->le_device_index, sign_counter + 1); 160164b12680SMatthias Ringwald // send signed write command 16025cf1669fSMatthias Ringwald send_gatt_signed_write_request(gatt_client, sign_counter); 16033deb3ec6SMatthias Ringwald // finally, notifiy client that write is complete 1604526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 1605b68ac7a5SMatthias Ringwald break; 16063deb3ec6SMatthias Ringwald } 16077a766ebfSMatthias Ringwald #endif 16083deb3ec6SMatthias Ringwald default: 1609b68ac7a5SMatthias Ringwald done = false; 16103deb3ec6SMatthias Ringwald break; 16113deb3ec6SMatthias Ringwald } 161247181045SMatthias Ringwald 16130038504eSMatthias Ringwald if (done){ 16140038504eSMatthias Ringwald return packet_sent; 16150038504eSMatthias Ringwald } 16160038504eSMatthias Ringwald 161759d34cd2SMatthias Ringwald // write without response callback 161859d34cd2SMatthias Ringwald btstack_context_callback_registration_t * callback = 161959d34cd2SMatthias Ringwald (btstack_context_callback_registration_t *) btstack_linked_list_pop(&gatt_client->write_without_response_requests); 162059d34cd2SMatthias Ringwald if (callback != NULL){ 162159d34cd2SMatthias Ringwald (*callback->callback)(callback->context); 162259d34cd2SMatthias Ringwald return true; 162359d34cd2SMatthias Ringwald } 162459d34cd2SMatthias Ringwald 162559d34cd2SMatthias Ringwald // requested can send now old 1626f688bdb8SMatthias Ringwald if (gatt_client->write_without_response_callback != NULL){ 16275cf1669fSMatthias Ringwald btstack_packet_handler_t packet_handler = gatt_client->write_without_response_callback; 16285cf1669fSMatthias Ringwald gatt_client->write_without_response_callback = NULL; 162947181045SMatthias Ringwald uint8_t event[4]; 163047181045SMatthias Ringwald event[0] = GATT_EVENT_CAN_WRITE_WITHOUT_RESPONSE; 16314ea43905SMatthias Ringwald event[1] = sizeof(event) - 2u; 16325cf1669fSMatthias Ringwald little_endian_store_16(event, 2, gatt_client->con_handle); 16335cf1669fSMatthias Ringwald packet_handler(HCI_EVENT_PACKET, gatt_client->con_handle, event, sizeof(event)); 16341979f09cSMatthias Ringwald return true; // to trigger requeueing (even if higher layer didn't sent) 163547181045SMatthias Ringwald } 163647181045SMatthias Ringwald 16371979f09cSMatthias Ringwald return false; 16383deb3ec6SMatthias Ringwald } 16393deb3ec6SMatthias Ringwald 1640544128c3SMatthias Ringwald static void gatt_client_run(void){ 1641544128c3SMatthias Ringwald btstack_linked_item_t *it; 1642109c2548SMatthias Ringwald bool packet_sent; 16437627a0deSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 16447627a0deSMatthias Ringwald btstack_linked_list_iterator_t it_eatt; 16457627a0deSMatthias Ringwald #endif 1646a0da043fSMatthias Ringwald for (it = (btstack_linked_item_t *) gatt_client_connections; it != NULL; it = it->next){ 16475cf1669fSMatthias Ringwald gatt_client_t * gatt_client = (gatt_client_t *) it; 164846012949SMatthias Ringwald switch (gatt_client->bearer_type){ 164946012949SMatthias Ringwald case ATT_BEARER_UNENHANCED_LE: 16507627a0deSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 16517627a0deSMatthias Ringwald btstack_linked_list_iterator_init(&it_eatt, &gatt_client->eatt_clients); 16527627a0deSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it_eatt)) { 16537627a0deSMatthias Ringwald gatt_client_t * eatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it_eatt); 1654052dc82aSMatthias Ringwald if (eatt_client->state != P_READY){ 16554c226876SMatthias Ringwald if (att_dispatch_client_can_send_now(gatt_client->con_handle)){ 16567627a0deSMatthias Ringwald gatt_client_run_for_gatt_client(eatt_client); 16577627a0deSMatthias Ringwald } 16587627a0deSMatthias Ringwald } 16597627a0deSMatthias Ringwald } 16607627a0deSMatthias Ringwald #endif 166146012949SMatthias Ringwald if (!att_dispatch_client_can_send_now(gatt_client->con_handle)) { 166246012949SMatthias Ringwald att_dispatch_client_request_can_send_now_event(gatt_client->con_handle); 166346012949SMatthias Ringwald return; 166446012949SMatthias Ringwald } 1665109c2548SMatthias Ringwald packet_sent = gatt_client_run_for_gatt_client(gatt_client); 166646012949SMatthias Ringwald if (packet_sent){ 166746012949SMatthias Ringwald // request new permission 166846012949SMatthias Ringwald att_dispatch_client_request_can_send_now_event(gatt_client->con_handle); 166946012949SMatthias Ringwald // requeue client for fairness and exit 167046012949SMatthias Ringwald // note: iterator has become invalid 167146012949SMatthias Ringwald btstack_linked_list_remove(&gatt_client_connections, (btstack_linked_item_t *) gatt_client); 167246012949SMatthias Ringwald btstack_linked_list_add_tail(&gatt_client_connections, (btstack_linked_item_t *) gatt_client); 167346012949SMatthias Ringwald return; 167446012949SMatthias Ringwald } 167546012949SMatthias Ringwald break; 16761450cdc6SMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC 167746012949SMatthias Ringwald case ATT_BEARER_UNENHANCED_CLASSIC: 16781450cdc6SMatthias Ringwald if (gatt_client->con_handle == HCI_CON_HANDLE_INVALID) { 16791450cdc6SMatthias Ringwald continue; 16801450cdc6SMatthias Ringwald } 16811aa9e3e8SMatthias Ringwald 16821aa9e3e8SMatthias Ringwald // handle GATT over BR/EDR 16834c226876SMatthias Ringwald if (att_dispatch_client_can_send_now(gatt_client->con_handle) == false) { 16844c226876SMatthias Ringwald att_dispatch_client_request_can_send_now_event(gatt_client->con_handle); 16851aa9e3e8SMatthias Ringwald return; 16861aa9e3e8SMatthias Ringwald } 1687109c2548SMatthias Ringwald packet_sent = gatt_client_run_for_gatt_client(gatt_client); 16881aa9e3e8SMatthias Ringwald if (packet_sent){ 16891aa9e3e8SMatthias Ringwald // request new permission 16901aa9e3e8SMatthias Ringwald att_dispatch_client_request_can_send_now_event(gatt_client->con_handle); 16911aa9e3e8SMatthias Ringwald // requeue client for fairness and exit 16921aa9e3e8SMatthias Ringwald // note: iterator has become invalid 16931aa9e3e8SMatthias Ringwald btstack_linked_list_remove(&gatt_client_connections, (btstack_linked_item_t *) gatt_client); 16941aa9e3e8SMatthias Ringwald btstack_linked_list_add_tail(&gatt_client_connections, (btstack_linked_item_t *) gatt_client); 16951aa9e3e8SMatthias Ringwald return; 16961aa9e3e8SMatthias Ringwald } 169746012949SMatthias Ringwald break; 16981450cdc6SMatthias Ringwald #endif 169946012949SMatthias Ringwald default: 170046012949SMatthias Ringwald btstack_unreachable(); 170146012949SMatthias Ringwald break; 1702544128c3SMatthias Ringwald } 170346012949SMatthias Ringwald 170446012949SMatthias Ringwald 1705544128c3SMatthias Ringwald } 17063deb3ec6SMatthias Ringwald } 17073deb3ec6SMatthias Ringwald 1708544a5845SMatthias Ringwald // emit complete event, used to avoid emitting event from API call 1709544a5845SMatthias Ringwald static void gatt_client_emit_events(void * context){ 1710544a5845SMatthias Ringwald UNUSED(context); 1711544a5845SMatthias Ringwald btstack_linked_item_t *it; 1712544a5845SMatthias Ringwald for (it = (btstack_linked_item_t *) gatt_client_connections; it != NULL; it = it->next) { 1713544a5845SMatthias Ringwald gatt_client_t *gatt_client = (gatt_client_t *) it; 1714544a5845SMatthias Ringwald if (gatt_client->state == P_W2_EMIT_QUERY_COMPLETE_EVENT){ 1715544a5845SMatthias Ringwald gatt_client->state = P_READY; 1716544a5845SMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_SUCCESS); 1717544a5845SMatthias Ringwald } 1718544a5845SMatthias Ringwald } 1719544a5845SMatthias Ringwald } 1720544a5845SMatthias Ringwald 17215cf1669fSMatthias Ringwald static void gatt_client_report_error_if_pending(gatt_client_t *gatt_client, uint8_t att_error_code) { 1722643a64fcSMatthias Ringwald if (is_ready(gatt_client)) return; 1723526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, att_error_code); 17243deb3ec6SMatthias Ringwald } 17253deb3ec6SMatthias Ringwald 172678c4542aSMatthias Ringwald static void gatt_client_handle_reencryption_complete(const uint8_t * packet){ 172778c4542aSMatthias Ringwald hci_con_handle_t con_handle = sm_event_reencryption_complete_get_handle(packet); 172878c4542aSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_get_context_for_handle(con_handle); 172978c4542aSMatthias Ringwald if (gatt_client == NULL) return; 173078c4542aSMatthias Ringwald 173178c4542aSMatthias Ringwald // update security level 173278c4542aSMatthias Ringwald gatt_client->security_level = gatt_client_le_security_level_for_connection(con_handle); 173378c4542aSMatthias Ringwald 173478c4542aSMatthias Ringwald gatt_client->reencryption_result = sm_event_reencryption_complete_get_status(packet); 173578c4542aSMatthias Ringwald gatt_client->reencryption_active = false; 17362197dbafSMatthias Ringwald gatt_client->wait_for_authentication_complete = false; 173778c4542aSMatthias Ringwald 1738052dc82aSMatthias Ringwald if (gatt_client->state == P_READY) return; 173978c4542aSMatthias Ringwald 174078c4542aSMatthias Ringwald switch (sm_event_reencryption_complete_get_status(packet)){ 174178c4542aSMatthias Ringwald case ERROR_CODE_SUCCESS: 174278c4542aSMatthias Ringwald log_info("re-encryption success, retry operation"); 174378c4542aSMatthias Ringwald break; 174478c4542aSMatthias Ringwald case ERROR_CODE_AUTHENTICATION_FAILURE: 174578c4542aSMatthias Ringwald case ERROR_CODE_PIN_OR_KEY_MISSING: 174678c4542aSMatthias Ringwald #if defined(ENABLE_GATT_CLIENT_PAIRING) && !defined(ENABLE_LE_PROACTIVE_AUTHENTICATION) 174778c4542aSMatthias Ringwald if (gatt_client_required_security_level == LEVEL_0) { 174878c4542aSMatthias Ringwald // re-encryption failed for reactive authentication with pairing and we have a pending client request 174978c4542aSMatthias Ringwald // => try to resolve it by deleting bonding information if we started pairing before 175078c4542aSMatthias Ringwald // delete bonding information 175178c4542aSMatthias Ringwald int le_device_db_index = sm_le_device_index(gatt_client->con_handle); 175278c4542aSMatthias Ringwald btstack_assert(le_device_db_index >= 0); 175378c4542aSMatthias Ringwald log_info("reactive auth with pairing: delete bonding and start pairing"); 175478c4542aSMatthias Ringwald #ifdef ENABLE_LE_PRIVACY_ADDRESS_RESOLUTION 175578c4542aSMatthias Ringwald hci_remove_le_device_db_entry_from_resolving_list((uint16_t) le_device_db_index); 175678c4542aSMatthias Ringwald #endif 175778c4542aSMatthias Ringwald le_device_db_remove(le_device_db_index); 175878c4542aSMatthias Ringwald // trigger pairing again 175978c4542aSMatthias Ringwald sm_request_pairing(gatt_client->con_handle); 176078c4542aSMatthias Ringwald break; 176178c4542aSMatthias Ringwald } 176278c4542aSMatthias Ringwald #endif 176378c4542aSMatthias Ringwald // report bonding information missing 1764526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_BONDING_INFORMATION_MISSING); 176578c4542aSMatthias Ringwald break; 176678c4542aSMatthias Ringwald default: 176778c4542aSMatthias Ringwald // report bonding information missing 1768526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, gatt_client->pending_error_code); 176978c4542aSMatthias Ringwald break; 177078c4542aSMatthias Ringwald } 177178c4542aSMatthias Ringwald } 177278c4542aSMatthias Ringwald 177378c4542aSMatthias Ringwald static void gatt_client_handle_disconnection_complete(const uint8_t * packet){ 177478c4542aSMatthias Ringwald log_info("GATT Client: HCI_EVENT_DISCONNECTION_COMPLETE"); 177578c4542aSMatthias Ringwald hci_con_handle_t con_handle = little_endian_read_16(packet,3); 177678c4542aSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_get_context_for_handle(con_handle); 177778c4542aSMatthias Ringwald if (gatt_client == NULL) return; 177878c4542aSMatthias Ringwald 177978c4542aSMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, ATT_ERROR_HCI_DISCONNECT_RECEIVED); 178078c4542aSMatthias Ringwald gatt_client_timeout_stop(gatt_client); 178178c4542aSMatthias Ringwald btstack_linked_list_remove(&gatt_client_connections, (btstack_linked_item_t *) gatt_client); 178278c4542aSMatthias Ringwald btstack_memory_gatt_client_free(gatt_client); 178378c4542aSMatthias Ringwald } 178478c4542aSMatthias Ringwald 1785f4b33574SMatthias Ringwald static void gatt_client_event_packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size){ 17861ac26e06SMatthias Ringwald UNUSED(channel); // ok: handling own l2cap events 17871ac26e06SMatthias Ringwald UNUSED(size); // ok: there is no channel 17889ec2630cSMatthias Ringwald 1789361b1363SMatthias Ringwald if (packet_type != HCI_EVENT_PACKET) return; 1790361b1363SMatthias Ringwald 1791f4b33574SMatthias Ringwald hci_con_handle_t con_handle; 17925cf1669fSMatthias Ringwald gatt_client_t * gatt_client; 17930e2df43fSMatthias Ringwald switch (hci_event_packet_get_type(packet)) { 17943deb3ec6SMatthias Ringwald case HCI_EVENT_DISCONNECTION_COMPLETE: 179578c4542aSMatthias Ringwald gatt_client_handle_disconnection_complete(packet); 17963deb3ec6SMatthias Ringwald break; 1797f4b33574SMatthias Ringwald 1798f4b33574SMatthias Ringwald // Pairing complete (with/without bonding=storing of pairing information) 1799f4b33574SMatthias Ringwald case SM_EVENT_PAIRING_COMPLETE: 1800f4b33574SMatthias Ringwald con_handle = sm_event_pairing_complete_get_handle(packet); 18015cf1669fSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(con_handle); 18025cf1669fSMatthias Ringwald if (gatt_client == NULL) break; 1803f4b33574SMatthias Ringwald 18041dfae9c7SMatthias Ringwald // update security level 18051dfae9c7SMatthias Ringwald gatt_client->security_level = gatt_client_le_security_level_for_connection(con_handle); 18061dfae9c7SMatthias Ringwald 18073503dc74SMatthias Ringwald if (gatt_client->wait_for_authentication_complete){ 18082197dbafSMatthias Ringwald gatt_client->wait_for_authentication_complete = false; 1809f688bdb8SMatthias Ringwald if (sm_event_pairing_complete_get_status(packet) != ERROR_CODE_SUCCESS){ 18105cf1669fSMatthias Ringwald log_info("pairing failed, report previous error 0x%x", gatt_client->pending_error_code); 1811ec9babacSMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, gatt_client->pending_error_code); 1812f4b33574SMatthias Ringwald } else { 1813f4b33574SMatthias Ringwald log_info("pairing success, retry operation"); 18143deb3ec6SMatthias Ringwald } 1815f4b33574SMatthias Ringwald } 1816f4b33574SMatthias Ringwald break; 181711279da7SMatthias Ringwald 1818793cf6ceSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 1819793cf6ceSMatthias Ringwald // Identity Resolving completed (no code, gatt_client_run will continue) 1820793cf6ceSMatthias Ringwald case SM_EVENT_IDENTITY_RESOLVING_SUCCEEDED: 1821793cf6ceSMatthias Ringwald case SM_EVENT_IDENTITY_RESOLVING_FAILED: 1822793cf6ceSMatthias Ringwald break; 1823793cf6ceSMatthias Ringwald #endif 1824a95ca902SMatthias Ringwald 18258918bbdaSMatthias Ringwald // re-encryption started 18268918bbdaSMatthias Ringwald case SM_EVENT_REENCRYPTION_STARTED: 18278918bbdaSMatthias Ringwald con_handle = sm_event_reencryption_complete_get_handle(packet); 18288918bbdaSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(con_handle); 18298918bbdaSMatthias Ringwald if (gatt_client == NULL) break; 18308918bbdaSMatthias Ringwald 18318918bbdaSMatthias Ringwald gatt_client->reencryption_active = true; 18328918bbdaSMatthias Ringwald gatt_client->reencryption_result = ERROR_CODE_SUCCESS; 18338918bbdaSMatthias Ringwald break; 18348918bbdaSMatthias Ringwald 1835ec9babacSMatthias Ringwald // re-encryption complete 1836ec9babacSMatthias Ringwald case SM_EVENT_REENCRYPTION_COMPLETE: 183778c4542aSMatthias Ringwald gatt_client_handle_reencryption_complete(packet); 1838ec9babacSMatthias Ringwald break; 18393deb3ec6SMatthias Ringwald default: 18403deb3ec6SMatthias Ringwald break; 18413deb3ec6SMatthias Ringwald } 18423deb3ec6SMatthias Ringwald 1843361b1363SMatthias Ringwald gatt_client_run(); 18443deb3ec6SMatthias Ringwald } 18453deb3ec6SMatthias Ringwald 18462da0d963SMatthias Ringwald static void gatt_client_handle_att_read_response(gatt_client_t *gatt_client, uint8_t *packet, uint16_t size) { 1847052dc82aSMatthias Ringwald switch (gatt_client->state) { 18482da0d963SMatthias Ringwald case P_W4_INCLUDED_SERVICE_UUID_WITH_QUERY_RESULT: 18492da0d963SMatthias Ringwald if (size >= 17) { 18502da0d963SMatthias Ringwald uint8_t uuid128[16]; 18512da0d963SMatthias Ringwald reverse_128(&packet[1], uuid128); 18522da0d963SMatthias Ringwald report_gatt_included_service_uuid128(gatt_client, gatt_client->start_group_handle, uuid128); 18532da0d963SMatthias Ringwald } 18542da0d963SMatthias Ringwald trigger_next_included_service_query(gatt_client, gatt_client->start_group_handle); 18555611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 18563deb3ec6SMatthias Ringwald break; 18572da0d963SMatthias Ringwald 18582da0d963SMatthias Ringwald case P_W4_READ_CHARACTERISTIC_VALUE_RESULT: 18592da0d963SMatthias Ringwald report_gatt_characteristic_value(gatt_client, gatt_client->attribute_handle, &packet[1], size - 1u); 1860526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 18612da0d963SMatthias Ringwald break; 18622da0d963SMatthias Ringwald 18632da0d963SMatthias Ringwald case P_W4_READ_CHARACTERISTIC_DESCRIPTOR_RESULT: 18642da0d963SMatthias Ringwald report_gatt_characteristic_descriptor(gatt_client, gatt_client->attribute_handle, &packet[1], 18652da0d963SMatthias Ringwald size - 1u, 0u); 1866526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 18672da0d963SMatthias Ringwald break; 18682da0d963SMatthias Ringwald 18692da0d963SMatthias Ringwald // Use ATT_READ_REQUEST for first blob of Read Long Characteristic 18702da0d963SMatthias Ringwald case P_W4_READ_BLOB_RESULT: 18712da0d963SMatthias Ringwald report_gatt_long_characteristic_value_blob(gatt_client, gatt_client->attribute_handle, &packet[1], 18722da0d963SMatthias Ringwald size - 1u, gatt_client->attribute_offset); 18732da0d963SMatthias Ringwald trigger_next_blob_query(gatt_client, P_W2_SEND_READ_BLOB_QUERY, size - 1u); 18742da0d963SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 18752da0d963SMatthias Ringwald break; 18762da0d963SMatthias Ringwald 18772da0d963SMatthias Ringwald // Use ATT_READ_REQUEST for first blob of Read Long Characteristic Descriptor 18782da0d963SMatthias Ringwald case P_W4_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_RESULT: 18792da0d963SMatthias Ringwald report_gatt_long_characteristic_descriptor(gatt_client, gatt_client->attribute_handle, &packet[1], 18802da0d963SMatthias Ringwald size - 1u, gatt_client->attribute_offset); 18812da0d963SMatthias Ringwald trigger_next_blob_query(gatt_client, P_W2_SEND_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_QUERY, 18822da0d963SMatthias Ringwald size - 1u); 18832da0d963SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 18842da0d963SMatthias Ringwald break; 18852da0d963SMatthias Ringwald 18863deb3ec6SMatthias Ringwald default: 18873deb3ec6SMatthias Ringwald break; 18883deb3ec6SMatthias Ringwald } 18892da0d963SMatthias Ringwald } 18903deb3ec6SMatthias Ringwald 18912da0d963SMatthias Ringwald static void gatt_client_handle_att_read_by_type_response(gatt_client_t *gatt_client, uint8_t *packet, uint16_t size) { 1892052dc82aSMatthias Ringwald switch (gatt_client->state) { 18933deb3ec6SMatthias Ringwald case P_W4_ALL_CHARACTERISTICS_OF_SERVICE_QUERY_RESULT: 18945cf1669fSMatthias Ringwald report_gatt_characteristics(gatt_client, packet, size); 1895cf8e5718SMatthias Ringwald trigger_next_characteristic_query(gatt_client, 1896cf8e5718SMatthias Ringwald get_last_result_handle_from_characteristics_list(packet, size)); 18975611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done, or by ATT_ERROR 18983deb3ec6SMatthias Ringwald break; 18993deb3ec6SMatthias Ringwald case P_W4_CHARACTERISTIC_WITH_UUID_QUERY_RESULT: 19005cf1669fSMatthias Ringwald report_gatt_characteristics(gatt_client, packet, size); 1901cf8e5718SMatthias Ringwald trigger_next_characteristic_query(gatt_client, 1902cf8e5718SMatthias Ringwald get_last_result_handle_from_characteristics_list(packet, size)); 19035611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done, or by ATT_ERROR 19043deb3ec6SMatthias Ringwald break; 1905cf8e5718SMatthias Ringwald case P_W4_INCLUDED_SERVICE_QUERY_RESULT: { 19064ea43905SMatthias Ringwald if (size < 2u) break; 19073deb3ec6SMatthias Ringwald uint16_t uuid16 = 0; 19083deb3ec6SMatthias Ringwald uint16_t pair_size = packet[1]; 19093deb3ec6SMatthias Ringwald 19104ea43905SMatthias Ringwald if (pair_size == 6u) { 19114ea43905SMatthias Ringwald if (size < 8u) break; 19123deb3ec6SMatthias Ringwald // UUIDs not available, query first included service 19135cf1669fSMatthias Ringwald gatt_client->start_group_handle = little_endian_read_16(packet, 2); // ready for next query 19145cf1669fSMatthias Ringwald gatt_client->query_start_handle = little_endian_read_16(packet, 4); 19155cf1669fSMatthias Ringwald gatt_client->query_end_handle = little_endian_read_16(packet, 6); 1916052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_INCLUDED_SERVICE_WITH_UUID_QUERY; 19173deb3ec6SMatthias Ringwald break; 19183deb3ec6SMatthias Ringwald } 19193deb3ec6SMatthias Ringwald 19204ea43905SMatthias Ringwald if (pair_size != 8u) break; 19219f698c82SMatthias Ringwald 19229f698c82SMatthias Ringwald // UUIDs included, report all of them 19233deb3ec6SMatthias Ringwald uint16_t offset; 19244ea43905SMatthias Ringwald for (offset = 2u; (offset + 8u) <= size; offset += pair_size) { 1925f8fbdce0SMatthias Ringwald uint16_t include_handle = little_endian_read_16(packet, offset); 19265cf1669fSMatthias Ringwald gatt_client->query_start_handle = little_endian_read_16(packet, offset + 2u); 19275cf1669fSMatthias Ringwald gatt_client->query_end_handle = little_endian_read_16(packet, offset + 4u); 19284ea43905SMatthias Ringwald uuid16 = little_endian_read_16(packet, offset + 6u); 19295cf1669fSMatthias Ringwald report_gatt_included_service_uuid16(gatt_client, include_handle, uuid16); 19303deb3ec6SMatthias Ringwald } 19313deb3ec6SMatthias Ringwald 1932cf8e5718SMatthias Ringwald trigger_next_included_service_query(gatt_client, 1933cf8e5718SMatthias Ringwald get_last_result_handle_from_included_services_list(packet, 1934cf8e5718SMatthias Ringwald size)); 19355611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 19363deb3ec6SMatthias Ringwald break; 19373deb3ec6SMatthias Ringwald } 1938abdc9fb5SMatthias Ringwald #ifndef ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY 19393deb3ec6SMatthias Ringwald case P_W4_READ_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY_RESULT: 19405cf1669fSMatthias Ringwald gatt_client->client_characteristic_configuration_handle = little_endian_read_16(packet, 2); 1941052dc82aSMatthias Ringwald gatt_client->state = P_W2_WRITE_CLIENT_CHARACTERISTIC_CONFIGURATION; 19423deb3ec6SMatthias Ringwald break; 1943abdc9fb5SMatthias Ringwald #endif 19443deb3ec6SMatthias Ringwald case P_W4_READ_BY_TYPE_RESPONSE: { 19453deb3ec6SMatthias Ringwald uint16_t pair_size = packet[1]; 194639ac9711SMatthias Ringwald // set last result handle to last valid handle, only used if pair_size invalid 194739ac9711SMatthias Ringwald uint16_t last_result_handle = 0xffff; 194839ac9711SMatthias Ringwald if (pair_size > 2) { 19493deb3ec6SMatthias Ringwald uint16_t offset; 19503deb3ec6SMatthias Ringwald for (offset = 2; offset < size; offset += pair_size) { 1951f8fbdce0SMatthias Ringwald uint16_t value_handle = little_endian_read_16(packet, offset); 1952cf8e5718SMatthias Ringwald report_gatt_characteristic_value(gatt_client, value_handle, &packet[offset + 2u], 1953cf8e5718SMatthias Ringwald pair_size - 2u); 19543deb3ec6SMatthias Ringwald last_result_handle = value_handle; 19553deb3ec6SMatthias Ringwald } 195639ac9711SMatthias Ringwald } 19575cf1669fSMatthias Ringwald trigger_next_read_by_type_query(gatt_client, last_result_handle); 19583deb3ec6SMatthias Ringwald break; 19593deb3ec6SMatthias Ringwald } 19603deb3ec6SMatthias Ringwald default: 19613deb3ec6SMatthias Ringwald break; 19623deb3ec6SMatthias Ringwald } 196339ac9711SMatthias Ringwald } 1964dc13fd8dSMatthias Ringwald 19652da0d963SMatthias Ringwald static void gatt_client_handle_att_write_response(gatt_client_t *gatt_client) { 1966052dc82aSMatthias Ringwald switch (gatt_client->state) { 19672da0d963SMatthias Ringwald case P_W4_WRITE_CHARACTERISTIC_VALUE_RESULT: 1968526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 19693deb3ec6SMatthias Ringwald break; 19702da0d963SMatthias Ringwald case P_W4_CLIENT_CHARACTERISTIC_CONFIGURATION_RESULT: 1971526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 19723deb3ec6SMatthias Ringwald break; 19732da0d963SMatthias Ringwald case P_W4_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT: 1974526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 19752da0d963SMatthias Ringwald break; 19762da0d963SMatthias Ringwald default: 19772da0d963SMatthias Ringwald break; 19782da0d963SMatthias Ringwald } 19792da0d963SMatthias Ringwald } 1980dc13fd8dSMatthias Ringwald 19812da0d963SMatthias Ringwald static void gatt_client_handle_att_response(gatt_client_t * gatt_client, uint8_t * packet, uint16_t size) { 19824740230fSMatthias Ringwald uint8_t att_status; 19832da0d963SMatthias Ringwald switch (packet[0]) { 19842da0d963SMatthias Ringwald case ATT_EXCHANGE_MTU_RESPONSE: { 19852da0d963SMatthias Ringwald if (size < 3u) break; 198646012949SMatthias Ringwald bool update_gatt_server_att_mtu = false; 19872da0d963SMatthias Ringwald uint16_t remote_rx_mtu = little_endian_read_16(packet, 1); 19882da0d963SMatthias Ringwald uint16_t local_rx_mtu = l2cap_max_le_mtu(); 198946012949SMatthias Ringwald switch (gatt_client->bearer_type){ 199046012949SMatthias Ringwald case ATT_BEARER_UNENHANCED_LE: 199146012949SMatthias Ringwald update_gatt_server_att_mtu = true; 199246012949SMatthias Ringwald break; 19932da0d963SMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC 199446012949SMatthias Ringwald case ATT_BEARER_UNENHANCED_CLASSIC: 19952da0d963SMatthias Ringwald local_rx_mtu = gatt_client->mtu; 199646012949SMatthias Ringwald break; 19972da0d963SMatthias Ringwald #endif 199846012949SMatthias Ringwald default: 199946012949SMatthias Ringwald btstack_unreachable(); 200046012949SMatthias Ringwald break; 200146012949SMatthias Ringwald } 200246012949SMatthias Ringwald 20032da0d963SMatthias Ringwald uint16_t mtu = (remote_rx_mtu < local_rx_mtu) ? remote_rx_mtu : local_rx_mtu; 20042da0d963SMatthias Ringwald 20052da0d963SMatthias Ringwald // set gatt client mtu 20062da0d963SMatthias Ringwald gatt_client->mtu = mtu; 20072da0d963SMatthias Ringwald gatt_client->mtu_state = MTU_EXCHANGED; 20082da0d963SMatthias Ringwald 200946012949SMatthias Ringwald if (update_gatt_server_att_mtu){ 20102da0d963SMatthias Ringwald // set per connection mtu state - for fixed channel 20112da0d963SMatthias Ringwald hci_connection_t *hci_connection = hci_connection_for_handle(gatt_client->con_handle); 20122da0d963SMatthias Ringwald hci_connection->att_connection.mtu = gatt_client->mtu; 20132da0d963SMatthias Ringwald hci_connection->att_connection.mtu_exchanged = true; 20142da0d963SMatthias Ringwald } 20152da0d963SMatthias Ringwald emit_gatt_mtu_exchanged_result_event(gatt_client, gatt_client->mtu); 20162da0d963SMatthias Ringwald break; 20172da0d963SMatthias Ringwald } 20182da0d963SMatthias Ringwald case ATT_READ_BY_GROUP_TYPE_RESPONSE: 2019052dc82aSMatthias Ringwald switch (gatt_client->state) { 20202da0d963SMatthias Ringwald case P_W4_SERVICE_QUERY_RESULT: 20212da0d963SMatthias Ringwald report_gatt_services(gatt_client, packet, size); 20222da0d963SMatthias Ringwald trigger_next_service_query(gatt_client, get_last_result_handle_from_service_list(packet, size)); 202330952227SMilanka Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 202430952227SMilanka Ringwald break; 20253deb3ec6SMatthias Ringwald default: 20263deb3ec6SMatthias Ringwald break; 20273deb3ec6SMatthias Ringwald } 20283deb3ec6SMatthias Ringwald break; 20292da0d963SMatthias Ringwald case ATT_HANDLE_VALUE_NOTIFICATION: 20302da0d963SMatthias Ringwald if (size < 3u) return; 20312da0d963SMatthias Ringwald report_gatt_notification(gatt_client, little_endian_read_16(packet, 1u), &packet[3], size - 3u); 20322da0d963SMatthias Ringwald return; 2033cbba69d5SMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 2034cbba69d5SMatthias Ringwald case ATT_MULTIPLE_HANDLE_VALUE_NTF: 2035cbba69d5SMatthias Ringwald if (size >= 5u) { 2036cbba69d5SMatthias Ringwald uint16_t offset = 1; 2037cbba69d5SMatthias Ringwald while (true){ 2038cbba69d5SMatthias Ringwald uint16_t value_handle = little_endian_read_16(packet, offset); 2039cbba69d5SMatthias Ringwald offset += 2; 2040cbba69d5SMatthias Ringwald uint16_t value_length = little_endian_read_16(packet, offset); 2041cbba69d5SMatthias Ringwald offset += 2; 2042cbba69d5SMatthias Ringwald if ((offset + value_length) > size) break; 2043cbba69d5SMatthias Ringwald report_gatt_notification(gatt_client, value_handle, &packet[offset], value_length); 2044cbba69d5SMatthias Ringwald offset += value_length; 2045cbba69d5SMatthias Ringwald } 2046cbba69d5SMatthias Ringwald } 2047cbba69d5SMatthias Ringwald return; 2048cbba69d5SMatthias Ringwald #endif 20492da0d963SMatthias Ringwald case ATT_HANDLE_VALUE_INDICATION: 20502da0d963SMatthias Ringwald if (size < 3u) break; 20512da0d963SMatthias Ringwald report_gatt_indication(gatt_client, little_endian_read_16(packet, 1u), &packet[3], size - 3u); 205252377058SMatthias Ringwald gatt_client->send_confirmation = true; 20532da0d963SMatthias Ringwald break; 20542da0d963SMatthias Ringwald case ATT_READ_BY_TYPE_RESPONSE: 20552da0d963SMatthias Ringwald gatt_client_handle_att_read_by_type_response(gatt_client, packet, size); 20562da0d963SMatthias Ringwald break; 20572da0d963SMatthias Ringwald case ATT_READ_RESPONSE: 20582da0d963SMatthias Ringwald gatt_client_handle_att_read_response(gatt_client, packet, size); 20592da0d963SMatthias Ringwald break; 2060cf8e5718SMatthias Ringwald case ATT_FIND_BY_TYPE_VALUE_RESPONSE: { 20613deb3ec6SMatthias Ringwald uint8_t pair_size = 4; 20623deb3ec6SMatthias Ringwald int i; 20633deb3ec6SMatthias Ringwald uint16_t start_group_handle; 20645611a760SMatthias Ringwald uint16_t end_group_handle = 0xffff; // asserts GATT_EVENT_QUERY_COMPLETE is emitted if no results 20654ea43905SMatthias Ringwald for (i = 1u; (i + pair_size) <= size; i += pair_size) { 2066f8fbdce0SMatthias Ringwald start_group_handle = little_endian_read_16(packet, i); 2067f8fbdce0SMatthias Ringwald end_group_handle = little_endian_read_16(packet, i + 2); 2068cf8e5718SMatthias Ringwald emit_gatt_service_query_result_event(gatt_client, start_group_handle, end_group_handle, 2069cf8e5718SMatthias Ringwald gatt_client->uuid128); 20703deb3ec6SMatthias Ringwald } 20715cf1669fSMatthias Ringwald trigger_next_service_by_uuid_query(gatt_client, end_group_handle); 20725611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 20733deb3ec6SMatthias Ringwald break; 20743deb3ec6SMatthias Ringwald } 2075cf8e5718SMatthias Ringwald case ATT_FIND_INFORMATION_REPLY: { 20764ea43905SMatthias Ringwald if (size < 2u) break; 2077a6121b51SMilanka Ringwald 20783deb3ec6SMatthias Ringwald uint8_t pair_size = 4; 20794ea43905SMatthias Ringwald if (packet[1u] == 2u) { 20803deb3ec6SMatthias Ringwald pair_size = 18; 20813deb3ec6SMatthias Ringwald } 2082a6121b51SMilanka Ringwald uint16_t offset = 2; 2083a6121b51SMilanka Ringwald 2084a6121b51SMilanka Ringwald if (size < (pair_size + offset)) break; 2085f8fbdce0SMatthias Ringwald uint16_t last_descriptor_handle = little_endian_read_16(packet, size - pair_size); 2086abdc9fb5SMatthias Ringwald 2087abdc9fb5SMatthias Ringwald #ifdef ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY 20885cf1669fSMatthias Ringwald log_info("ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY, state %x", gatt_client->gatt_client_state); 20895cf1669fSMatthias Ringwald if (gatt_client->gatt_client_state == P_W4_FIND_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY_RESULT){ 2090abdc9fb5SMatthias Ringwald // iterate over descriptors looking for CCC 2091abdc9fb5SMatthias Ringwald if (pair_size == 4){ 2092a6121b51SMilanka Ringwald while ((offset + 4) <= size){ 2093abdc9fb5SMatthias Ringwald uint16_t uuid16 = little_endian_read_16(packet, offset + 2); 2094abdc9fb5SMatthias Ringwald if (uuid16 == GATT_CLIENT_CHARACTERISTICS_CONFIGURATION){ 20955cf1669fSMatthias Ringwald gatt_client->client_characteristic_configuration_handle = little_endian_read_16(packet, offset); 20965cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_WRITE_CLIENT_CHARACTERISTIC_CONFIGURATION; 20975cf1669fSMatthias Ringwald log_info("CCC found %x", gatt_client->client_characteristic_configuration_handle); 2098abdc9fb5SMatthias Ringwald break; 2099abdc9fb5SMatthias Ringwald } 2100abdc9fb5SMatthias Ringwald offset += pair_size; 2101abdc9fb5SMatthias Ringwald } 2102abdc9fb5SMatthias Ringwald } 21035cf1669fSMatthias Ringwald if (is_query_done(gatt_client, last_descriptor_handle)){ 2104abdc9fb5SMatthias Ringwald 2105abdc9fb5SMatthias Ringwald } else { 2106abdc9fb5SMatthias Ringwald // next 21075cf1669fSMatthias Ringwald gatt_client->start_group_handle = last_descriptor_handle + 1; 21085cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_FIND_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY; 2109abdc9fb5SMatthias Ringwald } 2110abdc9fb5SMatthias Ringwald break; 2111abdc9fb5SMatthias Ringwald } 2112abdc9fb5SMatthias Ringwald #endif 21135cf1669fSMatthias Ringwald report_gatt_all_characteristic_descriptors(gatt_client, &packet[2], size - 2u, pair_size); 21145cf1669fSMatthias Ringwald trigger_next_characteristic_descriptor_query(gatt_client, last_descriptor_handle); 21155611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 21163deb3ec6SMatthias Ringwald break; 21173deb3ec6SMatthias Ringwald } 21183deb3ec6SMatthias Ringwald 21193deb3ec6SMatthias Ringwald case ATT_WRITE_RESPONSE: 21202da0d963SMatthias Ringwald gatt_client_handle_att_write_response(gatt_client); 21213deb3ec6SMatthias Ringwald break; 21223deb3ec6SMatthias Ringwald 21233deb3ec6SMatthias Ringwald case ATT_READ_BLOB_RESPONSE: { 21244ea43905SMatthias Ringwald uint16_t received_blob_length = size - 1u; 2125052dc82aSMatthias Ringwald switch (gatt_client->state) { 21263deb3ec6SMatthias Ringwald case P_W4_READ_BLOB_RESULT: 2127cf8e5718SMatthias Ringwald report_gatt_long_characteristic_value_blob(gatt_client, gatt_client->attribute_handle, &packet[1], 2128cf8e5718SMatthias Ringwald received_blob_length, gatt_client->attribute_offset); 21295cf1669fSMatthias Ringwald trigger_next_blob_query(gatt_client, P_W2_SEND_READ_BLOB_QUERY, received_blob_length); 21305611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 21313deb3ec6SMatthias Ringwald break; 21323deb3ec6SMatthias Ringwald case P_W4_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_RESULT: 21335cf1669fSMatthias Ringwald report_gatt_long_characteristic_descriptor(gatt_client, gatt_client->attribute_handle, 21343deb3ec6SMatthias Ringwald &packet[1], received_blob_length, 21355cf1669fSMatthias Ringwald gatt_client->attribute_offset); 2136cf8e5718SMatthias Ringwald trigger_next_blob_query(gatt_client, P_W2_SEND_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_QUERY, 2137cf8e5718SMatthias Ringwald received_blob_length); 21385611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 21393deb3ec6SMatthias Ringwald break; 21403deb3ec6SMatthias Ringwald default: 21413deb3ec6SMatthias Ringwald break; 21423deb3ec6SMatthias Ringwald } 21433deb3ec6SMatthias Ringwald break; 21443deb3ec6SMatthias Ringwald } 21453deb3ec6SMatthias Ringwald case ATT_PREPARE_WRITE_RESPONSE: 2146052dc82aSMatthias Ringwald switch (gatt_client->state) { 21473deb3ec6SMatthias Ringwald case P_W4_PREPARE_WRITE_SINGLE_RESULT: 21485cf1669fSMatthias Ringwald if (is_value_valid(gatt_client, packet, size)) { 21494740230fSMatthias Ringwald att_status = ATT_ERROR_SUCCESS; 21503deb3ec6SMatthias Ringwald } else { 21514740230fSMatthias Ringwald att_status = ATT_ERROR_DATA_MISMATCH; 21523deb3ec6SMatthias Ringwald } 2153526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, att_status); 21543deb3ec6SMatthias Ringwald break; 21553deb3ec6SMatthias Ringwald 21563deb3ec6SMatthias Ringwald case P_W4_PREPARE_WRITE_RESULT: { 21575cf1669fSMatthias Ringwald gatt_client->attribute_offset = little_endian_read_16(packet, 3); 21585cf1669fSMatthias Ringwald trigger_next_prepare_write_query(gatt_client, P_W2_PREPARE_WRITE, P_W2_EXECUTE_PREPARED_WRITE); 21595611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 21603deb3ec6SMatthias Ringwald break; 21613deb3ec6SMatthias Ringwald } 21623deb3ec6SMatthias Ringwald case P_W4_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT: { 21635cf1669fSMatthias Ringwald gatt_client->attribute_offset = little_endian_read_16(packet, 3); 2164cf8e5718SMatthias Ringwald trigger_next_prepare_write_query(gatt_client, P_W2_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR, 2165cf8e5718SMatthias Ringwald P_W2_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR); 21665611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 21673deb3ec6SMatthias Ringwald break; 21683deb3ec6SMatthias Ringwald } 21693deb3ec6SMatthias Ringwald case P_W4_PREPARE_RELIABLE_WRITE_RESULT: { 21705cf1669fSMatthias Ringwald if (is_value_valid(gatt_client, packet, size)) { 21715cf1669fSMatthias Ringwald gatt_client->attribute_offset = little_endian_read_16(packet, 3); 2172cf8e5718SMatthias Ringwald trigger_next_prepare_write_query(gatt_client, P_W2_PREPARE_RELIABLE_WRITE, 2173cf8e5718SMatthias Ringwald P_W2_EXECUTE_PREPARED_WRITE); 21745611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 21753deb3ec6SMatthias Ringwald break; 21763deb3ec6SMatthias Ringwald } 2177052dc82aSMatthias Ringwald gatt_client->state = P_W2_CANCEL_PREPARED_WRITE_DATA_MISMATCH; 21783deb3ec6SMatthias Ringwald break; 21793deb3ec6SMatthias Ringwald } 21803deb3ec6SMatthias Ringwald default: 21813deb3ec6SMatthias Ringwald break; 21823deb3ec6SMatthias Ringwald } 21833deb3ec6SMatthias Ringwald break; 21843deb3ec6SMatthias Ringwald 21853deb3ec6SMatthias Ringwald case ATT_EXECUTE_WRITE_RESPONSE: 2186052dc82aSMatthias Ringwald switch (gatt_client->state) { 21873deb3ec6SMatthias Ringwald case P_W4_EXECUTE_PREPARED_WRITE_RESULT: 2188526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 21893deb3ec6SMatthias Ringwald break; 21903deb3ec6SMatthias Ringwald case P_W4_CANCEL_PREPARED_WRITE_RESULT: 2191526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 21923deb3ec6SMatthias Ringwald break; 21933deb3ec6SMatthias Ringwald case P_W4_CANCEL_PREPARED_WRITE_DATA_MISMATCH_RESULT: 2194526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_DATA_MISMATCH); 21953deb3ec6SMatthias Ringwald break; 21963deb3ec6SMatthias Ringwald case P_W4_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT: 2197526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 21983deb3ec6SMatthias Ringwald break; 21993deb3ec6SMatthias Ringwald default: 22003deb3ec6SMatthias Ringwald break; 22013deb3ec6SMatthias Ringwald 22023deb3ec6SMatthias Ringwald } 22033deb3ec6SMatthias Ringwald break; 22043deb3ec6SMatthias Ringwald 22053deb3ec6SMatthias Ringwald case ATT_READ_MULTIPLE_RESPONSE: 2206052dc82aSMatthias Ringwald switch (gatt_client->state) { 22073deb3ec6SMatthias Ringwald case P_W4_READ_MULTIPLE_RESPONSE: 22085cf1669fSMatthias Ringwald report_gatt_characteristic_value(gatt_client, 0u, &packet[1], size - 1u); 2209526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 22103deb3ec6SMatthias Ringwald break; 22113deb3ec6SMatthias Ringwald default: 22123deb3ec6SMatthias Ringwald break; 22133deb3ec6SMatthias Ringwald } 22143deb3ec6SMatthias Ringwald break; 22153deb3ec6SMatthias Ringwald 2216f125a8efSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 2217f125a8efSMatthias Ringwald case ATT_READ_MULTIPLE_VARIABLE_RSP: 2218052dc82aSMatthias Ringwald switch (gatt_client->state) { 2219169b9876SMatthias Ringwald case P_W4_READ_MULTIPLE_VARIABLE_RESPONSE: 2220f125a8efSMatthias Ringwald report_gatt_characteristic_value(gatt_client, 0u, &packet[1], size - 1u); 2221f125a8efSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 2222f125a8efSMatthias Ringwald break; 2223f125a8efSMatthias Ringwald default: 2224f125a8efSMatthias Ringwald break; 2225f125a8efSMatthias Ringwald } 2226f125a8efSMatthias Ringwald break; 2227f125a8efSMatthias Ringwald #endif 2228f125a8efSMatthias Ringwald 22293deb3ec6SMatthias Ringwald case ATT_ERROR_RESPONSE: 22304ea43905SMatthias Ringwald if (size < 5u) return; 22314740230fSMatthias Ringwald att_status = packet[4]; 22324740230fSMatthias Ringwald switch (att_status) { 22333deb3ec6SMatthias Ringwald case ATT_ERROR_ATTRIBUTE_NOT_FOUND: { 2234052dc82aSMatthias Ringwald switch (gatt_client->state) { 22353deb3ec6SMatthias Ringwald case P_W4_SERVICE_QUERY_RESULT: 22363deb3ec6SMatthias Ringwald case P_W4_SERVICE_WITH_UUID_RESULT: 22373deb3ec6SMatthias Ringwald case P_W4_INCLUDED_SERVICE_QUERY_RESULT: 22383deb3ec6SMatthias Ringwald case P_W4_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY_RESULT: 2239526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 22403deb3ec6SMatthias Ringwald break; 22413deb3ec6SMatthias Ringwald case P_W4_ALL_CHARACTERISTICS_OF_SERVICE_QUERY_RESULT: 22423deb3ec6SMatthias Ringwald case P_W4_CHARACTERISTIC_WITH_UUID_QUERY_RESULT: 224323d583b8SMatthias Ringwald report_gatt_characteristic_end_found(gatt_client, gatt_client->end_group_handle); 2244526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 22453deb3ec6SMatthias Ringwald break; 22463deb3ec6SMatthias Ringwald case P_W4_READ_BY_TYPE_RESPONSE: 22475cf1669fSMatthias Ringwald if (gatt_client->start_group_handle == gatt_client->query_start_handle) { 22484740230fSMatthias Ringwald att_status = ATT_ERROR_ATTRIBUTE_NOT_FOUND; 22493deb3ec6SMatthias Ringwald } else { 22504740230fSMatthias Ringwald att_status = ATT_ERROR_SUCCESS; 22513deb3ec6SMatthias Ringwald } 2252526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, att_status); 22533deb3ec6SMatthias Ringwald break; 22543deb3ec6SMatthias Ringwald default: 22554740230fSMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, att_status); 22563deb3ec6SMatthias Ringwald break; 22573deb3ec6SMatthias Ringwald } 22583deb3ec6SMatthias Ringwald break; 22593deb3ec6SMatthias Ringwald } 2260f4b33574SMatthias Ringwald 2261f4b33574SMatthias Ringwald #ifdef ENABLE_GATT_CLIENT_PAIRING 2262f4b33574SMatthias Ringwald 2263f4b33574SMatthias Ringwald case ATT_ERROR_INSUFFICIENT_AUTHENTICATION: 2264f4b33574SMatthias Ringwald case ATT_ERROR_INSUFFICIENT_ENCRYPTION_KEY_SIZE: 2265a0e0c2beSMatthias Ringwald case ATT_ERROR_INSUFFICIENT_ENCRYPTION: { 2266a0e0c2beSMatthias Ringwald 2267f4b33574SMatthias Ringwald // security too low 22685cf1669fSMatthias Ringwald if (gatt_client->security_counter > 0) { 22694740230fSMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, att_status); 2270f4b33574SMatthias Ringwald break; 2271f4b33574SMatthias Ringwald } 2272f4b33574SMatthias Ringwald // start security 22735cf1669fSMatthias Ringwald gatt_client->security_counter++; 2274f4b33574SMatthias Ringwald 2275f4b33574SMatthias Ringwald // setup action 2276f4b33574SMatthias Ringwald int retry = 1; 2277052dc82aSMatthias Ringwald switch (gatt_client->state){ 2278f4b33574SMatthias Ringwald case P_W4_READ_CHARACTERISTIC_VALUE_RESULT: 2279052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_CHARACTERISTIC_VALUE_QUERY ; 2280f4b33574SMatthias Ringwald break; 2281f4b33574SMatthias Ringwald case P_W4_READ_BLOB_RESULT: 2282052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_BLOB_QUERY; 2283f4b33574SMatthias Ringwald break; 2284f4b33574SMatthias Ringwald case P_W4_READ_BY_TYPE_RESPONSE: 2285052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_BY_TYPE_REQUEST; 2286f4b33574SMatthias Ringwald break; 2287f4b33574SMatthias Ringwald case P_W4_READ_MULTIPLE_RESPONSE: 2288052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_MULTIPLE_REQUEST; 2289f4b33574SMatthias Ringwald break; 2290f125a8efSMatthias Ringwald case P_W4_READ_MULTIPLE_VARIABLE_RESPONSE: 2291052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_MULTIPLE_VARIABLE_REQUEST; 2292f125a8efSMatthias Ringwald break; 2293f4b33574SMatthias Ringwald case P_W4_WRITE_CHARACTERISTIC_VALUE_RESULT: 2294052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_WRITE_CHARACTERISTIC_VALUE; 2295f4b33574SMatthias Ringwald break; 2296f4b33574SMatthias Ringwald case P_W4_PREPARE_WRITE_RESULT: 2297052dc82aSMatthias Ringwald gatt_client->state = P_W2_PREPARE_WRITE; 2298f4b33574SMatthias Ringwald break; 2299f4b33574SMatthias Ringwald case P_W4_PREPARE_WRITE_SINGLE_RESULT: 2300052dc82aSMatthias Ringwald gatt_client->state = P_W2_PREPARE_WRITE_SINGLE; 2301f4b33574SMatthias Ringwald break; 2302f4b33574SMatthias Ringwald case P_W4_PREPARE_RELIABLE_WRITE_RESULT: 2303052dc82aSMatthias Ringwald gatt_client->state = P_W2_PREPARE_RELIABLE_WRITE; 2304f4b33574SMatthias Ringwald break; 2305f4b33574SMatthias Ringwald case P_W4_EXECUTE_PREPARED_WRITE_RESULT: 2306052dc82aSMatthias Ringwald gatt_client->state = P_W2_EXECUTE_PREPARED_WRITE; 2307f4b33574SMatthias Ringwald break; 2308f4b33574SMatthias Ringwald case P_W4_CANCEL_PREPARED_WRITE_RESULT: 2309052dc82aSMatthias Ringwald gatt_client->state = P_W2_CANCEL_PREPARED_WRITE; 2310f4b33574SMatthias Ringwald break; 2311f4b33574SMatthias Ringwald case P_W4_CANCEL_PREPARED_WRITE_DATA_MISMATCH_RESULT: 2312052dc82aSMatthias Ringwald gatt_client->state = P_W2_CANCEL_PREPARED_WRITE_DATA_MISMATCH; 2313f4b33574SMatthias Ringwald break; 2314f4b33574SMatthias Ringwald case P_W4_READ_CHARACTERISTIC_DESCRIPTOR_RESULT: 2315052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_CHARACTERISTIC_DESCRIPTOR_QUERY; 2316f4b33574SMatthias Ringwald break; 2317f4b33574SMatthias Ringwald case P_W4_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_RESULT: 2318052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_QUERY; 2319f4b33574SMatthias Ringwald break; 2320f4b33574SMatthias Ringwald case P_W4_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT: 2321052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_WRITE_CHARACTERISTIC_DESCRIPTOR; 2322f4b33574SMatthias Ringwald break; 2323f4b33574SMatthias Ringwald case P_W4_CLIENT_CHARACTERISTIC_CONFIGURATION_RESULT: 2324052dc82aSMatthias Ringwald gatt_client->state = P_W2_WRITE_CLIENT_CHARACTERISTIC_CONFIGURATION; 2325f4b33574SMatthias Ringwald break; 2326f4b33574SMatthias Ringwald case P_W4_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT: 2327052dc82aSMatthias Ringwald gatt_client->state = P_W2_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR; 2328f4b33574SMatthias Ringwald break; 2329f4b33574SMatthias Ringwald case P_W4_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT: 2330052dc82aSMatthias Ringwald gatt_client->state = P_W2_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR; 2331f4b33574SMatthias Ringwald break; 2332f4b33574SMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 233330cf4543SMilanka Ringwald case P_W4_SEND_SIGNED_WRITE_DONE: 2334052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_SIGNED_WRITE; 2335f4b33574SMatthias Ringwald break; 2336f4b33574SMatthias Ringwald #endif 2337f4b33574SMatthias Ringwald default: 2338052dc82aSMatthias Ringwald log_info("retry not supported for state %x", gatt_client->state); 2339f4b33574SMatthias Ringwald retry = 0; 2340f4b33574SMatthias Ringwald break; 2341f4b33574SMatthias Ringwald } 2342f4b33574SMatthias Ringwald 2343f4b33574SMatthias Ringwald if (!retry) { 23444740230fSMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, att_status); 2345f4b33574SMatthias Ringwald break; 2346f4b33574SMatthias Ringwald } 2347f4b33574SMatthias Ringwald 2348f4b33574SMatthias Ringwald log_info("security error, start pairing"); 2349f4b33574SMatthias Ringwald 2350f060f108SMatthias Ringwald // start pairing for higher security level 23512197dbafSMatthias Ringwald gatt_client->wait_for_authentication_complete = true; 23524740230fSMatthias Ringwald gatt_client->pending_error_code = att_status; 23535cf1669fSMatthias Ringwald sm_request_pairing(gatt_client->con_handle); 2354f4b33574SMatthias Ringwald break; 2355a0e0c2beSMatthias Ringwald } 2356f4b33574SMatthias Ringwald #endif 2357f4b33574SMatthias Ringwald 2358f4b33574SMatthias Ringwald // nothing we can do about that 2359f4b33574SMatthias Ringwald case ATT_ERROR_INSUFFICIENT_AUTHORIZATION: 23603deb3ec6SMatthias Ringwald default: 23614740230fSMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, att_status); 23623deb3ec6SMatthias Ringwald break; 23633deb3ec6SMatthias Ringwald } 23643deb3ec6SMatthias Ringwald break; 23653deb3ec6SMatthias Ringwald 23663deb3ec6SMatthias Ringwald default: 23673deb3ec6SMatthias Ringwald log_info("ATT Handler, unhandled response type 0x%02x", packet[0]); 23683deb3ec6SMatthias Ringwald break; 23693deb3ec6SMatthias Ringwald } 2370cf8e5718SMatthias Ringwald } 2371cf8e5718SMatthias Ringwald 2372cf8e5718SMatthias Ringwald static void gatt_client_att_packet_handler(uint8_t packet_type, uint16_t handle, uint8_t *packet, uint16_t size) { 2373cf8e5718SMatthias Ringwald gatt_client_t *gatt_client; 2374180cbe79SMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC 2375b1da4983SMatthias Ringwald uint8_t status; 2376b1da4983SMatthias Ringwald hci_connection_t * hci_connection; 2377180cbe79SMatthias Ringwald hci_con_handle_t con_handle; 2378180cbe79SMatthias Ringwald #endif 2379180cbe79SMatthias Ringwald 2380cf8e5718SMatthias Ringwald if (size < 1u) return; 238159b5e157SMatthias Ringwald switch (packet_type){ 238259b5e157SMatthias Ringwald case HCI_EVENT_PACKET: 238359b5e157SMatthias Ringwald switch (hci_event_packet_get_type(packet)) { 238459b5e157SMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC 238559b5e157SMatthias Ringwald case L2CAP_EVENT_CHANNEL_OPENED: 238659b5e157SMatthias Ringwald status = l2cap_event_channel_opened_get_status(packet); 238759b5e157SMatthias Ringwald gatt_client = gatt_client_get_context_for_l2cap_cid(l2cap_event_channel_opened_get_local_cid(packet)); 2388de5a18caSMatthias Ringwald if (gatt_client != NULL){ 2389180cbe79SMatthias Ringwald con_handle = l2cap_event_channel_opened_get_handle(packet); 2390180cbe79SMatthias Ringwald hci_connection = hci_connection_for_handle(con_handle); 2391ab6f9d8fSMatthias Ringwald if (status == L2CAP_CONNECTION_RESPONSE_RESULT_REFUSED_RESOURCES){ 2392ab6f9d8fSMatthias Ringwald if ((hci_connection != NULL) && hci_connection->att_server.incoming_connection_request) { 2393180cbe79SMatthias Ringwald log_info("Collision, retry in 100ms"); 2394180cbe79SMatthias Ringwald gatt_client->state = P_W2_L2CAP_CONNECT; 2395180cbe79SMatthias Ringwald // set timer for retry 2396b1da4983SMatthias Ringwald btstack_run_loop_set_timer(&gatt_client->gc_timeout, GATT_CLIENT_COLLISION_BACKOFF_MS); 2397180cbe79SMatthias Ringwald btstack_run_loop_set_timer_handler(&gatt_client->gc_timeout, gatt_client_classic_retry); 2398180cbe79SMatthias Ringwald btstack_run_loop_add_timer(&gatt_client->gc_timeout); 2399180cbe79SMatthias Ringwald break; 2400180cbe79SMatthias Ringwald } 2401ab6f9d8fSMatthias Ringwald } 240259b5e157SMatthias Ringwald // if status != 0, gatt_client will be discarded 2403052dc82aSMatthias Ringwald gatt_client->state = P_READY; 240459b5e157SMatthias Ringwald gatt_client->con_handle = l2cap_event_channel_opened_get_handle(packet); 240559b5e157SMatthias Ringwald gatt_client->mtu = l2cap_event_channel_opened_get_remote_mtu(packet); 240659b5e157SMatthias Ringwald gatt_client_classic_handle_connected(gatt_client, status); 2407de5a18caSMatthias Ringwald } 240859b5e157SMatthias Ringwald break; 240959b5e157SMatthias Ringwald case L2CAP_EVENT_CHANNEL_CLOSED: 241059b5e157SMatthias Ringwald gatt_client = gatt_client_get_context_for_l2cap_cid(l2cap_event_channel_closed_get_local_cid(packet)); 2411de5a18caSMatthias Ringwald if (gatt_client != NULL){ 241259b5e157SMatthias Ringwald // discard gatt client object 241359b5e157SMatthias Ringwald gatt_client_classic_handle_disconnected(gatt_client); 2414de5a18caSMatthias Ringwald } 241559b5e157SMatthias Ringwald break; 241659b5e157SMatthias Ringwald #endif 2417cf8e5718SMatthias Ringwald case L2CAP_EVENT_CAN_SEND_NOW: 24183deb3ec6SMatthias Ringwald gatt_client_run(); 2419cf8e5718SMatthias Ringwald break; 2420cf8e5718SMatthias Ringwald // att_server has negotiated the mtu for this connection, cache if context exists 2421cf8e5718SMatthias Ringwald case ATT_EVENT_MTU_EXCHANGE_COMPLETE: 2422cf8e5718SMatthias Ringwald if (size < 6u) break; 2423cf8e5718SMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(handle); 2424de5a18caSMatthias Ringwald if (gatt_client != NULL) { 2425cf8e5718SMatthias Ringwald gatt_client->mtu = little_endian_read_16(packet, 4); 2426de5a18caSMatthias Ringwald } 2427cf8e5718SMatthias Ringwald break; 2428cf8e5718SMatthias Ringwald default: 2429cf8e5718SMatthias Ringwald break; 2430cf8e5718SMatthias Ringwald } 243159b5e157SMatthias Ringwald break; 2432cf8e5718SMatthias Ringwald 243359b5e157SMatthias Ringwald case ATT_DATA_PACKET: 2434cf8e5718SMatthias Ringwald // special cases: notifications & indications motivate creating context 2435cf8e5718SMatthias Ringwald switch (packet[0]) { 2436cf8e5718SMatthias Ringwald case ATT_HANDLE_VALUE_NOTIFICATION: 2437cf8e5718SMatthias Ringwald case ATT_HANDLE_VALUE_INDICATION: 2438cf8e5718SMatthias Ringwald gatt_client_provide_context_for_handle(handle, &gatt_client); 2439cf8e5718SMatthias Ringwald break; 2440cf8e5718SMatthias Ringwald default: 2441cf8e5718SMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(handle); 2442cf8e5718SMatthias Ringwald break; 2443cf8e5718SMatthias Ringwald } 2444cf8e5718SMatthias Ringwald 2445cf8e5718SMatthias Ringwald if (gatt_client != NULL) { 2446cf8e5718SMatthias Ringwald gatt_client_handle_att_response(gatt_client, packet, size); 2447cf8e5718SMatthias Ringwald gatt_client_run(); 2448cf8e5718SMatthias Ringwald } 244959b5e157SMatthias Ringwald break; 245059b5e157SMatthias Ringwald 245159b5e157SMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC 245259b5e157SMatthias Ringwald case L2CAP_DATA_PACKET: 245359b5e157SMatthias Ringwald gatt_client = gatt_client_get_context_for_l2cap_cid(handle); 2454de5a18caSMatthias Ringwald if (gatt_client != NULL){ 245559b5e157SMatthias Ringwald gatt_client_handle_att_response(gatt_client, packet, size); 245659b5e157SMatthias Ringwald gatt_client_run(); 2457de5a18caSMatthias Ringwald } 245859b5e157SMatthias Ringwald break; 245959b5e157SMatthias Ringwald #endif 246059b5e157SMatthias Ringwald 246159b5e157SMatthias Ringwald default: 246259b5e157SMatthias Ringwald break; 246359b5e157SMatthias Ringwald } 24643deb3ec6SMatthias Ringwald } 24653deb3ec6SMatthias Ringwald 24667a766ebfSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 24673deb3ec6SMatthias Ringwald static void att_signed_write_handle_cmac_result(uint8_t hash[8]){ 2468665d90f2SMatthias Ringwald btstack_linked_list_iterator_t it; 2469665d90f2SMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client_connections); 2470665d90f2SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 24715cf1669fSMatthias Ringwald gatt_client_t * gatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it); 2472052dc82aSMatthias Ringwald if (gatt_client->state == P_W4_CMAC_RESULT){ 24733deb3ec6SMatthias Ringwald // store result 24745cf1669fSMatthias Ringwald (void)memcpy(gatt_client->cmac, hash, 8); 24755cf1669fSMatthias Ringwald // reverse_64(hash, gatt_client->cmac); 2476052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_SIGNED_WRITE; 24773deb3ec6SMatthias Ringwald gatt_client_run(); 24783deb3ec6SMatthias Ringwald return; 24793deb3ec6SMatthias Ringwald } 24803deb3ec6SMatthias Ringwald } 24813deb3ec6SMatthias Ringwald } 24823deb3ec6SMatthias Ringwald 2483b45b7749SMilanka 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){ 248440faeb84SMilanka Ringwald gatt_client_t * gatt_client; 248540faeb84SMilanka Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 248640faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 248740faeb84SMilanka Ringwald return status; 248840faeb84SMilanka Ringwald } 248940faeb84SMilanka Ringwald if (is_ready(gatt_client) == 0){ 249040faeb84SMilanka Ringwald return GATT_CLIENT_IN_WRONG_STATE; 249140faeb84SMilanka Ringwald } 24923deb3ec6SMatthias Ringwald 24935cf1669fSMatthias Ringwald gatt_client->callback = callback; 2494b45b7749SMilanka Ringwald gatt_client->attribute_handle = value_handle; 24955cf1669fSMatthias Ringwald gatt_client->attribute_length = message_len; 24965cf1669fSMatthias Ringwald gatt_client->attribute_value = message; 2497052dc82aSMatthias Ringwald gatt_client->state = P_W4_IDENTITY_RESOLVING; 24983deb3ec6SMatthias Ringwald gatt_client_run(); 249925b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 25003deb3ec6SMatthias Ringwald } 25017a766ebfSMatthias Ringwald #endif 25023deb3ec6SMatthias Ringwald 2503711e6c80SMatthias Ringwald uint8_t gatt_client_discover_primary_services(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 250440faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2505de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 250640faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 250740faeb84SMilanka Ringwald return status; 250840faeb84SMilanka Ringwald } 25093deb3ec6SMatthias Ringwald 25105cf1669fSMatthias Ringwald gatt_client->callback = callback; 25115cf1669fSMatthias Ringwald gatt_client->start_group_handle = 0x0001; 25125cf1669fSMatthias Ringwald gatt_client->end_group_handle = 0xffff; 2513052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_SERVICE_QUERY; 25148d1f34d3SMatheus Eduardo Garbelini gatt_client->uuid16 = GATT_PRIMARY_SERVICE_UUID; 25153deb3ec6SMatthias Ringwald gatt_client_run(); 251625b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 25173deb3ec6SMatthias Ringwald } 25183deb3ec6SMatthias Ringwald 25198d1f34d3SMatheus Eduardo Garbelini uint8_t gatt_client_discover_secondary_services(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 252040faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2521de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 252240faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 252340faeb84SMilanka Ringwald return status; 252440faeb84SMilanka Ringwald } 25258d1f34d3SMatheus Eduardo Garbelini 25268d1f34d3SMatheus Eduardo Garbelini gatt_client->callback = callback; 25278d1f34d3SMatheus Eduardo Garbelini gatt_client->start_group_handle = 0x0001; 25288d1f34d3SMatheus Eduardo Garbelini gatt_client->end_group_handle = 0xffff; 2529052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_SERVICE_QUERY; 25308d1f34d3SMatheus Eduardo Garbelini gatt_client->uuid16 = GATT_SECONDARY_SERVICE_UUID; 25318d1f34d3SMatheus Eduardo Garbelini gatt_client_run(); 25328d1f34d3SMatheus Eduardo Garbelini return ERROR_CODE_SUCCESS; 25338d1f34d3SMatheus Eduardo Garbelini } 25343deb3ec6SMatthias Ringwald 253568ced5c9SMatthias Ringwald uint8_t gatt_client_discover_primary_services_by_uuid16_with_context(btstack_packet_handler_t callback, hci_con_handle_t con_handle, 253668ced5c9SMatthias Ringwald uint16_t uuid16, uint16_t service_id, uint16_t connection_id){ 253740faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2538de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 253940faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 254040faeb84SMilanka Ringwald return status; 254140faeb84SMilanka Ringwald } 25423deb3ec6SMatthias Ringwald 25435cf1669fSMatthias Ringwald gatt_client->callback = callback; 254468ced5c9SMatthias Ringwald gatt_client->service_id = service_id; 254568ced5c9SMatthias Ringwald gatt_client->connection_id = connection_id; 25465cf1669fSMatthias Ringwald gatt_client->start_group_handle = 0x0001; 25475cf1669fSMatthias Ringwald gatt_client->end_group_handle = 0xffff; 2548052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_SERVICE_WITH_UUID_QUERY; 25495cf1669fSMatthias Ringwald gatt_client->uuid16 = uuid16; 25505cf1669fSMatthias Ringwald uuid_add_bluetooth_prefix((uint8_t*) &(gatt_client->uuid128), gatt_client->uuid16); 25513deb3ec6SMatthias Ringwald gatt_client_run(); 255225b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 25533deb3ec6SMatthias Ringwald } 25543deb3ec6SMatthias Ringwald 255568ced5c9SMatthias Ringwald uint8_t gatt_client_discover_primary_services_by_uuid16(btstack_packet_handler_t callback, hci_con_handle_t con_handle, uint16_t uuid16){ 255668ced5c9SMatthias Ringwald return gatt_client_discover_primary_services_by_uuid16_with_context(callback, con_handle, uuid16, 0, 0); 255768ced5c9SMatthias Ringwald } 255868ced5c9SMatthias Ringwald 2559711e6c80SMatthias 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){ 256040faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2561de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 256240faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 256340faeb84SMilanka Ringwald return status; 256440faeb84SMilanka Ringwald } 25653deb3ec6SMatthias Ringwald 25665cf1669fSMatthias Ringwald gatt_client->callback = callback; 25675cf1669fSMatthias Ringwald gatt_client->start_group_handle = 0x0001; 25685cf1669fSMatthias Ringwald gatt_client->end_group_handle = 0xffff; 25695cf1669fSMatthias Ringwald gatt_client->uuid16 = 0; 25705cf1669fSMatthias Ringwald (void)memcpy(gatt_client->uuid128, uuid128, 16); 2571052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_SERVICE_WITH_UUID_QUERY; 25723deb3ec6SMatthias Ringwald gatt_client_run(); 257325b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 25743deb3ec6SMatthias Ringwald } 25753deb3ec6SMatthias Ringwald 25768183ac30SMatthias Ringwald uint8_t gatt_client_discover_characteristics_for_service_with_context(btstack_packet_handler_t callback, hci_con_handle_t con_handle, gatt_client_service_t * service, 25778183ac30SMatthias Ringwald uint16_t service_id, uint16_t connection_id){ 257840faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2579de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 258040faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 258140faeb84SMilanka Ringwald return status; 258240faeb84SMilanka Ringwald } 25833deb3ec6SMatthias Ringwald 25845cf1669fSMatthias Ringwald gatt_client->callback = callback; 25858183ac30SMatthias Ringwald gatt_client->service_id = service_id; 25868183ac30SMatthias Ringwald gatt_client->connection_id = connection_id; 25875cf1669fSMatthias Ringwald gatt_client->start_group_handle = service->start_group_handle; 25885cf1669fSMatthias Ringwald gatt_client->end_group_handle = service->end_group_handle; 2589ab415e75SMatthias Ringwald gatt_client->filter_with_uuid = false; 25905cf1669fSMatthias Ringwald gatt_client->characteristic_start_handle = 0; 2591052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_ALL_CHARACTERISTICS_OF_SERVICE_QUERY; 25923deb3ec6SMatthias Ringwald gatt_client_run(); 259325b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 25943deb3ec6SMatthias Ringwald } 25958183ac30SMatthias Ringwald 25968183ac30SMatthias 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){ 25978183ac30SMatthias Ringwald return gatt_client_discover_characteristics_for_service_with_context(callback, con_handle, service, 0, 0); 25988183ac30SMatthias Ringwald } 25998183ac30SMatthias Ringwald 2600aa43543aSMatthias Ringwald uint8_t gatt_client_find_included_services_for_service_with_context(btstack_packet_handler_t callback, hci_con_handle_t con_handle, 2601aa43543aSMatthias Ringwald gatt_client_service_t * service, uint16_t service_id, uint16_t connection_id){ 260240faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2603de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 260440faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 260540faeb84SMilanka Ringwald return status; 260640faeb84SMilanka Ringwald } 2607de27733dSMatthias Ringwald 26085cf1669fSMatthias Ringwald gatt_client->callback = callback; 2609aa43543aSMatthias Ringwald gatt_client->service_id = service_id; 2610aa43543aSMatthias Ringwald gatt_client->connection_id = connection_id; 26115cf1669fSMatthias Ringwald gatt_client->start_group_handle = service->start_group_handle; 26125cf1669fSMatthias Ringwald gatt_client->end_group_handle = service->end_group_handle; 2613052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_INCLUDED_SERVICE_QUERY; 26143deb3ec6SMatthias Ringwald 26153deb3ec6SMatthias Ringwald gatt_client_run(); 261625b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 26173deb3ec6SMatthias Ringwald } 26183deb3ec6SMatthias Ringwald 2619aa43543aSMatthias 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) { 2620aa43543aSMatthias Ringwald return gatt_client_find_included_services_for_service_with_context(callback, con_handle, service, 0, 0); 2621aa43543aSMatthias Ringwald } 2622aa43543aSMatthias Ringwald 2623711e6c80SMatthias 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){ 262440faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2625de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 262640faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 262740faeb84SMilanka Ringwald return status; 262840faeb84SMilanka Ringwald } 26293deb3ec6SMatthias Ringwald 26305cf1669fSMatthias Ringwald gatt_client->callback = callback; 26315cf1669fSMatthias Ringwald gatt_client->start_group_handle = start_handle; 26325cf1669fSMatthias Ringwald gatt_client->end_group_handle = end_handle; 2633ab415e75SMatthias Ringwald gatt_client->filter_with_uuid = true; 26345cf1669fSMatthias Ringwald gatt_client->uuid16 = uuid16; 26355cf1669fSMatthias Ringwald uuid_add_bluetooth_prefix((uint8_t*) &(gatt_client->uuid128), uuid16); 26365cf1669fSMatthias Ringwald gatt_client->characteristic_start_handle = 0; 2637052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_CHARACTERISTIC_WITH_UUID_QUERY; 26383deb3ec6SMatthias Ringwald gatt_client_run(); 263925b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 26403deb3ec6SMatthias Ringwald } 26413deb3ec6SMatthias Ringwald 2642045d700dSDavid 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){ 264340faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2644de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 264540faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 264640faeb84SMilanka Ringwald return status; 264740faeb84SMilanka Ringwald } 26483deb3ec6SMatthias Ringwald 26495cf1669fSMatthias Ringwald gatt_client->callback = callback; 26505cf1669fSMatthias Ringwald gatt_client->start_group_handle = start_handle; 26515cf1669fSMatthias Ringwald gatt_client->end_group_handle = end_handle; 2652ab415e75SMatthias Ringwald gatt_client->filter_with_uuid = true; 26535cf1669fSMatthias Ringwald gatt_client->uuid16 = 0; 26545cf1669fSMatthias Ringwald (void)memcpy(gatt_client->uuid128, uuid128, 16); 26555cf1669fSMatthias Ringwald gatt_client->characteristic_start_handle = 0; 2656052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_CHARACTERISTIC_WITH_UUID_QUERY; 26573deb3ec6SMatthias Ringwald gatt_client_run(); 265825b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 26593deb3ec6SMatthias Ringwald } 26603deb3ec6SMatthias Ringwald 26613deb3ec6SMatthias Ringwald 2662b45b7749SMilanka 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){ 2663b45b7749SMilanka Ringwald return gatt_client_discover_characteristics_for_handle_range_by_uuid16(callback, con_handle, service->start_group_handle, service->end_group_handle, uuid16); 26643deb3ec6SMatthias Ringwald } 26653deb3ec6SMatthias Ringwald 2666b45b7749SMilanka 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){ 2667b45b7749SMilanka Ringwald return gatt_client_discover_characteristics_for_handle_range_by_uuid128(callback, con_handle, service->start_group_handle, service->end_group_handle, uuid128); 26683deb3ec6SMatthias Ringwald } 26693deb3ec6SMatthias Ringwald 2670a94d23eaSMatthias Ringwald uint8_t gatt_client_discover_characteristic_descriptors_with_context(btstack_packet_handler_t callback, hci_con_handle_t con_handle, 2671a94d23eaSMatthias Ringwald gatt_client_characteristic_t * characteristic, uint16_t service_id, uint16_t connection_id){ 267240faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2673de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 267440faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 267540faeb84SMilanka Ringwald return status; 267640faeb84SMilanka Ringwald } 26773deb3ec6SMatthias Ringwald 2678a94d23eaSMatthias Ringwald gatt_client->service_id = service_id; 2679a94d23eaSMatthias Ringwald gatt_client->connection_id = connection_id; 2680a94d23eaSMatthias Ringwald 2681544a5845SMatthias Ringwald // check if there is space for characteristics descriptors 2682544a5845SMatthias Ringwald if (characteristic->end_handle > characteristic->value_handle){ 26835cf1669fSMatthias Ringwald gatt_client->callback = callback; 26845cf1669fSMatthias Ringwald gatt_client->start_group_handle = characteristic->value_handle + 1u; 26855cf1669fSMatthias Ringwald gatt_client->end_group_handle = characteristic->end_handle; 2686052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY; 26873deb3ec6SMatthias Ringwald gatt_client_run(); 2688544a5845SMatthias Ringwald } else { 2689544a5845SMatthias Ringwald // schedule gatt complete event on next run loop iteration otherwise 2690544a5845SMatthias Ringwald gatt_client->state = P_W2_EMIT_QUERY_COMPLETE_EVENT; 2691544a5845SMatthias Ringwald gatt_client_deferred_event_emit.callback = gatt_client_emit_events; 2692544a5845SMatthias Ringwald btstack_run_loop_execute_on_main_thread(&gatt_client_deferred_event_emit); 2693544a5845SMatthias Ringwald } 269425b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 26953deb3ec6SMatthias Ringwald } 26963deb3ec6SMatthias Ringwald 2697a94d23eaSMatthias Ringwald uint8_t gatt_client_discover_characteristic_descriptors(btstack_packet_handler_t callback, hci_con_handle_t con_handle, gatt_client_characteristic_t * characteristic){ 2698a94d23eaSMatthias Ringwald return gatt_client_discover_characteristic_descriptors_with_context(callback, con_handle, characteristic, 0, 0); 2699a94d23eaSMatthias Ringwald } 2700a94d23eaSMatthias Ringwald 2701e38d764eSMatthias Ringwald uint8_t gatt_client_read_value_of_characteristic_using_value_handle_with_context(btstack_packet_handler_t callback, 2702e38d764eSMatthias Ringwald hci_con_handle_t con_handle, 2703e38d764eSMatthias Ringwald uint16_t value_handle, 2704e38d764eSMatthias Ringwald uint16_t service_id, 2705e38d764eSMatthias Ringwald uint16_t connection_id) { 270640faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2707de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 270840faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 270940faeb84SMilanka Ringwald return status; 271040faeb84SMilanka Ringwald } 27113deb3ec6SMatthias Ringwald 27125cf1669fSMatthias Ringwald gatt_client->callback = callback; 2713e38d764eSMatthias Ringwald gatt_client->service_id = service_id; 2714e38d764eSMatthias Ringwald gatt_client->connection_id = connection_id; 27155cf1669fSMatthias Ringwald gatt_client->attribute_handle = value_handle; 27165cf1669fSMatthias Ringwald gatt_client->attribute_offset = 0; 2717052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_CHARACTERISTIC_VALUE_QUERY; 27183deb3ec6SMatthias Ringwald gatt_client_run(); 271925b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 27203deb3ec6SMatthias Ringwald } 27213deb3ec6SMatthias Ringwald 2722e38d764eSMatthias 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){ 2723e38d764eSMatthias Ringwald return gatt_client_read_value_of_characteristic_using_value_handle_with_context(callback, con_handle, value_handle, 0, 0); 2724e38d764eSMatthias Ringwald 2725e38d764eSMatthias Ringwald } 2726e38d764eSMatthias Ringwald 2727711e6c80SMatthias 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){ 272840faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2729de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 273040faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 273140faeb84SMilanka Ringwald return status; 273240faeb84SMilanka Ringwald } 27333deb3ec6SMatthias Ringwald 27345cf1669fSMatthias Ringwald gatt_client->callback = callback; 27355cf1669fSMatthias Ringwald gatt_client->start_group_handle = start_handle; 27365cf1669fSMatthias Ringwald gatt_client->end_group_handle = end_handle; 27375cf1669fSMatthias Ringwald gatt_client->query_start_handle = start_handle; 27385cf1669fSMatthias Ringwald gatt_client->query_end_handle = end_handle; 27395cf1669fSMatthias Ringwald gatt_client->uuid16 = uuid16; 27405cf1669fSMatthias Ringwald uuid_add_bluetooth_prefix((uint8_t*) &(gatt_client->uuid128), uuid16); 2741052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_BY_TYPE_REQUEST; 27423deb3ec6SMatthias Ringwald gatt_client_run(); 274325b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 27443deb3ec6SMatthias Ringwald } 27453deb3ec6SMatthias Ringwald 2746045d700dSDavid 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){ 274740faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2748de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 274940faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 275040faeb84SMilanka Ringwald return status; 275140faeb84SMilanka Ringwald } 27523deb3ec6SMatthias Ringwald 27535cf1669fSMatthias Ringwald gatt_client->callback = callback; 27545cf1669fSMatthias Ringwald gatt_client->start_group_handle = start_handle; 27555cf1669fSMatthias Ringwald gatt_client->end_group_handle = end_handle; 27565cf1669fSMatthias Ringwald gatt_client->query_start_handle = start_handle; 27575cf1669fSMatthias Ringwald gatt_client->query_end_handle = end_handle; 27585cf1669fSMatthias Ringwald gatt_client->uuid16 = 0; 27595cf1669fSMatthias Ringwald (void)memcpy(gatt_client->uuid128, uuid128, 16); 2760052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_BY_TYPE_REQUEST; 27613deb3ec6SMatthias Ringwald gatt_client_run(); 276225b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 27633deb3ec6SMatthias Ringwald } 27643deb3ec6SMatthias Ringwald 27653deb3ec6SMatthias Ringwald 2766b45b7749SMilanka 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){ 2767b45b7749SMilanka Ringwald return gatt_client_read_value_of_characteristic_using_value_handle(callback, con_handle, characteristic->value_handle); 27683deb3ec6SMatthias Ringwald } 27693deb3ec6SMatthias Ringwald 2770b45b7749SMilanka 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){ 277140faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2772de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 277340faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 277440faeb84SMilanka Ringwald return status; 277540faeb84SMilanka Ringwald } 27763deb3ec6SMatthias Ringwald 27775cf1669fSMatthias Ringwald gatt_client->callback = callback; 2778b45b7749SMilanka Ringwald gatt_client->attribute_handle = value_handle; 27795cf1669fSMatthias Ringwald gatt_client->attribute_offset = offset; 2780052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_BLOB_QUERY; 27813deb3ec6SMatthias Ringwald gatt_client_run(); 278225b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 27833deb3ec6SMatthias Ringwald } 2784691e02c2SMatthias Ringwald uint8_t gatt_client_read_long_value_of_characteristic_using_value_handle_with_context(btstack_packet_handler_t callback, 2785691e02c2SMatthias Ringwald hci_con_handle_t con_handle, uint16_t value_handle, 2786691e02c2SMatthias Ringwald uint16_t service_id, uint16_t connection_id){ 2787691e02c2SMatthias Ringwald // TODO: move into gatt_client_read_long_value_of_characteristic_using_value_handle_with_offset once 2788691e02c2SMatthias Ringwald // gatt_client_read_long_value_of_characteristic_using_value_handle_with_offset_and_context exists 2789691e02c2SMatthias Ringwald gatt_client_t * gatt_client; 2790691e02c2SMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 2791691e02c2SMatthias Ringwald if (status != ERROR_CODE_SUCCESS){ 2792691e02c2SMatthias Ringwald return status; 2793691e02c2SMatthias Ringwald } 2794691e02c2SMatthias Ringwald gatt_client->service_id = service_id; 2795691e02c2SMatthias Ringwald gatt_client->connection_id = connection_id; 2796691e02c2SMatthias Ringwald return gatt_client_read_long_value_of_characteristic_using_value_handle_with_offset(callback, con_handle, value_handle, 0); 2797691e02c2SMatthias Ringwald } 27983deb3ec6SMatthias Ringwald 2799b45b7749SMilanka 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){ 2800691e02c2SMatthias Ringwald return gatt_client_read_long_value_of_characteristic_using_value_handle_with_context(callback, con_handle, value_handle, 0, 0); 28013deb3ec6SMatthias Ringwald } 28023deb3ec6SMatthias Ringwald 2803b45b7749SMilanka 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){ 2804b45b7749SMilanka Ringwald return gatt_client_read_long_value_of_characteristic_using_value_handle(callback, con_handle, characteristic->value_handle); 28053deb3ec6SMatthias Ringwald } 28063deb3ec6SMatthias Ringwald 2807f125a8efSMatthias 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){ 280840faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2809de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 281040faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 281140faeb84SMilanka Ringwald return status; 281240faeb84SMilanka Ringwald } 28133deb3ec6SMatthias Ringwald 2814f125a8efSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 2815f125a8efSMatthias Ringwald if (state == P_W2_SEND_READ_MULTIPLE_VARIABLE_REQUEST){ 2816f125a8efSMatthias Ringwald if (gatt_client->bearer_type != ATT_BEARER_ENHANCED_LE){ 2817f125a8efSMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 2818f125a8efSMatthias Ringwald } 2819f125a8efSMatthias Ringwald } 2820f125a8efSMatthias Ringwald #endif 2821f125a8efSMatthias Ringwald 28225cf1669fSMatthias Ringwald gatt_client->callback = callback; 28235cf1669fSMatthias Ringwald gatt_client->read_multiple_handle_count = num_value_handles; 28245cf1669fSMatthias Ringwald gatt_client->read_multiple_handles = value_handles; 2825052dc82aSMatthias Ringwald gatt_client->state = state; 28263deb3ec6SMatthias Ringwald gatt_client_run(); 282725b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 28283deb3ec6SMatthias Ringwald } 28293deb3ec6SMatthias Ringwald 2830f125a8efSMatthias 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){ 2831f125a8efSMatthias Ringwald return gatt_client_read_multiple_characteristic_values_with_state(callback, con_handle, num_value_handles, value_handles, P_W2_SEND_READ_MULTIPLE_REQUEST); 2832f125a8efSMatthias Ringwald } 2833f125a8efSMatthias Ringwald 2834f125a8efSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 2835f125a8efSMatthias 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){ 2836f125a8efSMatthias 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); 2837f125a8efSMatthias Ringwald } 2838f125a8efSMatthias Ringwald #endif 2839f125a8efSMatthias Ringwald 2840de9f8e94SMatthias 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){ 284140faeb84SMilanka Ringwald gatt_client_t * gatt_client; 284240faeb84SMilanka Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 284340faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 284440faeb84SMilanka Ringwald return status; 284540faeb84SMilanka Ringwald } 28463deb3ec6SMatthias Ringwald 2847dda77937SMatthias Ringwald if (value_length > (gatt_client->mtu - 3u)) return GATT_CLIENT_VALUE_TOO_LONG; 28485cf1669fSMatthias Ringwald if (!att_dispatch_client_can_send_now(gatt_client->con_handle)) return GATT_CLIENT_BUSY; 28493deb3ec6SMatthias Ringwald 28506e7b444cSMatthias Ringwald return att_write_request(gatt_client, ATT_WRITE_COMMAND, value_handle, value_length, value); 28513deb3ec6SMatthias Ringwald } 2852b444aa75SMatthias Ringwald uint8_t gatt_client_write_value_of_characteristic_with_context(btstack_packet_handler_t callback, hci_con_handle_t con_handle, uint16_t value_handle, 2853b444aa75SMatthias Ringwald uint16_t value_length, uint8_t * value, uint16_t service_id, uint16_t connection_id){ 285440faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2855de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 285640faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 285740faeb84SMilanka Ringwald return status; 285840faeb84SMilanka Ringwald } 28593deb3ec6SMatthias Ringwald 28605cf1669fSMatthias Ringwald gatt_client->callback = callback; 2861b444aa75SMatthias Ringwald gatt_client->service_id = service_id; 2862b444aa75SMatthias Ringwald gatt_client->connection_id = connection_id; 28635cf1669fSMatthias Ringwald gatt_client->attribute_handle = value_handle; 28645cf1669fSMatthias Ringwald gatt_client->attribute_length = value_length; 2865b45b7749SMilanka Ringwald gatt_client->attribute_value = value; 2866052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_WRITE_CHARACTERISTIC_VALUE; 28673deb3ec6SMatthias Ringwald gatt_client_run(); 286825b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 28693deb3ec6SMatthias Ringwald } 2870b444aa75SMatthias 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) { 2871b444aa75SMatthias Ringwald return gatt_client_write_value_of_characteristic_with_context(callback, con_handle, value_handle, value_length, value, 0, 0); 2872b444aa75SMatthias Ringwald } 28733deb3ec6SMatthias Ringwald 2874b45b7749SMilanka 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){ 287540faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2876de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 287740faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 287840faeb84SMilanka Ringwald return status; 287940faeb84SMilanka Ringwald } 28803deb3ec6SMatthias Ringwald 28815cf1669fSMatthias Ringwald gatt_client->callback = callback; 28825cf1669fSMatthias Ringwald gatt_client->attribute_handle = value_handle; 28835cf1669fSMatthias Ringwald gatt_client->attribute_length = value_length; 28845cf1669fSMatthias Ringwald gatt_client->attribute_offset = offset; 2885b45b7749SMilanka Ringwald gatt_client->attribute_value = value; 2886052dc82aSMatthias Ringwald gatt_client->state = P_W2_PREPARE_WRITE; 28873deb3ec6SMatthias Ringwald gatt_client_run(); 288825b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 28893deb3ec6SMatthias Ringwald } 28903deb3ec6SMatthias Ringwald 2891b538fb89SMatthias Ringwald uint8_t gatt_client_write_long_value_of_characteristic_with_context(btstack_packet_handler_t callback, hci_con_handle_t con_handle, uint16_t value_handle, uint16_t value_length, uint8_t * value, uint16_t service_id, uint16_t connection_id){ 2892b538fb89SMatthias Ringwald // TODO: move into gatt_client_write_long_value_of_characteristic_with_offset once gatt_client_write_long_value_of_characteristic_with_offset_with_context exists 2893b538fb89SMatthias Ringwald gatt_client_t * gatt_client; 2894b538fb89SMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 2895b538fb89SMatthias Ringwald if (status != ERROR_CODE_SUCCESS){ 2896b538fb89SMatthias Ringwald return status; 2897b538fb89SMatthias Ringwald } 2898b538fb89SMatthias Ringwald gatt_client->service_id = service_id; 2899b538fb89SMatthias Ringwald gatt_client->connection_id = connection_id; 29009c662c9bSMatthias Ringwald return gatt_client_write_long_value_of_characteristic_with_offset(callback, con_handle, value_handle, 0, value_length, value); 29013deb3ec6SMatthias Ringwald } 29023deb3ec6SMatthias Ringwald 2903b538fb89SMatthias 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){ 2904b538fb89SMatthias Ringwald return gatt_client_write_long_value_of_characteristic_with_context(callback, con_handle, value_handle, value_length, value, 0, 0); 2905b538fb89SMatthias Ringwald } 2906b538fb89SMatthias Ringwald 2907711e6c80SMatthias 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){ 290840faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2909de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 291040faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 291140faeb84SMilanka Ringwald return status; 291240faeb84SMilanka Ringwald } 29133deb3ec6SMatthias Ringwald 29145cf1669fSMatthias Ringwald gatt_client->callback = callback; 29155cf1669fSMatthias Ringwald gatt_client->attribute_handle = value_handle; 29165cf1669fSMatthias Ringwald gatt_client->attribute_length = value_length; 29175cf1669fSMatthias Ringwald gatt_client->attribute_offset = 0; 29185cf1669fSMatthias Ringwald gatt_client->attribute_value = value; 2919052dc82aSMatthias Ringwald gatt_client->state = P_W2_PREPARE_RELIABLE_WRITE; 29203deb3ec6SMatthias Ringwald gatt_client_run(); 292125b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 29223deb3ec6SMatthias Ringwald } 29233deb3ec6SMatthias Ringwald 2924cb5b2b64SMatthias Ringwald uint8_t gatt_client_write_client_characteristic_configuration_with_context(btstack_packet_handler_t callback, hci_con_handle_t con_handle, 2925cb5b2b64SMatthias Ringwald gatt_client_characteristic_t * characteristic, uint16_t configuration, uint16_t service_id, uint16_t connection_id){ 292640faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2927de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 292840faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 292940faeb84SMilanka Ringwald return status; 293040faeb84SMilanka Ringwald } 29313deb3ec6SMatthias Ringwald 29328915696fSMilanka Ringwald if (configuration > 3){ 29338915696fSMilanka Ringwald return ERROR_CODE_UNSUPPORTED_FEATURE_OR_PARAMETER_VALUE; 29348915696fSMilanka Ringwald } 29358915696fSMilanka Ringwald 29363deb3ec6SMatthias Ringwald if ( (configuration & GATT_CLIENT_CHARACTERISTICS_CONFIGURATION_NOTIFICATION) && 29374ea43905SMatthias Ringwald ((characteristic->properties & ATT_PROPERTY_NOTIFY) == 0u)) { 2938d8e8f12aSMatthias Ringwald log_info("gatt_client_write_client_characteristic_configuration: GATT_CLIENT_CHARACTERISTIC_NOTIFICATION_NOT_SUPPORTED"); 2939616edd56SMatthias Ringwald return GATT_CLIENT_CHARACTERISTIC_NOTIFICATION_NOT_SUPPORTED; 29403deb3ec6SMatthias Ringwald } else if ( (configuration & GATT_CLIENT_CHARACTERISTICS_CONFIGURATION_INDICATION) && 29414ea43905SMatthias Ringwald ((characteristic->properties & ATT_PROPERTY_INDICATE) == 0u)){ 2942d8e8f12aSMatthias Ringwald log_info("gatt_client_write_client_characteristic_configuration: GATT_CLIENT_CHARACTERISTIC_INDICATION_NOT_SUPPORTED"); 2943616edd56SMatthias Ringwald return GATT_CLIENT_CHARACTERISTIC_INDICATION_NOT_SUPPORTED; 29443deb3ec6SMatthias Ringwald } 29453deb3ec6SMatthias Ringwald 29465cf1669fSMatthias Ringwald gatt_client->callback = callback; 2947cb5b2b64SMatthias Ringwald gatt_client->service_id = service_id; 2948cb5b2b64SMatthias Ringwald gatt_client->connection_id = connection_id; 29495cf1669fSMatthias Ringwald gatt_client->start_group_handle = characteristic->value_handle; 29505cf1669fSMatthias Ringwald gatt_client->end_group_handle = characteristic->end_handle; 29515cf1669fSMatthias Ringwald little_endian_store_16(gatt_client->client_characteristic_configuration_value, 0, configuration); 29523deb3ec6SMatthias Ringwald 2953abdc9fb5SMatthias Ringwald #ifdef ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY 29545cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_FIND_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY; 2955abdc9fb5SMatthias Ringwald #else 2956052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY; 2957abdc9fb5SMatthias Ringwald #endif 29583deb3ec6SMatthias Ringwald gatt_client_run(); 29599cb80b17SMilanka Ringwald return ERROR_CODE_SUCCESS; 29603deb3ec6SMatthias Ringwald } 29613deb3ec6SMatthias Ringwald 2962cb5b2b64SMatthias 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){ 2963cb5b2b64SMatthias Ringwald return gatt_client_write_client_characteristic_configuration_with_context(callback, con_handle, characteristic, configuration, 0, 0); 2964cb5b2b64SMatthias Ringwald } 2965cb5b2b64SMatthias Ringwald 2966711e6c80SMatthias 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){ 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 = descriptor_handle; 29753deb3ec6SMatthias Ringwald 2976052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_CHARACTERISTIC_DESCRIPTOR_QUERY; 29773deb3ec6SMatthias Ringwald gatt_client_run(); 297825b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 29793deb3ec6SMatthias Ringwald } 29803deb3ec6SMatthias Ringwald 2981711e6c80SMatthias 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){ 29829c662c9bSMatthias Ringwald return gatt_client_read_characteristic_descriptor_using_descriptor_handle(callback, con_handle, descriptor->handle); 29833deb3ec6SMatthias Ringwald } 29843deb3ec6SMatthias Ringwald 2985711e6c80SMatthias 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){ 298640faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2987de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 298840faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 298940faeb84SMilanka Ringwald return status; 299040faeb84SMilanka Ringwald } 29913deb3ec6SMatthias Ringwald 29925cf1669fSMatthias Ringwald gatt_client->callback = callback; 29935cf1669fSMatthias Ringwald gatt_client->attribute_handle = descriptor_handle; 29945cf1669fSMatthias Ringwald gatt_client->attribute_offset = offset; 2995052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_QUERY; 29963deb3ec6SMatthias Ringwald gatt_client_run(); 299725b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 29983deb3ec6SMatthias Ringwald } 29993deb3ec6SMatthias Ringwald 3000711e6c80SMatthias 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){ 30019c662c9bSMatthias Ringwald return gatt_client_read_long_characteristic_descriptor_using_descriptor_handle_with_offset(callback, con_handle, descriptor_handle, 0); 30023deb3ec6SMatthias Ringwald } 30033deb3ec6SMatthias Ringwald 3004711e6c80SMatthias 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){ 30059c662c9bSMatthias Ringwald return gatt_client_read_long_characteristic_descriptor_using_descriptor_handle(callback, con_handle, descriptor->handle); 30063deb3ec6SMatthias Ringwald } 30073deb3ec6SMatthias Ringwald 3008b45b7749SMilanka 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){ 300940faeb84SMilanka Ringwald gatt_client_t * gatt_client; 3010de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 301140faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 301240faeb84SMilanka Ringwald return status; 301340faeb84SMilanka Ringwald } 30143deb3ec6SMatthias Ringwald 30155cf1669fSMatthias Ringwald gatt_client->callback = callback; 30165cf1669fSMatthias Ringwald gatt_client->attribute_handle = descriptor_handle; 3017b45b7749SMilanka Ringwald gatt_client->attribute_length = value_length; 30185cf1669fSMatthias Ringwald gatt_client->attribute_offset = 0; 3019b45b7749SMilanka Ringwald gatt_client->attribute_value = value; 3020052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_WRITE_CHARACTERISTIC_DESCRIPTOR; 30213deb3ec6SMatthias Ringwald gatt_client_run(); 302225b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 30233deb3ec6SMatthias Ringwald } 30243deb3ec6SMatthias Ringwald 302548cdff9cSMilanka 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){ 302648cdff9cSMilanka Ringwald return gatt_client_write_characteristic_descriptor_using_descriptor_handle(callback, con_handle, descriptor->handle, value_length, value); 30273deb3ec6SMatthias Ringwald } 30283deb3ec6SMatthias Ringwald 3029b45b7749SMilanka 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){ 303040faeb84SMilanka Ringwald gatt_client_t * gatt_client; 3031de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 303240faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 303340faeb84SMilanka Ringwald return status; 303440faeb84SMilanka Ringwald } 30353deb3ec6SMatthias Ringwald 30365cf1669fSMatthias Ringwald gatt_client->callback = callback; 30375cf1669fSMatthias Ringwald gatt_client->attribute_handle = descriptor_handle; 3038b45b7749SMilanka Ringwald gatt_client->attribute_length = value_length; 30395cf1669fSMatthias Ringwald gatt_client->attribute_offset = offset; 3040b45b7749SMilanka Ringwald gatt_client->attribute_value = value; 3041052dc82aSMatthias Ringwald gatt_client->state = P_W2_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR; 30423deb3ec6SMatthias Ringwald gatt_client_run(); 304325b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 30443deb3ec6SMatthias Ringwald } 30453deb3ec6SMatthias Ringwald 3046b45b7749SMilanka 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){ 3047b45b7749SMilanka Ringwald return gatt_client_write_long_characteristic_descriptor_using_descriptor_handle_with_offset(callback, con_handle, descriptor_handle, 0, value_length, value); 30483deb3ec6SMatthias Ringwald } 30493deb3ec6SMatthias Ringwald 3050b45b7749SMilanka 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){ 3051b45b7749SMilanka Ringwald return gatt_client_write_long_characteristic_descriptor_using_descriptor_handle(callback, con_handle, descriptor->handle, value_length, value); 30523deb3ec6SMatthias Ringwald } 30533deb3ec6SMatthias Ringwald 30543deb3ec6SMatthias Ringwald /** 30553deb3ec6SMatthias Ringwald * @brief -> gatt complete event 30563deb3ec6SMatthias Ringwald */ 3057b45b7749SMilanka 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){ 305840faeb84SMilanka Ringwald gatt_client_t * gatt_client; 3059de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 306040faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 306140faeb84SMilanka Ringwald return status; 306240faeb84SMilanka Ringwald } 30633deb3ec6SMatthias Ringwald 30645cf1669fSMatthias Ringwald gatt_client->callback = callback; 30655cf1669fSMatthias Ringwald gatt_client->attribute_handle = attribute_handle; 3066b45b7749SMilanka Ringwald gatt_client->attribute_length = value_length; 30675cf1669fSMatthias Ringwald gatt_client->attribute_offset = offset; 3068b45b7749SMilanka Ringwald gatt_client->attribute_value = value; 3069052dc82aSMatthias Ringwald gatt_client->state = P_W2_PREPARE_WRITE_SINGLE; 30703deb3ec6SMatthias Ringwald gatt_client_run(); 307125b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 30723deb3ec6SMatthias Ringwald } 30733deb3ec6SMatthias Ringwald 30743deb3ec6SMatthias Ringwald /** 30753deb3ec6SMatthias Ringwald * @brief -> gatt complete event 30763deb3ec6SMatthias Ringwald */ 3077711e6c80SMatthias Ringwald uint8_t gatt_client_execute_write(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 307840faeb84SMilanka Ringwald gatt_client_t * gatt_client; 3079de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 308040faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 308140faeb84SMilanka Ringwald return status; 308240faeb84SMilanka Ringwald } 30833deb3ec6SMatthias Ringwald 30845cf1669fSMatthias Ringwald gatt_client->callback = callback; 3085052dc82aSMatthias Ringwald gatt_client->state = P_W2_EXECUTE_PREPARED_WRITE; 30863deb3ec6SMatthias Ringwald gatt_client_run(); 308725b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 30883deb3ec6SMatthias Ringwald } 30893deb3ec6SMatthias Ringwald 30903deb3ec6SMatthias Ringwald /** 30913deb3ec6SMatthias Ringwald * @brief -> gatt complete event 30923deb3ec6SMatthias Ringwald */ 3093711e6c80SMatthias Ringwald uint8_t gatt_client_cancel_write(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 309440faeb84SMilanka Ringwald gatt_client_t * gatt_client; 3095de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 309640faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 309740faeb84SMilanka Ringwald return status; 309840faeb84SMilanka Ringwald } 30993deb3ec6SMatthias Ringwald 31005cf1669fSMatthias Ringwald gatt_client->callback = callback; 3101052dc82aSMatthias Ringwald gatt_client->state = P_W2_CANCEL_PREPARED_WRITE; 31023deb3ec6SMatthias Ringwald gatt_client_run(); 31037d2258b3SMilanka Ringwald return ERROR_CODE_SUCCESS; 31043deb3ec6SMatthias Ringwald } 31053deb3ec6SMatthias Ringwald 3106313e337bSMatthias Ringwald void gatt_client_deserialize_service(const uint8_t *packet, int offset, gatt_client_service_t * service){ 31076ba2ad22SMatthias Ringwald service->start_group_handle = little_endian_read_16(packet, offset); 31086ba2ad22SMatthias Ringwald service->end_group_handle = little_endian_read_16(packet, offset + 2); 31096ba2ad22SMatthias Ringwald reverse_128(&packet[offset + 4], service->uuid128); 31106ba2ad22SMatthias Ringwald if (uuid_has_bluetooth_prefix(service->uuid128)){ 31116ba2ad22SMatthias Ringwald service->uuid16 = big_endian_read_32(service->uuid128, 0); 3112c839c6f9SMatthias Ringwald } else { 3113c839c6f9SMatthias Ringwald service->uuid16 = 0; 31146ba2ad22SMatthias Ringwald } 31156ba2ad22SMatthias Ringwald } 31166ba2ad22SMatthias Ringwald 3117313e337bSMatthias Ringwald void gatt_client_deserialize_characteristic(const uint8_t * packet, int offset, gatt_client_characteristic_t * characteristic){ 31186ba2ad22SMatthias Ringwald characteristic->start_handle = little_endian_read_16(packet, offset); 31196ba2ad22SMatthias Ringwald characteristic->value_handle = little_endian_read_16(packet, offset + 2); 31206ba2ad22SMatthias Ringwald characteristic->end_handle = little_endian_read_16(packet, offset + 4); 31216ba2ad22SMatthias Ringwald characteristic->properties = little_endian_read_16(packet, offset + 6); 312286c38559SMatthias Ringwald reverse_128(&packet[offset+8], characteristic->uuid128); 31236ba2ad22SMatthias Ringwald if (uuid_has_bluetooth_prefix(characteristic->uuid128)){ 31246ba2ad22SMatthias Ringwald characteristic->uuid16 = big_endian_read_32(characteristic->uuid128, 0); 3125c839c6f9SMatthias Ringwald } else { 3126c839c6f9SMatthias Ringwald characteristic->uuid16 = 0; 31276ba2ad22SMatthias Ringwald } 31286ba2ad22SMatthias Ringwald } 31296ba2ad22SMatthias Ringwald 3130313e337bSMatthias Ringwald void gatt_client_deserialize_characteristic_descriptor(const uint8_t * packet, int offset, gatt_client_characteristic_descriptor_t * descriptor){ 31316ba2ad22SMatthias Ringwald descriptor->handle = little_endian_read_16(packet, offset); 31326ba2ad22SMatthias Ringwald reverse_128(&packet[offset+2], descriptor->uuid128); 3133b4895529SJakob Krantz if (uuid_has_bluetooth_prefix(descriptor->uuid128)){ 3134b4895529SJakob Krantz descriptor->uuid16 = big_endian_read_32(descriptor->uuid128, 0); 3135c839c6f9SMatthias Ringwald } else { 3136c839c6f9SMatthias Ringwald descriptor->uuid16 = 0; 3137b4895529SJakob Krantz } 31386ba2ad22SMatthias Ringwald } 31395cf6c434SJakob Krantz 31405cf6c434SJakob Krantz void gatt_client_send_mtu_negotiation(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 314140faeb84SMilanka Ringwald gatt_client_t * gatt_client; 314240faeb84SMilanka Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 314340faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 314440faeb84SMilanka Ringwald return; 314540faeb84SMilanka Ringwald } 314640faeb84SMilanka Ringwald if (gatt_client->mtu_state == MTU_AUTO_EXCHANGE_DISABLED){ 314740faeb84SMilanka Ringwald gatt_client->callback = callback; 314840faeb84SMilanka Ringwald gatt_client->mtu_state = SEND_MTU_EXCHANGE; 31495cf6c434SJakob Krantz gatt_client_run(); 31505cf6c434SJakob Krantz } 31515cf6c434SJakob Krantz } 315247181045SMatthias Ringwald 315359d34cd2SMatthias Ringwald uint8_t gatt_client_request_to_write_without_response(btstack_context_callback_registration_t * callback_registration, hci_con_handle_t con_handle){ 315459d34cd2SMatthias Ringwald gatt_client_t * gatt_client; 315559d34cd2SMatthias Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 315659d34cd2SMatthias Ringwald if (status != ERROR_CODE_SUCCESS){ 315759d34cd2SMatthias Ringwald return status; 315859d34cd2SMatthias Ringwald } 315959d34cd2SMatthias Ringwald bool added = btstack_linked_list_add_tail(&gatt_client->write_without_response_requests, (btstack_linked_item_t*) callback_registration); 31602832a98aSMatthias Ringwald if (added == false){ 316159d34cd2SMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 31622832a98aSMatthias Ringwald } else { 31632832a98aSMatthias Ringwald att_dispatch_client_request_can_send_now_event(gatt_client->con_handle); 31642832a98aSMatthias Ringwald return ERROR_CODE_SUCCESS; 316559d34cd2SMatthias Ringwald } 316659d34cd2SMatthias Ringwald } 316759d34cd2SMatthias Ringwald 316853e9c18fSMatthias Ringwald uint8_t gatt_client_request_to_send_gatt_query(btstack_context_callback_registration_t * callback_registration, hci_con_handle_t con_handle){ 316953e9c18fSMatthias Ringwald gatt_client_t * gatt_client; 317053e9c18fSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 317153e9c18fSMatthias Ringwald if (status != ERROR_CODE_SUCCESS){ 317253e9c18fSMatthias Ringwald return status; 317353e9c18fSMatthias Ringwald } 317453e9c18fSMatthias Ringwald bool added = btstack_linked_list_add_tail(&gatt_client->query_requests, (btstack_linked_item_t*) callback_registration); 31752832a98aSMatthias Ringwald if (added == false){ 317653e9c18fSMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 31772832a98aSMatthias Ringwald } else { 31782832a98aSMatthias Ringwald gatt_client_notify_can_send_query(gatt_client); 31792832a98aSMatthias Ringwald return ERROR_CODE_SUCCESS; 318053e9c18fSMatthias Ringwald } 318153e9c18fSMatthias Ringwald } 318253e9c18fSMatthias Ringwald 318348553f67SDirk Helbig uint8_t gatt_client_remove_gatt_query(btstack_context_callback_registration_t * callback_registration, hci_con_handle_t con_handle){ 318448553f67SDirk Helbig gatt_client_t * gatt_client; 318548553f67SDirk Helbig uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 318648553f67SDirk Helbig if (status != ERROR_CODE_SUCCESS){ 318748553f67SDirk Helbig return status; 318848553f67SDirk Helbig } 318948553f67SDirk Helbig (void)btstack_linked_list_remove(&gatt_client->query_requests, (btstack_linked_item_t*) callback_registration); 319048553f67SDirk Helbig return ERROR_CODE_SUCCESS; 319148553f67SDirk Helbig } 319248553f67SDirk Helbig 319347181045SMatthias Ringwald uint8_t gatt_client_request_can_write_without_response_event(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 319440faeb84SMilanka Ringwald gatt_client_t * gatt_client; 319540faeb84SMilanka Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 319640faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 319740faeb84SMilanka Ringwald return status; 319840faeb84SMilanka Ringwald } 319940faeb84SMilanka Ringwald if (gatt_client->write_without_response_callback != NULL){ 320040faeb84SMilanka Ringwald return GATT_CLIENT_IN_WRONG_STATE; 320140faeb84SMilanka Ringwald } 320240faeb84SMilanka Ringwald gatt_client->write_without_response_callback = callback; 320340faeb84SMilanka Ringwald att_dispatch_client_request_can_send_now_event(gatt_client->con_handle); 32047d2258b3SMilanka Ringwald return ERROR_CODE_SUCCESS; 320547181045SMatthias Ringwald } 3206842492f0SMatthias Ringwald 3207842492f0SMatthias Ringwald #ifdef ENABLE_GATT_CLIENT_SERVICE_CHANGED 320858e8c9f5SMatthias Ringwald void gatt_client_add_service_changed_handler(btstack_packet_callback_registration_t * callback) { 320958e8c9f5SMatthias Ringwald btstack_linked_list_add_tail(&gatt_client_service_changed_handler, (btstack_linked_item_t*) callback); 321058e8c9f5SMatthias Ringwald } 3211a6121b51SMilanka Ringwald 321258e8c9f5SMatthias Ringwald void gatt_client_remove_service_changed_handler(btstack_packet_callback_registration_t * callback){ 321358e8c9f5SMatthias Ringwald btstack_linked_list_remove(&gatt_client_service_changed_handler, (btstack_linked_item_t*) callback); 321458e8c9f5SMatthias Ringwald } 3215842492f0SMatthias Ringwald #endif 32167627a0deSMatthias Ringwald 32177627a0deSMatthias Ringwald #if defined(ENABLE_GATT_OVER_CLASSIC) || defined(ENABLE_GATT_OVER_EATT) 32181450cdc6SMatthias Ringwald 32191450cdc6SMatthias Ringwald #include "hci_event.h" 32201450cdc6SMatthias Ringwald 32211450cdc6SMatthias Ringwald static const hci_event_t gatt_client_connected = { 3222b2d70d58SMatthias Ringwald GATT_EVENT_CONNECTED, 0, "11BH" 32231450cdc6SMatthias Ringwald }; 32241450cdc6SMatthias Ringwald 32256b4a68c3SMatthias Ringwald static const hci_event_t gatt_client_disconnected = { 32266b4a68c3SMatthias Ringwald GATT_EVENT_DISCONNECTED, 0, "H" 32276b4a68c3SMatthias Ringwald }; 32281c7a19feSMatthias Ringwald 3229b2d70d58SMatthias Ringwald static void 3230b2d70d58SMatthias Ringwald gatt_client_emit_connected(btstack_packet_handler_t callback, uint8_t status, bd_addr_type_t addr_type, bd_addr_t addr, 32311c7a19feSMatthias Ringwald hci_con_handle_t con_handle) { 32321c7a19feSMatthias Ringwald uint8_t buffer[20]; 32331c7a19feSMatthias Ringwald uint16_t len = hci_event_create_from_template_and_arguments(buffer, sizeof(buffer), &gatt_client_connected, status, addr, con_handle); 32341c7a19feSMatthias Ringwald (*callback)(HCI_EVENT_PACKET, 0, buffer, len); 32351c7a19feSMatthias Ringwald } 32361c7a19feSMatthias Ringwald 32377627a0deSMatthias Ringwald #endif 32387627a0deSMatthias Ringwald 32397627a0deSMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC 32407627a0deSMatthias Ringwald 32417627a0deSMatthias Ringwald #include "bluetooth_psm.h" 32427627a0deSMatthias Ringwald 32437627a0deSMatthias Ringwald // single active SDP query 32447627a0deSMatthias Ringwald static gatt_client_t * gatt_client_classic_active_sdp_query; 32457627a0deSMatthias Ringwald 32467627a0deSMatthias Ringwald // macos protocol descriptor list requires 16 bytes 32477627a0deSMatthias Ringwald static uint8_t gatt_client_classic_sdp_buffer[32]; 32487627a0deSMatthias Ringwald 32496b4a68c3SMatthias Ringwald 32501450cdc6SMatthias Ringwald static gatt_client_t * gatt_client_get_context_for_classic_addr(bd_addr_t addr){ 32511450cdc6SMatthias Ringwald btstack_linked_item_t *it; 32521450cdc6SMatthias Ringwald for (it = (btstack_linked_item_t *) gatt_client_connections; it != NULL; it = it->next){ 32531450cdc6SMatthias Ringwald gatt_client_t * gatt_client = (gatt_client_t *) it; 32541450cdc6SMatthias Ringwald if (memcmp(gatt_client->addr, addr, 6) == 0){ 32551450cdc6SMatthias Ringwald return gatt_client; 32561450cdc6SMatthias Ringwald } 32571450cdc6SMatthias Ringwald } 32581450cdc6SMatthias Ringwald return NULL; 32591450cdc6SMatthias Ringwald } 32601450cdc6SMatthias Ringwald 32611450cdc6SMatthias Ringwald static gatt_client_t * gatt_client_get_context_for_l2cap_cid(uint16_t l2cap_cid){ 32621450cdc6SMatthias Ringwald btstack_linked_item_t *it; 32631450cdc6SMatthias Ringwald for (it = (btstack_linked_item_t *) gatt_client_connections; it != NULL; it = it->next){ 32641450cdc6SMatthias Ringwald gatt_client_t * gatt_client = (gatt_client_t *) it; 32651450cdc6SMatthias Ringwald if (gatt_client->l2cap_cid == l2cap_cid){ 32661450cdc6SMatthias Ringwald return gatt_client; 32671450cdc6SMatthias Ringwald } 32681450cdc6SMatthias Ringwald } 32691450cdc6SMatthias Ringwald return NULL; 32701450cdc6SMatthias Ringwald } 32711450cdc6SMatthias Ringwald 32721450cdc6SMatthias Ringwald static void gatt_client_classic_handle_connected(gatt_client_t * gatt_client, uint8_t status){ 3273b2d70d58SMatthias Ringwald // cache peer information 32741450cdc6SMatthias Ringwald bd_addr_t addr; 3275d5529700SMatthias Ringwald // cppcheck-suppress uninitvar ; addr is reported as uninitialized although it's the destination of the memcpy 32761450cdc6SMatthias Ringwald memcpy(addr, gatt_client->addr, 6); 3277b2d70d58SMatthias Ringwald bd_addr_type_t addr_type = gatt_client->addr_type; 3278b2d70d58SMatthias Ringwald gatt_client->addr_type = BD_ADDR_TYPE_ACL; 32791450cdc6SMatthias Ringwald hci_con_handle_t con_handle = gatt_client->con_handle; 32801450cdc6SMatthias Ringwald btstack_packet_handler_t callback = gatt_client->callback; 3281b2d70d58SMatthias Ringwald 32829ed6f53cSMatthias Ringwald if (status != ERROR_CODE_SUCCESS){ 32833b0e0cc5SMatthias Ringwald btstack_linked_list_remove(&gatt_client_connections, (btstack_linked_item_t *) gatt_client); 32843b0e0cc5SMatthias Ringwald btstack_memory_gatt_client_free(gatt_client); 32853b0e0cc5SMatthias Ringwald } 3286b2d70d58SMatthias Ringwald 3287b2d70d58SMatthias Ringwald gatt_client_emit_connected(callback, status, addr_type, addr, con_handle); 32881450cdc6SMatthias Ringwald } 32891450cdc6SMatthias Ringwald 3290180cbe79SMatthias Ringwald static void gatt_client_classic_retry(btstack_timer_source_t * ts){ 3291180cbe79SMatthias Ringwald gatt_client_t * gatt_client = gatt_client_for_timer(ts); 3292180cbe79SMatthias Ringwald if (gatt_client != NULL){ 3293180cbe79SMatthias Ringwald gatt_client->state = P_W4_L2CAP_CONNECTION; 3294180cbe79SMatthias Ringwald att_dispatch_classic_connect(gatt_client->addr, gatt_client->l2cap_psm, &gatt_client->l2cap_cid); 3295180cbe79SMatthias Ringwald } 3296180cbe79SMatthias Ringwald } 3297180cbe79SMatthias Ringwald 32986b4a68c3SMatthias Ringwald static void gatt_client_classic_handle_disconnected(gatt_client_t * gatt_client){ 32996b4a68c3SMatthias Ringwald 33006b4a68c3SMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, ATT_ERROR_HCI_DISCONNECT_RECEIVED); 33016b4a68c3SMatthias Ringwald gatt_client_timeout_stop(gatt_client); 33026b4a68c3SMatthias Ringwald 33036b4a68c3SMatthias Ringwald hci_con_handle_t con_handle = gatt_client->con_handle; 33046b4a68c3SMatthias Ringwald btstack_packet_handler_t callback = gatt_client->callback; 33056b4a68c3SMatthias Ringwald btstack_linked_list_remove(&gatt_client_connections, (btstack_linked_item_t *) gatt_client); 33066b4a68c3SMatthias Ringwald btstack_memory_gatt_client_free(gatt_client); 33076b4a68c3SMatthias Ringwald 33086b4a68c3SMatthias Ringwald uint8_t buffer[20]; 33096b4a68c3SMatthias Ringwald uint16_t len = hci_event_create_from_template_and_arguments(buffer, sizeof(buffer), &gatt_client_disconnected, con_handle); 33106b4a68c3SMatthias Ringwald (*callback)(HCI_EVENT_PACKET, 0, buffer, len); 33116b4a68c3SMatthias Ringwald } 33126b4a68c3SMatthias Ringwald 33131450cdc6SMatthias Ringwald static void gatt_client_handle_sdp_client_query_attribute_value(gatt_client_t * connection, uint8_t *packet){ 33141450cdc6SMatthias Ringwald des_iterator_t des_list_it; 33151450cdc6SMatthias Ringwald des_iterator_t prot_it; 33161450cdc6SMatthias Ringwald 33171450cdc6SMatthias Ringwald if (sdp_event_query_attribute_byte_get_attribute_length(packet) <= sizeof(gatt_client_classic_sdp_buffer)) { 33181450cdc6SMatthias Ringwald gatt_client_classic_sdp_buffer[sdp_event_query_attribute_byte_get_data_offset(packet)] = sdp_event_query_attribute_byte_get_data(packet); 33191450cdc6SMatthias Ringwald if ((uint16_t)(sdp_event_query_attribute_byte_get_data_offset(packet)+1) == sdp_event_query_attribute_byte_get_attribute_length(packet)) { 33201450cdc6SMatthias Ringwald switch(sdp_event_query_attribute_byte_get_attribute_id(packet)) { 33211450cdc6SMatthias Ringwald case BLUETOOTH_ATTRIBUTE_PROTOCOL_DESCRIPTOR_LIST: 33221450cdc6SMatthias 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)) { 33231450cdc6SMatthias Ringwald uint8_t *des_element; 33241450cdc6SMatthias Ringwald uint8_t *element; 33251450cdc6SMatthias Ringwald uint32_t uuid; 33261450cdc6SMatthias Ringwald 33271450cdc6SMatthias Ringwald if (des_iterator_get_type(&des_list_it) != DE_DES) continue; 33281450cdc6SMatthias Ringwald 33291450cdc6SMatthias Ringwald des_element = des_iterator_get_element(&des_list_it); 33301450cdc6SMatthias Ringwald des_iterator_init(&prot_it, des_element); 33311450cdc6SMatthias Ringwald element = des_iterator_get_element(&prot_it); 33321450cdc6SMatthias Ringwald 33331450cdc6SMatthias Ringwald if (de_get_element_type(element) != DE_UUID) continue; 33341450cdc6SMatthias Ringwald 33351450cdc6SMatthias Ringwald uuid = de_get_uuid32(element); 33361450cdc6SMatthias Ringwald des_iterator_next(&prot_it); 33371450cdc6SMatthias Ringwald // we assume that the even if there are both roles supported, remote device uses the same psm and avdtp version for both 33381450cdc6SMatthias Ringwald switch (uuid){ 33391450cdc6SMatthias Ringwald case BLUETOOTH_PROTOCOL_L2CAP: 33401450cdc6SMatthias Ringwald if (!des_iterator_has_more(&prot_it)) continue; 33411450cdc6SMatthias Ringwald de_element_get_uint16(des_iterator_get_element(&prot_it), &connection->l2cap_psm); 33421450cdc6SMatthias Ringwald break; 33431450cdc6SMatthias Ringwald default: 33441450cdc6SMatthias Ringwald break; 33451450cdc6SMatthias Ringwald } 33461450cdc6SMatthias Ringwald } 33471450cdc6SMatthias Ringwald break; 33481450cdc6SMatthias Ringwald 33491450cdc6SMatthias Ringwald default: 33501450cdc6SMatthias Ringwald break; 33511450cdc6SMatthias Ringwald } 33521450cdc6SMatthias Ringwald } 33531450cdc6SMatthias Ringwald } 33541450cdc6SMatthias Ringwald } 33551450cdc6SMatthias Ringwald 33561450cdc6SMatthias Ringwald static void gatt_client_classic_sdp_handler(uint8_t packet_type, uint16_t handle, uint8_t *packet, uint16_t size){ 33571450cdc6SMatthias Ringwald gatt_client_t * gatt_client = gatt_client_classic_active_sdp_query; 33581450cdc6SMatthias Ringwald btstack_assert(gatt_client != NULL); 33591450cdc6SMatthias Ringwald uint8_t status; 33601450cdc6SMatthias Ringwald 33611450cdc6SMatthias Ringwald // TODO: handle sdp events, get l2cap psm 33621450cdc6SMatthias Ringwald switch (hci_event_packet_get_type(packet)){ 33631450cdc6SMatthias Ringwald case SDP_EVENT_QUERY_ATTRIBUTE_VALUE: 33641450cdc6SMatthias Ringwald gatt_client_handle_sdp_client_query_attribute_value(gatt_client, packet); 33651450cdc6SMatthias Ringwald // TODO: 33661450cdc6SMatthias Ringwald return; 33671450cdc6SMatthias Ringwald case SDP_EVENT_QUERY_COMPLETE: 33681450cdc6SMatthias Ringwald status = sdp_event_query_complete_get_status(packet); 33691450cdc6SMatthias Ringwald gatt_client_classic_active_sdp_query = NULL; 33701450cdc6SMatthias Ringwald log_info("l2cap psm: %0x, status %02x", gatt_client->l2cap_psm, status); 33711450cdc6SMatthias Ringwald if (status != ERROR_CODE_SUCCESS) break; 33721450cdc6SMatthias Ringwald if (gatt_client->l2cap_psm == 0) { 33731450cdc6SMatthias Ringwald status = SDP_SERVICE_NOT_FOUND; 33741450cdc6SMatthias Ringwald break; 33751450cdc6SMatthias Ringwald } 33761450cdc6SMatthias Ringwald break; 33771450cdc6SMatthias Ringwald default: 33781450cdc6SMatthias Ringwald btstack_assert(false); 33791450cdc6SMatthias Ringwald return; 33801450cdc6SMatthias Ringwald } 33811450cdc6SMatthias Ringwald 33821450cdc6SMatthias Ringwald // done 33831450cdc6SMatthias Ringwald if (status == ERROR_CODE_SUCCESS){ 3384052dc82aSMatthias Ringwald gatt_client->state = P_W4_L2CAP_CONNECTION; 338559b5e157SMatthias Ringwald status = att_dispatch_classic_connect(gatt_client->addr, gatt_client->l2cap_psm, &gatt_client->l2cap_cid); 33861450cdc6SMatthias Ringwald } 33871450cdc6SMatthias Ringwald if (status != ERROR_CODE_SUCCESS) { 33881450cdc6SMatthias Ringwald gatt_client_classic_handle_connected(gatt_client, status); 33891450cdc6SMatthias Ringwald } 33901450cdc6SMatthias Ringwald } 33911450cdc6SMatthias Ringwald 33921450cdc6SMatthias Ringwald static void gatt_client_classic_sdp_start(void * context){ 33931450cdc6SMatthias Ringwald gatt_client_classic_active_sdp_query = (gatt_client_t *) context; 3394052dc82aSMatthias Ringwald gatt_client_classic_active_sdp_query->state = P_W4_SDP_QUERY; 33951450cdc6SMatthias Ringwald sdp_client_query_uuid16(gatt_client_classic_sdp_handler, gatt_client_classic_active_sdp_query->addr, ORG_BLUETOOTH_SERVICE_GENERIC_ATTRIBUTE); 33961450cdc6SMatthias Ringwald } 33971450cdc6SMatthias Ringwald 339874daebdeSMatthias Ringwald static void gatt_client_classic_emit_connected(void * context){ 339974daebdeSMatthias Ringwald gatt_client_t * gatt_client = (gatt_client_t *) context; 3400052dc82aSMatthias Ringwald gatt_client->state = P_READY; 3401b2d70d58SMatthias Ringwald gatt_client_emit_connected(gatt_client->callback, ERROR_CODE_SUCCESS, gatt_client->addr_type, gatt_client->addr, gatt_client->con_handle); 340274daebdeSMatthias Ringwald } 340374daebdeSMatthias Ringwald 34041450cdc6SMatthias Ringwald uint8_t gatt_client_classic_connect(btstack_packet_handler_t callback, bd_addr_t addr){ 34051450cdc6SMatthias Ringwald gatt_client_t * gatt_client = gatt_client_get_context_for_classic_addr(addr); 34061450cdc6SMatthias Ringwald if (gatt_client != NULL){ 34071450cdc6SMatthias Ringwald return ERROR_CODE_ACL_CONNECTION_ALREADY_EXISTS; 34081450cdc6SMatthias Ringwald } 34091450cdc6SMatthias Ringwald gatt_client = btstack_memory_gatt_client_get(); 34101450cdc6SMatthias Ringwald if (gatt_client == NULL){ 34111450cdc6SMatthias Ringwald return ERROR_CODE_MEMORY_CAPACITY_EXCEEDED; 34121450cdc6SMatthias Ringwald } 34131450cdc6SMatthias Ringwald // init state 3414e9cdf30bSMatthias Ringwald gatt_client->bearer_type = ATT_BEARER_UNENHANCED_CLASSIC; 34151450cdc6SMatthias Ringwald gatt_client->con_handle = HCI_CON_HANDLE_INVALID; 34161450cdc6SMatthias Ringwald memcpy(gatt_client->addr, addr, 6); 3417b2d70d58SMatthias Ringwald gatt_client->addr_type = BD_ADDR_TYPE_ACL; 34181450cdc6SMatthias Ringwald gatt_client->mtu = ATT_DEFAULT_MTU; 34191450cdc6SMatthias Ringwald gatt_client->security_level = LEVEL_0; 34201450cdc6SMatthias Ringwald gatt_client->mtu_state = MTU_AUTO_EXCHANGE_DISABLED; 34211450cdc6SMatthias Ringwald gatt_client->callback = callback; 3422cbd76cecSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 3423cbd76cecSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_IDLE; 3424cbd76cecSMatthias Ringwald #endif 34251450cdc6SMatthias Ringwald btstack_linked_list_add(&gatt_client_connections, (btstack_linked_item_t*)gatt_client); 342674daebdeSMatthias Ringwald 342774daebdeSMatthias Ringwald // schedule emitted event if already connected, otherwise 342874daebdeSMatthias Ringwald bool already_connected = false; 342974daebdeSMatthias Ringwald hci_connection_t * hci_connection = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL); 343074daebdeSMatthias Ringwald if (hci_connection != NULL){ 343174daebdeSMatthias Ringwald if (hci_connection->att_server.l2cap_cid != 0){ 343274daebdeSMatthias Ringwald already_connected = true; 343374daebdeSMatthias Ringwald } 343474daebdeSMatthias Ringwald } 3435052dc82aSMatthias Ringwald gatt_client->callback_request.context = gatt_client; 343674daebdeSMatthias Ringwald if (already_connected){ 343774daebdeSMatthias Ringwald gatt_client->con_handle = hci_connection->con_handle; 3438052dc82aSMatthias Ringwald gatt_client->callback_request.callback = &gatt_client_classic_emit_connected; 3439052dc82aSMatthias Ringwald gatt_client->state = P_W2_EMIT_CONNECTED; 3440052dc82aSMatthias Ringwald btstack_run_loop_execute_on_main_thread(&gatt_client->callback_request); 344174daebdeSMatthias Ringwald } else { 3442052dc82aSMatthias Ringwald gatt_client->callback_request.callback = &gatt_client_classic_sdp_start; 3443052dc82aSMatthias Ringwald gatt_client->state = P_W2_SDP_QUERY; 3444052dc82aSMatthias Ringwald sdp_client_register_query_callback(&gatt_client->callback_request); 344574daebdeSMatthias Ringwald } 3446b7b03a30SMatthias Ringwald return ERROR_CODE_SUCCESS; 34471450cdc6SMatthias Ringwald } 34481450cdc6SMatthias Ringwald 34491450cdc6SMatthias Ringwald uint8_t gatt_client_classic_disconnect(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 34501450cdc6SMatthias Ringwald gatt_client_t * gatt_client = gatt_client_get_context_for_handle(con_handle); 34511450cdc6SMatthias Ringwald if (gatt_client == NULL){ 34521450cdc6SMatthias Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 34531450cdc6SMatthias Ringwald } 34541450cdc6SMatthias Ringwald gatt_client->callback = callback; 34551450cdc6SMatthias Ringwald return l2cap_disconnect(gatt_client->l2cap_cid); 34561450cdc6SMatthias Ringwald } 34571450cdc6SMatthias Ringwald #endif 34581450cdc6SMatthias Ringwald 345926166ecfSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 346026166ecfSMatthias Ringwald 346126166ecfSMatthias Ringwald #define MAX_NR_EATT_CHANNELS 5 34627627a0deSMatthias Ringwald 34637627a0deSMatthias Ringwald static void gatt_client_le_enhanced_packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size); 34647627a0deSMatthias Ringwald 3465df0a5c68SMatthias Ringwald static uint8_t gatt_client_le_enhanced_num_eatt_clients_in_state(gatt_client_t * gatt_client, gatt_client_state_t state){ 3466df0a5c68SMatthias Ringwald uint8_t num_clients = 0; 3467df0a5c68SMatthias Ringwald btstack_linked_list_iterator_t it; 3468df0a5c68SMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client->eatt_clients); 3469df0a5c68SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 3470df0a5c68SMatthias Ringwald gatt_client_t * eatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it); 3471df0a5c68SMatthias Ringwald if (eatt_client->state == state){ 3472df0a5c68SMatthias Ringwald num_clients++; 3473df0a5c68SMatthias Ringwald } 3474df0a5c68SMatthias Ringwald } 3475df0a5c68SMatthias Ringwald return num_clients; 3476df0a5c68SMatthias Ringwald } 3477df0a5c68SMatthias Ringwald 34787627a0deSMatthias Ringwald static void gatt_client_eatt_finalize(gatt_client_t * gatt_client) { 34797627a0deSMatthias Ringwald // free eatt clients 34807627a0deSMatthias Ringwald btstack_linked_list_iterator_t it; 34817627a0deSMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client_connections); 34827627a0deSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)) { 34837627a0deSMatthias Ringwald gatt_client_t *eatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it); 34847627a0deSMatthias Ringwald btstack_linked_list_iterator_remove(&it); 34857627a0deSMatthias Ringwald btstack_memory_gatt_client_free(eatt_client); 34867627a0deSMatthias Ringwald } 34877627a0deSMatthias Ringwald } 34887627a0deSMatthias Ringwald 34897627a0deSMatthias Ringwald // all channels connected 34907627a0deSMatthias Ringwald static void gatt_client_le_enhanced_handle_connected(gatt_client_t * gatt_client, uint8_t status) { 34917627a0deSMatthias Ringwald if (status == ERROR_CODE_SUCCESS){ 3492df0a5c68SMatthias Ringwald uint8_t num_ready = gatt_client_le_enhanced_num_eatt_clients_in_state(gatt_client, P_READY); 3493df0a5c68SMatthias Ringwald if (num_ready > 0){ 34947627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_READY; 3495df0a5c68SMatthias Ringwald // free unused channels 3496df0a5c68SMatthias Ringwald btstack_linked_list_iterator_t it; 3497df0a5c68SMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client_connections); 3498df0a5c68SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)) { 3499df0a5c68SMatthias Ringwald gatt_client_t *eatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it); 3500df0a5c68SMatthias Ringwald if (eatt_client->state == P_L2CAP_CLOSED){ 3501df0a5c68SMatthias Ringwald btstack_linked_list_iterator_remove(&it); 3502df0a5c68SMatthias Ringwald btstack_memory_gatt_client_free(eatt_client); 3503df0a5c68SMatthias Ringwald } 3504df0a5c68SMatthias Ringwald } 3505df0a5c68SMatthias Ringwald } else { 35066d0f6f49SMatthias Ringwald hci_connection_t * hci_connection = hci_connection_for_handle(gatt_client->con_handle); 35076d0f6f49SMatthias Ringwald btstack_assert(hci_connection != NULL); 35086d0f6f49SMatthias Ringwald if (hci_connection->att_server.incoming_connection_request){ 35096d0f6f49SMatthias Ringwald hci_connection->att_server.incoming_connection_request = false; 35106d0f6f49SMatthias Ringwald log_info("Collision, retry in 100ms"); 35116d0f6f49SMatthias Ringwald gatt_client->state = P_W2_L2CAP_CONNECT; 35126d0f6f49SMatthias Ringwald // set timer for retry 3513b1da4983SMatthias Ringwald btstack_run_loop_set_timer(&gatt_client->gc_timeout, GATT_CLIENT_COLLISION_BACKOFF_MS); 35146d0f6f49SMatthias Ringwald btstack_run_loop_set_timer_handler(&gatt_client->gc_timeout, gatt_client_le_enhanced_retry); 35156d0f6f49SMatthias Ringwald btstack_run_loop_add_timer(&gatt_client->gc_timeout); 35166d0f6f49SMatthias Ringwald return; 35176d0f6f49SMatthias Ringwald } else { 3518df0a5c68SMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_IDLE; 3519df0a5c68SMatthias Ringwald status = ERROR_CODE_CONNECTION_REJECTED_DUE_TO_LIMITED_RESOURCES; 3520df0a5c68SMatthias Ringwald } 35216d0f6f49SMatthias Ringwald } 35227627a0deSMatthias Ringwald } else { 35237627a0deSMatthias Ringwald gatt_client_eatt_finalize(gatt_client); 35247627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_IDLE; 35257627a0deSMatthias Ringwald } 35267627a0deSMatthias Ringwald 3527b2d70d58SMatthias Ringwald gatt_client_emit_connected(gatt_client->callback, status, gatt_client->addr_type, gatt_client->addr, gatt_client->con_handle); 35287627a0deSMatthias Ringwald } 35297627a0deSMatthias Ringwald 35307627a0deSMatthias Ringwald // single channel disconnected 35317627a0deSMatthias Ringwald static void gatt_client_le_enhanced_handle_ecbm_disconnected(gatt_client_t * gatt_client, gatt_client_t * eatt_client) { 35327627a0deSMatthias Ringwald 35337627a0deSMatthias Ringwald // report error 35347627a0deSMatthias Ringwald gatt_client_report_error_if_pending(eatt_client, ATT_ERROR_HCI_DISCONNECT_RECEIVED); 35357627a0deSMatthias Ringwald 35367627a0deSMatthias Ringwald // free memory 35377627a0deSMatthias Ringwald btstack_linked_list_remove(&gatt_client->eatt_clients, (btstack_linked_item_t *) eatt_client); 35387627a0deSMatthias Ringwald btstack_memory_gatt_client_free(eatt_client); 35397627a0deSMatthias Ringwald 3540570bdd2dSMatthias Ringwald // last channel 35417627a0deSMatthias Ringwald if (btstack_linked_list_empty(&gatt_client->eatt_clients)){ 3542570bdd2dSMatthias Ringwald hci_connection_t * hci_connection = hci_connection_for_handle(gatt_client->con_handle); 3543570bdd2dSMatthias Ringwald hci_connection->att_server.eatt_outgoing_active = false; 3544570bdd2dSMatthias Ringwald 3545570bdd2dSMatthias Ringwald if (gatt_client->eatt_state == GATT_CLIENT_EATT_READY) { 3546570bdd2dSMatthias Ringwald // report disconnected if last channel closed 35477627a0deSMatthias Ringwald uint8_t buffer[20]; 35487627a0deSMatthias Ringwald uint16_t len = hci_event_create_from_template_and_arguments(buffer, sizeof(buffer), &gatt_client_disconnected, gatt_client->con_handle); 35497627a0deSMatthias Ringwald (*gatt_client->callback)(HCI_EVENT_PACKET, 0, buffer, len); 35507627a0deSMatthias Ringwald } 35517627a0deSMatthias Ringwald } 35527627a0deSMatthias Ringwald } 35537627a0deSMatthias Ringwald 35547627a0deSMatthias Ringwald static gatt_client_t * gatt_client_le_enhanced_get_context_for_l2cap_cid(uint16_t l2cap_cid, gatt_client_t ** out_eatt_client){ 35557627a0deSMatthias Ringwald btstack_linked_list_iterator_t it; 35567627a0deSMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client_connections); 35577627a0deSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)) { 35587627a0deSMatthias Ringwald gatt_client_t * gatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it); 35597627a0deSMatthias Ringwald btstack_linked_list_iterator_t it2; 35607627a0deSMatthias Ringwald btstack_linked_list_iterator_init(&it2, &gatt_client->eatt_clients); 35617627a0deSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it2)) { 35627627a0deSMatthias Ringwald gatt_client_t * eatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it2); 35637627a0deSMatthias Ringwald if (eatt_client->l2cap_cid == l2cap_cid){ 35647627a0deSMatthias Ringwald *out_eatt_client = eatt_client; 35657627a0deSMatthias Ringwald return gatt_client; 35667627a0deSMatthias Ringwald } 35677627a0deSMatthias Ringwald } 35687627a0deSMatthias Ringwald } 35697627a0deSMatthias Ringwald return NULL; 35707627a0deSMatthias Ringwald } 35717627a0deSMatthias Ringwald 35727627a0deSMatthias Ringwald static void gatt_client_le_enhanced_setup_l2cap_channel(gatt_client_t * gatt_client){ 35737627a0deSMatthias Ringwald uint8_t num_channels = gatt_client->eatt_num_clients; 35747627a0deSMatthias Ringwald 35757627a0deSMatthias Ringwald // setup channels 35767627a0deSMatthias Ringwald uint16_t buffer_size_per_client = gatt_client->eatt_storage_size / num_channels; 3577f7a42e72SMatthias Ringwald uint16_t max_mtu = (buffer_size_per_client - REPORT_PREBUFFER_HEADER) / 2; 35787627a0deSMatthias Ringwald uint8_t * receive_buffers[MAX_NR_EATT_CHANNELS]; 35797627a0deSMatthias Ringwald uint16_t new_cids[MAX_NR_EATT_CHANNELS]; 35807627a0deSMatthias Ringwald memset(gatt_client->eatt_storage_buffer, 0, gatt_client->eatt_storage_size); 35817627a0deSMatthias Ringwald uint8_t i; 35827627a0deSMatthias Ringwald for (i=0;i<gatt_client->eatt_num_clients; i++){ 3583f7a42e72SMatthias Ringwald receive_buffers[i] = &gatt_client->eatt_storage_buffer[REPORT_PREBUFFER_HEADER]; 3584f7a42e72SMatthias Ringwald gatt_client->eatt_storage_buffer += REPORT_PREBUFFER_HEADER + max_mtu; 35857627a0deSMatthias Ringwald } 35867627a0deSMatthias Ringwald 35877627a0deSMatthias Ringwald log_info("%u EATT clients with receive buffer size %u", gatt_client->eatt_num_clients, buffer_size_per_client); 35887627a0deSMatthias Ringwald 3589f7a42e72SMatthias Ringwald uint8_t status = l2cap_ecbm_create_channels(&gatt_client_le_enhanced_packet_handler, 3590f7a42e72SMatthias Ringwald gatt_client->con_handle, 35917627a0deSMatthias Ringwald gatt_client->security_level, 3592f7a42e72SMatthias Ringwald BLUETOOTH_PSM_EATT, num_channels, 3593f7a42e72SMatthias Ringwald L2CAP_LE_AUTOMATIC_CREDITS, 35947627a0deSMatthias Ringwald buffer_size_per_client, 3595f7a42e72SMatthias Ringwald receive_buffers, 3596f7a42e72SMatthias Ringwald new_cids); 35977627a0deSMatthias Ringwald 35987627a0deSMatthias Ringwald if (status == ERROR_CODE_SUCCESS){ 35997627a0deSMatthias Ringwald i = 0; 36007627a0deSMatthias Ringwald btstack_linked_list_iterator_t it; 36017627a0deSMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client->eatt_clients); 36027627a0deSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)) { 36037627a0deSMatthias Ringwald gatt_client_t *new_eatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it); 36047627a0deSMatthias Ringwald 36057627a0deSMatthias Ringwald // init state with new cid and transmit buffer 36067627a0deSMatthias Ringwald new_eatt_client->bearer_type = ATT_BEARER_ENHANCED_LE; 36077627a0deSMatthias Ringwald new_eatt_client->con_handle = gatt_client->con_handle; 36087627a0deSMatthias Ringwald new_eatt_client->mtu = 64; 36097627a0deSMatthias Ringwald new_eatt_client->security_level = LEVEL_0; 36107627a0deSMatthias Ringwald new_eatt_client->mtu_state = MTU_AUTO_EXCHANGE_DISABLED; 3611052dc82aSMatthias Ringwald new_eatt_client->state = P_W4_L2CAP_CONNECTION; 36127627a0deSMatthias Ringwald new_eatt_client->l2cap_cid = new_cids[i]; 36137627a0deSMatthias Ringwald new_eatt_client->eatt_storage_buffer = gatt_client->eatt_storage_buffer; 3614f7a42e72SMatthias Ringwald gatt_client->eatt_storage_buffer += max_mtu; 36157627a0deSMatthias Ringwald i++; 36167627a0deSMatthias Ringwald } 36177627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_L2CAP_SETUP; 36187627a0deSMatthias Ringwald } else { 36197627a0deSMatthias Ringwald gatt_client_le_enhanced_handle_connected(gatt_client, status); 36207627a0deSMatthias Ringwald } 362126166ecfSMatthias Ringwald } 362226166ecfSMatthias Ringwald 36236d0f6f49SMatthias Ringwald static void gatt_client_le_enhanced_retry(btstack_timer_source_t * ts){ 36246d0f6f49SMatthias Ringwald gatt_client_t * gatt_client = gatt_client_for_timer(ts); 36256d0f6f49SMatthias Ringwald if (gatt_client != NULL){ 36266d0f6f49SMatthias Ringwald gatt_client->state = P_W4_L2CAP_CONNECTION; 36276d0f6f49SMatthias Ringwald gatt_client_le_enhanced_setup_l2cap_channel(gatt_client); 36286d0f6f49SMatthias Ringwald } 36296d0f6f49SMatthias Ringwald } 36306d0f6f49SMatthias Ringwald 363126166ecfSMatthias Ringwald static void gatt_client_le_enhanced_packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size) { 36327627a0deSMatthias Ringwald gatt_client_t *gatt_client; 36337627a0deSMatthias Ringwald gatt_client_t *eatt_client; 363426166ecfSMatthias Ringwald hci_con_handle_t con_handle; 36357627a0deSMatthias Ringwald uint16_t l2cap_cid; 363626166ecfSMatthias Ringwald uint8_t status; 363726166ecfSMatthias Ringwald gatt_client_characteristic_t characteristic; 36387627a0deSMatthias Ringwald gatt_client_service_t service; 363926166ecfSMatthias Ringwald switch (packet_type) { 364026166ecfSMatthias Ringwald case HCI_EVENT_PACKET: 364126166ecfSMatthias Ringwald switch (hci_event_packet_get_type(packet)) { 36427627a0deSMatthias Ringwald case GATT_EVENT_SERVICE_QUERY_RESULT: 36437627a0deSMatthias Ringwald con_handle = gatt_event_service_query_result_get_handle(packet); 36447627a0deSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(con_handle); 36457627a0deSMatthias Ringwald btstack_assert(gatt_client != NULL); 36467627a0deSMatthias Ringwald btstack_assert(gatt_client->eatt_state == GATT_CLIENT_EATT_DISCOVER_GATT_SERVICE_W4_DONE); 36477627a0deSMatthias Ringwald gatt_event_service_query_result_get_service(packet, &service); 36487627a0deSMatthias Ringwald gatt_client->gatt_service_start_group_handle = service.start_group_handle; 36497627a0deSMatthias Ringwald gatt_client->gatt_service_end_group_handle = service.end_group_handle; 36507627a0deSMatthias Ringwald break; 365126166ecfSMatthias Ringwald case GATT_EVENT_CHARACTERISTIC_VALUE_QUERY_RESULT: 365226166ecfSMatthias Ringwald con_handle = gatt_event_characteristic_value_query_result_get_handle(packet); 365326166ecfSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(con_handle); 365426166ecfSMatthias Ringwald btstack_assert(gatt_client != NULL); 36557627a0deSMatthias Ringwald btstack_assert(gatt_client->eatt_state == GATT_CLIENT_EATT_READ_SERVER_SUPPORTED_FEATURES_W4_DONE); 365626166ecfSMatthias Ringwald if (gatt_event_characteristic_value_query_result_get_value_length(packet) >= 1) { 36577627a0deSMatthias Ringwald gatt_client->gatt_server_supported_features = gatt_event_characteristic_value_query_result_get_value(packet)[0]; 365826166ecfSMatthias Ringwald } 365926166ecfSMatthias Ringwald break; 366026166ecfSMatthias Ringwald case GATT_EVENT_CHARACTERISTIC_QUERY_RESULT: 366126166ecfSMatthias Ringwald con_handle = gatt_event_characteristic_query_result_get_handle(packet); 366226166ecfSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(con_handle); 366326166ecfSMatthias Ringwald btstack_assert(gatt_client != NULL); 36647627a0deSMatthias Ringwald btstack_assert(gatt_client->eatt_state == GATT_CLIENT_EATT_FIND_CLIENT_SUPPORTED_FEATURES_W4_DONE); 36657627a0deSMatthias Ringwald gatt_event_characteristic_query_result_get_characteristic(packet, &characteristic); 366626166ecfSMatthias Ringwald gatt_client->gatt_client_supported_features_handle = characteristic.value_handle; 366726166ecfSMatthias Ringwald break; 366826166ecfSMatthias Ringwald case GATT_EVENT_QUERY_COMPLETE: 366926166ecfSMatthias Ringwald con_handle = gatt_event_query_complete_get_handle(packet); 367026166ecfSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(con_handle); 367126166ecfSMatthias Ringwald btstack_assert(gatt_client != NULL); 36727627a0deSMatthias Ringwald switch (gatt_client->eatt_state){ 36737627a0deSMatthias Ringwald case GATT_CLIENT_EATT_DISCOVER_GATT_SERVICE_W4_DONE: 36747627a0deSMatthias Ringwald if (gatt_client->gatt_service_start_group_handle == 0){ 36757627a0deSMatthias Ringwald gatt_client_le_enhanced_handle_connected(gatt_client, ERROR_CODE_UNSUPPORTED_FEATURE_OR_PARAMETER_VALUE); 36767627a0deSMatthias Ringwald } else { 36777627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_READ_SERVER_SUPPORTED_FEATURES_W2_SEND; 36787627a0deSMatthias Ringwald } 36797627a0deSMatthias Ringwald break; 36807627a0deSMatthias Ringwald case GATT_CLIENT_EATT_READ_SERVER_SUPPORTED_FEATURES_W4_DONE: 36817627a0deSMatthias Ringwald if ((gatt_client->gatt_server_supported_features & 1) == 0) { 36827627a0deSMatthias Ringwald gatt_client_le_enhanced_handle_connected(gatt_client, ERROR_CODE_UNSUPPORTED_FEATURE_OR_PARAMETER_VALUE); 36837627a0deSMatthias Ringwald } else { 36847627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_FIND_CLIENT_SUPPORTED_FEATURES_W2_SEND; 36857627a0deSMatthias Ringwald } 36867627a0deSMatthias Ringwald break; 36877627a0deSMatthias Ringwald case GATT_CLIENT_EATT_FIND_CLIENT_SUPPORTED_FEATURES_W4_DONE: 36887627a0deSMatthias Ringwald if (gatt_client->gatt_client_supported_features_handle == 0){ 36897627a0deSMatthias Ringwald gatt_client_le_enhanced_handle_connected(gatt_client, ERROR_CODE_UNSUPPORTED_FEATURE_OR_PARAMETER_VALUE); 36907627a0deSMatthias Ringwald } else { 36917627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_WRITE_ClIENT_SUPPORTED_FEATURES_W2_SEND; 36927627a0deSMatthias Ringwald } 36937627a0deSMatthias Ringwald break; 36947627a0deSMatthias Ringwald case GATT_CLIENT_EATT_WRITE_ClIENT_SUPPORTED_FEATURES_W4_DONE: 36957627a0deSMatthias Ringwald gatt_client_le_enhanced_setup_l2cap_channel(gatt_client); 369626166ecfSMatthias Ringwald break; 369726166ecfSMatthias Ringwald default: 369826166ecfSMatthias Ringwald break; 369926166ecfSMatthias Ringwald } 370026166ecfSMatthias Ringwald break; 37017627a0deSMatthias Ringwald case L2CAP_EVENT_ECBM_CHANNEL_OPENED: 37027627a0deSMatthias Ringwald l2cap_cid = l2cap_event_ecbm_channel_opened_get_local_cid(packet); 37037627a0deSMatthias Ringwald gatt_client = gatt_client_le_enhanced_get_context_for_l2cap_cid(l2cap_cid, &eatt_client); 37047627a0deSMatthias Ringwald 37057627a0deSMatthias Ringwald btstack_assert(gatt_client != NULL); 37067627a0deSMatthias Ringwald btstack_assert(eatt_client != NULL); 3707052dc82aSMatthias Ringwald btstack_assert(eatt_client->state == P_W4_L2CAP_CONNECTION); 37087627a0deSMatthias Ringwald 37097627a0deSMatthias Ringwald status = l2cap_event_channel_opened_get_status(packet); 37107627a0deSMatthias Ringwald if (status == ERROR_CODE_SUCCESS){ 3711052dc82aSMatthias Ringwald eatt_client->state = P_READY; 37127627a0deSMatthias Ringwald eatt_client->mtu = l2cap_event_channel_opened_get_remote_mtu(packet); 37137627a0deSMatthias Ringwald } else { 3714df0a5c68SMatthias Ringwald eatt_client->state = P_L2CAP_CLOSED; 37157627a0deSMatthias Ringwald } 3716df0a5c68SMatthias Ringwald // connected if opened event for all channels received 3717df0a5c68SMatthias Ringwald if (gatt_client_le_enhanced_num_eatt_clients_in_state(gatt_client, P_W4_L2CAP_CONNECTION) == 0){ 37187627a0deSMatthias Ringwald gatt_client_le_enhanced_handle_connected(gatt_client, ERROR_CODE_SUCCESS); 37197627a0deSMatthias Ringwald } 37207627a0deSMatthias Ringwald break; 37217627a0deSMatthias Ringwald case L2CAP_EVENT_CHANNEL_CLOSED: 37227627a0deSMatthias Ringwald l2cap_cid = l2cap_event_channel_closed_get_local_cid(packet); 37237627a0deSMatthias Ringwald gatt_client = gatt_client_le_enhanced_get_context_for_l2cap_cid(l2cap_cid, &eatt_client); 37247627a0deSMatthias Ringwald btstack_assert(gatt_client != NULL); 37257627a0deSMatthias Ringwald btstack_assert(eatt_client != NULL); 37267627a0deSMatthias Ringwald gatt_client_le_enhanced_handle_ecbm_disconnected(gatt_client, eatt_client); 37277627a0deSMatthias Ringwald break; 37287627a0deSMatthias Ringwald default: 37297627a0deSMatthias Ringwald break; 37307627a0deSMatthias Ringwald } 37317627a0deSMatthias Ringwald break; 37327627a0deSMatthias Ringwald case L2CAP_DATA_PACKET: 37337627a0deSMatthias Ringwald gatt_client = gatt_client_le_enhanced_get_context_for_l2cap_cid(channel, &eatt_client); 37347627a0deSMatthias Ringwald btstack_assert(gatt_client != NULL); 3735ce82ac7fSMatthias Ringwald btstack_assert(eatt_client != NULL); 3736ce82ac7fSMatthias Ringwald gatt_client_handle_att_response(eatt_client, packet, size); 37377627a0deSMatthias Ringwald gatt_client_run(); 37387627a0deSMatthias Ringwald break; 373926166ecfSMatthias Ringwald default: 374026166ecfSMatthias Ringwald break; 374126166ecfSMatthias Ringwald } 374226166ecfSMatthias Ringwald } 374326166ecfSMatthias Ringwald 37447627a0deSMatthias Ringwald static bool gatt_client_le_enhanced_handle_can_send_query(gatt_client_t * gatt_client){ 374526166ecfSMatthias Ringwald uint8_t status = ERROR_CODE_SUCCESS; 374626166ecfSMatthias Ringwald uint8_t gatt_client_supported_features = 0x06; // eatt + multiple value notifications 374726166ecfSMatthias Ringwald switch (gatt_client->eatt_state){ 37487627a0deSMatthias Ringwald case GATT_CLIENT_EATT_DISCOVER_GATT_SERVICE_W2_SEND: 37497627a0deSMatthias Ringwald gatt_client->gatt_service_start_group_handle = 0; 37507627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_DISCOVER_GATT_SERVICE_W4_DONE; 37517627a0deSMatthias Ringwald status = gatt_client_discover_primary_services_by_uuid16(&gatt_client_le_enhanced_packet_handler, 37527627a0deSMatthias Ringwald gatt_client->con_handle, 37537627a0deSMatthias Ringwald ORG_BLUETOOTH_SERVICE_GENERIC_ATTRIBUTE); 37547627a0deSMatthias Ringwald break; 375526166ecfSMatthias Ringwald case GATT_CLIENT_EATT_READ_SERVER_SUPPORTED_FEATURES_W2_SEND: 37567627a0deSMatthias Ringwald gatt_client->gatt_server_supported_features = 0; 37577627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_READ_SERVER_SUPPORTED_FEATURES_W4_DONE; 375826166ecfSMatthias Ringwald status = gatt_client_read_value_of_characteristics_by_uuid16(&gatt_client_le_enhanced_packet_handler, 37597627a0deSMatthias Ringwald gatt_client->con_handle, 37607627a0deSMatthias Ringwald gatt_client->gatt_service_start_group_handle, 37617627a0deSMatthias Ringwald gatt_client->gatt_service_end_group_handle, 376226166ecfSMatthias Ringwald ORG_BLUETOOTH_CHARACTERISTIC_SERVER_SUPPORTED_FEATURES); 376326166ecfSMatthias Ringwald return true; 376426166ecfSMatthias Ringwald case GATT_CLIENT_EATT_FIND_CLIENT_SUPPORTED_FEATURES_W2_SEND: 37657627a0deSMatthias Ringwald gatt_client->gatt_client_supported_features_handle = 0; 37667627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_FIND_CLIENT_SUPPORTED_FEATURES_W4_DONE; 376726166ecfSMatthias Ringwald status = gatt_client_discover_characteristics_for_handle_range_by_uuid16(&gatt_client_le_enhanced_packet_handler, 37687627a0deSMatthias Ringwald gatt_client->con_handle, 37697627a0deSMatthias Ringwald gatt_client->gatt_service_start_group_handle, 37707627a0deSMatthias Ringwald gatt_client->gatt_service_end_group_handle, 37717627a0deSMatthias Ringwald ORG_BLUETOOTH_CHARACTERISTIC_CLIENT_SUPPORTED_FEATURES); 377226166ecfSMatthias Ringwald return true; 377326166ecfSMatthias Ringwald case GATT_CLIENT_EATT_WRITE_ClIENT_SUPPORTED_FEATURES_W2_SEND: 377426166ecfSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_WRITE_ClIENT_SUPPORTED_FEATURES_W4_DONE; 377526166ecfSMatthias Ringwald status = gatt_client_write_value_of_characteristic(&gatt_client_le_enhanced_packet_handler, gatt_client->con_handle, 377626166ecfSMatthias Ringwald gatt_client->gatt_client_supported_features_handle, 1, 377726166ecfSMatthias Ringwald &gatt_client_supported_features); 377826166ecfSMatthias Ringwald return true; 377926166ecfSMatthias Ringwald default: 378026166ecfSMatthias Ringwald break; 378126166ecfSMatthias Ringwald } 37827627a0deSMatthias Ringwald btstack_assert(status == ERROR_CODE_SUCCESS); 37837627a0deSMatthias Ringwald UNUSED(status); 378426166ecfSMatthias Ringwald return false; 378526166ecfSMatthias Ringwald } 378626166ecfSMatthias Ringwald 378726166ecfSMatthias 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) { 378826166ecfSMatthias Ringwald gatt_client_t * gatt_client; 378926166ecfSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 379026166ecfSMatthias Ringwald if (status != ERROR_CODE_SUCCESS){ 379126166ecfSMatthias Ringwald return status; 379226166ecfSMatthias Ringwald } 379326166ecfSMatthias Ringwald 379426166ecfSMatthias Ringwald if (gatt_client->eatt_state != GATT_CLIENT_EATT_IDLE){ 379526166ecfSMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 379626166ecfSMatthias Ringwald } 379726166ecfSMatthias Ringwald 3798f7a42e72SMatthias Ringwald // need one buffer for sending and one for receiving. Receiving includes pre-buffer for reports 37997627a0deSMatthias Ringwald uint16_t buffer_size_per_client = storage_size / num_channels; 3800f7a42e72SMatthias Ringwald uint16_t max_mtu = (buffer_size_per_client - REPORT_PREBUFFER_HEADER) / 2; 3801f7a42e72SMatthias Ringwald if (max_mtu < 64) { 38027627a0deSMatthias Ringwald return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS; 38037627a0deSMatthias Ringwald } 38047627a0deSMatthias Ringwald 38057627a0deSMatthias Ringwald if ((num_channels == 0) || (num_channels > MAX_NR_EATT_CHANNELS)){ 38067627a0deSMatthias Ringwald return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS; 38077627a0deSMatthias Ringwald } 38087627a0deSMatthias Ringwald 38097627a0deSMatthias Ringwald // create max num_channel eatt clients 38107627a0deSMatthias Ringwald uint8_t i; 38117627a0deSMatthias Ringwald btstack_linked_list_t eatt_clients = NULL; 38127627a0deSMatthias Ringwald for (i=0;i<num_channels;i++) { 38137627a0deSMatthias Ringwald gatt_client_t * new_gatt_client = btstack_memory_gatt_client_get(); 38147627a0deSMatthias Ringwald if (new_gatt_client == NULL) { 38157627a0deSMatthias Ringwald break; 38167627a0deSMatthias Ringwald } 38177627a0deSMatthias Ringwald btstack_linked_list_add(&eatt_clients, (btstack_linked_item_t*)new_gatt_client); 38187627a0deSMatthias Ringwald } 38197627a0deSMatthias Ringwald 38207627a0deSMatthias Ringwald if (i != num_channels){ 38217627a0deSMatthias Ringwald while (true){ 38227627a0deSMatthias Ringwald gatt_client = (gatt_client_t *) btstack_linked_list_pop(&eatt_clients); 38237627a0deSMatthias Ringwald if (gatt_client == NULL) { 38247627a0deSMatthias Ringwald break; 38257627a0deSMatthias Ringwald } 38267627a0deSMatthias Ringwald btstack_memory_gatt_client_free(gatt_client); 38277627a0deSMatthias Ringwald } 38287627a0deSMatthias Ringwald return ERROR_CODE_MEMORY_CAPACITY_EXCEEDED; 38297627a0deSMatthias Ringwald } 38307627a0deSMatthias Ringwald 3831570bdd2dSMatthias Ringwald hci_connection_t * hci_connection = hci_connection_for_handle(con_handle); 3832570bdd2dSMatthias Ringwald hci_connection->att_server.eatt_outgoing_active = true; 3833570bdd2dSMatthias Ringwald 38347627a0deSMatthias Ringwald gatt_client->callback = callback; 38357627a0deSMatthias Ringwald gatt_client->eatt_num_clients = num_channels; 38367627a0deSMatthias Ringwald gatt_client->eatt_storage_buffer = storage_buffer; 38377627a0deSMatthias Ringwald gatt_client->eatt_storage_size = storage_size; 38387627a0deSMatthias Ringwald gatt_client->eatt_clients = eatt_clients; 38397627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_DISCOVER_GATT_SERVICE_W2_SEND; 384026166ecfSMatthias Ringwald gatt_client_notify_can_send_query(gatt_client); 384126166ecfSMatthias Ringwald 384226166ecfSMatthias Ringwald return ERROR_CODE_SUCCESS; 384326166ecfSMatthias Ringwald } 384426166ecfSMatthias Ringwald 384526166ecfSMatthias Ringwald #endif 384626166ecfSMatthias Ringwald 3847a6121b51SMilanka Ringwald #ifdef FUZZING_BUILD_MODE_UNSAFE_FOR_PRODUCTION 3848a6121b51SMilanka Ringwald void gatt_client_att_packet_handler_fuzz(uint8_t packet_type, uint16_t handle, uint8_t *packet, uint16_t size){ 3849a6121b51SMilanka Ringwald gatt_client_att_packet_handler(packet_type, handle, packet, size); 3850a6121b51SMilanka Ringwald } 3851ae1ee62dSMilanka Ringwald 385240faeb84SMilanka Ringwald uint8_t gatt_client_get_client(hci_con_handle_t con_handle, gatt_client_t ** out_gatt_client){ 385340faeb84SMilanka Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, out_gatt_client); 385440faeb84SMilanka Ringwald return status; 3855ae1ee62dSMilanka Ringwald } 3856a6121b51SMilanka Ringwald #endif 3857