13deb3ec6SMatthias Ringwald /* 23deb3ec6SMatthias Ringwald * Copyright (C) 2014 BlueKitchen GmbH 33deb3ec6SMatthias Ringwald * 43deb3ec6SMatthias Ringwald * Redistribution and use in source and binary forms, with or without 53deb3ec6SMatthias Ringwald * modification, are permitted provided that the following conditions 63deb3ec6SMatthias Ringwald * are met: 73deb3ec6SMatthias Ringwald * 83deb3ec6SMatthias Ringwald * 1. Redistributions of source code must retain the above copyright 93deb3ec6SMatthias Ringwald * notice, this list of conditions and the following disclaimer. 103deb3ec6SMatthias Ringwald * 2. Redistributions in binary form must reproduce the above copyright 113deb3ec6SMatthias Ringwald * notice, this list of conditions and the following disclaimer in the 123deb3ec6SMatthias Ringwald * documentation and/or other materials provided with the distribution. 133deb3ec6SMatthias Ringwald * 3. Neither the name of the copyright holders nor the names of 143deb3ec6SMatthias Ringwald * contributors may be used to endorse or promote products derived 153deb3ec6SMatthias Ringwald * from this software without specific prior written permission. 163deb3ec6SMatthias Ringwald * 4. Any redistribution, use, or modification is done solely for 173deb3ec6SMatthias Ringwald * personal benefit and not for any commercial purpose or for 183deb3ec6SMatthias Ringwald * monetary gain. 193deb3ec6SMatthias Ringwald * 203deb3ec6SMatthias Ringwald * THIS SOFTWARE IS PROVIDED BY BLUEKITCHEN GMBH AND CONTRIBUTORS 213deb3ec6SMatthias Ringwald * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 223deb3ec6SMatthias Ringwald * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS 232fca4dadSMilanka Ringwald * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL BLUEKITCHEN 242fca4dadSMilanka Ringwald * GMBH OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, 253deb3ec6SMatthias Ringwald * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, 263deb3ec6SMatthias Ringwald * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS 273deb3ec6SMatthias Ringwald * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED 283deb3ec6SMatthias Ringwald * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, 293deb3ec6SMatthias Ringwald * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF 303deb3ec6SMatthias Ringwald * THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 313deb3ec6SMatthias Ringwald * SUCH DAMAGE. 323deb3ec6SMatthias Ringwald * 333deb3ec6SMatthias Ringwald * Please inquire about commercial licensing options at 343deb3ec6SMatthias Ringwald * [email protected] 353deb3ec6SMatthias Ringwald * 363deb3ec6SMatthias Ringwald */ 373deb3ec6SMatthias Ringwald 38e501bae0SMatthias Ringwald #define BTSTACK_FILE__ "gatt_client.c" 39ab2c6ae4SMatthias Ringwald 403deb3ec6SMatthias Ringwald #include <stdint.h> 413deb3ec6SMatthias Ringwald #include <string.h> 42a95ca902SMatthias Ringwald #include <stddef.h> 433deb3ec6SMatthias Ringwald 447907f069SMatthias Ringwald #include "btstack_config.h" 453deb3ec6SMatthias Ringwald 46296289e3SMatthias Ringwald #include "ble/att_dispatch.h" 470e2df43fSMatthias Ringwald #include "ble/att_db.h" 480e2df43fSMatthias Ringwald #include "ble/gatt_client.h" 490e2df43fSMatthias Ringwald #include "ble/le_device_db.h" 500e2df43fSMatthias Ringwald #include "ble/sm.h" 5116ece135SMatthias Ringwald #include "btstack_debug.h" 520e2df43fSMatthias Ringwald #include "btstack_event.h" 533deb3ec6SMatthias Ringwald #include "btstack_memory.h" 540e2df43fSMatthias Ringwald #include "btstack_run_loop.h" 550e2df43fSMatthias Ringwald #include "btstack_util.h" 563deb3ec6SMatthias Ringwald #include "hci.h" 573deb3ec6SMatthias Ringwald #include "hci_dump.h" 583deb3ec6SMatthias Ringwald #include "l2cap.h" 591450cdc6SMatthias Ringwald #include "classic/sdp_client.h" 601450cdc6SMatthias Ringwald #include "bluetooth_gatt.h" 611450cdc6SMatthias Ringwald #include "bluetooth_sdp.h" 621450cdc6SMatthias Ringwald #include "classic/sdp_util.h" 633deb3ec6SMatthias Ringwald 649c662c9bSMatthias Ringwald static btstack_linked_list_t gatt_client_connections; 659c662c9bSMatthias Ringwald static btstack_linked_list_t gatt_client_value_listeners; 66361b1363SMatthias Ringwald static btstack_packet_callback_registration_t hci_event_callback_registration; 67f4b33574SMatthias Ringwald static btstack_packet_callback_registration_t sm_event_callback_registration; 68f4b33574SMatthias Ringwald 6911279da7SMatthias Ringwald // GATT Client Configuration 7011279da7SMatthias Ringwald static bool gatt_client_mtu_exchange_enabled; 7111279da7SMatthias Ringwald static gap_security_level_t gatt_client_required_security_level; 725cf6c434SJakob Krantz 733deb3ec6SMatthias Ringwald static void gatt_client_att_packet_handler(uint8_t packet_type, uint16_t handle, uint8_t *packet, uint16_t size); 74f4b33574SMatthias Ringwald static void gatt_client_event_packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size); 755cf1669fSMatthias Ringwald static void gatt_client_report_error_if_pending(gatt_client_t *gatt_client, uint8_t att_error_code); 767a766ebfSMatthias Ringwald 777a766ebfSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 783deb3ec6SMatthias Ringwald static void att_signed_write_handle_cmac_result(uint8_t hash[8]); 797a766ebfSMatthias Ringwald #endif 803deb3ec6SMatthias Ringwald 81*59b5e157SMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC 82*59b5e157SMatthias Ringwald static gatt_client_t * gatt_client_get_context_for_l2cap_cid(uint16_t l2cap_cid); 83*59b5e157SMatthias Ringwald static void gatt_client_classic_handle_connected(gatt_client_t * gatt_client, uint8_t status); 84*59b5e157SMatthias Ringwald static void gatt_client_classic_handle_disconnected(gatt_client_t * gatt_client); 85*59b5e157SMatthias Ringwald #endif 86*59b5e157SMatthias Ringwald 8726166ecfSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 887627a0deSMatthias Ringwald static bool gatt_client_le_enhanced_handle_can_send_query(gatt_client_t * gatt_client); 8926166ecfSMatthias Ringwald #endif 9026166ecfSMatthias Ringwald 913deb3ec6SMatthias Ringwald void gatt_client_init(void){ 923deb3ec6SMatthias Ringwald gatt_client_connections = NULL; 93f4b33574SMatthias Ringwald 9411279da7SMatthias Ringwald // default configuration 9511279da7SMatthias Ringwald gatt_client_mtu_exchange_enabled = true; 9611279da7SMatthias Ringwald gatt_client_required_security_level = LEVEL_0; 9711279da7SMatthias Ringwald 9811279da7SMatthias Ringwald // register for HCI Events 99f4b33574SMatthias Ringwald hci_event_callback_registration.callback = &gatt_client_event_packet_handler; 100361b1363SMatthias Ringwald hci_add_event_handler(&hci_event_callback_registration); 101361b1363SMatthias Ringwald 102f4b33574SMatthias Ringwald // register for SM Events 103f4b33574SMatthias Ringwald sm_event_callback_registration.callback = &gatt_client_event_packet_handler; 104f4b33574SMatthias Ringwald sm_add_event_handler(&sm_event_callback_registration); 105f4b33574SMatthias Ringwald 106361b1363SMatthias Ringwald // and ATT Client PDUs 1073deb3ec6SMatthias Ringwald att_dispatch_register_client(gatt_client_att_packet_handler); 1083deb3ec6SMatthias Ringwald } 1093deb3ec6SMatthias Ringwald 11011279da7SMatthias Ringwald void gatt_client_set_required_security_level(gap_security_level_t level){ 11111279da7SMatthias Ringwald gatt_client_required_security_level = level; 11211279da7SMatthias Ringwald } 11311279da7SMatthias Ringwald 114ec820d77SMatthias Ringwald static gatt_client_t * gatt_client_for_timer(btstack_timer_source_t * ts){ 115665d90f2SMatthias Ringwald btstack_linked_list_iterator_t it; 116665d90f2SMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client_connections); 117665d90f2SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 1185cf1669fSMatthias Ringwald gatt_client_t * gatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it); 1195cf1669fSMatthias Ringwald if (&gatt_client->gc_timeout == ts) { 1205cf1669fSMatthias Ringwald return gatt_client; 1213deb3ec6SMatthias Ringwald } 1223deb3ec6SMatthias Ringwald } 1233deb3ec6SMatthias Ringwald return NULL; 1243deb3ec6SMatthias Ringwald } 1253deb3ec6SMatthias Ringwald 126ec820d77SMatthias Ringwald static void gatt_client_timeout_handler(btstack_timer_source_t * timer){ 1275cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_for_timer(timer); 1285cf1669fSMatthias Ringwald if (gatt_client == NULL) return; 1295cf1669fSMatthias Ringwald log_info("GATT client timeout handle, handle 0x%02x", gatt_client->con_handle); 1305cf1669fSMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, ATT_ERROR_TIMEOUT); 1313deb3ec6SMatthias Ringwald } 1323deb3ec6SMatthias Ringwald 1335cf1669fSMatthias Ringwald static void gatt_client_timeout_start(gatt_client_t * gatt_client){ 1345cf1669fSMatthias Ringwald log_info("GATT client timeout start, handle 0x%02x", gatt_client->con_handle); 1355cf1669fSMatthias Ringwald btstack_run_loop_remove_timer(&gatt_client->gc_timeout); 1365cf1669fSMatthias Ringwald btstack_run_loop_set_timer_handler(&gatt_client->gc_timeout, gatt_client_timeout_handler); 1375cf1669fSMatthias Ringwald btstack_run_loop_set_timer(&gatt_client->gc_timeout, 30000); // 30 seconds sm timeout 1385cf1669fSMatthias Ringwald btstack_run_loop_add_timer(&gatt_client->gc_timeout); 1393deb3ec6SMatthias Ringwald } 1403deb3ec6SMatthias Ringwald 1415cf1669fSMatthias Ringwald static void gatt_client_timeout_stop(gatt_client_t * gatt_client){ 1425cf1669fSMatthias Ringwald log_info("GATT client timeout stop, handle 0x%02x", gatt_client->con_handle); 1435cf1669fSMatthias Ringwald btstack_run_loop_remove_timer(&gatt_client->gc_timeout); 1443deb3ec6SMatthias Ringwald } 1453deb3ec6SMatthias Ringwald 1461dfae9c7SMatthias Ringwald static gap_security_level_t gatt_client_le_security_level_for_connection(hci_con_handle_t con_handle){ 1471dfae9c7SMatthias Ringwald uint8_t encryption_key_size = gap_encryption_key_size(con_handle); 1481dfae9c7SMatthias Ringwald if (encryption_key_size == 0) return LEVEL_0; 1491dfae9c7SMatthias Ringwald 150ff3f1026SMatthias Ringwald bool authenticated = gap_authenticated(con_handle); 1511dfae9c7SMatthias Ringwald if (!authenticated) return LEVEL_2; 1521dfae9c7SMatthias Ringwald 1531dfae9c7SMatthias Ringwald return encryption_key_size == 16 ? LEVEL_4 : LEVEL_3; 1541dfae9c7SMatthias Ringwald } 1551dfae9c7SMatthias Ringwald 1565cf1669fSMatthias Ringwald static gatt_client_t * gatt_client_get_context_for_handle(uint16_t handle){ 157665d90f2SMatthias Ringwald btstack_linked_item_t *it; 158a0da043fSMatthias Ringwald for (it = (btstack_linked_item_t *) gatt_client_connections; it != NULL; it = it->next){ 1595cf1669fSMatthias Ringwald gatt_client_t * gatt_client = (gatt_client_t *) it; 1605cf1669fSMatthias Ringwald if (gatt_client->con_handle == handle){ 1615cf1669fSMatthias Ringwald return gatt_client; 1623deb3ec6SMatthias Ringwald } 1633deb3ec6SMatthias Ringwald } 1643deb3ec6SMatthias Ringwald return NULL; 1653deb3ec6SMatthias Ringwald } 1663deb3ec6SMatthias Ringwald 1673deb3ec6SMatthias Ringwald 1686b65794dSMilanka Ringwald // @return gatt_client context 1693deb3ec6SMatthias Ringwald // returns existing one, or tries to setup new one 17040faeb84SMilanka Ringwald static uint8_t gatt_client_provide_context_for_handle(hci_con_handle_t con_handle, gatt_client_t ** out_gatt_client){ 1715cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_get_context_for_handle(con_handle); 17240faeb84SMilanka Ringwald 17340faeb84SMilanka Ringwald if (gatt_client != NULL){ 17440faeb84SMilanka Ringwald *out_gatt_client = gatt_client; 17540faeb84SMilanka Ringwald return ERROR_CODE_SUCCESS; 17640faeb84SMilanka Ringwald } 1773deb3ec6SMatthias Ringwald 178ae1d1237SMatthias Ringwald // bail if no such hci connection 1790e0bba86SMatthias Ringwald hci_connection_t * hci_connection = hci_connection_for_handle(con_handle); 1800e0bba86SMatthias Ringwald if (hci_connection == NULL){ 181ae1d1237SMatthias Ringwald log_error("No connection for handle 0x%04x", con_handle); 18240faeb84SMilanka Ringwald *out_gatt_client = NULL; 18340faeb84SMilanka Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 184ae1d1237SMatthias Ringwald } 18540faeb84SMilanka Ringwald 1865cf1669fSMatthias Ringwald gatt_client = btstack_memory_gatt_client_get(); 18740faeb84SMilanka Ringwald if (gatt_client == NULL){ 18840faeb84SMilanka Ringwald *out_gatt_client = NULL; 18940faeb84SMilanka Ringwald return ERROR_CODE_MEMORY_CAPACITY_EXCEEDED; 19040faeb84SMilanka Ringwald } 1913deb3ec6SMatthias Ringwald // init state 192e9cdf30bSMatthias Ringwald gatt_client->bearer_type = ATT_BEARER_UNENHANCED_LE; 1935cf1669fSMatthias Ringwald gatt_client->con_handle = con_handle; 1945cf1669fSMatthias Ringwald gatt_client->mtu = ATT_DEFAULT_MTU; 1951dfae9c7SMatthias Ringwald gatt_client->security_level = gatt_client_le_security_level_for_connection(con_handle); 19611279da7SMatthias Ringwald if (gatt_client_mtu_exchange_enabled){ 1975cf1669fSMatthias Ringwald gatt_client->mtu_state = SEND_MTU_EXCHANGE; 1985cf6c434SJakob Krantz } else { 1995cf1669fSMatthias Ringwald gatt_client->mtu_state = MTU_AUTO_EXCHANGE_DISABLED; 2005cf6c434SJakob Krantz } 2015cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_READY; 202cbd76cecSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 203cbd76cecSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_IDLE; 204cbd76cecSMatthias Ringwald #endif 2055cf1669fSMatthias Ringwald btstack_linked_list_add(&gatt_client_connections, (btstack_linked_item_t*)gatt_client); 2060e0bba86SMatthias Ringwald 2070e0bba86SMatthias Ringwald // get unenhanced att bearer state 2080e0bba86SMatthias Ringwald if (hci_connection->att_connection.mtu_exchanged){ 2090e0bba86SMatthias Ringwald gatt_client->mtu = hci_connection->att_connection.mtu; 2100e0bba86SMatthias Ringwald gatt_client->mtu_state = MTU_EXCHANGED; 2110e0bba86SMatthias Ringwald } 21240faeb84SMilanka Ringwald *out_gatt_client = gatt_client; 21340faeb84SMilanka Ringwald return ERROR_CODE_SUCCESS; 2143deb3ec6SMatthias Ringwald } 2153deb3ec6SMatthias Ringwald 216de27733dSMatthias Ringwald static bool is_ready(gatt_client_t * gatt_client){ 217de27733dSMatthias Ringwald return gatt_client->gatt_client_state == P_READY; 218de27733dSMatthias Ringwald } 219de27733dSMatthias Ringwald 220de27733dSMatthias Ringwald static uint8_t gatt_client_provide_context_for_request(hci_con_handle_t con_handle, gatt_client_t ** out_gatt_client){ 221de27733dSMatthias Ringwald gatt_client_t * gatt_client = NULL; 222de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 22340faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 22440faeb84SMilanka Ringwald return status; 22540faeb84SMilanka Ringwald } 226de27733dSMatthias Ringwald 2277627a0deSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 2287627a0deSMatthias Ringwald if (gatt_client->eatt_state == GATT_CLIENT_EATT_READY){ 2297627a0deSMatthias Ringwald btstack_linked_list_iterator_t it; 2307627a0deSMatthias Ringwald gatt_client_t * eatt_client = NULL; 2317627a0deSMatthias Ringwald // find free eatt client 2327627a0deSMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client->eatt_clients); 2337627a0deSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 2347627a0deSMatthias Ringwald gatt_client_t * client = (gatt_client_t *) btstack_linked_list_iterator_next(&it); 2357627a0deSMatthias Ringwald if (client->gatt_client_state == P_READY){ 2367627a0deSMatthias Ringwald eatt_client = client; 2377627a0deSMatthias Ringwald break; 2387627a0deSMatthias Ringwald } 2397627a0deSMatthias Ringwald } 2407627a0deSMatthias Ringwald if (eatt_client == NULL){ 2417627a0deSMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 2427627a0deSMatthias Ringwald } 2437627a0deSMatthias Ringwald gatt_client = eatt_client; 2447627a0deSMatthias Ringwald } 2457627a0deSMatthias Ringwald #endif 2467627a0deSMatthias Ringwald 247de27733dSMatthias Ringwald if (is_ready(gatt_client) == 0){ 248de27733dSMatthias Ringwald return GATT_CLIENT_IN_WRONG_STATE; 2493deb3ec6SMatthias Ringwald } 2503deb3ec6SMatthias Ringwald 251de27733dSMatthias Ringwald gatt_client_timeout_start(gatt_client); 252de27733dSMatthias Ringwald 253de27733dSMatthias Ringwald *out_gatt_client = gatt_client; 254de27733dSMatthias Ringwald 255de27733dSMatthias Ringwald return status; 2563deb3ec6SMatthias Ringwald } 2573deb3ec6SMatthias Ringwald 258fc64f94aSMatthias Ringwald int gatt_client_is_ready(hci_con_handle_t con_handle){ 25940faeb84SMilanka Ringwald gatt_client_t * gatt_client; 26040faeb84SMilanka Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 26140faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 26240faeb84SMilanka Ringwald return 0; 26340faeb84SMilanka Ringwald } 264aacf1b1aSMilanka Ringwald return is_ready(gatt_client) ? 1 : 0; 2653deb3ec6SMatthias Ringwald } 2663deb3ec6SMatthias Ringwald 2675cf6c434SJakob Krantz void gatt_client_mtu_enable_auto_negotiation(uint8_t enabled){ 26811279da7SMatthias Ringwald gatt_client_mtu_exchange_enabled = enabled != 0; 2695cf6c434SJakob Krantz } 2705cf6c434SJakob Krantz 271fc64f94aSMatthias Ringwald uint8_t gatt_client_get_mtu(hci_con_handle_t con_handle, uint16_t * mtu){ 27240faeb84SMilanka Ringwald gatt_client_t * gatt_client; 27340faeb84SMilanka Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 27440faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 27540faeb84SMilanka Ringwald return status; 27640faeb84SMilanka Ringwald } 2777d2258b3SMilanka Ringwald 2785cf1669fSMatthias Ringwald if ((gatt_client->mtu_state == MTU_EXCHANGED) || (gatt_client->mtu_state == MTU_AUTO_EXCHANGE_DISABLED)){ 2795cf1669fSMatthias Ringwald *mtu = gatt_client->mtu; 2807d2258b3SMilanka Ringwald return ERROR_CODE_SUCCESS; 2813deb3ec6SMatthias Ringwald } 2823deb3ec6SMatthias Ringwald *mtu = ATT_DEFAULT_MTU; 283616edd56SMatthias Ringwald return GATT_CLIENT_IN_WRONG_STATE; 2843deb3ec6SMatthias Ringwald } 2853deb3ec6SMatthias Ringwald 2867627a0deSMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC 2877627a0deSMatthias Ringwald // TODO: re-use single buffer for all eatt channels 2887627a0deSMatthias Ringwald static uint8_t gatt_client_le_enhanced_request_buffer[512]; 2897627a0deSMatthias Ringwald #endif 2907627a0deSMatthias Ringwald 2919228fd32SMatthias Ringwald static uint8_t *gatt_client_reserve_request_buffer(gatt_client_t *gatt_client) { 2927627a0deSMatthias Ringwald switch (gatt_client->bearer_type){ 2937627a0deSMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC 2947627a0deSMatthias Ringwald case ATT_BEARER_UNENHANCED_CLASSIC: 2957627a0deSMatthias Ringwald #endif 2967627a0deSMatthias Ringwald case ATT_BEARER_UNENHANCED_LE: 2979228fd32SMatthias Ringwald l2cap_reserve_packet_buffer(); 2989228fd32SMatthias Ringwald return l2cap_get_outgoing_buffer(); 2997627a0deSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 3007627a0deSMatthias Ringwald case ATT_BEARER_ENHANCED_LE: 3017627a0deSMatthias Ringwald return gatt_client->eatt_storage_buffer; 3027627a0deSMatthias Ringwald #endif 3037627a0deSMatthias Ringwald default: 3047627a0deSMatthias Ringwald btstack_unreachable(); 3057627a0deSMatthias Ringwald break; 3067627a0deSMatthias Ringwald } 3077627a0deSMatthias Ringwald return NULL; 3089228fd32SMatthias Ringwald } 3099228fd32SMatthias Ringwald 3103deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 3116e7b444cSMatthias Ringwald static uint8_t gatt_client_send(gatt_client_t * gatt_client, uint16_t len){ 31246012949SMatthias Ringwald switch (gatt_client->bearer_type){ 31346012949SMatthias Ringwald case ATT_BEARER_UNENHANCED_LE: 3146e7b444cSMatthias Ringwald return l2cap_send_prepared_connectionless(gatt_client->con_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL, len); 31546012949SMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC 31646012949SMatthias Ringwald case ATT_BEARER_UNENHANCED_CLASSIC: 31746012949SMatthias Ringwald return l2cap_send_prepared(gatt_client->l2cap_cid, len); 31846012949SMatthias Ringwald #endif 3197627a0deSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 3207627a0deSMatthias Ringwald case ATT_BEARER_ENHANCED_LE: 3217627a0deSMatthias Ringwald return l2cap_send(gatt_client->l2cap_cid, gatt_client->eatt_storage_buffer, len); 3227627a0deSMatthias Ringwald #endif 32346012949SMatthias Ringwald default: 32446012949SMatthias Ringwald btstack_unreachable(); 32546012949SMatthias Ringwald return ERROR_CODE_HARDWARE_FAILURE; 32646012949SMatthias Ringwald } 3273deb3ec6SMatthias Ringwald } 3283deb3ec6SMatthias Ringwald 3293deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 3306e7b444cSMatthias Ringwald static uint8_t att_confirmation(gatt_client_t * gatt_client) { 3319228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 3326e7b444cSMatthias Ringwald 3336e7b444cSMatthias Ringwald request[0] = ATT_HANDLE_VALUE_CONFIRMATION; 3346e7b444cSMatthias Ringwald 3356e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 1); 3366e7b444cSMatthias Ringwald } 3376e7b444cSMatthias Ringwald 3386e7b444cSMatthias Ringwald // precondition: can_send_packet_now == TRUE 3396e7b444cSMatthias Ringwald static uint8_t att_find_information_request(gatt_client_t *gatt_client, uint8_t request_type, uint16_t start_handle, 3406e7b444cSMatthias Ringwald uint16_t end_handle) { 3419228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 3426e7b444cSMatthias Ringwald 3433deb3ec6SMatthias Ringwald request[0] = request_type; 344f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, start_handle); 345f8fbdce0SMatthias Ringwald little_endian_store_16(request, 3, end_handle); 3463deb3ec6SMatthias Ringwald 3476e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 5); 3483deb3ec6SMatthias Ringwald } 3493deb3ec6SMatthias Ringwald 3503deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 3516e7b444cSMatthias Ringwald static uint8_t 3526e7b444cSMatthias Ringwald att_find_by_type_value_request(gatt_client_t *gatt_client, uint8_t request_type, uint16_t attribute_group_type, 3536e7b444cSMatthias Ringwald uint16_t start_handle, uint16_t end_handle, uint8_t *value, uint16_t value_size) { 3549228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 3553deb3ec6SMatthias Ringwald request[0] = request_type; 3569228fd32SMatthias Ringwald 357f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, start_handle); 358f8fbdce0SMatthias Ringwald little_endian_store_16(request, 3, end_handle); 359f8fbdce0SMatthias Ringwald little_endian_store_16(request, 5, attribute_group_type); 3606535961aSMatthias Ringwald (void)memcpy(&request[7], value, value_size); 3613deb3ec6SMatthias Ringwald 3626e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 7u + value_size); 3633deb3ec6SMatthias Ringwald } 3643deb3ec6SMatthias Ringwald 3653deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 3666e7b444cSMatthias Ringwald static uint8_t 3676e7b444cSMatthias Ringwald att_read_by_type_or_group_request_for_uuid16(gatt_client_t *gatt_client, uint8_t request_type, uint16_t uuid16, 3686e7b444cSMatthias Ringwald uint16_t start_handle, uint16_t end_handle) { 3699228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 3706e7b444cSMatthias Ringwald 3713deb3ec6SMatthias Ringwald request[0] = request_type; 372f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, start_handle); 373f8fbdce0SMatthias Ringwald little_endian_store_16(request, 3, end_handle); 374f8fbdce0SMatthias Ringwald little_endian_store_16(request, 5, uuid16); 3753deb3ec6SMatthias Ringwald 3766e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 7); 3773deb3ec6SMatthias Ringwald } 3783deb3ec6SMatthias Ringwald 3793deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 3806e7b444cSMatthias Ringwald static uint8_t 3816e7b444cSMatthias Ringwald att_read_by_type_or_group_request_for_uuid128(gatt_client_t *gatt_client, uint8_t request_type, const uint8_t *uuid128, 3826e7b444cSMatthias Ringwald uint16_t start_handle, uint16_t end_handle) { 3839228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 3846e7b444cSMatthias Ringwald 3853deb3ec6SMatthias Ringwald request[0] = request_type; 386f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, start_handle); 387f8fbdce0SMatthias Ringwald little_endian_store_16(request, 3, end_handle); 3889c80e4ccSMatthias Ringwald reverse_128(uuid128, &request[5]); 3893deb3ec6SMatthias Ringwald 3906e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 21); 3913deb3ec6SMatthias Ringwald } 3923deb3ec6SMatthias Ringwald 3933deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 3946e7b444cSMatthias Ringwald static uint8_t att_read_request(gatt_client_t *gatt_client, uint8_t request_type, uint16_t attribute_handle) { 3959228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 3966e7b444cSMatthias Ringwald 3973deb3ec6SMatthias Ringwald request[0] = request_type; 398f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, attribute_handle); 3993deb3ec6SMatthias Ringwald 4006e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 3); 4013deb3ec6SMatthias Ringwald } 4023deb3ec6SMatthias Ringwald 4033deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 4046e7b444cSMatthias Ringwald static uint8_t att_read_blob_request(gatt_client_t *gatt_client, uint8_t request_type, uint16_t attribute_handle, 4056e7b444cSMatthias Ringwald uint16_t value_offset) { 4069228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 4079228fd32SMatthias Ringwald 4083deb3ec6SMatthias Ringwald request[0] = request_type; 409f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, attribute_handle); 410f8fbdce0SMatthias Ringwald little_endian_store_16(request, 3, value_offset); 4113deb3ec6SMatthias Ringwald 4126e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 5); 4133deb3ec6SMatthias Ringwald } 4143deb3ec6SMatthias Ringwald 4156e7b444cSMatthias Ringwald static uint8_t 416f125a8efSMatthias Ringwald att_read_multiple_request_with_opcode(gatt_client_t *gatt_client, uint16_t num_value_handles, uint16_t *value_handles, uint8_t opcode) { 4179228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 4189228fd32SMatthias Ringwald 419f125a8efSMatthias Ringwald request[0] = opcode; 4209228fd32SMatthias Ringwald uint16_t i; 4219228fd32SMatthias Ringwald uint16_t offset = 1; 4223deb3ec6SMatthias Ringwald for (i=0;i<num_value_handles;i++){ 423f8fbdce0SMatthias Ringwald little_endian_store_16(request, offset, value_handles[i]); 4243deb3ec6SMatthias Ringwald offset += 2; 4253deb3ec6SMatthias Ringwald } 42625b7c058SMilanka Ringwald 4276e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, offset); 4283deb3ec6SMatthias Ringwald } 4293deb3ec6SMatthias Ringwald 430f125a8efSMatthias Ringwald static uint8_t 431f125a8efSMatthias Ringwald att_read_multiple_request(gatt_client_t *gatt_client, uint16_t num_value_handles, uint16_t *value_handles) { 432f125a8efSMatthias Ringwald return att_read_multiple_request_with_opcode(gatt_client, num_value_handles, value_handles, ATT_READ_MULTIPLE_REQUEST); 433f125a8efSMatthias Ringwald } 434f125a8efSMatthias Ringwald 435f125a8efSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 436f125a8efSMatthias Ringwald static uint8_t 437f125a8efSMatthias Ringwald att_read_multiple_variable_request(gatt_client_t *gatt_client, uint16_t num_value_handles, uint16_t *value_handles) { 438f125a8efSMatthias Ringwald return att_read_multiple_request_with_opcode(gatt_client, num_value_handles, value_handles, ATT_READ_MULTIPLE_VARIABLE_REQ); 439f125a8efSMatthias Ringwald } 440f125a8efSMatthias Ringwald #endif 441f125a8efSMatthias Ringwald 4427a766ebfSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 4433deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 4446e7b444cSMatthias Ringwald static uint8_t att_signed_write_request(gatt_client_t *gatt_client, uint16_t request_type, uint16_t attribute_handle, 4456e7b444cSMatthias Ringwald uint16_t value_length, uint8_t *value, uint32_t sign_counter, uint8_t sgn[8]) { 4469228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 4479228fd32SMatthias Ringwald 4483deb3ec6SMatthias Ringwald request[0] = request_type; 449f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, attribute_handle); 4506535961aSMatthias Ringwald (void)memcpy(&request[3], value, value_length); 451f8fbdce0SMatthias Ringwald little_endian_store_32(request, 3 + value_length, sign_counter); 4529c80e4ccSMatthias Ringwald reverse_64(sgn, &request[3 + value_length + 4]); 45325b7c058SMilanka Ringwald 4546e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 3 + value_length + 12); 4553deb3ec6SMatthias Ringwald } 4567a766ebfSMatthias Ringwald #endif 4573deb3ec6SMatthias Ringwald 4583deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 4596e7b444cSMatthias Ringwald static uint8_t 4606e7b444cSMatthias Ringwald att_write_request(gatt_client_t *gatt_client, uint8_t request_type, uint16_t attribute_handle, uint16_t value_length, 4616e7b444cSMatthias Ringwald uint8_t *value) { 4629228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 4639228fd32SMatthias Ringwald 4643deb3ec6SMatthias Ringwald request[0] = request_type; 465f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, attribute_handle); 4666535961aSMatthias Ringwald (void)memcpy(&request[3], value, value_length); 4673deb3ec6SMatthias Ringwald 4686e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 3u + value_length); 4693deb3ec6SMatthias Ringwald } 4703deb3ec6SMatthias Ringwald 4713deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 4726e7b444cSMatthias Ringwald static uint8_t att_execute_write_request(gatt_client_t *gatt_client, uint8_t request_type, uint8_t execute_write) { 4739228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 4749228fd32SMatthias Ringwald 4753deb3ec6SMatthias Ringwald request[0] = request_type; 4763deb3ec6SMatthias Ringwald request[1] = execute_write; 47725b7c058SMilanka Ringwald 4786e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 2); 4793deb3ec6SMatthias Ringwald } 4803deb3ec6SMatthias Ringwald 4813deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 4826e7b444cSMatthias Ringwald static uint8_t att_prepare_write_request(gatt_client_t *gatt_client, uint8_t request_type, uint16_t attribute_handle, 4836e7b444cSMatthias Ringwald uint16_t value_offset, uint16_t blob_length, uint8_t *value) { 4849228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 4859228fd32SMatthias Ringwald 4863deb3ec6SMatthias Ringwald request[0] = request_type; 487f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, attribute_handle); 488f8fbdce0SMatthias Ringwald little_endian_store_16(request, 3, value_offset); 4896535961aSMatthias Ringwald (void)memcpy(&request[5], &value[value_offset], blob_length); 4903deb3ec6SMatthias Ringwald 4916e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 5u + blob_length); 4923deb3ec6SMatthias Ringwald } 4933deb3ec6SMatthias Ringwald 4946e7b444cSMatthias Ringwald static uint8_t att_exchange_mtu_request(gatt_client_t *gatt_client) { 4959228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 4969228fd32SMatthias Ringwald 4973deb3ec6SMatthias Ringwald request[0] = ATT_EXCHANGE_MTU_REQUEST; 4989228fd32SMatthias Ringwald uint16_t mtu = l2cap_max_le_mtu(); 499f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, mtu); 50025b7c058SMilanka Ringwald 5016e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 3); 5023deb3ec6SMatthias Ringwald } 5033deb3ec6SMatthias Ringwald 5045cf1669fSMatthias Ringwald static uint16_t write_blob_length(gatt_client_t * gatt_client){ 505dda77937SMatthias Ringwald uint16_t max_blob_length = gatt_client->mtu - 5u; 5065cf1669fSMatthias Ringwald if (gatt_client->attribute_offset >= gatt_client->attribute_length) { 5073deb3ec6SMatthias Ringwald return 0; 5083deb3ec6SMatthias Ringwald } 5095cf1669fSMatthias Ringwald uint16_t rest_length = gatt_client->attribute_length - gatt_client->attribute_offset; 5103deb3ec6SMatthias Ringwald if (max_blob_length > rest_length){ 5113deb3ec6SMatthias Ringwald return rest_length; 5123deb3ec6SMatthias Ringwald } 5133deb3ec6SMatthias Ringwald return max_blob_length; 5143deb3ec6SMatthias Ringwald } 5153deb3ec6SMatthias Ringwald 5165cf1669fSMatthias Ringwald static void send_gatt_services_request(gatt_client_t *gatt_client){ 5176e7b444cSMatthias Ringwald att_read_by_type_or_group_request_for_uuid16(gatt_client, ATT_READ_BY_GROUP_TYPE_REQUEST, 5186e7b444cSMatthias Ringwald gatt_client->uuid16, gatt_client->start_group_handle, 5196e7b444cSMatthias Ringwald gatt_client->end_group_handle); 5203deb3ec6SMatthias Ringwald } 5213deb3ec6SMatthias Ringwald 5225cf1669fSMatthias Ringwald static void send_gatt_by_uuid_request(gatt_client_t *gatt_client, uint16_t attribute_group_type){ 5235cf1669fSMatthias Ringwald if (gatt_client->uuid16){ 5243deb3ec6SMatthias Ringwald uint8_t uuid16[2]; 5255cf1669fSMatthias Ringwald little_endian_store_16(uuid16, 0, gatt_client->uuid16); 5266e7b444cSMatthias Ringwald att_find_by_type_value_request(gatt_client, ATT_FIND_BY_TYPE_VALUE_REQUEST, attribute_group_type, 5276e7b444cSMatthias Ringwald gatt_client->start_group_handle, gatt_client->end_group_handle, uuid16, 2); 5283deb3ec6SMatthias Ringwald return; 5293deb3ec6SMatthias Ringwald } 5303deb3ec6SMatthias Ringwald uint8_t uuid128[16]; 5315cf1669fSMatthias Ringwald reverse_128(gatt_client->uuid128, uuid128); 5326e7b444cSMatthias Ringwald att_find_by_type_value_request(gatt_client, ATT_FIND_BY_TYPE_VALUE_REQUEST, attribute_group_type, 5336e7b444cSMatthias Ringwald gatt_client->start_group_handle, gatt_client->end_group_handle, uuid128, 16); 5343deb3ec6SMatthias Ringwald } 5353deb3ec6SMatthias Ringwald 5365cf1669fSMatthias Ringwald static void send_gatt_services_by_uuid_request(gatt_client_t *gatt_client){ 5375cf1669fSMatthias Ringwald send_gatt_by_uuid_request(gatt_client, GATT_PRIMARY_SERVICE_UUID); 5383deb3ec6SMatthias Ringwald } 5393deb3ec6SMatthias Ringwald 5405cf1669fSMatthias Ringwald static void send_gatt_included_service_uuid_request(gatt_client_t *gatt_client){ 5416e7b444cSMatthias Ringwald att_read_request(gatt_client, ATT_READ_REQUEST, gatt_client->query_start_handle); 5423deb3ec6SMatthias Ringwald } 5433deb3ec6SMatthias Ringwald 5445cf1669fSMatthias Ringwald static void send_gatt_included_service_request(gatt_client_t *gatt_client){ 5456e7b444cSMatthias Ringwald att_read_by_type_or_group_request_for_uuid16(gatt_client, ATT_READ_BY_TYPE_REQUEST, 5466e7b444cSMatthias Ringwald GATT_INCLUDE_SERVICE_UUID, gatt_client->start_group_handle, 5476e7b444cSMatthias Ringwald gatt_client->end_group_handle); 5483deb3ec6SMatthias Ringwald } 5493deb3ec6SMatthias Ringwald 5505cf1669fSMatthias Ringwald static void send_gatt_characteristic_request(gatt_client_t *gatt_client){ 5516e7b444cSMatthias Ringwald att_read_by_type_or_group_request_for_uuid16(gatt_client, ATT_READ_BY_TYPE_REQUEST, 5526e7b444cSMatthias Ringwald GATT_CHARACTERISTICS_UUID, gatt_client->start_group_handle, 5536e7b444cSMatthias Ringwald gatt_client->end_group_handle); 5543deb3ec6SMatthias Ringwald } 5553deb3ec6SMatthias Ringwald 5565cf1669fSMatthias Ringwald static void send_gatt_characteristic_descriptor_request(gatt_client_t *gatt_client){ 5576e7b444cSMatthias Ringwald att_find_information_request(gatt_client, ATT_FIND_INFORMATION_REQUEST, gatt_client->start_group_handle, 5586e7b444cSMatthias Ringwald gatt_client->end_group_handle); 5593deb3ec6SMatthias Ringwald } 5603deb3ec6SMatthias Ringwald 5615cf1669fSMatthias Ringwald static void send_gatt_read_characteristic_value_request(gatt_client_t *gatt_client){ 5626e7b444cSMatthias Ringwald att_read_request(gatt_client, ATT_READ_REQUEST, gatt_client->attribute_handle); 5633deb3ec6SMatthias Ringwald } 5643deb3ec6SMatthias Ringwald 5655cf1669fSMatthias Ringwald static void send_gatt_read_by_type_request(gatt_client_t * gatt_client){ 5665cf1669fSMatthias Ringwald if (gatt_client->uuid16){ 5676e7b444cSMatthias Ringwald att_read_by_type_or_group_request_for_uuid16(gatt_client, ATT_READ_BY_TYPE_REQUEST, 5686e7b444cSMatthias Ringwald gatt_client->uuid16, gatt_client->start_group_handle, 5696e7b444cSMatthias Ringwald gatt_client->end_group_handle); 5703deb3ec6SMatthias Ringwald } else { 5716e7b444cSMatthias Ringwald att_read_by_type_or_group_request_for_uuid128(gatt_client, ATT_READ_BY_TYPE_REQUEST, 5726e7b444cSMatthias Ringwald gatt_client->uuid128, gatt_client->start_group_handle, 5736e7b444cSMatthias Ringwald gatt_client->end_group_handle); 5743deb3ec6SMatthias Ringwald } 5753deb3ec6SMatthias Ringwald } 5763deb3ec6SMatthias Ringwald 5775cf1669fSMatthias Ringwald static void send_gatt_read_blob_request(gatt_client_t *gatt_client){ 57830952227SMilanka Ringwald if (gatt_client->attribute_offset == 0){ 5796e7b444cSMatthias Ringwald att_read_request(gatt_client, ATT_READ_REQUEST, gatt_client->attribute_handle); 58030952227SMilanka Ringwald } else { 5816e7b444cSMatthias Ringwald att_read_blob_request(gatt_client, ATT_READ_BLOB_REQUEST, gatt_client->attribute_handle, 5826e7b444cSMatthias Ringwald gatt_client->attribute_offset); 5833deb3ec6SMatthias Ringwald } 58430952227SMilanka Ringwald } 5853deb3ec6SMatthias Ringwald 5865cf1669fSMatthias Ringwald static void send_gatt_read_multiple_request(gatt_client_t * gatt_client){ 5876e7b444cSMatthias Ringwald att_read_multiple_request(gatt_client, gatt_client->read_multiple_handle_count, gatt_client->read_multiple_handles); 5883deb3ec6SMatthias Ringwald } 5893deb3ec6SMatthias Ringwald 590f125a8efSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 591f125a8efSMatthias Ringwald static void send_gatt_read_multiple_variable_request(gatt_client_t * gatt_client){ 592f125a8efSMatthias Ringwald att_read_multiple_variable_request(gatt_client, gatt_client->read_multiple_handle_count, gatt_client->read_multiple_handles); 593f125a8efSMatthias Ringwald } 594f125a8efSMatthias Ringwald #endif 595f125a8efSMatthias Ringwald 5965cf1669fSMatthias Ringwald static void send_gatt_write_attribute_value_request(gatt_client_t * gatt_client){ 5976e7b444cSMatthias Ringwald att_write_request(gatt_client, ATT_WRITE_REQUEST, gatt_client->attribute_handle, gatt_client->attribute_length, 5986e7b444cSMatthias Ringwald gatt_client->attribute_value); 5993deb3ec6SMatthias Ringwald } 6003deb3ec6SMatthias Ringwald 6015cf1669fSMatthias Ringwald static void send_gatt_write_client_characteristic_configuration_request(gatt_client_t * gatt_client){ 6026e7b444cSMatthias Ringwald att_write_request(gatt_client, ATT_WRITE_REQUEST, gatt_client->client_characteristic_configuration_handle, 2, 6036e7b444cSMatthias Ringwald gatt_client->client_characteristic_configuration_value); 6043deb3ec6SMatthias Ringwald } 6053deb3ec6SMatthias Ringwald 6065cf1669fSMatthias Ringwald static void send_gatt_prepare_write_request(gatt_client_t * gatt_client){ 6076e7b444cSMatthias Ringwald att_prepare_write_request(gatt_client, ATT_PREPARE_WRITE_REQUEST, gatt_client->attribute_handle, 6086e7b444cSMatthias Ringwald gatt_client->attribute_offset, write_blob_length(gatt_client), 6096e7b444cSMatthias Ringwald gatt_client->attribute_value); 6103deb3ec6SMatthias Ringwald } 6113deb3ec6SMatthias Ringwald 6125cf1669fSMatthias Ringwald static void send_gatt_execute_write_request(gatt_client_t * gatt_client){ 6136e7b444cSMatthias Ringwald att_execute_write_request(gatt_client, ATT_EXECUTE_WRITE_REQUEST, 1); 6143deb3ec6SMatthias Ringwald } 6153deb3ec6SMatthias Ringwald 6165cf1669fSMatthias Ringwald static void send_gatt_cancel_prepared_write_request(gatt_client_t * gatt_client){ 6176e7b444cSMatthias Ringwald att_execute_write_request(gatt_client, ATT_EXECUTE_WRITE_REQUEST, 0); 6183deb3ec6SMatthias Ringwald } 6193deb3ec6SMatthias Ringwald 620abdc9fb5SMatthias Ringwald #ifndef ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY 6215cf1669fSMatthias Ringwald static void send_gatt_read_client_characteristic_configuration_request(gatt_client_t * gatt_client){ 6226e7b444cSMatthias Ringwald att_read_by_type_or_group_request_for_uuid16(gatt_client, ATT_READ_BY_TYPE_REQUEST, 6236e7b444cSMatthias Ringwald GATT_CLIENT_CHARACTERISTICS_CONFIGURATION, 6246e7b444cSMatthias Ringwald gatt_client->start_group_handle, gatt_client->end_group_handle); 6253deb3ec6SMatthias Ringwald } 626abdc9fb5SMatthias Ringwald #endif 6273deb3ec6SMatthias Ringwald 6285cf1669fSMatthias Ringwald static void send_gatt_read_characteristic_descriptor_request(gatt_client_t * gatt_client){ 6296e7b444cSMatthias Ringwald att_read_request(gatt_client, ATT_READ_REQUEST, gatt_client->attribute_handle); 6303deb3ec6SMatthias Ringwald } 6313deb3ec6SMatthias Ringwald 6327a766ebfSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 6335cf1669fSMatthias Ringwald static void send_gatt_signed_write_request(gatt_client_t * gatt_client, uint32_t sign_counter){ 6346e7b444cSMatthias Ringwald att_signed_write_request(gatt_client, ATT_SIGNED_WRITE_COMMAND, gatt_client->attribute_handle, 6356e7b444cSMatthias Ringwald gatt_client->attribute_length, gatt_client->attribute_value, sign_counter, 6366e7b444cSMatthias Ringwald gatt_client->cmac); 6373deb3ec6SMatthias Ringwald } 6387a766ebfSMatthias Ringwald #endif 6393deb3ec6SMatthias Ringwald 6403deb3ec6SMatthias Ringwald static uint16_t get_last_result_handle_from_service_list(uint8_t * packet, uint16_t size){ 64139ac9711SMatthias Ringwald if (size < 2) return 0xffff; 6423deb3ec6SMatthias Ringwald uint8_t attr_length = packet[1]; 64339ac9711SMatthias Ringwald if ((2 + attr_length) > size) return 0xffff; 6444ea43905SMatthias Ringwald return little_endian_read_16(packet, size - attr_length + 2u); 6453deb3ec6SMatthias Ringwald } 6463deb3ec6SMatthias Ringwald 6473deb3ec6SMatthias Ringwald static uint16_t get_last_result_handle_from_characteristics_list(uint8_t * packet, uint16_t size){ 64839ac9711SMatthias Ringwald if (size < 2) return 0xffff; 6493deb3ec6SMatthias Ringwald uint8_t attr_length = packet[1]; 65039ac9711SMatthias Ringwald if ((2 + attr_length) > size) return 0xffff; 6514ea43905SMatthias Ringwald return little_endian_read_16(packet, size - attr_length + 3u); 6523deb3ec6SMatthias Ringwald } 6533deb3ec6SMatthias Ringwald 6543deb3ec6SMatthias Ringwald static uint16_t get_last_result_handle_from_included_services_list(uint8_t * packet, uint16_t size){ 65539ac9711SMatthias Ringwald if (size < 2) return 0xffff; 6563deb3ec6SMatthias Ringwald uint8_t attr_length = packet[1]; 65739ac9711SMatthias Ringwald if ((2 + attr_length) > size) return 0xffff; 658f8fbdce0SMatthias Ringwald return little_endian_read_16(packet, size - attr_length); 6593deb3ec6SMatthias Ringwald } 6603deb3ec6SMatthias Ringwald 66153e9c18fSMatthias Ringwald static void gatt_client_notify_can_send_query(gatt_client_t * gatt_client){ 66219c614acSMatthias Ringwald 66319c614acSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 66419c614acSMatthias Ringwald // if eatt is ready, notify all clients that can send a query 66519c614acSMatthias Ringwald if (gatt_client->eatt_state == GATT_CLIENT_EATT_READY){ 66619c614acSMatthias Ringwald btstack_linked_list_iterator_t it; 66719c614acSMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client->eatt_clients); 66819c614acSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 66919c614acSMatthias Ringwald gatt_client_t * client = (gatt_client_t *) btstack_linked_list_iterator_next(&it); 67019c614acSMatthias Ringwald if (client->gatt_client_state == P_READY){ 67119c614acSMatthias Ringwald // call callback 67219c614acSMatthias Ringwald btstack_context_callback_registration_t * callback = (btstack_context_callback_registration_t *) btstack_linked_list_pop(&gatt_client->query_requests); 67319c614acSMatthias Ringwald if (callback == NULL) { 67419c614acSMatthias Ringwald return; 67519c614acSMatthias Ringwald } 67619c614acSMatthias Ringwald (*callback->callback)(callback->context); 67719c614acSMatthias Ringwald } 67819c614acSMatthias Ringwald } 67919c614acSMatthias Ringwald return; 68019c614acSMatthias Ringwald } 68119c614acSMatthias Ringwald #endif 68219c614acSMatthias Ringwald 68353e9c18fSMatthias Ringwald while (gatt_client->gatt_client_state == P_READY){ 68426166ecfSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 6857627a0deSMatthias Ringwald bool query_sent = gatt_client_le_enhanced_handle_can_send_query(gatt_client); 68626166ecfSMatthias Ringwald if (query_sent){ 68726166ecfSMatthias Ringwald continue; 68826166ecfSMatthias Ringwald } 68926166ecfSMatthias Ringwald #endif 69053e9c18fSMatthias Ringwald btstack_context_callback_registration_t * callback = (btstack_context_callback_registration_t *) btstack_linked_list_pop(&gatt_client->query_requests); 69109834412SMatthias Ringwald if (callback == NULL) { 69209834412SMatthias Ringwald return; 69353e9c18fSMatthias Ringwald } 69409834412SMatthias Ringwald (*callback->callback)(callback->context); 69553e9c18fSMatthias Ringwald } 69653e9c18fSMatthias Ringwald } 69753e9c18fSMatthias Ringwald 69823d583b8SMatthias Ringwald // test if notification/indication should be delivered to application (BLESA) 69923d583b8SMatthias Ringwald static bool gatt_client_accept_server_message(gatt_client_t *gatt_client) { 70023d583b8SMatthias Ringwald // ignore messages until re-encryption is complete 70123d583b8SMatthias Ringwald if (gap_reconnect_security_setup_active(gatt_client->con_handle)) return false; 70223d583b8SMatthias Ringwald 70323d583b8SMatthias Ringwald // after that ignore if bonded but not encrypted 70423d583b8SMatthias Ringwald return !gap_bonded(gatt_client->con_handle) || (gap_encryption_key_size(gatt_client->con_handle) > 0); 70523d583b8SMatthias Ringwald } 70623d583b8SMatthias Ringwald 7079c662c9bSMatthias Ringwald static void emit_event_new(btstack_packet_handler_t callback, uint8_t * packet, uint16_t size){ 7089c662c9bSMatthias Ringwald if (!callback) return; 70992da54c4SMatthias Ringwald hci_dump_packet(HCI_EVENT_PACKET, 1, packet, size); 7109c662c9bSMatthias Ringwald (*callback)(HCI_EVENT_PACKET, 0, packet, size); 7113deb3ec6SMatthias Ringwald } 7123deb3ec6SMatthias Ringwald 713711e6c80SMatthias Ringwald static void emit_event_to_registered_listeners(hci_con_handle_t con_handle, uint16_t attribute_handle, uint8_t * packet, uint16_t size){ 714665d90f2SMatthias Ringwald btstack_linked_list_iterator_t it; 7159c662c9bSMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client_value_listeners); 716665d90f2SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 71786c38559SMatthias Ringwald gatt_client_notification_t * notification = (gatt_client_notification_t*) btstack_linked_list_iterator_next(&it); 718b3f03c84SMatthias Ringwald if ((notification->con_handle != GATT_CLIENT_ANY_CONNECTION) && (notification->con_handle != con_handle)) continue; 719b3f03c84SMatthias Ringwald if ((notification->attribute_handle != GATT_CLIENT_ANY_VALUE_HANDLE) && (notification->attribute_handle != attribute_handle)) continue; 72086c38559SMatthias Ringwald (*notification->callback)(HCI_EVENT_PACKET, 0, packet, size); 7213deb3ec6SMatthias Ringwald } 7223deb3ec6SMatthias Ringwald } 7233deb3ec6SMatthias Ringwald 7245cf1669fSMatthias Ringwald static void emit_gatt_complete_event(gatt_client_t * gatt_client, uint8_t att_status){ 7253deb3ec6SMatthias Ringwald // @format H1 7263deb3ec6SMatthias Ringwald uint8_t packet[5]; 7275611a760SMatthias Ringwald packet[0] = GATT_EVENT_QUERY_COMPLETE; 7283deb3ec6SMatthias Ringwald packet[1] = 3; 7295cf1669fSMatthias Ringwald little_endian_store_16(packet, 2, gatt_client->con_handle); 7307d2258b3SMilanka Ringwald packet[4] = att_status; 7315cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, sizeof(packet)); 7323deb3ec6SMatthias Ringwald } 7333deb3ec6SMatthias Ringwald 734045d700dSDavid 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){ 7353deb3ec6SMatthias Ringwald // @format HX 7363deb3ec6SMatthias Ringwald uint8_t packet[24]; 7375611a760SMatthias Ringwald packet[0] = GATT_EVENT_SERVICE_QUERY_RESULT; 7384ea43905SMatthias Ringwald packet[1] = sizeof(packet) - 2u; 7395cf1669fSMatthias Ringwald little_endian_store_16(packet, 2, gatt_client->con_handle); 7403deb3ec6SMatthias Ringwald /// 741f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 4, start_group_handle); 742f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 6, end_group_handle); 7439c80e4ccSMatthias Ringwald reverse_128(uuid128, &packet[8]); 7445cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, sizeof(packet)); 7453deb3ec6SMatthias Ringwald } 7463deb3ec6SMatthias Ringwald 747045d700dSDavid 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){ 7483deb3ec6SMatthias Ringwald // @format HX 7493deb3ec6SMatthias Ringwald uint8_t packet[26]; 7505611a760SMatthias Ringwald packet[0] = GATT_EVENT_INCLUDED_SERVICE_QUERY_RESULT; 7514ea43905SMatthias Ringwald packet[1] = sizeof(packet) - 2u; 7525cf1669fSMatthias Ringwald little_endian_store_16(packet, 2, gatt_client->con_handle); 7533deb3ec6SMatthias Ringwald /// 754f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 4, include_handle); 7553deb3ec6SMatthias Ringwald // 756f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 6, start_group_handle); 757f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 8, end_group_handle); 7589c80e4ccSMatthias Ringwald reverse_128(uuid128, &packet[10]); 7595cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, sizeof(packet)); 7603deb3ec6SMatthias Ringwald } 7613deb3ec6SMatthias Ringwald 7625cf1669fSMatthias 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, 763045d700dSDavid Lechner uint16_t properties, const uint8_t * uuid128){ 7643deb3ec6SMatthias Ringwald // @format HY 7653deb3ec6SMatthias Ringwald uint8_t packet[28]; 7665611a760SMatthias Ringwald packet[0] = GATT_EVENT_CHARACTERISTIC_QUERY_RESULT; 7674ea43905SMatthias Ringwald packet[1] = sizeof(packet) - 2u; 7685cf1669fSMatthias Ringwald little_endian_store_16(packet, 2, gatt_client->con_handle); 7693deb3ec6SMatthias Ringwald /// 770f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 4, start_handle); 771f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 6, value_handle); 772f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 8, end_handle); 773f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 10, properties); 7749c80e4ccSMatthias Ringwald reverse_128(uuid128, &packet[12]); 7755cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, sizeof(packet)); 7763deb3ec6SMatthias Ringwald } 7773deb3ec6SMatthias Ringwald 7783deb3ec6SMatthias Ringwald static void emit_gatt_all_characteristic_descriptors_result_event( 779045d700dSDavid Lechner gatt_client_t * gatt_client, uint16_t descriptor_handle, const uint8_t * uuid128){ 7803deb3ec6SMatthias Ringwald // @format HZ 7813deb3ec6SMatthias Ringwald uint8_t packet[22]; 7825611a760SMatthias Ringwald packet[0] = GATT_EVENT_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY_RESULT; 7834ea43905SMatthias Ringwald packet[1] = sizeof(packet) - 2u; 7845cf1669fSMatthias Ringwald little_endian_store_16(packet, 2, gatt_client->con_handle); 7853deb3ec6SMatthias Ringwald /// 786f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 4, descriptor_handle); 7879c80e4ccSMatthias Ringwald reverse_128(uuid128, &packet[6]); 7885cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, sizeof(packet)); 7893deb3ec6SMatthias Ringwald } 7903deb3ec6SMatthias Ringwald 7915cf1669fSMatthias Ringwald static void emit_gatt_mtu_exchanged_result_event(gatt_client_t * gatt_client, uint16_t new_mtu){ 7928f37572aSJakob Krantz // @format H2 7938f37572aSJakob Krantz uint8_t packet[6]; 7948f37572aSJakob Krantz packet[0] = GATT_EVENT_MTU; 7954ea43905SMatthias Ringwald packet[1] = sizeof(packet) - 2u; 7965cf1669fSMatthias Ringwald little_endian_store_16(packet, 2, gatt_client->con_handle); 7978f37572aSJakob Krantz little_endian_store_16(packet, 4, new_mtu); 7985cf1669fSMatthias Ringwald att_dispatch_client_mtu_exchanged(gatt_client->con_handle, new_mtu); 7995cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, sizeof(packet)); 8008f37572aSJakob Krantz } 80123d583b8SMatthias Ringwald 80223d583b8SMatthias Ringwald // helper 80323d583b8SMatthias Ringwald static void gatt_client_handle_transaction_complete(gatt_client_t *gatt_client, uint8_t att_status) { 80423d583b8SMatthias Ringwald gatt_client->gatt_client_state = P_READY; 80523d583b8SMatthias Ringwald gatt_client_timeout_stop(gatt_client); 80623d583b8SMatthias Ringwald emit_gatt_complete_event(gatt_client, att_status); 80723d583b8SMatthias Ringwald gatt_client_notify_can_send_query(gatt_client); 80823d583b8SMatthias Ringwald } 80923d583b8SMatthias Ringwald 81023d583b8SMatthias Ringwald // @return packet pointer 81123d583b8SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite HCI + L2CAP packet headers 81223d583b8SMatthias Ringwald #define CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE 8 81323d583b8SMatthias 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){ 81423d583b8SMatthias Ringwald #ifdef FUZZING_BUILD_MODE_UNSAFE_FOR_PRODUCTION 81523d583b8SMatthias Ringwald // copy value into test packet for testing 81623d583b8SMatthias Ringwald static uint8_t packet[1000]; 81723d583b8SMatthias Ringwald memcpy(&packet[8], value, length); 81823d583b8SMatthias Ringwald #else 81923d583b8SMatthias Ringwald // before the value inside the ATT PDU 82023d583b8SMatthias Ringwald uint8_t * packet = value - CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE; 82123d583b8SMatthias Ringwald #endif 82223d583b8SMatthias Ringwald packet[0] = type; 82323d583b8SMatthias Ringwald packet[1] = CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE - 2 + length; 82423d583b8SMatthias Ringwald little_endian_store_16(packet, 2, con_handle); 82523d583b8SMatthias Ringwald little_endian_store_16(packet, 4, attribute_handle); 82623d583b8SMatthias Ringwald little_endian_store_16(packet, 6, length); 82723d583b8SMatthias Ringwald return packet; 82823d583b8SMatthias Ringwald } 82923d583b8SMatthias Ringwald 83023d583b8SMatthias Ringwald // @return packet pointer 83123d583b8SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite parts of the HCI/L2CAP/ATT packet (4/4/3) bytes 83223d583b8SMatthias Ringwald #define LONG_CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE 10 83323d583b8SMatthias 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){ 83423d583b8SMatthias Ringwald #ifdef FUZZING_BUILD_MODE_UNSAFE_FOR_PRODUCTION 83523d583b8SMatthias Ringwald // avoid using pre ATT headers. 83623d583b8SMatthias Ringwald return NULL; 83723d583b8SMatthias Ringwald #endif 83823d583b8SMatthias 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) 83923d583b8SMatthias Ringwald // before the value inside the ATT PDU 84023d583b8SMatthias Ringwald uint8_t * packet = value - LONG_CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE; 84123d583b8SMatthias Ringwald packet[0] = type; 84223d583b8SMatthias Ringwald packet[1] = LONG_CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE - 2 + length; 84323d583b8SMatthias Ringwald little_endian_store_16(packet, 2, con_handle); 84423d583b8SMatthias Ringwald little_endian_store_16(packet, 4, attribute_handle); 84523d583b8SMatthias Ringwald little_endian_store_16(packet, 6, offset); 84623d583b8SMatthias Ringwald little_endian_store_16(packet, 8, length); 84723d583b8SMatthias Ringwald return packet; 84823d583b8SMatthias Ringwald #else 84923d583b8SMatthias Ringwald log_error("HCI_INCOMING_PRE_BUFFER_SIZE >= 2 required for long characteristic reads"); 85023d583b8SMatthias Ringwald return NULL; 85123d583b8SMatthias Ringwald #endif 85223d583b8SMatthias Ringwald } 85323d583b8SMatthias Ringwald 854f7a42e72SMatthias Ringwald #if (LONG_CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE > CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE) 855f7a42e72SMatthias Ringwald #define REPORT_PREBUFFER_HEADER LONG_CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE 856f7a42e72SMatthias Ringwald #else 857f7a42e72SMatthias Ringwald #define REPORT_PREBUFFER_HEADER CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE 858f7a42e72SMatthias Ringwald #endif 859f7a42e72SMatthias Ringwald 8608f37572aSJakob Krantz /// 8615cf1669fSMatthias Ringwald static void report_gatt_services(gatt_client_t * gatt_client, uint8_t * packet, uint16_t size){ 86239ac9711SMatthias Ringwald if (size < 2) return; 8633deb3ec6SMatthias Ringwald uint8_t attr_length = packet[1]; 8644ea43905SMatthias Ringwald uint8_t uuid_length = attr_length - 4u; 8653deb3ec6SMatthias Ringwald 8663deb3ec6SMatthias Ringwald int i; 86739ac9711SMatthias Ringwald for (i = 2; (i+attr_length) <= size; i += attr_length){ 868f8fbdce0SMatthias Ringwald uint16_t start_group_handle = little_endian_read_16(packet,i); 869f8fbdce0SMatthias Ringwald uint16_t end_group_handle = little_endian_read_16(packet,i+2); 8703deb3ec6SMatthias Ringwald uint8_t uuid128[16]; 8713deb3ec6SMatthias Ringwald uint16_t uuid16 = 0; 8723deb3ec6SMatthias Ringwald 8734ea43905SMatthias Ringwald if (uuid_length == 2u){ 874f8fbdce0SMatthias Ringwald uuid16 = little_endian_read_16(packet, i+4); 875e1a125dfSMatthias Ringwald uuid_add_bluetooth_prefix((uint8_t*) &uuid128, uuid16); 87639ac9711SMatthias Ringwald } else if (uuid_length == 16u) { 8779c80e4ccSMatthias Ringwald reverse_128(&packet[i+4], uuid128); 87839ac9711SMatthias Ringwald } else { 87939ac9711SMatthias Ringwald return; 8803deb3ec6SMatthias Ringwald } 8815cf1669fSMatthias Ringwald emit_gatt_service_query_result_event(gatt_client, start_group_handle, end_group_handle, uuid128); 8823deb3ec6SMatthias Ringwald } 8833deb3ec6SMatthias Ringwald } 8843deb3ec6SMatthias Ringwald 88523d583b8SMatthias 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){ 8863deb3ec6SMatthias Ringwald uint8_t uuid128[16]; 8873deb3ec6SMatthias Ringwald uint16_t uuid16 = 0; 8884ea43905SMatthias Ringwald if (uuid_length == 2u){ 889f8fbdce0SMatthias Ringwald uuid16 = little_endian_read_16(uuid, 0); 890e1a125dfSMatthias Ringwald uuid_add_bluetooth_prefix((uint8_t*) uuid128, uuid16); 8914ea43905SMatthias Ringwald } else if (uuid_length == 16u){ 8929c80e4ccSMatthias Ringwald reverse_128(uuid, uuid128); 893d73c9dbeSMilanka Ringwald } else { 894d73c9dbeSMilanka Ringwald return; 8953deb3ec6SMatthias Ringwald } 8963deb3ec6SMatthias Ringwald 8975cf1669fSMatthias Ringwald if (gatt_client->filter_with_uuid && (memcmp(gatt_client->uuid128, uuid128, 16) != 0)) return; 8983deb3ec6SMatthias Ringwald 8995cf1669fSMatthias Ringwald gatt_client->characteristic_properties = properties; 9005cf1669fSMatthias Ringwald gatt_client->characteristic_start_handle = start_handle; 9015cf1669fSMatthias Ringwald gatt_client->attribute_handle = value_handle; 9023deb3ec6SMatthias Ringwald 9035cf1669fSMatthias Ringwald if (gatt_client->filter_with_uuid) return; 9043deb3ec6SMatthias Ringwald 9055cf1669fSMatthias Ringwald gatt_client->uuid16 = uuid16; 9065cf1669fSMatthias Ringwald (void)memcpy(gatt_client->uuid128, uuid128, 16); 9073deb3ec6SMatthias Ringwald } 9083deb3ec6SMatthias Ringwald 90923d583b8SMatthias Ringwald static void report_gatt_characteristic_end_found(gatt_client_t * gatt_client, uint16_t end_handle){ 9103deb3ec6SMatthias Ringwald // TODO: stop searching if filter and uuid found 9113deb3ec6SMatthias Ringwald 9125cf1669fSMatthias Ringwald if (!gatt_client->characteristic_start_handle) return; 9133deb3ec6SMatthias Ringwald 9145cf1669fSMatthias Ringwald emit_gatt_characteristic_query_result_event(gatt_client, gatt_client->characteristic_start_handle, gatt_client->attribute_handle, 9155cf1669fSMatthias Ringwald end_handle, gatt_client->characteristic_properties, gatt_client->uuid128); 9163deb3ec6SMatthias Ringwald 9175cf1669fSMatthias Ringwald gatt_client->characteristic_start_handle = 0; 9183deb3ec6SMatthias Ringwald } 9193deb3ec6SMatthias Ringwald 92023d583b8SMatthias Ringwald 9215cf1669fSMatthias Ringwald static void report_gatt_characteristics(gatt_client_t * gatt_client, uint8_t * packet, uint16_t size){ 9224ea43905SMatthias Ringwald if (size < 2u) return; 9233deb3ec6SMatthias Ringwald uint8_t attr_length = packet[1]; 9244ea43905SMatthias Ringwald if ((attr_length != 7u) && (attr_length != 21u)) return; 9254ea43905SMatthias Ringwald uint8_t uuid_length = attr_length - 5u; 9263deb3ec6SMatthias Ringwald int i; 9274ea43905SMatthias Ringwald for (i = 2u; (i + attr_length) <= size; i += attr_length){ 928f8fbdce0SMatthias Ringwald uint16_t start_handle = little_endian_read_16(packet, i); 9293deb3ec6SMatthias Ringwald uint8_t properties = packet[i+2]; 930f8fbdce0SMatthias Ringwald uint16_t value_handle = little_endian_read_16(packet, i+3); 93123d583b8SMatthias Ringwald report_gatt_characteristic_end_found(gatt_client, start_handle - 1u); 93223d583b8SMatthias Ringwald report_gatt_characteristic_start_found(gatt_client, start_handle, properties, value_handle, &packet[i + 5], 93323d583b8SMatthias Ringwald uuid_length); 9343deb3ec6SMatthias Ringwald } 9353deb3ec6SMatthias Ringwald } 9363deb3ec6SMatthias Ringwald 9375cf1669fSMatthias Ringwald static void report_gatt_included_service_uuid16(gatt_client_t * gatt_client, uint16_t include_handle, uint16_t uuid16){ 9383deb3ec6SMatthias Ringwald uint8_t normalized_uuid128[16]; 939e1a125dfSMatthias Ringwald uuid_add_bluetooth_prefix(normalized_uuid128, uuid16); 9405cf1669fSMatthias Ringwald emit_gatt_included_service_query_result_event(gatt_client, include_handle, gatt_client->query_start_handle, 9415cf1669fSMatthias Ringwald gatt_client->query_end_handle, normalized_uuid128); 9423deb3ec6SMatthias Ringwald } 9433deb3ec6SMatthias Ringwald 944045d700dSDavid Lechner static void report_gatt_included_service_uuid128(gatt_client_t * gatt_client, uint16_t include_handle, const uint8_t * uuid128){ 9455cf1669fSMatthias Ringwald emit_gatt_included_service_query_result_event(gatt_client, include_handle, gatt_client->query_start_handle, 9465cf1669fSMatthias Ringwald gatt_client->query_end_handle, uuid128); 9473deb3ec6SMatthias Ringwald } 9483deb3ec6SMatthias Ringwald 9493deb3ec6SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite parts of the HCI/L2CAP/ATT packet (4/4/3) bytes 9500fde3c5eSMatthias Ringwald static void report_gatt_notification(gatt_client_t *gatt_client, uint16_t value_handle, uint8_t *value, int length) { 9510fde3c5eSMatthias Ringwald if (!gatt_client_accept_server_message(gatt_client)) return; 9520fde3c5eSMatthias Ringwald uint8_t * packet = setup_characteristic_value_packet(GATT_EVENT_NOTIFICATION, gatt_client->con_handle, value_handle, value, length); 95323d583b8SMatthias Ringwald emit_event_to_registered_listeners(gatt_client->con_handle, value_handle, packet, CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE + length); 9543deb3ec6SMatthias Ringwald } 9553deb3ec6SMatthias Ringwald 9563deb3ec6SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite parts of the HCI/L2CAP/ATT packet (4/4/3) bytes 9570fde3c5eSMatthias Ringwald static void report_gatt_indication(gatt_client_t *gatt_client, uint16_t value_handle, uint8_t *value, int length) { 9580fde3c5eSMatthias Ringwald if (!gatt_client_accept_server_message(gatt_client)) return; 9590fde3c5eSMatthias Ringwald uint8_t * packet = setup_characteristic_value_packet(GATT_EVENT_INDICATION, gatt_client->con_handle, value_handle, value, length); 96023d583b8SMatthias Ringwald emit_event_to_registered_listeners(gatt_client->con_handle, value_handle, packet, CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE + length); 9613deb3ec6SMatthias Ringwald } 9623deb3ec6SMatthias Ringwald 9633deb3ec6SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite parts of the HCI/L2CAP/ATT packet (4/4/3) bytes 9645cf1669fSMatthias Ringwald static void report_gatt_characteristic_value(gatt_client_t * gatt_client, uint16_t attribute_handle, uint8_t * value, uint16_t length){ 9655cf1669fSMatthias Ringwald uint8_t * packet = setup_characteristic_value_packet(GATT_EVENT_CHARACTERISTIC_VALUE_QUERY_RESULT, gatt_client->con_handle, attribute_handle, value, length); 96623d583b8SMatthias Ringwald emit_event_new(gatt_client->callback, packet, CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE + length); 9673deb3ec6SMatthias Ringwald } 9683deb3ec6SMatthias Ringwald 9693deb3ec6SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite parts of the HCI/L2CAP/ATT packet (4/4/3) bytes 9705cf1669fSMatthias 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){ 9715cf1669fSMatthias 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); 9723deb3ec6SMatthias Ringwald if (!packet) return; 97323d583b8SMatthias Ringwald emit_event_new(gatt_client->callback, packet, blob_length + LONG_CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE); 9743deb3ec6SMatthias Ringwald } 9753deb3ec6SMatthias Ringwald 9765cf1669fSMatthias 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){ 9779ec2630cSMatthias Ringwald UNUSED(value_offset); 9785cf1669fSMatthias Ringwald uint8_t * packet = setup_characteristic_value_packet(GATT_EVENT_CHARACTERISTIC_DESCRIPTOR_QUERY_RESULT, gatt_client->con_handle, descriptor_handle, value, value_length); 9795cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, value_length + 8u); 9803deb3ec6SMatthias Ringwald } 9813deb3ec6SMatthias Ringwald 9825cf1669fSMatthias 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){ 9835cf1669fSMatthias 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); 9843deb3ec6SMatthias Ringwald if (!packet) return; 98523d583b8SMatthias Ringwald emit_event_new(gatt_client->callback, packet, blob_length + LONG_CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE); 9863deb3ec6SMatthias Ringwald } 9873deb3ec6SMatthias Ringwald 9885cf1669fSMatthias Ringwald static void report_gatt_all_characteristic_descriptors(gatt_client_t * gatt_client, uint8_t * packet, uint16_t size, uint16_t pair_size){ 9893deb3ec6SMatthias Ringwald int i; 9904ea43905SMatthias Ringwald for (i = 0u; (i + pair_size) <= size; i += pair_size){ 991f8fbdce0SMatthias Ringwald uint16_t descriptor_handle = little_endian_read_16(packet,i); 9923deb3ec6SMatthias Ringwald uint8_t uuid128[16]; 9933deb3ec6SMatthias Ringwald uint16_t uuid16 = 0; 9944ea43905SMatthias Ringwald if (pair_size == 4u){ 995f8fbdce0SMatthias Ringwald uuid16 = little_endian_read_16(packet,i+2); 996e1a125dfSMatthias Ringwald uuid_add_bluetooth_prefix(uuid128, uuid16); 9973deb3ec6SMatthias Ringwald } else { 9989c80e4ccSMatthias Ringwald reverse_128(&packet[i+2], uuid128); 9993deb3ec6SMatthias Ringwald } 10005cf1669fSMatthias Ringwald emit_gatt_all_characteristic_descriptors_result_event(gatt_client, descriptor_handle, uuid128); 10013deb3ec6SMatthias Ringwald } 10023deb3ec6SMatthias Ringwald 10033deb3ec6SMatthias Ringwald } 10043deb3ec6SMatthias Ringwald 10055cf1669fSMatthias Ringwald static int is_query_done(gatt_client_t * gatt_client, uint16_t last_result_handle){ 10065cf1669fSMatthias Ringwald return last_result_handle >= gatt_client->end_group_handle; 10073deb3ec6SMatthias Ringwald } 10083deb3ec6SMatthias Ringwald 10095cf1669fSMatthias Ringwald static void trigger_next_query(gatt_client_t * gatt_client, uint16_t last_result_handle, gatt_client_state_t next_query_state){ 10105cf1669fSMatthias Ringwald if (is_query_done(gatt_client, last_result_handle)){ 1011526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 10123deb3ec6SMatthias Ringwald return; 10133deb3ec6SMatthias Ringwald } 10143deb3ec6SMatthias Ringwald // next 10155cf1669fSMatthias Ringwald gatt_client->start_group_handle = last_result_handle + 1u; 10165cf1669fSMatthias Ringwald gatt_client->gatt_client_state = next_query_state; 10173deb3ec6SMatthias Ringwald } 10183deb3ec6SMatthias Ringwald 10195cf1669fSMatthias Ringwald static void trigger_next_included_service_query(gatt_client_t * gatt_client, uint16_t last_result_handle){ 10205cf1669fSMatthias Ringwald trigger_next_query(gatt_client, last_result_handle, P_W2_SEND_INCLUDED_SERVICE_QUERY); 10213deb3ec6SMatthias Ringwald } 10223deb3ec6SMatthias Ringwald 10235cf1669fSMatthias Ringwald static void trigger_next_service_query(gatt_client_t * gatt_client, uint16_t last_result_handle){ 10245cf1669fSMatthias Ringwald trigger_next_query(gatt_client, last_result_handle, P_W2_SEND_SERVICE_QUERY); 10253deb3ec6SMatthias Ringwald } 10263deb3ec6SMatthias Ringwald 10275cf1669fSMatthias Ringwald static void trigger_next_service_by_uuid_query(gatt_client_t * gatt_client, uint16_t last_result_handle){ 10285cf1669fSMatthias Ringwald trigger_next_query(gatt_client, last_result_handle, P_W2_SEND_SERVICE_WITH_UUID_QUERY); 10293deb3ec6SMatthias Ringwald } 10303deb3ec6SMatthias Ringwald 10315cf1669fSMatthias Ringwald static void trigger_next_characteristic_query(gatt_client_t * gatt_client, uint16_t last_result_handle){ 10325cf1669fSMatthias Ringwald if (is_query_done(gatt_client, last_result_handle)){ 10333deb3ec6SMatthias Ringwald // report last characteristic 103423d583b8SMatthias Ringwald report_gatt_characteristic_end_found(gatt_client, gatt_client->end_group_handle); 10353deb3ec6SMatthias Ringwald } 10365cf1669fSMatthias Ringwald trigger_next_query(gatt_client, last_result_handle, P_W2_SEND_ALL_CHARACTERISTICS_OF_SERVICE_QUERY); 10373deb3ec6SMatthias Ringwald } 10383deb3ec6SMatthias Ringwald 10395cf1669fSMatthias Ringwald static void trigger_next_characteristic_descriptor_query(gatt_client_t * gatt_client, uint16_t last_result_handle){ 10405cf1669fSMatthias Ringwald trigger_next_query(gatt_client, last_result_handle, P_W2_SEND_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY); 10413deb3ec6SMatthias Ringwald } 10423deb3ec6SMatthias Ringwald 10435cf1669fSMatthias Ringwald static void trigger_next_read_by_type_query(gatt_client_t * gatt_client, uint16_t last_result_handle){ 10445cf1669fSMatthias Ringwald trigger_next_query(gatt_client, last_result_handle, P_W2_SEND_READ_BY_TYPE_REQUEST); 10453deb3ec6SMatthias Ringwald } 10463deb3ec6SMatthias Ringwald 10475cf1669fSMatthias 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){ 10485cf1669fSMatthias Ringwald gatt_client->attribute_offset += write_blob_length(gatt_client); 10495cf1669fSMatthias Ringwald uint16_t next_blob_length = write_blob_length(gatt_client); 10503deb3ec6SMatthias Ringwald 10514ea43905SMatthias Ringwald if (next_blob_length == 0u){ 10525cf1669fSMatthias Ringwald gatt_client->gatt_client_state = done_state; 10533deb3ec6SMatthias Ringwald return; 10543deb3ec6SMatthias Ringwald } 10555cf1669fSMatthias Ringwald gatt_client->gatt_client_state = next_query_state; 10563deb3ec6SMatthias Ringwald } 10573deb3ec6SMatthias Ringwald 10585cf1669fSMatthias Ringwald static void trigger_next_blob_query(gatt_client_t * gatt_client, gatt_client_state_t next_query_state, uint16_t received_blob_length){ 10593deb3ec6SMatthias Ringwald 1060dda77937SMatthias Ringwald uint16_t max_blob_length = gatt_client->mtu - 1u; 10613deb3ec6SMatthias Ringwald if (received_blob_length < max_blob_length){ 1062526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 10633deb3ec6SMatthias Ringwald return; 10643deb3ec6SMatthias Ringwald } 10653deb3ec6SMatthias Ringwald 10665cf1669fSMatthias Ringwald gatt_client->attribute_offset += received_blob_length; 10675cf1669fSMatthias Ringwald gatt_client->gatt_client_state = next_query_state; 10683deb3ec6SMatthias Ringwald } 10693deb3ec6SMatthias Ringwald 107023d583b8SMatthias 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){ 107123d583b8SMatthias Ringwald notification->callback = callback; 107223d583b8SMatthias Ringwald notification->con_handle = con_handle; 107323d583b8SMatthias Ringwald if (characteristic == NULL){ 107423d583b8SMatthias Ringwald notification->attribute_handle = GATT_CLIENT_ANY_VALUE_HANDLE; 107523d583b8SMatthias Ringwald } else { 107623d583b8SMatthias Ringwald notification->attribute_handle = characteristic->value_handle; 107723d583b8SMatthias Ringwald } 107823d583b8SMatthias Ringwald btstack_linked_list_add(&gatt_client_value_listeners, (btstack_linked_item_t*) notification); 107923d583b8SMatthias Ringwald } 108023d583b8SMatthias Ringwald 108123d583b8SMatthias Ringwald void gatt_client_stop_listening_for_characteristic_value_updates(gatt_client_notification_t * notification){ 108223d583b8SMatthias Ringwald btstack_linked_list_remove(&gatt_client_value_listeners, (btstack_linked_item_t*) notification); 108323d583b8SMatthias Ringwald } 10843deb3ec6SMatthias Ringwald 10855cf1669fSMatthias Ringwald static int is_value_valid(gatt_client_t *gatt_client, uint8_t *packet, uint16_t size){ 1086f8fbdce0SMatthias Ringwald uint16_t attribute_handle = little_endian_read_16(packet, 1); 1087f8fbdce0SMatthias Ringwald uint16_t value_offset = little_endian_read_16(packet, 3); 10883deb3ec6SMatthias Ringwald 10895cf1669fSMatthias Ringwald if (gatt_client->attribute_handle != attribute_handle) return 0; 10905cf1669fSMatthias Ringwald if (gatt_client->attribute_offset != value_offset) return 0; 10915cf1669fSMatthias Ringwald return memcmp(&gatt_client->attribute_value[gatt_client->attribute_offset], &packet[5], size - 5u) == 0u; 10923deb3ec6SMatthias Ringwald } 10933deb3ec6SMatthias Ringwald 10940038504eSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 109592a7335eSMatthias Ringwald static void gatt_client_run_for_client_start_signed_write(gatt_client_t *gatt_client) { 109692a7335eSMatthias Ringwald sm_key_t csrk; 109792a7335eSMatthias Ringwald le_device_db_local_csrk_get(gatt_client->le_device_index, csrk); 109892a7335eSMatthias Ringwald uint32_t sign_counter = le_device_db_local_counter_get(gatt_client->le_device_index); 109992a7335eSMatthias Ringwald gatt_client->gatt_client_state = P_W4_CMAC_RESULT; 110092a7335eSMatthias 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); 110192a7335eSMatthias Ringwald } 11020038504eSMatthias Ringwald #endif 110392a7335eSMatthias Ringwald 110492a7335eSMatthias Ringwald // returns true if packet was sent 11051979f09cSMatthias Ringwald static bool gatt_client_run_for_gatt_client(gatt_client_t * gatt_client){ 11063deb3ec6SMatthias Ringwald 1107e4d159baSMatthias Ringwald // wait until re-encryption is complete 11081979f09cSMatthias Ringwald if (gap_reconnect_security_setup_active(gatt_client->con_handle)) return false; 1109d1e1a57fSMatthias Ringwald 1110e4d159baSMatthias Ringwald // wait until re-encryption is complete 11111979f09cSMatthias Ringwald if (gatt_client->reencryption_active) return false; 11126c124bc2SMatthias Ringwald 111311279da7SMatthias Ringwald // wait until pairing complete (either reactive authentication or due to required security level) 11141979f09cSMatthias Ringwald if (gatt_client->wait_for_authentication_complete) return false; 111511279da7SMatthias Ringwald 1116fd14b205SMatthias Ringwald bool client_request_pending = gatt_client->gatt_client_state != P_READY; 1117fd14b205SMatthias Ringwald 11181aa9e3e8SMatthias Ringwald // verify security level for Mandatory Authentication over LE 111946012949SMatthias Ringwald bool check_security; 112046012949SMatthias Ringwald switch (gatt_client->bearer_type){ 112146012949SMatthias Ringwald case ATT_BEARER_UNENHANCED_LE: 112246012949SMatthias Ringwald check_security = true; 112346012949SMatthias Ringwald break; 112446012949SMatthias Ringwald default: 11259ced96e1SMatthias Ringwald check_security = false; 112646012949SMatthias Ringwald break; 11279ced96e1SMatthias Ringwald } 11289ced96e1SMatthias Ringwald if (client_request_pending && (gatt_client_required_security_level > gatt_client->security_level) && check_security){ 11291dfae9c7SMatthias Ringwald log_info("Trigger pairing, current security level %u, required %u\n", gatt_client->security_level, gatt_client_required_security_level); 11303503dc74SMatthias Ringwald gatt_client->wait_for_authentication_complete = 1; 113111279da7SMatthias Ringwald // set att error code for pairing failure based on required level 113211279da7SMatthias Ringwald switch (gatt_client_required_security_level){ 113311279da7SMatthias Ringwald case LEVEL_4: 113411279da7SMatthias Ringwald case LEVEL_3: 113511279da7SMatthias Ringwald gatt_client->pending_error_code = ATT_ERROR_INSUFFICIENT_AUTHENTICATION; 113611279da7SMatthias Ringwald break; 113711279da7SMatthias Ringwald default: 113811279da7SMatthias Ringwald gatt_client->pending_error_code = ATT_ERROR_INSUFFICIENT_ENCRYPTION; 113911279da7SMatthias Ringwald break; 114011279da7SMatthias Ringwald } 114111279da7SMatthias Ringwald sm_request_pairing(gatt_client->con_handle); 114211279da7SMatthias Ringwald // sm probably just sent a pdu 11431979f09cSMatthias Ringwald return true; 114411279da7SMatthias Ringwald } 1145f4b33574SMatthias Ringwald 11465cf1669fSMatthias Ringwald switch (gatt_client->mtu_state) { 1147544128c3SMatthias Ringwald case SEND_MTU_EXCHANGE: 11485cf1669fSMatthias Ringwald gatt_client->mtu_state = SENT_MTU_EXCHANGE; 11496e7b444cSMatthias Ringwald att_exchange_mtu_request(gatt_client); 11501979f09cSMatthias Ringwald return true; 11513deb3ec6SMatthias Ringwald case SENT_MTU_EXCHANGE: 11521979f09cSMatthias Ringwald return false; 11533deb3ec6SMatthias Ringwald default: 11543deb3ec6SMatthias Ringwald break; 11553deb3ec6SMatthias Ringwald } 11563deb3ec6SMatthias Ringwald 11575cf1669fSMatthias Ringwald if (gatt_client->send_confirmation){ 11585cf1669fSMatthias Ringwald gatt_client->send_confirmation = 0; 11596e7b444cSMatthias Ringwald att_confirmation(gatt_client); 11601979f09cSMatthias Ringwald return true; 11613deb3ec6SMatthias Ringwald } 11623deb3ec6SMatthias Ringwald 11633deb3ec6SMatthias Ringwald // check MTU for writes 11645cf1669fSMatthias Ringwald switch (gatt_client->gatt_client_state){ 11653deb3ec6SMatthias Ringwald case P_W2_SEND_WRITE_CHARACTERISTIC_VALUE: 11663deb3ec6SMatthias Ringwald case P_W2_SEND_WRITE_CHARACTERISTIC_DESCRIPTOR: 1167dda77937SMatthias Ringwald if (gatt_client->attribute_length <= (gatt_client->mtu - 3u)) break; 1168dda77937SMatthias Ringwald log_error("gatt_client_run: value len %u > MTU %u - 3\n", gatt_client->attribute_length,gatt_client->mtu); 1169526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_INVALID_ATTRIBUTE_VALUE_LENGTH); 11701979f09cSMatthias Ringwald return false; 11713deb3ec6SMatthias Ringwald default: 11723deb3ec6SMatthias Ringwald break; 11733deb3ec6SMatthias Ringwald } 11743deb3ec6SMatthias Ringwald 11750038504eSMatthias Ringwald bool packet_sent = true; 11760038504eSMatthias Ringwald bool done = true; 11775cf1669fSMatthias Ringwald switch (gatt_client->gatt_client_state){ 11783deb3ec6SMatthias Ringwald case P_W2_SEND_SERVICE_QUERY: 11795cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_SERVICE_QUERY_RESULT; 11805cf1669fSMatthias Ringwald send_gatt_services_request(gatt_client); 11810038504eSMatthias Ringwald break; 11823deb3ec6SMatthias Ringwald 11833deb3ec6SMatthias Ringwald case P_W2_SEND_SERVICE_WITH_UUID_QUERY: 11845cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_SERVICE_WITH_UUID_RESULT; 11855cf1669fSMatthias Ringwald send_gatt_services_by_uuid_request(gatt_client); 11860038504eSMatthias Ringwald break; 11873deb3ec6SMatthias Ringwald 11883deb3ec6SMatthias Ringwald case P_W2_SEND_ALL_CHARACTERISTICS_OF_SERVICE_QUERY: 11895cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_ALL_CHARACTERISTICS_OF_SERVICE_QUERY_RESULT; 11905cf1669fSMatthias Ringwald send_gatt_characteristic_request(gatt_client); 11910038504eSMatthias Ringwald break; 11923deb3ec6SMatthias Ringwald 11933deb3ec6SMatthias Ringwald case P_W2_SEND_CHARACTERISTIC_WITH_UUID_QUERY: 11945cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_CHARACTERISTIC_WITH_UUID_QUERY_RESULT; 11955cf1669fSMatthias Ringwald send_gatt_characteristic_request(gatt_client); 11960038504eSMatthias Ringwald break; 11973deb3ec6SMatthias Ringwald 11983deb3ec6SMatthias Ringwald case P_W2_SEND_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY: 11995cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_CHARACTERISTIC_WITH_UUID_QUERY_RESULT; 12005cf1669fSMatthias Ringwald send_gatt_characteristic_descriptor_request(gatt_client); 12010038504eSMatthias Ringwald break; 12023deb3ec6SMatthias Ringwald 12033deb3ec6SMatthias Ringwald case P_W2_SEND_INCLUDED_SERVICE_QUERY: 12045cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_INCLUDED_SERVICE_QUERY_RESULT; 12055cf1669fSMatthias Ringwald send_gatt_included_service_request(gatt_client); 12060038504eSMatthias Ringwald break; 12073deb3ec6SMatthias Ringwald 12083deb3ec6SMatthias Ringwald case P_W2_SEND_INCLUDED_SERVICE_WITH_UUID_QUERY: 12095cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_INCLUDED_SERVICE_UUID_WITH_QUERY_RESULT; 12105cf1669fSMatthias Ringwald send_gatt_included_service_uuid_request(gatt_client); 12110038504eSMatthias Ringwald break; 12123deb3ec6SMatthias Ringwald 12133deb3ec6SMatthias Ringwald case P_W2_SEND_READ_CHARACTERISTIC_VALUE_QUERY: 12145cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_READ_CHARACTERISTIC_VALUE_RESULT; 12155cf1669fSMatthias Ringwald send_gatt_read_characteristic_value_request(gatt_client); 12160038504eSMatthias Ringwald break; 12173deb3ec6SMatthias Ringwald 12183deb3ec6SMatthias Ringwald case P_W2_SEND_READ_BLOB_QUERY: 12195cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_READ_BLOB_RESULT; 12205cf1669fSMatthias Ringwald send_gatt_read_blob_request(gatt_client); 12210038504eSMatthias Ringwald break; 12223deb3ec6SMatthias Ringwald 12233deb3ec6SMatthias Ringwald case P_W2_SEND_READ_BY_TYPE_REQUEST: 12245cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_READ_BY_TYPE_RESPONSE; 12255cf1669fSMatthias Ringwald send_gatt_read_by_type_request(gatt_client); 12260038504eSMatthias Ringwald break; 12273deb3ec6SMatthias Ringwald 12283deb3ec6SMatthias Ringwald case P_W2_SEND_READ_MULTIPLE_REQUEST: 12295cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_READ_MULTIPLE_RESPONSE; 12305cf1669fSMatthias Ringwald send_gatt_read_multiple_request(gatt_client); 12310038504eSMatthias Ringwald break; 12323deb3ec6SMatthias Ringwald 1233f125a8efSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 1234f125a8efSMatthias Ringwald case P_W2_SEND_READ_MULTIPLE_VARIABLE_REQUEST: 1235f125a8efSMatthias Ringwald gatt_client->gatt_client_state = P_W4_READ_MULTIPLE_VARIABLE_RESPONSE; 1236f125a8efSMatthias Ringwald send_gatt_read_multiple_variable_request(gatt_client); 1237f125a8efSMatthias Ringwald break; 1238f125a8efSMatthias Ringwald #endif 1239f125a8efSMatthias Ringwald 12403deb3ec6SMatthias Ringwald case P_W2_SEND_WRITE_CHARACTERISTIC_VALUE: 12415cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_WRITE_CHARACTERISTIC_VALUE_RESULT; 12425cf1669fSMatthias Ringwald send_gatt_write_attribute_value_request(gatt_client); 12430038504eSMatthias Ringwald break; 12443deb3ec6SMatthias Ringwald 12453deb3ec6SMatthias Ringwald case P_W2_PREPARE_WRITE: 12465cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_PREPARE_WRITE_RESULT; 12475cf1669fSMatthias Ringwald send_gatt_prepare_write_request(gatt_client); 12480038504eSMatthias Ringwald break; 12493deb3ec6SMatthias Ringwald 12503deb3ec6SMatthias Ringwald case P_W2_PREPARE_WRITE_SINGLE: 12515cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_PREPARE_WRITE_SINGLE_RESULT; 12525cf1669fSMatthias Ringwald send_gatt_prepare_write_request(gatt_client); 12530038504eSMatthias Ringwald break; 12543deb3ec6SMatthias Ringwald 12553deb3ec6SMatthias Ringwald case P_W2_PREPARE_RELIABLE_WRITE: 12565cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_PREPARE_RELIABLE_WRITE_RESULT; 12575cf1669fSMatthias Ringwald send_gatt_prepare_write_request(gatt_client); 12580038504eSMatthias Ringwald break; 12593deb3ec6SMatthias Ringwald 12603deb3ec6SMatthias Ringwald case P_W2_EXECUTE_PREPARED_WRITE: 12615cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_EXECUTE_PREPARED_WRITE_RESULT; 12625cf1669fSMatthias Ringwald send_gatt_execute_write_request(gatt_client); 12630038504eSMatthias Ringwald break; 12643deb3ec6SMatthias Ringwald 12653deb3ec6SMatthias Ringwald case P_W2_CANCEL_PREPARED_WRITE: 12665cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_CANCEL_PREPARED_WRITE_RESULT; 12675cf1669fSMatthias Ringwald send_gatt_cancel_prepared_write_request(gatt_client); 12680038504eSMatthias Ringwald break; 12693deb3ec6SMatthias Ringwald 12703deb3ec6SMatthias Ringwald case P_W2_CANCEL_PREPARED_WRITE_DATA_MISMATCH: 12715cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_CANCEL_PREPARED_WRITE_DATA_MISMATCH_RESULT; 12725cf1669fSMatthias Ringwald send_gatt_cancel_prepared_write_request(gatt_client); 12730038504eSMatthias Ringwald break; 12743deb3ec6SMatthias Ringwald 1275abdc9fb5SMatthias Ringwald #ifdef ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY 1276abdc9fb5SMatthias Ringwald case P_W2_SEND_FIND_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY: 1277abdc9fb5SMatthias Ringwald // use Find Information 12785cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_FIND_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY_RESULT; 12795cf1669fSMatthias Ringwald send_gatt_characteristic_descriptor_request(gatt_client); 1280abdc9fb5SMatthias Ringwald #else 12813deb3ec6SMatthias Ringwald case P_W2_SEND_READ_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY: 1282abdc9fb5SMatthias Ringwald // Use Read By Type 12835cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_READ_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY_RESULT; 12845cf1669fSMatthias Ringwald send_gatt_read_client_characteristic_configuration_request(gatt_client); 1285abdc9fb5SMatthias Ringwald #endif 12860038504eSMatthias Ringwald break; 12873deb3ec6SMatthias Ringwald 12883deb3ec6SMatthias Ringwald case P_W2_SEND_READ_CHARACTERISTIC_DESCRIPTOR_QUERY: 12895cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_READ_CHARACTERISTIC_DESCRIPTOR_RESULT; 12905cf1669fSMatthias Ringwald send_gatt_read_characteristic_descriptor_request(gatt_client); 12910038504eSMatthias Ringwald break; 12923deb3ec6SMatthias Ringwald 12933deb3ec6SMatthias Ringwald case P_W2_SEND_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_QUERY: 12945cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_RESULT; 12955cf1669fSMatthias Ringwald send_gatt_read_blob_request(gatt_client); 12960038504eSMatthias Ringwald break; 12973deb3ec6SMatthias Ringwald 12983deb3ec6SMatthias Ringwald case P_W2_SEND_WRITE_CHARACTERISTIC_DESCRIPTOR: 12995cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT; 13005cf1669fSMatthias Ringwald send_gatt_write_attribute_value_request(gatt_client); 13010038504eSMatthias Ringwald break; 13023deb3ec6SMatthias Ringwald 13033deb3ec6SMatthias Ringwald case P_W2_WRITE_CLIENT_CHARACTERISTIC_CONFIGURATION: 13045cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_CLIENT_CHARACTERISTIC_CONFIGURATION_RESULT; 13055cf1669fSMatthias Ringwald send_gatt_write_client_characteristic_configuration_request(gatt_client); 13060038504eSMatthias Ringwald break; 13073deb3ec6SMatthias Ringwald 13083deb3ec6SMatthias Ringwald case P_W2_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR: 13095cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT; 13105cf1669fSMatthias Ringwald send_gatt_prepare_write_request(gatt_client); 13110038504eSMatthias Ringwald break; 13123deb3ec6SMatthias Ringwald 13133deb3ec6SMatthias Ringwald case P_W2_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR: 13145cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT; 13155cf1669fSMatthias Ringwald send_gatt_execute_write_request(gatt_client); 13160038504eSMatthias Ringwald break; 13173deb3ec6SMatthias Ringwald 13187a766ebfSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 1319793cf6ceSMatthias Ringwald case P_W4_IDENTITY_RESOLVING: 13205cf1669fSMatthias Ringwald log_info("P_W4_IDENTITY_RESOLVING - state %x", sm_identity_resolving_state(gatt_client->con_handle)); 13215cf1669fSMatthias Ringwald switch (sm_identity_resolving_state(gatt_client->con_handle)){ 1322793cf6ceSMatthias Ringwald case IRK_LOOKUP_SUCCEEDED: 13235cf1669fSMatthias Ringwald gatt_client->le_device_index = sm_le_device_index(gatt_client->con_handle); 13245cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_CMAC_READY; 132592a7335eSMatthias Ringwald if (sm_cmac_ready()){ 132692a7335eSMatthias Ringwald gatt_client_run_for_client_start_signed_write(gatt_client); 132792a7335eSMatthias Ringwald } 1328793cf6ceSMatthias Ringwald break; 1329793cf6ceSMatthias Ringwald case IRK_LOOKUP_FAILED: 1330526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_BONDING_INFORMATION_MISSING); 133192a7335eSMatthias Ringwald break; 1332793cf6ceSMatthias Ringwald default: 133392a7335eSMatthias Ringwald break; 1334793cf6ceSMatthias Ringwald } 13350038504eSMatthias Ringwald packet_sent = false; 13360038504eSMatthias Ringwald break; 1337793cf6ceSMatthias Ringwald 13383deb3ec6SMatthias Ringwald case P_W4_CMAC_READY: 13393deb3ec6SMatthias Ringwald if (sm_cmac_ready()){ 134092a7335eSMatthias Ringwald gatt_client_run_for_client_start_signed_write(gatt_client); 13413deb3ec6SMatthias Ringwald } 13420038504eSMatthias Ringwald packet_sent = false; 13430038504eSMatthias Ringwald break; 13443deb3ec6SMatthias Ringwald 13453deb3ec6SMatthias Ringwald case P_W2_SEND_SIGNED_WRITE: { 13465cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_SEND_SINGED_WRITE_DONE; 13473deb3ec6SMatthias Ringwald // bump local signing counter 13485cf1669fSMatthias Ringwald uint32_t sign_counter = le_device_db_local_counter_get(gatt_client->le_device_index); 13495cf1669fSMatthias Ringwald le_device_db_local_counter_set(gatt_client->le_device_index, sign_counter + 1); 135064b12680SMatthias Ringwald // send signed write command 13515cf1669fSMatthias Ringwald send_gatt_signed_write_request(gatt_client, sign_counter); 13523deb3ec6SMatthias Ringwald // finally, notifiy client that write is complete 1353526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 1354b68ac7a5SMatthias Ringwald break; 13553deb3ec6SMatthias Ringwald } 13567a766ebfSMatthias Ringwald #endif 13573deb3ec6SMatthias Ringwald default: 1358b68ac7a5SMatthias Ringwald done = false; 13593deb3ec6SMatthias Ringwald break; 13603deb3ec6SMatthias Ringwald } 136147181045SMatthias Ringwald 13620038504eSMatthias Ringwald if (done){ 13630038504eSMatthias Ringwald return packet_sent; 13640038504eSMatthias Ringwald } 13650038504eSMatthias Ringwald 136659d34cd2SMatthias Ringwald // write without response callback 136759d34cd2SMatthias Ringwald btstack_context_callback_registration_t * callback = 136859d34cd2SMatthias Ringwald (btstack_context_callback_registration_t *) btstack_linked_list_pop(&gatt_client->write_without_response_requests); 136959d34cd2SMatthias Ringwald if (callback != NULL){ 137059d34cd2SMatthias Ringwald (*callback->callback)(callback->context); 137159d34cd2SMatthias Ringwald return true; 137259d34cd2SMatthias Ringwald } 137359d34cd2SMatthias Ringwald 137459d34cd2SMatthias Ringwald // requested can send now old 13755cf1669fSMatthias Ringwald if (gatt_client->write_without_response_callback){ 13765cf1669fSMatthias Ringwald btstack_packet_handler_t packet_handler = gatt_client->write_without_response_callback; 13775cf1669fSMatthias Ringwald gatt_client->write_without_response_callback = NULL; 137847181045SMatthias Ringwald uint8_t event[4]; 137947181045SMatthias Ringwald event[0] = GATT_EVENT_CAN_WRITE_WITHOUT_RESPONSE; 13804ea43905SMatthias Ringwald event[1] = sizeof(event) - 2u; 13815cf1669fSMatthias Ringwald little_endian_store_16(event, 2, gatt_client->con_handle); 13825cf1669fSMatthias Ringwald packet_handler(HCI_EVENT_PACKET, gatt_client->con_handle, event, sizeof(event)); 13831979f09cSMatthias Ringwald return true; // to trigger requeueing (even if higher layer didn't sent) 138447181045SMatthias Ringwald } 138547181045SMatthias Ringwald 13861979f09cSMatthias Ringwald return false; 13873deb3ec6SMatthias Ringwald } 13883deb3ec6SMatthias Ringwald 1389544128c3SMatthias Ringwald static void gatt_client_run(void){ 1390544128c3SMatthias Ringwald btstack_linked_item_t *it; 1391109c2548SMatthias Ringwald bool packet_sent; 13927627a0deSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 13937627a0deSMatthias Ringwald btstack_linked_list_iterator_t it_eatt; 13947627a0deSMatthias Ringwald #endif 1395a0da043fSMatthias Ringwald for (it = (btstack_linked_item_t *) gatt_client_connections; it != NULL; it = it->next){ 13965cf1669fSMatthias Ringwald gatt_client_t * gatt_client = (gatt_client_t *) it; 139746012949SMatthias Ringwald switch (gatt_client->bearer_type){ 139846012949SMatthias Ringwald case ATT_BEARER_UNENHANCED_LE: 13997627a0deSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 14007627a0deSMatthias Ringwald btstack_linked_list_iterator_init(&it_eatt, &gatt_client->eatt_clients); 14017627a0deSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it_eatt)) { 14027627a0deSMatthias Ringwald gatt_client_t * eatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it_eatt); 14037627a0deSMatthias Ringwald if (eatt_client->gatt_client_state != P_READY){ 14047627a0deSMatthias Ringwald if (l2cap_can_send_packet_now(eatt_client->l2cap_cid)){ 14057627a0deSMatthias Ringwald gatt_client_run_for_gatt_client(eatt_client); 14067627a0deSMatthias Ringwald } 14077627a0deSMatthias Ringwald } 14087627a0deSMatthias Ringwald } 14097627a0deSMatthias Ringwald #endif 141046012949SMatthias Ringwald if (!att_dispatch_client_can_send_now(gatt_client->con_handle)) { 141146012949SMatthias Ringwald att_dispatch_client_request_can_send_now_event(gatt_client->con_handle); 141246012949SMatthias Ringwald return; 141346012949SMatthias Ringwald } 1414109c2548SMatthias Ringwald packet_sent = gatt_client_run_for_gatt_client(gatt_client); 141546012949SMatthias Ringwald if (packet_sent){ 141646012949SMatthias Ringwald // request new permission 141746012949SMatthias Ringwald att_dispatch_client_request_can_send_now_event(gatt_client->con_handle); 141846012949SMatthias Ringwald // requeue client for fairness and exit 141946012949SMatthias Ringwald // note: iterator has become invalid 142046012949SMatthias Ringwald btstack_linked_list_remove(&gatt_client_connections, (btstack_linked_item_t *) gatt_client); 142146012949SMatthias Ringwald btstack_linked_list_add_tail(&gatt_client_connections, (btstack_linked_item_t *) gatt_client); 142246012949SMatthias Ringwald return; 142346012949SMatthias Ringwald } 142446012949SMatthias Ringwald break; 14251450cdc6SMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC 142646012949SMatthias Ringwald case ATT_BEARER_UNENHANCED_CLASSIC: 14271450cdc6SMatthias Ringwald if (gatt_client->con_handle == HCI_CON_HANDLE_INVALID) { 14281450cdc6SMatthias Ringwald continue; 14291450cdc6SMatthias Ringwald } 14301aa9e3e8SMatthias Ringwald 14311aa9e3e8SMatthias Ringwald // handle GATT over BR/EDR 14321aa9e3e8SMatthias Ringwald if (l2cap_can_send_packet_now(gatt_client->l2cap_cid) == false){ 14331aa9e3e8SMatthias Ringwald l2cap_request_can_send_now_event(gatt_client->l2cap_cid); 14341aa9e3e8SMatthias Ringwald return; 14351aa9e3e8SMatthias Ringwald } 1436109c2548SMatthias Ringwald packet_sent = gatt_client_run_for_gatt_client(gatt_client); 14371aa9e3e8SMatthias Ringwald if (packet_sent){ 14381aa9e3e8SMatthias Ringwald // request new permission 14391aa9e3e8SMatthias Ringwald att_dispatch_client_request_can_send_now_event(gatt_client->con_handle); 14401aa9e3e8SMatthias Ringwald // requeue client for fairness and exit 14411aa9e3e8SMatthias Ringwald // note: iterator has become invalid 14421aa9e3e8SMatthias Ringwald btstack_linked_list_remove(&gatt_client_connections, (btstack_linked_item_t *) gatt_client); 14431aa9e3e8SMatthias Ringwald btstack_linked_list_add_tail(&gatt_client_connections, (btstack_linked_item_t *) gatt_client); 14441aa9e3e8SMatthias Ringwald return; 14451aa9e3e8SMatthias Ringwald } 144646012949SMatthias Ringwald break; 14471450cdc6SMatthias Ringwald #endif 144846012949SMatthias Ringwald default: 144946012949SMatthias Ringwald btstack_unreachable(); 145046012949SMatthias Ringwald break; 1451544128c3SMatthias Ringwald } 145246012949SMatthias Ringwald 145346012949SMatthias Ringwald 1454544128c3SMatthias Ringwald } 14553deb3ec6SMatthias Ringwald } 14563deb3ec6SMatthias Ringwald 14575cf1669fSMatthias Ringwald static void gatt_client_report_error_if_pending(gatt_client_t *gatt_client, uint8_t att_error_code) { 14585cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 1) return; 1459526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, att_error_code); 14603deb3ec6SMatthias Ringwald } 14613deb3ec6SMatthias Ringwald 146278c4542aSMatthias Ringwald static void gatt_client_handle_reencryption_complete(const uint8_t * packet){ 146378c4542aSMatthias Ringwald hci_con_handle_t con_handle = sm_event_reencryption_complete_get_handle(packet); 146478c4542aSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_get_context_for_handle(con_handle); 146578c4542aSMatthias Ringwald if (gatt_client == NULL) return; 146678c4542aSMatthias Ringwald 146778c4542aSMatthias Ringwald // update security level 146878c4542aSMatthias Ringwald gatt_client->security_level = gatt_client_le_security_level_for_connection(con_handle); 146978c4542aSMatthias Ringwald 147078c4542aSMatthias Ringwald gatt_client->reencryption_result = sm_event_reencryption_complete_get_status(packet); 147178c4542aSMatthias Ringwald gatt_client->reencryption_active = false; 147278c4542aSMatthias Ringwald gatt_client->wait_for_authentication_complete = 0; 147378c4542aSMatthias Ringwald 147478c4542aSMatthias Ringwald if (gatt_client->gatt_client_state == P_READY) return; 147578c4542aSMatthias Ringwald 147678c4542aSMatthias Ringwald switch (sm_event_reencryption_complete_get_status(packet)){ 147778c4542aSMatthias Ringwald case ERROR_CODE_SUCCESS: 147878c4542aSMatthias Ringwald log_info("re-encryption success, retry operation"); 147978c4542aSMatthias Ringwald break; 148078c4542aSMatthias Ringwald case ERROR_CODE_AUTHENTICATION_FAILURE: 148178c4542aSMatthias Ringwald case ERROR_CODE_PIN_OR_KEY_MISSING: 148278c4542aSMatthias Ringwald #if defined(ENABLE_GATT_CLIENT_PAIRING) && !defined(ENABLE_LE_PROACTIVE_AUTHENTICATION) 148378c4542aSMatthias Ringwald if (gatt_client_required_security_level == LEVEL_0) { 148478c4542aSMatthias Ringwald // re-encryption failed for reactive authentication with pairing and we have a pending client request 148578c4542aSMatthias Ringwald // => try to resolve it by deleting bonding information if we started pairing before 148678c4542aSMatthias Ringwald // delete bonding information 148778c4542aSMatthias Ringwald int le_device_db_index = sm_le_device_index(gatt_client->con_handle); 148878c4542aSMatthias Ringwald btstack_assert(le_device_db_index >= 0); 148978c4542aSMatthias Ringwald log_info("reactive auth with pairing: delete bonding and start pairing"); 149078c4542aSMatthias Ringwald #ifdef ENABLE_LE_PRIVACY_ADDRESS_RESOLUTION 149178c4542aSMatthias Ringwald hci_remove_le_device_db_entry_from_resolving_list((uint16_t) le_device_db_index); 149278c4542aSMatthias Ringwald #endif 149378c4542aSMatthias Ringwald le_device_db_remove(le_device_db_index); 149478c4542aSMatthias Ringwald // trigger pairing again 149578c4542aSMatthias Ringwald sm_request_pairing(gatt_client->con_handle); 149678c4542aSMatthias Ringwald break; 149778c4542aSMatthias Ringwald } 149878c4542aSMatthias Ringwald #endif 149978c4542aSMatthias Ringwald // report bonding information missing 1500526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_BONDING_INFORMATION_MISSING); 150178c4542aSMatthias Ringwald break; 150278c4542aSMatthias Ringwald default: 150378c4542aSMatthias Ringwald // report bonding information missing 1504526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, gatt_client->pending_error_code); 150578c4542aSMatthias Ringwald break; 150678c4542aSMatthias Ringwald } 150778c4542aSMatthias Ringwald } 150878c4542aSMatthias Ringwald 150978c4542aSMatthias Ringwald static void gatt_client_handle_disconnection_complete(const uint8_t * packet){ 151078c4542aSMatthias Ringwald log_info("GATT Client: HCI_EVENT_DISCONNECTION_COMPLETE"); 151178c4542aSMatthias Ringwald hci_con_handle_t con_handle = little_endian_read_16(packet,3); 151278c4542aSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_get_context_for_handle(con_handle); 151378c4542aSMatthias Ringwald if (gatt_client == NULL) return; 151478c4542aSMatthias Ringwald 151578c4542aSMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, ATT_ERROR_HCI_DISCONNECT_RECEIVED); 151678c4542aSMatthias Ringwald gatt_client_timeout_stop(gatt_client); 151778c4542aSMatthias Ringwald btstack_linked_list_remove(&gatt_client_connections, (btstack_linked_item_t *) gatt_client); 151878c4542aSMatthias Ringwald btstack_memory_gatt_client_free(gatt_client); 151978c4542aSMatthias Ringwald } 152078c4542aSMatthias Ringwald 1521f4b33574SMatthias Ringwald static void gatt_client_event_packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size){ 15221ac26e06SMatthias Ringwald UNUSED(channel); // ok: handling own l2cap events 15231ac26e06SMatthias Ringwald UNUSED(size); // ok: there is no channel 15249ec2630cSMatthias Ringwald 1525361b1363SMatthias Ringwald if (packet_type != HCI_EVENT_PACKET) return; 1526361b1363SMatthias Ringwald 1527f4b33574SMatthias Ringwald hci_con_handle_t con_handle; 15285cf1669fSMatthias Ringwald gatt_client_t * gatt_client; 15290e2df43fSMatthias Ringwald switch (hci_event_packet_get_type(packet)) { 15303deb3ec6SMatthias Ringwald case HCI_EVENT_DISCONNECTION_COMPLETE: 153178c4542aSMatthias Ringwald gatt_client_handle_disconnection_complete(packet); 15323deb3ec6SMatthias Ringwald break; 1533f4b33574SMatthias Ringwald 1534f4b33574SMatthias Ringwald // Pairing complete (with/without bonding=storing of pairing information) 1535f4b33574SMatthias Ringwald case SM_EVENT_PAIRING_COMPLETE: 1536f4b33574SMatthias Ringwald con_handle = sm_event_pairing_complete_get_handle(packet); 15375cf1669fSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(con_handle); 15385cf1669fSMatthias Ringwald if (gatt_client == NULL) break; 1539f4b33574SMatthias Ringwald 15401dfae9c7SMatthias Ringwald // update security level 15411dfae9c7SMatthias Ringwald gatt_client->security_level = gatt_client_le_security_level_for_connection(con_handle); 15421dfae9c7SMatthias Ringwald 15433503dc74SMatthias Ringwald if (gatt_client->wait_for_authentication_complete){ 15443503dc74SMatthias Ringwald gatt_client->wait_for_authentication_complete = 0; 1545f4b33574SMatthias Ringwald if (sm_event_pairing_complete_get_status(packet)){ 15465cf1669fSMatthias Ringwald log_info("pairing failed, report previous error 0x%x", gatt_client->pending_error_code); 1547ec9babacSMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, gatt_client->pending_error_code); 1548f4b33574SMatthias Ringwald } else { 1549f4b33574SMatthias Ringwald log_info("pairing success, retry operation"); 15503deb3ec6SMatthias Ringwald } 1551f4b33574SMatthias Ringwald } 1552f4b33574SMatthias Ringwald break; 155311279da7SMatthias Ringwald 1554793cf6ceSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 1555793cf6ceSMatthias Ringwald // Identity Resolving completed (no code, gatt_client_run will continue) 1556793cf6ceSMatthias Ringwald case SM_EVENT_IDENTITY_RESOLVING_SUCCEEDED: 1557793cf6ceSMatthias Ringwald case SM_EVENT_IDENTITY_RESOLVING_FAILED: 1558793cf6ceSMatthias Ringwald break; 1559793cf6ceSMatthias Ringwald #endif 1560a95ca902SMatthias Ringwald 15618918bbdaSMatthias Ringwald // re-encryption started 15628918bbdaSMatthias Ringwald case SM_EVENT_REENCRYPTION_STARTED: 15638918bbdaSMatthias Ringwald con_handle = sm_event_reencryption_complete_get_handle(packet); 15648918bbdaSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(con_handle); 15658918bbdaSMatthias Ringwald if (gatt_client == NULL) break; 15668918bbdaSMatthias Ringwald 15678918bbdaSMatthias Ringwald gatt_client->reencryption_active = true; 15688918bbdaSMatthias Ringwald gatt_client->reencryption_result = ERROR_CODE_SUCCESS; 15698918bbdaSMatthias Ringwald break; 15708918bbdaSMatthias Ringwald 1571ec9babacSMatthias Ringwald // re-encryption complete 1572ec9babacSMatthias Ringwald case SM_EVENT_REENCRYPTION_COMPLETE: 157378c4542aSMatthias Ringwald gatt_client_handle_reencryption_complete(packet); 1574ec9babacSMatthias Ringwald break; 15753deb3ec6SMatthias Ringwald default: 15763deb3ec6SMatthias Ringwald break; 15773deb3ec6SMatthias Ringwald } 15783deb3ec6SMatthias Ringwald 1579361b1363SMatthias Ringwald gatt_client_run(); 15803deb3ec6SMatthias Ringwald } 15813deb3ec6SMatthias Ringwald 15822da0d963SMatthias Ringwald static void gatt_client_handle_att_read_response(gatt_client_t *gatt_client, uint8_t *packet, uint16_t size) { 15835cf1669fSMatthias Ringwald switch (gatt_client->gatt_client_state) { 15842da0d963SMatthias Ringwald case P_W4_INCLUDED_SERVICE_UUID_WITH_QUERY_RESULT: 15852da0d963SMatthias Ringwald if (size >= 17) { 15862da0d963SMatthias Ringwald uint8_t uuid128[16]; 15872da0d963SMatthias Ringwald reverse_128(&packet[1], uuid128); 15882da0d963SMatthias Ringwald report_gatt_included_service_uuid128(gatt_client, gatt_client->start_group_handle, uuid128); 15892da0d963SMatthias Ringwald } 15902da0d963SMatthias Ringwald trigger_next_included_service_query(gatt_client, gatt_client->start_group_handle); 15915611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 15923deb3ec6SMatthias Ringwald break; 15932da0d963SMatthias Ringwald 15942da0d963SMatthias Ringwald case P_W4_READ_CHARACTERISTIC_VALUE_RESULT: 15952da0d963SMatthias Ringwald report_gatt_characteristic_value(gatt_client, gatt_client->attribute_handle, &packet[1], size - 1u); 1596526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 15972da0d963SMatthias Ringwald break; 15982da0d963SMatthias Ringwald 15992da0d963SMatthias Ringwald case P_W4_READ_CHARACTERISTIC_DESCRIPTOR_RESULT: 16002da0d963SMatthias Ringwald report_gatt_characteristic_descriptor(gatt_client, gatt_client->attribute_handle, &packet[1], 16012da0d963SMatthias Ringwald size - 1u, 0u); 1602526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 16032da0d963SMatthias Ringwald break; 16042da0d963SMatthias Ringwald 16052da0d963SMatthias Ringwald // Use ATT_READ_REQUEST for first blob of Read Long Characteristic 16062da0d963SMatthias Ringwald case P_W4_READ_BLOB_RESULT: 16072da0d963SMatthias Ringwald report_gatt_long_characteristic_value_blob(gatt_client, gatt_client->attribute_handle, &packet[1], 16082da0d963SMatthias Ringwald size - 1u, gatt_client->attribute_offset); 16092da0d963SMatthias Ringwald trigger_next_blob_query(gatt_client, P_W2_SEND_READ_BLOB_QUERY, size - 1u); 16102da0d963SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 16112da0d963SMatthias Ringwald break; 16122da0d963SMatthias Ringwald 16132da0d963SMatthias Ringwald // Use ATT_READ_REQUEST for first blob of Read Long Characteristic Descriptor 16142da0d963SMatthias Ringwald case P_W4_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_RESULT: 16152da0d963SMatthias Ringwald report_gatt_long_characteristic_descriptor(gatt_client, gatt_client->attribute_handle, &packet[1], 16162da0d963SMatthias Ringwald size - 1u, gatt_client->attribute_offset); 16172da0d963SMatthias Ringwald trigger_next_blob_query(gatt_client, P_W2_SEND_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_QUERY, 16182da0d963SMatthias Ringwald size - 1u); 16192da0d963SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 16202da0d963SMatthias Ringwald break; 16212da0d963SMatthias Ringwald 16223deb3ec6SMatthias Ringwald default: 16233deb3ec6SMatthias Ringwald break; 16243deb3ec6SMatthias Ringwald } 16252da0d963SMatthias Ringwald } 16263deb3ec6SMatthias Ringwald 16272da0d963SMatthias Ringwald static void gatt_client_handle_att_read_by_type_response(gatt_client_t *gatt_client, uint8_t *packet, uint16_t size) { 16285cf1669fSMatthias Ringwald switch (gatt_client->gatt_client_state) { 16293deb3ec6SMatthias Ringwald case P_W4_ALL_CHARACTERISTICS_OF_SERVICE_QUERY_RESULT: 16305cf1669fSMatthias Ringwald report_gatt_characteristics(gatt_client, packet, size); 1631cf8e5718SMatthias Ringwald trigger_next_characteristic_query(gatt_client, 1632cf8e5718SMatthias Ringwald get_last_result_handle_from_characteristics_list(packet, size)); 16335611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done, or by ATT_ERROR 16343deb3ec6SMatthias Ringwald break; 16353deb3ec6SMatthias Ringwald case P_W4_CHARACTERISTIC_WITH_UUID_QUERY_RESULT: 16365cf1669fSMatthias Ringwald report_gatt_characteristics(gatt_client, packet, size); 1637cf8e5718SMatthias Ringwald trigger_next_characteristic_query(gatt_client, 1638cf8e5718SMatthias Ringwald get_last_result_handle_from_characteristics_list(packet, size)); 16395611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done, or by ATT_ERROR 16403deb3ec6SMatthias Ringwald break; 1641cf8e5718SMatthias Ringwald case P_W4_INCLUDED_SERVICE_QUERY_RESULT: { 16424ea43905SMatthias Ringwald if (size < 2u) break; 16433deb3ec6SMatthias Ringwald uint16_t uuid16 = 0; 16443deb3ec6SMatthias Ringwald uint16_t pair_size = packet[1]; 16453deb3ec6SMatthias Ringwald 16464ea43905SMatthias Ringwald if (pair_size == 6u) { 16474ea43905SMatthias Ringwald if (size < 8u) break; 16483deb3ec6SMatthias Ringwald // UUIDs not available, query first included service 16495cf1669fSMatthias Ringwald gatt_client->start_group_handle = little_endian_read_16(packet, 2); // ready for next query 16505cf1669fSMatthias Ringwald gatt_client->query_start_handle = little_endian_read_16(packet, 4); 16515cf1669fSMatthias Ringwald gatt_client->query_end_handle = little_endian_read_16(packet, 6); 16525cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_INCLUDED_SERVICE_WITH_UUID_QUERY; 16533deb3ec6SMatthias Ringwald break; 16543deb3ec6SMatthias Ringwald } 16553deb3ec6SMatthias Ringwald 16564ea43905SMatthias Ringwald if (pair_size != 8u) break; 16579f698c82SMatthias Ringwald 16589f698c82SMatthias Ringwald // UUIDs included, report all of them 16593deb3ec6SMatthias Ringwald uint16_t offset; 16604ea43905SMatthias Ringwald for (offset = 2u; (offset + 8u) <= size; offset += pair_size) { 1661f8fbdce0SMatthias Ringwald uint16_t include_handle = little_endian_read_16(packet, offset); 16625cf1669fSMatthias Ringwald gatt_client->query_start_handle = little_endian_read_16(packet, offset + 2u); 16635cf1669fSMatthias Ringwald gatt_client->query_end_handle = little_endian_read_16(packet, offset + 4u); 16644ea43905SMatthias Ringwald uuid16 = little_endian_read_16(packet, offset + 6u); 16655cf1669fSMatthias Ringwald report_gatt_included_service_uuid16(gatt_client, include_handle, uuid16); 16663deb3ec6SMatthias Ringwald } 16673deb3ec6SMatthias Ringwald 1668cf8e5718SMatthias Ringwald trigger_next_included_service_query(gatt_client, 1669cf8e5718SMatthias Ringwald get_last_result_handle_from_included_services_list(packet, 1670cf8e5718SMatthias Ringwald size)); 16715611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 16723deb3ec6SMatthias Ringwald break; 16733deb3ec6SMatthias Ringwald } 1674abdc9fb5SMatthias Ringwald #ifndef ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY 16753deb3ec6SMatthias Ringwald case P_W4_READ_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY_RESULT: 16765cf1669fSMatthias Ringwald gatt_client->client_characteristic_configuration_handle = little_endian_read_16(packet, 2); 16775cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_WRITE_CLIENT_CHARACTERISTIC_CONFIGURATION; 16783deb3ec6SMatthias Ringwald break; 1679abdc9fb5SMatthias Ringwald #endif 16803deb3ec6SMatthias Ringwald case P_W4_READ_BY_TYPE_RESPONSE: { 16813deb3ec6SMatthias Ringwald uint16_t pair_size = packet[1]; 168239ac9711SMatthias Ringwald // set last result handle to last valid handle, only used if pair_size invalid 168339ac9711SMatthias Ringwald uint16_t last_result_handle = 0xffff; 168439ac9711SMatthias Ringwald if (pair_size > 2) { 16853deb3ec6SMatthias Ringwald uint16_t offset; 16863deb3ec6SMatthias Ringwald for (offset = 2; offset < size; offset += pair_size) { 1687f8fbdce0SMatthias Ringwald uint16_t value_handle = little_endian_read_16(packet, offset); 1688cf8e5718SMatthias Ringwald report_gatt_characteristic_value(gatt_client, value_handle, &packet[offset + 2u], 1689cf8e5718SMatthias Ringwald pair_size - 2u); 16903deb3ec6SMatthias Ringwald last_result_handle = value_handle; 16913deb3ec6SMatthias Ringwald } 169239ac9711SMatthias Ringwald } 16935cf1669fSMatthias Ringwald trigger_next_read_by_type_query(gatt_client, last_result_handle); 16943deb3ec6SMatthias Ringwald break; 16953deb3ec6SMatthias Ringwald } 16963deb3ec6SMatthias Ringwald default: 16973deb3ec6SMatthias Ringwald break; 16983deb3ec6SMatthias Ringwald } 169939ac9711SMatthias Ringwald } 1700dc13fd8dSMatthias Ringwald 17012da0d963SMatthias Ringwald static void gatt_client_handle_att_write_response(gatt_client_t *gatt_client) { 17022da0d963SMatthias Ringwald switch (gatt_client->gatt_client_state) { 17032da0d963SMatthias Ringwald case P_W4_WRITE_CHARACTERISTIC_VALUE_RESULT: 1704526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 17053deb3ec6SMatthias Ringwald break; 17062da0d963SMatthias Ringwald case P_W4_CLIENT_CHARACTERISTIC_CONFIGURATION_RESULT: 1707526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 17083deb3ec6SMatthias Ringwald break; 17092da0d963SMatthias Ringwald case P_W4_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT: 1710526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 17112da0d963SMatthias Ringwald break; 17122da0d963SMatthias Ringwald default: 17132da0d963SMatthias Ringwald break; 17142da0d963SMatthias Ringwald } 17152da0d963SMatthias Ringwald } 1716dc13fd8dSMatthias Ringwald 17172da0d963SMatthias Ringwald static void gatt_client_handle_att_response(gatt_client_t * gatt_client, uint8_t * packet, uint16_t size) { 17184740230fSMatthias Ringwald uint8_t att_status; 17192da0d963SMatthias Ringwald switch (packet[0]) { 17202da0d963SMatthias Ringwald case ATT_EXCHANGE_MTU_RESPONSE: { 17212da0d963SMatthias Ringwald if (size < 3u) break; 172246012949SMatthias Ringwald bool update_gatt_server_att_mtu = false; 17232da0d963SMatthias Ringwald uint16_t remote_rx_mtu = little_endian_read_16(packet, 1); 17242da0d963SMatthias Ringwald uint16_t local_rx_mtu = l2cap_max_le_mtu(); 172546012949SMatthias Ringwald switch (gatt_client->bearer_type){ 172646012949SMatthias Ringwald case ATT_BEARER_UNENHANCED_LE: 172746012949SMatthias Ringwald update_gatt_server_att_mtu = true; 172846012949SMatthias Ringwald break; 17292da0d963SMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC 173046012949SMatthias Ringwald case ATT_BEARER_UNENHANCED_CLASSIC: 17312da0d963SMatthias Ringwald local_rx_mtu = gatt_client->mtu; 173246012949SMatthias Ringwald break; 17332da0d963SMatthias Ringwald #endif 173446012949SMatthias Ringwald default: 173546012949SMatthias Ringwald btstack_unreachable(); 173646012949SMatthias Ringwald break; 173746012949SMatthias Ringwald } 173846012949SMatthias Ringwald 17392da0d963SMatthias Ringwald uint16_t mtu = (remote_rx_mtu < local_rx_mtu) ? remote_rx_mtu : local_rx_mtu; 17402da0d963SMatthias Ringwald 17412da0d963SMatthias Ringwald // set gatt client mtu 17422da0d963SMatthias Ringwald gatt_client->mtu = mtu; 17432da0d963SMatthias Ringwald gatt_client->mtu_state = MTU_EXCHANGED; 17442da0d963SMatthias Ringwald 174546012949SMatthias Ringwald if (update_gatt_server_att_mtu){ 17462da0d963SMatthias Ringwald // set per connection mtu state - for fixed channel 17472da0d963SMatthias Ringwald hci_connection_t *hci_connection = hci_connection_for_handle(gatt_client->con_handle); 17482da0d963SMatthias Ringwald hci_connection->att_connection.mtu = gatt_client->mtu; 17492da0d963SMatthias Ringwald hci_connection->att_connection.mtu_exchanged = true; 17502da0d963SMatthias Ringwald } 17512da0d963SMatthias Ringwald emit_gatt_mtu_exchanged_result_event(gatt_client, gatt_client->mtu); 17522da0d963SMatthias Ringwald break; 17532da0d963SMatthias Ringwald } 17542da0d963SMatthias Ringwald case ATT_READ_BY_GROUP_TYPE_RESPONSE: 17552da0d963SMatthias Ringwald switch (gatt_client->gatt_client_state) { 17562da0d963SMatthias Ringwald case P_W4_SERVICE_QUERY_RESULT: 17572da0d963SMatthias Ringwald report_gatt_services(gatt_client, packet, size); 17582da0d963SMatthias Ringwald trigger_next_service_query(gatt_client, get_last_result_handle_from_service_list(packet, size)); 175930952227SMilanka Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 176030952227SMilanka Ringwald break; 17613deb3ec6SMatthias Ringwald default: 17623deb3ec6SMatthias Ringwald break; 17633deb3ec6SMatthias Ringwald } 17643deb3ec6SMatthias Ringwald break; 17652da0d963SMatthias Ringwald case ATT_HANDLE_VALUE_NOTIFICATION: 17662da0d963SMatthias Ringwald if (size < 3u) return; 17672da0d963SMatthias Ringwald report_gatt_notification(gatt_client, little_endian_read_16(packet, 1u), &packet[3], size - 3u); 17682da0d963SMatthias Ringwald return; 1769cbba69d5SMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 1770cbba69d5SMatthias Ringwald case ATT_MULTIPLE_HANDLE_VALUE_NTF: 1771cbba69d5SMatthias Ringwald if (size >= 5u) { 1772cbba69d5SMatthias Ringwald uint16_t offset = 1; 1773cbba69d5SMatthias Ringwald while (true){ 1774cbba69d5SMatthias Ringwald uint16_t value_handle = little_endian_read_16(packet, offset); 1775cbba69d5SMatthias Ringwald offset += 2; 1776cbba69d5SMatthias Ringwald uint16_t value_length = little_endian_read_16(packet, offset); 1777cbba69d5SMatthias Ringwald offset += 2; 1778cbba69d5SMatthias Ringwald if ((offset + value_length) > size) break; 1779cbba69d5SMatthias Ringwald report_gatt_notification(gatt_client, value_handle, &packet[offset], value_length); 1780cbba69d5SMatthias Ringwald offset += value_length; 1781cbba69d5SMatthias Ringwald } 1782cbba69d5SMatthias Ringwald } 1783cbba69d5SMatthias Ringwald return; 1784cbba69d5SMatthias Ringwald #endif 17852da0d963SMatthias Ringwald case ATT_HANDLE_VALUE_INDICATION: 17862da0d963SMatthias Ringwald if (size < 3u) break; 17872da0d963SMatthias Ringwald report_gatt_indication(gatt_client, little_endian_read_16(packet, 1u), &packet[3], size - 3u); 17882da0d963SMatthias Ringwald gatt_client->send_confirmation = 1; 17892da0d963SMatthias Ringwald break; 17902da0d963SMatthias Ringwald case ATT_READ_BY_TYPE_RESPONSE: 17912da0d963SMatthias Ringwald gatt_client_handle_att_read_by_type_response(gatt_client, packet, size); 17922da0d963SMatthias Ringwald break; 17932da0d963SMatthias Ringwald case ATT_READ_RESPONSE: 17942da0d963SMatthias Ringwald gatt_client_handle_att_read_response(gatt_client, packet, size); 17952da0d963SMatthias Ringwald break; 1796cf8e5718SMatthias Ringwald case ATT_FIND_BY_TYPE_VALUE_RESPONSE: { 17973deb3ec6SMatthias Ringwald uint8_t pair_size = 4; 17983deb3ec6SMatthias Ringwald int i; 17993deb3ec6SMatthias Ringwald uint16_t start_group_handle; 18005611a760SMatthias Ringwald uint16_t end_group_handle = 0xffff; // asserts GATT_EVENT_QUERY_COMPLETE is emitted if no results 18014ea43905SMatthias Ringwald for (i = 1u; (i + pair_size) <= size; i += pair_size) { 1802f8fbdce0SMatthias Ringwald start_group_handle = little_endian_read_16(packet, i); 1803f8fbdce0SMatthias Ringwald end_group_handle = little_endian_read_16(packet, i + 2); 1804cf8e5718SMatthias Ringwald emit_gatt_service_query_result_event(gatt_client, start_group_handle, end_group_handle, 1805cf8e5718SMatthias Ringwald gatt_client->uuid128); 18063deb3ec6SMatthias Ringwald } 18075cf1669fSMatthias Ringwald trigger_next_service_by_uuid_query(gatt_client, end_group_handle); 18085611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 18093deb3ec6SMatthias Ringwald break; 18103deb3ec6SMatthias Ringwald } 1811cf8e5718SMatthias Ringwald case ATT_FIND_INFORMATION_REPLY: { 18124ea43905SMatthias Ringwald if (size < 2u) break; 1813a6121b51SMilanka Ringwald 18143deb3ec6SMatthias Ringwald uint8_t pair_size = 4; 18154ea43905SMatthias Ringwald if (packet[1u] == 2u) { 18163deb3ec6SMatthias Ringwald pair_size = 18; 18173deb3ec6SMatthias Ringwald } 1818a6121b51SMilanka Ringwald uint16_t offset = 2; 1819a6121b51SMilanka Ringwald 1820a6121b51SMilanka Ringwald if (size < (pair_size + offset)) break; 1821f8fbdce0SMatthias Ringwald uint16_t last_descriptor_handle = little_endian_read_16(packet, size - pair_size); 1822abdc9fb5SMatthias Ringwald 1823abdc9fb5SMatthias Ringwald #ifdef ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY 18245cf1669fSMatthias Ringwald log_info("ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY, state %x", gatt_client->gatt_client_state); 18255cf1669fSMatthias Ringwald if (gatt_client->gatt_client_state == P_W4_FIND_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY_RESULT){ 1826abdc9fb5SMatthias Ringwald // iterate over descriptors looking for CCC 1827abdc9fb5SMatthias Ringwald if (pair_size == 4){ 1828a6121b51SMilanka Ringwald while ((offset + 4) <= size){ 1829abdc9fb5SMatthias Ringwald uint16_t uuid16 = little_endian_read_16(packet, offset + 2); 1830abdc9fb5SMatthias Ringwald if (uuid16 == GATT_CLIENT_CHARACTERISTICS_CONFIGURATION){ 18315cf1669fSMatthias Ringwald gatt_client->client_characteristic_configuration_handle = little_endian_read_16(packet, offset); 18325cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_WRITE_CLIENT_CHARACTERISTIC_CONFIGURATION; 18335cf1669fSMatthias Ringwald log_info("CCC found %x", gatt_client->client_characteristic_configuration_handle); 1834abdc9fb5SMatthias Ringwald break; 1835abdc9fb5SMatthias Ringwald } 1836abdc9fb5SMatthias Ringwald offset += pair_size; 1837abdc9fb5SMatthias Ringwald } 1838abdc9fb5SMatthias Ringwald } 18395cf1669fSMatthias Ringwald if (is_query_done(gatt_client, last_descriptor_handle)){ 1840abdc9fb5SMatthias Ringwald 1841abdc9fb5SMatthias Ringwald } else { 1842abdc9fb5SMatthias Ringwald // next 18435cf1669fSMatthias Ringwald gatt_client->start_group_handle = last_descriptor_handle + 1; 18445cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_FIND_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY; 1845abdc9fb5SMatthias Ringwald } 1846abdc9fb5SMatthias Ringwald break; 1847abdc9fb5SMatthias Ringwald } 1848abdc9fb5SMatthias Ringwald #endif 18495cf1669fSMatthias Ringwald report_gatt_all_characteristic_descriptors(gatt_client, &packet[2], size - 2u, pair_size); 18505cf1669fSMatthias Ringwald trigger_next_characteristic_descriptor_query(gatt_client, last_descriptor_handle); 18515611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 18523deb3ec6SMatthias Ringwald break; 18533deb3ec6SMatthias Ringwald } 18543deb3ec6SMatthias Ringwald 18553deb3ec6SMatthias Ringwald case ATT_WRITE_RESPONSE: 18562da0d963SMatthias Ringwald gatt_client_handle_att_write_response(gatt_client); 18573deb3ec6SMatthias Ringwald break; 18583deb3ec6SMatthias Ringwald 18593deb3ec6SMatthias Ringwald case ATT_READ_BLOB_RESPONSE: { 18604ea43905SMatthias Ringwald uint16_t received_blob_length = size - 1u; 18615cf1669fSMatthias Ringwald switch (gatt_client->gatt_client_state) { 18623deb3ec6SMatthias Ringwald case P_W4_READ_BLOB_RESULT: 1863cf8e5718SMatthias Ringwald report_gatt_long_characteristic_value_blob(gatt_client, gatt_client->attribute_handle, &packet[1], 1864cf8e5718SMatthias Ringwald received_blob_length, gatt_client->attribute_offset); 18655cf1669fSMatthias Ringwald trigger_next_blob_query(gatt_client, P_W2_SEND_READ_BLOB_QUERY, received_blob_length); 18665611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 18673deb3ec6SMatthias Ringwald break; 18683deb3ec6SMatthias Ringwald case P_W4_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_RESULT: 18695cf1669fSMatthias Ringwald report_gatt_long_characteristic_descriptor(gatt_client, gatt_client->attribute_handle, 18703deb3ec6SMatthias Ringwald &packet[1], received_blob_length, 18715cf1669fSMatthias Ringwald gatt_client->attribute_offset); 1872cf8e5718SMatthias Ringwald trigger_next_blob_query(gatt_client, P_W2_SEND_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_QUERY, 1873cf8e5718SMatthias Ringwald received_blob_length); 18745611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 18753deb3ec6SMatthias Ringwald break; 18763deb3ec6SMatthias Ringwald default: 18773deb3ec6SMatthias Ringwald break; 18783deb3ec6SMatthias Ringwald } 18793deb3ec6SMatthias Ringwald break; 18803deb3ec6SMatthias Ringwald } 18813deb3ec6SMatthias Ringwald case ATT_PREPARE_WRITE_RESPONSE: 18825cf1669fSMatthias Ringwald switch (gatt_client->gatt_client_state) { 18833deb3ec6SMatthias Ringwald case P_W4_PREPARE_WRITE_SINGLE_RESULT: 18845cf1669fSMatthias Ringwald if (is_value_valid(gatt_client, packet, size)) { 18854740230fSMatthias Ringwald att_status = ATT_ERROR_SUCCESS; 18863deb3ec6SMatthias Ringwald } else { 18874740230fSMatthias Ringwald att_status = ATT_ERROR_DATA_MISMATCH; 18883deb3ec6SMatthias Ringwald } 1889526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, att_status); 18903deb3ec6SMatthias Ringwald break; 18913deb3ec6SMatthias Ringwald 18923deb3ec6SMatthias Ringwald case P_W4_PREPARE_WRITE_RESULT: { 18935cf1669fSMatthias Ringwald gatt_client->attribute_offset = little_endian_read_16(packet, 3); 18945cf1669fSMatthias Ringwald trigger_next_prepare_write_query(gatt_client, P_W2_PREPARE_WRITE, P_W2_EXECUTE_PREPARED_WRITE); 18955611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 18963deb3ec6SMatthias Ringwald break; 18973deb3ec6SMatthias Ringwald } 18983deb3ec6SMatthias Ringwald case P_W4_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT: { 18995cf1669fSMatthias Ringwald gatt_client->attribute_offset = little_endian_read_16(packet, 3); 1900cf8e5718SMatthias Ringwald trigger_next_prepare_write_query(gatt_client, P_W2_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR, 1901cf8e5718SMatthias Ringwald P_W2_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR); 19025611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 19033deb3ec6SMatthias Ringwald break; 19043deb3ec6SMatthias Ringwald } 19053deb3ec6SMatthias Ringwald case P_W4_PREPARE_RELIABLE_WRITE_RESULT: { 19065cf1669fSMatthias Ringwald if (is_value_valid(gatt_client, packet, size)) { 19075cf1669fSMatthias Ringwald gatt_client->attribute_offset = little_endian_read_16(packet, 3); 1908cf8e5718SMatthias Ringwald trigger_next_prepare_write_query(gatt_client, P_W2_PREPARE_RELIABLE_WRITE, 1909cf8e5718SMatthias Ringwald P_W2_EXECUTE_PREPARED_WRITE); 19105611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 19113deb3ec6SMatthias Ringwald break; 19123deb3ec6SMatthias Ringwald } 19135cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_CANCEL_PREPARED_WRITE_DATA_MISMATCH; 19143deb3ec6SMatthias Ringwald break; 19153deb3ec6SMatthias Ringwald } 19163deb3ec6SMatthias Ringwald default: 19173deb3ec6SMatthias Ringwald break; 19183deb3ec6SMatthias Ringwald } 19193deb3ec6SMatthias Ringwald break; 19203deb3ec6SMatthias Ringwald 19213deb3ec6SMatthias Ringwald case ATT_EXECUTE_WRITE_RESPONSE: 19225cf1669fSMatthias Ringwald switch (gatt_client->gatt_client_state) { 19233deb3ec6SMatthias Ringwald case P_W4_EXECUTE_PREPARED_WRITE_RESULT: 1924526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 19253deb3ec6SMatthias Ringwald break; 19263deb3ec6SMatthias Ringwald case P_W4_CANCEL_PREPARED_WRITE_RESULT: 1927526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 19283deb3ec6SMatthias Ringwald break; 19293deb3ec6SMatthias Ringwald case P_W4_CANCEL_PREPARED_WRITE_DATA_MISMATCH_RESULT: 1930526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_DATA_MISMATCH); 19313deb3ec6SMatthias Ringwald break; 19323deb3ec6SMatthias Ringwald case P_W4_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT: 1933526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 19343deb3ec6SMatthias Ringwald break; 19353deb3ec6SMatthias Ringwald default: 19363deb3ec6SMatthias Ringwald break; 19373deb3ec6SMatthias Ringwald 19383deb3ec6SMatthias Ringwald } 19393deb3ec6SMatthias Ringwald break; 19403deb3ec6SMatthias Ringwald 19413deb3ec6SMatthias Ringwald case ATT_READ_MULTIPLE_RESPONSE: 19425cf1669fSMatthias Ringwald switch (gatt_client->gatt_client_state) { 19433deb3ec6SMatthias Ringwald case P_W4_READ_MULTIPLE_RESPONSE: 19445cf1669fSMatthias Ringwald report_gatt_characteristic_value(gatt_client, 0u, &packet[1], size - 1u); 1945526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 19463deb3ec6SMatthias Ringwald break; 19473deb3ec6SMatthias Ringwald default: 19483deb3ec6SMatthias Ringwald break; 19493deb3ec6SMatthias Ringwald } 19503deb3ec6SMatthias Ringwald break; 19513deb3ec6SMatthias Ringwald 1952f125a8efSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 1953f125a8efSMatthias Ringwald case ATT_READ_MULTIPLE_VARIABLE_RSP: 1954f125a8efSMatthias Ringwald switch (gatt_client->gatt_client_state) { 1955169b9876SMatthias Ringwald case P_W4_READ_MULTIPLE_VARIABLE_RESPONSE: 1956f125a8efSMatthias Ringwald report_gatt_characteristic_value(gatt_client, 0u, &packet[1], size - 1u); 1957f125a8efSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 1958f125a8efSMatthias Ringwald break; 1959f125a8efSMatthias Ringwald default: 1960f125a8efSMatthias Ringwald break; 1961f125a8efSMatthias Ringwald } 1962f125a8efSMatthias Ringwald break; 1963f125a8efSMatthias Ringwald #endif 1964f125a8efSMatthias Ringwald 19653deb3ec6SMatthias Ringwald case ATT_ERROR_RESPONSE: 19664ea43905SMatthias Ringwald if (size < 5u) return; 19674740230fSMatthias Ringwald att_status = packet[4]; 19684740230fSMatthias Ringwald switch (att_status) { 19693deb3ec6SMatthias Ringwald case ATT_ERROR_ATTRIBUTE_NOT_FOUND: { 19705cf1669fSMatthias Ringwald switch (gatt_client->gatt_client_state) { 19713deb3ec6SMatthias Ringwald case P_W4_SERVICE_QUERY_RESULT: 19723deb3ec6SMatthias Ringwald case P_W4_SERVICE_WITH_UUID_RESULT: 19733deb3ec6SMatthias Ringwald case P_W4_INCLUDED_SERVICE_QUERY_RESULT: 19743deb3ec6SMatthias Ringwald case P_W4_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY_RESULT: 1975526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 19763deb3ec6SMatthias Ringwald break; 19773deb3ec6SMatthias Ringwald case P_W4_ALL_CHARACTERISTICS_OF_SERVICE_QUERY_RESULT: 19783deb3ec6SMatthias Ringwald case P_W4_CHARACTERISTIC_WITH_UUID_QUERY_RESULT: 197923d583b8SMatthias Ringwald report_gatt_characteristic_end_found(gatt_client, gatt_client->end_group_handle); 1980526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 19813deb3ec6SMatthias Ringwald break; 19823deb3ec6SMatthias Ringwald case P_W4_READ_BY_TYPE_RESPONSE: 19835cf1669fSMatthias Ringwald if (gatt_client->start_group_handle == gatt_client->query_start_handle) { 19844740230fSMatthias Ringwald att_status = ATT_ERROR_ATTRIBUTE_NOT_FOUND; 19853deb3ec6SMatthias Ringwald } else { 19864740230fSMatthias Ringwald att_status = ATT_ERROR_SUCCESS; 19873deb3ec6SMatthias Ringwald } 1988526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, att_status); 19893deb3ec6SMatthias Ringwald break; 19903deb3ec6SMatthias Ringwald default: 19914740230fSMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, att_status); 19923deb3ec6SMatthias Ringwald break; 19933deb3ec6SMatthias Ringwald } 19943deb3ec6SMatthias Ringwald break; 19953deb3ec6SMatthias Ringwald } 1996f4b33574SMatthias Ringwald 1997f4b33574SMatthias Ringwald #ifdef ENABLE_GATT_CLIENT_PAIRING 1998f4b33574SMatthias Ringwald 1999f4b33574SMatthias Ringwald case ATT_ERROR_INSUFFICIENT_AUTHENTICATION: 2000f4b33574SMatthias Ringwald case ATT_ERROR_INSUFFICIENT_ENCRYPTION_KEY_SIZE: 2001a0e0c2beSMatthias Ringwald case ATT_ERROR_INSUFFICIENT_ENCRYPTION: { 2002a0e0c2beSMatthias Ringwald 2003f4b33574SMatthias Ringwald // security too low 20045cf1669fSMatthias Ringwald if (gatt_client->security_counter > 0) { 20054740230fSMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, att_status); 2006f4b33574SMatthias Ringwald break; 2007f4b33574SMatthias Ringwald } 2008f4b33574SMatthias Ringwald // start security 20095cf1669fSMatthias Ringwald gatt_client->security_counter++; 2010f4b33574SMatthias Ringwald 2011f4b33574SMatthias Ringwald // setup action 2012f4b33574SMatthias Ringwald int retry = 1; 20135cf1669fSMatthias Ringwald switch (gatt_client->gatt_client_state){ 2014f4b33574SMatthias Ringwald case P_W4_READ_CHARACTERISTIC_VALUE_RESULT: 20155cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_CHARACTERISTIC_VALUE_QUERY ; 2016f4b33574SMatthias Ringwald break; 2017f4b33574SMatthias Ringwald case P_W4_READ_BLOB_RESULT: 20185cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_BLOB_QUERY; 2019f4b33574SMatthias Ringwald break; 2020f4b33574SMatthias Ringwald case P_W4_READ_BY_TYPE_RESPONSE: 20215cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_BY_TYPE_REQUEST; 2022f4b33574SMatthias Ringwald break; 2023f4b33574SMatthias Ringwald case P_W4_READ_MULTIPLE_RESPONSE: 20245cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_MULTIPLE_REQUEST; 2025f4b33574SMatthias Ringwald break; 2026f125a8efSMatthias Ringwald case P_W4_READ_MULTIPLE_VARIABLE_RESPONSE: 2027f125a8efSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_MULTIPLE_VARIABLE_REQUEST; 2028f125a8efSMatthias Ringwald break; 2029f4b33574SMatthias Ringwald case P_W4_WRITE_CHARACTERISTIC_VALUE_RESULT: 20305cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_WRITE_CHARACTERISTIC_VALUE; 2031f4b33574SMatthias Ringwald break; 2032f4b33574SMatthias Ringwald case P_W4_PREPARE_WRITE_RESULT: 20335cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_PREPARE_WRITE; 2034f4b33574SMatthias Ringwald break; 2035f4b33574SMatthias Ringwald case P_W4_PREPARE_WRITE_SINGLE_RESULT: 20365cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_PREPARE_WRITE_SINGLE; 2037f4b33574SMatthias Ringwald break; 2038f4b33574SMatthias Ringwald case P_W4_PREPARE_RELIABLE_WRITE_RESULT: 20395cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_PREPARE_RELIABLE_WRITE; 2040f4b33574SMatthias Ringwald break; 2041f4b33574SMatthias Ringwald case P_W4_EXECUTE_PREPARED_WRITE_RESULT: 20425cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_EXECUTE_PREPARED_WRITE; 2043f4b33574SMatthias Ringwald break; 2044f4b33574SMatthias Ringwald case P_W4_CANCEL_PREPARED_WRITE_RESULT: 20455cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_CANCEL_PREPARED_WRITE; 2046f4b33574SMatthias Ringwald break; 2047f4b33574SMatthias Ringwald case P_W4_CANCEL_PREPARED_WRITE_DATA_MISMATCH_RESULT: 20485cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_CANCEL_PREPARED_WRITE_DATA_MISMATCH; 2049f4b33574SMatthias Ringwald break; 2050f4b33574SMatthias Ringwald case P_W4_READ_CHARACTERISTIC_DESCRIPTOR_RESULT: 20515cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_CHARACTERISTIC_DESCRIPTOR_QUERY; 2052f4b33574SMatthias Ringwald break; 2053f4b33574SMatthias Ringwald case P_W4_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_RESULT: 20545cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_QUERY; 2055f4b33574SMatthias Ringwald break; 2056f4b33574SMatthias Ringwald case P_W4_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT: 20575cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_WRITE_CHARACTERISTIC_DESCRIPTOR; 2058f4b33574SMatthias Ringwald break; 2059f4b33574SMatthias Ringwald case P_W4_CLIENT_CHARACTERISTIC_CONFIGURATION_RESULT: 20605cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_WRITE_CLIENT_CHARACTERISTIC_CONFIGURATION; 2061f4b33574SMatthias Ringwald break; 2062f4b33574SMatthias Ringwald case P_W4_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT: 20635cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR; 2064f4b33574SMatthias Ringwald break; 2065f4b33574SMatthias Ringwald case P_W4_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT: 20665cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR; 2067f4b33574SMatthias Ringwald break; 2068f4b33574SMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 2069f4b33574SMatthias Ringwald case P_W4_SEND_SINGED_WRITE_DONE: 20705cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_SIGNED_WRITE; 2071f4b33574SMatthias Ringwald break; 2072f4b33574SMatthias Ringwald #endif 2073f4b33574SMatthias Ringwald default: 20745cf1669fSMatthias Ringwald log_info("retry not supported for state %x", gatt_client->gatt_client_state); 2075f4b33574SMatthias Ringwald retry = 0; 2076f4b33574SMatthias Ringwald break; 2077f4b33574SMatthias Ringwald } 2078f4b33574SMatthias Ringwald 2079f4b33574SMatthias Ringwald if (!retry) { 20804740230fSMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, att_status); 2081f4b33574SMatthias Ringwald break; 2082f4b33574SMatthias Ringwald } 2083f4b33574SMatthias Ringwald 2084f4b33574SMatthias Ringwald log_info("security error, start pairing"); 2085f4b33574SMatthias Ringwald 2086f060f108SMatthias Ringwald // start pairing for higher security level 20873503dc74SMatthias Ringwald gatt_client->wait_for_authentication_complete = 1; 20884740230fSMatthias Ringwald gatt_client->pending_error_code = att_status; 20895cf1669fSMatthias Ringwald sm_request_pairing(gatt_client->con_handle); 2090f4b33574SMatthias Ringwald break; 2091a0e0c2beSMatthias Ringwald } 2092f4b33574SMatthias Ringwald #endif 2093f4b33574SMatthias Ringwald 2094f4b33574SMatthias Ringwald // nothing we can do about that 2095f4b33574SMatthias Ringwald case ATT_ERROR_INSUFFICIENT_AUTHORIZATION: 20963deb3ec6SMatthias Ringwald default: 20974740230fSMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, att_status); 20983deb3ec6SMatthias Ringwald break; 20993deb3ec6SMatthias Ringwald } 21003deb3ec6SMatthias Ringwald break; 21013deb3ec6SMatthias Ringwald 21023deb3ec6SMatthias Ringwald default: 21033deb3ec6SMatthias Ringwald log_info("ATT Handler, unhandled response type 0x%02x", packet[0]); 21043deb3ec6SMatthias Ringwald break; 21053deb3ec6SMatthias Ringwald } 2106cf8e5718SMatthias Ringwald } 2107cf8e5718SMatthias Ringwald 2108cf8e5718SMatthias Ringwald static void gatt_client_att_packet_handler(uint8_t packet_type, uint16_t handle, uint8_t *packet, uint16_t size) { 2109cf8e5718SMatthias Ringwald gatt_client_t *gatt_client; 2110*59b5e157SMatthias Ringwald hci_connection_t * hci_connection; 2111*59b5e157SMatthias Ringwald uint8_t status; 2112cf8e5718SMatthias Ringwald if (size < 1u) return; 2113*59b5e157SMatthias Ringwald switch (packet_type){ 2114*59b5e157SMatthias Ringwald case HCI_EVENT_PACKET: 2115*59b5e157SMatthias Ringwald switch (hci_event_packet_get_type(packet)) { 2116*59b5e157SMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC 2117*59b5e157SMatthias Ringwald case L2CAP_EVENT_CHANNEL_OPENED: 2118*59b5e157SMatthias Ringwald status = l2cap_event_channel_opened_get_status(packet); 2119*59b5e157SMatthias Ringwald gatt_client = gatt_client_get_context_for_l2cap_cid(l2cap_event_channel_opened_get_local_cid(packet)); 2120*59b5e157SMatthias Ringwald btstack_assert(gatt_client != NULL); 2121*59b5e157SMatthias Ringwald // if status != 0, gatt_client will be discarded 2122*59b5e157SMatthias Ringwald gatt_client->gatt_client_state = P_READY; 2123*59b5e157SMatthias Ringwald gatt_client->con_handle = l2cap_event_channel_opened_get_handle(packet); 2124*59b5e157SMatthias Ringwald gatt_client->mtu = l2cap_event_channel_opened_get_remote_mtu(packet); 2125*59b5e157SMatthias Ringwald gatt_client_classic_handle_connected(gatt_client, status); 2126*59b5e157SMatthias Ringwald break; 2127*59b5e157SMatthias Ringwald case L2CAP_EVENT_CHANNEL_CLOSED: 2128*59b5e157SMatthias Ringwald gatt_client = gatt_client_get_context_for_l2cap_cid(l2cap_event_channel_closed_get_local_cid(packet)); 2129*59b5e157SMatthias Ringwald // clear l2cap cid in hci_connection->att_server 2130*59b5e157SMatthias Ringwald hci_connection = hci_connection_for_handle(gatt_client->con_handle); 2131*59b5e157SMatthias Ringwald hci_connection->att_server.l2cap_cid = 0; 2132*59b5e157SMatthias Ringwald // discard gatt client object 2133*59b5e157SMatthias Ringwald gatt_client_classic_handle_disconnected(gatt_client); 2134*59b5e157SMatthias Ringwald break; 2135*59b5e157SMatthias Ringwald #endif 2136cf8e5718SMatthias Ringwald case L2CAP_EVENT_CAN_SEND_NOW: 21373deb3ec6SMatthias Ringwald gatt_client_run(); 2138cf8e5718SMatthias Ringwald break; 2139cf8e5718SMatthias Ringwald // att_server has negotiated the mtu for this connection, cache if context exists 2140cf8e5718SMatthias Ringwald case ATT_EVENT_MTU_EXCHANGE_COMPLETE: 2141cf8e5718SMatthias Ringwald if (size < 6u) break; 2142cf8e5718SMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(handle); 2143cf8e5718SMatthias Ringwald if (gatt_client == NULL) break; 2144cf8e5718SMatthias Ringwald gatt_client->mtu = little_endian_read_16(packet, 4); 2145cf8e5718SMatthias Ringwald break; 2146cf8e5718SMatthias Ringwald default: 2147cf8e5718SMatthias Ringwald break; 2148cf8e5718SMatthias Ringwald } 2149*59b5e157SMatthias Ringwald break; 2150cf8e5718SMatthias Ringwald 2151*59b5e157SMatthias Ringwald case ATT_DATA_PACKET: 2152cf8e5718SMatthias Ringwald // special cases: notifications & indications motivate creating context 2153cf8e5718SMatthias Ringwald switch (packet[0]) { 2154cf8e5718SMatthias Ringwald case ATT_HANDLE_VALUE_NOTIFICATION: 2155cf8e5718SMatthias Ringwald case ATT_HANDLE_VALUE_INDICATION: 2156cf8e5718SMatthias Ringwald gatt_client_provide_context_for_handle(handle, &gatt_client); 2157cf8e5718SMatthias Ringwald break; 2158cf8e5718SMatthias Ringwald default: 2159cf8e5718SMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(handle); 2160cf8e5718SMatthias Ringwald break; 2161cf8e5718SMatthias Ringwald } 2162cf8e5718SMatthias Ringwald 2163cf8e5718SMatthias Ringwald if (gatt_client != NULL) { 2164cf8e5718SMatthias Ringwald gatt_client_handle_att_response(gatt_client, packet, size); 2165cf8e5718SMatthias Ringwald gatt_client_run(); 2166cf8e5718SMatthias Ringwald } 2167*59b5e157SMatthias Ringwald break; 2168*59b5e157SMatthias Ringwald 2169*59b5e157SMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC 2170*59b5e157SMatthias Ringwald case L2CAP_DATA_PACKET: 2171*59b5e157SMatthias Ringwald gatt_client = gatt_client_get_context_for_l2cap_cid(handle); 2172*59b5e157SMatthias Ringwald btstack_assert(gatt_client != NULL); 2173*59b5e157SMatthias Ringwald gatt_client_handle_att_response(gatt_client, packet, size); 2174*59b5e157SMatthias Ringwald gatt_client_run(); 2175*59b5e157SMatthias Ringwald break; 2176*59b5e157SMatthias Ringwald #endif 2177*59b5e157SMatthias Ringwald 2178*59b5e157SMatthias Ringwald default: 2179*59b5e157SMatthias Ringwald break; 2180*59b5e157SMatthias Ringwald } 21813deb3ec6SMatthias Ringwald } 21823deb3ec6SMatthias Ringwald 21837a766ebfSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 21843deb3ec6SMatthias Ringwald static void att_signed_write_handle_cmac_result(uint8_t hash[8]){ 2185665d90f2SMatthias Ringwald btstack_linked_list_iterator_t it; 2186665d90f2SMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client_connections); 2187665d90f2SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 21885cf1669fSMatthias Ringwald gatt_client_t * gatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it); 21895cf1669fSMatthias Ringwald if (gatt_client->gatt_client_state == P_W4_CMAC_RESULT){ 21903deb3ec6SMatthias Ringwald // store result 21915cf1669fSMatthias Ringwald (void)memcpy(gatt_client->cmac, hash, 8); 21925cf1669fSMatthias Ringwald // reverse_64(hash, gatt_client->cmac); 21935cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_SIGNED_WRITE; 21943deb3ec6SMatthias Ringwald gatt_client_run(); 21953deb3ec6SMatthias Ringwald return; 21963deb3ec6SMatthias Ringwald } 21973deb3ec6SMatthias Ringwald } 21983deb3ec6SMatthias Ringwald } 21993deb3ec6SMatthias Ringwald 2200b45b7749SMilanka 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){ 220140faeb84SMilanka Ringwald gatt_client_t * gatt_client; 220240faeb84SMilanka Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 220340faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 220440faeb84SMilanka Ringwald return status; 220540faeb84SMilanka Ringwald } 220640faeb84SMilanka Ringwald if (is_ready(gatt_client) == 0){ 220740faeb84SMilanka Ringwald return GATT_CLIENT_IN_WRONG_STATE; 220840faeb84SMilanka Ringwald } 22093deb3ec6SMatthias Ringwald 22105cf1669fSMatthias Ringwald gatt_client->callback = callback; 2211b45b7749SMilanka Ringwald gatt_client->attribute_handle = value_handle; 22125cf1669fSMatthias Ringwald gatt_client->attribute_length = message_len; 22135cf1669fSMatthias Ringwald gatt_client->attribute_value = message; 22145cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_IDENTITY_RESOLVING; 22153deb3ec6SMatthias Ringwald gatt_client_run(); 221625b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 22173deb3ec6SMatthias Ringwald } 22187a766ebfSMatthias Ringwald #endif 22193deb3ec6SMatthias Ringwald 2220711e6c80SMatthias Ringwald uint8_t gatt_client_discover_primary_services(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 222140faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2222de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 222340faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 222440faeb84SMilanka Ringwald return status; 222540faeb84SMilanka Ringwald } 22263deb3ec6SMatthias Ringwald 22275cf1669fSMatthias Ringwald gatt_client->callback = callback; 22285cf1669fSMatthias Ringwald gatt_client->start_group_handle = 0x0001; 22295cf1669fSMatthias Ringwald gatt_client->end_group_handle = 0xffff; 22305cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_SERVICE_QUERY; 22318d1f34d3SMatheus Eduardo Garbelini gatt_client->uuid16 = GATT_PRIMARY_SERVICE_UUID; 22323deb3ec6SMatthias Ringwald gatt_client_run(); 223325b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 22343deb3ec6SMatthias Ringwald } 22353deb3ec6SMatthias Ringwald 22368d1f34d3SMatheus Eduardo Garbelini uint8_t gatt_client_discover_secondary_services(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 223740faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2238de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 223940faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 224040faeb84SMilanka Ringwald return status; 224140faeb84SMilanka Ringwald } 22428d1f34d3SMatheus Eduardo Garbelini 22438d1f34d3SMatheus Eduardo Garbelini gatt_client->callback = callback; 22448d1f34d3SMatheus Eduardo Garbelini gatt_client->start_group_handle = 0x0001; 22458d1f34d3SMatheus Eduardo Garbelini gatt_client->end_group_handle = 0xffff; 22468d1f34d3SMatheus Eduardo Garbelini gatt_client->gatt_client_state = P_W2_SEND_SERVICE_QUERY; 22478d1f34d3SMatheus Eduardo Garbelini gatt_client->uuid16 = GATT_SECONDARY_SERVICE_UUID; 22488d1f34d3SMatheus Eduardo Garbelini gatt_client_run(); 22498d1f34d3SMatheus Eduardo Garbelini return ERROR_CODE_SUCCESS; 22508d1f34d3SMatheus Eduardo Garbelini } 22513deb3ec6SMatthias Ringwald 2252711e6c80SMatthias Ringwald uint8_t gatt_client_discover_primary_services_by_uuid16(btstack_packet_handler_t callback, hci_con_handle_t con_handle, uint16_t uuid16){ 225340faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2254de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 225540faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 225640faeb84SMilanka Ringwald return status; 225740faeb84SMilanka Ringwald } 22583deb3ec6SMatthias Ringwald 22595cf1669fSMatthias Ringwald gatt_client->callback = callback; 22605cf1669fSMatthias Ringwald gatt_client->start_group_handle = 0x0001; 22615cf1669fSMatthias Ringwald gatt_client->end_group_handle = 0xffff; 22625cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_SERVICE_WITH_UUID_QUERY; 22635cf1669fSMatthias Ringwald gatt_client->uuid16 = uuid16; 22645cf1669fSMatthias Ringwald uuid_add_bluetooth_prefix((uint8_t*) &(gatt_client->uuid128), gatt_client->uuid16); 22653deb3ec6SMatthias Ringwald gatt_client_run(); 226625b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 22673deb3ec6SMatthias Ringwald } 22683deb3ec6SMatthias Ringwald 2269711e6c80SMatthias 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){ 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 } 22753deb3ec6SMatthias Ringwald 22765cf1669fSMatthias Ringwald gatt_client->callback = callback; 22775cf1669fSMatthias Ringwald gatt_client->start_group_handle = 0x0001; 22785cf1669fSMatthias Ringwald gatt_client->end_group_handle = 0xffff; 22795cf1669fSMatthias Ringwald gatt_client->uuid16 = 0; 22805cf1669fSMatthias Ringwald (void)memcpy(gatt_client->uuid128, uuid128, 16); 22815cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_SERVICE_WITH_UUID_QUERY; 22823deb3ec6SMatthias Ringwald gatt_client_run(); 228325b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 22843deb3ec6SMatthias Ringwald } 22853deb3ec6SMatthias Ringwald 2286711e6c80SMatthias 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){ 228740faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2288de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 228940faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 229040faeb84SMilanka Ringwald return status; 229140faeb84SMilanka Ringwald } 22923deb3ec6SMatthias Ringwald 22935cf1669fSMatthias Ringwald gatt_client->callback = callback; 22945cf1669fSMatthias Ringwald gatt_client->start_group_handle = service->start_group_handle; 22955cf1669fSMatthias Ringwald gatt_client->end_group_handle = service->end_group_handle; 22965cf1669fSMatthias Ringwald gatt_client->filter_with_uuid = 0; 22975cf1669fSMatthias Ringwald gatt_client->characteristic_start_handle = 0; 22985cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_ALL_CHARACTERISTICS_OF_SERVICE_QUERY; 22993deb3ec6SMatthias Ringwald gatt_client_run(); 230025b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 23013deb3ec6SMatthias Ringwald } 23023deb3ec6SMatthias Ringwald 2303711e6c80SMatthias 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){ 230440faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2305de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 230640faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 230740faeb84SMilanka Ringwald return status; 230840faeb84SMilanka Ringwald } 2309de27733dSMatthias Ringwald 23105cf1669fSMatthias Ringwald gatt_client->callback = callback; 23115cf1669fSMatthias Ringwald gatt_client->start_group_handle = service->start_group_handle; 23125cf1669fSMatthias Ringwald gatt_client->end_group_handle = service->end_group_handle; 23135cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_INCLUDED_SERVICE_QUERY; 23143deb3ec6SMatthias Ringwald 23153deb3ec6SMatthias Ringwald gatt_client_run(); 231625b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 23173deb3ec6SMatthias Ringwald } 23183deb3ec6SMatthias Ringwald 2319711e6c80SMatthias 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){ 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 = start_handle; 23285cf1669fSMatthias Ringwald gatt_client->end_group_handle = end_handle; 23295cf1669fSMatthias Ringwald gatt_client->filter_with_uuid = 1; 23305cf1669fSMatthias Ringwald gatt_client->uuid16 = uuid16; 23315cf1669fSMatthias Ringwald uuid_add_bluetooth_prefix((uint8_t*) &(gatt_client->uuid128), uuid16); 23325cf1669fSMatthias Ringwald gatt_client->characteristic_start_handle = 0; 23335cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_CHARACTERISTIC_WITH_UUID_QUERY; 23343deb3ec6SMatthias Ringwald gatt_client_run(); 233525b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 23363deb3ec6SMatthias Ringwald } 23373deb3ec6SMatthias Ringwald 2338045d700dSDavid 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){ 233940faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2340de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 234140faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 234240faeb84SMilanka Ringwald return status; 234340faeb84SMilanka Ringwald } 23443deb3ec6SMatthias Ringwald 23455cf1669fSMatthias Ringwald gatt_client->callback = callback; 23465cf1669fSMatthias Ringwald gatt_client->start_group_handle = start_handle; 23475cf1669fSMatthias Ringwald gatt_client->end_group_handle = end_handle; 23485cf1669fSMatthias Ringwald gatt_client->filter_with_uuid = 1; 23495cf1669fSMatthias Ringwald gatt_client->uuid16 = 0; 23505cf1669fSMatthias Ringwald (void)memcpy(gatt_client->uuid128, uuid128, 16); 23515cf1669fSMatthias Ringwald gatt_client->characteristic_start_handle = 0; 23525cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_CHARACTERISTIC_WITH_UUID_QUERY; 23533deb3ec6SMatthias Ringwald gatt_client_run(); 235425b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 23553deb3ec6SMatthias Ringwald } 23563deb3ec6SMatthias Ringwald 23573deb3ec6SMatthias Ringwald 2358b45b7749SMilanka 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){ 2359b45b7749SMilanka Ringwald return gatt_client_discover_characteristics_for_handle_range_by_uuid16(callback, con_handle, service->start_group_handle, service->end_group_handle, uuid16); 23603deb3ec6SMatthias Ringwald } 23613deb3ec6SMatthias Ringwald 2362b45b7749SMilanka 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){ 2363b45b7749SMilanka Ringwald return gatt_client_discover_characteristics_for_handle_range_by_uuid128(callback, con_handle, service->start_group_handle, service->end_group_handle, uuid128); 23643deb3ec6SMatthias Ringwald } 23653deb3ec6SMatthias Ringwald 2366711e6c80SMatthias Ringwald uint8_t gatt_client_discover_characteristic_descriptors(btstack_packet_handler_t callback, hci_con_handle_t con_handle, gatt_client_characteristic_t * characteristic){ 236740faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2368de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 236940faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 237040faeb84SMilanka Ringwald return status; 237140faeb84SMilanka Ringwald } 23723deb3ec6SMatthias Ringwald 23733deb3ec6SMatthias Ringwald if (characteristic->value_handle == characteristic->end_handle){ 237425b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 23753deb3ec6SMatthias Ringwald } 23765cf1669fSMatthias Ringwald gatt_client->callback = callback; 23775cf1669fSMatthias Ringwald gatt_client->start_group_handle = characteristic->value_handle + 1u; 23785cf1669fSMatthias Ringwald gatt_client->end_group_handle = characteristic->end_handle; 23795cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY; 23803deb3ec6SMatthias Ringwald gatt_client_run(); 238125b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 23823deb3ec6SMatthias Ringwald } 23833deb3ec6SMatthias Ringwald 2384711e6c80SMatthias 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){ 238540faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2386de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 238740faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 238840faeb84SMilanka Ringwald return status; 238940faeb84SMilanka Ringwald } 23903deb3ec6SMatthias Ringwald 23915cf1669fSMatthias Ringwald gatt_client->callback = callback; 23925cf1669fSMatthias Ringwald gatt_client->attribute_handle = value_handle; 23935cf1669fSMatthias Ringwald gatt_client->attribute_offset = 0; 23945cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_CHARACTERISTIC_VALUE_QUERY; 23953deb3ec6SMatthias Ringwald gatt_client_run(); 239625b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 23973deb3ec6SMatthias Ringwald } 23983deb3ec6SMatthias Ringwald 2399711e6c80SMatthias 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){ 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 24065cf1669fSMatthias Ringwald gatt_client->callback = callback; 24075cf1669fSMatthias Ringwald gatt_client->start_group_handle = start_handle; 24085cf1669fSMatthias Ringwald gatt_client->end_group_handle = end_handle; 24095cf1669fSMatthias Ringwald gatt_client->query_start_handle = start_handle; 24105cf1669fSMatthias Ringwald gatt_client->query_end_handle = end_handle; 24115cf1669fSMatthias Ringwald gatt_client->uuid16 = uuid16; 24125cf1669fSMatthias Ringwald uuid_add_bluetooth_prefix((uint8_t*) &(gatt_client->uuid128), uuid16); 24135cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_BY_TYPE_REQUEST; 24143deb3ec6SMatthias Ringwald gatt_client_run(); 241525b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 24163deb3ec6SMatthias Ringwald } 24173deb3ec6SMatthias Ringwald 2418045d700dSDavid 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){ 241940faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2420de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 242140faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 242240faeb84SMilanka Ringwald return status; 242340faeb84SMilanka Ringwald } 24243deb3ec6SMatthias Ringwald 24255cf1669fSMatthias Ringwald gatt_client->callback = callback; 24265cf1669fSMatthias Ringwald gatt_client->start_group_handle = start_handle; 24275cf1669fSMatthias Ringwald gatt_client->end_group_handle = end_handle; 24285cf1669fSMatthias Ringwald gatt_client->query_start_handle = start_handle; 24295cf1669fSMatthias Ringwald gatt_client->query_end_handle = end_handle; 24305cf1669fSMatthias Ringwald gatt_client->uuid16 = 0; 24315cf1669fSMatthias Ringwald (void)memcpy(gatt_client->uuid128, uuid128, 16); 24325cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_BY_TYPE_REQUEST; 24333deb3ec6SMatthias Ringwald gatt_client_run(); 243425b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 24353deb3ec6SMatthias Ringwald } 24363deb3ec6SMatthias Ringwald 24373deb3ec6SMatthias Ringwald 2438b45b7749SMilanka 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){ 2439b45b7749SMilanka Ringwald return gatt_client_read_value_of_characteristic_using_value_handle(callback, con_handle, characteristic->value_handle); 24403deb3ec6SMatthias Ringwald } 24413deb3ec6SMatthias Ringwald 2442b45b7749SMilanka 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){ 244340faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2444de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 244540faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 244640faeb84SMilanka Ringwald return status; 244740faeb84SMilanka Ringwald } 24483deb3ec6SMatthias Ringwald 24495cf1669fSMatthias Ringwald gatt_client->callback = callback; 2450b45b7749SMilanka Ringwald gatt_client->attribute_handle = value_handle; 24515cf1669fSMatthias Ringwald gatt_client->attribute_offset = offset; 24525cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_BLOB_QUERY; 24533deb3ec6SMatthias Ringwald gatt_client_run(); 245425b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 24553deb3ec6SMatthias Ringwald } 24563deb3ec6SMatthias Ringwald 2457b45b7749SMilanka 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){ 2458b45b7749SMilanka Ringwald return gatt_client_read_long_value_of_characteristic_using_value_handle_with_offset(callback, con_handle, value_handle, 0); 24593deb3ec6SMatthias Ringwald } 24603deb3ec6SMatthias Ringwald 2461b45b7749SMilanka 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){ 2462b45b7749SMilanka Ringwald return gatt_client_read_long_value_of_characteristic_using_value_handle(callback, con_handle, characteristic->value_handle); 24633deb3ec6SMatthias Ringwald } 24643deb3ec6SMatthias Ringwald 2465f125a8efSMatthias 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){ 246640faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2467de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 246840faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 246940faeb84SMilanka Ringwald return status; 247040faeb84SMilanka Ringwald } 24713deb3ec6SMatthias Ringwald 2472f125a8efSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 2473f125a8efSMatthias Ringwald if (state == P_W2_SEND_READ_MULTIPLE_VARIABLE_REQUEST){ 2474f125a8efSMatthias Ringwald if (gatt_client->bearer_type != ATT_BEARER_ENHANCED_LE){ 2475f125a8efSMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 2476f125a8efSMatthias Ringwald } 2477f125a8efSMatthias Ringwald } 2478f125a8efSMatthias Ringwald #endif 2479f125a8efSMatthias Ringwald 24805cf1669fSMatthias Ringwald gatt_client->callback = callback; 24815cf1669fSMatthias Ringwald gatt_client->read_multiple_handle_count = num_value_handles; 24825cf1669fSMatthias Ringwald gatt_client->read_multiple_handles = value_handles; 2483f125a8efSMatthias Ringwald gatt_client->gatt_client_state = state; 24843deb3ec6SMatthias Ringwald gatt_client_run(); 248525b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 24863deb3ec6SMatthias Ringwald } 24873deb3ec6SMatthias Ringwald 2488f125a8efSMatthias 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){ 2489f125a8efSMatthias Ringwald return gatt_client_read_multiple_characteristic_values_with_state(callback, con_handle, num_value_handles, value_handles, P_W2_SEND_READ_MULTIPLE_REQUEST); 2490f125a8efSMatthias Ringwald } 2491f125a8efSMatthias Ringwald 2492f125a8efSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 2493f125a8efSMatthias 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){ 2494f125a8efSMatthias 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); 2495f125a8efSMatthias Ringwald } 2496f125a8efSMatthias Ringwald #endif 2497f125a8efSMatthias Ringwald 2498de9f8e94SMatthias 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){ 249940faeb84SMilanka Ringwald gatt_client_t * gatt_client; 250040faeb84SMilanka Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 250140faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 250240faeb84SMilanka Ringwald return status; 250340faeb84SMilanka Ringwald } 25043deb3ec6SMatthias Ringwald 2505dda77937SMatthias Ringwald if (value_length > (gatt_client->mtu - 3u)) return GATT_CLIENT_VALUE_TOO_LONG; 25065cf1669fSMatthias Ringwald if (!att_dispatch_client_can_send_now(gatt_client->con_handle)) return GATT_CLIENT_BUSY; 25073deb3ec6SMatthias Ringwald 25086e7b444cSMatthias Ringwald return att_write_request(gatt_client, ATT_WRITE_COMMAND, value_handle, value_length, value); 25093deb3ec6SMatthias Ringwald } 25103deb3ec6SMatthias Ringwald 2511b45b7749SMilanka 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){ 251240faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2513de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 251440faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 251540faeb84SMilanka Ringwald return status; 251640faeb84SMilanka Ringwald } 25173deb3ec6SMatthias Ringwald 25185cf1669fSMatthias Ringwald gatt_client->callback = callback; 25195cf1669fSMatthias Ringwald gatt_client->attribute_handle = value_handle; 25205cf1669fSMatthias Ringwald gatt_client->attribute_length = value_length; 2521b45b7749SMilanka Ringwald gatt_client->attribute_value = value; 25225cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_WRITE_CHARACTERISTIC_VALUE; 25233deb3ec6SMatthias Ringwald gatt_client_run(); 252425b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 25253deb3ec6SMatthias Ringwald } 25263deb3ec6SMatthias Ringwald 2527b45b7749SMilanka 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){ 252840faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2529de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 253040faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 253140faeb84SMilanka Ringwald return status; 253240faeb84SMilanka Ringwald } 25333deb3ec6SMatthias Ringwald 25345cf1669fSMatthias Ringwald gatt_client->callback = callback; 25355cf1669fSMatthias Ringwald gatt_client->attribute_handle = value_handle; 25365cf1669fSMatthias Ringwald gatt_client->attribute_length = value_length; 25375cf1669fSMatthias Ringwald gatt_client->attribute_offset = offset; 2538b45b7749SMilanka Ringwald gatt_client->attribute_value = value; 25395cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_PREPARE_WRITE; 25403deb3ec6SMatthias Ringwald gatt_client_run(); 254125b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 25423deb3ec6SMatthias Ringwald } 25433deb3ec6SMatthias Ringwald 2544711e6c80SMatthias 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){ 25459c662c9bSMatthias Ringwald return gatt_client_write_long_value_of_characteristic_with_offset(callback, con_handle, value_handle, 0, value_length, value); 25463deb3ec6SMatthias Ringwald } 25473deb3ec6SMatthias Ringwald 2548711e6c80SMatthias 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){ 254940faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2550de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 255140faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 255240faeb84SMilanka Ringwald return status; 255340faeb84SMilanka Ringwald } 25543deb3ec6SMatthias Ringwald 25555cf1669fSMatthias Ringwald gatt_client->callback = callback; 25565cf1669fSMatthias Ringwald gatt_client->attribute_handle = value_handle; 25575cf1669fSMatthias Ringwald gatt_client->attribute_length = value_length; 25585cf1669fSMatthias Ringwald gatt_client->attribute_offset = 0; 25595cf1669fSMatthias Ringwald gatt_client->attribute_value = value; 25605cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_PREPARE_RELIABLE_WRITE; 25613deb3ec6SMatthias Ringwald gatt_client_run(); 256225b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 25633deb3ec6SMatthias Ringwald } 25643deb3ec6SMatthias Ringwald 2565711e6c80SMatthias 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){ 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 25723deb3ec6SMatthias Ringwald if ( (configuration & GATT_CLIENT_CHARACTERISTICS_CONFIGURATION_NOTIFICATION) && 25734ea43905SMatthias Ringwald ((characteristic->properties & ATT_PROPERTY_NOTIFY) == 0u)) { 2574d8e8f12aSMatthias Ringwald log_info("gatt_client_write_client_characteristic_configuration: GATT_CLIENT_CHARACTERISTIC_NOTIFICATION_NOT_SUPPORTED"); 2575616edd56SMatthias Ringwald return GATT_CLIENT_CHARACTERISTIC_NOTIFICATION_NOT_SUPPORTED; 25763deb3ec6SMatthias Ringwald } else if ( (configuration & GATT_CLIENT_CHARACTERISTICS_CONFIGURATION_INDICATION) && 25774ea43905SMatthias Ringwald ((characteristic->properties & ATT_PROPERTY_INDICATE) == 0u)){ 2578d8e8f12aSMatthias Ringwald log_info("gatt_client_write_client_characteristic_configuration: GATT_CLIENT_CHARACTERISTIC_INDICATION_NOT_SUPPORTED"); 2579616edd56SMatthias Ringwald return GATT_CLIENT_CHARACTERISTIC_INDICATION_NOT_SUPPORTED; 25803deb3ec6SMatthias Ringwald } 25813deb3ec6SMatthias Ringwald 25825cf1669fSMatthias Ringwald gatt_client->callback = callback; 25835cf1669fSMatthias Ringwald gatt_client->start_group_handle = characteristic->value_handle; 25845cf1669fSMatthias Ringwald gatt_client->end_group_handle = characteristic->end_handle; 25855cf1669fSMatthias Ringwald little_endian_store_16(gatt_client->client_characteristic_configuration_value, 0, configuration); 25863deb3ec6SMatthias Ringwald 2587abdc9fb5SMatthias Ringwald #ifdef ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY 25885cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_FIND_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY; 2589abdc9fb5SMatthias Ringwald #else 25905cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY; 2591abdc9fb5SMatthias Ringwald #endif 25923deb3ec6SMatthias Ringwald gatt_client_run(); 25939cb80b17SMilanka Ringwald return ERROR_CODE_SUCCESS; 25943deb3ec6SMatthias Ringwald } 25953deb3ec6SMatthias Ringwald 2596711e6c80SMatthias 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){ 259740faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2598de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 259940faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 260040faeb84SMilanka Ringwald return status; 260140faeb84SMilanka Ringwald } 26023deb3ec6SMatthias Ringwald 26035cf1669fSMatthias Ringwald gatt_client->callback = callback; 26045cf1669fSMatthias Ringwald gatt_client->attribute_handle = descriptor_handle; 26053deb3ec6SMatthias Ringwald 26065cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_CHARACTERISTIC_DESCRIPTOR_QUERY; 26073deb3ec6SMatthias Ringwald gatt_client_run(); 260825b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 26093deb3ec6SMatthias Ringwald } 26103deb3ec6SMatthias Ringwald 2611711e6c80SMatthias 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){ 26129c662c9bSMatthias Ringwald return gatt_client_read_characteristic_descriptor_using_descriptor_handle(callback, con_handle, descriptor->handle); 26133deb3ec6SMatthias Ringwald } 26143deb3ec6SMatthias Ringwald 2615711e6c80SMatthias 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){ 261640faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2617de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 261840faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 261940faeb84SMilanka Ringwald return status; 262040faeb84SMilanka Ringwald } 26213deb3ec6SMatthias Ringwald 26225cf1669fSMatthias Ringwald gatt_client->callback = callback; 26235cf1669fSMatthias Ringwald gatt_client->attribute_handle = descriptor_handle; 26245cf1669fSMatthias Ringwald gatt_client->attribute_offset = offset; 26255cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_QUERY; 26263deb3ec6SMatthias Ringwald gatt_client_run(); 262725b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 26283deb3ec6SMatthias Ringwald } 26293deb3ec6SMatthias Ringwald 2630711e6c80SMatthias 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){ 26319c662c9bSMatthias Ringwald return gatt_client_read_long_characteristic_descriptor_using_descriptor_handle_with_offset(callback, con_handle, descriptor_handle, 0); 26323deb3ec6SMatthias Ringwald } 26333deb3ec6SMatthias Ringwald 2634711e6c80SMatthias 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){ 26359c662c9bSMatthias Ringwald return gatt_client_read_long_characteristic_descriptor_using_descriptor_handle(callback, con_handle, descriptor->handle); 26363deb3ec6SMatthias Ringwald } 26373deb3ec6SMatthias Ringwald 2638b45b7749SMilanka 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){ 263940faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2640de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 264140faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 264240faeb84SMilanka Ringwald return status; 264340faeb84SMilanka Ringwald } 26443deb3ec6SMatthias Ringwald 26455cf1669fSMatthias Ringwald gatt_client->callback = callback; 26465cf1669fSMatthias Ringwald gatt_client->attribute_handle = descriptor_handle; 2647b45b7749SMilanka Ringwald gatt_client->attribute_length = value_length; 26485cf1669fSMatthias Ringwald gatt_client->attribute_offset = 0; 2649b45b7749SMilanka Ringwald gatt_client->attribute_value = value; 26505cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_WRITE_CHARACTERISTIC_DESCRIPTOR; 26513deb3ec6SMatthias Ringwald gatt_client_run(); 265225b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 26533deb3ec6SMatthias Ringwald } 26543deb3ec6SMatthias Ringwald 265548cdff9cSMilanka 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){ 265648cdff9cSMilanka Ringwald return gatt_client_write_characteristic_descriptor_using_descriptor_handle(callback, con_handle, descriptor->handle, value_length, value); 26573deb3ec6SMatthias Ringwald } 26583deb3ec6SMatthias Ringwald 2659b45b7749SMilanka 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){ 266040faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2661de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 266240faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 266340faeb84SMilanka Ringwald return status; 266440faeb84SMilanka Ringwald } 26653deb3ec6SMatthias Ringwald 26665cf1669fSMatthias Ringwald gatt_client->callback = callback; 26675cf1669fSMatthias Ringwald gatt_client->attribute_handle = descriptor_handle; 2668b45b7749SMilanka Ringwald gatt_client->attribute_length = value_length; 26695cf1669fSMatthias Ringwald gatt_client->attribute_offset = offset; 2670b45b7749SMilanka Ringwald gatt_client->attribute_value = value; 26715cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR; 26723deb3ec6SMatthias Ringwald gatt_client_run(); 267325b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 26743deb3ec6SMatthias Ringwald } 26753deb3ec6SMatthias Ringwald 2676b45b7749SMilanka 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){ 2677b45b7749SMilanka Ringwald return gatt_client_write_long_characteristic_descriptor_using_descriptor_handle_with_offset(callback, con_handle, descriptor_handle, 0, value_length, value); 26783deb3ec6SMatthias Ringwald } 26793deb3ec6SMatthias Ringwald 2680b45b7749SMilanka 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){ 2681b45b7749SMilanka Ringwald return gatt_client_write_long_characteristic_descriptor_using_descriptor_handle(callback, con_handle, descriptor->handle, value_length, value); 26823deb3ec6SMatthias Ringwald } 26833deb3ec6SMatthias Ringwald 26843deb3ec6SMatthias Ringwald /** 26853deb3ec6SMatthias Ringwald * @brief -> gatt complete event 26863deb3ec6SMatthias Ringwald */ 2687b45b7749SMilanka 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){ 268840faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2689de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 269040faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 269140faeb84SMilanka Ringwald return status; 269240faeb84SMilanka Ringwald } 26933deb3ec6SMatthias Ringwald 26945cf1669fSMatthias Ringwald gatt_client->callback = callback; 26955cf1669fSMatthias Ringwald gatt_client->attribute_handle = attribute_handle; 2696b45b7749SMilanka Ringwald gatt_client->attribute_length = value_length; 26975cf1669fSMatthias Ringwald gatt_client->attribute_offset = offset; 2698b45b7749SMilanka Ringwald gatt_client->attribute_value = value; 26995cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_PREPARE_WRITE_SINGLE; 27003deb3ec6SMatthias Ringwald gatt_client_run(); 270125b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 27023deb3ec6SMatthias Ringwald } 27033deb3ec6SMatthias Ringwald 27043deb3ec6SMatthias Ringwald /** 27053deb3ec6SMatthias Ringwald * @brief -> gatt complete event 27063deb3ec6SMatthias Ringwald */ 2707711e6c80SMatthias Ringwald uint8_t gatt_client_execute_write(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 270840faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2709de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 271040faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 271140faeb84SMilanka Ringwald return status; 271240faeb84SMilanka Ringwald } 27133deb3ec6SMatthias Ringwald 27145cf1669fSMatthias Ringwald gatt_client->callback = callback; 27155cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_EXECUTE_PREPARED_WRITE; 27163deb3ec6SMatthias Ringwald gatt_client_run(); 271725b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 27183deb3ec6SMatthias Ringwald } 27193deb3ec6SMatthias Ringwald 27203deb3ec6SMatthias Ringwald /** 27213deb3ec6SMatthias Ringwald * @brief -> gatt complete event 27223deb3ec6SMatthias Ringwald */ 2723711e6c80SMatthias Ringwald uint8_t gatt_client_cancel_write(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 272440faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2725de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 272640faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 272740faeb84SMilanka Ringwald return status; 272840faeb84SMilanka Ringwald } 27293deb3ec6SMatthias Ringwald 27305cf1669fSMatthias Ringwald gatt_client->callback = callback; 27315cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_CANCEL_PREPARED_WRITE; 27323deb3ec6SMatthias Ringwald gatt_client_run(); 27337d2258b3SMilanka Ringwald return ERROR_CODE_SUCCESS; 27343deb3ec6SMatthias Ringwald } 27353deb3ec6SMatthias Ringwald 2736313e337bSMatthias Ringwald void gatt_client_deserialize_service(const uint8_t *packet, int offset, gatt_client_service_t * service){ 27376ba2ad22SMatthias Ringwald service->start_group_handle = little_endian_read_16(packet, offset); 27386ba2ad22SMatthias Ringwald service->end_group_handle = little_endian_read_16(packet, offset + 2); 27396ba2ad22SMatthias Ringwald reverse_128(&packet[offset + 4], service->uuid128); 27406ba2ad22SMatthias Ringwald if (uuid_has_bluetooth_prefix(service->uuid128)){ 27416ba2ad22SMatthias Ringwald service->uuid16 = big_endian_read_32(service->uuid128, 0); 2742c839c6f9SMatthias Ringwald } else { 2743c839c6f9SMatthias Ringwald service->uuid16 = 0; 27446ba2ad22SMatthias Ringwald } 27456ba2ad22SMatthias Ringwald } 27466ba2ad22SMatthias Ringwald 2747313e337bSMatthias Ringwald void gatt_client_deserialize_characteristic(const uint8_t * packet, int offset, gatt_client_characteristic_t * characteristic){ 27486ba2ad22SMatthias Ringwald characteristic->start_handle = little_endian_read_16(packet, offset); 27496ba2ad22SMatthias Ringwald characteristic->value_handle = little_endian_read_16(packet, offset + 2); 27506ba2ad22SMatthias Ringwald characteristic->end_handle = little_endian_read_16(packet, offset + 4); 27516ba2ad22SMatthias Ringwald characteristic->properties = little_endian_read_16(packet, offset + 6); 275286c38559SMatthias Ringwald reverse_128(&packet[offset+8], characteristic->uuid128); 27536ba2ad22SMatthias Ringwald if (uuid_has_bluetooth_prefix(characteristic->uuid128)){ 27546ba2ad22SMatthias Ringwald characteristic->uuid16 = big_endian_read_32(characteristic->uuid128, 0); 2755c839c6f9SMatthias Ringwald } else { 2756c839c6f9SMatthias Ringwald characteristic->uuid16 = 0; 27576ba2ad22SMatthias Ringwald } 27586ba2ad22SMatthias Ringwald } 27596ba2ad22SMatthias Ringwald 2760313e337bSMatthias Ringwald void gatt_client_deserialize_characteristic_descriptor(const uint8_t * packet, int offset, gatt_client_characteristic_descriptor_t * descriptor){ 27616ba2ad22SMatthias Ringwald descriptor->handle = little_endian_read_16(packet, offset); 27626ba2ad22SMatthias Ringwald reverse_128(&packet[offset+2], descriptor->uuid128); 2763b4895529SJakob Krantz if (uuid_has_bluetooth_prefix(descriptor->uuid128)){ 2764b4895529SJakob Krantz descriptor->uuid16 = big_endian_read_32(descriptor->uuid128, 0); 2765c839c6f9SMatthias Ringwald } else { 2766c839c6f9SMatthias Ringwald descriptor->uuid16 = 0; 2767b4895529SJakob Krantz } 27686ba2ad22SMatthias Ringwald } 27695cf6c434SJakob Krantz 27705cf6c434SJakob Krantz void gatt_client_send_mtu_negotiation(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 277140faeb84SMilanka Ringwald gatt_client_t * gatt_client; 277240faeb84SMilanka Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 277340faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 277440faeb84SMilanka Ringwald return; 277540faeb84SMilanka Ringwald } 277640faeb84SMilanka Ringwald if (gatt_client->mtu_state == MTU_AUTO_EXCHANGE_DISABLED){ 277740faeb84SMilanka Ringwald gatt_client->callback = callback; 277840faeb84SMilanka Ringwald gatt_client->mtu_state = SEND_MTU_EXCHANGE; 27795cf6c434SJakob Krantz gatt_client_run(); 27805cf6c434SJakob Krantz } 27815cf6c434SJakob Krantz } 278247181045SMatthias Ringwald 278359d34cd2SMatthias Ringwald uint8_t gatt_client_request_to_write_without_response(btstack_context_callback_registration_t * callback_registration, hci_con_handle_t con_handle){ 278459d34cd2SMatthias Ringwald gatt_client_t * gatt_client; 278559d34cd2SMatthias Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 278659d34cd2SMatthias Ringwald if (status != ERROR_CODE_SUCCESS){ 278759d34cd2SMatthias Ringwald return status; 278859d34cd2SMatthias Ringwald } 278959d34cd2SMatthias Ringwald bool added = btstack_linked_list_add_tail(&gatt_client->write_without_response_requests, (btstack_linked_item_t*) callback_registration); 27902832a98aSMatthias Ringwald if (added == false){ 279159d34cd2SMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 27922832a98aSMatthias Ringwald } else { 27932832a98aSMatthias Ringwald att_dispatch_client_request_can_send_now_event(gatt_client->con_handle); 27942832a98aSMatthias Ringwald return ERROR_CODE_SUCCESS; 279559d34cd2SMatthias Ringwald } 279659d34cd2SMatthias Ringwald } 279759d34cd2SMatthias Ringwald 279853e9c18fSMatthias Ringwald uint8_t gatt_client_request_to_send_gatt_query(btstack_context_callback_registration_t * callback_registration, hci_con_handle_t con_handle){ 279953e9c18fSMatthias Ringwald gatt_client_t * gatt_client; 280053e9c18fSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 280153e9c18fSMatthias Ringwald if (status != ERROR_CODE_SUCCESS){ 280253e9c18fSMatthias Ringwald return status; 280353e9c18fSMatthias Ringwald } 280453e9c18fSMatthias Ringwald bool added = btstack_linked_list_add_tail(&gatt_client->query_requests, (btstack_linked_item_t*) callback_registration); 28052832a98aSMatthias Ringwald if (added == false){ 280653e9c18fSMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 28072832a98aSMatthias Ringwald } else { 28082832a98aSMatthias Ringwald gatt_client_notify_can_send_query(gatt_client); 28092832a98aSMatthias Ringwald return ERROR_CODE_SUCCESS; 281053e9c18fSMatthias Ringwald } 281153e9c18fSMatthias Ringwald } 281253e9c18fSMatthias Ringwald 281347181045SMatthias Ringwald uint8_t gatt_client_request_can_write_without_response_event(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 281440faeb84SMilanka Ringwald gatt_client_t * gatt_client; 281540faeb84SMilanka Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 281640faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 281740faeb84SMilanka Ringwald return status; 281840faeb84SMilanka Ringwald } 281940faeb84SMilanka Ringwald if (gatt_client->write_without_response_callback != NULL){ 282040faeb84SMilanka Ringwald return GATT_CLIENT_IN_WRONG_STATE; 282140faeb84SMilanka Ringwald } 282240faeb84SMilanka Ringwald gatt_client->write_without_response_callback = callback; 282340faeb84SMilanka Ringwald att_dispatch_client_request_can_send_now_event(gatt_client->con_handle); 28247d2258b3SMilanka Ringwald return ERROR_CODE_SUCCESS; 282547181045SMatthias Ringwald } 2826a6121b51SMilanka Ringwald 28277627a0deSMatthias Ringwald 28287627a0deSMatthias Ringwald #if defined(ENABLE_GATT_OVER_CLASSIC) || defined(ENABLE_GATT_OVER_EATT) 28291450cdc6SMatthias Ringwald 28301450cdc6SMatthias Ringwald #include "hci_event.h" 28311450cdc6SMatthias Ringwald 28321450cdc6SMatthias Ringwald static const hci_event_t gatt_client_connected = { 28331450cdc6SMatthias Ringwald GATT_EVENT_CONNECTED, 0, "1BH" 28341450cdc6SMatthias Ringwald }; 28351450cdc6SMatthias Ringwald 28366b4a68c3SMatthias Ringwald static const hci_event_t gatt_client_disconnected = { 28376b4a68c3SMatthias Ringwald GATT_EVENT_DISCONNECTED, 0, "H" 28386b4a68c3SMatthias Ringwald }; 28397627a0deSMatthias Ringwald #endif 28407627a0deSMatthias Ringwald 28417627a0deSMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC 28427627a0deSMatthias Ringwald 28437627a0deSMatthias Ringwald #include "bluetooth_psm.h" 28447627a0deSMatthias Ringwald 28457627a0deSMatthias Ringwald // single active SDP query 28467627a0deSMatthias Ringwald static gatt_client_t * gatt_client_classic_active_sdp_query; 28477627a0deSMatthias Ringwald 28487627a0deSMatthias Ringwald // macos protocol descriptor list requires 16 bytes 28497627a0deSMatthias Ringwald static uint8_t gatt_client_classic_sdp_buffer[32]; 28507627a0deSMatthias Ringwald 28516b4a68c3SMatthias Ringwald 28521450cdc6SMatthias Ringwald static gatt_client_t * gatt_client_get_context_for_classic_addr(bd_addr_t addr){ 28531450cdc6SMatthias Ringwald btstack_linked_item_t *it; 28541450cdc6SMatthias Ringwald for (it = (btstack_linked_item_t *) gatt_client_connections; it != NULL; it = it->next){ 28551450cdc6SMatthias Ringwald gatt_client_t * gatt_client = (gatt_client_t *) it; 28561450cdc6SMatthias Ringwald if (memcmp(gatt_client->addr, addr, 6) == 0){ 28571450cdc6SMatthias Ringwald return gatt_client; 28581450cdc6SMatthias Ringwald } 28591450cdc6SMatthias Ringwald } 28601450cdc6SMatthias Ringwald return NULL; 28611450cdc6SMatthias Ringwald } 28621450cdc6SMatthias Ringwald 28631450cdc6SMatthias Ringwald static gatt_client_t * gatt_client_get_context_for_l2cap_cid(uint16_t l2cap_cid){ 28641450cdc6SMatthias Ringwald btstack_linked_item_t *it; 28651450cdc6SMatthias Ringwald for (it = (btstack_linked_item_t *) gatt_client_connections; it != NULL; it = it->next){ 28661450cdc6SMatthias Ringwald gatt_client_t * gatt_client = (gatt_client_t *) it; 28671450cdc6SMatthias Ringwald if (gatt_client->l2cap_cid == l2cap_cid){ 28681450cdc6SMatthias Ringwald return gatt_client; 28691450cdc6SMatthias Ringwald } 28701450cdc6SMatthias Ringwald } 28711450cdc6SMatthias Ringwald return NULL; 28721450cdc6SMatthias Ringwald } 28731450cdc6SMatthias Ringwald 28741450cdc6SMatthias Ringwald static void gatt_client_classic_handle_connected(gatt_client_t * gatt_client, uint8_t status){ 28751450cdc6SMatthias Ringwald bd_addr_t addr; 2876d5529700SMatthias Ringwald // cppcheck-suppress uninitvar ; addr is reported as uninitialized although it's the destination of the memcpy 28771450cdc6SMatthias Ringwald memcpy(addr, gatt_client->addr, 6); 28781450cdc6SMatthias Ringwald hci_con_handle_t con_handle = gatt_client->con_handle; 28791450cdc6SMatthias Ringwald btstack_packet_handler_t callback = gatt_client->callback; 28801450cdc6SMatthias Ringwald if (status != ERROR_CODE_SUCCESS){ 28811450cdc6SMatthias Ringwald btstack_linked_list_remove(&gatt_client_connections, (btstack_linked_item_t *) gatt_client); 28821450cdc6SMatthias Ringwald btstack_memory_gatt_client_free(gatt_client); 28831450cdc6SMatthias Ringwald } 2884d8acf267SMatthias Ringwald 2885d8acf267SMatthias Ringwald // store l2cap cid in hci_connection->att_server 2886d8acf267SMatthias Ringwald hci_connection_t * hci_connection = hci_connection_for_handle(con_handle); 2887d8acf267SMatthias Ringwald hci_connection->att_server.l2cap_cid = gatt_client->l2cap_cid; 2888d8acf267SMatthias Ringwald 28891450cdc6SMatthias Ringwald uint8_t buffer[20]; 28901450cdc6SMatthias Ringwald uint16_t len = hci_event_create_from_template_and_arguments(buffer, sizeof(buffer), &gatt_client_connected, status, addr, 28911450cdc6SMatthias Ringwald con_handle); 28921450cdc6SMatthias Ringwald (*callback)(HCI_EVENT_PACKET, 0, buffer, len); 28931450cdc6SMatthias Ringwald } 28941450cdc6SMatthias Ringwald 28956b4a68c3SMatthias Ringwald static void gatt_client_classic_handle_disconnected(gatt_client_t * gatt_client){ 28966b4a68c3SMatthias Ringwald 28976b4a68c3SMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, ATT_ERROR_HCI_DISCONNECT_RECEIVED); 28986b4a68c3SMatthias Ringwald gatt_client_timeout_stop(gatt_client); 28996b4a68c3SMatthias Ringwald 29006b4a68c3SMatthias Ringwald hci_con_handle_t con_handle = gatt_client->con_handle; 29016b4a68c3SMatthias Ringwald btstack_packet_handler_t callback = gatt_client->callback; 29026b4a68c3SMatthias Ringwald btstack_linked_list_remove(&gatt_client_connections, (btstack_linked_item_t *) gatt_client); 29036b4a68c3SMatthias Ringwald btstack_memory_gatt_client_free(gatt_client); 29046b4a68c3SMatthias Ringwald 29056b4a68c3SMatthias Ringwald uint8_t buffer[20]; 29066b4a68c3SMatthias Ringwald uint16_t len = hci_event_create_from_template_and_arguments(buffer, sizeof(buffer), &gatt_client_disconnected, con_handle); 29076b4a68c3SMatthias Ringwald (*callback)(HCI_EVENT_PACKET, 0, buffer, len); 29086b4a68c3SMatthias Ringwald } 29096b4a68c3SMatthias Ringwald 29101450cdc6SMatthias Ringwald static void gatt_client_handle_sdp_client_query_attribute_value(gatt_client_t * connection, uint8_t *packet){ 29111450cdc6SMatthias Ringwald des_iterator_t des_list_it; 29121450cdc6SMatthias Ringwald des_iterator_t prot_it; 29131450cdc6SMatthias Ringwald 29141450cdc6SMatthias Ringwald if (sdp_event_query_attribute_byte_get_attribute_length(packet) <= sizeof(gatt_client_classic_sdp_buffer)) { 29151450cdc6SMatthias Ringwald gatt_client_classic_sdp_buffer[sdp_event_query_attribute_byte_get_data_offset(packet)] = sdp_event_query_attribute_byte_get_data(packet); 29161450cdc6SMatthias Ringwald if ((uint16_t)(sdp_event_query_attribute_byte_get_data_offset(packet)+1) == sdp_event_query_attribute_byte_get_attribute_length(packet)) { 29171450cdc6SMatthias Ringwald switch(sdp_event_query_attribute_byte_get_attribute_id(packet)) { 29181450cdc6SMatthias Ringwald case BLUETOOTH_ATTRIBUTE_PROTOCOL_DESCRIPTOR_LIST: 29191450cdc6SMatthias 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)) { 29201450cdc6SMatthias Ringwald uint8_t *des_element; 29211450cdc6SMatthias Ringwald uint8_t *element; 29221450cdc6SMatthias Ringwald uint32_t uuid; 29231450cdc6SMatthias Ringwald 29241450cdc6SMatthias Ringwald if (des_iterator_get_type(&des_list_it) != DE_DES) continue; 29251450cdc6SMatthias Ringwald 29261450cdc6SMatthias Ringwald des_element = des_iterator_get_element(&des_list_it); 29271450cdc6SMatthias Ringwald des_iterator_init(&prot_it, des_element); 29281450cdc6SMatthias Ringwald element = des_iterator_get_element(&prot_it); 29291450cdc6SMatthias Ringwald 29301450cdc6SMatthias Ringwald if (de_get_element_type(element) != DE_UUID) continue; 29311450cdc6SMatthias Ringwald 29321450cdc6SMatthias Ringwald uuid = de_get_uuid32(element); 29331450cdc6SMatthias Ringwald des_iterator_next(&prot_it); 29341450cdc6SMatthias Ringwald // we assume that the even if there are both roles supported, remote device uses the same psm and avdtp version for both 29351450cdc6SMatthias Ringwald switch (uuid){ 29361450cdc6SMatthias Ringwald case BLUETOOTH_PROTOCOL_L2CAP: 29371450cdc6SMatthias Ringwald if (!des_iterator_has_more(&prot_it)) continue; 29381450cdc6SMatthias Ringwald de_element_get_uint16(des_iterator_get_element(&prot_it), &connection->l2cap_psm); 29391450cdc6SMatthias Ringwald break; 29401450cdc6SMatthias Ringwald default: 29411450cdc6SMatthias Ringwald break; 29421450cdc6SMatthias Ringwald } 29431450cdc6SMatthias Ringwald } 29441450cdc6SMatthias Ringwald break; 29451450cdc6SMatthias Ringwald 29461450cdc6SMatthias Ringwald default: 29471450cdc6SMatthias Ringwald break; 29481450cdc6SMatthias Ringwald } 29491450cdc6SMatthias Ringwald } 29501450cdc6SMatthias Ringwald } 29511450cdc6SMatthias Ringwald } 29521450cdc6SMatthias Ringwald 29531450cdc6SMatthias Ringwald static void gatt_client_classic_sdp_handler(uint8_t packet_type, uint16_t handle, uint8_t *packet, uint16_t size){ 29541450cdc6SMatthias Ringwald gatt_client_t * gatt_client = gatt_client_classic_active_sdp_query; 29551450cdc6SMatthias Ringwald btstack_assert(gatt_client != NULL); 29561450cdc6SMatthias Ringwald uint8_t status; 29571450cdc6SMatthias Ringwald 29581450cdc6SMatthias Ringwald // TODO: handle sdp events, get l2cap psm 29591450cdc6SMatthias Ringwald switch (hci_event_packet_get_type(packet)){ 29601450cdc6SMatthias Ringwald case SDP_EVENT_QUERY_ATTRIBUTE_VALUE: 29611450cdc6SMatthias Ringwald gatt_client_handle_sdp_client_query_attribute_value(gatt_client, packet); 29621450cdc6SMatthias Ringwald // TODO: 29631450cdc6SMatthias Ringwald return; 29641450cdc6SMatthias Ringwald case SDP_EVENT_QUERY_COMPLETE: 29651450cdc6SMatthias Ringwald status = sdp_event_query_complete_get_status(packet); 29661450cdc6SMatthias Ringwald gatt_client_classic_active_sdp_query = NULL; 29671450cdc6SMatthias Ringwald log_info("l2cap psm: %0x, status %02x", gatt_client->l2cap_psm, status); 29681450cdc6SMatthias Ringwald if (status != ERROR_CODE_SUCCESS) break; 29691450cdc6SMatthias Ringwald if (gatt_client->l2cap_psm == 0) { 29701450cdc6SMatthias Ringwald status = SDP_SERVICE_NOT_FOUND; 29711450cdc6SMatthias Ringwald break; 29721450cdc6SMatthias Ringwald } 29731450cdc6SMatthias Ringwald break; 29741450cdc6SMatthias Ringwald default: 29751450cdc6SMatthias Ringwald btstack_assert(false); 29761450cdc6SMatthias Ringwald return; 29771450cdc6SMatthias Ringwald } 29781450cdc6SMatthias Ringwald 29791450cdc6SMatthias Ringwald // done 29801450cdc6SMatthias Ringwald if (status == ERROR_CODE_SUCCESS){ 29811450cdc6SMatthias Ringwald gatt_client->gatt_client_state = P_W4_L2CAP_CONNECTION; 2982*59b5e157SMatthias Ringwald status = att_dispatch_classic_connect(gatt_client->addr, gatt_client->l2cap_psm, &gatt_client->l2cap_cid); 29831450cdc6SMatthias Ringwald } 29841450cdc6SMatthias Ringwald if (status != ERROR_CODE_SUCCESS) { 29851450cdc6SMatthias Ringwald gatt_client_classic_handle_connected(gatt_client, status); 29861450cdc6SMatthias Ringwald } 29871450cdc6SMatthias Ringwald } 29881450cdc6SMatthias Ringwald 29891450cdc6SMatthias Ringwald static void gatt_client_classic_sdp_start(void * context){ 29901450cdc6SMatthias Ringwald gatt_client_classic_active_sdp_query = (gatt_client_t *) context; 29911450cdc6SMatthias Ringwald gatt_client_classic_active_sdp_query->gatt_client_state = P_W4_SDP_QUERY; 29921450cdc6SMatthias Ringwald sdp_client_query_uuid16(gatt_client_classic_sdp_handler, gatt_client_classic_active_sdp_query->addr, ORG_BLUETOOTH_SERVICE_GENERIC_ATTRIBUTE); 29931450cdc6SMatthias Ringwald } 29941450cdc6SMatthias Ringwald 29951450cdc6SMatthias Ringwald uint8_t gatt_client_classic_connect(btstack_packet_handler_t callback, bd_addr_t addr){ 29961450cdc6SMatthias Ringwald gatt_client_t * gatt_client = gatt_client_get_context_for_classic_addr(addr); 29971450cdc6SMatthias Ringwald if (gatt_client != NULL){ 29981450cdc6SMatthias Ringwald return ERROR_CODE_ACL_CONNECTION_ALREADY_EXISTS; 29991450cdc6SMatthias Ringwald } 30001450cdc6SMatthias Ringwald gatt_client = btstack_memory_gatt_client_get(); 30011450cdc6SMatthias Ringwald if (gatt_client == NULL){ 30021450cdc6SMatthias Ringwald return ERROR_CODE_MEMORY_CAPACITY_EXCEEDED; 30031450cdc6SMatthias Ringwald } 30041450cdc6SMatthias Ringwald // init state 3005e9cdf30bSMatthias Ringwald gatt_client->bearer_type = ATT_BEARER_UNENHANCED_CLASSIC; 30061450cdc6SMatthias Ringwald gatt_client->con_handle = HCI_CON_HANDLE_INVALID; 30071450cdc6SMatthias Ringwald memcpy(gatt_client->addr, addr, 6); 30081450cdc6SMatthias Ringwald gatt_client->mtu = ATT_DEFAULT_MTU; 30091450cdc6SMatthias Ringwald gatt_client->security_level = LEVEL_0; 30101450cdc6SMatthias Ringwald gatt_client->mtu_state = MTU_AUTO_EXCHANGE_DISABLED; 30111450cdc6SMatthias Ringwald gatt_client->gatt_client_state = P_W2_SDP_QUERY; 30121450cdc6SMatthias Ringwald gatt_client->sdp_query_request.callback = &gatt_client_classic_sdp_start; 30131450cdc6SMatthias Ringwald gatt_client->sdp_query_request.context = gatt_client; 30141450cdc6SMatthias Ringwald gatt_client->callback = callback; 3015cbd76cecSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 3016cbd76cecSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_IDLE; 3017cbd76cecSMatthias Ringwald #endif 30181450cdc6SMatthias Ringwald btstack_linked_list_add(&gatt_client_connections, (btstack_linked_item_t*)gatt_client); 30191450cdc6SMatthias Ringwald sdp_client_register_query_callback(&gatt_client->sdp_query_request); 3020b7b03a30SMatthias Ringwald return ERROR_CODE_SUCCESS; 30211450cdc6SMatthias Ringwald } 30221450cdc6SMatthias Ringwald 30231450cdc6SMatthias Ringwald uint8_t gatt_client_classic_disconnect(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 30241450cdc6SMatthias Ringwald gatt_client_t * gatt_client = gatt_client_get_context_for_handle(con_handle); 30251450cdc6SMatthias Ringwald if (gatt_client == NULL){ 30261450cdc6SMatthias Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 30271450cdc6SMatthias Ringwald } 30281450cdc6SMatthias Ringwald gatt_client->callback = callback; 30291450cdc6SMatthias Ringwald return l2cap_disconnect(gatt_client->l2cap_cid); 30301450cdc6SMatthias Ringwald } 30311450cdc6SMatthias Ringwald #endif 30321450cdc6SMatthias Ringwald 303326166ecfSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 303426166ecfSMatthias Ringwald 303526166ecfSMatthias Ringwald #define MAX_NR_EATT_CHANNELS 5 30367627a0deSMatthias Ringwald 30377627a0deSMatthias Ringwald static void gatt_client_le_enhanced_packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size); 30387627a0deSMatthias Ringwald 30397627a0deSMatthias Ringwald static void gatt_client_eatt_finalize(gatt_client_t * gatt_client) { 30407627a0deSMatthias Ringwald // free eatt clients 30417627a0deSMatthias Ringwald btstack_linked_list_iterator_t it; 30427627a0deSMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client_connections); 30437627a0deSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)) { 30447627a0deSMatthias Ringwald gatt_client_t *eatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it); 30457627a0deSMatthias Ringwald btstack_linked_list_iterator_remove(&it); 30467627a0deSMatthias Ringwald btstack_memory_gatt_client_free(eatt_client); 30477627a0deSMatthias Ringwald } 30487627a0deSMatthias Ringwald } 30497627a0deSMatthias Ringwald 30507627a0deSMatthias Ringwald // all channels connected 30517627a0deSMatthias Ringwald static void gatt_client_le_enhanced_handle_connected(gatt_client_t * gatt_client, uint8_t status) { 30527627a0deSMatthias Ringwald if (status == ERROR_CODE_SUCCESS){ 30537627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_READY; 30547627a0deSMatthias Ringwald } else { 30557627a0deSMatthias Ringwald gatt_client_eatt_finalize(gatt_client); 30567627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_IDLE; 30577627a0deSMatthias Ringwald } 30587627a0deSMatthias Ringwald 30597627a0deSMatthias Ringwald uint8_t buffer[20]; 30607627a0deSMatthias Ringwald uint16_t len = hci_event_create_from_template_and_arguments(buffer, sizeof(buffer), &gatt_client_connected, status, gatt_client->addr, 30617627a0deSMatthias Ringwald gatt_client->con_handle); 30627627a0deSMatthias Ringwald (*gatt_client->callback)(HCI_EVENT_PACKET, 0, buffer, len); 30637627a0deSMatthias Ringwald } 30647627a0deSMatthias Ringwald 30657627a0deSMatthias Ringwald // single channel disconnected 30667627a0deSMatthias Ringwald static void gatt_client_le_enhanced_handle_ecbm_disconnected(gatt_client_t * gatt_client, gatt_client_t * eatt_client) { 30677627a0deSMatthias Ringwald if (gatt_client->eatt_state == GATT_CLIENT_EATT_READY) { 30687627a0deSMatthias Ringwald 30697627a0deSMatthias Ringwald // report error 30707627a0deSMatthias Ringwald gatt_client_report_error_if_pending(eatt_client, ATT_ERROR_HCI_DISCONNECT_RECEIVED); 30717627a0deSMatthias Ringwald 30727627a0deSMatthias Ringwald // free memory 30737627a0deSMatthias Ringwald btstack_linked_list_remove(&gatt_client->eatt_clients, (btstack_linked_item_t *) eatt_client); 30747627a0deSMatthias Ringwald btstack_memory_gatt_client_free(eatt_client); 30757627a0deSMatthias Ringwald 30767627a0deSMatthias Ringwald // report disconnected if last channel closed 30777627a0deSMatthias Ringwald if (btstack_linked_list_empty(&gatt_client->eatt_clients)){ 30787627a0deSMatthias Ringwald // emit disconnected when last eatt client is gone 30797627a0deSMatthias Ringwald uint8_t buffer[20]; 30807627a0deSMatthias Ringwald uint16_t len = hci_event_create_from_template_and_arguments(buffer, sizeof(buffer), &gatt_client_disconnected, gatt_client->con_handle); 30817627a0deSMatthias Ringwald (*gatt_client->callback)(HCI_EVENT_PACKET, 0, buffer, len); 30827627a0deSMatthias Ringwald } 30837627a0deSMatthias Ringwald } 30847627a0deSMatthias Ringwald } 30857627a0deSMatthias Ringwald 30867627a0deSMatthias Ringwald static gatt_client_t * gatt_client_le_enhanced_get_context_for_l2cap_cid(uint16_t l2cap_cid, gatt_client_t ** out_eatt_client){ 30877627a0deSMatthias Ringwald btstack_linked_list_iterator_t it; 30887627a0deSMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client_connections); 30897627a0deSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)) { 30907627a0deSMatthias Ringwald gatt_client_t * gatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it); 30917627a0deSMatthias Ringwald btstack_linked_list_iterator_t it2; 30927627a0deSMatthias Ringwald btstack_linked_list_iterator_init(&it2, &gatt_client->eatt_clients); 30937627a0deSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it2)) { 30947627a0deSMatthias Ringwald gatt_client_t * eatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it2); 30957627a0deSMatthias Ringwald if (eatt_client->l2cap_cid == l2cap_cid){ 30967627a0deSMatthias Ringwald *out_eatt_client = eatt_client; 30977627a0deSMatthias Ringwald return gatt_client; 30987627a0deSMatthias Ringwald } 30997627a0deSMatthias Ringwald } 31007627a0deSMatthias Ringwald } 31017627a0deSMatthias Ringwald return NULL; 31027627a0deSMatthias Ringwald } 31037627a0deSMatthias Ringwald 31047627a0deSMatthias Ringwald static void gatt_client_le_enhanced_setup_l2cap_channel(gatt_client_t * gatt_client){ 31057627a0deSMatthias Ringwald uint8_t num_channels = gatt_client->eatt_num_clients; 31067627a0deSMatthias Ringwald 31077627a0deSMatthias Ringwald // setup channels 31087627a0deSMatthias Ringwald uint16_t buffer_size_per_client = gatt_client->eatt_storage_size / num_channels; 3109f7a42e72SMatthias Ringwald uint16_t max_mtu = (buffer_size_per_client - REPORT_PREBUFFER_HEADER) / 2; 31107627a0deSMatthias Ringwald uint8_t * receive_buffers[MAX_NR_EATT_CHANNELS]; 31117627a0deSMatthias Ringwald uint16_t new_cids[MAX_NR_EATT_CHANNELS]; 31127627a0deSMatthias Ringwald memset(gatt_client->eatt_storage_buffer, 0, gatt_client->eatt_storage_size); 31137627a0deSMatthias Ringwald uint8_t i; 31147627a0deSMatthias Ringwald for (i=0;i<gatt_client->eatt_num_clients; i++){ 3115f7a42e72SMatthias Ringwald receive_buffers[i] = &gatt_client->eatt_storage_buffer[REPORT_PREBUFFER_HEADER]; 3116f7a42e72SMatthias Ringwald gatt_client->eatt_storage_buffer += REPORT_PREBUFFER_HEADER + max_mtu; 31177627a0deSMatthias Ringwald } 31187627a0deSMatthias Ringwald 31197627a0deSMatthias Ringwald log_info("%u EATT clients with receive buffer size %u", gatt_client->eatt_num_clients, buffer_size_per_client); 31207627a0deSMatthias Ringwald 3121f7a42e72SMatthias Ringwald uint8_t status = l2cap_ecbm_create_channels(&gatt_client_le_enhanced_packet_handler, 3122f7a42e72SMatthias Ringwald gatt_client->con_handle, 31237627a0deSMatthias Ringwald gatt_client->security_level, 3124f7a42e72SMatthias Ringwald BLUETOOTH_PSM_EATT, num_channels, 3125f7a42e72SMatthias Ringwald L2CAP_LE_AUTOMATIC_CREDITS, 31267627a0deSMatthias Ringwald buffer_size_per_client, 3127f7a42e72SMatthias Ringwald receive_buffers, 3128f7a42e72SMatthias Ringwald new_cids); 31297627a0deSMatthias Ringwald 31307627a0deSMatthias Ringwald if (status == ERROR_CODE_SUCCESS){ 31317627a0deSMatthias Ringwald i = 0; 31327627a0deSMatthias Ringwald btstack_linked_list_iterator_t it; 31337627a0deSMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client->eatt_clients); 31347627a0deSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)) { 31357627a0deSMatthias Ringwald gatt_client_t *new_eatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it); 31367627a0deSMatthias Ringwald 31377627a0deSMatthias Ringwald // init state with new cid and transmit buffer 31387627a0deSMatthias Ringwald new_eatt_client->bearer_type = ATT_BEARER_ENHANCED_LE; 31397627a0deSMatthias Ringwald new_eatt_client->con_handle = gatt_client->con_handle; 31407627a0deSMatthias Ringwald new_eatt_client->mtu = 64; 31417627a0deSMatthias Ringwald new_eatt_client->security_level = LEVEL_0; 31427627a0deSMatthias Ringwald new_eatt_client->mtu_state = MTU_AUTO_EXCHANGE_DISABLED; 31437627a0deSMatthias Ringwald new_eatt_client->gatt_client_state = P_W4_L2CAP_CONNECTION; 31447627a0deSMatthias Ringwald new_eatt_client->l2cap_cid = new_cids[i]; 31457627a0deSMatthias Ringwald new_eatt_client->eatt_storage_buffer = gatt_client->eatt_storage_buffer; 3146f7a42e72SMatthias Ringwald gatt_client->eatt_storage_buffer += max_mtu; 31477627a0deSMatthias Ringwald i++; 31487627a0deSMatthias Ringwald } 31497627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_L2CAP_SETUP; 31507627a0deSMatthias Ringwald } else { 31517627a0deSMatthias Ringwald gatt_client_le_enhanced_handle_connected(gatt_client, status); 31527627a0deSMatthias Ringwald } 315326166ecfSMatthias Ringwald } 315426166ecfSMatthias Ringwald 315526166ecfSMatthias Ringwald static void gatt_client_le_enhanced_packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size) { 31567627a0deSMatthias Ringwald gatt_client_t *gatt_client; 31577627a0deSMatthias Ringwald gatt_client_t *eatt_client; 315826166ecfSMatthias Ringwald hci_con_handle_t con_handle; 31597627a0deSMatthias Ringwald uint16_t l2cap_cid; 316026166ecfSMatthias Ringwald uint8_t status; 316126166ecfSMatthias Ringwald gatt_client_characteristic_t characteristic; 31627627a0deSMatthias Ringwald gatt_client_service_t service; 316326166ecfSMatthias Ringwald switch (packet_type) { 316426166ecfSMatthias Ringwald case HCI_EVENT_PACKET: 316526166ecfSMatthias Ringwald switch (hci_event_packet_get_type(packet)) { 31667627a0deSMatthias Ringwald case GATT_EVENT_SERVICE_QUERY_RESULT: 31677627a0deSMatthias Ringwald con_handle = gatt_event_service_query_result_get_handle(packet); 31687627a0deSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(con_handle); 31697627a0deSMatthias Ringwald btstack_assert(gatt_client != NULL); 31707627a0deSMatthias Ringwald btstack_assert(gatt_client->eatt_state == GATT_CLIENT_EATT_DISCOVER_GATT_SERVICE_W4_DONE); 31717627a0deSMatthias Ringwald gatt_event_service_query_result_get_service(packet, &service); 31727627a0deSMatthias Ringwald gatt_client->gatt_service_start_group_handle = service.start_group_handle; 31737627a0deSMatthias Ringwald gatt_client->gatt_service_end_group_handle = service.end_group_handle; 31747627a0deSMatthias Ringwald break; 317526166ecfSMatthias Ringwald case GATT_EVENT_CHARACTERISTIC_VALUE_QUERY_RESULT: 317626166ecfSMatthias Ringwald con_handle = gatt_event_characteristic_value_query_result_get_handle(packet); 317726166ecfSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(con_handle); 317826166ecfSMatthias Ringwald btstack_assert(gatt_client != NULL); 31797627a0deSMatthias Ringwald btstack_assert(gatt_client->eatt_state == GATT_CLIENT_EATT_READ_SERVER_SUPPORTED_FEATURES_W4_DONE); 318026166ecfSMatthias Ringwald if (gatt_event_characteristic_value_query_result_get_value_length(packet) >= 1) { 31817627a0deSMatthias Ringwald gatt_client->gatt_server_supported_features = gatt_event_characteristic_value_query_result_get_value(packet)[0]; 318226166ecfSMatthias Ringwald } 318326166ecfSMatthias Ringwald break; 318426166ecfSMatthias Ringwald case GATT_EVENT_CHARACTERISTIC_QUERY_RESULT: 318526166ecfSMatthias Ringwald con_handle = gatt_event_characteristic_query_result_get_handle(packet); 318626166ecfSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(con_handle); 318726166ecfSMatthias Ringwald btstack_assert(gatt_client != NULL); 31887627a0deSMatthias Ringwald btstack_assert(gatt_client->eatt_state == GATT_CLIENT_EATT_FIND_CLIENT_SUPPORTED_FEATURES_W4_DONE); 31897627a0deSMatthias Ringwald gatt_event_characteristic_query_result_get_characteristic(packet, &characteristic); 319026166ecfSMatthias Ringwald gatt_client->gatt_client_supported_features_handle = characteristic.value_handle; 319126166ecfSMatthias Ringwald break; 319226166ecfSMatthias Ringwald case GATT_EVENT_QUERY_COMPLETE: 319326166ecfSMatthias Ringwald con_handle = gatt_event_query_complete_get_handle(packet); 319426166ecfSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(con_handle); 319526166ecfSMatthias Ringwald btstack_assert(gatt_client != NULL); 31967627a0deSMatthias Ringwald switch (gatt_client->eatt_state){ 31977627a0deSMatthias Ringwald case GATT_CLIENT_EATT_DISCOVER_GATT_SERVICE_W4_DONE: 31987627a0deSMatthias Ringwald if (gatt_client->gatt_service_start_group_handle == 0){ 31997627a0deSMatthias Ringwald gatt_client_le_enhanced_handle_connected(gatt_client, ERROR_CODE_UNSUPPORTED_FEATURE_OR_PARAMETER_VALUE); 32007627a0deSMatthias Ringwald } else { 32017627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_READ_SERVER_SUPPORTED_FEATURES_W2_SEND; 32027627a0deSMatthias Ringwald } 32037627a0deSMatthias Ringwald break; 32047627a0deSMatthias Ringwald case GATT_CLIENT_EATT_READ_SERVER_SUPPORTED_FEATURES_W4_DONE: 32057627a0deSMatthias Ringwald if ((gatt_client->gatt_server_supported_features & 1) == 0) { 32067627a0deSMatthias Ringwald gatt_client_le_enhanced_handle_connected(gatt_client, ERROR_CODE_UNSUPPORTED_FEATURE_OR_PARAMETER_VALUE); 32077627a0deSMatthias Ringwald } else { 32087627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_FIND_CLIENT_SUPPORTED_FEATURES_W2_SEND; 32097627a0deSMatthias Ringwald } 32107627a0deSMatthias Ringwald break; 32117627a0deSMatthias Ringwald case GATT_CLIENT_EATT_FIND_CLIENT_SUPPORTED_FEATURES_W4_DONE: 32127627a0deSMatthias Ringwald if (gatt_client->gatt_client_supported_features_handle == 0){ 32137627a0deSMatthias Ringwald gatt_client_le_enhanced_handle_connected(gatt_client, ERROR_CODE_UNSUPPORTED_FEATURE_OR_PARAMETER_VALUE); 32147627a0deSMatthias Ringwald } else { 32157627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_WRITE_ClIENT_SUPPORTED_FEATURES_W2_SEND; 32167627a0deSMatthias Ringwald } 32177627a0deSMatthias Ringwald break; 32187627a0deSMatthias Ringwald case GATT_CLIENT_EATT_WRITE_ClIENT_SUPPORTED_FEATURES_W4_DONE: 32197627a0deSMatthias Ringwald gatt_client_le_enhanced_setup_l2cap_channel(gatt_client); 322026166ecfSMatthias Ringwald break; 322126166ecfSMatthias Ringwald default: 322226166ecfSMatthias Ringwald break; 322326166ecfSMatthias Ringwald } 322426166ecfSMatthias Ringwald break; 32257627a0deSMatthias Ringwald case L2CAP_EVENT_ECBM_CHANNEL_OPENED: 32267627a0deSMatthias Ringwald l2cap_cid = l2cap_event_ecbm_channel_opened_get_local_cid(packet); 32277627a0deSMatthias Ringwald gatt_client = gatt_client_le_enhanced_get_context_for_l2cap_cid(l2cap_cid, &eatt_client); 32287627a0deSMatthias Ringwald 32297627a0deSMatthias Ringwald btstack_assert(gatt_client != NULL); 32307627a0deSMatthias Ringwald btstack_assert(eatt_client != NULL); 32317627a0deSMatthias Ringwald btstack_assert(eatt_client->gatt_client_state == P_W4_L2CAP_CONNECTION); 32327627a0deSMatthias Ringwald 32337627a0deSMatthias Ringwald status = l2cap_event_channel_opened_get_status(packet); 32347627a0deSMatthias Ringwald if (status == ERROR_CODE_SUCCESS){ 32357627a0deSMatthias Ringwald eatt_client->gatt_client_state = P_READY; 32367627a0deSMatthias Ringwald eatt_client->mtu = l2cap_event_channel_opened_get_remote_mtu(packet); 32377627a0deSMatthias Ringwald } else { 32387627a0deSMatthias Ringwald gatt_client_le_enhanced_handle_ecbm_disconnected(gatt_client, eatt_client); 32397627a0deSMatthias Ringwald } 32407627a0deSMatthias Ringwald // all channels opened? 32417627a0deSMatthias Ringwald gatt_client->eatt_num_clients--; 32427627a0deSMatthias Ringwald if (gatt_client->eatt_num_clients == 0){ 32437627a0deSMatthias Ringwald gatt_client_le_enhanced_handle_connected(gatt_client, ERROR_CODE_SUCCESS); 32447627a0deSMatthias Ringwald } 32457627a0deSMatthias Ringwald break; 32467627a0deSMatthias Ringwald case L2CAP_EVENT_CHANNEL_CLOSED: 32477627a0deSMatthias Ringwald l2cap_cid = l2cap_event_channel_closed_get_local_cid(packet); 32487627a0deSMatthias Ringwald gatt_client = gatt_client_le_enhanced_get_context_for_l2cap_cid(l2cap_cid, &eatt_client); 32497627a0deSMatthias Ringwald btstack_assert(gatt_client != NULL); 32507627a0deSMatthias Ringwald btstack_assert(eatt_client != NULL); 32517627a0deSMatthias Ringwald gatt_client_le_enhanced_handle_ecbm_disconnected(gatt_client, eatt_client); 32527627a0deSMatthias Ringwald break; 32537627a0deSMatthias Ringwald default: 32547627a0deSMatthias Ringwald break; 32557627a0deSMatthias Ringwald } 32567627a0deSMatthias Ringwald break; 32577627a0deSMatthias Ringwald case L2CAP_DATA_PACKET: 32587627a0deSMatthias Ringwald gatt_client = gatt_client_le_enhanced_get_context_for_l2cap_cid(channel, &eatt_client); 32597627a0deSMatthias Ringwald btstack_assert(gatt_client != NULL); 3260ce82ac7fSMatthias Ringwald btstack_assert(eatt_client != NULL); 3261ce82ac7fSMatthias Ringwald gatt_client_handle_att_response(eatt_client, packet, size); 32627627a0deSMatthias Ringwald gatt_client_run(); 32637627a0deSMatthias Ringwald break; 326426166ecfSMatthias Ringwald default: 326526166ecfSMatthias Ringwald break; 326626166ecfSMatthias Ringwald } 326726166ecfSMatthias Ringwald } 326826166ecfSMatthias Ringwald 32697627a0deSMatthias Ringwald static bool gatt_client_le_enhanced_handle_can_send_query(gatt_client_t * gatt_client){ 327026166ecfSMatthias Ringwald uint8_t status = ERROR_CODE_SUCCESS; 327126166ecfSMatthias Ringwald uint8_t gatt_client_supported_features = 0x06; // eatt + multiple value notifications 327226166ecfSMatthias Ringwald switch (gatt_client->eatt_state){ 32737627a0deSMatthias Ringwald case GATT_CLIENT_EATT_DISCOVER_GATT_SERVICE_W2_SEND: 32747627a0deSMatthias Ringwald gatt_client->gatt_service_start_group_handle = 0; 32757627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_DISCOVER_GATT_SERVICE_W4_DONE; 32767627a0deSMatthias Ringwald status = gatt_client_discover_primary_services_by_uuid16(&gatt_client_le_enhanced_packet_handler, 32777627a0deSMatthias Ringwald gatt_client->con_handle, 32787627a0deSMatthias Ringwald ORG_BLUETOOTH_SERVICE_GENERIC_ATTRIBUTE); 32797627a0deSMatthias Ringwald break; 328026166ecfSMatthias Ringwald case GATT_CLIENT_EATT_READ_SERVER_SUPPORTED_FEATURES_W2_SEND: 32817627a0deSMatthias Ringwald gatt_client->gatt_server_supported_features = 0; 32827627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_READ_SERVER_SUPPORTED_FEATURES_W4_DONE; 328326166ecfSMatthias Ringwald status = gatt_client_read_value_of_characteristics_by_uuid16(&gatt_client_le_enhanced_packet_handler, 32847627a0deSMatthias Ringwald gatt_client->con_handle, 32857627a0deSMatthias Ringwald gatt_client->gatt_service_start_group_handle, 32867627a0deSMatthias Ringwald gatt_client->gatt_service_end_group_handle, 328726166ecfSMatthias Ringwald ORG_BLUETOOTH_CHARACTERISTIC_SERVER_SUPPORTED_FEATURES); 328826166ecfSMatthias Ringwald return true; 328926166ecfSMatthias Ringwald case GATT_CLIENT_EATT_FIND_CLIENT_SUPPORTED_FEATURES_W2_SEND: 32907627a0deSMatthias Ringwald gatt_client->gatt_client_supported_features_handle = 0; 32917627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_FIND_CLIENT_SUPPORTED_FEATURES_W4_DONE; 329226166ecfSMatthias Ringwald status = gatt_client_discover_characteristics_for_handle_range_by_uuid16(&gatt_client_le_enhanced_packet_handler, 32937627a0deSMatthias Ringwald gatt_client->con_handle, 32947627a0deSMatthias Ringwald gatt_client->gatt_service_start_group_handle, 32957627a0deSMatthias Ringwald gatt_client->gatt_service_end_group_handle, 32967627a0deSMatthias Ringwald ORG_BLUETOOTH_CHARACTERISTIC_CLIENT_SUPPORTED_FEATURES); 329726166ecfSMatthias Ringwald return true; 329826166ecfSMatthias Ringwald case GATT_CLIENT_EATT_WRITE_ClIENT_SUPPORTED_FEATURES_W2_SEND: 329926166ecfSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_WRITE_ClIENT_SUPPORTED_FEATURES_W4_DONE; 330026166ecfSMatthias Ringwald status = gatt_client_write_value_of_characteristic(&gatt_client_le_enhanced_packet_handler, gatt_client->con_handle, 330126166ecfSMatthias Ringwald gatt_client->gatt_client_supported_features_handle, 1, 330226166ecfSMatthias Ringwald &gatt_client_supported_features); 330326166ecfSMatthias Ringwald return true; 330426166ecfSMatthias Ringwald default: 330526166ecfSMatthias Ringwald break; 330626166ecfSMatthias Ringwald } 33077627a0deSMatthias Ringwald btstack_assert(status == ERROR_CODE_SUCCESS); 33087627a0deSMatthias Ringwald UNUSED(status); 330926166ecfSMatthias Ringwald return false; 331026166ecfSMatthias Ringwald } 331126166ecfSMatthias Ringwald 331226166ecfSMatthias 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) { 331326166ecfSMatthias Ringwald gatt_client_t * gatt_client; 331426166ecfSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 331526166ecfSMatthias Ringwald if (status != ERROR_CODE_SUCCESS){ 331626166ecfSMatthias Ringwald return status; 331726166ecfSMatthias Ringwald } 331826166ecfSMatthias Ringwald 331926166ecfSMatthias Ringwald if (gatt_client->eatt_state != GATT_CLIENT_EATT_IDLE){ 332026166ecfSMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 332126166ecfSMatthias Ringwald } 332226166ecfSMatthias Ringwald 3323f7a42e72SMatthias Ringwald // need one buffer for sending and one for receiving. Receiving includes pre-buffer for reports 33247627a0deSMatthias Ringwald uint16_t buffer_size_per_client = storage_size / num_channels; 3325f7a42e72SMatthias Ringwald uint16_t max_mtu = (buffer_size_per_client - REPORT_PREBUFFER_HEADER) / 2; 3326f7a42e72SMatthias Ringwald if (max_mtu < 64) { 33277627a0deSMatthias Ringwald return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS; 33287627a0deSMatthias Ringwald } 33297627a0deSMatthias Ringwald 33307627a0deSMatthias Ringwald if ((num_channels == 0) || (num_channels > MAX_NR_EATT_CHANNELS)){ 33317627a0deSMatthias Ringwald return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS; 33327627a0deSMatthias Ringwald } 33337627a0deSMatthias Ringwald 33347627a0deSMatthias Ringwald // create max num_channel eatt clients 33357627a0deSMatthias Ringwald uint8_t i; 33367627a0deSMatthias Ringwald btstack_linked_list_t eatt_clients = NULL; 33377627a0deSMatthias Ringwald for (i=0;i<num_channels;i++) { 33387627a0deSMatthias Ringwald gatt_client_t * new_gatt_client = btstack_memory_gatt_client_get(); 33397627a0deSMatthias Ringwald if (new_gatt_client == NULL) { 33407627a0deSMatthias Ringwald break; 33417627a0deSMatthias Ringwald } 33427627a0deSMatthias Ringwald btstack_linked_list_add(&eatt_clients, (btstack_linked_item_t*)new_gatt_client); 33437627a0deSMatthias Ringwald } 33447627a0deSMatthias Ringwald 33457627a0deSMatthias Ringwald if (i != num_channels){ 33467627a0deSMatthias Ringwald while (true){ 33477627a0deSMatthias Ringwald gatt_client = (gatt_client_t *) btstack_linked_list_pop(&eatt_clients); 33487627a0deSMatthias Ringwald if (gatt_client == NULL) { 33497627a0deSMatthias Ringwald break; 33507627a0deSMatthias Ringwald } 33517627a0deSMatthias Ringwald btstack_memory_gatt_client_free(gatt_client); 33527627a0deSMatthias Ringwald } 33537627a0deSMatthias Ringwald return ERROR_CODE_MEMORY_CAPACITY_EXCEEDED; 33547627a0deSMatthias Ringwald } 33557627a0deSMatthias Ringwald 33567627a0deSMatthias Ringwald gatt_client->callback = callback; 33577627a0deSMatthias Ringwald gatt_client->eatt_num_clients = num_channels; 33587627a0deSMatthias Ringwald gatt_client->eatt_storage_buffer = storage_buffer; 33597627a0deSMatthias Ringwald gatt_client->eatt_storage_size = storage_size; 33607627a0deSMatthias Ringwald gatt_client->eatt_clients = eatt_clients; 33617627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_DISCOVER_GATT_SERVICE_W2_SEND; 336226166ecfSMatthias Ringwald gatt_client_notify_can_send_query(gatt_client); 336326166ecfSMatthias Ringwald 336426166ecfSMatthias Ringwald return ERROR_CODE_SUCCESS; 336526166ecfSMatthias Ringwald } 336626166ecfSMatthias Ringwald 336726166ecfSMatthias Ringwald #endif 336826166ecfSMatthias Ringwald 3369a6121b51SMilanka Ringwald #ifdef FUZZING_BUILD_MODE_UNSAFE_FOR_PRODUCTION 3370a6121b51SMilanka Ringwald void gatt_client_att_packet_handler_fuzz(uint8_t packet_type, uint16_t handle, uint8_t *packet, uint16_t size){ 3371a6121b51SMilanka Ringwald gatt_client_att_packet_handler(packet_type, handle, packet, size); 3372a6121b51SMilanka Ringwald } 3373ae1ee62dSMilanka Ringwald 337440faeb84SMilanka Ringwald uint8_t gatt_client_get_client(hci_con_handle_t con_handle, gatt_client_t ** out_gatt_client){ 337540faeb84SMilanka Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, out_gatt_client); 337640faeb84SMilanka Ringwald return status; 3377ae1ee62dSMilanka Ringwald } 3378a6121b51SMilanka Ringwald #endif 3379