13deb3ec6SMatthias Ringwald /* 23deb3ec6SMatthias Ringwald * Copyright (C) 2014 BlueKitchen GmbH 33deb3ec6SMatthias Ringwald * 43deb3ec6SMatthias Ringwald * Redistribution and use in source and binary forms, with or without 53deb3ec6SMatthias Ringwald * modification, are permitted provided that the following conditions 63deb3ec6SMatthias Ringwald * are met: 73deb3ec6SMatthias Ringwald * 83deb3ec6SMatthias Ringwald * 1. Redistributions of source code must retain the above copyright 93deb3ec6SMatthias Ringwald * notice, this list of conditions and the following disclaimer. 103deb3ec6SMatthias Ringwald * 2. Redistributions in binary form must reproduce the above copyright 113deb3ec6SMatthias Ringwald * notice, this list of conditions and the following disclaimer in the 123deb3ec6SMatthias Ringwald * documentation and/or other materials provided with the distribution. 133deb3ec6SMatthias Ringwald * 3. Neither the name of the copyright holders nor the names of 143deb3ec6SMatthias Ringwald * contributors may be used to endorse or promote products derived 153deb3ec6SMatthias Ringwald * from this software without specific prior written permission. 163deb3ec6SMatthias Ringwald * 4. Any redistribution, use, or modification is done solely for 173deb3ec6SMatthias Ringwald * personal benefit and not for any commercial purpose or for 183deb3ec6SMatthias Ringwald * monetary gain. 193deb3ec6SMatthias Ringwald * 203deb3ec6SMatthias Ringwald * THIS SOFTWARE IS PROVIDED BY BLUEKITCHEN GMBH AND CONTRIBUTORS 213deb3ec6SMatthias Ringwald * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 223deb3ec6SMatthias Ringwald * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS 232fca4dadSMilanka Ringwald * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL BLUEKITCHEN 242fca4dadSMilanka Ringwald * GMBH OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, 253deb3ec6SMatthias Ringwald * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, 263deb3ec6SMatthias Ringwald * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS 273deb3ec6SMatthias Ringwald * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED 283deb3ec6SMatthias Ringwald * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, 293deb3ec6SMatthias Ringwald * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF 303deb3ec6SMatthias Ringwald * THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 313deb3ec6SMatthias Ringwald * SUCH DAMAGE. 323deb3ec6SMatthias Ringwald * 333deb3ec6SMatthias Ringwald * Please inquire about commercial licensing options at 343deb3ec6SMatthias Ringwald * [email protected] 353deb3ec6SMatthias Ringwald * 363deb3ec6SMatthias Ringwald */ 373deb3ec6SMatthias Ringwald 38e501bae0SMatthias Ringwald #define BTSTACK_FILE__ "gatt_client.c" 39ab2c6ae4SMatthias Ringwald 403deb3ec6SMatthias Ringwald #include <stdint.h> 413deb3ec6SMatthias Ringwald #include <string.h> 42a95ca902SMatthias Ringwald #include <stddef.h> 433deb3ec6SMatthias Ringwald 447907f069SMatthias Ringwald #include "btstack_config.h" 453deb3ec6SMatthias Ringwald 46296289e3SMatthias Ringwald #include "ble/att_dispatch.h" 470e2df43fSMatthias Ringwald #include "ble/att_db.h" 480e2df43fSMatthias Ringwald #include "ble/gatt_client.h" 490e2df43fSMatthias Ringwald #include "ble/le_device_db.h" 500e2df43fSMatthias Ringwald #include "ble/sm.h" 5116ece135SMatthias Ringwald #include "btstack_debug.h" 520e2df43fSMatthias Ringwald #include "btstack_event.h" 533deb3ec6SMatthias Ringwald #include "btstack_memory.h" 540e2df43fSMatthias Ringwald #include "btstack_run_loop.h" 550e2df43fSMatthias Ringwald #include "btstack_util.h" 563deb3ec6SMatthias Ringwald #include "hci.h" 573deb3ec6SMatthias Ringwald #include "hci_dump.h" 583deb3ec6SMatthias Ringwald #include "l2cap.h" 591450cdc6SMatthias Ringwald #include "classic/sdp_client.h" 601450cdc6SMatthias Ringwald #include "bluetooth_gatt.h" 611450cdc6SMatthias Ringwald #include "bluetooth_sdp.h" 621450cdc6SMatthias Ringwald #include "classic/sdp_util.h" 633deb3ec6SMatthias Ringwald 64b1da4983SMatthias Ringwald // L2CAP Test Spec p35 defines a minimum of 100 ms, but PTS might indicate an error if we sent after 100 ms 65b1da4983SMatthias Ringwald #define GATT_CLIENT_COLLISION_BACKOFF_MS 150 66b1da4983SMatthias Ringwald 679c662c9bSMatthias Ringwald static btstack_linked_list_t gatt_client_connections; 689c662c9bSMatthias Ringwald static btstack_linked_list_t gatt_client_value_listeners; 69361b1363SMatthias Ringwald static btstack_packet_callback_registration_t hci_event_callback_registration; 70f4b33574SMatthias Ringwald static btstack_packet_callback_registration_t sm_event_callback_registration; 71544a5845SMatthias Ringwald static btstack_context_callback_registration_t gatt_client_deferred_event_emit; 72f4b33574SMatthias Ringwald 7311279da7SMatthias Ringwald // GATT Client Configuration 7411279da7SMatthias Ringwald static bool gatt_client_mtu_exchange_enabled; 7511279da7SMatthias Ringwald static gap_security_level_t gatt_client_required_security_level; 765cf6c434SJakob Krantz 773deb3ec6SMatthias Ringwald static void gatt_client_att_packet_handler(uint8_t packet_type, uint16_t handle, uint8_t *packet, uint16_t size); 78f4b33574SMatthias Ringwald static void gatt_client_event_packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size); 795cf1669fSMatthias Ringwald static void gatt_client_report_error_if_pending(gatt_client_t *gatt_client, uint8_t att_error_code); 807a766ebfSMatthias Ringwald 817a766ebfSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 823deb3ec6SMatthias Ringwald static void att_signed_write_handle_cmac_result(uint8_t hash[8]); 837a766ebfSMatthias Ringwald #endif 843deb3ec6SMatthias Ringwald 8559b5e157SMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC 8659b5e157SMatthias Ringwald static gatt_client_t * gatt_client_get_context_for_l2cap_cid(uint16_t l2cap_cid); 8759b5e157SMatthias Ringwald static void gatt_client_classic_handle_connected(gatt_client_t * gatt_client, uint8_t status); 8859b5e157SMatthias Ringwald static void gatt_client_classic_handle_disconnected(gatt_client_t * gatt_client); 89180cbe79SMatthias Ringwald static void gatt_client_classic_retry(btstack_timer_source_t * ts); 9059b5e157SMatthias Ringwald #endif 9159b5e157SMatthias Ringwald 9226166ecfSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 937627a0deSMatthias Ringwald static bool gatt_client_le_enhanced_handle_can_send_query(gatt_client_t * gatt_client); 946d0f6f49SMatthias Ringwald static void gatt_client_le_enhanced_retry(btstack_timer_source_t * ts); 9526166ecfSMatthias Ringwald #endif 9626166ecfSMatthias Ringwald 973deb3ec6SMatthias Ringwald void gatt_client_init(void){ 983deb3ec6SMatthias Ringwald gatt_client_connections = NULL; 99f4b33574SMatthias Ringwald 10011279da7SMatthias Ringwald // default configuration 10111279da7SMatthias Ringwald gatt_client_mtu_exchange_enabled = true; 10211279da7SMatthias Ringwald gatt_client_required_security_level = LEVEL_0; 10311279da7SMatthias Ringwald 10411279da7SMatthias Ringwald // register for HCI Events 105f4b33574SMatthias Ringwald hci_event_callback_registration.callback = &gatt_client_event_packet_handler; 106361b1363SMatthias Ringwald hci_add_event_handler(&hci_event_callback_registration); 107361b1363SMatthias Ringwald 108f4b33574SMatthias Ringwald // register for SM Events 109f4b33574SMatthias Ringwald sm_event_callback_registration.callback = &gatt_client_event_packet_handler; 110f4b33574SMatthias Ringwald sm_add_event_handler(&sm_event_callback_registration); 111f4b33574SMatthias Ringwald 112361b1363SMatthias Ringwald // and ATT Client PDUs 1133deb3ec6SMatthias Ringwald att_dispatch_register_client(gatt_client_att_packet_handler); 1143deb3ec6SMatthias Ringwald } 1153deb3ec6SMatthias Ringwald 11611279da7SMatthias Ringwald void gatt_client_set_required_security_level(gap_security_level_t level){ 11711279da7SMatthias Ringwald gatt_client_required_security_level = level; 11811279da7SMatthias Ringwald } 11911279da7SMatthias Ringwald 120ec820d77SMatthias Ringwald static gatt_client_t * gatt_client_for_timer(btstack_timer_source_t * ts){ 121665d90f2SMatthias Ringwald btstack_linked_list_iterator_t it; 122665d90f2SMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client_connections); 123665d90f2SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 1245cf1669fSMatthias Ringwald gatt_client_t * gatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it); 1255cf1669fSMatthias Ringwald if (&gatt_client->gc_timeout == ts) { 1265cf1669fSMatthias Ringwald return gatt_client; 1273deb3ec6SMatthias Ringwald } 1283deb3ec6SMatthias Ringwald } 1293deb3ec6SMatthias Ringwald return NULL; 1303deb3ec6SMatthias Ringwald } 1313deb3ec6SMatthias Ringwald 132ec820d77SMatthias Ringwald static void gatt_client_timeout_handler(btstack_timer_source_t * timer){ 1335cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_for_timer(timer); 1345cf1669fSMatthias Ringwald if (gatt_client == NULL) return; 1355cf1669fSMatthias Ringwald log_info("GATT client timeout handle, handle 0x%02x", gatt_client->con_handle); 1365cf1669fSMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, ATT_ERROR_TIMEOUT); 1373deb3ec6SMatthias Ringwald } 1383deb3ec6SMatthias Ringwald 1395cf1669fSMatthias Ringwald static void gatt_client_timeout_start(gatt_client_t * gatt_client){ 1405cf1669fSMatthias Ringwald log_info("GATT client timeout start, handle 0x%02x", gatt_client->con_handle); 1415cf1669fSMatthias Ringwald btstack_run_loop_remove_timer(&gatt_client->gc_timeout); 1425cf1669fSMatthias Ringwald btstack_run_loop_set_timer_handler(&gatt_client->gc_timeout, gatt_client_timeout_handler); 1435cf1669fSMatthias Ringwald btstack_run_loop_set_timer(&gatt_client->gc_timeout, 30000); // 30 seconds sm timeout 1445cf1669fSMatthias Ringwald btstack_run_loop_add_timer(&gatt_client->gc_timeout); 1453deb3ec6SMatthias Ringwald } 1463deb3ec6SMatthias Ringwald 1475cf1669fSMatthias Ringwald static void gatt_client_timeout_stop(gatt_client_t * gatt_client){ 1485cf1669fSMatthias Ringwald log_info("GATT client timeout stop, handle 0x%02x", gatt_client->con_handle); 1495cf1669fSMatthias Ringwald btstack_run_loop_remove_timer(&gatt_client->gc_timeout); 1503deb3ec6SMatthias Ringwald } 1513deb3ec6SMatthias Ringwald 1521dfae9c7SMatthias Ringwald static gap_security_level_t gatt_client_le_security_level_for_connection(hci_con_handle_t con_handle){ 1531dfae9c7SMatthias Ringwald uint8_t encryption_key_size = gap_encryption_key_size(con_handle); 1541dfae9c7SMatthias Ringwald if (encryption_key_size == 0) return LEVEL_0; 1551dfae9c7SMatthias Ringwald 156ff3f1026SMatthias Ringwald bool authenticated = gap_authenticated(con_handle); 1571dfae9c7SMatthias Ringwald if (!authenticated) return LEVEL_2; 1581dfae9c7SMatthias Ringwald 1591dfae9c7SMatthias Ringwald return encryption_key_size == 16 ? LEVEL_4 : LEVEL_3; 1601dfae9c7SMatthias Ringwald } 1611dfae9c7SMatthias Ringwald 1625cf1669fSMatthias Ringwald static gatt_client_t * gatt_client_get_context_for_handle(uint16_t handle){ 163665d90f2SMatthias Ringwald btstack_linked_item_t *it; 164a0da043fSMatthias Ringwald for (it = (btstack_linked_item_t *) gatt_client_connections; it != NULL; it = it->next){ 1655cf1669fSMatthias Ringwald gatt_client_t * gatt_client = (gatt_client_t *) it; 1665cf1669fSMatthias Ringwald if (gatt_client->con_handle == handle){ 1675cf1669fSMatthias Ringwald return gatt_client; 1683deb3ec6SMatthias Ringwald } 1693deb3ec6SMatthias Ringwald } 1703deb3ec6SMatthias Ringwald return NULL; 1713deb3ec6SMatthias Ringwald } 1723deb3ec6SMatthias Ringwald 1733deb3ec6SMatthias Ringwald 1746b65794dSMilanka Ringwald // @return gatt_client context 1753deb3ec6SMatthias Ringwald // returns existing one, or tries to setup new one 17640faeb84SMilanka Ringwald static uint8_t gatt_client_provide_context_for_handle(hci_con_handle_t con_handle, gatt_client_t ** out_gatt_client){ 1775cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_get_context_for_handle(con_handle); 17840faeb84SMilanka Ringwald 17940faeb84SMilanka Ringwald if (gatt_client != NULL){ 18040faeb84SMilanka Ringwald *out_gatt_client = gatt_client; 18140faeb84SMilanka Ringwald return ERROR_CODE_SUCCESS; 18240faeb84SMilanka Ringwald } 1833deb3ec6SMatthias Ringwald 184ae1d1237SMatthias Ringwald // bail if no such hci connection 1850e0bba86SMatthias Ringwald hci_connection_t * hci_connection = hci_connection_for_handle(con_handle); 1860e0bba86SMatthias Ringwald if (hci_connection == NULL){ 187ae1d1237SMatthias Ringwald log_error("No connection for handle 0x%04x", con_handle); 18840faeb84SMilanka Ringwald *out_gatt_client = NULL; 18940faeb84SMilanka Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 190ae1d1237SMatthias Ringwald } 19140faeb84SMilanka Ringwald 1925cf1669fSMatthias Ringwald gatt_client = btstack_memory_gatt_client_get(); 19340faeb84SMilanka Ringwald if (gatt_client == NULL){ 19440faeb84SMilanka Ringwald *out_gatt_client = NULL; 19540faeb84SMilanka Ringwald return ERROR_CODE_MEMORY_CAPACITY_EXCEEDED; 19640faeb84SMilanka Ringwald } 1973deb3ec6SMatthias Ringwald // init state 198e9cdf30bSMatthias Ringwald gatt_client->bearer_type = ATT_BEARER_UNENHANCED_LE; 1995cf1669fSMatthias Ringwald gatt_client->con_handle = con_handle; 2005cf1669fSMatthias Ringwald gatt_client->mtu = ATT_DEFAULT_MTU; 2011dfae9c7SMatthias Ringwald gatt_client->security_level = gatt_client_le_security_level_for_connection(con_handle); 20211279da7SMatthias Ringwald if (gatt_client_mtu_exchange_enabled){ 2035cf1669fSMatthias Ringwald gatt_client->mtu_state = SEND_MTU_EXCHANGE; 2045cf6c434SJakob Krantz } else { 2055cf1669fSMatthias Ringwald gatt_client->mtu_state = MTU_AUTO_EXCHANGE_DISABLED; 2065cf6c434SJakob Krantz } 207052dc82aSMatthias Ringwald gatt_client->state = P_READY; 208cbd76cecSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 209cbd76cecSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_IDLE; 210cbd76cecSMatthias Ringwald #endif 2115cf1669fSMatthias Ringwald btstack_linked_list_add(&gatt_client_connections, (btstack_linked_item_t*)gatt_client); 2120e0bba86SMatthias Ringwald 2130e0bba86SMatthias Ringwald // get unenhanced att bearer state 2140e0bba86SMatthias Ringwald if (hci_connection->att_connection.mtu_exchanged){ 2150e0bba86SMatthias Ringwald gatt_client->mtu = hci_connection->att_connection.mtu; 2160e0bba86SMatthias Ringwald gatt_client->mtu_state = MTU_EXCHANGED; 2170e0bba86SMatthias Ringwald } 21840faeb84SMilanka Ringwald *out_gatt_client = gatt_client; 21940faeb84SMilanka Ringwald return ERROR_CODE_SUCCESS; 2203deb3ec6SMatthias Ringwald } 2213deb3ec6SMatthias Ringwald 222de27733dSMatthias Ringwald static bool is_ready(gatt_client_t * gatt_client){ 223052dc82aSMatthias Ringwald return gatt_client->state == P_READY; 224de27733dSMatthias Ringwald } 225de27733dSMatthias Ringwald 226de27733dSMatthias Ringwald static uint8_t gatt_client_provide_context_for_request(hci_con_handle_t con_handle, gatt_client_t ** out_gatt_client){ 227de27733dSMatthias Ringwald gatt_client_t * gatt_client = NULL; 228de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 22940faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 23040faeb84SMilanka Ringwald return status; 23140faeb84SMilanka Ringwald } 232de27733dSMatthias Ringwald 2337627a0deSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 2347627a0deSMatthias Ringwald if (gatt_client->eatt_state == GATT_CLIENT_EATT_READY){ 2357627a0deSMatthias Ringwald btstack_linked_list_iterator_t it; 2367627a0deSMatthias Ringwald gatt_client_t * eatt_client = NULL; 2377627a0deSMatthias Ringwald // find free eatt client 2387627a0deSMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client->eatt_clients); 2397627a0deSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 2407627a0deSMatthias Ringwald gatt_client_t * client = (gatt_client_t *) btstack_linked_list_iterator_next(&it); 241052dc82aSMatthias Ringwald if (client->state == P_READY){ 2427627a0deSMatthias Ringwald eatt_client = client; 2437627a0deSMatthias Ringwald break; 2447627a0deSMatthias Ringwald } 2457627a0deSMatthias Ringwald } 2467627a0deSMatthias Ringwald if (eatt_client == NULL){ 2477627a0deSMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 2487627a0deSMatthias Ringwald } 2497627a0deSMatthias Ringwald gatt_client = eatt_client; 2507627a0deSMatthias Ringwald } 2517627a0deSMatthias Ringwald #endif 2527627a0deSMatthias Ringwald 253643a64fcSMatthias Ringwald if (is_ready(gatt_client) == false){ 254de27733dSMatthias Ringwald return GATT_CLIENT_IN_WRONG_STATE; 2553deb3ec6SMatthias Ringwald } 2563deb3ec6SMatthias Ringwald 257de27733dSMatthias Ringwald gatt_client_timeout_start(gatt_client); 258de27733dSMatthias Ringwald 259de27733dSMatthias Ringwald *out_gatt_client = gatt_client; 260de27733dSMatthias Ringwald 261de27733dSMatthias Ringwald return status; 2623deb3ec6SMatthias Ringwald } 2633deb3ec6SMatthias Ringwald 264fc64f94aSMatthias Ringwald int gatt_client_is_ready(hci_con_handle_t con_handle){ 26540faeb84SMilanka Ringwald gatt_client_t * gatt_client; 26640faeb84SMilanka Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 26740faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 26840faeb84SMilanka Ringwald return 0; 26940faeb84SMilanka Ringwald } 270aacf1b1aSMilanka Ringwald return is_ready(gatt_client) ? 1 : 0; 2713deb3ec6SMatthias Ringwald } 2723deb3ec6SMatthias Ringwald 2735cf6c434SJakob Krantz void gatt_client_mtu_enable_auto_negotiation(uint8_t enabled){ 27411279da7SMatthias Ringwald gatt_client_mtu_exchange_enabled = enabled != 0; 2755cf6c434SJakob Krantz } 2765cf6c434SJakob Krantz 277fc64f94aSMatthias Ringwald uint8_t gatt_client_get_mtu(hci_con_handle_t con_handle, uint16_t * mtu){ 27840faeb84SMilanka Ringwald gatt_client_t * gatt_client; 27940faeb84SMilanka Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 28040faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 28140faeb84SMilanka Ringwald return status; 28240faeb84SMilanka Ringwald } 2837d2258b3SMilanka Ringwald 2845cf1669fSMatthias Ringwald if ((gatt_client->mtu_state == MTU_EXCHANGED) || (gatt_client->mtu_state == MTU_AUTO_EXCHANGE_DISABLED)){ 2855cf1669fSMatthias Ringwald *mtu = gatt_client->mtu; 2867d2258b3SMilanka Ringwald return ERROR_CODE_SUCCESS; 2873deb3ec6SMatthias Ringwald } 2883deb3ec6SMatthias Ringwald *mtu = ATT_DEFAULT_MTU; 289616edd56SMatthias Ringwald return GATT_CLIENT_IN_WRONG_STATE; 2903deb3ec6SMatthias Ringwald } 2913deb3ec6SMatthias Ringwald 2929228fd32SMatthias Ringwald static uint8_t *gatt_client_reserve_request_buffer(gatt_client_t *gatt_client) { 2937627a0deSMatthias Ringwald switch (gatt_client->bearer_type){ 2947627a0deSMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC 2957627a0deSMatthias Ringwald case ATT_BEARER_UNENHANCED_CLASSIC: 2967627a0deSMatthias Ringwald #endif 2977627a0deSMatthias Ringwald case ATT_BEARER_UNENHANCED_LE: 2989228fd32SMatthias Ringwald l2cap_reserve_packet_buffer(); 2999228fd32SMatthias Ringwald return l2cap_get_outgoing_buffer(); 3007627a0deSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 3017627a0deSMatthias Ringwald case ATT_BEARER_ENHANCED_LE: 3027627a0deSMatthias Ringwald return gatt_client->eatt_storage_buffer; 3037627a0deSMatthias Ringwald #endif 3047627a0deSMatthias Ringwald default: 3057627a0deSMatthias Ringwald btstack_unreachable(); 3067627a0deSMatthias Ringwald break; 3077627a0deSMatthias Ringwald } 3087627a0deSMatthias Ringwald return NULL; 3099228fd32SMatthias Ringwald } 3109228fd32SMatthias Ringwald 3113deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 3126e7b444cSMatthias Ringwald static uint8_t gatt_client_send(gatt_client_t * gatt_client, uint16_t len){ 31346012949SMatthias Ringwald switch (gatt_client->bearer_type){ 31446012949SMatthias Ringwald case ATT_BEARER_UNENHANCED_LE: 3156e7b444cSMatthias Ringwald return l2cap_send_prepared_connectionless(gatt_client->con_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL, len); 31646012949SMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC 31746012949SMatthias Ringwald case ATT_BEARER_UNENHANCED_CLASSIC: 31846012949SMatthias Ringwald return l2cap_send_prepared(gatt_client->l2cap_cid, len); 31946012949SMatthias Ringwald #endif 3207627a0deSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 3217627a0deSMatthias Ringwald case ATT_BEARER_ENHANCED_LE: 3227627a0deSMatthias Ringwald return l2cap_send(gatt_client->l2cap_cid, gatt_client->eatt_storage_buffer, len); 3237627a0deSMatthias Ringwald #endif 32446012949SMatthias Ringwald default: 32546012949SMatthias Ringwald btstack_unreachable(); 32646012949SMatthias Ringwald return ERROR_CODE_HARDWARE_FAILURE; 32746012949SMatthias Ringwald } 3283deb3ec6SMatthias Ringwald } 3293deb3ec6SMatthias Ringwald 3303deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 3316e7b444cSMatthias Ringwald static uint8_t att_confirmation(gatt_client_t * gatt_client) { 3329228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 3336e7b444cSMatthias Ringwald 3346e7b444cSMatthias Ringwald request[0] = ATT_HANDLE_VALUE_CONFIRMATION; 3356e7b444cSMatthias Ringwald 3366e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 1); 3376e7b444cSMatthias Ringwald } 3386e7b444cSMatthias Ringwald 3396e7b444cSMatthias Ringwald // precondition: can_send_packet_now == TRUE 3406e7b444cSMatthias Ringwald static uint8_t att_find_information_request(gatt_client_t *gatt_client, uint8_t request_type, uint16_t start_handle, 3416e7b444cSMatthias Ringwald uint16_t end_handle) { 3429228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 3436e7b444cSMatthias Ringwald 3443deb3ec6SMatthias Ringwald request[0] = request_type; 345f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, start_handle); 346f8fbdce0SMatthias Ringwald little_endian_store_16(request, 3, end_handle); 3473deb3ec6SMatthias Ringwald 3486e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 5); 3493deb3ec6SMatthias Ringwald } 3503deb3ec6SMatthias Ringwald 3513deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 3526e7b444cSMatthias Ringwald static uint8_t 3536e7b444cSMatthias Ringwald att_find_by_type_value_request(gatt_client_t *gatt_client, uint8_t request_type, uint16_t attribute_group_type, 3546e7b444cSMatthias Ringwald uint16_t start_handle, uint16_t end_handle, uint8_t *value, uint16_t value_size) { 3559228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 3563deb3ec6SMatthias Ringwald request[0] = request_type; 3579228fd32SMatthias Ringwald 358f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, start_handle); 359f8fbdce0SMatthias Ringwald little_endian_store_16(request, 3, end_handle); 360f8fbdce0SMatthias Ringwald little_endian_store_16(request, 5, attribute_group_type); 3616535961aSMatthias Ringwald (void)memcpy(&request[7], value, value_size); 3623deb3ec6SMatthias Ringwald 3636e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 7u + value_size); 3643deb3ec6SMatthias Ringwald } 3653deb3ec6SMatthias Ringwald 3663deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 3676e7b444cSMatthias Ringwald static uint8_t 3686e7b444cSMatthias Ringwald att_read_by_type_or_group_request_for_uuid16(gatt_client_t *gatt_client, uint8_t request_type, uint16_t uuid16, 3696e7b444cSMatthias Ringwald uint16_t start_handle, uint16_t end_handle) { 3709228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 3716e7b444cSMatthias Ringwald 3723deb3ec6SMatthias Ringwald request[0] = request_type; 373f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, start_handle); 374f8fbdce0SMatthias Ringwald little_endian_store_16(request, 3, end_handle); 375f8fbdce0SMatthias Ringwald little_endian_store_16(request, 5, uuid16); 3763deb3ec6SMatthias Ringwald 3776e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 7); 3783deb3ec6SMatthias Ringwald } 3793deb3ec6SMatthias Ringwald 3803deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 3816e7b444cSMatthias Ringwald static uint8_t 3826e7b444cSMatthias Ringwald att_read_by_type_or_group_request_for_uuid128(gatt_client_t *gatt_client, uint8_t request_type, const uint8_t *uuid128, 3836e7b444cSMatthias Ringwald uint16_t start_handle, uint16_t end_handle) { 3849228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 3856e7b444cSMatthias Ringwald 3863deb3ec6SMatthias Ringwald request[0] = request_type; 387f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, start_handle); 388f8fbdce0SMatthias Ringwald little_endian_store_16(request, 3, end_handle); 3899c80e4ccSMatthias Ringwald reverse_128(uuid128, &request[5]); 3903deb3ec6SMatthias Ringwald 3916e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 21); 3923deb3ec6SMatthias Ringwald } 3933deb3ec6SMatthias Ringwald 3943deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 3956e7b444cSMatthias Ringwald static uint8_t att_read_request(gatt_client_t *gatt_client, uint8_t request_type, uint16_t attribute_handle) { 3969228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 3976e7b444cSMatthias Ringwald 3983deb3ec6SMatthias Ringwald request[0] = request_type; 399f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, attribute_handle); 4003deb3ec6SMatthias Ringwald 4016e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 3); 4023deb3ec6SMatthias Ringwald } 4033deb3ec6SMatthias Ringwald 4043deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 4056e7b444cSMatthias Ringwald static uint8_t att_read_blob_request(gatt_client_t *gatt_client, uint8_t request_type, uint16_t attribute_handle, 4066e7b444cSMatthias Ringwald uint16_t value_offset) { 4079228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 4089228fd32SMatthias Ringwald 4093deb3ec6SMatthias Ringwald request[0] = request_type; 410f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, attribute_handle); 411f8fbdce0SMatthias Ringwald little_endian_store_16(request, 3, value_offset); 4123deb3ec6SMatthias Ringwald 4136e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 5); 4143deb3ec6SMatthias Ringwald } 4153deb3ec6SMatthias Ringwald 4166e7b444cSMatthias Ringwald static uint8_t 417f125a8efSMatthias Ringwald att_read_multiple_request_with_opcode(gatt_client_t *gatt_client, uint16_t num_value_handles, uint16_t *value_handles, uint8_t opcode) { 4189228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 4199228fd32SMatthias Ringwald 420f125a8efSMatthias Ringwald request[0] = opcode; 4219228fd32SMatthias Ringwald uint16_t i; 4229228fd32SMatthias Ringwald uint16_t offset = 1; 4233deb3ec6SMatthias Ringwald for (i=0;i<num_value_handles;i++){ 424f8fbdce0SMatthias Ringwald little_endian_store_16(request, offset, value_handles[i]); 4253deb3ec6SMatthias Ringwald offset += 2; 4263deb3ec6SMatthias Ringwald } 42725b7c058SMilanka Ringwald 4286e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, offset); 4293deb3ec6SMatthias Ringwald } 4303deb3ec6SMatthias Ringwald 431f125a8efSMatthias Ringwald static uint8_t 432f125a8efSMatthias Ringwald att_read_multiple_request(gatt_client_t *gatt_client, uint16_t num_value_handles, uint16_t *value_handles) { 433f125a8efSMatthias Ringwald return att_read_multiple_request_with_opcode(gatt_client, num_value_handles, value_handles, ATT_READ_MULTIPLE_REQUEST); 434f125a8efSMatthias Ringwald } 435f125a8efSMatthias Ringwald 436f125a8efSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 437f125a8efSMatthias Ringwald static uint8_t 438f125a8efSMatthias Ringwald att_read_multiple_variable_request(gatt_client_t *gatt_client, uint16_t num_value_handles, uint16_t *value_handles) { 439f125a8efSMatthias Ringwald return att_read_multiple_request_with_opcode(gatt_client, num_value_handles, value_handles, ATT_READ_MULTIPLE_VARIABLE_REQ); 440f125a8efSMatthias Ringwald } 441f125a8efSMatthias Ringwald #endif 442f125a8efSMatthias Ringwald 4437a766ebfSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 4443deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 4456e7b444cSMatthias Ringwald static uint8_t att_signed_write_request(gatt_client_t *gatt_client, uint16_t request_type, uint16_t attribute_handle, 4466e7b444cSMatthias Ringwald uint16_t value_length, uint8_t *value, uint32_t sign_counter, uint8_t sgn[8]) { 4479228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 4489228fd32SMatthias Ringwald 4493deb3ec6SMatthias Ringwald request[0] = request_type; 450f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, attribute_handle); 4516535961aSMatthias Ringwald (void)memcpy(&request[3], value, value_length); 452f8fbdce0SMatthias Ringwald little_endian_store_32(request, 3 + value_length, sign_counter); 4539c80e4ccSMatthias Ringwald reverse_64(sgn, &request[3 + value_length + 4]); 45425b7c058SMilanka Ringwald 4556e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 3 + value_length + 12); 4563deb3ec6SMatthias Ringwald } 4577a766ebfSMatthias Ringwald #endif 4583deb3ec6SMatthias Ringwald 4593deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 4606e7b444cSMatthias Ringwald static uint8_t 4616e7b444cSMatthias Ringwald att_write_request(gatt_client_t *gatt_client, uint8_t request_type, uint16_t attribute_handle, uint16_t value_length, 4626e7b444cSMatthias Ringwald uint8_t *value) { 4639228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 4649228fd32SMatthias Ringwald 4653deb3ec6SMatthias Ringwald request[0] = request_type; 466f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, attribute_handle); 4676535961aSMatthias Ringwald (void)memcpy(&request[3], value, value_length); 4683deb3ec6SMatthias Ringwald 4696e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 3u + value_length); 4703deb3ec6SMatthias Ringwald } 4713deb3ec6SMatthias Ringwald 4723deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 4736e7b444cSMatthias Ringwald static uint8_t att_execute_write_request(gatt_client_t *gatt_client, uint8_t request_type, uint8_t execute_write) { 4749228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 4759228fd32SMatthias Ringwald 4763deb3ec6SMatthias Ringwald request[0] = request_type; 4773deb3ec6SMatthias Ringwald request[1] = execute_write; 47825b7c058SMilanka Ringwald 4796e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 2); 4803deb3ec6SMatthias Ringwald } 4813deb3ec6SMatthias Ringwald 4823deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 4836e7b444cSMatthias Ringwald static uint8_t att_prepare_write_request(gatt_client_t *gatt_client, uint8_t request_type, uint16_t attribute_handle, 4846e7b444cSMatthias Ringwald uint16_t value_offset, uint16_t blob_length, uint8_t *value) { 4859228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 4869228fd32SMatthias Ringwald 4873deb3ec6SMatthias Ringwald request[0] = request_type; 488f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, attribute_handle); 489f8fbdce0SMatthias Ringwald little_endian_store_16(request, 3, value_offset); 4906535961aSMatthias Ringwald (void)memcpy(&request[5], &value[value_offset], blob_length); 4913deb3ec6SMatthias Ringwald 4926e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 5u + blob_length); 4933deb3ec6SMatthias Ringwald } 4943deb3ec6SMatthias Ringwald 4956e7b444cSMatthias Ringwald static uint8_t att_exchange_mtu_request(gatt_client_t *gatt_client) { 4969228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 4979228fd32SMatthias Ringwald 4983deb3ec6SMatthias Ringwald request[0] = ATT_EXCHANGE_MTU_REQUEST; 4999228fd32SMatthias Ringwald uint16_t mtu = l2cap_max_le_mtu(); 500f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, mtu); 50125b7c058SMilanka Ringwald 5026e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 3); 5033deb3ec6SMatthias Ringwald } 5043deb3ec6SMatthias Ringwald 5055cf1669fSMatthias Ringwald static uint16_t write_blob_length(gatt_client_t * gatt_client){ 506dda77937SMatthias Ringwald uint16_t max_blob_length = gatt_client->mtu - 5u; 5075cf1669fSMatthias Ringwald if (gatt_client->attribute_offset >= gatt_client->attribute_length) { 5083deb3ec6SMatthias Ringwald return 0; 5093deb3ec6SMatthias Ringwald } 5105cf1669fSMatthias Ringwald uint16_t rest_length = gatt_client->attribute_length - gatt_client->attribute_offset; 5113deb3ec6SMatthias Ringwald if (max_blob_length > rest_length){ 5123deb3ec6SMatthias Ringwald return rest_length; 5133deb3ec6SMatthias Ringwald } 5143deb3ec6SMatthias Ringwald return max_blob_length; 5153deb3ec6SMatthias Ringwald } 5163deb3ec6SMatthias Ringwald 5175cf1669fSMatthias Ringwald static void send_gatt_services_request(gatt_client_t *gatt_client){ 5186e7b444cSMatthias Ringwald att_read_by_type_or_group_request_for_uuid16(gatt_client, ATT_READ_BY_GROUP_TYPE_REQUEST, 5196e7b444cSMatthias Ringwald gatt_client->uuid16, gatt_client->start_group_handle, 5206e7b444cSMatthias Ringwald gatt_client->end_group_handle); 5213deb3ec6SMatthias Ringwald } 5223deb3ec6SMatthias Ringwald 5235cf1669fSMatthias Ringwald static void send_gatt_by_uuid_request(gatt_client_t *gatt_client, uint16_t attribute_group_type){ 52452377058SMatthias Ringwald if (gatt_client->uuid16 != 0u){ 5253deb3ec6SMatthias Ringwald uint8_t uuid16[2]; 5265cf1669fSMatthias Ringwald little_endian_store_16(uuid16, 0, gatt_client->uuid16); 5276e7b444cSMatthias Ringwald att_find_by_type_value_request(gatt_client, ATT_FIND_BY_TYPE_VALUE_REQUEST, attribute_group_type, 5286e7b444cSMatthias Ringwald gatt_client->start_group_handle, gatt_client->end_group_handle, uuid16, 2); 5293deb3ec6SMatthias Ringwald return; 5303deb3ec6SMatthias Ringwald } 5313deb3ec6SMatthias Ringwald uint8_t uuid128[16]; 5325cf1669fSMatthias Ringwald reverse_128(gatt_client->uuid128, uuid128); 5336e7b444cSMatthias Ringwald att_find_by_type_value_request(gatt_client, ATT_FIND_BY_TYPE_VALUE_REQUEST, attribute_group_type, 5346e7b444cSMatthias Ringwald gatt_client->start_group_handle, gatt_client->end_group_handle, uuid128, 16); 5353deb3ec6SMatthias Ringwald } 5363deb3ec6SMatthias Ringwald 5375cf1669fSMatthias Ringwald static void send_gatt_services_by_uuid_request(gatt_client_t *gatt_client){ 5385cf1669fSMatthias Ringwald send_gatt_by_uuid_request(gatt_client, GATT_PRIMARY_SERVICE_UUID); 5393deb3ec6SMatthias Ringwald } 5403deb3ec6SMatthias Ringwald 5415cf1669fSMatthias Ringwald static void send_gatt_included_service_uuid_request(gatt_client_t *gatt_client){ 5426e7b444cSMatthias Ringwald att_read_request(gatt_client, ATT_READ_REQUEST, gatt_client->query_start_handle); 5433deb3ec6SMatthias Ringwald } 5443deb3ec6SMatthias Ringwald 5455cf1669fSMatthias Ringwald static void send_gatt_included_service_request(gatt_client_t *gatt_client){ 5466e7b444cSMatthias Ringwald att_read_by_type_or_group_request_for_uuid16(gatt_client, ATT_READ_BY_TYPE_REQUEST, 5476e7b444cSMatthias Ringwald GATT_INCLUDE_SERVICE_UUID, gatt_client->start_group_handle, 5486e7b444cSMatthias Ringwald gatt_client->end_group_handle); 5493deb3ec6SMatthias Ringwald } 5503deb3ec6SMatthias Ringwald 5515cf1669fSMatthias Ringwald static void send_gatt_characteristic_request(gatt_client_t *gatt_client){ 5526e7b444cSMatthias Ringwald att_read_by_type_or_group_request_for_uuid16(gatt_client, ATT_READ_BY_TYPE_REQUEST, 5536e7b444cSMatthias Ringwald GATT_CHARACTERISTICS_UUID, gatt_client->start_group_handle, 5546e7b444cSMatthias Ringwald gatt_client->end_group_handle); 5553deb3ec6SMatthias Ringwald } 5563deb3ec6SMatthias Ringwald 5575cf1669fSMatthias Ringwald static void send_gatt_characteristic_descriptor_request(gatt_client_t *gatt_client){ 5586e7b444cSMatthias Ringwald att_find_information_request(gatt_client, ATT_FIND_INFORMATION_REQUEST, gatt_client->start_group_handle, 5596e7b444cSMatthias Ringwald gatt_client->end_group_handle); 5603deb3ec6SMatthias Ringwald } 5613deb3ec6SMatthias Ringwald 5625cf1669fSMatthias Ringwald static void send_gatt_read_characteristic_value_request(gatt_client_t *gatt_client){ 5636e7b444cSMatthias Ringwald att_read_request(gatt_client, ATT_READ_REQUEST, gatt_client->attribute_handle); 5643deb3ec6SMatthias Ringwald } 5653deb3ec6SMatthias Ringwald 5665cf1669fSMatthias Ringwald static void send_gatt_read_by_type_request(gatt_client_t * gatt_client){ 56752377058SMatthias Ringwald if (gatt_client->uuid16 != 0u){ 5686e7b444cSMatthias Ringwald att_read_by_type_or_group_request_for_uuid16(gatt_client, ATT_READ_BY_TYPE_REQUEST, 5696e7b444cSMatthias Ringwald gatt_client->uuid16, gatt_client->start_group_handle, 5706e7b444cSMatthias Ringwald gatt_client->end_group_handle); 5713deb3ec6SMatthias Ringwald } else { 5726e7b444cSMatthias Ringwald att_read_by_type_or_group_request_for_uuid128(gatt_client, ATT_READ_BY_TYPE_REQUEST, 5736e7b444cSMatthias Ringwald gatt_client->uuid128, gatt_client->start_group_handle, 5746e7b444cSMatthias Ringwald gatt_client->end_group_handle); 5753deb3ec6SMatthias Ringwald } 5763deb3ec6SMatthias Ringwald } 5773deb3ec6SMatthias Ringwald 5785cf1669fSMatthias Ringwald static void send_gatt_read_blob_request(gatt_client_t *gatt_client){ 57930952227SMilanka Ringwald if (gatt_client->attribute_offset == 0){ 5806e7b444cSMatthias Ringwald att_read_request(gatt_client, ATT_READ_REQUEST, gatt_client->attribute_handle); 58130952227SMilanka Ringwald } else { 5826e7b444cSMatthias Ringwald att_read_blob_request(gatt_client, ATT_READ_BLOB_REQUEST, gatt_client->attribute_handle, 5836e7b444cSMatthias Ringwald gatt_client->attribute_offset); 5843deb3ec6SMatthias Ringwald } 58530952227SMilanka Ringwald } 5863deb3ec6SMatthias Ringwald 5875cf1669fSMatthias Ringwald static void send_gatt_read_multiple_request(gatt_client_t * gatt_client){ 5886e7b444cSMatthias Ringwald att_read_multiple_request(gatt_client, gatt_client->read_multiple_handle_count, gatt_client->read_multiple_handles); 5893deb3ec6SMatthias Ringwald } 5903deb3ec6SMatthias Ringwald 591f125a8efSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 592f125a8efSMatthias Ringwald static void send_gatt_read_multiple_variable_request(gatt_client_t * gatt_client){ 593f125a8efSMatthias Ringwald att_read_multiple_variable_request(gatt_client, gatt_client->read_multiple_handle_count, gatt_client->read_multiple_handles); 594f125a8efSMatthias Ringwald } 595f125a8efSMatthias Ringwald #endif 596f125a8efSMatthias Ringwald 5975cf1669fSMatthias Ringwald static void send_gatt_write_attribute_value_request(gatt_client_t * gatt_client){ 5986e7b444cSMatthias Ringwald att_write_request(gatt_client, ATT_WRITE_REQUEST, gatt_client->attribute_handle, gatt_client->attribute_length, 5996e7b444cSMatthias Ringwald gatt_client->attribute_value); 6003deb3ec6SMatthias Ringwald } 6013deb3ec6SMatthias Ringwald 6025cf1669fSMatthias Ringwald static void send_gatt_write_client_characteristic_configuration_request(gatt_client_t * gatt_client){ 6036e7b444cSMatthias Ringwald att_write_request(gatt_client, ATT_WRITE_REQUEST, gatt_client->client_characteristic_configuration_handle, 2, 6046e7b444cSMatthias Ringwald gatt_client->client_characteristic_configuration_value); 6053deb3ec6SMatthias Ringwald } 6063deb3ec6SMatthias Ringwald 6075cf1669fSMatthias Ringwald static void send_gatt_prepare_write_request(gatt_client_t * gatt_client){ 6086e7b444cSMatthias Ringwald att_prepare_write_request(gatt_client, ATT_PREPARE_WRITE_REQUEST, gatt_client->attribute_handle, 6096e7b444cSMatthias Ringwald gatt_client->attribute_offset, write_blob_length(gatt_client), 6106e7b444cSMatthias Ringwald gatt_client->attribute_value); 6113deb3ec6SMatthias Ringwald } 6123deb3ec6SMatthias Ringwald 6135cf1669fSMatthias Ringwald static void send_gatt_execute_write_request(gatt_client_t * gatt_client){ 6146e7b444cSMatthias Ringwald att_execute_write_request(gatt_client, ATT_EXECUTE_WRITE_REQUEST, 1); 6153deb3ec6SMatthias Ringwald } 6163deb3ec6SMatthias Ringwald 6175cf1669fSMatthias Ringwald static void send_gatt_cancel_prepared_write_request(gatt_client_t * gatt_client){ 6186e7b444cSMatthias Ringwald att_execute_write_request(gatt_client, ATT_EXECUTE_WRITE_REQUEST, 0); 6193deb3ec6SMatthias Ringwald } 6203deb3ec6SMatthias Ringwald 621abdc9fb5SMatthias Ringwald #ifndef ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY 6225cf1669fSMatthias Ringwald static void send_gatt_read_client_characteristic_configuration_request(gatt_client_t * gatt_client){ 6236e7b444cSMatthias Ringwald att_read_by_type_or_group_request_for_uuid16(gatt_client, ATT_READ_BY_TYPE_REQUEST, 6246e7b444cSMatthias Ringwald GATT_CLIENT_CHARACTERISTICS_CONFIGURATION, 6256e7b444cSMatthias Ringwald gatt_client->start_group_handle, gatt_client->end_group_handle); 6263deb3ec6SMatthias Ringwald } 627abdc9fb5SMatthias Ringwald #endif 6283deb3ec6SMatthias Ringwald 6295cf1669fSMatthias Ringwald static void send_gatt_read_characteristic_descriptor_request(gatt_client_t * gatt_client){ 6306e7b444cSMatthias Ringwald att_read_request(gatt_client, ATT_READ_REQUEST, gatt_client->attribute_handle); 6313deb3ec6SMatthias Ringwald } 6323deb3ec6SMatthias Ringwald 6337a766ebfSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 6345cf1669fSMatthias Ringwald static void send_gatt_signed_write_request(gatt_client_t * gatt_client, uint32_t sign_counter){ 6356e7b444cSMatthias Ringwald att_signed_write_request(gatt_client, ATT_SIGNED_WRITE_COMMAND, gatt_client->attribute_handle, 6366e7b444cSMatthias Ringwald gatt_client->attribute_length, gatt_client->attribute_value, sign_counter, 6376e7b444cSMatthias Ringwald gatt_client->cmac); 6383deb3ec6SMatthias Ringwald } 6397a766ebfSMatthias Ringwald #endif 6403deb3ec6SMatthias Ringwald 6413deb3ec6SMatthias Ringwald static uint16_t get_last_result_handle_from_service_list(uint8_t * packet, uint16_t size){ 64239ac9711SMatthias Ringwald if (size < 2) return 0xffff; 6433deb3ec6SMatthias Ringwald uint8_t attr_length = packet[1]; 64439ac9711SMatthias Ringwald if ((2 + attr_length) > size) return 0xffff; 6454ea43905SMatthias Ringwald return little_endian_read_16(packet, size - attr_length + 2u); 6463deb3ec6SMatthias Ringwald } 6473deb3ec6SMatthias Ringwald 6483deb3ec6SMatthias Ringwald static uint16_t get_last_result_handle_from_characteristics_list(uint8_t * packet, uint16_t size){ 64939ac9711SMatthias Ringwald if (size < 2) return 0xffff; 6503deb3ec6SMatthias Ringwald uint8_t attr_length = packet[1]; 65139ac9711SMatthias Ringwald if ((2 + attr_length) > size) return 0xffff; 6524ea43905SMatthias Ringwald return little_endian_read_16(packet, size - attr_length + 3u); 6533deb3ec6SMatthias Ringwald } 6543deb3ec6SMatthias Ringwald 6553deb3ec6SMatthias Ringwald static uint16_t get_last_result_handle_from_included_services_list(uint8_t * packet, uint16_t size){ 65639ac9711SMatthias Ringwald if (size < 2) return 0xffff; 6573deb3ec6SMatthias Ringwald uint8_t attr_length = packet[1]; 65839ac9711SMatthias Ringwald if ((2 + attr_length) > size) return 0xffff; 659f8fbdce0SMatthias Ringwald return little_endian_read_16(packet, size - attr_length); 6603deb3ec6SMatthias Ringwald } 6613deb3ec6SMatthias Ringwald 66253e9c18fSMatthias Ringwald static void gatt_client_notify_can_send_query(gatt_client_t * gatt_client){ 66319c614acSMatthias Ringwald 66419c614acSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 66519c614acSMatthias Ringwald // if eatt is ready, notify all clients that can send a query 66619c614acSMatthias Ringwald if (gatt_client->eatt_state == GATT_CLIENT_EATT_READY){ 66719c614acSMatthias Ringwald btstack_linked_list_iterator_t it; 66819c614acSMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client->eatt_clients); 66919c614acSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 67019c614acSMatthias Ringwald gatt_client_t * client = (gatt_client_t *) btstack_linked_list_iterator_next(&it); 671052dc82aSMatthias Ringwald if (client->state == P_READY){ 67219c614acSMatthias Ringwald // call callback 67319c614acSMatthias Ringwald btstack_context_callback_registration_t * callback = (btstack_context_callback_registration_t *) btstack_linked_list_pop(&gatt_client->query_requests); 67419c614acSMatthias Ringwald if (callback == NULL) { 67519c614acSMatthias Ringwald return; 67619c614acSMatthias Ringwald } 67719c614acSMatthias Ringwald (*callback->callback)(callback->context); 67819c614acSMatthias Ringwald } 67919c614acSMatthias Ringwald } 68019c614acSMatthias Ringwald return; 68119c614acSMatthias Ringwald } 68219c614acSMatthias Ringwald #endif 68319c614acSMatthias Ringwald 684052dc82aSMatthias Ringwald while (gatt_client->state == P_READY){ 68526166ecfSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 6867627a0deSMatthias Ringwald bool query_sent = gatt_client_le_enhanced_handle_can_send_query(gatt_client); 68726166ecfSMatthias Ringwald if (query_sent){ 68826166ecfSMatthias Ringwald continue; 68926166ecfSMatthias Ringwald } 69026166ecfSMatthias Ringwald #endif 69153e9c18fSMatthias Ringwald btstack_context_callback_registration_t * callback = (btstack_context_callback_registration_t *) btstack_linked_list_pop(&gatt_client->query_requests); 69209834412SMatthias Ringwald if (callback == NULL) { 69309834412SMatthias Ringwald return; 69453e9c18fSMatthias Ringwald } 69509834412SMatthias Ringwald (*callback->callback)(callback->context); 69653e9c18fSMatthias Ringwald } 69753e9c18fSMatthias Ringwald } 69853e9c18fSMatthias Ringwald 69923d583b8SMatthias Ringwald // test if notification/indication should be delivered to application (BLESA) 70023d583b8SMatthias Ringwald static bool gatt_client_accept_server_message(gatt_client_t *gatt_client) { 70123d583b8SMatthias Ringwald // ignore messages until re-encryption is complete 70223d583b8SMatthias Ringwald if (gap_reconnect_security_setup_active(gatt_client->con_handle)) return false; 70323d583b8SMatthias Ringwald 70423d583b8SMatthias Ringwald // after that ignore if bonded but not encrypted 70523d583b8SMatthias Ringwald return !gap_bonded(gatt_client->con_handle) || (gap_encryption_key_size(gatt_client->con_handle) > 0); 70623d583b8SMatthias Ringwald } 70723d583b8SMatthias Ringwald 7089c662c9bSMatthias Ringwald static void emit_event_new(btstack_packet_handler_t callback, uint8_t * packet, uint16_t size){ 7099c662c9bSMatthias Ringwald if (!callback) return; 71092da54c4SMatthias Ringwald hci_dump_packet(HCI_EVENT_PACKET, 1, packet, size); 7119c662c9bSMatthias Ringwald (*callback)(HCI_EVENT_PACKET, 0, packet, size); 7123deb3ec6SMatthias Ringwald } 7133deb3ec6SMatthias Ringwald 714711e6c80SMatthias Ringwald static void emit_event_to_registered_listeners(hci_con_handle_t con_handle, uint16_t attribute_handle, uint8_t * packet, uint16_t size){ 715665d90f2SMatthias Ringwald btstack_linked_list_iterator_t it; 7169c662c9bSMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client_value_listeners); 717665d90f2SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 71886c38559SMatthias Ringwald gatt_client_notification_t * notification = (gatt_client_notification_t*) btstack_linked_list_iterator_next(&it); 719b3f03c84SMatthias Ringwald if ((notification->con_handle != GATT_CLIENT_ANY_CONNECTION) && (notification->con_handle != con_handle)) continue; 720b3f03c84SMatthias Ringwald if ((notification->attribute_handle != GATT_CLIENT_ANY_VALUE_HANDLE) && (notification->attribute_handle != attribute_handle)) continue; 72186c38559SMatthias Ringwald (*notification->callback)(HCI_EVENT_PACKET, 0, packet, size); 7223deb3ec6SMatthias Ringwald } 7233deb3ec6SMatthias Ringwald } 7243deb3ec6SMatthias Ringwald 7255cf1669fSMatthias Ringwald static void emit_gatt_complete_event(gatt_client_t * gatt_client, uint8_t att_status){ 7263deb3ec6SMatthias Ringwald // @format H1 7273deb3ec6SMatthias Ringwald uint8_t packet[5]; 7285611a760SMatthias Ringwald packet[0] = GATT_EVENT_QUERY_COMPLETE; 7293deb3ec6SMatthias Ringwald packet[1] = 3; 7305cf1669fSMatthias Ringwald little_endian_store_16(packet, 2, gatt_client->con_handle); 7317d2258b3SMilanka Ringwald packet[4] = att_status; 7325cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, sizeof(packet)); 7333deb3ec6SMatthias Ringwald } 7343deb3ec6SMatthias Ringwald 735045d700dSDavid 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){ 7363deb3ec6SMatthias Ringwald // @format HX 7373deb3ec6SMatthias Ringwald uint8_t packet[24]; 7385611a760SMatthias Ringwald packet[0] = GATT_EVENT_SERVICE_QUERY_RESULT; 7394ea43905SMatthias Ringwald packet[1] = sizeof(packet) - 2u; 7405cf1669fSMatthias Ringwald little_endian_store_16(packet, 2, gatt_client->con_handle); 7413deb3ec6SMatthias Ringwald /// 742f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 4, start_group_handle); 743f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 6, end_group_handle); 7449c80e4ccSMatthias Ringwald reverse_128(uuid128, &packet[8]); 7455cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, sizeof(packet)); 7463deb3ec6SMatthias Ringwald } 7473deb3ec6SMatthias Ringwald 748045d700dSDavid 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){ 7493deb3ec6SMatthias Ringwald // @format HX 7503deb3ec6SMatthias Ringwald uint8_t packet[26]; 7515611a760SMatthias Ringwald packet[0] = GATT_EVENT_INCLUDED_SERVICE_QUERY_RESULT; 7524ea43905SMatthias Ringwald packet[1] = sizeof(packet) - 2u; 7535cf1669fSMatthias Ringwald little_endian_store_16(packet, 2, gatt_client->con_handle); 7543deb3ec6SMatthias Ringwald /// 755f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 4, include_handle); 7563deb3ec6SMatthias Ringwald // 757f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 6, start_group_handle); 758f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 8, end_group_handle); 7599c80e4ccSMatthias Ringwald reverse_128(uuid128, &packet[10]); 7605cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, sizeof(packet)); 7613deb3ec6SMatthias Ringwald } 7623deb3ec6SMatthias Ringwald 7635cf1669fSMatthias 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, 764045d700dSDavid Lechner uint16_t properties, const uint8_t * uuid128){ 7653deb3ec6SMatthias Ringwald // @format HY 7663deb3ec6SMatthias Ringwald uint8_t packet[28]; 7675611a760SMatthias Ringwald packet[0] = GATT_EVENT_CHARACTERISTIC_QUERY_RESULT; 7684ea43905SMatthias Ringwald packet[1] = sizeof(packet) - 2u; 7695cf1669fSMatthias Ringwald little_endian_store_16(packet, 2, gatt_client->con_handle); 7703deb3ec6SMatthias Ringwald /// 771f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 4, start_handle); 772f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 6, value_handle); 773f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 8, end_handle); 774f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 10, properties); 7759c80e4ccSMatthias Ringwald reverse_128(uuid128, &packet[12]); 7765cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, sizeof(packet)); 7773deb3ec6SMatthias Ringwald } 7783deb3ec6SMatthias Ringwald 7793deb3ec6SMatthias Ringwald static void emit_gatt_all_characteristic_descriptors_result_event( 780045d700dSDavid Lechner gatt_client_t * gatt_client, uint16_t descriptor_handle, const uint8_t * uuid128){ 7813deb3ec6SMatthias Ringwald // @format HZ 7823deb3ec6SMatthias Ringwald uint8_t packet[22]; 7835611a760SMatthias Ringwald packet[0] = GATT_EVENT_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY_RESULT; 7844ea43905SMatthias Ringwald packet[1] = sizeof(packet) - 2u; 7855cf1669fSMatthias Ringwald little_endian_store_16(packet, 2, gatt_client->con_handle); 7863deb3ec6SMatthias Ringwald /// 787f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 4, descriptor_handle); 7889c80e4ccSMatthias Ringwald reverse_128(uuid128, &packet[6]); 7895cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, sizeof(packet)); 7903deb3ec6SMatthias Ringwald } 7913deb3ec6SMatthias Ringwald 7925cf1669fSMatthias Ringwald static void emit_gatt_mtu_exchanged_result_event(gatt_client_t * gatt_client, uint16_t new_mtu){ 7938f37572aSJakob Krantz // @format H2 7948f37572aSJakob Krantz uint8_t packet[6]; 7958f37572aSJakob Krantz packet[0] = GATT_EVENT_MTU; 7964ea43905SMatthias Ringwald packet[1] = sizeof(packet) - 2u; 7975cf1669fSMatthias Ringwald little_endian_store_16(packet, 2, gatt_client->con_handle); 7988f37572aSJakob Krantz little_endian_store_16(packet, 4, new_mtu); 7995cf1669fSMatthias Ringwald att_dispatch_client_mtu_exchanged(gatt_client->con_handle, new_mtu); 8005cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, sizeof(packet)); 8018f37572aSJakob Krantz } 80223d583b8SMatthias Ringwald 80323d583b8SMatthias Ringwald // helper 80423d583b8SMatthias Ringwald static void gatt_client_handle_transaction_complete(gatt_client_t *gatt_client, uint8_t att_status) { 805052dc82aSMatthias Ringwald gatt_client->state = P_READY; 80623d583b8SMatthias Ringwald gatt_client_timeout_stop(gatt_client); 80723d583b8SMatthias Ringwald emit_gatt_complete_event(gatt_client, att_status); 80823d583b8SMatthias Ringwald gatt_client_notify_can_send_query(gatt_client); 80923d583b8SMatthias Ringwald } 81023d583b8SMatthias Ringwald 81123d583b8SMatthias Ringwald // @return packet pointer 81223d583b8SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite HCI + L2CAP packet headers 81323d583b8SMatthias Ringwald #define CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE 8 81423d583b8SMatthias Ringwald static uint8_t * setup_characteristic_value_packet(uint8_t type, hci_con_handle_t con_handle, uint16_t attribute_handle, uint8_t * value, uint16_t length){ 81523d583b8SMatthias Ringwald #ifdef FUZZING_BUILD_MODE_UNSAFE_FOR_PRODUCTION 81623d583b8SMatthias Ringwald // copy value into test packet for testing 81723d583b8SMatthias Ringwald static uint8_t packet[1000]; 81823d583b8SMatthias Ringwald memcpy(&packet[8], value, length); 81923d583b8SMatthias Ringwald #else 82023d583b8SMatthias Ringwald // before the value inside the ATT PDU 82123d583b8SMatthias Ringwald uint8_t * packet = value - CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE; 82223d583b8SMatthias Ringwald #endif 82323d583b8SMatthias Ringwald packet[0] = type; 82423d583b8SMatthias Ringwald packet[1] = CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE - 2 + length; 82523d583b8SMatthias Ringwald little_endian_store_16(packet, 2, con_handle); 82623d583b8SMatthias Ringwald little_endian_store_16(packet, 4, attribute_handle); 82723d583b8SMatthias Ringwald little_endian_store_16(packet, 6, length); 82823d583b8SMatthias Ringwald return packet; 82923d583b8SMatthias Ringwald } 83023d583b8SMatthias Ringwald 83123d583b8SMatthias Ringwald // @return packet pointer 83223d583b8SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite parts of the HCI/L2CAP/ATT packet (4/4/3) bytes 83323d583b8SMatthias Ringwald #define LONG_CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE 10 83423d583b8SMatthias Ringwald static uint8_t * setup_long_characteristic_value_packet(uint8_t type, hci_con_handle_t con_handle, uint16_t attribute_handle, uint16_t offset, uint8_t * value, uint16_t length){ 83523d583b8SMatthias Ringwald #ifdef FUZZING_BUILD_MODE_UNSAFE_FOR_PRODUCTION 83623d583b8SMatthias Ringwald // avoid using pre ATT headers. 83723d583b8SMatthias Ringwald return NULL; 83823d583b8SMatthias Ringwald #endif 83923d583b8SMatthias Ringwald #if defined(HCI_INCOMING_PRE_BUFFER_SIZE) && (HCI_INCOMING_PRE_BUFFER_SIZE >= LONG_CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE - 8) // L2CAP Header (4) - ACL Header (4) 84023d583b8SMatthias Ringwald // before the value inside the ATT PDU 84123d583b8SMatthias Ringwald uint8_t * packet = value - LONG_CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE; 84223d583b8SMatthias Ringwald packet[0] = type; 84323d583b8SMatthias Ringwald packet[1] = LONG_CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE - 2 + length; 84423d583b8SMatthias Ringwald little_endian_store_16(packet, 2, con_handle); 84523d583b8SMatthias Ringwald little_endian_store_16(packet, 4, attribute_handle); 84623d583b8SMatthias Ringwald little_endian_store_16(packet, 6, offset); 84723d583b8SMatthias Ringwald little_endian_store_16(packet, 8, length); 84823d583b8SMatthias Ringwald return packet; 84923d583b8SMatthias Ringwald #else 85023d583b8SMatthias Ringwald log_error("HCI_INCOMING_PRE_BUFFER_SIZE >= 2 required for long characteristic reads"); 85123d583b8SMatthias Ringwald return NULL; 85223d583b8SMatthias Ringwald #endif 85323d583b8SMatthias Ringwald } 85423d583b8SMatthias Ringwald 855f7a42e72SMatthias Ringwald #if (LONG_CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE > CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE) 856f7a42e72SMatthias Ringwald #define REPORT_PREBUFFER_HEADER LONG_CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE 857f7a42e72SMatthias Ringwald #else 858f7a42e72SMatthias Ringwald #define REPORT_PREBUFFER_HEADER CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE 859f7a42e72SMatthias Ringwald #endif 860f7a42e72SMatthias Ringwald 8618f37572aSJakob Krantz /// 8625cf1669fSMatthias Ringwald static void report_gatt_services(gatt_client_t * gatt_client, uint8_t * packet, uint16_t size){ 86339ac9711SMatthias Ringwald if (size < 2) return; 8643deb3ec6SMatthias Ringwald uint8_t attr_length = packet[1]; 8654ea43905SMatthias Ringwald uint8_t uuid_length = attr_length - 4u; 8663deb3ec6SMatthias Ringwald 8673deb3ec6SMatthias Ringwald int i; 86839ac9711SMatthias Ringwald for (i = 2; (i+attr_length) <= size; i += attr_length){ 869f8fbdce0SMatthias Ringwald uint16_t start_group_handle = little_endian_read_16(packet,i); 870f8fbdce0SMatthias Ringwald uint16_t end_group_handle = little_endian_read_16(packet,i+2); 8713deb3ec6SMatthias Ringwald uint8_t uuid128[16]; 8723deb3ec6SMatthias Ringwald uint16_t uuid16 = 0; 8733deb3ec6SMatthias Ringwald 8744ea43905SMatthias Ringwald if (uuid_length == 2u){ 875f8fbdce0SMatthias Ringwald uuid16 = little_endian_read_16(packet, i+4); 876e1a125dfSMatthias Ringwald uuid_add_bluetooth_prefix((uint8_t*) &uuid128, uuid16); 87739ac9711SMatthias Ringwald } else if (uuid_length == 16u) { 8789c80e4ccSMatthias Ringwald reverse_128(&packet[i+4], uuid128); 87939ac9711SMatthias Ringwald } else { 88039ac9711SMatthias Ringwald return; 8813deb3ec6SMatthias Ringwald } 8825cf1669fSMatthias Ringwald emit_gatt_service_query_result_event(gatt_client, start_group_handle, end_group_handle, uuid128); 8833deb3ec6SMatthias Ringwald } 8843deb3ec6SMatthias Ringwald } 8853deb3ec6SMatthias Ringwald 88623d583b8SMatthias 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){ 8873deb3ec6SMatthias Ringwald uint8_t uuid128[16]; 8883deb3ec6SMatthias Ringwald uint16_t uuid16 = 0; 8894ea43905SMatthias Ringwald if (uuid_length == 2u){ 890f8fbdce0SMatthias Ringwald uuid16 = little_endian_read_16(uuid, 0); 891e1a125dfSMatthias Ringwald uuid_add_bluetooth_prefix((uint8_t*) uuid128, uuid16); 8924ea43905SMatthias Ringwald } else if (uuid_length == 16u){ 8939c80e4ccSMatthias Ringwald reverse_128(uuid, uuid128); 894d73c9dbeSMilanka Ringwald } else { 895d73c9dbeSMilanka Ringwald return; 8963deb3ec6SMatthias Ringwald } 8973deb3ec6SMatthias Ringwald 8985cf1669fSMatthias Ringwald if (gatt_client->filter_with_uuid && (memcmp(gatt_client->uuid128, uuid128, 16) != 0)) return; 8993deb3ec6SMatthias Ringwald 9005cf1669fSMatthias Ringwald gatt_client->characteristic_properties = properties; 9015cf1669fSMatthias Ringwald gatt_client->characteristic_start_handle = start_handle; 9025cf1669fSMatthias Ringwald gatt_client->attribute_handle = value_handle; 9033deb3ec6SMatthias Ringwald 9045cf1669fSMatthias Ringwald if (gatt_client->filter_with_uuid) return; 9053deb3ec6SMatthias Ringwald 9065cf1669fSMatthias Ringwald gatt_client->uuid16 = uuid16; 9075cf1669fSMatthias Ringwald (void)memcpy(gatt_client->uuid128, uuid128, 16); 9083deb3ec6SMatthias Ringwald } 9093deb3ec6SMatthias Ringwald 91023d583b8SMatthias Ringwald static void report_gatt_characteristic_end_found(gatt_client_t * gatt_client, uint16_t end_handle){ 9113deb3ec6SMatthias Ringwald // TODO: stop searching if filter and uuid found 9123deb3ec6SMatthias Ringwald 9135cf1669fSMatthias Ringwald if (!gatt_client->characteristic_start_handle) return; 9143deb3ec6SMatthias Ringwald 9155cf1669fSMatthias Ringwald emit_gatt_characteristic_query_result_event(gatt_client, gatt_client->characteristic_start_handle, gatt_client->attribute_handle, 9165cf1669fSMatthias Ringwald end_handle, gatt_client->characteristic_properties, gatt_client->uuid128); 9173deb3ec6SMatthias Ringwald 9185cf1669fSMatthias Ringwald gatt_client->characteristic_start_handle = 0; 9193deb3ec6SMatthias Ringwald } 9203deb3ec6SMatthias Ringwald 92123d583b8SMatthias Ringwald 9225cf1669fSMatthias Ringwald static void report_gatt_characteristics(gatt_client_t * gatt_client, uint8_t * packet, uint16_t size){ 9234ea43905SMatthias Ringwald if (size < 2u) return; 9243deb3ec6SMatthias Ringwald uint8_t attr_length = packet[1]; 9254ea43905SMatthias Ringwald if ((attr_length != 7u) && (attr_length != 21u)) return; 9264ea43905SMatthias Ringwald uint8_t uuid_length = attr_length - 5u; 9273deb3ec6SMatthias Ringwald int i; 9284ea43905SMatthias Ringwald for (i = 2u; (i + attr_length) <= size; i += attr_length){ 929f8fbdce0SMatthias Ringwald uint16_t start_handle = little_endian_read_16(packet, i); 9303deb3ec6SMatthias Ringwald uint8_t properties = packet[i+2]; 931f8fbdce0SMatthias Ringwald uint16_t value_handle = little_endian_read_16(packet, i+3); 93223d583b8SMatthias Ringwald report_gatt_characteristic_end_found(gatt_client, start_handle - 1u); 93323d583b8SMatthias Ringwald report_gatt_characteristic_start_found(gatt_client, start_handle, properties, value_handle, &packet[i + 5], 93423d583b8SMatthias Ringwald uuid_length); 9353deb3ec6SMatthias Ringwald } 9363deb3ec6SMatthias Ringwald } 9373deb3ec6SMatthias Ringwald 9385cf1669fSMatthias Ringwald static void report_gatt_included_service_uuid16(gatt_client_t * gatt_client, uint16_t include_handle, uint16_t uuid16){ 9393deb3ec6SMatthias Ringwald uint8_t normalized_uuid128[16]; 940e1a125dfSMatthias Ringwald uuid_add_bluetooth_prefix(normalized_uuid128, uuid16); 9415cf1669fSMatthias Ringwald emit_gatt_included_service_query_result_event(gatt_client, include_handle, gatt_client->query_start_handle, 9425cf1669fSMatthias Ringwald gatt_client->query_end_handle, normalized_uuid128); 9433deb3ec6SMatthias Ringwald } 9443deb3ec6SMatthias Ringwald 945045d700dSDavid Lechner static void report_gatt_included_service_uuid128(gatt_client_t * gatt_client, uint16_t include_handle, const uint8_t * uuid128){ 9465cf1669fSMatthias Ringwald emit_gatt_included_service_query_result_event(gatt_client, include_handle, gatt_client->query_start_handle, 9475cf1669fSMatthias Ringwald gatt_client->query_end_handle, uuid128); 9483deb3ec6SMatthias Ringwald } 9493deb3ec6SMatthias Ringwald 9503deb3ec6SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite parts of the HCI/L2CAP/ATT packet (4/4/3) bytes 9510fde3c5eSMatthias Ringwald static void report_gatt_notification(gatt_client_t *gatt_client, uint16_t value_handle, uint8_t *value, int length) { 9520fde3c5eSMatthias Ringwald if (!gatt_client_accept_server_message(gatt_client)) return; 9530fde3c5eSMatthias Ringwald uint8_t * packet = setup_characteristic_value_packet(GATT_EVENT_NOTIFICATION, gatt_client->con_handle, value_handle, value, length); 95423d583b8SMatthias Ringwald emit_event_to_registered_listeners(gatt_client->con_handle, value_handle, packet, CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE + length); 9553deb3ec6SMatthias Ringwald } 9563deb3ec6SMatthias Ringwald 9573deb3ec6SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite parts of the HCI/L2CAP/ATT packet (4/4/3) bytes 9580fde3c5eSMatthias Ringwald static void report_gatt_indication(gatt_client_t *gatt_client, uint16_t value_handle, uint8_t *value, int length) { 9590fde3c5eSMatthias Ringwald if (!gatt_client_accept_server_message(gatt_client)) return; 9600fde3c5eSMatthias Ringwald uint8_t * packet = setup_characteristic_value_packet(GATT_EVENT_INDICATION, gatt_client->con_handle, value_handle, value, length); 96123d583b8SMatthias Ringwald emit_event_to_registered_listeners(gatt_client->con_handle, value_handle, packet, CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE + length); 9623deb3ec6SMatthias Ringwald } 9633deb3ec6SMatthias Ringwald 9643deb3ec6SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite parts of the HCI/L2CAP/ATT packet (4/4/3) bytes 9655cf1669fSMatthias Ringwald static void report_gatt_characteristic_value(gatt_client_t * gatt_client, uint16_t attribute_handle, uint8_t * value, uint16_t length){ 9665cf1669fSMatthias Ringwald uint8_t * packet = setup_characteristic_value_packet(GATT_EVENT_CHARACTERISTIC_VALUE_QUERY_RESULT, gatt_client->con_handle, attribute_handle, value, length); 96723d583b8SMatthias Ringwald emit_event_new(gatt_client->callback, packet, CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE + length); 9683deb3ec6SMatthias Ringwald } 9693deb3ec6SMatthias Ringwald 9703deb3ec6SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite parts of the HCI/L2CAP/ATT packet (4/4/3) bytes 9715cf1669fSMatthias 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){ 9725cf1669fSMatthias Ringwald uint8_t * packet = setup_long_characteristic_value_packet(GATT_EVENT_LONG_CHARACTERISTIC_VALUE_QUERY_RESULT, gatt_client->con_handle, attribute_handle, value_offset, blob, blob_length); 9733deb3ec6SMatthias Ringwald if (!packet) return; 97423d583b8SMatthias Ringwald emit_event_new(gatt_client->callback, packet, blob_length + LONG_CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE); 9753deb3ec6SMatthias Ringwald } 9763deb3ec6SMatthias Ringwald 9775cf1669fSMatthias 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){ 9789ec2630cSMatthias Ringwald UNUSED(value_offset); 9795cf1669fSMatthias Ringwald uint8_t * packet = setup_characteristic_value_packet(GATT_EVENT_CHARACTERISTIC_DESCRIPTOR_QUERY_RESULT, gatt_client->con_handle, descriptor_handle, value, value_length); 9805cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, value_length + 8u); 9813deb3ec6SMatthias Ringwald } 9823deb3ec6SMatthias Ringwald 9835cf1669fSMatthias 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){ 9845cf1669fSMatthias Ringwald uint8_t * packet = setup_long_characteristic_value_packet(GATT_EVENT_LONG_CHARACTERISTIC_DESCRIPTOR_QUERY_RESULT, gatt_client->con_handle, descriptor_handle, value_offset, blob, blob_length); 9853deb3ec6SMatthias Ringwald if (!packet) return; 98623d583b8SMatthias Ringwald emit_event_new(gatt_client->callback, packet, blob_length + LONG_CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE); 9873deb3ec6SMatthias Ringwald } 9883deb3ec6SMatthias Ringwald 9895cf1669fSMatthias Ringwald static void report_gatt_all_characteristic_descriptors(gatt_client_t * gatt_client, uint8_t * packet, uint16_t size, uint16_t pair_size){ 9903deb3ec6SMatthias Ringwald int i; 9914ea43905SMatthias Ringwald for (i = 0u; (i + pair_size) <= size; i += pair_size){ 992f8fbdce0SMatthias Ringwald uint16_t descriptor_handle = little_endian_read_16(packet,i); 9933deb3ec6SMatthias Ringwald uint8_t uuid128[16]; 9943deb3ec6SMatthias Ringwald uint16_t uuid16 = 0; 9954ea43905SMatthias Ringwald if (pair_size == 4u){ 996f8fbdce0SMatthias Ringwald uuid16 = little_endian_read_16(packet,i+2); 997e1a125dfSMatthias Ringwald uuid_add_bluetooth_prefix(uuid128, uuid16); 9983deb3ec6SMatthias Ringwald } else { 9999c80e4ccSMatthias Ringwald reverse_128(&packet[i+2], uuid128); 10003deb3ec6SMatthias Ringwald } 10015cf1669fSMatthias Ringwald emit_gatt_all_characteristic_descriptors_result_event(gatt_client, descriptor_handle, uuid128); 10023deb3ec6SMatthias Ringwald } 10033deb3ec6SMatthias Ringwald 10043deb3ec6SMatthias Ringwald } 10053deb3ec6SMatthias Ringwald 100652377058SMatthias Ringwald static bool is_query_done(gatt_client_t * gatt_client, uint16_t last_result_handle){ 10075cf1669fSMatthias Ringwald return last_result_handle >= gatt_client->end_group_handle; 10083deb3ec6SMatthias Ringwald } 10093deb3ec6SMatthias Ringwald 10105cf1669fSMatthias Ringwald static void trigger_next_query(gatt_client_t * gatt_client, uint16_t last_result_handle, gatt_client_state_t next_query_state){ 10115cf1669fSMatthias Ringwald if (is_query_done(gatt_client, last_result_handle)){ 1012526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 10133deb3ec6SMatthias Ringwald return; 10143deb3ec6SMatthias Ringwald } 10153deb3ec6SMatthias Ringwald // next 10165cf1669fSMatthias Ringwald gatt_client->start_group_handle = last_result_handle + 1u; 1017052dc82aSMatthias Ringwald gatt_client->state = next_query_state; 10183deb3ec6SMatthias Ringwald } 10193deb3ec6SMatthias Ringwald 10205cf1669fSMatthias Ringwald static void trigger_next_included_service_query(gatt_client_t * gatt_client, uint16_t last_result_handle){ 10215cf1669fSMatthias Ringwald trigger_next_query(gatt_client, last_result_handle, P_W2_SEND_INCLUDED_SERVICE_QUERY); 10223deb3ec6SMatthias Ringwald } 10233deb3ec6SMatthias Ringwald 10245cf1669fSMatthias Ringwald static void trigger_next_service_query(gatt_client_t * gatt_client, uint16_t last_result_handle){ 10255cf1669fSMatthias Ringwald trigger_next_query(gatt_client, last_result_handle, P_W2_SEND_SERVICE_QUERY); 10263deb3ec6SMatthias Ringwald } 10273deb3ec6SMatthias Ringwald 10285cf1669fSMatthias Ringwald static void trigger_next_service_by_uuid_query(gatt_client_t * gatt_client, uint16_t last_result_handle){ 10295cf1669fSMatthias Ringwald trigger_next_query(gatt_client, last_result_handle, P_W2_SEND_SERVICE_WITH_UUID_QUERY); 10303deb3ec6SMatthias Ringwald } 10313deb3ec6SMatthias Ringwald 10325cf1669fSMatthias Ringwald static void trigger_next_characteristic_query(gatt_client_t * gatt_client, uint16_t last_result_handle){ 10335cf1669fSMatthias Ringwald if (is_query_done(gatt_client, last_result_handle)){ 10343deb3ec6SMatthias Ringwald // report last characteristic 103523d583b8SMatthias Ringwald report_gatt_characteristic_end_found(gatt_client, gatt_client->end_group_handle); 10363deb3ec6SMatthias Ringwald } 10375cf1669fSMatthias Ringwald trigger_next_query(gatt_client, last_result_handle, P_W2_SEND_ALL_CHARACTERISTICS_OF_SERVICE_QUERY); 10383deb3ec6SMatthias Ringwald } 10393deb3ec6SMatthias Ringwald 10405cf1669fSMatthias Ringwald static void trigger_next_characteristic_descriptor_query(gatt_client_t * gatt_client, uint16_t last_result_handle){ 10415cf1669fSMatthias Ringwald trigger_next_query(gatt_client, last_result_handle, P_W2_SEND_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY); 10423deb3ec6SMatthias Ringwald } 10433deb3ec6SMatthias Ringwald 10445cf1669fSMatthias Ringwald static void trigger_next_read_by_type_query(gatt_client_t * gatt_client, uint16_t last_result_handle){ 10455cf1669fSMatthias Ringwald trigger_next_query(gatt_client, last_result_handle, P_W2_SEND_READ_BY_TYPE_REQUEST); 10463deb3ec6SMatthias Ringwald } 10473deb3ec6SMatthias Ringwald 10485cf1669fSMatthias 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){ 10495cf1669fSMatthias Ringwald gatt_client->attribute_offset += write_blob_length(gatt_client); 10505cf1669fSMatthias Ringwald uint16_t next_blob_length = write_blob_length(gatt_client); 10513deb3ec6SMatthias Ringwald 10524ea43905SMatthias Ringwald if (next_blob_length == 0u){ 1053052dc82aSMatthias Ringwald gatt_client->state = done_state; 10543deb3ec6SMatthias Ringwald return; 10553deb3ec6SMatthias Ringwald } 1056052dc82aSMatthias Ringwald gatt_client->state = next_query_state; 10573deb3ec6SMatthias Ringwald } 10583deb3ec6SMatthias Ringwald 10595cf1669fSMatthias Ringwald static void trigger_next_blob_query(gatt_client_t * gatt_client, gatt_client_state_t next_query_state, uint16_t received_blob_length){ 10603deb3ec6SMatthias Ringwald 1061dda77937SMatthias Ringwald uint16_t max_blob_length = gatt_client->mtu - 1u; 10623deb3ec6SMatthias Ringwald if (received_blob_length < max_blob_length){ 1063526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 10643deb3ec6SMatthias Ringwald return; 10653deb3ec6SMatthias Ringwald } 10663deb3ec6SMatthias Ringwald 10675cf1669fSMatthias Ringwald gatt_client->attribute_offset += received_blob_length; 1068052dc82aSMatthias Ringwald gatt_client->state = next_query_state; 10693deb3ec6SMatthias Ringwald } 10703deb3ec6SMatthias Ringwald 107123d583b8SMatthias 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){ 107223d583b8SMatthias Ringwald notification->callback = callback; 107323d583b8SMatthias Ringwald notification->con_handle = con_handle; 107423d583b8SMatthias Ringwald if (characteristic == NULL){ 107523d583b8SMatthias Ringwald notification->attribute_handle = GATT_CLIENT_ANY_VALUE_HANDLE; 107623d583b8SMatthias Ringwald } else { 107723d583b8SMatthias Ringwald notification->attribute_handle = characteristic->value_handle; 107823d583b8SMatthias Ringwald } 107923d583b8SMatthias Ringwald btstack_linked_list_add(&gatt_client_value_listeners, (btstack_linked_item_t*) notification); 108023d583b8SMatthias Ringwald } 108123d583b8SMatthias Ringwald 108223d583b8SMatthias Ringwald void gatt_client_stop_listening_for_characteristic_value_updates(gatt_client_notification_t * notification){ 108323d583b8SMatthias Ringwald btstack_linked_list_remove(&gatt_client_value_listeners, (btstack_linked_item_t*) notification); 108423d583b8SMatthias Ringwald } 10853deb3ec6SMatthias Ringwald 108662f7b41dSMatthias Ringwald static bool is_value_valid(gatt_client_t *gatt_client, uint8_t *packet, uint16_t size){ 1087f8fbdce0SMatthias Ringwald uint16_t attribute_handle = little_endian_read_16(packet, 1); 1088f8fbdce0SMatthias Ringwald uint16_t value_offset = little_endian_read_16(packet, 3); 10893deb3ec6SMatthias Ringwald 109062f7b41dSMatthias Ringwald if (gatt_client->attribute_handle != attribute_handle) return false; 109162f7b41dSMatthias Ringwald if (gatt_client->attribute_offset != value_offset) return false; 10925cf1669fSMatthias Ringwald return memcmp(&gatt_client->attribute_value[gatt_client->attribute_offset], &packet[5], size - 5u) == 0u; 10933deb3ec6SMatthias Ringwald } 10943deb3ec6SMatthias Ringwald 10950038504eSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 109692a7335eSMatthias Ringwald static void gatt_client_run_for_client_start_signed_write(gatt_client_t *gatt_client) { 109792a7335eSMatthias Ringwald sm_key_t csrk; 109892a7335eSMatthias Ringwald le_device_db_local_csrk_get(gatt_client->le_device_index, csrk); 109992a7335eSMatthias Ringwald uint32_t sign_counter = le_device_db_local_counter_get(gatt_client->le_device_index); 1100052dc82aSMatthias Ringwald gatt_client->state = P_W4_CMAC_RESULT; 110192a7335eSMatthias 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); 110292a7335eSMatthias Ringwald } 11030038504eSMatthias Ringwald #endif 110492a7335eSMatthias Ringwald 110592a7335eSMatthias Ringwald // returns true if packet was sent 11061979f09cSMatthias Ringwald static bool gatt_client_run_for_gatt_client(gatt_client_t * gatt_client){ 11073deb3ec6SMatthias Ringwald 1108e4d159baSMatthias Ringwald // wait until re-encryption is complete 11091979f09cSMatthias Ringwald if (gap_reconnect_security_setup_active(gatt_client->con_handle)) return false; 1110d1e1a57fSMatthias Ringwald 1111e4d159baSMatthias Ringwald // wait until re-encryption is complete 11121979f09cSMatthias Ringwald if (gatt_client->reencryption_active) return false; 11136c124bc2SMatthias Ringwald 111411279da7SMatthias Ringwald // wait until pairing complete (either reactive authentication or due to required security level) 11151979f09cSMatthias Ringwald if (gatt_client->wait_for_authentication_complete) return false; 111611279da7SMatthias Ringwald 1117052dc82aSMatthias Ringwald bool client_request_pending = gatt_client->state != P_READY; 1118fd14b205SMatthias Ringwald 11191aa9e3e8SMatthias Ringwald // verify security level for Mandatory Authentication over LE 112046012949SMatthias Ringwald bool check_security; 112146012949SMatthias Ringwald switch (gatt_client->bearer_type){ 112246012949SMatthias Ringwald case ATT_BEARER_UNENHANCED_LE: 112346012949SMatthias Ringwald check_security = true; 112446012949SMatthias Ringwald break; 112546012949SMatthias Ringwald default: 11269ced96e1SMatthias Ringwald check_security = false; 112746012949SMatthias Ringwald break; 11289ced96e1SMatthias Ringwald } 11299ced96e1SMatthias Ringwald if (client_request_pending && (gatt_client_required_security_level > gatt_client->security_level) && check_security){ 11301dfae9c7SMatthias Ringwald log_info("Trigger pairing, current security level %u, required %u\n", gatt_client->security_level, gatt_client_required_security_level); 11312197dbafSMatthias Ringwald gatt_client->wait_for_authentication_complete = true; 113211279da7SMatthias Ringwald // set att error code for pairing failure based on required level 113311279da7SMatthias Ringwald switch (gatt_client_required_security_level){ 113411279da7SMatthias Ringwald case LEVEL_4: 113511279da7SMatthias Ringwald case LEVEL_3: 113611279da7SMatthias Ringwald gatt_client->pending_error_code = ATT_ERROR_INSUFFICIENT_AUTHENTICATION; 113711279da7SMatthias Ringwald break; 113811279da7SMatthias Ringwald default: 113911279da7SMatthias Ringwald gatt_client->pending_error_code = ATT_ERROR_INSUFFICIENT_ENCRYPTION; 114011279da7SMatthias Ringwald break; 114111279da7SMatthias Ringwald } 114211279da7SMatthias Ringwald sm_request_pairing(gatt_client->con_handle); 114311279da7SMatthias Ringwald // sm probably just sent a pdu 11441979f09cSMatthias Ringwald return true; 114511279da7SMatthias Ringwald } 1146f4b33574SMatthias Ringwald 11475cf1669fSMatthias Ringwald switch (gatt_client->mtu_state) { 1148544128c3SMatthias Ringwald case SEND_MTU_EXCHANGE: 11495cf1669fSMatthias Ringwald gatt_client->mtu_state = SENT_MTU_EXCHANGE; 11506e7b444cSMatthias Ringwald att_exchange_mtu_request(gatt_client); 11511979f09cSMatthias Ringwald return true; 11523deb3ec6SMatthias Ringwald case SENT_MTU_EXCHANGE: 11531979f09cSMatthias Ringwald return false; 11543deb3ec6SMatthias Ringwald default: 11553deb3ec6SMatthias Ringwald break; 11563deb3ec6SMatthias Ringwald } 11573deb3ec6SMatthias Ringwald 11585cf1669fSMatthias Ringwald if (gatt_client->send_confirmation){ 115952377058SMatthias Ringwald gatt_client->send_confirmation = false; 11606e7b444cSMatthias Ringwald att_confirmation(gatt_client); 11611979f09cSMatthias Ringwald return true; 11623deb3ec6SMatthias Ringwald } 11633deb3ec6SMatthias Ringwald 11643deb3ec6SMatthias Ringwald // check MTU for writes 1165052dc82aSMatthias Ringwald switch (gatt_client->state){ 11663deb3ec6SMatthias Ringwald case P_W2_SEND_WRITE_CHARACTERISTIC_VALUE: 11673deb3ec6SMatthias Ringwald case P_W2_SEND_WRITE_CHARACTERISTIC_DESCRIPTOR: 1168dda77937SMatthias Ringwald if (gatt_client->attribute_length <= (gatt_client->mtu - 3u)) break; 1169dda77937SMatthias Ringwald log_error("gatt_client_run: value len %u > MTU %u - 3\n", gatt_client->attribute_length,gatt_client->mtu); 1170526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_INVALID_ATTRIBUTE_VALUE_LENGTH); 11711979f09cSMatthias Ringwald return false; 11723deb3ec6SMatthias Ringwald default: 11733deb3ec6SMatthias Ringwald break; 11743deb3ec6SMatthias Ringwald } 11753deb3ec6SMatthias Ringwald 11760038504eSMatthias Ringwald bool packet_sent = true; 11770038504eSMatthias Ringwald bool done = true; 1178052dc82aSMatthias Ringwald switch (gatt_client->state){ 11793deb3ec6SMatthias Ringwald case P_W2_SEND_SERVICE_QUERY: 1180052dc82aSMatthias Ringwald gatt_client->state = P_W4_SERVICE_QUERY_RESULT; 11815cf1669fSMatthias Ringwald send_gatt_services_request(gatt_client); 11820038504eSMatthias Ringwald break; 11833deb3ec6SMatthias Ringwald 11843deb3ec6SMatthias Ringwald case P_W2_SEND_SERVICE_WITH_UUID_QUERY: 1185052dc82aSMatthias Ringwald gatt_client->state = P_W4_SERVICE_WITH_UUID_RESULT; 11865cf1669fSMatthias Ringwald send_gatt_services_by_uuid_request(gatt_client); 11870038504eSMatthias Ringwald break; 11883deb3ec6SMatthias Ringwald 11893deb3ec6SMatthias Ringwald case P_W2_SEND_ALL_CHARACTERISTICS_OF_SERVICE_QUERY: 1190052dc82aSMatthias Ringwald gatt_client->state = P_W4_ALL_CHARACTERISTICS_OF_SERVICE_QUERY_RESULT; 11915cf1669fSMatthias Ringwald send_gatt_characteristic_request(gatt_client); 11920038504eSMatthias Ringwald break; 11933deb3ec6SMatthias Ringwald 11943deb3ec6SMatthias Ringwald case P_W2_SEND_CHARACTERISTIC_WITH_UUID_QUERY: 1195052dc82aSMatthias Ringwald gatt_client->state = P_W4_CHARACTERISTIC_WITH_UUID_QUERY_RESULT; 11965cf1669fSMatthias Ringwald send_gatt_characteristic_request(gatt_client); 11970038504eSMatthias Ringwald break; 11983deb3ec6SMatthias Ringwald 11993deb3ec6SMatthias Ringwald case P_W2_SEND_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY: 1200052dc82aSMatthias Ringwald gatt_client->state = P_W4_CHARACTERISTIC_WITH_UUID_QUERY_RESULT; 12015cf1669fSMatthias Ringwald send_gatt_characteristic_descriptor_request(gatt_client); 12020038504eSMatthias Ringwald break; 12033deb3ec6SMatthias Ringwald 12043deb3ec6SMatthias Ringwald case P_W2_SEND_INCLUDED_SERVICE_QUERY: 1205052dc82aSMatthias Ringwald gatt_client->state = P_W4_INCLUDED_SERVICE_QUERY_RESULT; 12065cf1669fSMatthias Ringwald send_gatt_included_service_request(gatt_client); 12070038504eSMatthias Ringwald break; 12083deb3ec6SMatthias Ringwald 12093deb3ec6SMatthias Ringwald case P_W2_SEND_INCLUDED_SERVICE_WITH_UUID_QUERY: 1210052dc82aSMatthias Ringwald gatt_client->state = P_W4_INCLUDED_SERVICE_UUID_WITH_QUERY_RESULT; 12115cf1669fSMatthias Ringwald send_gatt_included_service_uuid_request(gatt_client); 12120038504eSMatthias Ringwald break; 12133deb3ec6SMatthias Ringwald 12143deb3ec6SMatthias Ringwald case P_W2_SEND_READ_CHARACTERISTIC_VALUE_QUERY: 1215052dc82aSMatthias Ringwald gatt_client->state = P_W4_READ_CHARACTERISTIC_VALUE_RESULT; 12165cf1669fSMatthias Ringwald send_gatt_read_characteristic_value_request(gatt_client); 12170038504eSMatthias Ringwald break; 12183deb3ec6SMatthias Ringwald 12193deb3ec6SMatthias Ringwald case P_W2_SEND_READ_BLOB_QUERY: 1220052dc82aSMatthias Ringwald gatt_client->state = P_W4_READ_BLOB_RESULT; 12215cf1669fSMatthias Ringwald send_gatt_read_blob_request(gatt_client); 12220038504eSMatthias Ringwald break; 12233deb3ec6SMatthias Ringwald 12243deb3ec6SMatthias Ringwald case P_W2_SEND_READ_BY_TYPE_REQUEST: 1225052dc82aSMatthias Ringwald gatt_client->state = P_W4_READ_BY_TYPE_RESPONSE; 12265cf1669fSMatthias Ringwald send_gatt_read_by_type_request(gatt_client); 12270038504eSMatthias Ringwald break; 12283deb3ec6SMatthias Ringwald 12293deb3ec6SMatthias Ringwald case P_W2_SEND_READ_MULTIPLE_REQUEST: 1230052dc82aSMatthias Ringwald gatt_client->state = P_W4_READ_MULTIPLE_RESPONSE; 12315cf1669fSMatthias Ringwald send_gatt_read_multiple_request(gatt_client); 12320038504eSMatthias Ringwald break; 12333deb3ec6SMatthias Ringwald 1234f125a8efSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 1235f125a8efSMatthias Ringwald case P_W2_SEND_READ_MULTIPLE_VARIABLE_REQUEST: 1236052dc82aSMatthias Ringwald gatt_client->state = P_W4_READ_MULTIPLE_VARIABLE_RESPONSE; 1237f125a8efSMatthias Ringwald send_gatt_read_multiple_variable_request(gatt_client); 1238f125a8efSMatthias Ringwald break; 1239f125a8efSMatthias Ringwald #endif 1240f125a8efSMatthias Ringwald 12413deb3ec6SMatthias Ringwald case P_W2_SEND_WRITE_CHARACTERISTIC_VALUE: 1242052dc82aSMatthias Ringwald gatt_client->state = P_W4_WRITE_CHARACTERISTIC_VALUE_RESULT; 12435cf1669fSMatthias Ringwald send_gatt_write_attribute_value_request(gatt_client); 12440038504eSMatthias Ringwald break; 12453deb3ec6SMatthias Ringwald 12463deb3ec6SMatthias Ringwald case P_W2_PREPARE_WRITE: 1247052dc82aSMatthias Ringwald gatt_client->state = P_W4_PREPARE_WRITE_RESULT; 12485cf1669fSMatthias Ringwald send_gatt_prepare_write_request(gatt_client); 12490038504eSMatthias Ringwald break; 12503deb3ec6SMatthias Ringwald 12513deb3ec6SMatthias Ringwald case P_W2_PREPARE_WRITE_SINGLE: 1252052dc82aSMatthias Ringwald gatt_client->state = P_W4_PREPARE_WRITE_SINGLE_RESULT; 12535cf1669fSMatthias Ringwald send_gatt_prepare_write_request(gatt_client); 12540038504eSMatthias Ringwald break; 12553deb3ec6SMatthias Ringwald 12563deb3ec6SMatthias Ringwald case P_W2_PREPARE_RELIABLE_WRITE: 1257052dc82aSMatthias Ringwald gatt_client->state = P_W4_PREPARE_RELIABLE_WRITE_RESULT; 12585cf1669fSMatthias Ringwald send_gatt_prepare_write_request(gatt_client); 12590038504eSMatthias Ringwald break; 12603deb3ec6SMatthias Ringwald 12613deb3ec6SMatthias Ringwald case P_W2_EXECUTE_PREPARED_WRITE: 1262052dc82aSMatthias Ringwald gatt_client->state = P_W4_EXECUTE_PREPARED_WRITE_RESULT; 12635cf1669fSMatthias Ringwald send_gatt_execute_write_request(gatt_client); 12640038504eSMatthias Ringwald break; 12653deb3ec6SMatthias Ringwald 12663deb3ec6SMatthias Ringwald case P_W2_CANCEL_PREPARED_WRITE: 1267052dc82aSMatthias Ringwald gatt_client->state = P_W4_CANCEL_PREPARED_WRITE_RESULT; 12685cf1669fSMatthias Ringwald send_gatt_cancel_prepared_write_request(gatt_client); 12690038504eSMatthias Ringwald break; 12703deb3ec6SMatthias Ringwald 12713deb3ec6SMatthias Ringwald case P_W2_CANCEL_PREPARED_WRITE_DATA_MISMATCH: 1272052dc82aSMatthias Ringwald gatt_client->state = P_W4_CANCEL_PREPARED_WRITE_DATA_MISMATCH_RESULT; 12735cf1669fSMatthias Ringwald send_gatt_cancel_prepared_write_request(gatt_client); 12740038504eSMatthias Ringwald break; 12753deb3ec6SMatthias Ringwald 1276abdc9fb5SMatthias Ringwald #ifdef ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY 1277abdc9fb5SMatthias Ringwald case P_W2_SEND_FIND_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY: 1278abdc9fb5SMatthias Ringwald // use Find Information 12795cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_FIND_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY_RESULT; 12805cf1669fSMatthias Ringwald send_gatt_characteristic_descriptor_request(gatt_client); 1281abdc9fb5SMatthias Ringwald #else 12823deb3ec6SMatthias Ringwald case P_W2_SEND_READ_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY: 1283abdc9fb5SMatthias Ringwald // Use Read By Type 1284052dc82aSMatthias Ringwald gatt_client->state = P_W4_READ_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY_RESULT; 12855cf1669fSMatthias Ringwald send_gatt_read_client_characteristic_configuration_request(gatt_client); 1286abdc9fb5SMatthias Ringwald #endif 12870038504eSMatthias Ringwald break; 12883deb3ec6SMatthias Ringwald 12893deb3ec6SMatthias Ringwald case P_W2_SEND_READ_CHARACTERISTIC_DESCRIPTOR_QUERY: 1290052dc82aSMatthias Ringwald gatt_client->state = P_W4_READ_CHARACTERISTIC_DESCRIPTOR_RESULT; 12915cf1669fSMatthias Ringwald send_gatt_read_characteristic_descriptor_request(gatt_client); 12920038504eSMatthias Ringwald break; 12933deb3ec6SMatthias Ringwald 12943deb3ec6SMatthias Ringwald case P_W2_SEND_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_QUERY: 1295052dc82aSMatthias Ringwald gatt_client->state = P_W4_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_RESULT; 12965cf1669fSMatthias Ringwald send_gatt_read_blob_request(gatt_client); 12970038504eSMatthias Ringwald break; 12983deb3ec6SMatthias Ringwald 12993deb3ec6SMatthias Ringwald case P_W2_SEND_WRITE_CHARACTERISTIC_DESCRIPTOR: 1300052dc82aSMatthias Ringwald gatt_client->state = P_W4_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT; 13015cf1669fSMatthias Ringwald send_gatt_write_attribute_value_request(gatt_client); 13020038504eSMatthias Ringwald break; 13033deb3ec6SMatthias Ringwald 13043deb3ec6SMatthias Ringwald case P_W2_WRITE_CLIENT_CHARACTERISTIC_CONFIGURATION: 1305052dc82aSMatthias Ringwald gatt_client->state = P_W4_CLIENT_CHARACTERISTIC_CONFIGURATION_RESULT; 13065cf1669fSMatthias Ringwald send_gatt_write_client_characteristic_configuration_request(gatt_client); 13070038504eSMatthias Ringwald break; 13083deb3ec6SMatthias Ringwald 13093deb3ec6SMatthias Ringwald case P_W2_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR: 1310052dc82aSMatthias Ringwald gatt_client->state = P_W4_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT; 13115cf1669fSMatthias Ringwald send_gatt_prepare_write_request(gatt_client); 13120038504eSMatthias Ringwald break; 13133deb3ec6SMatthias Ringwald 13143deb3ec6SMatthias Ringwald case P_W2_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR: 1315052dc82aSMatthias Ringwald gatt_client->state = P_W4_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT; 13165cf1669fSMatthias Ringwald send_gatt_execute_write_request(gatt_client); 13170038504eSMatthias Ringwald break; 13183deb3ec6SMatthias Ringwald 13197a766ebfSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 1320793cf6ceSMatthias Ringwald case P_W4_IDENTITY_RESOLVING: 13215cf1669fSMatthias Ringwald log_info("P_W4_IDENTITY_RESOLVING - state %x", sm_identity_resolving_state(gatt_client->con_handle)); 13225cf1669fSMatthias Ringwald switch (sm_identity_resolving_state(gatt_client->con_handle)){ 1323793cf6ceSMatthias Ringwald case IRK_LOOKUP_SUCCEEDED: 13245cf1669fSMatthias Ringwald gatt_client->le_device_index = sm_le_device_index(gatt_client->con_handle); 1325052dc82aSMatthias Ringwald gatt_client->state = P_W4_CMAC_READY; 132692a7335eSMatthias Ringwald if (sm_cmac_ready()){ 132792a7335eSMatthias Ringwald gatt_client_run_for_client_start_signed_write(gatt_client); 132892a7335eSMatthias Ringwald } 1329793cf6ceSMatthias Ringwald break; 1330793cf6ceSMatthias Ringwald case IRK_LOOKUP_FAILED: 1331526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_BONDING_INFORMATION_MISSING); 133292a7335eSMatthias Ringwald break; 1333793cf6ceSMatthias Ringwald default: 133492a7335eSMatthias Ringwald break; 1335793cf6ceSMatthias Ringwald } 13360038504eSMatthias Ringwald packet_sent = false; 13370038504eSMatthias Ringwald break; 1338793cf6ceSMatthias Ringwald 13393deb3ec6SMatthias Ringwald case P_W4_CMAC_READY: 13403deb3ec6SMatthias Ringwald if (sm_cmac_ready()){ 134192a7335eSMatthias Ringwald gatt_client_run_for_client_start_signed_write(gatt_client); 13423deb3ec6SMatthias Ringwald } 13430038504eSMatthias Ringwald packet_sent = false; 13440038504eSMatthias Ringwald break; 13453deb3ec6SMatthias Ringwald 13463deb3ec6SMatthias Ringwald case P_W2_SEND_SIGNED_WRITE: { 13474c7c987fSMatthias Ringwald gatt_client->state = P_W4_SEND_SIGNED_WRITE_DONE; 13483deb3ec6SMatthias Ringwald // bump local signing counter 13495cf1669fSMatthias Ringwald uint32_t sign_counter = le_device_db_local_counter_get(gatt_client->le_device_index); 13505cf1669fSMatthias Ringwald le_device_db_local_counter_set(gatt_client->le_device_index, sign_counter + 1); 135164b12680SMatthias Ringwald // send signed write command 13525cf1669fSMatthias Ringwald send_gatt_signed_write_request(gatt_client, sign_counter); 13533deb3ec6SMatthias Ringwald // finally, notifiy client that write is complete 1354526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 1355b68ac7a5SMatthias Ringwald break; 13563deb3ec6SMatthias Ringwald } 13577a766ebfSMatthias Ringwald #endif 13583deb3ec6SMatthias Ringwald default: 1359b68ac7a5SMatthias Ringwald done = false; 13603deb3ec6SMatthias Ringwald break; 13613deb3ec6SMatthias Ringwald } 136247181045SMatthias Ringwald 13630038504eSMatthias Ringwald if (done){ 13640038504eSMatthias Ringwald return packet_sent; 13650038504eSMatthias Ringwald } 13660038504eSMatthias Ringwald 136759d34cd2SMatthias Ringwald // write without response callback 136859d34cd2SMatthias Ringwald btstack_context_callback_registration_t * callback = 136959d34cd2SMatthias Ringwald (btstack_context_callback_registration_t *) btstack_linked_list_pop(&gatt_client->write_without_response_requests); 137059d34cd2SMatthias Ringwald if (callback != NULL){ 137159d34cd2SMatthias Ringwald (*callback->callback)(callback->context); 137259d34cd2SMatthias Ringwald return true; 137359d34cd2SMatthias Ringwald } 137459d34cd2SMatthias Ringwald 137559d34cd2SMatthias Ringwald // requested can send now old 1376f688bdb8SMatthias Ringwald if (gatt_client->write_without_response_callback != NULL){ 13775cf1669fSMatthias Ringwald btstack_packet_handler_t packet_handler = gatt_client->write_without_response_callback; 13785cf1669fSMatthias Ringwald gatt_client->write_without_response_callback = NULL; 137947181045SMatthias Ringwald uint8_t event[4]; 138047181045SMatthias Ringwald event[0] = GATT_EVENT_CAN_WRITE_WITHOUT_RESPONSE; 13814ea43905SMatthias Ringwald event[1] = sizeof(event) - 2u; 13825cf1669fSMatthias Ringwald little_endian_store_16(event, 2, gatt_client->con_handle); 13835cf1669fSMatthias Ringwald packet_handler(HCI_EVENT_PACKET, gatt_client->con_handle, event, sizeof(event)); 13841979f09cSMatthias Ringwald return true; // to trigger requeueing (even if higher layer didn't sent) 138547181045SMatthias Ringwald } 138647181045SMatthias Ringwald 13871979f09cSMatthias Ringwald return false; 13883deb3ec6SMatthias Ringwald } 13893deb3ec6SMatthias Ringwald 1390544128c3SMatthias Ringwald static void gatt_client_run(void){ 1391544128c3SMatthias Ringwald btstack_linked_item_t *it; 1392109c2548SMatthias Ringwald bool packet_sent; 13937627a0deSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 13947627a0deSMatthias Ringwald btstack_linked_list_iterator_t it_eatt; 13957627a0deSMatthias Ringwald #endif 1396a0da043fSMatthias Ringwald for (it = (btstack_linked_item_t *) gatt_client_connections; it != NULL; it = it->next){ 13975cf1669fSMatthias Ringwald gatt_client_t * gatt_client = (gatt_client_t *) it; 139846012949SMatthias Ringwald switch (gatt_client->bearer_type){ 139946012949SMatthias Ringwald case ATT_BEARER_UNENHANCED_LE: 14007627a0deSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 14017627a0deSMatthias Ringwald btstack_linked_list_iterator_init(&it_eatt, &gatt_client->eatt_clients); 14027627a0deSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it_eatt)) { 14037627a0deSMatthias Ringwald gatt_client_t * eatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it_eatt); 1404052dc82aSMatthias Ringwald if (eatt_client->state != P_READY){ 14054c226876SMatthias Ringwald if (att_dispatch_client_can_send_now(gatt_client->con_handle)){ 14067627a0deSMatthias Ringwald gatt_client_run_for_gatt_client(eatt_client); 14077627a0deSMatthias Ringwald } 14087627a0deSMatthias Ringwald } 14097627a0deSMatthias Ringwald } 14107627a0deSMatthias Ringwald #endif 141146012949SMatthias Ringwald if (!att_dispatch_client_can_send_now(gatt_client->con_handle)) { 141246012949SMatthias Ringwald att_dispatch_client_request_can_send_now_event(gatt_client->con_handle); 141346012949SMatthias Ringwald return; 141446012949SMatthias Ringwald } 1415109c2548SMatthias Ringwald packet_sent = gatt_client_run_for_gatt_client(gatt_client); 141646012949SMatthias Ringwald if (packet_sent){ 141746012949SMatthias Ringwald // request new permission 141846012949SMatthias Ringwald att_dispatch_client_request_can_send_now_event(gatt_client->con_handle); 141946012949SMatthias Ringwald // requeue client for fairness and exit 142046012949SMatthias Ringwald // note: iterator has become invalid 142146012949SMatthias Ringwald btstack_linked_list_remove(&gatt_client_connections, (btstack_linked_item_t *) gatt_client); 142246012949SMatthias Ringwald btstack_linked_list_add_tail(&gatt_client_connections, (btstack_linked_item_t *) gatt_client); 142346012949SMatthias Ringwald return; 142446012949SMatthias Ringwald } 142546012949SMatthias Ringwald break; 14261450cdc6SMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC 142746012949SMatthias Ringwald case ATT_BEARER_UNENHANCED_CLASSIC: 14281450cdc6SMatthias Ringwald if (gatt_client->con_handle == HCI_CON_HANDLE_INVALID) { 14291450cdc6SMatthias Ringwald continue; 14301450cdc6SMatthias Ringwald } 14311aa9e3e8SMatthias Ringwald 14321aa9e3e8SMatthias Ringwald // handle GATT over BR/EDR 14334c226876SMatthias Ringwald if (att_dispatch_client_can_send_now(gatt_client->con_handle) == false) { 14344c226876SMatthias Ringwald att_dispatch_client_request_can_send_now_event(gatt_client->con_handle); 14351aa9e3e8SMatthias Ringwald return; 14361aa9e3e8SMatthias Ringwald } 1437109c2548SMatthias Ringwald packet_sent = gatt_client_run_for_gatt_client(gatt_client); 14381aa9e3e8SMatthias Ringwald if (packet_sent){ 14391aa9e3e8SMatthias Ringwald // request new permission 14401aa9e3e8SMatthias Ringwald att_dispatch_client_request_can_send_now_event(gatt_client->con_handle); 14411aa9e3e8SMatthias Ringwald // requeue client for fairness and exit 14421aa9e3e8SMatthias Ringwald // note: iterator has become invalid 14431aa9e3e8SMatthias Ringwald btstack_linked_list_remove(&gatt_client_connections, (btstack_linked_item_t *) gatt_client); 14441aa9e3e8SMatthias Ringwald btstack_linked_list_add_tail(&gatt_client_connections, (btstack_linked_item_t *) gatt_client); 14451aa9e3e8SMatthias Ringwald return; 14461aa9e3e8SMatthias Ringwald } 144746012949SMatthias Ringwald break; 14481450cdc6SMatthias Ringwald #endif 144946012949SMatthias Ringwald default: 145046012949SMatthias Ringwald btstack_unreachable(); 145146012949SMatthias Ringwald break; 1452544128c3SMatthias Ringwald } 145346012949SMatthias Ringwald 145446012949SMatthias Ringwald 1455544128c3SMatthias Ringwald } 14563deb3ec6SMatthias Ringwald } 14573deb3ec6SMatthias Ringwald 1458544a5845SMatthias Ringwald // emit complete event, used to avoid emitting event from API call 1459544a5845SMatthias Ringwald static void gatt_client_emit_events(void * context){ 1460544a5845SMatthias Ringwald UNUSED(context); 1461544a5845SMatthias Ringwald btstack_linked_item_t *it; 1462544a5845SMatthias Ringwald for (it = (btstack_linked_item_t *) gatt_client_connections; it != NULL; it = it->next) { 1463544a5845SMatthias Ringwald gatt_client_t *gatt_client = (gatt_client_t *) it; 1464544a5845SMatthias Ringwald if (gatt_client->state == P_W2_EMIT_QUERY_COMPLETE_EVENT){ 1465544a5845SMatthias Ringwald gatt_client->state = P_READY; 1466544a5845SMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_SUCCESS); 1467544a5845SMatthias Ringwald } 1468544a5845SMatthias Ringwald } 1469544a5845SMatthias Ringwald } 1470544a5845SMatthias Ringwald 14715cf1669fSMatthias Ringwald static void gatt_client_report_error_if_pending(gatt_client_t *gatt_client, uint8_t att_error_code) { 1472643a64fcSMatthias Ringwald if (is_ready(gatt_client)) return; 1473526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, att_error_code); 14743deb3ec6SMatthias Ringwald } 14753deb3ec6SMatthias Ringwald 147678c4542aSMatthias Ringwald static void gatt_client_handle_reencryption_complete(const uint8_t * packet){ 147778c4542aSMatthias Ringwald hci_con_handle_t con_handle = sm_event_reencryption_complete_get_handle(packet); 147878c4542aSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_get_context_for_handle(con_handle); 147978c4542aSMatthias Ringwald if (gatt_client == NULL) return; 148078c4542aSMatthias Ringwald 148178c4542aSMatthias Ringwald // update security level 148278c4542aSMatthias Ringwald gatt_client->security_level = gatt_client_le_security_level_for_connection(con_handle); 148378c4542aSMatthias Ringwald 148478c4542aSMatthias Ringwald gatt_client->reencryption_result = sm_event_reencryption_complete_get_status(packet); 148578c4542aSMatthias Ringwald gatt_client->reencryption_active = false; 14862197dbafSMatthias Ringwald gatt_client->wait_for_authentication_complete = false; 148778c4542aSMatthias Ringwald 1488052dc82aSMatthias Ringwald if (gatt_client->state == P_READY) return; 148978c4542aSMatthias Ringwald 149078c4542aSMatthias Ringwald switch (sm_event_reencryption_complete_get_status(packet)){ 149178c4542aSMatthias Ringwald case ERROR_CODE_SUCCESS: 149278c4542aSMatthias Ringwald log_info("re-encryption success, retry operation"); 149378c4542aSMatthias Ringwald break; 149478c4542aSMatthias Ringwald case ERROR_CODE_AUTHENTICATION_FAILURE: 149578c4542aSMatthias Ringwald case ERROR_CODE_PIN_OR_KEY_MISSING: 149678c4542aSMatthias Ringwald #if defined(ENABLE_GATT_CLIENT_PAIRING) && !defined(ENABLE_LE_PROACTIVE_AUTHENTICATION) 149778c4542aSMatthias Ringwald if (gatt_client_required_security_level == LEVEL_0) { 149878c4542aSMatthias Ringwald // re-encryption failed for reactive authentication with pairing and we have a pending client request 149978c4542aSMatthias Ringwald // => try to resolve it by deleting bonding information if we started pairing before 150078c4542aSMatthias Ringwald // delete bonding information 150178c4542aSMatthias Ringwald int le_device_db_index = sm_le_device_index(gatt_client->con_handle); 150278c4542aSMatthias Ringwald btstack_assert(le_device_db_index >= 0); 150378c4542aSMatthias Ringwald log_info("reactive auth with pairing: delete bonding and start pairing"); 150478c4542aSMatthias Ringwald #ifdef ENABLE_LE_PRIVACY_ADDRESS_RESOLUTION 150578c4542aSMatthias Ringwald hci_remove_le_device_db_entry_from_resolving_list((uint16_t) le_device_db_index); 150678c4542aSMatthias Ringwald #endif 150778c4542aSMatthias Ringwald le_device_db_remove(le_device_db_index); 150878c4542aSMatthias Ringwald // trigger pairing again 150978c4542aSMatthias Ringwald sm_request_pairing(gatt_client->con_handle); 151078c4542aSMatthias Ringwald break; 151178c4542aSMatthias Ringwald } 151278c4542aSMatthias Ringwald #endif 151378c4542aSMatthias Ringwald // report bonding information missing 1514526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_BONDING_INFORMATION_MISSING); 151578c4542aSMatthias Ringwald break; 151678c4542aSMatthias Ringwald default: 151778c4542aSMatthias Ringwald // report bonding information missing 1518526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, gatt_client->pending_error_code); 151978c4542aSMatthias Ringwald break; 152078c4542aSMatthias Ringwald } 152178c4542aSMatthias Ringwald } 152278c4542aSMatthias Ringwald 152378c4542aSMatthias Ringwald static void gatt_client_handle_disconnection_complete(const uint8_t * packet){ 152478c4542aSMatthias Ringwald log_info("GATT Client: HCI_EVENT_DISCONNECTION_COMPLETE"); 152578c4542aSMatthias Ringwald hci_con_handle_t con_handle = little_endian_read_16(packet,3); 152678c4542aSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_get_context_for_handle(con_handle); 152778c4542aSMatthias Ringwald if (gatt_client == NULL) return; 152878c4542aSMatthias Ringwald 152978c4542aSMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, ATT_ERROR_HCI_DISCONNECT_RECEIVED); 153078c4542aSMatthias Ringwald gatt_client_timeout_stop(gatt_client); 153178c4542aSMatthias Ringwald btstack_linked_list_remove(&gatt_client_connections, (btstack_linked_item_t *) gatt_client); 153278c4542aSMatthias Ringwald btstack_memory_gatt_client_free(gatt_client); 153378c4542aSMatthias Ringwald } 153478c4542aSMatthias Ringwald 1535f4b33574SMatthias Ringwald static void gatt_client_event_packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size){ 15361ac26e06SMatthias Ringwald UNUSED(channel); // ok: handling own l2cap events 15371ac26e06SMatthias Ringwald UNUSED(size); // ok: there is no channel 15389ec2630cSMatthias Ringwald 1539361b1363SMatthias Ringwald if (packet_type != HCI_EVENT_PACKET) return; 1540361b1363SMatthias Ringwald 1541f4b33574SMatthias Ringwald hci_con_handle_t con_handle; 15425cf1669fSMatthias Ringwald gatt_client_t * gatt_client; 15430e2df43fSMatthias Ringwald switch (hci_event_packet_get_type(packet)) { 15443deb3ec6SMatthias Ringwald case HCI_EVENT_DISCONNECTION_COMPLETE: 154578c4542aSMatthias Ringwald gatt_client_handle_disconnection_complete(packet); 15463deb3ec6SMatthias Ringwald break; 1547f4b33574SMatthias Ringwald 1548f4b33574SMatthias Ringwald // Pairing complete (with/without bonding=storing of pairing information) 1549f4b33574SMatthias Ringwald case SM_EVENT_PAIRING_COMPLETE: 1550f4b33574SMatthias Ringwald con_handle = sm_event_pairing_complete_get_handle(packet); 15515cf1669fSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(con_handle); 15525cf1669fSMatthias Ringwald if (gatt_client == NULL) break; 1553f4b33574SMatthias Ringwald 15541dfae9c7SMatthias Ringwald // update security level 15551dfae9c7SMatthias Ringwald gatt_client->security_level = gatt_client_le_security_level_for_connection(con_handle); 15561dfae9c7SMatthias Ringwald 15573503dc74SMatthias Ringwald if (gatt_client->wait_for_authentication_complete){ 15582197dbafSMatthias Ringwald gatt_client->wait_for_authentication_complete = false; 1559f688bdb8SMatthias Ringwald if (sm_event_pairing_complete_get_status(packet) != ERROR_CODE_SUCCESS){ 15605cf1669fSMatthias Ringwald log_info("pairing failed, report previous error 0x%x", gatt_client->pending_error_code); 1561ec9babacSMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, gatt_client->pending_error_code); 1562f4b33574SMatthias Ringwald } else { 1563f4b33574SMatthias Ringwald log_info("pairing success, retry operation"); 15643deb3ec6SMatthias Ringwald } 1565f4b33574SMatthias Ringwald } 1566f4b33574SMatthias Ringwald break; 156711279da7SMatthias Ringwald 1568793cf6ceSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 1569793cf6ceSMatthias Ringwald // Identity Resolving completed (no code, gatt_client_run will continue) 1570793cf6ceSMatthias Ringwald case SM_EVENT_IDENTITY_RESOLVING_SUCCEEDED: 1571793cf6ceSMatthias Ringwald case SM_EVENT_IDENTITY_RESOLVING_FAILED: 1572793cf6ceSMatthias Ringwald break; 1573793cf6ceSMatthias Ringwald #endif 1574a95ca902SMatthias Ringwald 15758918bbdaSMatthias Ringwald // re-encryption started 15768918bbdaSMatthias Ringwald case SM_EVENT_REENCRYPTION_STARTED: 15778918bbdaSMatthias Ringwald con_handle = sm_event_reencryption_complete_get_handle(packet); 15788918bbdaSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(con_handle); 15798918bbdaSMatthias Ringwald if (gatt_client == NULL) break; 15808918bbdaSMatthias Ringwald 15818918bbdaSMatthias Ringwald gatt_client->reencryption_active = true; 15828918bbdaSMatthias Ringwald gatt_client->reencryption_result = ERROR_CODE_SUCCESS; 15838918bbdaSMatthias Ringwald break; 15848918bbdaSMatthias Ringwald 1585ec9babacSMatthias Ringwald // re-encryption complete 1586ec9babacSMatthias Ringwald case SM_EVENT_REENCRYPTION_COMPLETE: 158778c4542aSMatthias Ringwald gatt_client_handle_reencryption_complete(packet); 1588ec9babacSMatthias Ringwald break; 15893deb3ec6SMatthias Ringwald default: 15903deb3ec6SMatthias Ringwald break; 15913deb3ec6SMatthias Ringwald } 15923deb3ec6SMatthias Ringwald 1593361b1363SMatthias Ringwald gatt_client_run(); 15943deb3ec6SMatthias Ringwald } 15953deb3ec6SMatthias Ringwald 15962da0d963SMatthias Ringwald static void gatt_client_handle_att_read_response(gatt_client_t *gatt_client, uint8_t *packet, uint16_t size) { 1597052dc82aSMatthias Ringwald switch (gatt_client->state) { 15982da0d963SMatthias Ringwald case P_W4_INCLUDED_SERVICE_UUID_WITH_QUERY_RESULT: 15992da0d963SMatthias Ringwald if (size >= 17) { 16002da0d963SMatthias Ringwald uint8_t uuid128[16]; 16012da0d963SMatthias Ringwald reverse_128(&packet[1], uuid128); 16022da0d963SMatthias Ringwald report_gatt_included_service_uuid128(gatt_client, gatt_client->start_group_handle, uuid128); 16032da0d963SMatthias Ringwald } 16042da0d963SMatthias Ringwald trigger_next_included_service_query(gatt_client, gatt_client->start_group_handle); 16055611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 16063deb3ec6SMatthias Ringwald break; 16072da0d963SMatthias Ringwald 16082da0d963SMatthias Ringwald case P_W4_READ_CHARACTERISTIC_VALUE_RESULT: 16092da0d963SMatthias Ringwald report_gatt_characteristic_value(gatt_client, gatt_client->attribute_handle, &packet[1], size - 1u); 1610526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 16112da0d963SMatthias Ringwald break; 16122da0d963SMatthias Ringwald 16132da0d963SMatthias Ringwald case P_W4_READ_CHARACTERISTIC_DESCRIPTOR_RESULT: 16142da0d963SMatthias Ringwald report_gatt_characteristic_descriptor(gatt_client, gatt_client->attribute_handle, &packet[1], 16152da0d963SMatthias Ringwald size - 1u, 0u); 1616526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 16172da0d963SMatthias Ringwald break; 16182da0d963SMatthias Ringwald 16192da0d963SMatthias Ringwald // Use ATT_READ_REQUEST for first blob of Read Long Characteristic 16202da0d963SMatthias Ringwald case P_W4_READ_BLOB_RESULT: 16212da0d963SMatthias Ringwald report_gatt_long_characteristic_value_blob(gatt_client, gatt_client->attribute_handle, &packet[1], 16222da0d963SMatthias Ringwald size - 1u, gatt_client->attribute_offset); 16232da0d963SMatthias Ringwald trigger_next_blob_query(gatt_client, P_W2_SEND_READ_BLOB_QUERY, size - 1u); 16242da0d963SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 16252da0d963SMatthias Ringwald break; 16262da0d963SMatthias Ringwald 16272da0d963SMatthias Ringwald // Use ATT_READ_REQUEST for first blob of Read Long Characteristic Descriptor 16282da0d963SMatthias Ringwald case P_W4_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_RESULT: 16292da0d963SMatthias Ringwald report_gatt_long_characteristic_descriptor(gatt_client, gatt_client->attribute_handle, &packet[1], 16302da0d963SMatthias Ringwald size - 1u, gatt_client->attribute_offset); 16312da0d963SMatthias Ringwald trigger_next_blob_query(gatt_client, P_W2_SEND_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_QUERY, 16322da0d963SMatthias Ringwald size - 1u); 16332da0d963SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 16342da0d963SMatthias Ringwald break; 16352da0d963SMatthias Ringwald 16363deb3ec6SMatthias Ringwald default: 16373deb3ec6SMatthias Ringwald break; 16383deb3ec6SMatthias Ringwald } 16392da0d963SMatthias Ringwald } 16403deb3ec6SMatthias Ringwald 16412da0d963SMatthias Ringwald static void gatt_client_handle_att_read_by_type_response(gatt_client_t *gatt_client, uint8_t *packet, uint16_t size) { 1642052dc82aSMatthias Ringwald switch (gatt_client->state) { 16433deb3ec6SMatthias Ringwald case P_W4_ALL_CHARACTERISTICS_OF_SERVICE_QUERY_RESULT: 16445cf1669fSMatthias Ringwald report_gatt_characteristics(gatt_client, packet, size); 1645cf8e5718SMatthias Ringwald trigger_next_characteristic_query(gatt_client, 1646cf8e5718SMatthias Ringwald get_last_result_handle_from_characteristics_list(packet, size)); 16475611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done, or by ATT_ERROR 16483deb3ec6SMatthias Ringwald break; 16493deb3ec6SMatthias Ringwald case P_W4_CHARACTERISTIC_WITH_UUID_QUERY_RESULT: 16505cf1669fSMatthias Ringwald report_gatt_characteristics(gatt_client, packet, size); 1651cf8e5718SMatthias Ringwald trigger_next_characteristic_query(gatt_client, 1652cf8e5718SMatthias Ringwald get_last_result_handle_from_characteristics_list(packet, size)); 16535611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done, or by ATT_ERROR 16543deb3ec6SMatthias Ringwald break; 1655cf8e5718SMatthias Ringwald case P_W4_INCLUDED_SERVICE_QUERY_RESULT: { 16564ea43905SMatthias Ringwald if (size < 2u) break; 16573deb3ec6SMatthias Ringwald uint16_t uuid16 = 0; 16583deb3ec6SMatthias Ringwald uint16_t pair_size = packet[1]; 16593deb3ec6SMatthias Ringwald 16604ea43905SMatthias Ringwald if (pair_size == 6u) { 16614ea43905SMatthias Ringwald if (size < 8u) break; 16623deb3ec6SMatthias Ringwald // UUIDs not available, query first included service 16635cf1669fSMatthias Ringwald gatt_client->start_group_handle = little_endian_read_16(packet, 2); // ready for next query 16645cf1669fSMatthias Ringwald gatt_client->query_start_handle = little_endian_read_16(packet, 4); 16655cf1669fSMatthias Ringwald gatt_client->query_end_handle = little_endian_read_16(packet, 6); 1666052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_INCLUDED_SERVICE_WITH_UUID_QUERY; 16673deb3ec6SMatthias Ringwald break; 16683deb3ec6SMatthias Ringwald } 16693deb3ec6SMatthias Ringwald 16704ea43905SMatthias Ringwald if (pair_size != 8u) break; 16719f698c82SMatthias Ringwald 16729f698c82SMatthias Ringwald // UUIDs included, report all of them 16733deb3ec6SMatthias Ringwald uint16_t offset; 16744ea43905SMatthias Ringwald for (offset = 2u; (offset + 8u) <= size; offset += pair_size) { 1675f8fbdce0SMatthias Ringwald uint16_t include_handle = little_endian_read_16(packet, offset); 16765cf1669fSMatthias Ringwald gatt_client->query_start_handle = little_endian_read_16(packet, offset + 2u); 16775cf1669fSMatthias Ringwald gatt_client->query_end_handle = little_endian_read_16(packet, offset + 4u); 16784ea43905SMatthias Ringwald uuid16 = little_endian_read_16(packet, offset + 6u); 16795cf1669fSMatthias Ringwald report_gatt_included_service_uuid16(gatt_client, include_handle, uuid16); 16803deb3ec6SMatthias Ringwald } 16813deb3ec6SMatthias Ringwald 1682cf8e5718SMatthias Ringwald trigger_next_included_service_query(gatt_client, 1683cf8e5718SMatthias Ringwald get_last_result_handle_from_included_services_list(packet, 1684cf8e5718SMatthias Ringwald size)); 16855611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 16863deb3ec6SMatthias Ringwald break; 16873deb3ec6SMatthias Ringwald } 1688abdc9fb5SMatthias Ringwald #ifndef ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY 16893deb3ec6SMatthias Ringwald case P_W4_READ_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY_RESULT: 16905cf1669fSMatthias Ringwald gatt_client->client_characteristic_configuration_handle = little_endian_read_16(packet, 2); 1691052dc82aSMatthias Ringwald gatt_client->state = P_W2_WRITE_CLIENT_CHARACTERISTIC_CONFIGURATION; 16923deb3ec6SMatthias Ringwald break; 1693abdc9fb5SMatthias Ringwald #endif 16943deb3ec6SMatthias Ringwald case P_W4_READ_BY_TYPE_RESPONSE: { 16953deb3ec6SMatthias Ringwald uint16_t pair_size = packet[1]; 169639ac9711SMatthias Ringwald // set last result handle to last valid handle, only used if pair_size invalid 169739ac9711SMatthias Ringwald uint16_t last_result_handle = 0xffff; 169839ac9711SMatthias Ringwald if (pair_size > 2) { 16993deb3ec6SMatthias Ringwald uint16_t offset; 17003deb3ec6SMatthias Ringwald for (offset = 2; offset < size; offset += pair_size) { 1701f8fbdce0SMatthias Ringwald uint16_t value_handle = little_endian_read_16(packet, offset); 1702cf8e5718SMatthias Ringwald report_gatt_characteristic_value(gatt_client, value_handle, &packet[offset + 2u], 1703cf8e5718SMatthias Ringwald pair_size - 2u); 17043deb3ec6SMatthias Ringwald last_result_handle = value_handle; 17053deb3ec6SMatthias Ringwald } 170639ac9711SMatthias Ringwald } 17075cf1669fSMatthias Ringwald trigger_next_read_by_type_query(gatt_client, last_result_handle); 17083deb3ec6SMatthias Ringwald break; 17093deb3ec6SMatthias Ringwald } 17103deb3ec6SMatthias Ringwald default: 17113deb3ec6SMatthias Ringwald break; 17123deb3ec6SMatthias Ringwald } 171339ac9711SMatthias Ringwald } 1714dc13fd8dSMatthias Ringwald 17152da0d963SMatthias Ringwald static void gatt_client_handle_att_write_response(gatt_client_t *gatt_client) { 1716052dc82aSMatthias Ringwald switch (gatt_client->state) { 17172da0d963SMatthias Ringwald case P_W4_WRITE_CHARACTERISTIC_VALUE_RESULT: 1718526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 17193deb3ec6SMatthias Ringwald break; 17202da0d963SMatthias Ringwald case P_W4_CLIENT_CHARACTERISTIC_CONFIGURATION_RESULT: 1721526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 17223deb3ec6SMatthias Ringwald break; 17232da0d963SMatthias Ringwald case P_W4_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT: 1724526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 17252da0d963SMatthias Ringwald break; 17262da0d963SMatthias Ringwald default: 17272da0d963SMatthias Ringwald break; 17282da0d963SMatthias Ringwald } 17292da0d963SMatthias Ringwald } 1730dc13fd8dSMatthias Ringwald 17312da0d963SMatthias Ringwald static void gatt_client_handle_att_response(gatt_client_t * gatt_client, uint8_t * packet, uint16_t size) { 17324740230fSMatthias Ringwald uint8_t att_status; 17332da0d963SMatthias Ringwald switch (packet[0]) { 17342da0d963SMatthias Ringwald case ATT_EXCHANGE_MTU_RESPONSE: { 17352da0d963SMatthias Ringwald if (size < 3u) break; 173646012949SMatthias Ringwald bool update_gatt_server_att_mtu = false; 17372da0d963SMatthias Ringwald uint16_t remote_rx_mtu = little_endian_read_16(packet, 1); 17382da0d963SMatthias Ringwald uint16_t local_rx_mtu = l2cap_max_le_mtu(); 173946012949SMatthias Ringwald switch (gatt_client->bearer_type){ 174046012949SMatthias Ringwald case ATT_BEARER_UNENHANCED_LE: 174146012949SMatthias Ringwald update_gatt_server_att_mtu = true; 174246012949SMatthias Ringwald break; 17432da0d963SMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC 174446012949SMatthias Ringwald case ATT_BEARER_UNENHANCED_CLASSIC: 17452da0d963SMatthias Ringwald local_rx_mtu = gatt_client->mtu; 174646012949SMatthias Ringwald break; 17472da0d963SMatthias Ringwald #endif 174846012949SMatthias Ringwald default: 174946012949SMatthias Ringwald btstack_unreachable(); 175046012949SMatthias Ringwald break; 175146012949SMatthias Ringwald } 175246012949SMatthias Ringwald 17532da0d963SMatthias Ringwald uint16_t mtu = (remote_rx_mtu < local_rx_mtu) ? remote_rx_mtu : local_rx_mtu; 17542da0d963SMatthias Ringwald 17552da0d963SMatthias Ringwald // set gatt client mtu 17562da0d963SMatthias Ringwald gatt_client->mtu = mtu; 17572da0d963SMatthias Ringwald gatt_client->mtu_state = MTU_EXCHANGED; 17582da0d963SMatthias Ringwald 175946012949SMatthias Ringwald if (update_gatt_server_att_mtu){ 17602da0d963SMatthias Ringwald // set per connection mtu state - for fixed channel 17612da0d963SMatthias Ringwald hci_connection_t *hci_connection = hci_connection_for_handle(gatt_client->con_handle); 17622da0d963SMatthias Ringwald hci_connection->att_connection.mtu = gatt_client->mtu; 17632da0d963SMatthias Ringwald hci_connection->att_connection.mtu_exchanged = true; 17642da0d963SMatthias Ringwald } 17652da0d963SMatthias Ringwald emit_gatt_mtu_exchanged_result_event(gatt_client, gatt_client->mtu); 17662da0d963SMatthias Ringwald break; 17672da0d963SMatthias Ringwald } 17682da0d963SMatthias Ringwald case ATT_READ_BY_GROUP_TYPE_RESPONSE: 1769052dc82aSMatthias Ringwald switch (gatt_client->state) { 17702da0d963SMatthias Ringwald case P_W4_SERVICE_QUERY_RESULT: 17712da0d963SMatthias Ringwald report_gatt_services(gatt_client, packet, size); 17722da0d963SMatthias Ringwald trigger_next_service_query(gatt_client, get_last_result_handle_from_service_list(packet, size)); 177330952227SMilanka Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 177430952227SMilanka Ringwald break; 17753deb3ec6SMatthias Ringwald default: 17763deb3ec6SMatthias Ringwald break; 17773deb3ec6SMatthias Ringwald } 17783deb3ec6SMatthias Ringwald break; 17792da0d963SMatthias Ringwald case ATT_HANDLE_VALUE_NOTIFICATION: 17802da0d963SMatthias Ringwald if (size < 3u) return; 17812da0d963SMatthias Ringwald report_gatt_notification(gatt_client, little_endian_read_16(packet, 1u), &packet[3], size - 3u); 17822da0d963SMatthias Ringwald return; 1783cbba69d5SMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 1784cbba69d5SMatthias Ringwald case ATT_MULTIPLE_HANDLE_VALUE_NTF: 1785cbba69d5SMatthias Ringwald if (size >= 5u) { 1786cbba69d5SMatthias Ringwald uint16_t offset = 1; 1787cbba69d5SMatthias Ringwald while (true){ 1788cbba69d5SMatthias Ringwald uint16_t value_handle = little_endian_read_16(packet, offset); 1789cbba69d5SMatthias Ringwald offset += 2; 1790cbba69d5SMatthias Ringwald uint16_t value_length = little_endian_read_16(packet, offset); 1791cbba69d5SMatthias Ringwald offset += 2; 1792cbba69d5SMatthias Ringwald if ((offset + value_length) > size) break; 1793cbba69d5SMatthias Ringwald report_gatt_notification(gatt_client, value_handle, &packet[offset], value_length); 1794cbba69d5SMatthias Ringwald offset += value_length; 1795cbba69d5SMatthias Ringwald } 1796cbba69d5SMatthias Ringwald } 1797cbba69d5SMatthias Ringwald return; 1798cbba69d5SMatthias Ringwald #endif 17992da0d963SMatthias Ringwald case ATT_HANDLE_VALUE_INDICATION: 18002da0d963SMatthias Ringwald if (size < 3u) break; 18012da0d963SMatthias Ringwald report_gatt_indication(gatt_client, little_endian_read_16(packet, 1u), &packet[3], size - 3u); 180252377058SMatthias Ringwald gatt_client->send_confirmation = true; 18032da0d963SMatthias Ringwald break; 18042da0d963SMatthias Ringwald case ATT_READ_BY_TYPE_RESPONSE: 18052da0d963SMatthias Ringwald gatt_client_handle_att_read_by_type_response(gatt_client, packet, size); 18062da0d963SMatthias Ringwald break; 18072da0d963SMatthias Ringwald case ATT_READ_RESPONSE: 18082da0d963SMatthias Ringwald gatt_client_handle_att_read_response(gatt_client, packet, size); 18092da0d963SMatthias Ringwald break; 1810cf8e5718SMatthias Ringwald case ATT_FIND_BY_TYPE_VALUE_RESPONSE: { 18113deb3ec6SMatthias Ringwald uint8_t pair_size = 4; 18123deb3ec6SMatthias Ringwald int i; 18133deb3ec6SMatthias Ringwald uint16_t start_group_handle; 18145611a760SMatthias Ringwald uint16_t end_group_handle = 0xffff; // asserts GATT_EVENT_QUERY_COMPLETE is emitted if no results 18154ea43905SMatthias Ringwald for (i = 1u; (i + pair_size) <= size; i += pair_size) { 1816f8fbdce0SMatthias Ringwald start_group_handle = little_endian_read_16(packet, i); 1817f8fbdce0SMatthias Ringwald end_group_handle = little_endian_read_16(packet, i + 2); 1818cf8e5718SMatthias Ringwald emit_gatt_service_query_result_event(gatt_client, start_group_handle, end_group_handle, 1819cf8e5718SMatthias Ringwald gatt_client->uuid128); 18203deb3ec6SMatthias Ringwald } 18215cf1669fSMatthias Ringwald trigger_next_service_by_uuid_query(gatt_client, end_group_handle); 18225611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 18233deb3ec6SMatthias Ringwald break; 18243deb3ec6SMatthias Ringwald } 1825cf8e5718SMatthias Ringwald case ATT_FIND_INFORMATION_REPLY: { 18264ea43905SMatthias Ringwald if (size < 2u) break; 1827a6121b51SMilanka Ringwald 18283deb3ec6SMatthias Ringwald uint8_t pair_size = 4; 18294ea43905SMatthias Ringwald if (packet[1u] == 2u) { 18303deb3ec6SMatthias Ringwald pair_size = 18; 18313deb3ec6SMatthias Ringwald } 1832a6121b51SMilanka Ringwald uint16_t offset = 2; 1833a6121b51SMilanka Ringwald 1834a6121b51SMilanka Ringwald if (size < (pair_size + offset)) break; 1835f8fbdce0SMatthias Ringwald uint16_t last_descriptor_handle = little_endian_read_16(packet, size - pair_size); 1836abdc9fb5SMatthias Ringwald 1837abdc9fb5SMatthias Ringwald #ifdef ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY 18385cf1669fSMatthias Ringwald log_info("ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY, state %x", gatt_client->gatt_client_state); 18395cf1669fSMatthias Ringwald if (gatt_client->gatt_client_state == P_W4_FIND_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY_RESULT){ 1840abdc9fb5SMatthias Ringwald // iterate over descriptors looking for CCC 1841abdc9fb5SMatthias Ringwald if (pair_size == 4){ 1842a6121b51SMilanka Ringwald while ((offset + 4) <= size){ 1843abdc9fb5SMatthias Ringwald uint16_t uuid16 = little_endian_read_16(packet, offset + 2); 1844abdc9fb5SMatthias Ringwald if (uuid16 == GATT_CLIENT_CHARACTERISTICS_CONFIGURATION){ 18455cf1669fSMatthias Ringwald gatt_client->client_characteristic_configuration_handle = little_endian_read_16(packet, offset); 18465cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_WRITE_CLIENT_CHARACTERISTIC_CONFIGURATION; 18475cf1669fSMatthias Ringwald log_info("CCC found %x", gatt_client->client_characteristic_configuration_handle); 1848abdc9fb5SMatthias Ringwald break; 1849abdc9fb5SMatthias Ringwald } 1850abdc9fb5SMatthias Ringwald offset += pair_size; 1851abdc9fb5SMatthias Ringwald } 1852abdc9fb5SMatthias Ringwald } 18535cf1669fSMatthias Ringwald if (is_query_done(gatt_client, last_descriptor_handle)){ 1854abdc9fb5SMatthias Ringwald 1855abdc9fb5SMatthias Ringwald } else { 1856abdc9fb5SMatthias Ringwald // next 18575cf1669fSMatthias Ringwald gatt_client->start_group_handle = last_descriptor_handle + 1; 18585cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_FIND_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY; 1859abdc9fb5SMatthias Ringwald } 1860abdc9fb5SMatthias Ringwald break; 1861abdc9fb5SMatthias Ringwald } 1862abdc9fb5SMatthias Ringwald #endif 18635cf1669fSMatthias Ringwald report_gatt_all_characteristic_descriptors(gatt_client, &packet[2], size - 2u, pair_size); 18645cf1669fSMatthias Ringwald trigger_next_characteristic_descriptor_query(gatt_client, last_descriptor_handle); 18655611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 18663deb3ec6SMatthias Ringwald break; 18673deb3ec6SMatthias Ringwald } 18683deb3ec6SMatthias Ringwald 18693deb3ec6SMatthias Ringwald case ATT_WRITE_RESPONSE: 18702da0d963SMatthias Ringwald gatt_client_handle_att_write_response(gatt_client); 18713deb3ec6SMatthias Ringwald break; 18723deb3ec6SMatthias Ringwald 18733deb3ec6SMatthias Ringwald case ATT_READ_BLOB_RESPONSE: { 18744ea43905SMatthias Ringwald uint16_t received_blob_length = size - 1u; 1875052dc82aSMatthias Ringwald switch (gatt_client->state) { 18763deb3ec6SMatthias Ringwald case P_W4_READ_BLOB_RESULT: 1877cf8e5718SMatthias Ringwald report_gatt_long_characteristic_value_blob(gatt_client, gatt_client->attribute_handle, &packet[1], 1878cf8e5718SMatthias Ringwald received_blob_length, gatt_client->attribute_offset); 18795cf1669fSMatthias Ringwald trigger_next_blob_query(gatt_client, P_W2_SEND_READ_BLOB_QUERY, received_blob_length); 18805611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 18813deb3ec6SMatthias Ringwald break; 18823deb3ec6SMatthias Ringwald case P_W4_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_RESULT: 18835cf1669fSMatthias Ringwald report_gatt_long_characteristic_descriptor(gatt_client, gatt_client->attribute_handle, 18843deb3ec6SMatthias Ringwald &packet[1], received_blob_length, 18855cf1669fSMatthias Ringwald gatt_client->attribute_offset); 1886cf8e5718SMatthias Ringwald trigger_next_blob_query(gatt_client, P_W2_SEND_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_QUERY, 1887cf8e5718SMatthias Ringwald received_blob_length); 18885611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 18893deb3ec6SMatthias Ringwald break; 18903deb3ec6SMatthias Ringwald default: 18913deb3ec6SMatthias Ringwald break; 18923deb3ec6SMatthias Ringwald } 18933deb3ec6SMatthias Ringwald break; 18943deb3ec6SMatthias Ringwald } 18953deb3ec6SMatthias Ringwald case ATT_PREPARE_WRITE_RESPONSE: 1896052dc82aSMatthias Ringwald switch (gatt_client->state) { 18973deb3ec6SMatthias Ringwald case P_W4_PREPARE_WRITE_SINGLE_RESULT: 18985cf1669fSMatthias Ringwald if (is_value_valid(gatt_client, packet, size)) { 18994740230fSMatthias Ringwald att_status = ATT_ERROR_SUCCESS; 19003deb3ec6SMatthias Ringwald } else { 19014740230fSMatthias Ringwald att_status = ATT_ERROR_DATA_MISMATCH; 19023deb3ec6SMatthias Ringwald } 1903526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, att_status); 19043deb3ec6SMatthias Ringwald break; 19053deb3ec6SMatthias Ringwald 19063deb3ec6SMatthias Ringwald case P_W4_PREPARE_WRITE_RESULT: { 19075cf1669fSMatthias Ringwald gatt_client->attribute_offset = little_endian_read_16(packet, 3); 19085cf1669fSMatthias Ringwald trigger_next_prepare_write_query(gatt_client, P_W2_PREPARE_WRITE, P_W2_EXECUTE_PREPARED_WRITE); 19095611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 19103deb3ec6SMatthias Ringwald break; 19113deb3ec6SMatthias Ringwald } 19123deb3ec6SMatthias Ringwald case P_W4_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT: { 19135cf1669fSMatthias Ringwald gatt_client->attribute_offset = little_endian_read_16(packet, 3); 1914cf8e5718SMatthias Ringwald trigger_next_prepare_write_query(gatt_client, P_W2_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR, 1915cf8e5718SMatthias Ringwald P_W2_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR); 19165611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 19173deb3ec6SMatthias Ringwald break; 19183deb3ec6SMatthias Ringwald } 19193deb3ec6SMatthias Ringwald case P_W4_PREPARE_RELIABLE_WRITE_RESULT: { 19205cf1669fSMatthias Ringwald if (is_value_valid(gatt_client, packet, size)) { 19215cf1669fSMatthias Ringwald gatt_client->attribute_offset = little_endian_read_16(packet, 3); 1922cf8e5718SMatthias Ringwald trigger_next_prepare_write_query(gatt_client, P_W2_PREPARE_RELIABLE_WRITE, 1923cf8e5718SMatthias Ringwald P_W2_EXECUTE_PREPARED_WRITE); 19245611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 19253deb3ec6SMatthias Ringwald break; 19263deb3ec6SMatthias Ringwald } 1927052dc82aSMatthias Ringwald gatt_client->state = P_W2_CANCEL_PREPARED_WRITE_DATA_MISMATCH; 19283deb3ec6SMatthias Ringwald break; 19293deb3ec6SMatthias Ringwald } 19303deb3ec6SMatthias Ringwald default: 19313deb3ec6SMatthias Ringwald break; 19323deb3ec6SMatthias Ringwald } 19333deb3ec6SMatthias Ringwald break; 19343deb3ec6SMatthias Ringwald 19353deb3ec6SMatthias Ringwald case ATT_EXECUTE_WRITE_RESPONSE: 1936052dc82aSMatthias Ringwald switch (gatt_client->state) { 19373deb3ec6SMatthias Ringwald case P_W4_EXECUTE_PREPARED_WRITE_RESULT: 1938526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 19393deb3ec6SMatthias Ringwald break; 19403deb3ec6SMatthias Ringwald case P_W4_CANCEL_PREPARED_WRITE_RESULT: 1941526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 19423deb3ec6SMatthias Ringwald break; 19433deb3ec6SMatthias Ringwald case P_W4_CANCEL_PREPARED_WRITE_DATA_MISMATCH_RESULT: 1944526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_DATA_MISMATCH); 19453deb3ec6SMatthias Ringwald break; 19463deb3ec6SMatthias Ringwald case P_W4_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT: 1947526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 19483deb3ec6SMatthias Ringwald break; 19493deb3ec6SMatthias Ringwald default: 19503deb3ec6SMatthias Ringwald break; 19513deb3ec6SMatthias Ringwald 19523deb3ec6SMatthias Ringwald } 19533deb3ec6SMatthias Ringwald break; 19543deb3ec6SMatthias Ringwald 19553deb3ec6SMatthias Ringwald case ATT_READ_MULTIPLE_RESPONSE: 1956052dc82aSMatthias Ringwald switch (gatt_client->state) { 19573deb3ec6SMatthias Ringwald case P_W4_READ_MULTIPLE_RESPONSE: 19585cf1669fSMatthias Ringwald report_gatt_characteristic_value(gatt_client, 0u, &packet[1], size - 1u); 1959526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 19603deb3ec6SMatthias Ringwald break; 19613deb3ec6SMatthias Ringwald default: 19623deb3ec6SMatthias Ringwald break; 19633deb3ec6SMatthias Ringwald } 19643deb3ec6SMatthias Ringwald break; 19653deb3ec6SMatthias Ringwald 1966f125a8efSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 1967f125a8efSMatthias Ringwald case ATT_READ_MULTIPLE_VARIABLE_RSP: 1968052dc82aSMatthias Ringwald switch (gatt_client->state) { 1969169b9876SMatthias Ringwald case P_W4_READ_MULTIPLE_VARIABLE_RESPONSE: 1970f125a8efSMatthias Ringwald report_gatt_characteristic_value(gatt_client, 0u, &packet[1], size - 1u); 1971f125a8efSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 1972f125a8efSMatthias Ringwald break; 1973f125a8efSMatthias Ringwald default: 1974f125a8efSMatthias Ringwald break; 1975f125a8efSMatthias Ringwald } 1976f125a8efSMatthias Ringwald break; 1977f125a8efSMatthias Ringwald #endif 1978f125a8efSMatthias Ringwald 19793deb3ec6SMatthias Ringwald case ATT_ERROR_RESPONSE: 19804ea43905SMatthias Ringwald if (size < 5u) return; 19814740230fSMatthias Ringwald att_status = packet[4]; 19824740230fSMatthias Ringwald switch (att_status) { 19833deb3ec6SMatthias Ringwald case ATT_ERROR_ATTRIBUTE_NOT_FOUND: { 1984052dc82aSMatthias Ringwald switch (gatt_client->state) { 19853deb3ec6SMatthias Ringwald case P_W4_SERVICE_QUERY_RESULT: 19863deb3ec6SMatthias Ringwald case P_W4_SERVICE_WITH_UUID_RESULT: 19873deb3ec6SMatthias Ringwald case P_W4_INCLUDED_SERVICE_QUERY_RESULT: 19883deb3ec6SMatthias Ringwald case P_W4_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY_RESULT: 1989526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 19903deb3ec6SMatthias Ringwald break; 19913deb3ec6SMatthias Ringwald case P_W4_ALL_CHARACTERISTICS_OF_SERVICE_QUERY_RESULT: 19923deb3ec6SMatthias Ringwald case P_W4_CHARACTERISTIC_WITH_UUID_QUERY_RESULT: 199323d583b8SMatthias Ringwald report_gatt_characteristic_end_found(gatt_client, gatt_client->end_group_handle); 1994526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 19953deb3ec6SMatthias Ringwald break; 19963deb3ec6SMatthias Ringwald case P_W4_READ_BY_TYPE_RESPONSE: 19975cf1669fSMatthias Ringwald if (gatt_client->start_group_handle == gatt_client->query_start_handle) { 19984740230fSMatthias Ringwald att_status = ATT_ERROR_ATTRIBUTE_NOT_FOUND; 19993deb3ec6SMatthias Ringwald } else { 20004740230fSMatthias Ringwald att_status = ATT_ERROR_SUCCESS; 20013deb3ec6SMatthias Ringwald } 2002526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, att_status); 20033deb3ec6SMatthias Ringwald break; 20043deb3ec6SMatthias Ringwald default: 20054740230fSMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, att_status); 20063deb3ec6SMatthias Ringwald break; 20073deb3ec6SMatthias Ringwald } 20083deb3ec6SMatthias Ringwald break; 20093deb3ec6SMatthias Ringwald } 2010f4b33574SMatthias Ringwald 2011f4b33574SMatthias Ringwald #ifdef ENABLE_GATT_CLIENT_PAIRING 2012f4b33574SMatthias Ringwald 2013f4b33574SMatthias Ringwald case ATT_ERROR_INSUFFICIENT_AUTHENTICATION: 2014f4b33574SMatthias Ringwald case ATT_ERROR_INSUFFICIENT_ENCRYPTION_KEY_SIZE: 2015a0e0c2beSMatthias Ringwald case ATT_ERROR_INSUFFICIENT_ENCRYPTION: { 2016a0e0c2beSMatthias Ringwald 2017f4b33574SMatthias Ringwald // security too low 20185cf1669fSMatthias Ringwald if (gatt_client->security_counter > 0) { 20194740230fSMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, att_status); 2020f4b33574SMatthias Ringwald break; 2021f4b33574SMatthias Ringwald } 2022f4b33574SMatthias Ringwald // start security 20235cf1669fSMatthias Ringwald gatt_client->security_counter++; 2024f4b33574SMatthias Ringwald 2025f4b33574SMatthias Ringwald // setup action 2026f4b33574SMatthias Ringwald int retry = 1; 2027052dc82aSMatthias Ringwald switch (gatt_client->state){ 2028f4b33574SMatthias Ringwald case P_W4_READ_CHARACTERISTIC_VALUE_RESULT: 2029052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_CHARACTERISTIC_VALUE_QUERY ; 2030f4b33574SMatthias Ringwald break; 2031f4b33574SMatthias Ringwald case P_W4_READ_BLOB_RESULT: 2032052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_BLOB_QUERY; 2033f4b33574SMatthias Ringwald break; 2034f4b33574SMatthias Ringwald case P_W4_READ_BY_TYPE_RESPONSE: 2035052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_BY_TYPE_REQUEST; 2036f4b33574SMatthias Ringwald break; 2037f4b33574SMatthias Ringwald case P_W4_READ_MULTIPLE_RESPONSE: 2038052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_MULTIPLE_REQUEST; 2039f4b33574SMatthias Ringwald break; 2040f125a8efSMatthias Ringwald case P_W4_READ_MULTIPLE_VARIABLE_RESPONSE: 2041052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_MULTIPLE_VARIABLE_REQUEST; 2042f125a8efSMatthias Ringwald break; 2043f4b33574SMatthias Ringwald case P_W4_WRITE_CHARACTERISTIC_VALUE_RESULT: 2044052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_WRITE_CHARACTERISTIC_VALUE; 2045f4b33574SMatthias Ringwald break; 2046f4b33574SMatthias Ringwald case P_W4_PREPARE_WRITE_RESULT: 2047052dc82aSMatthias Ringwald gatt_client->state = P_W2_PREPARE_WRITE; 2048f4b33574SMatthias Ringwald break; 2049f4b33574SMatthias Ringwald case P_W4_PREPARE_WRITE_SINGLE_RESULT: 2050052dc82aSMatthias Ringwald gatt_client->state = P_W2_PREPARE_WRITE_SINGLE; 2051f4b33574SMatthias Ringwald break; 2052f4b33574SMatthias Ringwald case P_W4_PREPARE_RELIABLE_WRITE_RESULT: 2053052dc82aSMatthias Ringwald gatt_client->state = P_W2_PREPARE_RELIABLE_WRITE; 2054f4b33574SMatthias Ringwald break; 2055f4b33574SMatthias Ringwald case P_W4_EXECUTE_PREPARED_WRITE_RESULT: 2056052dc82aSMatthias Ringwald gatt_client->state = P_W2_EXECUTE_PREPARED_WRITE; 2057f4b33574SMatthias Ringwald break; 2058f4b33574SMatthias Ringwald case P_W4_CANCEL_PREPARED_WRITE_RESULT: 2059052dc82aSMatthias Ringwald gatt_client->state = P_W2_CANCEL_PREPARED_WRITE; 2060f4b33574SMatthias Ringwald break; 2061f4b33574SMatthias Ringwald case P_W4_CANCEL_PREPARED_WRITE_DATA_MISMATCH_RESULT: 2062052dc82aSMatthias Ringwald gatt_client->state = P_W2_CANCEL_PREPARED_WRITE_DATA_MISMATCH; 2063f4b33574SMatthias Ringwald break; 2064f4b33574SMatthias Ringwald case P_W4_READ_CHARACTERISTIC_DESCRIPTOR_RESULT: 2065052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_CHARACTERISTIC_DESCRIPTOR_QUERY; 2066f4b33574SMatthias Ringwald break; 2067f4b33574SMatthias Ringwald case P_W4_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_RESULT: 2068052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_QUERY; 2069f4b33574SMatthias Ringwald break; 2070f4b33574SMatthias Ringwald case P_W4_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT: 2071052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_WRITE_CHARACTERISTIC_DESCRIPTOR; 2072f4b33574SMatthias Ringwald break; 2073f4b33574SMatthias Ringwald case P_W4_CLIENT_CHARACTERISTIC_CONFIGURATION_RESULT: 2074052dc82aSMatthias Ringwald gatt_client->state = P_W2_WRITE_CLIENT_CHARACTERISTIC_CONFIGURATION; 2075f4b33574SMatthias Ringwald break; 2076f4b33574SMatthias Ringwald case P_W4_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT: 2077052dc82aSMatthias Ringwald gatt_client->state = P_W2_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR; 2078f4b33574SMatthias Ringwald break; 2079f4b33574SMatthias Ringwald case P_W4_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT: 2080052dc82aSMatthias Ringwald gatt_client->state = P_W2_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR; 2081f4b33574SMatthias Ringwald break; 2082f4b33574SMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 2083f4b33574SMatthias Ringwald case P_W4_SEND_SINGED_WRITE_DONE: 2084052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_SIGNED_WRITE; 2085f4b33574SMatthias Ringwald break; 2086f4b33574SMatthias Ringwald #endif 2087f4b33574SMatthias Ringwald default: 2088052dc82aSMatthias Ringwald log_info("retry not supported for state %x", gatt_client->state); 2089f4b33574SMatthias Ringwald retry = 0; 2090f4b33574SMatthias Ringwald break; 2091f4b33574SMatthias Ringwald } 2092f4b33574SMatthias Ringwald 2093f4b33574SMatthias Ringwald if (!retry) { 20944740230fSMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, att_status); 2095f4b33574SMatthias Ringwald break; 2096f4b33574SMatthias Ringwald } 2097f4b33574SMatthias Ringwald 2098f4b33574SMatthias Ringwald log_info("security error, start pairing"); 2099f4b33574SMatthias Ringwald 2100f060f108SMatthias Ringwald // start pairing for higher security level 21012197dbafSMatthias Ringwald gatt_client->wait_for_authentication_complete = true; 21024740230fSMatthias Ringwald gatt_client->pending_error_code = att_status; 21035cf1669fSMatthias Ringwald sm_request_pairing(gatt_client->con_handle); 2104f4b33574SMatthias Ringwald break; 2105a0e0c2beSMatthias Ringwald } 2106f4b33574SMatthias Ringwald #endif 2107f4b33574SMatthias Ringwald 2108f4b33574SMatthias Ringwald // nothing we can do about that 2109f4b33574SMatthias Ringwald case ATT_ERROR_INSUFFICIENT_AUTHORIZATION: 21103deb3ec6SMatthias Ringwald default: 21114740230fSMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, att_status); 21123deb3ec6SMatthias Ringwald break; 21133deb3ec6SMatthias Ringwald } 21143deb3ec6SMatthias Ringwald break; 21153deb3ec6SMatthias Ringwald 21163deb3ec6SMatthias Ringwald default: 21173deb3ec6SMatthias Ringwald log_info("ATT Handler, unhandled response type 0x%02x", packet[0]); 21183deb3ec6SMatthias Ringwald break; 21193deb3ec6SMatthias Ringwald } 2120cf8e5718SMatthias Ringwald } 2121cf8e5718SMatthias Ringwald 2122cf8e5718SMatthias Ringwald static void gatt_client_att_packet_handler(uint8_t packet_type, uint16_t handle, uint8_t *packet, uint16_t size) { 2123cf8e5718SMatthias Ringwald gatt_client_t *gatt_client; 2124180cbe79SMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC 2125b1da4983SMatthias Ringwald uint8_t status; 2126b1da4983SMatthias Ringwald hci_connection_t * hci_connection; 2127180cbe79SMatthias Ringwald hci_con_handle_t con_handle; 2128180cbe79SMatthias Ringwald #endif 2129180cbe79SMatthias Ringwald 2130cf8e5718SMatthias Ringwald if (size < 1u) return; 213159b5e157SMatthias Ringwald switch (packet_type){ 213259b5e157SMatthias Ringwald case HCI_EVENT_PACKET: 213359b5e157SMatthias Ringwald switch (hci_event_packet_get_type(packet)) { 213459b5e157SMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC 213559b5e157SMatthias Ringwald case L2CAP_EVENT_CHANNEL_OPENED: 213659b5e157SMatthias Ringwald status = l2cap_event_channel_opened_get_status(packet); 213759b5e157SMatthias Ringwald gatt_client = gatt_client_get_context_for_l2cap_cid(l2cap_event_channel_opened_get_local_cid(packet)); 2138*de5a18caSMatthias Ringwald if (gatt_client != NULL){ 2139180cbe79SMatthias Ringwald con_handle = l2cap_event_channel_opened_get_handle(packet); 2140180cbe79SMatthias Ringwald hci_connection = hci_connection_for_handle(con_handle); 2141ab6f9d8fSMatthias Ringwald if (status == L2CAP_CONNECTION_RESPONSE_RESULT_REFUSED_RESOURCES){ 2142ab6f9d8fSMatthias Ringwald if ((hci_connection != NULL) && hci_connection->att_server.incoming_connection_request) { 2143180cbe79SMatthias Ringwald log_info("Collision, retry in 100ms"); 2144180cbe79SMatthias Ringwald gatt_client->state = P_W2_L2CAP_CONNECT; 2145180cbe79SMatthias Ringwald // set timer for retry 2146b1da4983SMatthias Ringwald btstack_run_loop_set_timer(&gatt_client->gc_timeout, GATT_CLIENT_COLLISION_BACKOFF_MS); 2147180cbe79SMatthias Ringwald btstack_run_loop_set_timer_handler(&gatt_client->gc_timeout, gatt_client_classic_retry); 2148180cbe79SMatthias Ringwald btstack_run_loop_add_timer(&gatt_client->gc_timeout); 2149180cbe79SMatthias Ringwald break; 2150180cbe79SMatthias Ringwald } 2151ab6f9d8fSMatthias Ringwald } 215259b5e157SMatthias Ringwald // if status != 0, gatt_client will be discarded 2153052dc82aSMatthias Ringwald gatt_client->state = P_READY; 215459b5e157SMatthias Ringwald gatt_client->con_handle = l2cap_event_channel_opened_get_handle(packet); 215559b5e157SMatthias Ringwald gatt_client->mtu = l2cap_event_channel_opened_get_remote_mtu(packet); 215659b5e157SMatthias Ringwald gatt_client_classic_handle_connected(gatt_client, status); 2157*de5a18caSMatthias Ringwald } 215859b5e157SMatthias Ringwald break; 215959b5e157SMatthias Ringwald case L2CAP_EVENT_CHANNEL_CLOSED: 216059b5e157SMatthias Ringwald gatt_client = gatt_client_get_context_for_l2cap_cid(l2cap_event_channel_closed_get_local_cid(packet)); 2161*de5a18caSMatthias Ringwald if (gatt_client != NULL){ 216259b5e157SMatthias Ringwald // discard gatt client object 216359b5e157SMatthias Ringwald gatt_client_classic_handle_disconnected(gatt_client); 2164*de5a18caSMatthias Ringwald } 216559b5e157SMatthias Ringwald break; 216659b5e157SMatthias Ringwald #endif 2167cf8e5718SMatthias Ringwald case L2CAP_EVENT_CAN_SEND_NOW: 21683deb3ec6SMatthias Ringwald gatt_client_run(); 2169cf8e5718SMatthias Ringwald break; 2170cf8e5718SMatthias Ringwald // att_server has negotiated the mtu for this connection, cache if context exists 2171cf8e5718SMatthias Ringwald case ATT_EVENT_MTU_EXCHANGE_COMPLETE: 2172cf8e5718SMatthias Ringwald if (size < 6u) break; 2173cf8e5718SMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(handle); 2174*de5a18caSMatthias Ringwald if (gatt_client != NULL) { 2175cf8e5718SMatthias Ringwald gatt_client->mtu = little_endian_read_16(packet, 4); 2176*de5a18caSMatthias Ringwald } 2177cf8e5718SMatthias Ringwald break; 2178cf8e5718SMatthias Ringwald default: 2179cf8e5718SMatthias Ringwald break; 2180cf8e5718SMatthias Ringwald } 218159b5e157SMatthias Ringwald break; 2182cf8e5718SMatthias Ringwald 218359b5e157SMatthias Ringwald case ATT_DATA_PACKET: 2184cf8e5718SMatthias Ringwald // special cases: notifications & indications motivate creating context 2185cf8e5718SMatthias Ringwald switch (packet[0]) { 2186cf8e5718SMatthias Ringwald case ATT_HANDLE_VALUE_NOTIFICATION: 2187cf8e5718SMatthias Ringwald case ATT_HANDLE_VALUE_INDICATION: 2188cf8e5718SMatthias Ringwald gatt_client_provide_context_for_handle(handle, &gatt_client); 2189cf8e5718SMatthias Ringwald break; 2190cf8e5718SMatthias Ringwald default: 2191cf8e5718SMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(handle); 2192cf8e5718SMatthias Ringwald break; 2193cf8e5718SMatthias Ringwald } 2194cf8e5718SMatthias Ringwald 2195cf8e5718SMatthias Ringwald if (gatt_client != NULL) { 2196cf8e5718SMatthias Ringwald gatt_client_handle_att_response(gatt_client, packet, size); 2197cf8e5718SMatthias Ringwald gatt_client_run(); 2198cf8e5718SMatthias Ringwald } 219959b5e157SMatthias Ringwald break; 220059b5e157SMatthias Ringwald 220159b5e157SMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC 220259b5e157SMatthias Ringwald case L2CAP_DATA_PACKET: 220359b5e157SMatthias Ringwald gatt_client = gatt_client_get_context_for_l2cap_cid(handle); 2204*de5a18caSMatthias Ringwald if (gatt_client != NULL){ 220559b5e157SMatthias Ringwald gatt_client_handle_att_response(gatt_client, packet, size); 220659b5e157SMatthias Ringwald gatt_client_run(); 2207*de5a18caSMatthias Ringwald } 220859b5e157SMatthias Ringwald break; 220959b5e157SMatthias Ringwald #endif 221059b5e157SMatthias Ringwald 221159b5e157SMatthias Ringwald default: 221259b5e157SMatthias Ringwald break; 221359b5e157SMatthias Ringwald } 22143deb3ec6SMatthias Ringwald } 22153deb3ec6SMatthias Ringwald 22167a766ebfSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 22173deb3ec6SMatthias Ringwald static void att_signed_write_handle_cmac_result(uint8_t hash[8]){ 2218665d90f2SMatthias Ringwald btstack_linked_list_iterator_t it; 2219665d90f2SMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client_connections); 2220665d90f2SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 22215cf1669fSMatthias Ringwald gatt_client_t * gatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it); 2222052dc82aSMatthias Ringwald if (gatt_client->state == P_W4_CMAC_RESULT){ 22233deb3ec6SMatthias Ringwald // store result 22245cf1669fSMatthias Ringwald (void)memcpy(gatt_client->cmac, hash, 8); 22255cf1669fSMatthias Ringwald // reverse_64(hash, gatt_client->cmac); 2226052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_SIGNED_WRITE; 22273deb3ec6SMatthias Ringwald gatt_client_run(); 22283deb3ec6SMatthias Ringwald return; 22293deb3ec6SMatthias Ringwald } 22303deb3ec6SMatthias Ringwald } 22313deb3ec6SMatthias Ringwald } 22323deb3ec6SMatthias Ringwald 2233b45b7749SMilanka 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){ 223440faeb84SMilanka Ringwald gatt_client_t * gatt_client; 223540faeb84SMilanka Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 223640faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 223740faeb84SMilanka Ringwald return status; 223840faeb84SMilanka Ringwald } 223940faeb84SMilanka Ringwald if (is_ready(gatt_client) == 0){ 224040faeb84SMilanka Ringwald return GATT_CLIENT_IN_WRONG_STATE; 224140faeb84SMilanka Ringwald } 22423deb3ec6SMatthias Ringwald 22435cf1669fSMatthias Ringwald gatt_client->callback = callback; 2244b45b7749SMilanka Ringwald gatt_client->attribute_handle = value_handle; 22455cf1669fSMatthias Ringwald gatt_client->attribute_length = message_len; 22465cf1669fSMatthias Ringwald gatt_client->attribute_value = message; 2247052dc82aSMatthias Ringwald gatt_client->state = P_W4_IDENTITY_RESOLVING; 22483deb3ec6SMatthias Ringwald gatt_client_run(); 224925b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 22503deb3ec6SMatthias Ringwald } 22517a766ebfSMatthias Ringwald #endif 22523deb3ec6SMatthias Ringwald 2253711e6c80SMatthias Ringwald uint8_t gatt_client_discover_primary_services(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 225440faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2255de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 225640faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 225740faeb84SMilanka Ringwald return status; 225840faeb84SMilanka Ringwald } 22593deb3ec6SMatthias Ringwald 22605cf1669fSMatthias Ringwald gatt_client->callback = callback; 22615cf1669fSMatthias Ringwald gatt_client->start_group_handle = 0x0001; 22625cf1669fSMatthias Ringwald gatt_client->end_group_handle = 0xffff; 2263052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_SERVICE_QUERY; 22648d1f34d3SMatheus Eduardo Garbelini gatt_client->uuid16 = GATT_PRIMARY_SERVICE_UUID; 22653deb3ec6SMatthias Ringwald gatt_client_run(); 226625b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 22673deb3ec6SMatthias Ringwald } 22683deb3ec6SMatthias Ringwald 22698d1f34d3SMatheus Eduardo Garbelini uint8_t gatt_client_discover_secondary_services(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 227040faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2271de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 227240faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 227340faeb84SMilanka Ringwald return status; 227440faeb84SMilanka Ringwald } 22758d1f34d3SMatheus Eduardo Garbelini 22768d1f34d3SMatheus Eduardo Garbelini gatt_client->callback = callback; 22778d1f34d3SMatheus Eduardo Garbelini gatt_client->start_group_handle = 0x0001; 22788d1f34d3SMatheus Eduardo Garbelini gatt_client->end_group_handle = 0xffff; 2279052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_SERVICE_QUERY; 22808d1f34d3SMatheus Eduardo Garbelini gatt_client->uuid16 = GATT_SECONDARY_SERVICE_UUID; 22818d1f34d3SMatheus Eduardo Garbelini gatt_client_run(); 22828d1f34d3SMatheus Eduardo Garbelini return ERROR_CODE_SUCCESS; 22838d1f34d3SMatheus Eduardo Garbelini } 22843deb3ec6SMatthias Ringwald 2285711e6c80SMatthias Ringwald uint8_t gatt_client_discover_primary_services_by_uuid16(btstack_packet_handler_t callback, hci_con_handle_t con_handle, uint16_t uuid16){ 228640faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2287de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 228840faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 228940faeb84SMilanka Ringwald return status; 229040faeb84SMilanka Ringwald } 22913deb3ec6SMatthias Ringwald 22925cf1669fSMatthias Ringwald gatt_client->callback = callback; 22935cf1669fSMatthias Ringwald gatt_client->start_group_handle = 0x0001; 22945cf1669fSMatthias Ringwald gatt_client->end_group_handle = 0xffff; 2295052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_SERVICE_WITH_UUID_QUERY; 22965cf1669fSMatthias Ringwald gatt_client->uuid16 = uuid16; 22975cf1669fSMatthias Ringwald uuid_add_bluetooth_prefix((uint8_t*) &(gatt_client->uuid128), gatt_client->uuid16); 22983deb3ec6SMatthias Ringwald gatt_client_run(); 229925b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 23003deb3ec6SMatthias Ringwald } 23013deb3ec6SMatthias Ringwald 2302711e6c80SMatthias 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){ 230340faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2304de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 230540faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 230640faeb84SMilanka Ringwald return status; 230740faeb84SMilanka Ringwald } 23083deb3ec6SMatthias Ringwald 23095cf1669fSMatthias Ringwald gatt_client->callback = callback; 23105cf1669fSMatthias Ringwald gatt_client->start_group_handle = 0x0001; 23115cf1669fSMatthias Ringwald gatt_client->end_group_handle = 0xffff; 23125cf1669fSMatthias Ringwald gatt_client->uuid16 = 0; 23135cf1669fSMatthias Ringwald (void)memcpy(gatt_client->uuid128, uuid128, 16); 2314052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_SERVICE_WITH_UUID_QUERY; 23153deb3ec6SMatthias Ringwald gatt_client_run(); 231625b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 23173deb3ec6SMatthias Ringwald } 23183deb3ec6SMatthias Ringwald 2319711e6c80SMatthias 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){ 232040faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2321de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 232240faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 232340faeb84SMilanka Ringwald return status; 232440faeb84SMilanka Ringwald } 23253deb3ec6SMatthias Ringwald 23265cf1669fSMatthias Ringwald gatt_client->callback = callback; 23275cf1669fSMatthias Ringwald gatt_client->start_group_handle = service->start_group_handle; 23285cf1669fSMatthias Ringwald gatt_client->end_group_handle = service->end_group_handle; 2329ab415e75SMatthias Ringwald gatt_client->filter_with_uuid = false; 23305cf1669fSMatthias Ringwald gatt_client->characteristic_start_handle = 0; 2331052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_ALL_CHARACTERISTICS_OF_SERVICE_QUERY; 23323deb3ec6SMatthias Ringwald gatt_client_run(); 233325b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 23343deb3ec6SMatthias Ringwald } 23353deb3ec6SMatthias Ringwald 2336711e6c80SMatthias 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){ 233740faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2338de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 233940faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 234040faeb84SMilanka Ringwald return status; 234140faeb84SMilanka Ringwald } 2342de27733dSMatthias Ringwald 23435cf1669fSMatthias Ringwald gatt_client->callback = callback; 23445cf1669fSMatthias Ringwald gatt_client->start_group_handle = service->start_group_handle; 23455cf1669fSMatthias Ringwald gatt_client->end_group_handle = service->end_group_handle; 2346052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_INCLUDED_SERVICE_QUERY; 23473deb3ec6SMatthias Ringwald 23483deb3ec6SMatthias Ringwald gatt_client_run(); 234925b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 23503deb3ec6SMatthias Ringwald } 23513deb3ec6SMatthias Ringwald 2352711e6c80SMatthias 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){ 235340faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2354de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 235540faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 235640faeb84SMilanka Ringwald return status; 235740faeb84SMilanka Ringwald } 23583deb3ec6SMatthias Ringwald 23595cf1669fSMatthias Ringwald gatt_client->callback = callback; 23605cf1669fSMatthias Ringwald gatt_client->start_group_handle = start_handle; 23615cf1669fSMatthias Ringwald gatt_client->end_group_handle = end_handle; 2362ab415e75SMatthias Ringwald gatt_client->filter_with_uuid = true; 23635cf1669fSMatthias Ringwald gatt_client->uuid16 = uuid16; 23645cf1669fSMatthias Ringwald uuid_add_bluetooth_prefix((uint8_t*) &(gatt_client->uuid128), uuid16); 23655cf1669fSMatthias Ringwald gatt_client->characteristic_start_handle = 0; 2366052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_CHARACTERISTIC_WITH_UUID_QUERY; 23673deb3ec6SMatthias Ringwald gatt_client_run(); 236825b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 23693deb3ec6SMatthias Ringwald } 23703deb3ec6SMatthias Ringwald 2371045d700dSDavid 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){ 237240faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2373de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 237440faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 237540faeb84SMilanka Ringwald return status; 237640faeb84SMilanka Ringwald } 23773deb3ec6SMatthias Ringwald 23785cf1669fSMatthias Ringwald gatt_client->callback = callback; 23795cf1669fSMatthias Ringwald gatt_client->start_group_handle = start_handle; 23805cf1669fSMatthias Ringwald gatt_client->end_group_handle = end_handle; 2381ab415e75SMatthias Ringwald gatt_client->filter_with_uuid = true; 23825cf1669fSMatthias Ringwald gatt_client->uuid16 = 0; 23835cf1669fSMatthias Ringwald (void)memcpy(gatt_client->uuid128, uuid128, 16); 23845cf1669fSMatthias Ringwald gatt_client->characteristic_start_handle = 0; 2385052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_CHARACTERISTIC_WITH_UUID_QUERY; 23863deb3ec6SMatthias Ringwald gatt_client_run(); 238725b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 23883deb3ec6SMatthias Ringwald } 23893deb3ec6SMatthias Ringwald 23903deb3ec6SMatthias Ringwald 2391b45b7749SMilanka 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){ 2392b45b7749SMilanka Ringwald return gatt_client_discover_characteristics_for_handle_range_by_uuid16(callback, con_handle, service->start_group_handle, service->end_group_handle, uuid16); 23933deb3ec6SMatthias Ringwald } 23943deb3ec6SMatthias Ringwald 2395b45b7749SMilanka 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){ 2396b45b7749SMilanka Ringwald return gatt_client_discover_characteristics_for_handle_range_by_uuid128(callback, con_handle, service->start_group_handle, service->end_group_handle, uuid128); 23973deb3ec6SMatthias Ringwald } 23983deb3ec6SMatthias Ringwald 2399711e6c80SMatthias Ringwald uint8_t gatt_client_discover_characteristic_descriptors(btstack_packet_handler_t callback, hci_con_handle_t con_handle, gatt_client_characteristic_t * characteristic){ 240040faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2401de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 240240faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 240340faeb84SMilanka Ringwald return status; 240440faeb84SMilanka Ringwald } 24053deb3ec6SMatthias Ringwald 2406544a5845SMatthias Ringwald // check if there is space for characteristics descriptors 2407544a5845SMatthias Ringwald if (characteristic->end_handle > characteristic->value_handle){ 24085cf1669fSMatthias Ringwald gatt_client->callback = callback; 24095cf1669fSMatthias Ringwald gatt_client->start_group_handle = characteristic->value_handle + 1u; 24105cf1669fSMatthias Ringwald gatt_client->end_group_handle = characteristic->end_handle; 2411052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY; 24123deb3ec6SMatthias Ringwald gatt_client_run(); 2413544a5845SMatthias Ringwald } else { 2414544a5845SMatthias Ringwald // schedule gatt complete event on next run loop iteration otherwise 2415544a5845SMatthias Ringwald gatt_client->state = P_W2_EMIT_QUERY_COMPLETE_EVENT; 2416544a5845SMatthias Ringwald gatt_client_deferred_event_emit.callback = gatt_client_emit_events; 2417544a5845SMatthias Ringwald btstack_run_loop_execute_on_main_thread(&gatt_client_deferred_event_emit); 2418544a5845SMatthias Ringwald } 241925b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 24203deb3ec6SMatthias Ringwald } 24213deb3ec6SMatthias Ringwald 2422711e6c80SMatthias 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){ 242340faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2424de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 242540faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 242640faeb84SMilanka Ringwald return status; 242740faeb84SMilanka Ringwald } 24283deb3ec6SMatthias Ringwald 24295cf1669fSMatthias Ringwald gatt_client->callback = callback; 24305cf1669fSMatthias Ringwald gatt_client->attribute_handle = value_handle; 24315cf1669fSMatthias Ringwald gatt_client->attribute_offset = 0; 2432052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_CHARACTERISTIC_VALUE_QUERY; 24333deb3ec6SMatthias Ringwald gatt_client_run(); 243425b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 24353deb3ec6SMatthias Ringwald } 24363deb3ec6SMatthias Ringwald 2437711e6c80SMatthias 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){ 243840faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2439de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 244040faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 244140faeb84SMilanka Ringwald return status; 244240faeb84SMilanka Ringwald } 24433deb3ec6SMatthias Ringwald 24445cf1669fSMatthias Ringwald gatt_client->callback = callback; 24455cf1669fSMatthias Ringwald gatt_client->start_group_handle = start_handle; 24465cf1669fSMatthias Ringwald gatt_client->end_group_handle = end_handle; 24475cf1669fSMatthias Ringwald gatt_client->query_start_handle = start_handle; 24485cf1669fSMatthias Ringwald gatt_client->query_end_handle = end_handle; 24495cf1669fSMatthias Ringwald gatt_client->uuid16 = uuid16; 24505cf1669fSMatthias Ringwald uuid_add_bluetooth_prefix((uint8_t*) &(gatt_client->uuid128), uuid16); 2451052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_BY_TYPE_REQUEST; 24523deb3ec6SMatthias Ringwald gatt_client_run(); 245325b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 24543deb3ec6SMatthias Ringwald } 24553deb3ec6SMatthias Ringwald 2456045d700dSDavid 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){ 245740faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2458de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 245940faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 246040faeb84SMilanka Ringwald return status; 246140faeb84SMilanka Ringwald } 24623deb3ec6SMatthias Ringwald 24635cf1669fSMatthias Ringwald gatt_client->callback = callback; 24645cf1669fSMatthias Ringwald gatt_client->start_group_handle = start_handle; 24655cf1669fSMatthias Ringwald gatt_client->end_group_handle = end_handle; 24665cf1669fSMatthias Ringwald gatt_client->query_start_handle = start_handle; 24675cf1669fSMatthias Ringwald gatt_client->query_end_handle = end_handle; 24685cf1669fSMatthias Ringwald gatt_client->uuid16 = 0; 24695cf1669fSMatthias Ringwald (void)memcpy(gatt_client->uuid128, uuid128, 16); 2470052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_BY_TYPE_REQUEST; 24713deb3ec6SMatthias Ringwald gatt_client_run(); 247225b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 24733deb3ec6SMatthias Ringwald } 24743deb3ec6SMatthias Ringwald 24753deb3ec6SMatthias Ringwald 2476b45b7749SMilanka 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){ 2477b45b7749SMilanka Ringwald return gatt_client_read_value_of_characteristic_using_value_handle(callback, con_handle, characteristic->value_handle); 24783deb3ec6SMatthias Ringwald } 24793deb3ec6SMatthias Ringwald 2480b45b7749SMilanka 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){ 248140faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2482de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 248340faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 248440faeb84SMilanka Ringwald return status; 248540faeb84SMilanka Ringwald } 24863deb3ec6SMatthias Ringwald 24875cf1669fSMatthias Ringwald gatt_client->callback = callback; 2488b45b7749SMilanka Ringwald gatt_client->attribute_handle = value_handle; 24895cf1669fSMatthias Ringwald gatt_client->attribute_offset = offset; 2490052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_BLOB_QUERY; 24913deb3ec6SMatthias Ringwald gatt_client_run(); 249225b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 24933deb3ec6SMatthias Ringwald } 24943deb3ec6SMatthias Ringwald 2495b45b7749SMilanka 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){ 2496b45b7749SMilanka Ringwald return gatt_client_read_long_value_of_characteristic_using_value_handle_with_offset(callback, con_handle, value_handle, 0); 24973deb3ec6SMatthias Ringwald } 24983deb3ec6SMatthias Ringwald 2499b45b7749SMilanka 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){ 2500b45b7749SMilanka Ringwald return gatt_client_read_long_value_of_characteristic_using_value_handle(callback, con_handle, characteristic->value_handle); 25013deb3ec6SMatthias Ringwald } 25023deb3ec6SMatthias Ringwald 2503f125a8efSMatthias 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){ 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 2510f125a8efSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 2511f125a8efSMatthias Ringwald if (state == P_W2_SEND_READ_MULTIPLE_VARIABLE_REQUEST){ 2512f125a8efSMatthias Ringwald if (gatt_client->bearer_type != ATT_BEARER_ENHANCED_LE){ 2513f125a8efSMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 2514f125a8efSMatthias Ringwald } 2515f125a8efSMatthias Ringwald } 2516f125a8efSMatthias Ringwald #endif 2517f125a8efSMatthias Ringwald 25185cf1669fSMatthias Ringwald gatt_client->callback = callback; 25195cf1669fSMatthias Ringwald gatt_client->read_multiple_handle_count = num_value_handles; 25205cf1669fSMatthias Ringwald gatt_client->read_multiple_handles = value_handles; 2521052dc82aSMatthias Ringwald gatt_client->state = state; 25223deb3ec6SMatthias Ringwald gatt_client_run(); 252325b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 25243deb3ec6SMatthias Ringwald } 25253deb3ec6SMatthias Ringwald 2526f125a8efSMatthias 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){ 2527f125a8efSMatthias Ringwald return gatt_client_read_multiple_characteristic_values_with_state(callback, con_handle, num_value_handles, value_handles, P_W2_SEND_READ_MULTIPLE_REQUEST); 2528f125a8efSMatthias Ringwald } 2529f125a8efSMatthias Ringwald 2530f125a8efSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 2531f125a8efSMatthias 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){ 2532f125a8efSMatthias 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); 2533f125a8efSMatthias Ringwald } 2534f125a8efSMatthias Ringwald #endif 2535f125a8efSMatthias Ringwald 2536de9f8e94SMatthias 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){ 253740faeb84SMilanka Ringwald gatt_client_t * gatt_client; 253840faeb84SMilanka Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 253940faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 254040faeb84SMilanka Ringwald return status; 254140faeb84SMilanka Ringwald } 25423deb3ec6SMatthias Ringwald 2543dda77937SMatthias Ringwald if (value_length > (gatt_client->mtu - 3u)) return GATT_CLIENT_VALUE_TOO_LONG; 25445cf1669fSMatthias Ringwald if (!att_dispatch_client_can_send_now(gatt_client->con_handle)) return GATT_CLIENT_BUSY; 25453deb3ec6SMatthias Ringwald 25466e7b444cSMatthias Ringwald return att_write_request(gatt_client, ATT_WRITE_COMMAND, value_handle, value_length, value); 25473deb3ec6SMatthias Ringwald } 25483deb3ec6SMatthias Ringwald 2549b45b7749SMilanka 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){ 255040faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2551de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 255240faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 255340faeb84SMilanka Ringwald return status; 255440faeb84SMilanka Ringwald } 25553deb3ec6SMatthias Ringwald 25565cf1669fSMatthias Ringwald gatt_client->callback = callback; 25575cf1669fSMatthias Ringwald gatt_client->attribute_handle = value_handle; 25585cf1669fSMatthias Ringwald gatt_client->attribute_length = value_length; 2559b45b7749SMilanka Ringwald gatt_client->attribute_value = value; 2560052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_WRITE_CHARACTERISTIC_VALUE; 25613deb3ec6SMatthias Ringwald gatt_client_run(); 256225b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 25633deb3ec6SMatthias Ringwald } 25643deb3ec6SMatthias Ringwald 2565b45b7749SMilanka 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){ 256640faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2567de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 256840faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 256940faeb84SMilanka Ringwald return status; 257040faeb84SMilanka Ringwald } 25713deb3ec6SMatthias Ringwald 25725cf1669fSMatthias Ringwald gatt_client->callback = callback; 25735cf1669fSMatthias Ringwald gatt_client->attribute_handle = value_handle; 25745cf1669fSMatthias Ringwald gatt_client->attribute_length = value_length; 25755cf1669fSMatthias Ringwald gatt_client->attribute_offset = offset; 2576b45b7749SMilanka Ringwald gatt_client->attribute_value = value; 2577052dc82aSMatthias Ringwald gatt_client->state = P_W2_PREPARE_WRITE; 25783deb3ec6SMatthias Ringwald gatt_client_run(); 257925b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 25803deb3ec6SMatthias Ringwald } 25813deb3ec6SMatthias Ringwald 2582711e6c80SMatthias 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){ 25839c662c9bSMatthias Ringwald return gatt_client_write_long_value_of_characteristic_with_offset(callback, con_handle, value_handle, 0, value_length, value); 25843deb3ec6SMatthias Ringwald } 25853deb3ec6SMatthias Ringwald 2586711e6c80SMatthias 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){ 258740faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2588de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 258940faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 259040faeb84SMilanka Ringwald return status; 259140faeb84SMilanka Ringwald } 25923deb3ec6SMatthias Ringwald 25935cf1669fSMatthias Ringwald gatt_client->callback = callback; 25945cf1669fSMatthias Ringwald gatt_client->attribute_handle = value_handle; 25955cf1669fSMatthias Ringwald gatt_client->attribute_length = value_length; 25965cf1669fSMatthias Ringwald gatt_client->attribute_offset = 0; 25975cf1669fSMatthias Ringwald gatt_client->attribute_value = value; 2598052dc82aSMatthias Ringwald gatt_client->state = P_W2_PREPARE_RELIABLE_WRITE; 25993deb3ec6SMatthias Ringwald gatt_client_run(); 260025b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 26013deb3ec6SMatthias Ringwald } 26023deb3ec6SMatthias Ringwald 2603711e6c80SMatthias 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){ 260440faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2605de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 260640faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 260740faeb84SMilanka Ringwald return status; 260840faeb84SMilanka Ringwald } 26093deb3ec6SMatthias Ringwald 26103deb3ec6SMatthias Ringwald if ( (configuration & GATT_CLIENT_CHARACTERISTICS_CONFIGURATION_NOTIFICATION) && 26114ea43905SMatthias Ringwald ((characteristic->properties & ATT_PROPERTY_NOTIFY) == 0u)) { 2612d8e8f12aSMatthias Ringwald log_info("gatt_client_write_client_characteristic_configuration: GATT_CLIENT_CHARACTERISTIC_NOTIFICATION_NOT_SUPPORTED"); 2613616edd56SMatthias Ringwald return GATT_CLIENT_CHARACTERISTIC_NOTIFICATION_NOT_SUPPORTED; 26143deb3ec6SMatthias Ringwald } else if ( (configuration & GATT_CLIENT_CHARACTERISTICS_CONFIGURATION_INDICATION) && 26154ea43905SMatthias Ringwald ((characteristic->properties & ATT_PROPERTY_INDICATE) == 0u)){ 2616d8e8f12aSMatthias Ringwald log_info("gatt_client_write_client_characteristic_configuration: GATT_CLIENT_CHARACTERISTIC_INDICATION_NOT_SUPPORTED"); 2617616edd56SMatthias Ringwald return GATT_CLIENT_CHARACTERISTIC_INDICATION_NOT_SUPPORTED; 26183deb3ec6SMatthias Ringwald } 26193deb3ec6SMatthias Ringwald 26205cf1669fSMatthias Ringwald gatt_client->callback = callback; 26215cf1669fSMatthias Ringwald gatt_client->start_group_handle = characteristic->value_handle; 26225cf1669fSMatthias Ringwald gatt_client->end_group_handle = characteristic->end_handle; 26235cf1669fSMatthias Ringwald little_endian_store_16(gatt_client->client_characteristic_configuration_value, 0, configuration); 26243deb3ec6SMatthias Ringwald 2625abdc9fb5SMatthias Ringwald #ifdef ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY 26265cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_FIND_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY; 2627abdc9fb5SMatthias Ringwald #else 2628052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY; 2629abdc9fb5SMatthias Ringwald #endif 26303deb3ec6SMatthias Ringwald gatt_client_run(); 26319cb80b17SMilanka Ringwald return ERROR_CODE_SUCCESS; 26323deb3ec6SMatthias Ringwald } 26333deb3ec6SMatthias Ringwald 2634711e6c80SMatthias 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){ 263540faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2636de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 263740faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 263840faeb84SMilanka Ringwald return status; 263940faeb84SMilanka Ringwald } 26403deb3ec6SMatthias Ringwald 26415cf1669fSMatthias Ringwald gatt_client->callback = callback; 26425cf1669fSMatthias Ringwald gatt_client->attribute_handle = descriptor_handle; 26433deb3ec6SMatthias Ringwald 2644052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_CHARACTERISTIC_DESCRIPTOR_QUERY; 26453deb3ec6SMatthias Ringwald gatt_client_run(); 264625b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 26473deb3ec6SMatthias Ringwald } 26483deb3ec6SMatthias Ringwald 2649711e6c80SMatthias 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){ 26509c662c9bSMatthias Ringwald return gatt_client_read_characteristic_descriptor_using_descriptor_handle(callback, con_handle, descriptor->handle); 26513deb3ec6SMatthias Ringwald } 26523deb3ec6SMatthias Ringwald 2653711e6c80SMatthias 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){ 265440faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2655de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 265640faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 265740faeb84SMilanka Ringwald return status; 265840faeb84SMilanka Ringwald } 26593deb3ec6SMatthias Ringwald 26605cf1669fSMatthias Ringwald gatt_client->callback = callback; 26615cf1669fSMatthias Ringwald gatt_client->attribute_handle = descriptor_handle; 26625cf1669fSMatthias Ringwald gatt_client->attribute_offset = offset; 2663052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_QUERY; 26643deb3ec6SMatthias Ringwald gatt_client_run(); 266525b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 26663deb3ec6SMatthias Ringwald } 26673deb3ec6SMatthias Ringwald 2668711e6c80SMatthias 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){ 26699c662c9bSMatthias Ringwald return gatt_client_read_long_characteristic_descriptor_using_descriptor_handle_with_offset(callback, con_handle, descriptor_handle, 0); 26703deb3ec6SMatthias Ringwald } 26713deb3ec6SMatthias Ringwald 2672711e6c80SMatthias 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){ 26739c662c9bSMatthias Ringwald return gatt_client_read_long_characteristic_descriptor_using_descriptor_handle(callback, con_handle, descriptor->handle); 26743deb3ec6SMatthias Ringwald } 26753deb3ec6SMatthias Ringwald 2676b45b7749SMilanka 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){ 267740faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2678de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 267940faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 268040faeb84SMilanka Ringwald return status; 268140faeb84SMilanka Ringwald } 26823deb3ec6SMatthias Ringwald 26835cf1669fSMatthias Ringwald gatt_client->callback = callback; 26845cf1669fSMatthias Ringwald gatt_client->attribute_handle = descriptor_handle; 2685b45b7749SMilanka Ringwald gatt_client->attribute_length = value_length; 26865cf1669fSMatthias Ringwald gatt_client->attribute_offset = 0; 2687b45b7749SMilanka Ringwald gatt_client->attribute_value = value; 2688052dc82aSMatthias Ringwald gatt_client->state = P_W2_SEND_WRITE_CHARACTERISTIC_DESCRIPTOR; 26893deb3ec6SMatthias Ringwald gatt_client_run(); 269025b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 26913deb3ec6SMatthias Ringwald } 26923deb3ec6SMatthias Ringwald 269348cdff9cSMilanka 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){ 269448cdff9cSMilanka Ringwald return gatt_client_write_characteristic_descriptor_using_descriptor_handle(callback, con_handle, descriptor->handle, value_length, value); 26953deb3ec6SMatthias Ringwald } 26963deb3ec6SMatthias Ringwald 2697b45b7749SMilanka 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){ 269840faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2699de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 270040faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 270140faeb84SMilanka Ringwald return status; 270240faeb84SMilanka Ringwald } 27033deb3ec6SMatthias Ringwald 27045cf1669fSMatthias Ringwald gatt_client->callback = callback; 27055cf1669fSMatthias Ringwald gatt_client->attribute_handle = descriptor_handle; 2706b45b7749SMilanka Ringwald gatt_client->attribute_length = value_length; 27075cf1669fSMatthias Ringwald gatt_client->attribute_offset = offset; 2708b45b7749SMilanka Ringwald gatt_client->attribute_value = value; 2709052dc82aSMatthias Ringwald gatt_client->state = P_W2_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR; 27103deb3ec6SMatthias Ringwald gatt_client_run(); 271125b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 27123deb3ec6SMatthias Ringwald } 27133deb3ec6SMatthias Ringwald 2714b45b7749SMilanka 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){ 2715b45b7749SMilanka Ringwald return gatt_client_write_long_characteristic_descriptor_using_descriptor_handle_with_offset(callback, con_handle, descriptor_handle, 0, value_length, value); 27163deb3ec6SMatthias Ringwald } 27173deb3ec6SMatthias Ringwald 2718b45b7749SMilanka 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){ 2719b45b7749SMilanka Ringwald return gatt_client_write_long_characteristic_descriptor_using_descriptor_handle(callback, con_handle, descriptor->handle, value_length, value); 27203deb3ec6SMatthias Ringwald } 27213deb3ec6SMatthias Ringwald 27223deb3ec6SMatthias Ringwald /** 27233deb3ec6SMatthias Ringwald * @brief -> gatt complete event 27243deb3ec6SMatthias Ringwald */ 2725b45b7749SMilanka 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){ 272640faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2727de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 272840faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 272940faeb84SMilanka Ringwald return status; 273040faeb84SMilanka Ringwald } 27313deb3ec6SMatthias Ringwald 27325cf1669fSMatthias Ringwald gatt_client->callback = callback; 27335cf1669fSMatthias Ringwald gatt_client->attribute_handle = attribute_handle; 2734b45b7749SMilanka Ringwald gatt_client->attribute_length = value_length; 27355cf1669fSMatthias Ringwald gatt_client->attribute_offset = offset; 2736b45b7749SMilanka Ringwald gatt_client->attribute_value = value; 2737052dc82aSMatthias Ringwald gatt_client->state = P_W2_PREPARE_WRITE_SINGLE; 27383deb3ec6SMatthias Ringwald gatt_client_run(); 273925b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 27403deb3ec6SMatthias Ringwald } 27413deb3ec6SMatthias Ringwald 27423deb3ec6SMatthias Ringwald /** 27433deb3ec6SMatthias Ringwald * @brief -> gatt complete event 27443deb3ec6SMatthias Ringwald */ 2745711e6c80SMatthias Ringwald uint8_t gatt_client_execute_write(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 274640faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2747de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 274840faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 274940faeb84SMilanka Ringwald return status; 275040faeb84SMilanka Ringwald } 27513deb3ec6SMatthias Ringwald 27525cf1669fSMatthias Ringwald gatt_client->callback = callback; 2753052dc82aSMatthias Ringwald gatt_client->state = P_W2_EXECUTE_PREPARED_WRITE; 27543deb3ec6SMatthias Ringwald gatt_client_run(); 275525b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 27563deb3ec6SMatthias Ringwald } 27573deb3ec6SMatthias Ringwald 27583deb3ec6SMatthias Ringwald /** 27593deb3ec6SMatthias Ringwald * @brief -> gatt complete event 27603deb3ec6SMatthias Ringwald */ 2761711e6c80SMatthias Ringwald uint8_t gatt_client_cancel_write(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 276240faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2763de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 276440faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 276540faeb84SMilanka Ringwald return status; 276640faeb84SMilanka Ringwald } 27673deb3ec6SMatthias Ringwald 27685cf1669fSMatthias Ringwald gatt_client->callback = callback; 2769052dc82aSMatthias Ringwald gatt_client->state = P_W2_CANCEL_PREPARED_WRITE; 27703deb3ec6SMatthias Ringwald gatt_client_run(); 27717d2258b3SMilanka Ringwald return ERROR_CODE_SUCCESS; 27723deb3ec6SMatthias Ringwald } 27733deb3ec6SMatthias Ringwald 2774313e337bSMatthias Ringwald void gatt_client_deserialize_service(const uint8_t *packet, int offset, gatt_client_service_t * service){ 27756ba2ad22SMatthias Ringwald service->start_group_handle = little_endian_read_16(packet, offset); 27766ba2ad22SMatthias Ringwald service->end_group_handle = little_endian_read_16(packet, offset + 2); 27776ba2ad22SMatthias Ringwald reverse_128(&packet[offset + 4], service->uuid128); 27786ba2ad22SMatthias Ringwald if (uuid_has_bluetooth_prefix(service->uuid128)){ 27796ba2ad22SMatthias Ringwald service->uuid16 = big_endian_read_32(service->uuid128, 0); 2780c839c6f9SMatthias Ringwald } else { 2781c839c6f9SMatthias Ringwald service->uuid16 = 0; 27826ba2ad22SMatthias Ringwald } 27836ba2ad22SMatthias Ringwald } 27846ba2ad22SMatthias Ringwald 2785313e337bSMatthias Ringwald void gatt_client_deserialize_characteristic(const uint8_t * packet, int offset, gatt_client_characteristic_t * characteristic){ 27866ba2ad22SMatthias Ringwald characteristic->start_handle = little_endian_read_16(packet, offset); 27876ba2ad22SMatthias Ringwald characteristic->value_handle = little_endian_read_16(packet, offset + 2); 27886ba2ad22SMatthias Ringwald characteristic->end_handle = little_endian_read_16(packet, offset + 4); 27896ba2ad22SMatthias Ringwald characteristic->properties = little_endian_read_16(packet, offset + 6); 279086c38559SMatthias Ringwald reverse_128(&packet[offset+8], characteristic->uuid128); 27916ba2ad22SMatthias Ringwald if (uuid_has_bluetooth_prefix(characteristic->uuid128)){ 27926ba2ad22SMatthias Ringwald characteristic->uuid16 = big_endian_read_32(characteristic->uuid128, 0); 2793c839c6f9SMatthias Ringwald } else { 2794c839c6f9SMatthias Ringwald characteristic->uuid16 = 0; 27956ba2ad22SMatthias Ringwald } 27966ba2ad22SMatthias Ringwald } 27976ba2ad22SMatthias Ringwald 2798313e337bSMatthias Ringwald void gatt_client_deserialize_characteristic_descriptor(const uint8_t * packet, int offset, gatt_client_characteristic_descriptor_t * descriptor){ 27996ba2ad22SMatthias Ringwald descriptor->handle = little_endian_read_16(packet, offset); 28006ba2ad22SMatthias Ringwald reverse_128(&packet[offset+2], descriptor->uuid128); 2801b4895529SJakob Krantz if (uuid_has_bluetooth_prefix(descriptor->uuid128)){ 2802b4895529SJakob Krantz descriptor->uuid16 = big_endian_read_32(descriptor->uuid128, 0); 2803c839c6f9SMatthias Ringwald } else { 2804c839c6f9SMatthias Ringwald descriptor->uuid16 = 0; 2805b4895529SJakob Krantz } 28066ba2ad22SMatthias Ringwald } 28075cf6c434SJakob Krantz 28085cf6c434SJakob Krantz void gatt_client_send_mtu_negotiation(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 280940faeb84SMilanka Ringwald gatt_client_t * gatt_client; 281040faeb84SMilanka Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 281140faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 281240faeb84SMilanka Ringwald return; 281340faeb84SMilanka Ringwald } 281440faeb84SMilanka Ringwald if (gatt_client->mtu_state == MTU_AUTO_EXCHANGE_DISABLED){ 281540faeb84SMilanka Ringwald gatt_client->callback = callback; 281640faeb84SMilanka Ringwald gatt_client->mtu_state = SEND_MTU_EXCHANGE; 28175cf6c434SJakob Krantz gatt_client_run(); 28185cf6c434SJakob Krantz } 28195cf6c434SJakob Krantz } 282047181045SMatthias Ringwald 282159d34cd2SMatthias Ringwald uint8_t gatt_client_request_to_write_without_response(btstack_context_callback_registration_t * callback_registration, hci_con_handle_t con_handle){ 282259d34cd2SMatthias Ringwald gatt_client_t * gatt_client; 282359d34cd2SMatthias Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 282459d34cd2SMatthias Ringwald if (status != ERROR_CODE_SUCCESS){ 282559d34cd2SMatthias Ringwald return status; 282659d34cd2SMatthias Ringwald } 282759d34cd2SMatthias Ringwald bool added = btstack_linked_list_add_tail(&gatt_client->write_without_response_requests, (btstack_linked_item_t*) callback_registration); 28282832a98aSMatthias Ringwald if (added == false){ 282959d34cd2SMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 28302832a98aSMatthias Ringwald } else { 28312832a98aSMatthias Ringwald att_dispatch_client_request_can_send_now_event(gatt_client->con_handle); 28322832a98aSMatthias Ringwald return ERROR_CODE_SUCCESS; 283359d34cd2SMatthias Ringwald } 283459d34cd2SMatthias Ringwald } 283559d34cd2SMatthias Ringwald 283653e9c18fSMatthias Ringwald uint8_t gatt_client_request_to_send_gatt_query(btstack_context_callback_registration_t * callback_registration, hci_con_handle_t con_handle){ 283753e9c18fSMatthias Ringwald gatt_client_t * gatt_client; 283853e9c18fSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 283953e9c18fSMatthias Ringwald if (status != ERROR_CODE_SUCCESS){ 284053e9c18fSMatthias Ringwald return status; 284153e9c18fSMatthias Ringwald } 284253e9c18fSMatthias Ringwald bool added = btstack_linked_list_add_tail(&gatt_client->query_requests, (btstack_linked_item_t*) callback_registration); 28432832a98aSMatthias Ringwald if (added == false){ 284453e9c18fSMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 28452832a98aSMatthias Ringwald } else { 28462832a98aSMatthias Ringwald gatt_client_notify_can_send_query(gatt_client); 28472832a98aSMatthias Ringwald return ERROR_CODE_SUCCESS; 284853e9c18fSMatthias Ringwald } 284953e9c18fSMatthias Ringwald } 285053e9c18fSMatthias Ringwald 285147181045SMatthias Ringwald uint8_t gatt_client_request_can_write_without_response_event(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 285240faeb84SMilanka Ringwald gatt_client_t * gatt_client; 285340faeb84SMilanka Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 285440faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 285540faeb84SMilanka Ringwald return status; 285640faeb84SMilanka Ringwald } 285740faeb84SMilanka Ringwald if (gatt_client->write_without_response_callback != NULL){ 285840faeb84SMilanka Ringwald return GATT_CLIENT_IN_WRONG_STATE; 285940faeb84SMilanka Ringwald } 286040faeb84SMilanka Ringwald gatt_client->write_without_response_callback = callback; 286140faeb84SMilanka Ringwald att_dispatch_client_request_can_send_now_event(gatt_client->con_handle); 28627d2258b3SMilanka Ringwald return ERROR_CODE_SUCCESS; 286347181045SMatthias Ringwald } 2864a6121b51SMilanka Ringwald 28657627a0deSMatthias Ringwald 28667627a0deSMatthias Ringwald #if defined(ENABLE_GATT_OVER_CLASSIC) || defined(ENABLE_GATT_OVER_EATT) 28671450cdc6SMatthias Ringwald 28681450cdc6SMatthias Ringwald #include "hci_event.h" 28691450cdc6SMatthias Ringwald 28701450cdc6SMatthias Ringwald static const hci_event_t gatt_client_connected = { 28711450cdc6SMatthias Ringwald GATT_EVENT_CONNECTED, 0, "1BH" 28721450cdc6SMatthias Ringwald }; 28731450cdc6SMatthias Ringwald 28746b4a68c3SMatthias Ringwald static const hci_event_t gatt_client_disconnected = { 28756b4a68c3SMatthias Ringwald GATT_EVENT_DISCONNECTED, 0, "H" 28766b4a68c3SMatthias Ringwald }; 28771c7a19feSMatthias Ringwald 28781c7a19feSMatthias Ringwald static void gatt_client_emit_connected(btstack_packet_handler_t callback, uint8_t status, bd_addr_t addr, 28791c7a19feSMatthias Ringwald hci_con_handle_t con_handle) { 28801c7a19feSMatthias Ringwald uint8_t buffer[20]; 28811c7a19feSMatthias Ringwald uint16_t len = hci_event_create_from_template_and_arguments(buffer, sizeof(buffer), &gatt_client_connected, status, addr, con_handle); 28821c7a19feSMatthias Ringwald (*callback)(HCI_EVENT_PACKET, 0, buffer, len); 28831c7a19feSMatthias Ringwald } 28841c7a19feSMatthias Ringwald 28857627a0deSMatthias Ringwald #endif 28867627a0deSMatthias Ringwald 28877627a0deSMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC 28887627a0deSMatthias Ringwald 28897627a0deSMatthias Ringwald #include "bluetooth_psm.h" 28907627a0deSMatthias Ringwald 28917627a0deSMatthias Ringwald // single active SDP query 28927627a0deSMatthias Ringwald static gatt_client_t * gatt_client_classic_active_sdp_query; 28937627a0deSMatthias Ringwald 28947627a0deSMatthias Ringwald // macos protocol descriptor list requires 16 bytes 28957627a0deSMatthias Ringwald static uint8_t gatt_client_classic_sdp_buffer[32]; 28967627a0deSMatthias Ringwald 28976b4a68c3SMatthias Ringwald 28981450cdc6SMatthias Ringwald static gatt_client_t * gatt_client_get_context_for_classic_addr(bd_addr_t addr){ 28991450cdc6SMatthias Ringwald btstack_linked_item_t *it; 29001450cdc6SMatthias Ringwald for (it = (btstack_linked_item_t *) gatt_client_connections; it != NULL; it = it->next){ 29011450cdc6SMatthias Ringwald gatt_client_t * gatt_client = (gatt_client_t *) it; 29021450cdc6SMatthias Ringwald if (memcmp(gatt_client->addr, addr, 6) == 0){ 29031450cdc6SMatthias Ringwald return gatt_client; 29041450cdc6SMatthias Ringwald } 29051450cdc6SMatthias Ringwald } 29061450cdc6SMatthias Ringwald return NULL; 29071450cdc6SMatthias Ringwald } 29081450cdc6SMatthias Ringwald 29091450cdc6SMatthias Ringwald static gatt_client_t * gatt_client_get_context_for_l2cap_cid(uint16_t l2cap_cid){ 29101450cdc6SMatthias Ringwald btstack_linked_item_t *it; 29111450cdc6SMatthias Ringwald for (it = (btstack_linked_item_t *) gatt_client_connections; it != NULL; it = it->next){ 29121450cdc6SMatthias Ringwald gatt_client_t * gatt_client = (gatt_client_t *) it; 29131450cdc6SMatthias Ringwald if (gatt_client->l2cap_cid == l2cap_cid){ 29141450cdc6SMatthias Ringwald return gatt_client; 29151450cdc6SMatthias Ringwald } 29161450cdc6SMatthias Ringwald } 29171450cdc6SMatthias Ringwald return NULL; 29181450cdc6SMatthias Ringwald } 29191450cdc6SMatthias Ringwald 29201450cdc6SMatthias Ringwald static void gatt_client_classic_handle_connected(gatt_client_t * gatt_client, uint8_t status){ 29211450cdc6SMatthias Ringwald bd_addr_t addr; 2922d5529700SMatthias Ringwald // cppcheck-suppress uninitvar ; addr is reported as uninitialized although it's the destination of the memcpy 29231450cdc6SMatthias Ringwald memcpy(addr, gatt_client->addr, 6); 29241450cdc6SMatthias Ringwald hci_con_handle_t con_handle = gatt_client->con_handle; 29251450cdc6SMatthias Ringwald btstack_packet_handler_t callback = gatt_client->callback; 29269ed6f53cSMatthias Ringwald if (status != ERROR_CODE_SUCCESS){ 29273b0e0cc5SMatthias Ringwald btstack_linked_list_remove(&gatt_client_connections, (btstack_linked_item_t *) gatt_client); 29283b0e0cc5SMatthias Ringwald btstack_memory_gatt_client_free(gatt_client); 29293b0e0cc5SMatthias Ringwald } 29301c7a19feSMatthias Ringwald gatt_client_emit_connected(callback, status, addr, con_handle); 29311450cdc6SMatthias Ringwald } 29321450cdc6SMatthias Ringwald 2933180cbe79SMatthias Ringwald static void gatt_client_classic_retry(btstack_timer_source_t * ts){ 2934180cbe79SMatthias Ringwald gatt_client_t * gatt_client = gatt_client_for_timer(ts); 2935180cbe79SMatthias Ringwald if (gatt_client != NULL){ 2936180cbe79SMatthias Ringwald gatt_client->state = P_W4_L2CAP_CONNECTION; 2937180cbe79SMatthias Ringwald att_dispatch_classic_connect(gatt_client->addr, gatt_client->l2cap_psm, &gatt_client->l2cap_cid); 2938180cbe79SMatthias Ringwald } 2939180cbe79SMatthias Ringwald } 2940180cbe79SMatthias Ringwald 29416b4a68c3SMatthias Ringwald static void gatt_client_classic_handle_disconnected(gatt_client_t * gatt_client){ 29426b4a68c3SMatthias Ringwald 29436b4a68c3SMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, ATT_ERROR_HCI_DISCONNECT_RECEIVED); 29446b4a68c3SMatthias Ringwald gatt_client_timeout_stop(gatt_client); 29456b4a68c3SMatthias Ringwald 29466b4a68c3SMatthias Ringwald hci_con_handle_t con_handle = gatt_client->con_handle; 29476b4a68c3SMatthias Ringwald btstack_packet_handler_t callback = gatt_client->callback; 29486b4a68c3SMatthias Ringwald btstack_linked_list_remove(&gatt_client_connections, (btstack_linked_item_t *) gatt_client); 29496b4a68c3SMatthias Ringwald btstack_memory_gatt_client_free(gatt_client); 29506b4a68c3SMatthias Ringwald 29516b4a68c3SMatthias Ringwald uint8_t buffer[20]; 29526b4a68c3SMatthias Ringwald uint16_t len = hci_event_create_from_template_and_arguments(buffer, sizeof(buffer), &gatt_client_disconnected, con_handle); 29536b4a68c3SMatthias Ringwald (*callback)(HCI_EVENT_PACKET, 0, buffer, len); 29546b4a68c3SMatthias Ringwald } 29556b4a68c3SMatthias Ringwald 29561450cdc6SMatthias Ringwald static void gatt_client_handle_sdp_client_query_attribute_value(gatt_client_t * connection, uint8_t *packet){ 29571450cdc6SMatthias Ringwald des_iterator_t des_list_it; 29581450cdc6SMatthias Ringwald des_iterator_t prot_it; 29591450cdc6SMatthias Ringwald 29601450cdc6SMatthias Ringwald if (sdp_event_query_attribute_byte_get_attribute_length(packet) <= sizeof(gatt_client_classic_sdp_buffer)) { 29611450cdc6SMatthias Ringwald gatt_client_classic_sdp_buffer[sdp_event_query_attribute_byte_get_data_offset(packet)] = sdp_event_query_attribute_byte_get_data(packet); 29621450cdc6SMatthias Ringwald if ((uint16_t)(sdp_event_query_attribute_byte_get_data_offset(packet)+1) == sdp_event_query_attribute_byte_get_attribute_length(packet)) { 29631450cdc6SMatthias Ringwald switch(sdp_event_query_attribute_byte_get_attribute_id(packet)) { 29641450cdc6SMatthias Ringwald case BLUETOOTH_ATTRIBUTE_PROTOCOL_DESCRIPTOR_LIST: 29651450cdc6SMatthias 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)) { 29661450cdc6SMatthias Ringwald uint8_t *des_element; 29671450cdc6SMatthias Ringwald uint8_t *element; 29681450cdc6SMatthias Ringwald uint32_t uuid; 29691450cdc6SMatthias Ringwald 29701450cdc6SMatthias Ringwald if (des_iterator_get_type(&des_list_it) != DE_DES) continue; 29711450cdc6SMatthias Ringwald 29721450cdc6SMatthias Ringwald des_element = des_iterator_get_element(&des_list_it); 29731450cdc6SMatthias Ringwald des_iterator_init(&prot_it, des_element); 29741450cdc6SMatthias Ringwald element = des_iterator_get_element(&prot_it); 29751450cdc6SMatthias Ringwald 29761450cdc6SMatthias Ringwald if (de_get_element_type(element) != DE_UUID) continue; 29771450cdc6SMatthias Ringwald 29781450cdc6SMatthias Ringwald uuid = de_get_uuid32(element); 29791450cdc6SMatthias Ringwald des_iterator_next(&prot_it); 29801450cdc6SMatthias Ringwald // we assume that the even if there are both roles supported, remote device uses the same psm and avdtp version for both 29811450cdc6SMatthias Ringwald switch (uuid){ 29821450cdc6SMatthias Ringwald case BLUETOOTH_PROTOCOL_L2CAP: 29831450cdc6SMatthias Ringwald if (!des_iterator_has_more(&prot_it)) continue; 29841450cdc6SMatthias Ringwald de_element_get_uint16(des_iterator_get_element(&prot_it), &connection->l2cap_psm); 29851450cdc6SMatthias Ringwald break; 29861450cdc6SMatthias Ringwald default: 29871450cdc6SMatthias Ringwald break; 29881450cdc6SMatthias Ringwald } 29891450cdc6SMatthias Ringwald } 29901450cdc6SMatthias Ringwald break; 29911450cdc6SMatthias Ringwald 29921450cdc6SMatthias Ringwald default: 29931450cdc6SMatthias Ringwald break; 29941450cdc6SMatthias Ringwald } 29951450cdc6SMatthias Ringwald } 29961450cdc6SMatthias Ringwald } 29971450cdc6SMatthias Ringwald } 29981450cdc6SMatthias Ringwald 29991450cdc6SMatthias Ringwald static void gatt_client_classic_sdp_handler(uint8_t packet_type, uint16_t handle, uint8_t *packet, uint16_t size){ 30001450cdc6SMatthias Ringwald gatt_client_t * gatt_client = gatt_client_classic_active_sdp_query; 30011450cdc6SMatthias Ringwald btstack_assert(gatt_client != NULL); 30021450cdc6SMatthias Ringwald uint8_t status; 30031450cdc6SMatthias Ringwald 30041450cdc6SMatthias Ringwald // TODO: handle sdp events, get l2cap psm 30051450cdc6SMatthias Ringwald switch (hci_event_packet_get_type(packet)){ 30061450cdc6SMatthias Ringwald case SDP_EVENT_QUERY_ATTRIBUTE_VALUE: 30071450cdc6SMatthias Ringwald gatt_client_handle_sdp_client_query_attribute_value(gatt_client, packet); 30081450cdc6SMatthias Ringwald // TODO: 30091450cdc6SMatthias Ringwald return; 30101450cdc6SMatthias Ringwald case SDP_EVENT_QUERY_COMPLETE: 30111450cdc6SMatthias Ringwald status = sdp_event_query_complete_get_status(packet); 30121450cdc6SMatthias Ringwald gatt_client_classic_active_sdp_query = NULL; 30131450cdc6SMatthias Ringwald log_info("l2cap psm: %0x, status %02x", gatt_client->l2cap_psm, status); 30141450cdc6SMatthias Ringwald if (status != ERROR_CODE_SUCCESS) break; 30151450cdc6SMatthias Ringwald if (gatt_client->l2cap_psm == 0) { 30161450cdc6SMatthias Ringwald status = SDP_SERVICE_NOT_FOUND; 30171450cdc6SMatthias Ringwald break; 30181450cdc6SMatthias Ringwald } 30191450cdc6SMatthias Ringwald break; 30201450cdc6SMatthias Ringwald default: 30211450cdc6SMatthias Ringwald btstack_assert(false); 30221450cdc6SMatthias Ringwald return; 30231450cdc6SMatthias Ringwald } 30241450cdc6SMatthias Ringwald 30251450cdc6SMatthias Ringwald // done 30261450cdc6SMatthias Ringwald if (status == ERROR_CODE_SUCCESS){ 3027052dc82aSMatthias Ringwald gatt_client->state = P_W4_L2CAP_CONNECTION; 302859b5e157SMatthias Ringwald status = att_dispatch_classic_connect(gatt_client->addr, gatt_client->l2cap_psm, &gatt_client->l2cap_cid); 30291450cdc6SMatthias Ringwald } 30301450cdc6SMatthias Ringwald if (status != ERROR_CODE_SUCCESS) { 30311450cdc6SMatthias Ringwald gatt_client_classic_handle_connected(gatt_client, status); 30321450cdc6SMatthias Ringwald } 30331450cdc6SMatthias Ringwald } 30341450cdc6SMatthias Ringwald 30351450cdc6SMatthias Ringwald static void gatt_client_classic_sdp_start(void * context){ 30361450cdc6SMatthias Ringwald gatt_client_classic_active_sdp_query = (gatt_client_t *) context; 3037052dc82aSMatthias Ringwald gatt_client_classic_active_sdp_query->state = P_W4_SDP_QUERY; 30381450cdc6SMatthias Ringwald sdp_client_query_uuid16(gatt_client_classic_sdp_handler, gatt_client_classic_active_sdp_query->addr, ORG_BLUETOOTH_SERVICE_GENERIC_ATTRIBUTE); 30391450cdc6SMatthias Ringwald } 30401450cdc6SMatthias Ringwald 304174daebdeSMatthias Ringwald static void gatt_client_classic_emit_connected(void * context){ 304274daebdeSMatthias Ringwald gatt_client_t * gatt_client = (gatt_client_t *) context; 3043052dc82aSMatthias Ringwald gatt_client->state = P_READY; 304474daebdeSMatthias Ringwald hci_connection_t * hci_connection = hci_connection_for_handle(gatt_client->con_handle); 304574daebdeSMatthias Ringwald btstack_assert(hci_connection != NULL); 304674daebdeSMatthias Ringwald gatt_client_emit_connected(gatt_client->callback, ERROR_CODE_SUCCESS, hci_connection->address, gatt_client->con_handle); 304774daebdeSMatthias Ringwald } 304874daebdeSMatthias Ringwald 30491450cdc6SMatthias Ringwald uint8_t gatt_client_classic_connect(btstack_packet_handler_t callback, bd_addr_t addr){ 30501450cdc6SMatthias Ringwald gatt_client_t * gatt_client = gatt_client_get_context_for_classic_addr(addr); 30511450cdc6SMatthias Ringwald if (gatt_client != NULL){ 30521450cdc6SMatthias Ringwald return ERROR_CODE_ACL_CONNECTION_ALREADY_EXISTS; 30531450cdc6SMatthias Ringwald } 30541450cdc6SMatthias Ringwald gatt_client = btstack_memory_gatt_client_get(); 30551450cdc6SMatthias Ringwald if (gatt_client == NULL){ 30561450cdc6SMatthias Ringwald return ERROR_CODE_MEMORY_CAPACITY_EXCEEDED; 30571450cdc6SMatthias Ringwald } 30581450cdc6SMatthias Ringwald // init state 3059e9cdf30bSMatthias Ringwald gatt_client->bearer_type = ATT_BEARER_UNENHANCED_CLASSIC; 30601450cdc6SMatthias Ringwald gatt_client->con_handle = HCI_CON_HANDLE_INVALID; 30611450cdc6SMatthias Ringwald memcpy(gatt_client->addr, addr, 6); 30621450cdc6SMatthias Ringwald gatt_client->mtu = ATT_DEFAULT_MTU; 30631450cdc6SMatthias Ringwald gatt_client->security_level = LEVEL_0; 30641450cdc6SMatthias Ringwald gatt_client->mtu_state = MTU_AUTO_EXCHANGE_DISABLED; 30651450cdc6SMatthias Ringwald gatt_client->callback = callback; 3066cbd76cecSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 3067cbd76cecSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_IDLE; 3068cbd76cecSMatthias Ringwald #endif 30691450cdc6SMatthias Ringwald btstack_linked_list_add(&gatt_client_connections, (btstack_linked_item_t*)gatt_client); 307074daebdeSMatthias Ringwald 307174daebdeSMatthias Ringwald // schedule emitted event if already connected, otherwise 307274daebdeSMatthias Ringwald bool already_connected = false; 307374daebdeSMatthias Ringwald hci_connection_t * hci_connection = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL); 307474daebdeSMatthias Ringwald if (hci_connection != NULL){ 307574daebdeSMatthias Ringwald if (hci_connection->att_server.l2cap_cid != 0){ 307674daebdeSMatthias Ringwald already_connected = true; 307774daebdeSMatthias Ringwald } 307874daebdeSMatthias Ringwald } 3079052dc82aSMatthias Ringwald gatt_client->callback_request.context = gatt_client; 308074daebdeSMatthias Ringwald if (already_connected){ 308174daebdeSMatthias Ringwald gatt_client->con_handle = hci_connection->con_handle; 3082052dc82aSMatthias Ringwald gatt_client->callback_request.callback = &gatt_client_classic_emit_connected; 3083052dc82aSMatthias Ringwald gatt_client->state = P_W2_EMIT_CONNECTED; 3084052dc82aSMatthias Ringwald btstack_run_loop_execute_on_main_thread(&gatt_client->callback_request); 308574daebdeSMatthias Ringwald } else { 3086052dc82aSMatthias Ringwald gatt_client->callback_request.callback = &gatt_client_classic_sdp_start; 3087052dc82aSMatthias Ringwald gatt_client->state = P_W2_SDP_QUERY; 3088052dc82aSMatthias Ringwald sdp_client_register_query_callback(&gatt_client->callback_request); 308974daebdeSMatthias Ringwald } 3090b7b03a30SMatthias Ringwald return ERROR_CODE_SUCCESS; 30911450cdc6SMatthias Ringwald } 30921450cdc6SMatthias Ringwald 30931450cdc6SMatthias Ringwald uint8_t gatt_client_classic_disconnect(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 30941450cdc6SMatthias Ringwald gatt_client_t * gatt_client = gatt_client_get_context_for_handle(con_handle); 30951450cdc6SMatthias Ringwald if (gatt_client == NULL){ 30961450cdc6SMatthias Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 30971450cdc6SMatthias Ringwald } 30981450cdc6SMatthias Ringwald gatt_client->callback = callback; 30991450cdc6SMatthias Ringwald return l2cap_disconnect(gatt_client->l2cap_cid); 31001450cdc6SMatthias Ringwald } 31011450cdc6SMatthias Ringwald #endif 31021450cdc6SMatthias Ringwald 310326166ecfSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 310426166ecfSMatthias Ringwald 310526166ecfSMatthias Ringwald #define MAX_NR_EATT_CHANNELS 5 31067627a0deSMatthias Ringwald 31077627a0deSMatthias Ringwald static void gatt_client_le_enhanced_packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size); 31087627a0deSMatthias Ringwald 3109df0a5c68SMatthias Ringwald static uint8_t gatt_client_le_enhanced_num_eatt_clients_in_state(gatt_client_t * gatt_client, gatt_client_state_t state){ 3110df0a5c68SMatthias Ringwald uint8_t num_clients = 0; 3111df0a5c68SMatthias Ringwald btstack_linked_list_iterator_t it; 3112df0a5c68SMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client->eatt_clients); 3113df0a5c68SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 3114df0a5c68SMatthias Ringwald gatt_client_t * eatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it); 3115df0a5c68SMatthias Ringwald if (eatt_client->state == state){ 3116df0a5c68SMatthias Ringwald num_clients++; 3117df0a5c68SMatthias Ringwald } 3118df0a5c68SMatthias Ringwald } 3119df0a5c68SMatthias Ringwald return num_clients; 3120df0a5c68SMatthias Ringwald } 3121df0a5c68SMatthias Ringwald 31227627a0deSMatthias Ringwald static void gatt_client_eatt_finalize(gatt_client_t * gatt_client) { 31237627a0deSMatthias Ringwald // free eatt clients 31247627a0deSMatthias Ringwald btstack_linked_list_iterator_t it; 31257627a0deSMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client_connections); 31267627a0deSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)) { 31277627a0deSMatthias Ringwald gatt_client_t *eatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it); 31287627a0deSMatthias Ringwald btstack_linked_list_iterator_remove(&it); 31297627a0deSMatthias Ringwald btstack_memory_gatt_client_free(eatt_client); 31307627a0deSMatthias Ringwald } 31317627a0deSMatthias Ringwald } 31327627a0deSMatthias Ringwald 31337627a0deSMatthias Ringwald // all channels connected 31347627a0deSMatthias Ringwald static void gatt_client_le_enhanced_handle_connected(gatt_client_t * gatt_client, uint8_t status) { 31357627a0deSMatthias Ringwald if (status == ERROR_CODE_SUCCESS){ 3136df0a5c68SMatthias Ringwald uint8_t num_ready = gatt_client_le_enhanced_num_eatt_clients_in_state(gatt_client, P_READY); 3137df0a5c68SMatthias Ringwald if (num_ready > 0){ 31387627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_READY; 3139df0a5c68SMatthias Ringwald // free unused channels 3140df0a5c68SMatthias Ringwald btstack_linked_list_iterator_t it; 3141df0a5c68SMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client_connections); 3142df0a5c68SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)) { 3143df0a5c68SMatthias Ringwald gatt_client_t *eatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it); 3144df0a5c68SMatthias Ringwald if (eatt_client->state == P_L2CAP_CLOSED){ 3145df0a5c68SMatthias Ringwald btstack_linked_list_iterator_remove(&it); 3146df0a5c68SMatthias Ringwald btstack_memory_gatt_client_free(eatt_client); 3147df0a5c68SMatthias Ringwald } 3148df0a5c68SMatthias Ringwald } 3149df0a5c68SMatthias Ringwald } else { 31506d0f6f49SMatthias Ringwald hci_connection_t * hci_connection = hci_connection_for_handle(gatt_client->con_handle); 31516d0f6f49SMatthias Ringwald btstack_assert(hci_connection != NULL); 31526d0f6f49SMatthias Ringwald if (hci_connection->att_server.incoming_connection_request){ 31536d0f6f49SMatthias Ringwald hci_connection->att_server.incoming_connection_request = false; 31546d0f6f49SMatthias Ringwald log_info("Collision, retry in 100ms"); 31556d0f6f49SMatthias Ringwald gatt_client->state = P_W2_L2CAP_CONNECT; 31566d0f6f49SMatthias Ringwald // set timer for retry 3157b1da4983SMatthias Ringwald btstack_run_loop_set_timer(&gatt_client->gc_timeout, GATT_CLIENT_COLLISION_BACKOFF_MS); 31586d0f6f49SMatthias Ringwald btstack_run_loop_set_timer_handler(&gatt_client->gc_timeout, gatt_client_le_enhanced_retry); 31596d0f6f49SMatthias Ringwald btstack_run_loop_add_timer(&gatt_client->gc_timeout); 31606d0f6f49SMatthias Ringwald return; 31616d0f6f49SMatthias Ringwald } else { 3162df0a5c68SMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_IDLE; 3163df0a5c68SMatthias Ringwald status = ERROR_CODE_CONNECTION_REJECTED_DUE_TO_LIMITED_RESOURCES; 3164df0a5c68SMatthias Ringwald } 31656d0f6f49SMatthias Ringwald } 31667627a0deSMatthias Ringwald } else { 31677627a0deSMatthias Ringwald gatt_client_eatt_finalize(gatt_client); 31687627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_IDLE; 31697627a0deSMatthias Ringwald } 31707627a0deSMatthias Ringwald 31711c7a19feSMatthias Ringwald gatt_client_emit_connected(gatt_client->callback, status, gatt_client->addr, gatt_client->con_handle); 31727627a0deSMatthias Ringwald } 31737627a0deSMatthias Ringwald 31747627a0deSMatthias Ringwald // single channel disconnected 31757627a0deSMatthias Ringwald static void gatt_client_le_enhanced_handle_ecbm_disconnected(gatt_client_t * gatt_client, gatt_client_t * eatt_client) { 31767627a0deSMatthias Ringwald 31777627a0deSMatthias Ringwald // report error 31787627a0deSMatthias Ringwald gatt_client_report_error_if_pending(eatt_client, ATT_ERROR_HCI_DISCONNECT_RECEIVED); 31797627a0deSMatthias Ringwald 31807627a0deSMatthias Ringwald // free memory 31817627a0deSMatthias Ringwald btstack_linked_list_remove(&gatt_client->eatt_clients, (btstack_linked_item_t *) eatt_client); 31827627a0deSMatthias Ringwald btstack_memory_gatt_client_free(eatt_client); 31837627a0deSMatthias Ringwald 3184570bdd2dSMatthias Ringwald // last channel 31857627a0deSMatthias Ringwald if (btstack_linked_list_empty(&gatt_client->eatt_clients)){ 3186570bdd2dSMatthias Ringwald hci_connection_t * hci_connection = hci_connection_for_handle(gatt_client->con_handle); 3187570bdd2dSMatthias Ringwald hci_connection->att_server.eatt_outgoing_active = false; 3188570bdd2dSMatthias Ringwald 3189570bdd2dSMatthias Ringwald if (gatt_client->eatt_state == GATT_CLIENT_EATT_READY) { 3190570bdd2dSMatthias Ringwald // report disconnected if last channel closed 31917627a0deSMatthias Ringwald uint8_t buffer[20]; 31927627a0deSMatthias Ringwald uint16_t len = hci_event_create_from_template_and_arguments(buffer, sizeof(buffer), &gatt_client_disconnected, gatt_client->con_handle); 31937627a0deSMatthias Ringwald (*gatt_client->callback)(HCI_EVENT_PACKET, 0, buffer, len); 31947627a0deSMatthias Ringwald } 31957627a0deSMatthias Ringwald } 31967627a0deSMatthias Ringwald } 31977627a0deSMatthias Ringwald 31987627a0deSMatthias Ringwald static gatt_client_t * gatt_client_le_enhanced_get_context_for_l2cap_cid(uint16_t l2cap_cid, gatt_client_t ** out_eatt_client){ 31997627a0deSMatthias Ringwald btstack_linked_list_iterator_t it; 32007627a0deSMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client_connections); 32017627a0deSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)) { 32027627a0deSMatthias Ringwald gatt_client_t * gatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it); 32037627a0deSMatthias Ringwald btstack_linked_list_iterator_t it2; 32047627a0deSMatthias Ringwald btstack_linked_list_iterator_init(&it2, &gatt_client->eatt_clients); 32057627a0deSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it2)) { 32067627a0deSMatthias Ringwald gatt_client_t * eatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it2); 32077627a0deSMatthias Ringwald if (eatt_client->l2cap_cid == l2cap_cid){ 32087627a0deSMatthias Ringwald *out_eatt_client = eatt_client; 32097627a0deSMatthias Ringwald return gatt_client; 32107627a0deSMatthias Ringwald } 32117627a0deSMatthias Ringwald } 32127627a0deSMatthias Ringwald } 32137627a0deSMatthias Ringwald return NULL; 32147627a0deSMatthias Ringwald } 32157627a0deSMatthias Ringwald 32167627a0deSMatthias Ringwald static void gatt_client_le_enhanced_setup_l2cap_channel(gatt_client_t * gatt_client){ 32177627a0deSMatthias Ringwald uint8_t num_channels = gatt_client->eatt_num_clients; 32187627a0deSMatthias Ringwald 32197627a0deSMatthias Ringwald // setup channels 32207627a0deSMatthias Ringwald uint16_t buffer_size_per_client = gatt_client->eatt_storage_size / num_channels; 3221f7a42e72SMatthias Ringwald uint16_t max_mtu = (buffer_size_per_client - REPORT_PREBUFFER_HEADER) / 2; 32227627a0deSMatthias Ringwald uint8_t * receive_buffers[MAX_NR_EATT_CHANNELS]; 32237627a0deSMatthias Ringwald uint16_t new_cids[MAX_NR_EATT_CHANNELS]; 32247627a0deSMatthias Ringwald memset(gatt_client->eatt_storage_buffer, 0, gatt_client->eatt_storage_size); 32257627a0deSMatthias Ringwald uint8_t i; 32267627a0deSMatthias Ringwald for (i=0;i<gatt_client->eatt_num_clients; i++){ 3227f7a42e72SMatthias Ringwald receive_buffers[i] = &gatt_client->eatt_storage_buffer[REPORT_PREBUFFER_HEADER]; 3228f7a42e72SMatthias Ringwald gatt_client->eatt_storage_buffer += REPORT_PREBUFFER_HEADER + max_mtu; 32297627a0deSMatthias Ringwald } 32307627a0deSMatthias Ringwald 32317627a0deSMatthias Ringwald log_info("%u EATT clients with receive buffer size %u", gatt_client->eatt_num_clients, buffer_size_per_client); 32327627a0deSMatthias Ringwald 3233f7a42e72SMatthias Ringwald uint8_t status = l2cap_ecbm_create_channels(&gatt_client_le_enhanced_packet_handler, 3234f7a42e72SMatthias Ringwald gatt_client->con_handle, 32357627a0deSMatthias Ringwald gatt_client->security_level, 3236f7a42e72SMatthias Ringwald BLUETOOTH_PSM_EATT, num_channels, 3237f7a42e72SMatthias Ringwald L2CAP_LE_AUTOMATIC_CREDITS, 32387627a0deSMatthias Ringwald buffer_size_per_client, 3239f7a42e72SMatthias Ringwald receive_buffers, 3240f7a42e72SMatthias Ringwald new_cids); 32417627a0deSMatthias Ringwald 32427627a0deSMatthias Ringwald if (status == ERROR_CODE_SUCCESS){ 32437627a0deSMatthias Ringwald i = 0; 32447627a0deSMatthias Ringwald btstack_linked_list_iterator_t it; 32457627a0deSMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client->eatt_clients); 32467627a0deSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)) { 32477627a0deSMatthias Ringwald gatt_client_t *new_eatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it); 32487627a0deSMatthias Ringwald 32497627a0deSMatthias Ringwald // init state with new cid and transmit buffer 32507627a0deSMatthias Ringwald new_eatt_client->bearer_type = ATT_BEARER_ENHANCED_LE; 32517627a0deSMatthias Ringwald new_eatt_client->con_handle = gatt_client->con_handle; 32527627a0deSMatthias Ringwald new_eatt_client->mtu = 64; 32537627a0deSMatthias Ringwald new_eatt_client->security_level = LEVEL_0; 32547627a0deSMatthias Ringwald new_eatt_client->mtu_state = MTU_AUTO_EXCHANGE_DISABLED; 3255052dc82aSMatthias Ringwald new_eatt_client->state = P_W4_L2CAP_CONNECTION; 32567627a0deSMatthias Ringwald new_eatt_client->l2cap_cid = new_cids[i]; 32577627a0deSMatthias Ringwald new_eatt_client->eatt_storage_buffer = gatt_client->eatt_storage_buffer; 3258f7a42e72SMatthias Ringwald gatt_client->eatt_storage_buffer += max_mtu; 32597627a0deSMatthias Ringwald i++; 32607627a0deSMatthias Ringwald } 32617627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_L2CAP_SETUP; 32627627a0deSMatthias Ringwald } else { 32637627a0deSMatthias Ringwald gatt_client_le_enhanced_handle_connected(gatt_client, status); 32647627a0deSMatthias Ringwald } 326526166ecfSMatthias Ringwald } 326626166ecfSMatthias Ringwald 32676d0f6f49SMatthias Ringwald static void gatt_client_le_enhanced_retry(btstack_timer_source_t * ts){ 32686d0f6f49SMatthias Ringwald gatt_client_t * gatt_client = gatt_client_for_timer(ts); 32696d0f6f49SMatthias Ringwald if (gatt_client != NULL){ 32706d0f6f49SMatthias Ringwald gatt_client->state = P_W4_L2CAP_CONNECTION; 32716d0f6f49SMatthias Ringwald gatt_client_le_enhanced_setup_l2cap_channel(gatt_client); 32726d0f6f49SMatthias Ringwald } 32736d0f6f49SMatthias Ringwald } 32746d0f6f49SMatthias Ringwald 327526166ecfSMatthias Ringwald static void gatt_client_le_enhanced_packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size) { 32767627a0deSMatthias Ringwald gatt_client_t *gatt_client; 32777627a0deSMatthias Ringwald gatt_client_t *eatt_client; 327826166ecfSMatthias Ringwald hci_con_handle_t con_handle; 32797627a0deSMatthias Ringwald uint16_t l2cap_cid; 328026166ecfSMatthias Ringwald uint8_t status; 328126166ecfSMatthias Ringwald gatt_client_characteristic_t characteristic; 32827627a0deSMatthias Ringwald gatt_client_service_t service; 3283df0a5c68SMatthias Ringwald btstack_linked_list_iterator_t it; 3284df0a5c68SMatthias Ringwald uint8_t num_pending_channels; 328526166ecfSMatthias Ringwald switch (packet_type) { 328626166ecfSMatthias Ringwald case HCI_EVENT_PACKET: 328726166ecfSMatthias Ringwald switch (hci_event_packet_get_type(packet)) { 32887627a0deSMatthias Ringwald case GATT_EVENT_SERVICE_QUERY_RESULT: 32897627a0deSMatthias Ringwald con_handle = gatt_event_service_query_result_get_handle(packet); 32907627a0deSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(con_handle); 32917627a0deSMatthias Ringwald btstack_assert(gatt_client != NULL); 32927627a0deSMatthias Ringwald btstack_assert(gatt_client->eatt_state == GATT_CLIENT_EATT_DISCOVER_GATT_SERVICE_W4_DONE); 32937627a0deSMatthias Ringwald gatt_event_service_query_result_get_service(packet, &service); 32947627a0deSMatthias Ringwald gatt_client->gatt_service_start_group_handle = service.start_group_handle; 32957627a0deSMatthias Ringwald gatt_client->gatt_service_end_group_handle = service.end_group_handle; 32967627a0deSMatthias Ringwald break; 329726166ecfSMatthias Ringwald case GATT_EVENT_CHARACTERISTIC_VALUE_QUERY_RESULT: 329826166ecfSMatthias Ringwald con_handle = gatt_event_characteristic_value_query_result_get_handle(packet); 329926166ecfSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(con_handle); 330026166ecfSMatthias Ringwald btstack_assert(gatt_client != NULL); 33017627a0deSMatthias Ringwald btstack_assert(gatt_client->eatt_state == GATT_CLIENT_EATT_READ_SERVER_SUPPORTED_FEATURES_W4_DONE); 330226166ecfSMatthias Ringwald if (gatt_event_characteristic_value_query_result_get_value_length(packet) >= 1) { 33037627a0deSMatthias Ringwald gatt_client->gatt_server_supported_features = gatt_event_characteristic_value_query_result_get_value(packet)[0]; 330426166ecfSMatthias Ringwald } 330526166ecfSMatthias Ringwald break; 330626166ecfSMatthias Ringwald case GATT_EVENT_CHARACTERISTIC_QUERY_RESULT: 330726166ecfSMatthias Ringwald con_handle = gatt_event_characteristic_query_result_get_handle(packet); 330826166ecfSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(con_handle); 330926166ecfSMatthias Ringwald btstack_assert(gatt_client != NULL); 33107627a0deSMatthias Ringwald btstack_assert(gatt_client->eatt_state == GATT_CLIENT_EATT_FIND_CLIENT_SUPPORTED_FEATURES_W4_DONE); 33117627a0deSMatthias Ringwald gatt_event_characteristic_query_result_get_characteristic(packet, &characteristic); 331226166ecfSMatthias Ringwald gatt_client->gatt_client_supported_features_handle = characteristic.value_handle; 331326166ecfSMatthias Ringwald break; 331426166ecfSMatthias Ringwald case GATT_EVENT_QUERY_COMPLETE: 331526166ecfSMatthias Ringwald con_handle = gatt_event_query_complete_get_handle(packet); 331626166ecfSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(con_handle); 331726166ecfSMatthias Ringwald btstack_assert(gatt_client != NULL); 33187627a0deSMatthias Ringwald switch (gatt_client->eatt_state){ 33197627a0deSMatthias Ringwald case GATT_CLIENT_EATT_DISCOVER_GATT_SERVICE_W4_DONE: 33207627a0deSMatthias Ringwald if (gatt_client->gatt_service_start_group_handle == 0){ 33217627a0deSMatthias Ringwald gatt_client_le_enhanced_handle_connected(gatt_client, ERROR_CODE_UNSUPPORTED_FEATURE_OR_PARAMETER_VALUE); 33227627a0deSMatthias Ringwald } else { 33237627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_READ_SERVER_SUPPORTED_FEATURES_W2_SEND; 33247627a0deSMatthias Ringwald } 33257627a0deSMatthias Ringwald break; 33267627a0deSMatthias Ringwald case GATT_CLIENT_EATT_READ_SERVER_SUPPORTED_FEATURES_W4_DONE: 33277627a0deSMatthias Ringwald if ((gatt_client->gatt_server_supported_features & 1) == 0) { 33287627a0deSMatthias Ringwald gatt_client_le_enhanced_handle_connected(gatt_client, ERROR_CODE_UNSUPPORTED_FEATURE_OR_PARAMETER_VALUE); 33297627a0deSMatthias Ringwald } else { 33307627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_FIND_CLIENT_SUPPORTED_FEATURES_W2_SEND; 33317627a0deSMatthias Ringwald } 33327627a0deSMatthias Ringwald break; 33337627a0deSMatthias Ringwald case GATT_CLIENT_EATT_FIND_CLIENT_SUPPORTED_FEATURES_W4_DONE: 33347627a0deSMatthias Ringwald if (gatt_client->gatt_client_supported_features_handle == 0){ 33357627a0deSMatthias Ringwald gatt_client_le_enhanced_handle_connected(gatt_client, ERROR_CODE_UNSUPPORTED_FEATURE_OR_PARAMETER_VALUE); 33367627a0deSMatthias Ringwald } else { 33377627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_WRITE_ClIENT_SUPPORTED_FEATURES_W2_SEND; 33387627a0deSMatthias Ringwald } 33397627a0deSMatthias Ringwald break; 33407627a0deSMatthias Ringwald case GATT_CLIENT_EATT_WRITE_ClIENT_SUPPORTED_FEATURES_W4_DONE: 33417627a0deSMatthias Ringwald gatt_client_le_enhanced_setup_l2cap_channel(gatt_client); 334226166ecfSMatthias Ringwald break; 334326166ecfSMatthias Ringwald default: 334426166ecfSMatthias Ringwald break; 334526166ecfSMatthias Ringwald } 334626166ecfSMatthias Ringwald break; 33477627a0deSMatthias Ringwald case L2CAP_EVENT_ECBM_CHANNEL_OPENED: 33487627a0deSMatthias Ringwald l2cap_cid = l2cap_event_ecbm_channel_opened_get_local_cid(packet); 33497627a0deSMatthias Ringwald gatt_client = gatt_client_le_enhanced_get_context_for_l2cap_cid(l2cap_cid, &eatt_client); 33507627a0deSMatthias Ringwald 33517627a0deSMatthias Ringwald btstack_assert(gatt_client != NULL); 33527627a0deSMatthias Ringwald btstack_assert(eatt_client != NULL); 3353052dc82aSMatthias Ringwald btstack_assert(eatt_client->state == P_W4_L2CAP_CONNECTION); 33547627a0deSMatthias Ringwald 33557627a0deSMatthias Ringwald status = l2cap_event_channel_opened_get_status(packet); 33567627a0deSMatthias Ringwald if (status == ERROR_CODE_SUCCESS){ 3357052dc82aSMatthias Ringwald eatt_client->state = P_READY; 33587627a0deSMatthias Ringwald eatt_client->mtu = l2cap_event_channel_opened_get_remote_mtu(packet); 33597627a0deSMatthias Ringwald } else { 3360df0a5c68SMatthias Ringwald eatt_client->state = P_L2CAP_CLOSED; 33617627a0deSMatthias Ringwald } 3362df0a5c68SMatthias Ringwald // connected if opened event for all channels received 3363df0a5c68SMatthias Ringwald if (gatt_client_le_enhanced_num_eatt_clients_in_state(gatt_client, P_W4_L2CAP_CONNECTION) == 0){ 33647627a0deSMatthias Ringwald gatt_client_le_enhanced_handle_connected(gatt_client, ERROR_CODE_SUCCESS); 33657627a0deSMatthias Ringwald } 33667627a0deSMatthias Ringwald break; 33677627a0deSMatthias Ringwald case L2CAP_EVENT_CHANNEL_CLOSED: 33687627a0deSMatthias Ringwald l2cap_cid = l2cap_event_channel_closed_get_local_cid(packet); 33697627a0deSMatthias Ringwald gatt_client = gatt_client_le_enhanced_get_context_for_l2cap_cid(l2cap_cid, &eatt_client); 33707627a0deSMatthias Ringwald btstack_assert(gatt_client != NULL); 33717627a0deSMatthias Ringwald btstack_assert(eatt_client != NULL); 33727627a0deSMatthias Ringwald gatt_client_le_enhanced_handle_ecbm_disconnected(gatt_client, eatt_client); 33737627a0deSMatthias Ringwald break; 33747627a0deSMatthias Ringwald default: 33757627a0deSMatthias Ringwald break; 33767627a0deSMatthias Ringwald } 33777627a0deSMatthias Ringwald break; 33787627a0deSMatthias Ringwald case L2CAP_DATA_PACKET: 33797627a0deSMatthias Ringwald gatt_client = gatt_client_le_enhanced_get_context_for_l2cap_cid(channel, &eatt_client); 33807627a0deSMatthias Ringwald btstack_assert(gatt_client != NULL); 3381ce82ac7fSMatthias Ringwald btstack_assert(eatt_client != NULL); 3382ce82ac7fSMatthias Ringwald gatt_client_handle_att_response(eatt_client, packet, size); 33837627a0deSMatthias Ringwald gatt_client_run(); 33847627a0deSMatthias Ringwald break; 338526166ecfSMatthias Ringwald default: 338626166ecfSMatthias Ringwald break; 338726166ecfSMatthias Ringwald } 338826166ecfSMatthias Ringwald } 338926166ecfSMatthias Ringwald 33907627a0deSMatthias Ringwald static bool gatt_client_le_enhanced_handle_can_send_query(gatt_client_t * gatt_client){ 339126166ecfSMatthias Ringwald uint8_t status = ERROR_CODE_SUCCESS; 339226166ecfSMatthias Ringwald uint8_t gatt_client_supported_features = 0x06; // eatt + multiple value notifications 339326166ecfSMatthias Ringwald switch (gatt_client->eatt_state){ 33947627a0deSMatthias Ringwald case GATT_CLIENT_EATT_DISCOVER_GATT_SERVICE_W2_SEND: 33957627a0deSMatthias Ringwald gatt_client->gatt_service_start_group_handle = 0; 33967627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_DISCOVER_GATT_SERVICE_W4_DONE; 33977627a0deSMatthias Ringwald status = gatt_client_discover_primary_services_by_uuid16(&gatt_client_le_enhanced_packet_handler, 33987627a0deSMatthias Ringwald gatt_client->con_handle, 33997627a0deSMatthias Ringwald ORG_BLUETOOTH_SERVICE_GENERIC_ATTRIBUTE); 34007627a0deSMatthias Ringwald break; 340126166ecfSMatthias Ringwald case GATT_CLIENT_EATT_READ_SERVER_SUPPORTED_FEATURES_W2_SEND: 34027627a0deSMatthias Ringwald gatt_client->gatt_server_supported_features = 0; 34037627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_READ_SERVER_SUPPORTED_FEATURES_W4_DONE; 340426166ecfSMatthias Ringwald status = gatt_client_read_value_of_characteristics_by_uuid16(&gatt_client_le_enhanced_packet_handler, 34057627a0deSMatthias Ringwald gatt_client->con_handle, 34067627a0deSMatthias Ringwald gatt_client->gatt_service_start_group_handle, 34077627a0deSMatthias Ringwald gatt_client->gatt_service_end_group_handle, 340826166ecfSMatthias Ringwald ORG_BLUETOOTH_CHARACTERISTIC_SERVER_SUPPORTED_FEATURES); 340926166ecfSMatthias Ringwald return true; 341026166ecfSMatthias Ringwald case GATT_CLIENT_EATT_FIND_CLIENT_SUPPORTED_FEATURES_W2_SEND: 34117627a0deSMatthias Ringwald gatt_client->gatt_client_supported_features_handle = 0; 34127627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_FIND_CLIENT_SUPPORTED_FEATURES_W4_DONE; 341326166ecfSMatthias Ringwald status = gatt_client_discover_characteristics_for_handle_range_by_uuid16(&gatt_client_le_enhanced_packet_handler, 34147627a0deSMatthias Ringwald gatt_client->con_handle, 34157627a0deSMatthias Ringwald gatt_client->gatt_service_start_group_handle, 34167627a0deSMatthias Ringwald gatt_client->gatt_service_end_group_handle, 34177627a0deSMatthias Ringwald ORG_BLUETOOTH_CHARACTERISTIC_CLIENT_SUPPORTED_FEATURES); 341826166ecfSMatthias Ringwald return true; 341926166ecfSMatthias Ringwald case GATT_CLIENT_EATT_WRITE_ClIENT_SUPPORTED_FEATURES_W2_SEND: 342026166ecfSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_WRITE_ClIENT_SUPPORTED_FEATURES_W4_DONE; 342126166ecfSMatthias Ringwald status = gatt_client_write_value_of_characteristic(&gatt_client_le_enhanced_packet_handler, gatt_client->con_handle, 342226166ecfSMatthias Ringwald gatt_client->gatt_client_supported_features_handle, 1, 342326166ecfSMatthias Ringwald &gatt_client_supported_features); 342426166ecfSMatthias Ringwald return true; 342526166ecfSMatthias Ringwald default: 342626166ecfSMatthias Ringwald break; 342726166ecfSMatthias Ringwald } 34287627a0deSMatthias Ringwald btstack_assert(status == ERROR_CODE_SUCCESS); 34297627a0deSMatthias Ringwald UNUSED(status); 343026166ecfSMatthias Ringwald return false; 343126166ecfSMatthias Ringwald } 343226166ecfSMatthias Ringwald 343326166ecfSMatthias 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) { 343426166ecfSMatthias Ringwald gatt_client_t * gatt_client; 343526166ecfSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 343626166ecfSMatthias Ringwald if (status != ERROR_CODE_SUCCESS){ 343726166ecfSMatthias Ringwald return status; 343826166ecfSMatthias Ringwald } 343926166ecfSMatthias Ringwald 344026166ecfSMatthias Ringwald if (gatt_client->eatt_state != GATT_CLIENT_EATT_IDLE){ 344126166ecfSMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 344226166ecfSMatthias Ringwald } 344326166ecfSMatthias Ringwald 3444f7a42e72SMatthias Ringwald // need one buffer for sending and one for receiving. Receiving includes pre-buffer for reports 34457627a0deSMatthias Ringwald uint16_t buffer_size_per_client = storage_size / num_channels; 3446f7a42e72SMatthias Ringwald uint16_t max_mtu = (buffer_size_per_client - REPORT_PREBUFFER_HEADER) / 2; 3447f7a42e72SMatthias Ringwald if (max_mtu < 64) { 34487627a0deSMatthias Ringwald return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS; 34497627a0deSMatthias Ringwald } 34507627a0deSMatthias Ringwald 34517627a0deSMatthias Ringwald if ((num_channels == 0) || (num_channels > MAX_NR_EATT_CHANNELS)){ 34527627a0deSMatthias Ringwald return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS; 34537627a0deSMatthias Ringwald } 34547627a0deSMatthias Ringwald 34557627a0deSMatthias Ringwald // create max num_channel eatt clients 34567627a0deSMatthias Ringwald uint8_t i; 34577627a0deSMatthias Ringwald btstack_linked_list_t eatt_clients = NULL; 34587627a0deSMatthias Ringwald for (i=0;i<num_channels;i++) { 34597627a0deSMatthias Ringwald gatt_client_t * new_gatt_client = btstack_memory_gatt_client_get(); 34607627a0deSMatthias Ringwald if (new_gatt_client == NULL) { 34617627a0deSMatthias Ringwald break; 34627627a0deSMatthias Ringwald } 34637627a0deSMatthias Ringwald btstack_linked_list_add(&eatt_clients, (btstack_linked_item_t*)new_gatt_client); 34647627a0deSMatthias Ringwald } 34657627a0deSMatthias Ringwald 34667627a0deSMatthias Ringwald if (i != num_channels){ 34677627a0deSMatthias Ringwald while (true){ 34687627a0deSMatthias Ringwald gatt_client = (gatt_client_t *) btstack_linked_list_pop(&eatt_clients); 34697627a0deSMatthias Ringwald if (gatt_client == NULL) { 34707627a0deSMatthias Ringwald break; 34717627a0deSMatthias Ringwald } 34727627a0deSMatthias Ringwald btstack_memory_gatt_client_free(gatt_client); 34737627a0deSMatthias Ringwald } 34747627a0deSMatthias Ringwald return ERROR_CODE_MEMORY_CAPACITY_EXCEEDED; 34757627a0deSMatthias Ringwald } 34767627a0deSMatthias Ringwald 3477570bdd2dSMatthias Ringwald hci_connection_t * hci_connection = hci_connection_for_handle(con_handle); 3478570bdd2dSMatthias Ringwald hci_connection->att_server.eatt_outgoing_active = true; 3479570bdd2dSMatthias Ringwald 34807627a0deSMatthias Ringwald gatt_client->callback = callback; 34817627a0deSMatthias Ringwald gatt_client->eatt_num_clients = num_channels; 34827627a0deSMatthias Ringwald gatt_client->eatt_storage_buffer = storage_buffer; 34837627a0deSMatthias Ringwald gatt_client->eatt_storage_size = storage_size; 34847627a0deSMatthias Ringwald gatt_client->eatt_clients = eatt_clients; 34857627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_DISCOVER_GATT_SERVICE_W2_SEND; 348626166ecfSMatthias Ringwald gatt_client_notify_can_send_query(gatt_client); 348726166ecfSMatthias Ringwald 348826166ecfSMatthias Ringwald return ERROR_CODE_SUCCESS; 348926166ecfSMatthias Ringwald } 349026166ecfSMatthias Ringwald 349126166ecfSMatthias Ringwald #endif 349226166ecfSMatthias Ringwald 3493a6121b51SMilanka Ringwald #ifdef FUZZING_BUILD_MODE_UNSAFE_FOR_PRODUCTION 3494a6121b51SMilanka Ringwald void gatt_client_att_packet_handler_fuzz(uint8_t packet_type, uint16_t handle, uint8_t *packet, uint16_t size){ 3495a6121b51SMilanka Ringwald gatt_client_att_packet_handler(packet_type, handle, packet, size); 3496a6121b51SMilanka Ringwald } 3497ae1ee62dSMilanka Ringwald 349840faeb84SMilanka Ringwald uint8_t gatt_client_get_client(hci_con_handle_t con_handle, gatt_client_t ** out_gatt_client){ 349940faeb84SMilanka Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, out_gatt_client); 350040faeb84SMilanka Ringwald return status; 3501ae1ee62dSMilanka Ringwald } 3502a6121b51SMilanka Ringwald #endif 3503