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 8126166ecfSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 827627a0deSMatthias Ringwald static bool gatt_client_le_enhanced_handle_can_send_query(gatt_client_t * gatt_client); 8326166ecfSMatthias Ringwald #endif 8426166ecfSMatthias Ringwald 853deb3ec6SMatthias Ringwald void gatt_client_init(void){ 863deb3ec6SMatthias Ringwald gatt_client_connections = NULL; 87f4b33574SMatthias Ringwald 8811279da7SMatthias Ringwald // default configuration 8911279da7SMatthias Ringwald gatt_client_mtu_exchange_enabled = true; 9011279da7SMatthias Ringwald gatt_client_required_security_level = LEVEL_0; 9111279da7SMatthias Ringwald 9211279da7SMatthias Ringwald // register for HCI Events 93f4b33574SMatthias Ringwald hci_event_callback_registration.callback = &gatt_client_event_packet_handler; 94361b1363SMatthias Ringwald hci_add_event_handler(&hci_event_callback_registration); 95361b1363SMatthias Ringwald 96f4b33574SMatthias Ringwald // register for SM Events 97f4b33574SMatthias Ringwald sm_event_callback_registration.callback = &gatt_client_event_packet_handler; 98f4b33574SMatthias Ringwald sm_add_event_handler(&sm_event_callback_registration); 99f4b33574SMatthias Ringwald 100361b1363SMatthias Ringwald // and ATT Client PDUs 1013deb3ec6SMatthias Ringwald att_dispatch_register_client(gatt_client_att_packet_handler); 1023deb3ec6SMatthias Ringwald } 1033deb3ec6SMatthias Ringwald 10411279da7SMatthias Ringwald void gatt_client_set_required_security_level(gap_security_level_t level){ 10511279da7SMatthias Ringwald gatt_client_required_security_level = level; 10611279da7SMatthias Ringwald } 10711279da7SMatthias Ringwald 108ec820d77SMatthias Ringwald static gatt_client_t * gatt_client_for_timer(btstack_timer_source_t * ts){ 109665d90f2SMatthias Ringwald btstack_linked_list_iterator_t it; 110665d90f2SMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client_connections); 111665d90f2SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 1125cf1669fSMatthias Ringwald gatt_client_t * gatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it); 1135cf1669fSMatthias Ringwald if (&gatt_client->gc_timeout == ts) { 1145cf1669fSMatthias Ringwald return gatt_client; 1153deb3ec6SMatthias Ringwald } 1163deb3ec6SMatthias Ringwald } 1173deb3ec6SMatthias Ringwald return NULL; 1183deb3ec6SMatthias Ringwald } 1193deb3ec6SMatthias Ringwald 120ec820d77SMatthias Ringwald static void gatt_client_timeout_handler(btstack_timer_source_t * timer){ 1215cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_for_timer(timer); 1225cf1669fSMatthias Ringwald if (gatt_client == NULL) return; 1235cf1669fSMatthias Ringwald log_info("GATT client timeout handle, handle 0x%02x", gatt_client->con_handle); 1245cf1669fSMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, ATT_ERROR_TIMEOUT); 1253deb3ec6SMatthias Ringwald } 1263deb3ec6SMatthias Ringwald 1275cf1669fSMatthias Ringwald static void gatt_client_timeout_start(gatt_client_t * gatt_client){ 1285cf1669fSMatthias Ringwald log_info("GATT client timeout start, handle 0x%02x", gatt_client->con_handle); 1295cf1669fSMatthias Ringwald btstack_run_loop_remove_timer(&gatt_client->gc_timeout); 1305cf1669fSMatthias Ringwald btstack_run_loop_set_timer_handler(&gatt_client->gc_timeout, gatt_client_timeout_handler); 1315cf1669fSMatthias Ringwald btstack_run_loop_set_timer(&gatt_client->gc_timeout, 30000); // 30 seconds sm timeout 1325cf1669fSMatthias Ringwald btstack_run_loop_add_timer(&gatt_client->gc_timeout); 1333deb3ec6SMatthias Ringwald } 1343deb3ec6SMatthias Ringwald 1355cf1669fSMatthias Ringwald static void gatt_client_timeout_stop(gatt_client_t * gatt_client){ 1365cf1669fSMatthias Ringwald log_info("GATT client timeout stop, handle 0x%02x", gatt_client->con_handle); 1375cf1669fSMatthias Ringwald btstack_run_loop_remove_timer(&gatt_client->gc_timeout); 1383deb3ec6SMatthias Ringwald } 1393deb3ec6SMatthias Ringwald 1401dfae9c7SMatthias Ringwald static gap_security_level_t gatt_client_le_security_level_for_connection(hci_con_handle_t con_handle){ 1411dfae9c7SMatthias Ringwald uint8_t encryption_key_size = gap_encryption_key_size(con_handle); 1421dfae9c7SMatthias Ringwald if (encryption_key_size == 0) return LEVEL_0; 1431dfae9c7SMatthias Ringwald 144ff3f1026SMatthias Ringwald bool authenticated = gap_authenticated(con_handle); 1451dfae9c7SMatthias Ringwald if (!authenticated) return LEVEL_2; 1461dfae9c7SMatthias Ringwald 1471dfae9c7SMatthias Ringwald return encryption_key_size == 16 ? LEVEL_4 : LEVEL_3; 1481dfae9c7SMatthias Ringwald } 1491dfae9c7SMatthias Ringwald 1505cf1669fSMatthias Ringwald static gatt_client_t * gatt_client_get_context_for_handle(uint16_t handle){ 151665d90f2SMatthias Ringwald btstack_linked_item_t *it; 152a0da043fSMatthias Ringwald for (it = (btstack_linked_item_t *) gatt_client_connections; it != NULL; it = it->next){ 1535cf1669fSMatthias Ringwald gatt_client_t * gatt_client = (gatt_client_t *) it; 1545cf1669fSMatthias Ringwald if (gatt_client->con_handle == handle){ 1555cf1669fSMatthias Ringwald return gatt_client; 1563deb3ec6SMatthias Ringwald } 1573deb3ec6SMatthias Ringwald } 1583deb3ec6SMatthias Ringwald return NULL; 1593deb3ec6SMatthias Ringwald } 1603deb3ec6SMatthias Ringwald 1613deb3ec6SMatthias Ringwald 1626b65794dSMilanka Ringwald // @return gatt_client context 1633deb3ec6SMatthias Ringwald // returns existing one, or tries to setup new one 16440faeb84SMilanka Ringwald static uint8_t gatt_client_provide_context_for_handle(hci_con_handle_t con_handle, gatt_client_t ** out_gatt_client){ 1655cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_get_context_for_handle(con_handle); 16640faeb84SMilanka Ringwald 16740faeb84SMilanka Ringwald if (gatt_client != NULL){ 16840faeb84SMilanka Ringwald *out_gatt_client = gatt_client; 16940faeb84SMilanka Ringwald return ERROR_CODE_SUCCESS; 17040faeb84SMilanka Ringwald } 1713deb3ec6SMatthias Ringwald 172ae1d1237SMatthias Ringwald // bail if no such hci connection 1730e0bba86SMatthias Ringwald hci_connection_t * hci_connection = hci_connection_for_handle(con_handle); 1740e0bba86SMatthias Ringwald if (hci_connection == NULL){ 175ae1d1237SMatthias Ringwald log_error("No connection for handle 0x%04x", con_handle); 17640faeb84SMilanka Ringwald *out_gatt_client = NULL; 17740faeb84SMilanka Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 178ae1d1237SMatthias Ringwald } 17940faeb84SMilanka Ringwald 1805cf1669fSMatthias Ringwald gatt_client = btstack_memory_gatt_client_get(); 18140faeb84SMilanka Ringwald if (gatt_client == NULL){ 18240faeb84SMilanka Ringwald *out_gatt_client = NULL; 18340faeb84SMilanka Ringwald return ERROR_CODE_MEMORY_CAPACITY_EXCEEDED; 18440faeb84SMilanka Ringwald } 1853deb3ec6SMatthias Ringwald // init state 186e9cdf30bSMatthias Ringwald gatt_client->bearer_type = ATT_BEARER_UNENHANCED_LE; 1875cf1669fSMatthias Ringwald gatt_client->con_handle = con_handle; 1885cf1669fSMatthias Ringwald gatt_client->mtu = ATT_DEFAULT_MTU; 1891dfae9c7SMatthias Ringwald gatt_client->security_level = gatt_client_le_security_level_for_connection(con_handle); 19011279da7SMatthias Ringwald if (gatt_client_mtu_exchange_enabled){ 1915cf1669fSMatthias Ringwald gatt_client->mtu_state = SEND_MTU_EXCHANGE; 1925cf6c434SJakob Krantz } else { 1935cf1669fSMatthias Ringwald gatt_client->mtu_state = MTU_AUTO_EXCHANGE_DISABLED; 1945cf6c434SJakob Krantz } 1955cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_READY; 196cbd76cecSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 197cbd76cecSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_IDLE; 198cbd76cecSMatthias Ringwald #endif 1995cf1669fSMatthias Ringwald btstack_linked_list_add(&gatt_client_connections, (btstack_linked_item_t*)gatt_client); 2000e0bba86SMatthias Ringwald 2010e0bba86SMatthias Ringwald // get unenhanced att bearer state 2020e0bba86SMatthias Ringwald if (hci_connection->att_connection.mtu_exchanged){ 2030e0bba86SMatthias Ringwald gatt_client->mtu = hci_connection->att_connection.mtu; 2040e0bba86SMatthias Ringwald gatt_client->mtu_state = MTU_EXCHANGED; 2050e0bba86SMatthias Ringwald } 20640faeb84SMilanka Ringwald *out_gatt_client = gatt_client; 20740faeb84SMilanka Ringwald return ERROR_CODE_SUCCESS; 2083deb3ec6SMatthias Ringwald } 2093deb3ec6SMatthias Ringwald 210de27733dSMatthias Ringwald static bool is_ready(gatt_client_t * gatt_client){ 211de27733dSMatthias Ringwald return gatt_client->gatt_client_state == P_READY; 212de27733dSMatthias Ringwald } 213de27733dSMatthias Ringwald 214de27733dSMatthias Ringwald static uint8_t gatt_client_provide_context_for_request(hci_con_handle_t con_handle, gatt_client_t ** out_gatt_client){ 215de27733dSMatthias Ringwald gatt_client_t * gatt_client = NULL; 216de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 21740faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 21840faeb84SMilanka Ringwald return status; 21940faeb84SMilanka Ringwald } 220de27733dSMatthias Ringwald 2217627a0deSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 2227627a0deSMatthias Ringwald if (gatt_client->eatt_state == GATT_CLIENT_EATT_READY){ 2237627a0deSMatthias Ringwald btstack_linked_list_iterator_t it; 2247627a0deSMatthias Ringwald gatt_client_t * eatt_client = NULL; 2257627a0deSMatthias Ringwald // find free eatt client 2267627a0deSMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client->eatt_clients); 2277627a0deSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 2287627a0deSMatthias Ringwald gatt_client_t * client = (gatt_client_t *) btstack_linked_list_iterator_next(&it); 2297627a0deSMatthias Ringwald if (client->gatt_client_state == P_READY){ 2307627a0deSMatthias Ringwald eatt_client = client; 2317627a0deSMatthias Ringwald break; 2327627a0deSMatthias Ringwald } 2337627a0deSMatthias Ringwald } 2347627a0deSMatthias Ringwald if (eatt_client == NULL){ 2357627a0deSMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 2367627a0deSMatthias Ringwald } 2377627a0deSMatthias Ringwald gatt_client = eatt_client; 2387627a0deSMatthias Ringwald } 2397627a0deSMatthias Ringwald #endif 2407627a0deSMatthias Ringwald 241de27733dSMatthias Ringwald if (is_ready(gatt_client) == 0){ 242de27733dSMatthias Ringwald return GATT_CLIENT_IN_WRONG_STATE; 2433deb3ec6SMatthias Ringwald } 2443deb3ec6SMatthias Ringwald 245de27733dSMatthias Ringwald gatt_client_timeout_start(gatt_client); 246de27733dSMatthias Ringwald 247de27733dSMatthias Ringwald *out_gatt_client = gatt_client; 248de27733dSMatthias Ringwald 249de27733dSMatthias Ringwald return status; 2503deb3ec6SMatthias Ringwald } 2513deb3ec6SMatthias Ringwald 252fc64f94aSMatthias Ringwald int gatt_client_is_ready(hci_con_handle_t con_handle){ 25340faeb84SMilanka Ringwald gatt_client_t * gatt_client; 25440faeb84SMilanka Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 25540faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 25640faeb84SMilanka Ringwald return 0; 25740faeb84SMilanka Ringwald } 258aacf1b1aSMilanka Ringwald return is_ready(gatt_client) ? 1 : 0; 2593deb3ec6SMatthias Ringwald } 2603deb3ec6SMatthias Ringwald 2615cf6c434SJakob Krantz void gatt_client_mtu_enable_auto_negotiation(uint8_t enabled){ 26211279da7SMatthias Ringwald gatt_client_mtu_exchange_enabled = enabled != 0; 2635cf6c434SJakob Krantz } 2645cf6c434SJakob Krantz 265fc64f94aSMatthias Ringwald uint8_t gatt_client_get_mtu(hci_con_handle_t con_handle, uint16_t * mtu){ 26640faeb84SMilanka Ringwald gatt_client_t * gatt_client; 26740faeb84SMilanka Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 26840faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 26940faeb84SMilanka Ringwald return status; 27040faeb84SMilanka Ringwald } 2717d2258b3SMilanka Ringwald 2725cf1669fSMatthias Ringwald if ((gatt_client->mtu_state == MTU_EXCHANGED) || (gatt_client->mtu_state == MTU_AUTO_EXCHANGE_DISABLED)){ 2735cf1669fSMatthias Ringwald *mtu = gatt_client->mtu; 2747d2258b3SMilanka Ringwald return ERROR_CODE_SUCCESS; 2753deb3ec6SMatthias Ringwald } 2763deb3ec6SMatthias Ringwald *mtu = ATT_DEFAULT_MTU; 277616edd56SMatthias Ringwald return GATT_CLIENT_IN_WRONG_STATE; 2783deb3ec6SMatthias Ringwald } 2793deb3ec6SMatthias Ringwald 2807627a0deSMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC 2817627a0deSMatthias Ringwald // TODO: re-use single buffer for all eatt channels 2827627a0deSMatthias Ringwald static uint8_t gatt_client_le_enhanced_request_buffer[512]; 2837627a0deSMatthias Ringwald #endif 2847627a0deSMatthias Ringwald 2859228fd32SMatthias Ringwald static uint8_t *gatt_client_reserve_request_buffer(gatt_client_t *gatt_client) { 2867627a0deSMatthias Ringwald switch (gatt_client->bearer_type){ 2877627a0deSMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC 2887627a0deSMatthias Ringwald case ATT_BEARER_UNENHANCED_CLASSIC: 2897627a0deSMatthias Ringwald #endif 2907627a0deSMatthias Ringwald case ATT_BEARER_UNENHANCED_LE: 2919228fd32SMatthias Ringwald l2cap_reserve_packet_buffer(); 2929228fd32SMatthias Ringwald return l2cap_get_outgoing_buffer(); 2937627a0deSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 2947627a0deSMatthias Ringwald case ATT_BEARER_ENHANCED_LE: 2957627a0deSMatthias Ringwald return gatt_client->eatt_storage_buffer; 2967627a0deSMatthias Ringwald #endif 2977627a0deSMatthias Ringwald default: 2987627a0deSMatthias Ringwald btstack_unreachable(); 2997627a0deSMatthias Ringwald break; 3007627a0deSMatthias Ringwald } 3017627a0deSMatthias Ringwald return NULL; 3029228fd32SMatthias Ringwald } 3039228fd32SMatthias Ringwald 3043deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 3056e7b444cSMatthias Ringwald static uint8_t gatt_client_send(gatt_client_t * gatt_client, uint16_t len){ 30646012949SMatthias Ringwald switch (gatt_client->bearer_type){ 30746012949SMatthias Ringwald case ATT_BEARER_UNENHANCED_LE: 3086e7b444cSMatthias Ringwald return l2cap_send_prepared_connectionless(gatt_client->con_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL, len); 30946012949SMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC 31046012949SMatthias Ringwald case ATT_BEARER_UNENHANCED_CLASSIC: 31146012949SMatthias Ringwald return l2cap_send_prepared(gatt_client->l2cap_cid, len); 31246012949SMatthias Ringwald #endif 3137627a0deSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 3147627a0deSMatthias Ringwald case ATT_BEARER_ENHANCED_LE: 3157627a0deSMatthias Ringwald return l2cap_send(gatt_client->l2cap_cid, gatt_client->eatt_storage_buffer, len); 3167627a0deSMatthias Ringwald #endif 31746012949SMatthias Ringwald default: 31846012949SMatthias Ringwald btstack_unreachable(); 31946012949SMatthias Ringwald return ERROR_CODE_HARDWARE_FAILURE; 32046012949SMatthias Ringwald } 3213deb3ec6SMatthias Ringwald } 3223deb3ec6SMatthias Ringwald 3233deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 3246e7b444cSMatthias Ringwald static uint8_t att_confirmation(gatt_client_t * gatt_client) { 3259228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 3266e7b444cSMatthias Ringwald 3276e7b444cSMatthias Ringwald request[0] = ATT_HANDLE_VALUE_CONFIRMATION; 3286e7b444cSMatthias Ringwald 3296e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 1); 3306e7b444cSMatthias Ringwald } 3316e7b444cSMatthias Ringwald 3326e7b444cSMatthias Ringwald // precondition: can_send_packet_now == TRUE 3336e7b444cSMatthias Ringwald static uint8_t att_find_information_request(gatt_client_t *gatt_client, uint8_t request_type, uint16_t start_handle, 3346e7b444cSMatthias Ringwald uint16_t end_handle) { 3359228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 3366e7b444cSMatthias Ringwald 3373deb3ec6SMatthias Ringwald request[0] = request_type; 338f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, start_handle); 339f8fbdce0SMatthias Ringwald little_endian_store_16(request, 3, end_handle); 3403deb3ec6SMatthias Ringwald 3416e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 5); 3423deb3ec6SMatthias Ringwald } 3433deb3ec6SMatthias Ringwald 3443deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 3456e7b444cSMatthias Ringwald static uint8_t 3466e7b444cSMatthias Ringwald att_find_by_type_value_request(gatt_client_t *gatt_client, uint8_t request_type, uint16_t attribute_group_type, 3476e7b444cSMatthias Ringwald uint16_t start_handle, uint16_t end_handle, uint8_t *value, uint16_t value_size) { 3489228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 3493deb3ec6SMatthias Ringwald request[0] = request_type; 3509228fd32SMatthias Ringwald 351f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, start_handle); 352f8fbdce0SMatthias Ringwald little_endian_store_16(request, 3, end_handle); 353f8fbdce0SMatthias Ringwald little_endian_store_16(request, 5, attribute_group_type); 3546535961aSMatthias Ringwald (void)memcpy(&request[7], value, value_size); 3553deb3ec6SMatthias Ringwald 3566e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 7u + value_size); 3573deb3ec6SMatthias Ringwald } 3583deb3ec6SMatthias Ringwald 3593deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 3606e7b444cSMatthias Ringwald static uint8_t 3616e7b444cSMatthias Ringwald att_read_by_type_or_group_request_for_uuid16(gatt_client_t *gatt_client, uint8_t request_type, uint16_t uuid16, 3626e7b444cSMatthias Ringwald uint16_t start_handle, uint16_t end_handle) { 3639228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 3646e7b444cSMatthias Ringwald 3653deb3ec6SMatthias Ringwald request[0] = request_type; 366f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, start_handle); 367f8fbdce0SMatthias Ringwald little_endian_store_16(request, 3, end_handle); 368f8fbdce0SMatthias Ringwald little_endian_store_16(request, 5, uuid16); 3693deb3ec6SMatthias Ringwald 3706e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 7); 3713deb3ec6SMatthias Ringwald } 3723deb3ec6SMatthias Ringwald 3733deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 3746e7b444cSMatthias Ringwald static uint8_t 3756e7b444cSMatthias Ringwald att_read_by_type_or_group_request_for_uuid128(gatt_client_t *gatt_client, uint8_t request_type, const uint8_t *uuid128, 3766e7b444cSMatthias Ringwald uint16_t start_handle, uint16_t end_handle) { 3779228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 3786e7b444cSMatthias Ringwald 3793deb3ec6SMatthias Ringwald request[0] = request_type; 380f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, start_handle); 381f8fbdce0SMatthias Ringwald little_endian_store_16(request, 3, end_handle); 3829c80e4ccSMatthias Ringwald reverse_128(uuid128, &request[5]); 3833deb3ec6SMatthias Ringwald 3846e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 21); 3853deb3ec6SMatthias Ringwald } 3863deb3ec6SMatthias Ringwald 3873deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 3886e7b444cSMatthias Ringwald static uint8_t att_read_request(gatt_client_t *gatt_client, uint8_t request_type, uint16_t attribute_handle) { 3899228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 3906e7b444cSMatthias Ringwald 3913deb3ec6SMatthias Ringwald request[0] = request_type; 392f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, attribute_handle); 3933deb3ec6SMatthias Ringwald 3946e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 3); 3953deb3ec6SMatthias Ringwald } 3963deb3ec6SMatthias Ringwald 3973deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 3986e7b444cSMatthias Ringwald static uint8_t att_read_blob_request(gatt_client_t *gatt_client, uint8_t request_type, uint16_t attribute_handle, 3996e7b444cSMatthias Ringwald uint16_t value_offset) { 4009228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 4019228fd32SMatthias Ringwald 4023deb3ec6SMatthias Ringwald request[0] = request_type; 403f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, attribute_handle); 404f8fbdce0SMatthias Ringwald little_endian_store_16(request, 3, value_offset); 4053deb3ec6SMatthias Ringwald 4066e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 5); 4073deb3ec6SMatthias Ringwald } 4083deb3ec6SMatthias Ringwald 4096e7b444cSMatthias Ringwald static uint8_t 410f125a8efSMatthias Ringwald att_read_multiple_request_with_opcode(gatt_client_t *gatt_client, uint16_t num_value_handles, uint16_t *value_handles, uint8_t opcode) { 4119228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 4129228fd32SMatthias Ringwald 413f125a8efSMatthias Ringwald request[0] = opcode; 4149228fd32SMatthias Ringwald uint16_t i; 4159228fd32SMatthias Ringwald uint16_t offset = 1; 4163deb3ec6SMatthias Ringwald for (i=0;i<num_value_handles;i++){ 417f8fbdce0SMatthias Ringwald little_endian_store_16(request, offset, value_handles[i]); 4183deb3ec6SMatthias Ringwald offset += 2; 4193deb3ec6SMatthias Ringwald } 42025b7c058SMilanka Ringwald 4216e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, offset); 4223deb3ec6SMatthias Ringwald } 4233deb3ec6SMatthias Ringwald 424f125a8efSMatthias Ringwald static uint8_t 425f125a8efSMatthias Ringwald att_read_multiple_request(gatt_client_t *gatt_client, uint16_t num_value_handles, uint16_t *value_handles) { 426f125a8efSMatthias Ringwald return att_read_multiple_request_with_opcode(gatt_client, num_value_handles, value_handles, ATT_READ_MULTIPLE_REQUEST); 427f125a8efSMatthias Ringwald } 428f125a8efSMatthias Ringwald 429f125a8efSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 430f125a8efSMatthias Ringwald static uint8_t 431f125a8efSMatthias Ringwald att_read_multiple_variable_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_VARIABLE_REQ); 433f125a8efSMatthias Ringwald } 434f125a8efSMatthias Ringwald #endif 435f125a8efSMatthias Ringwald 4367a766ebfSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 4373deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 4386e7b444cSMatthias Ringwald static uint8_t att_signed_write_request(gatt_client_t *gatt_client, uint16_t request_type, uint16_t attribute_handle, 4396e7b444cSMatthias Ringwald uint16_t value_length, uint8_t *value, uint32_t sign_counter, uint8_t sgn[8]) { 4409228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 4419228fd32SMatthias Ringwald 4423deb3ec6SMatthias Ringwald request[0] = request_type; 443f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, attribute_handle); 4446535961aSMatthias Ringwald (void)memcpy(&request[3], value, value_length); 445f8fbdce0SMatthias Ringwald little_endian_store_32(request, 3 + value_length, sign_counter); 4469c80e4ccSMatthias Ringwald reverse_64(sgn, &request[3 + value_length + 4]); 44725b7c058SMilanka Ringwald 4486e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 3 + value_length + 12); 4493deb3ec6SMatthias Ringwald } 4507a766ebfSMatthias Ringwald #endif 4513deb3ec6SMatthias Ringwald 4523deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 4536e7b444cSMatthias Ringwald static uint8_t 4546e7b444cSMatthias Ringwald att_write_request(gatt_client_t *gatt_client, uint8_t request_type, uint16_t attribute_handle, uint16_t value_length, 4556e7b444cSMatthias Ringwald uint8_t *value) { 4569228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 4579228fd32SMatthias Ringwald 4583deb3ec6SMatthias Ringwald request[0] = request_type; 459f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, attribute_handle); 4606535961aSMatthias Ringwald (void)memcpy(&request[3], value, value_length); 4613deb3ec6SMatthias Ringwald 4626e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 3u + value_length); 4633deb3ec6SMatthias Ringwald } 4643deb3ec6SMatthias Ringwald 4653deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 4666e7b444cSMatthias Ringwald static uint8_t att_execute_write_request(gatt_client_t *gatt_client, uint8_t request_type, uint8_t execute_write) { 4679228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 4689228fd32SMatthias Ringwald 4693deb3ec6SMatthias Ringwald request[0] = request_type; 4703deb3ec6SMatthias Ringwald request[1] = execute_write; 47125b7c058SMilanka Ringwald 4726e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 2); 4733deb3ec6SMatthias Ringwald } 4743deb3ec6SMatthias Ringwald 4753deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 4766e7b444cSMatthias Ringwald static uint8_t att_prepare_write_request(gatt_client_t *gatt_client, uint8_t request_type, uint16_t attribute_handle, 4776e7b444cSMatthias Ringwald uint16_t value_offset, uint16_t blob_length, uint8_t *value) { 4789228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 4799228fd32SMatthias Ringwald 4803deb3ec6SMatthias Ringwald request[0] = request_type; 481f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, attribute_handle); 482f8fbdce0SMatthias Ringwald little_endian_store_16(request, 3, value_offset); 4836535961aSMatthias Ringwald (void)memcpy(&request[5], &value[value_offset], blob_length); 4843deb3ec6SMatthias Ringwald 4856e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 5u + blob_length); 4863deb3ec6SMatthias Ringwald } 4873deb3ec6SMatthias Ringwald 4886e7b444cSMatthias Ringwald static uint8_t att_exchange_mtu_request(gatt_client_t *gatt_client) { 4899228fd32SMatthias Ringwald uint8_t *request = gatt_client_reserve_request_buffer(gatt_client); 4909228fd32SMatthias Ringwald 4913deb3ec6SMatthias Ringwald request[0] = ATT_EXCHANGE_MTU_REQUEST; 4929228fd32SMatthias Ringwald uint16_t mtu = l2cap_max_le_mtu(); 493f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, mtu); 49425b7c058SMilanka Ringwald 4956e7b444cSMatthias Ringwald return gatt_client_send(gatt_client, 3); 4963deb3ec6SMatthias Ringwald } 4973deb3ec6SMatthias Ringwald 4985cf1669fSMatthias Ringwald static uint16_t write_blob_length(gatt_client_t * gatt_client){ 499dda77937SMatthias Ringwald uint16_t max_blob_length = gatt_client->mtu - 5u; 5005cf1669fSMatthias Ringwald if (gatt_client->attribute_offset >= gatt_client->attribute_length) { 5013deb3ec6SMatthias Ringwald return 0; 5023deb3ec6SMatthias Ringwald } 5035cf1669fSMatthias Ringwald uint16_t rest_length = gatt_client->attribute_length - gatt_client->attribute_offset; 5043deb3ec6SMatthias Ringwald if (max_blob_length > rest_length){ 5053deb3ec6SMatthias Ringwald return rest_length; 5063deb3ec6SMatthias Ringwald } 5073deb3ec6SMatthias Ringwald return max_blob_length; 5083deb3ec6SMatthias Ringwald } 5093deb3ec6SMatthias Ringwald 5105cf1669fSMatthias Ringwald static void send_gatt_services_request(gatt_client_t *gatt_client){ 5116e7b444cSMatthias Ringwald att_read_by_type_or_group_request_for_uuid16(gatt_client, ATT_READ_BY_GROUP_TYPE_REQUEST, 5126e7b444cSMatthias Ringwald gatt_client->uuid16, gatt_client->start_group_handle, 5136e7b444cSMatthias Ringwald gatt_client->end_group_handle); 5143deb3ec6SMatthias Ringwald } 5153deb3ec6SMatthias Ringwald 5165cf1669fSMatthias Ringwald static void send_gatt_by_uuid_request(gatt_client_t *gatt_client, uint16_t attribute_group_type){ 5175cf1669fSMatthias Ringwald if (gatt_client->uuid16){ 5183deb3ec6SMatthias Ringwald uint8_t uuid16[2]; 5195cf1669fSMatthias Ringwald little_endian_store_16(uuid16, 0, gatt_client->uuid16); 5206e7b444cSMatthias Ringwald att_find_by_type_value_request(gatt_client, ATT_FIND_BY_TYPE_VALUE_REQUEST, attribute_group_type, 5216e7b444cSMatthias Ringwald gatt_client->start_group_handle, gatt_client->end_group_handle, uuid16, 2); 5223deb3ec6SMatthias Ringwald return; 5233deb3ec6SMatthias Ringwald } 5243deb3ec6SMatthias Ringwald uint8_t uuid128[16]; 5255cf1669fSMatthias Ringwald reverse_128(gatt_client->uuid128, uuid128); 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, uuid128, 16); 5283deb3ec6SMatthias Ringwald } 5293deb3ec6SMatthias Ringwald 5305cf1669fSMatthias Ringwald static void send_gatt_services_by_uuid_request(gatt_client_t *gatt_client){ 5315cf1669fSMatthias Ringwald send_gatt_by_uuid_request(gatt_client, GATT_PRIMARY_SERVICE_UUID); 5323deb3ec6SMatthias Ringwald } 5333deb3ec6SMatthias Ringwald 5345cf1669fSMatthias Ringwald static void send_gatt_included_service_uuid_request(gatt_client_t *gatt_client){ 5356e7b444cSMatthias Ringwald att_read_request(gatt_client, ATT_READ_REQUEST, gatt_client->query_start_handle); 5363deb3ec6SMatthias Ringwald } 5373deb3ec6SMatthias Ringwald 5385cf1669fSMatthias Ringwald static void send_gatt_included_service_request(gatt_client_t *gatt_client){ 5396e7b444cSMatthias Ringwald att_read_by_type_or_group_request_for_uuid16(gatt_client, ATT_READ_BY_TYPE_REQUEST, 5406e7b444cSMatthias Ringwald GATT_INCLUDE_SERVICE_UUID, gatt_client->start_group_handle, 5416e7b444cSMatthias Ringwald gatt_client->end_group_handle); 5423deb3ec6SMatthias Ringwald } 5433deb3ec6SMatthias Ringwald 5445cf1669fSMatthias Ringwald static void send_gatt_characteristic_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_CHARACTERISTICS_UUID, gatt_client->start_group_handle, 5476e7b444cSMatthias Ringwald gatt_client->end_group_handle); 5483deb3ec6SMatthias Ringwald } 5493deb3ec6SMatthias Ringwald 5505cf1669fSMatthias Ringwald static void send_gatt_characteristic_descriptor_request(gatt_client_t *gatt_client){ 5516e7b444cSMatthias Ringwald att_find_information_request(gatt_client, ATT_FIND_INFORMATION_REQUEST, gatt_client->start_group_handle, 5526e7b444cSMatthias Ringwald gatt_client->end_group_handle); 5533deb3ec6SMatthias Ringwald } 5543deb3ec6SMatthias Ringwald 5555cf1669fSMatthias Ringwald static void send_gatt_read_characteristic_value_request(gatt_client_t *gatt_client){ 5566e7b444cSMatthias Ringwald att_read_request(gatt_client, ATT_READ_REQUEST, gatt_client->attribute_handle); 5573deb3ec6SMatthias Ringwald } 5583deb3ec6SMatthias Ringwald 5595cf1669fSMatthias Ringwald static void send_gatt_read_by_type_request(gatt_client_t * gatt_client){ 5605cf1669fSMatthias Ringwald if (gatt_client->uuid16){ 5616e7b444cSMatthias Ringwald att_read_by_type_or_group_request_for_uuid16(gatt_client, ATT_READ_BY_TYPE_REQUEST, 5626e7b444cSMatthias Ringwald gatt_client->uuid16, gatt_client->start_group_handle, 5636e7b444cSMatthias Ringwald gatt_client->end_group_handle); 5643deb3ec6SMatthias Ringwald } else { 5656e7b444cSMatthias Ringwald att_read_by_type_or_group_request_for_uuid128(gatt_client, ATT_READ_BY_TYPE_REQUEST, 5666e7b444cSMatthias Ringwald gatt_client->uuid128, gatt_client->start_group_handle, 5676e7b444cSMatthias Ringwald gatt_client->end_group_handle); 5683deb3ec6SMatthias Ringwald } 5693deb3ec6SMatthias Ringwald } 5703deb3ec6SMatthias Ringwald 5715cf1669fSMatthias Ringwald static void send_gatt_read_blob_request(gatt_client_t *gatt_client){ 57230952227SMilanka Ringwald if (gatt_client->attribute_offset == 0){ 5736e7b444cSMatthias Ringwald att_read_request(gatt_client, ATT_READ_REQUEST, gatt_client->attribute_handle); 57430952227SMilanka Ringwald } else { 5756e7b444cSMatthias Ringwald att_read_blob_request(gatt_client, ATT_READ_BLOB_REQUEST, gatt_client->attribute_handle, 5766e7b444cSMatthias Ringwald gatt_client->attribute_offset); 5773deb3ec6SMatthias Ringwald } 57830952227SMilanka Ringwald } 5793deb3ec6SMatthias Ringwald 5805cf1669fSMatthias Ringwald static void send_gatt_read_multiple_request(gatt_client_t * gatt_client){ 5816e7b444cSMatthias Ringwald att_read_multiple_request(gatt_client, gatt_client->read_multiple_handle_count, gatt_client->read_multiple_handles); 5823deb3ec6SMatthias Ringwald } 5833deb3ec6SMatthias Ringwald 584f125a8efSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 585f125a8efSMatthias Ringwald static void send_gatt_read_multiple_variable_request(gatt_client_t * gatt_client){ 586f125a8efSMatthias Ringwald att_read_multiple_variable_request(gatt_client, gatt_client->read_multiple_handle_count, gatt_client->read_multiple_handles); 587f125a8efSMatthias Ringwald } 588f125a8efSMatthias Ringwald #endif 589f125a8efSMatthias Ringwald 5905cf1669fSMatthias Ringwald static void send_gatt_write_attribute_value_request(gatt_client_t * gatt_client){ 5916e7b444cSMatthias Ringwald att_write_request(gatt_client, ATT_WRITE_REQUEST, gatt_client->attribute_handle, gatt_client->attribute_length, 5926e7b444cSMatthias Ringwald gatt_client->attribute_value); 5933deb3ec6SMatthias Ringwald } 5943deb3ec6SMatthias Ringwald 5955cf1669fSMatthias Ringwald static void send_gatt_write_client_characteristic_configuration_request(gatt_client_t * gatt_client){ 5966e7b444cSMatthias Ringwald att_write_request(gatt_client, ATT_WRITE_REQUEST, gatt_client->client_characteristic_configuration_handle, 2, 5976e7b444cSMatthias Ringwald gatt_client->client_characteristic_configuration_value); 5983deb3ec6SMatthias Ringwald } 5993deb3ec6SMatthias Ringwald 6005cf1669fSMatthias Ringwald static void send_gatt_prepare_write_request(gatt_client_t * gatt_client){ 6016e7b444cSMatthias Ringwald att_prepare_write_request(gatt_client, ATT_PREPARE_WRITE_REQUEST, gatt_client->attribute_handle, 6026e7b444cSMatthias Ringwald gatt_client->attribute_offset, write_blob_length(gatt_client), 6036e7b444cSMatthias Ringwald gatt_client->attribute_value); 6043deb3ec6SMatthias Ringwald } 6053deb3ec6SMatthias Ringwald 6065cf1669fSMatthias Ringwald static void send_gatt_execute_write_request(gatt_client_t * gatt_client){ 6076e7b444cSMatthias Ringwald att_execute_write_request(gatt_client, ATT_EXECUTE_WRITE_REQUEST, 1); 6083deb3ec6SMatthias Ringwald } 6093deb3ec6SMatthias Ringwald 6105cf1669fSMatthias Ringwald static void send_gatt_cancel_prepared_write_request(gatt_client_t * gatt_client){ 6116e7b444cSMatthias Ringwald att_execute_write_request(gatt_client, ATT_EXECUTE_WRITE_REQUEST, 0); 6123deb3ec6SMatthias Ringwald } 6133deb3ec6SMatthias Ringwald 614abdc9fb5SMatthias Ringwald #ifndef ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY 6155cf1669fSMatthias Ringwald static void send_gatt_read_client_characteristic_configuration_request(gatt_client_t * gatt_client){ 6166e7b444cSMatthias Ringwald att_read_by_type_or_group_request_for_uuid16(gatt_client, ATT_READ_BY_TYPE_REQUEST, 6176e7b444cSMatthias Ringwald GATT_CLIENT_CHARACTERISTICS_CONFIGURATION, 6186e7b444cSMatthias Ringwald gatt_client->start_group_handle, gatt_client->end_group_handle); 6193deb3ec6SMatthias Ringwald } 620abdc9fb5SMatthias Ringwald #endif 6213deb3ec6SMatthias Ringwald 6225cf1669fSMatthias Ringwald static void send_gatt_read_characteristic_descriptor_request(gatt_client_t * gatt_client){ 6236e7b444cSMatthias Ringwald att_read_request(gatt_client, ATT_READ_REQUEST, gatt_client->attribute_handle); 6243deb3ec6SMatthias Ringwald } 6253deb3ec6SMatthias Ringwald 6267a766ebfSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 6275cf1669fSMatthias Ringwald static void send_gatt_signed_write_request(gatt_client_t * gatt_client, uint32_t sign_counter){ 6286e7b444cSMatthias Ringwald att_signed_write_request(gatt_client, ATT_SIGNED_WRITE_COMMAND, gatt_client->attribute_handle, 6296e7b444cSMatthias Ringwald gatt_client->attribute_length, gatt_client->attribute_value, sign_counter, 6306e7b444cSMatthias Ringwald gatt_client->cmac); 6313deb3ec6SMatthias Ringwald } 6327a766ebfSMatthias Ringwald #endif 6333deb3ec6SMatthias Ringwald 6343deb3ec6SMatthias Ringwald static uint16_t get_last_result_handle_from_service_list(uint8_t * packet, uint16_t size){ 63539ac9711SMatthias Ringwald if (size < 2) return 0xffff; 6363deb3ec6SMatthias Ringwald uint8_t attr_length = packet[1]; 63739ac9711SMatthias Ringwald if ((2 + attr_length) > size) return 0xffff; 6384ea43905SMatthias Ringwald return little_endian_read_16(packet, size - attr_length + 2u); 6393deb3ec6SMatthias Ringwald } 6403deb3ec6SMatthias Ringwald 6413deb3ec6SMatthias Ringwald static uint16_t get_last_result_handle_from_characteristics_list(uint8_t * packet, uint16_t size){ 64239ac9711SMatthias Ringwald if (size < 2) return 0xffff; 6433deb3ec6SMatthias Ringwald uint8_t attr_length = packet[1]; 64439ac9711SMatthias Ringwald if ((2 + attr_length) > size) return 0xffff; 6454ea43905SMatthias Ringwald return little_endian_read_16(packet, size - attr_length + 3u); 6463deb3ec6SMatthias Ringwald } 6473deb3ec6SMatthias Ringwald 6483deb3ec6SMatthias Ringwald static uint16_t get_last_result_handle_from_included_services_list(uint8_t * packet, uint16_t size){ 64939ac9711SMatthias Ringwald if (size < 2) return 0xffff; 6503deb3ec6SMatthias Ringwald uint8_t attr_length = packet[1]; 65139ac9711SMatthias Ringwald if ((2 + attr_length) > size) return 0xffff; 652f8fbdce0SMatthias Ringwald return little_endian_read_16(packet, size - attr_length); 6533deb3ec6SMatthias Ringwald } 6543deb3ec6SMatthias Ringwald 65553e9c18fSMatthias Ringwald static void gatt_client_notify_can_send_query(gatt_client_t * gatt_client){ 65653e9c18fSMatthias Ringwald while (gatt_client->gatt_client_state == P_READY){ 65726166ecfSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 6587627a0deSMatthias Ringwald bool query_sent = gatt_client_le_enhanced_handle_can_send_query(gatt_client); 65926166ecfSMatthias Ringwald if (query_sent){ 66026166ecfSMatthias Ringwald continue; 66126166ecfSMatthias Ringwald } 66226166ecfSMatthias Ringwald #endif 66353e9c18fSMatthias Ringwald btstack_context_callback_registration_t * callback = (btstack_context_callback_registration_t *) btstack_linked_list_pop(&gatt_client->query_requests); 66409834412SMatthias Ringwald if (callback == NULL) { 66509834412SMatthias Ringwald return; 66653e9c18fSMatthias Ringwald } 66709834412SMatthias Ringwald (*callback->callback)(callback->context); 66853e9c18fSMatthias Ringwald } 66953e9c18fSMatthias Ringwald } 67053e9c18fSMatthias Ringwald 67123d583b8SMatthias Ringwald // test if notification/indication should be delivered to application (BLESA) 67223d583b8SMatthias Ringwald static bool gatt_client_accept_server_message(gatt_client_t *gatt_client) { 67323d583b8SMatthias Ringwald #ifdef ENABLE_LE_PROACTIVE_AUTHENTICATION 67423d583b8SMatthias Ringwald // ignore messages until re-encryption is complete 67523d583b8SMatthias Ringwald if (gap_reconnect_security_setup_active(gatt_client->con_handle)) return false; 67623d583b8SMatthias Ringwald 67723d583b8SMatthias Ringwald // after that ignore if bonded but not encrypted 67823d583b8SMatthias Ringwald return !gap_bonded(gatt_client->con_handle) || (gap_encryption_key_size(gatt_client->con_handle) > 0); 67923d583b8SMatthias Ringwald #else 68023d583b8SMatthias Ringwald UNUSED(gatt_client); 68123d583b8SMatthias Ringwald return true; 68223d583b8SMatthias Ringwald #endif 68323d583b8SMatthias Ringwald } 68423d583b8SMatthias Ringwald 6859c662c9bSMatthias Ringwald static void emit_event_new(btstack_packet_handler_t callback, uint8_t * packet, uint16_t size){ 6869c662c9bSMatthias Ringwald if (!callback) return; 68792da54c4SMatthias Ringwald hci_dump_packet(HCI_EVENT_PACKET, 1, packet, size); 6889c662c9bSMatthias Ringwald (*callback)(HCI_EVENT_PACKET, 0, packet, size); 6893deb3ec6SMatthias Ringwald } 6903deb3ec6SMatthias Ringwald 691711e6c80SMatthias Ringwald static void emit_event_to_registered_listeners(hci_con_handle_t con_handle, uint16_t attribute_handle, uint8_t * packet, uint16_t size){ 692665d90f2SMatthias Ringwald btstack_linked_list_iterator_t it; 6939c662c9bSMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client_value_listeners); 694665d90f2SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 69586c38559SMatthias Ringwald gatt_client_notification_t * notification = (gatt_client_notification_t*) btstack_linked_list_iterator_next(&it); 696b3f03c84SMatthias Ringwald if ((notification->con_handle != GATT_CLIENT_ANY_CONNECTION) && (notification->con_handle != con_handle)) continue; 697b3f03c84SMatthias Ringwald if ((notification->attribute_handle != GATT_CLIENT_ANY_VALUE_HANDLE) && (notification->attribute_handle != attribute_handle)) continue; 69886c38559SMatthias Ringwald (*notification->callback)(HCI_EVENT_PACKET, 0, packet, size); 6993deb3ec6SMatthias Ringwald } 7003deb3ec6SMatthias Ringwald } 7013deb3ec6SMatthias Ringwald 7025cf1669fSMatthias Ringwald static void emit_gatt_complete_event(gatt_client_t * gatt_client, uint8_t att_status){ 7033deb3ec6SMatthias Ringwald // @format H1 7043deb3ec6SMatthias Ringwald uint8_t packet[5]; 7055611a760SMatthias Ringwald packet[0] = GATT_EVENT_QUERY_COMPLETE; 7063deb3ec6SMatthias Ringwald packet[1] = 3; 7075cf1669fSMatthias Ringwald little_endian_store_16(packet, 2, gatt_client->con_handle); 7087d2258b3SMilanka Ringwald packet[4] = att_status; 7095cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, sizeof(packet)); 7103deb3ec6SMatthias Ringwald } 7113deb3ec6SMatthias Ringwald 712045d700dSDavid 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){ 7133deb3ec6SMatthias Ringwald // @format HX 7143deb3ec6SMatthias Ringwald uint8_t packet[24]; 7155611a760SMatthias Ringwald packet[0] = GATT_EVENT_SERVICE_QUERY_RESULT; 7164ea43905SMatthias Ringwald packet[1] = sizeof(packet) - 2u; 7175cf1669fSMatthias Ringwald little_endian_store_16(packet, 2, gatt_client->con_handle); 7183deb3ec6SMatthias Ringwald /// 719f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 4, start_group_handle); 720f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 6, end_group_handle); 7219c80e4ccSMatthias Ringwald reverse_128(uuid128, &packet[8]); 7225cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, sizeof(packet)); 7233deb3ec6SMatthias Ringwald } 7243deb3ec6SMatthias Ringwald 725045d700dSDavid 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){ 7263deb3ec6SMatthias Ringwald // @format HX 7273deb3ec6SMatthias Ringwald uint8_t packet[26]; 7285611a760SMatthias Ringwald packet[0] = GATT_EVENT_INCLUDED_SERVICE_QUERY_RESULT; 7294ea43905SMatthias Ringwald packet[1] = sizeof(packet) - 2u; 7305cf1669fSMatthias Ringwald little_endian_store_16(packet, 2, gatt_client->con_handle); 7313deb3ec6SMatthias Ringwald /// 732f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 4, include_handle); 7333deb3ec6SMatthias Ringwald // 734f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 6, start_group_handle); 735f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 8, end_group_handle); 7369c80e4ccSMatthias Ringwald reverse_128(uuid128, &packet[10]); 7375cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, sizeof(packet)); 7383deb3ec6SMatthias Ringwald } 7393deb3ec6SMatthias Ringwald 7405cf1669fSMatthias 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, 741045d700dSDavid Lechner uint16_t properties, const uint8_t * uuid128){ 7423deb3ec6SMatthias Ringwald // @format HY 7433deb3ec6SMatthias Ringwald uint8_t packet[28]; 7445611a760SMatthias Ringwald packet[0] = GATT_EVENT_CHARACTERISTIC_QUERY_RESULT; 7454ea43905SMatthias Ringwald packet[1] = sizeof(packet) - 2u; 7465cf1669fSMatthias Ringwald little_endian_store_16(packet, 2, gatt_client->con_handle); 7473deb3ec6SMatthias Ringwald /// 748f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 4, start_handle); 749f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 6, value_handle); 750f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 8, end_handle); 751f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 10, properties); 7529c80e4ccSMatthias Ringwald reverse_128(uuid128, &packet[12]); 7535cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, sizeof(packet)); 7543deb3ec6SMatthias Ringwald } 7553deb3ec6SMatthias Ringwald 7563deb3ec6SMatthias Ringwald static void emit_gatt_all_characteristic_descriptors_result_event( 757045d700dSDavid Lechner gatt_client_t * gatt_client, uint16_t descriptor_handle, const uint8_t * uuid128){ 7583deb3ec6SMatthias Ringwald // @format HZ 7593deb3ec6SMatthias Ringwald uint8_t packet[22]; 7605611a760SMatthias Ringwald packet[0] = GATT_EVENT_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY_RESULT; 7614ea43905SMatthias Ringwald packet[1] = sizeof(packet) - 2u; 7625cf1669fSMatthias Ringwald little_endian_store_16(packet, 2, gatt_client->con_handle); 7633deb3ec6SMatthias Ringwald /// 764f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 4, descriptor_handle); 7659c80e4ccSMatthias Ringwald reverse_128(uuid128, &packet[6]); 7665cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, sizeof(packet)); 7673deb3ec6SMatthias Ringwald } 7683deb3ec6SMatthias Ringwald 7695cf1669fSMatthias Ringwald static void emit_gatt_mtu_exchanged_result_event(gatt_client_t * gatt_client, uint16_t new_mtu){ 7708f37572aSJakob Krantz // @format H2 7718f37572aSJakob Krantz uint8_t packet[6]; 7728f37572aSJakob Krantz packet[0] = GATT_EVENT_MTU; 7734ea43905SMatthias Ringwald packet[1] = sizeof(packet) - 2u; 7745cf1669fSMatthias Ringwald little_endian_store_16(packet, 2, gatt_client->con_handle); 7758f37572aSJakob Krantz little_endian_store_16(packet, 4, new_mtu); 7765cf1669fSMatthias Ringwald att_dispatch_client_mtu_exchanged(gatt_client->con_handle, new_mtu); 7775cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, sizeof(packet)); 7788f37572aSJakob Krantz } 77923d583b8SMatthias Ringwald 78023d583b8SMatthias Ringwald // helper 78123d583b8SMatthias Ringwald static void gatt_client_handle_transaction_complete(gatt_client_t *gatt_client, uint8_t att_status) { 78223d583b8SMatthias Ringwald gatt_client->gatt_client_state = P_READY; 78323d583b8SMatthias Ringwald gatt_client_timeout_stop(gatt_client); 78423d583b8SMatthias Ringwald emit_gatt_complete_event(gatt_client, att_status); 78523d583b8SMatthias Ringwald gatt_client_notify_can_send_query(gatt_client); 78623d583b8SMatthias Ringwald } 78723d583b8SMatthias Ringwald 78823d583b8SMatthias Ringwald // @return packet pointer 78923d583b8SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite HCI + L2CAP packet headers 79023d583b8SMatthias Ringwald #define CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE 8 79123d583b8SMatthias 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){ 79223d583b8SMatthias Ringwald #ifdef FUZZING_BUILD_MODE_UNSAFE_FOR_PRODUCTION 79323d583b8SMatthias Ringwald // copy value into test packet for testing 79423d583b8SMatthias Ringwald static uint8_t packet[1000]; 79523d583b8SMatthias Ringwald memcpy(&packet[8], value, length); 79623d583b8SMatthias Ringwald #else 79723d583b8SMatthias Ringwald // before the value inside the ATT PDU 79823d583b8SMatthias Ringwald uint8_t * packet = value - CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE; 79923d583b8SMatthias Ringwald #endif 80023d583b8SMatthias Ringwald packet[0] = type; 80123d583b8SMatthias Ringwald packet[1] = CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE - 2 + length; 80223d583b8SMatthias Ringwald little_endian_store_16(packet, 2, con_handle); 80323d583b8SMatthias Ringwald little_endian_store_16(packet, 4, attribute_handle); 80423d583b8SMatthias Ringwald little_endian_store_16(packet, 6, length); 80523d583b8SMatthias Ringwald return packet; 80623d583b8SMatthias Ringwald } 80723d583b8SMatthias Ringwald 80823d583b8SMatthias Ringwald // @return packet pointer 80923d583b8SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite parts of the HCI/L2CAP/ATT packet (4/4/3) bytes 81023d583b8SMatthias Ringwald #define LONG_CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE 10 81123d583b8SMatthias 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){ 81223d583b8SMatthias Ringwald #ifdef FUZZING_BUILD_MODE_UNSAFE_FOR_PRODUCTION 81323d583b8SMatthias Ringwald // avoid using pre ATT headers. 81423d583b8SMatthias Ringwald return NULL; 81523d583b8SMatthias Ringwald #endif 81623d583b8SMatthias 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) 81723d583b8SMatthias Ringwald // before the value inside the ATT PDU 81823d583b8SMatthias Ringwald uint8_t * packet = value - LONG_CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE; 81923d583b8SMatthias Ringwald packet[0] = type; 82023d583b8SMatthias Ringwald packet[1] = LONG_CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE - 2 + length; 82123d583b8SMatthias Ringwald little_endian_store_16(packet, 2, con_handle); 82223d583b8SMatthias Ringwald little_endian_store_16(packet, 4, attribute_handle); 82323d583b8SMatthias Ringwald little_endian_store_16(packet, 6, offset); 82423d583b8SMatthias Ringwald little_endian_store_16(packet, 8, length); 82523d583b8SMatthias Ringwald return packet; 82623d583b8SMatthias Ringwald #else 82723d583b8SMatthias Ringwald log_error("HCI_INCOMING_PRE_BUFFER_SIZE >= 2 required for long characteristic reads"); 82823d583b8SMatthias Ringwald return NULL; 82923d583b8SMatthias Ringwald #endif 83023d583b8SMatthias Ringwald } 83123d583b8SMatthias Ringwald 832f7a42e72SMatthias Ringwald #if (LONG_CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE > CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE) 833f7a42e72SMatthias Ringwald #define REPORT_PREBUFFER_HEADER LONG_CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE 834f7a42e72SMatthias Ringwald #else 835f7a42e72SMatthias Ringwald #define REPORT_PREBUFFER_HEADER CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE 836f7a42e72SMatthias Ringwald #endif 837f7a42e72SMatthias Ringwald 8388f37572aSJakob Krantz /// 8395cf1669fSMatthias Ringwald static void report_gatt_services(gatt_client_t * gatt_client, uint8_t * packet, uint16_t size){ 84039ac9711SMatthias Ringwald if (size < 2) return; 8413deb3ec6SMatthias Ringwald uint8_t attr_length = packet[1]; 8424ea43905SMatthias Ringwald uint8_t uuid_length = attr_length - 4u; 8433deb3ec6SMatthias Ringwald 8443deb3ec6SMatthias Ringwald int i; 84539ac9711SMatthias Ringwald for (i = 2; (i+attr_length) <= size; i += attr_length){ 846f8fbdce0SMatthias Ringwald uint16_t start_group_handle = little_endian_read_16(packet,i); 847f8fbdce0SMatthias Ringwald uint16_t end_group_handle = little_endian_read_16(packet,i+2); 8483deb3ec6SMatthias Ringwald uint8_t uuid128[16]; 8493deb3ec6SMatthias Ringwald uint16_t uuid16 = 0; 8503deb3ec6SMatthias Ringwald 8514ea43905SMatthias Ringwald if (uuid_length == 2u){ 852f8fbdce0SMatthias Ringwald uuid16 = little_endian_read_16(packet, i+4); 853e1a125dfSMatthias Ringwald uuid_add_bluetooth_prefix((uint8_t*) &uuid128, uuid16); 85439ac9711SMatthias Ringwald } else if (uuid_length == 16u) { 8559c80e4ccSMatthias Ringwald reverse_128(&packet[i+4], uuid128); 85639ac9711SMatthias Ringwald } else { 85739ac9711SMatthias Ringwald return; 8583deb3ec6SMatthias Ringwald } 8595cf1669fSMatthias Ringwald emit_gatt_service_query_result_event(gatt_client, start_group_handle, end_group_handle, uuid128); 8603deb3ec6SMatthias Ringwald } 8613deb3ec6SMatthias Ringwald } 8623deb3ec6SMatthias Ringwald 86323d583b8SMatthias 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){ 8643deb3ec6SMatthias Ringwald uint8_t uuid128[16]; 8653deb3ec6SMatthias Ringwald uint16_t uuid16 = 0; 8664ea43905SMatthias Ringwald if (uuid_length == 2u){ 867f8fbdce0SMatthias Ringwald uuid16 = little_endian_read_16(uuid, 0); 868e1a125dfSMatthias Ringwald uuid_add_bluetooth_prefix((uint8_t*) uuid128, uuid16); 8694ea43905SMatthias Ringwald } else if (uuid_length == 16u){ 8709c80e4ccSMatthias Ringwald reverse_128(uuid, uuid128); 871d73c9dbeSMilanka Ringwald } else { 872d73c9dbeSMilanka Ringwald return; 8733deb3ec6SMatthias Ringwald } 8743deb3ec6SMatthias Ringwald 8755cf1669fSMatthias Ringwald if (gatt_client->filter_with_uuid && (memcmp(gatt_client->uuid128, uuid128, 16) != 0)) return; 8763deb3ec6SMatthias Ringwald 8775cf1669fSMatthias Ringwald gatt_client->characteristic_properties = properties; 8785cf1669fSMatthias Ringwald gatt_client->characteristic_start_handle = start_handle; 8795cf1669fSMatthias Ringwald gatt_client->attribute_handle = value_handle; 8803deb3ec6SMatthias Ringwald 8815cf1669fSMatthias Ringwald if (gatt_client->filter_with_uuid) return; 8823deb3ec6SMatthias Ringwald 8835cf1669fSMatthias Ringwald gatt_client->uuid16 = uuid16; 8845cf1669fSMatthias Ringwald (void)memcpy(gatt_client->uuid128, uuid128, 16); 8853deb3ec6SMatthias Ringwald } 8863deb3ec6SMatthias Ringwald 88723d583b8SMatthias Ringwald static void report_gatt_characteristic_end_found(gatt_client_t * gatt_client, uint16_t end_handle){ 8883deb3ec6SMatthias Ringwald // TODO: stop searching if filter and uuid found 8893deb3ec6SMatthias Ringwald 8905cf1669fSMatthias Ringwald if (!gatt_client->characteristic_start_handle) return; 8913deb3ec6SMatthias Ringwald 8925cf1669fSMatthias Ringwald emit_gatt_characteristic_query_result_event(gatt_client, gatt_client->characteristic_start_handle, gatt_client->attribute_handle, 8935cf1669fSMatthias Ringwald end_handle, gatt_client->characteristic_properties, gatt_client->uuid128); 8943deb3ec6SMatthias Ringwald 8955cf1669fSMatthias Ringwald gatt_client->characteristic_start_handle = 0; 8963deb3ec6SMatthias Ringwald } 8973deb3ec6SMatthias Ringwald 89823d583b8SMatthias Ringwald 8995cf1669fSMatthias Ringwald static void report_gatt_characteristics(gatt_client_t * gatt_client, uint8_t * packet, uint16_t size){ 9004ea43905SMatthias Ringwald if (size < 2u) return; 9013deb3ec6SMatthias Ringwald uint8_t attr_length = packet[1]; 9024ea43905SMatthias Ringwald if ((attr_length != 7u) && (attr_length != 21u)) return; 9034ea43905SMatthias Ringwald uint8_t uuid_length = attr_length - 5u; 9043deb3ec6SMatthias Ringwald int i; 9054ea43905SMatthias Ringwald for (i = 2u; (i + attr_length) <= size; i += attr_length){ 906f8fbdce0SMatthias Ringwald uint16_t start_handle = little_endian_read_16(packet, i); 9073deb3ec6SMatthias Ringwald uint8_t properties = packet[i+2]; 908f8fbdce0SMatthias Ringwald uint16_t value_handle = little_endian_read_16(packet, i+3); 90923d583b8SMatthias Ringwald report_gatt_characteristic_end_found(gatt_client, start_handle - 1u); 91023d583b8SMatthias Ringwald report_gatt_characteristic_start_found(gatt_client, start_handle, properties, value_handle, &packet[i + 5], 91123d583b8SMatthias Ringwald uuid_length); 9123deb3ec6SMatthias Ringwald } 9133deb3ec6SMatthias Ringwald } 9143deb3ec6SMatthias Ringwald 9155cf1669fSMatthias Ringwald static void report_gatt_included_service_uuid16(gatt_client_t * gatt_client, uint16_t include_handle, uint16_t uuid16){ 9163deb3ec6SMatthias Ringwald uint8_t normalized_uuid128[16]; 917e1a125dfSMatthias Ringwald uuid_add_bluetooth_prefix(normalized_uuid128, uuid16); 9185cf1669fSMatthias Ringwald emit_gatt_included_service_query_result_event(gatt_client, include_handle, gatt_client->query_start_handle, 9195cf1669fSMatthias Ringwald gatt_client->query_end_handle, normalized_uuid128); 9203deb3ec6SMatthias Ringwald } 9213deb3ec6SMatthias Ringwald 922045d700dSDavid Lechner static void report_gatt_included_service_uuid128(gatt_client_t * gatt_client, uint16_t include_handle, const uint8_t * uuid128){ 9235cf1669fSMatthias Ringwald emit_gatt_included_service_query_result_event(gatt_client, include_handle, gatt_client->query_start_handle, 9245cf1669fSMatthias Ringwald gatt_client->query_end_handle, uuid128); 9253deb3ec6SMatthias Ringwald } 9263deb3ec6SMatthias Ringwald 9273deb3ec6SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite parts of the HCI/L2CAP/ATT packet (4/4/3) bytes 9280fde3c5eSMatthias Ringwald static void report_gatt_notification(gatt_client_t *gatt_client, uint16_t value_handle, uint8_t *value, int length) { 9290fde3c5eSMatthias Ringwald if (!gatt_client_accept_server_message(gatt_client)) return; 9300fde3c5eSMatthias Ringwald uint8_t * packet = setup_characteristic_value_packet(GATT_EVENT_NOTIFICATION, gatt_client->con_handle, value_handle, value, length); 93123d583b8SMatthias Ringwald emit_event_to_registered_listeners(gatt_client->con_handle, value_handle, packet, CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE + length); 9323deb3ec6SMatthias Ringwald } 9333deb3ec6SMatthias Ringwald 9343deb3ec6SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite parts of the HCI/L2CAP/ATT packet (4/4/3) bytes 9350fde3c5eSMatthias Ringwald static void report_gatt_indication(gatt_client_t *gatt_client, uint16_t value_handle, uint8_t *value, int length) { 9360fde3c5eSMatthias Ringwald if (!gatt_client_accept_server_message(gatt_client)) return; 9370fde3c5eSMatthias Ringwald uint8_t * packet = setup_characteristic_value_packet(GATT_EVENT_INDICATION, gatt_client->con_handle, value_handle, value, length); 93823d583b8SMatthias Ringwald emit_event_to_registered_listeners(gatt_client->con_handle, value_handle, packet, CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE + length); 9393deb3ec6SMatthias Ringwald } 9403deb3ec6SMatthias Ringwald 9413deb3ec6SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite parts of the HCI/L2CAP/ATT packet (4/4/3) bytes 9425cf1669fSMatthias Ringwald static void report_gatt_characteristic_value(gatt_client_t * gatt_client, uint16_t attribute_handle, uint8_t * value, uint16_t length){ 9435cf1669fSMatthias Ringwald uint8_t * packet = setup_characteristic_value_packet(GATT_EVENT_CHARACTERISTIC_VALUE_QUERY_RESULT, gatt_client->con_handle, attribute_handle, value, length); 94423d583b8SMatthias Ringwald emit_event_new(gatt_client->callback, packet, CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE + length); 9453deb3ec6SMatthias Ringwald } 9463deb3ec6SMatthias Ringwald 9473deb3ec6SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite parts of the HCI/L2CAP/ATT packet (4/4/3) bytes 9485cf1669fSMatthias 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){ 9495cf1669fSMatthias 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); 9503deb3ec6SMatthias Ringwald if (!packet) return; 95123d583b8SMatthias Ringwald emit_event_new(gatt_client->callback, packet, blob_length + LONG_CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE); 9523deb3ec6SMatthias Ringwald } 9533deb3ec6SMatthias Ringwald 9545cf1669fSMatthias 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){ 9559ec2630cSMatthias Ringwald UNUSED(value_offset); 9565cf1669fSMatthias Ringwald uint8_t * packet = setup_characteristic_value_packet(GATT_EVENT_CHARACTERISTIC_DESCRIPTOR_QUERY_RESULT, gatt_client->con_handle, descriptor_handle, value, value_length); 9575cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, value_length + 8u); 9583deb3ec6SMatthias Ringwald } 9593deb3ec6SMatthias Ringwald 9605cf1669fSMatthias 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){ 9615cf1669fSMatthias 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); 9623deb3ec6SMatthias Ringwald if (!packet) return; 96323d583b8SMatthias Ringwald emit_event_new(gatt_client->callback, packet, blob_length + LONG_CHARACTERISTIC_VALUE_EVENT_HEADER_SIZE); 9643deb3ec6SMatthias Ringwald } 9653deb3ec6SMatthias Ringwald 9665cf1669fSMatthias Ringwald static void report_gatt_all_characteristic_descriptors(gatt_client_t * gatt_client, uint8_t * packet, uint16_t size, uint16_t pair_size){ 9673deb3ec6SMatthias Ringwald int i; 9684ea43905SMatthias Ringwald for (i = 0u; (i + pair_size) <= size; i += pair_size){ 969f8fbdce0SMatthias Ringwald uint16_t descriptor_handle = little_endian_read_16(packet,i); 9703deb3ec6SMatthias Ringwald uint8_t uuid128[16]; 9713deb3ec6SMatthias Ringwald uint16_t uuid16 = 0; 9724ea43905SMatthias Ringwald if (pair_size == 4u){ 973f8fbdce0SMatthias Ringwald uuid16 = little_endian_read_16(packet,i+2); 974e1a125dfSMatthias Ringwald uuid_add_bluetooth_prefix(uuid128, uuid16); 9753deb3ec6SMatthias Ringwald } else { 9769c80e4ccSMatthias Ringwald reverse_128(&packet[i+2], uuid128); 9773deb3ec6SMatthias Ringwald } 9785cf1669fSMatthias Ringwald emit_gatt_all_characteristic_descriptors_result_event(gatt_client, descriptor_handle, uuid128); 9793deb3ec6SMatthias Ringwald } 9803deb3ec6SMatthias Ringwald 9813deb3ec6SMatthias Ringwald } 9823deb3ec6SMatthias Ringwald 9835cf1669fSMatthias Ringwald static int is_query_done(gatt_client_t * gatt_client, uint16_t last_result_handle){ 9845cf1669fSMatthias Ringwald return last_result_handle >= gatt_client->end_group_handle; 9853deb3ec6SMatthias Ringwald } 9863deb3ec6SMatthias Ringwald 9875cf1669fSMatthias Ringwald static void trigger_next_query(gatt_client_t * gatt_client, uint16_t last_result_handle, gatt_client_state_t next_query_state){ 9885cf1669fSMatthias Ringwald if (is_query_done(gatt_client, last_result_handle)){ 989526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 9903deb3ec6SMatthias Ringwald return; 9913deb3ec6SMatthias Ringwald } 9923deb3ec6SMatthias Ringwald // next 9935cf1669fSMatthias Ringwald gatt_client->start_group_handle = last_result_handle + 1u; 9945cf1669fSMatthias Ringwald gatt_client->gatt_client_state = next_query_state; 9953deb3ec6SMatthias Ringwald } 9963deb3ec6SMatthias Ringwald 9975cf1669fSMatthias Ringwald static void trigger_next_included_service_query(gatt_client_t * gatt_client, uint16_t last_result_handle){ 9985cf1669fSMatthias Ringwald trigger_next_query(gatt_client, last_result_handle, P_W2_SEND_INCLUDED_SERVICE_QUERY); 9993deb3ec6SMatthias Ringwald } 10003deb3ec6SMatthias Ringwald 10015cf1669fSMatthias Ringwald static void trigger_next_service_query(gatt_client_t * gatt_client, uint16_t last_result_handle){ 10025cf1669fSMatthias Ringwald trigger_next_query(gatt_client, last_result_handle, P_W2_SEND_SERVICE_QUERY); 10033deb3ec6SMatthias Ringwald } 10043deb3ec6SMatthias Ringwald 10055cf1669fSMatthias Ringwald static void trigger_next_service_by_uuid_query(gatt_client_t * gatt_client, uint16_t last_result_handle){ 10065cf1669fSMatthias Ringwald trigger_next_query(gatt_client, last_result_handle, P_W2_SEND_SERVICE_WITH_UUID_QUERY); 10073deb3ec6SMatthias Ringwald } 10083deb3ec6SMatthias Ringwald 10095cf1669fSMatthias Ringwald static void trigger_next_characteristic_query(gatt_client_t * gatt_client, uint16_t last_result_handle){ 10105cf1669fSMatthias Ringwald if (is_query_done(gatt_client, last_result_handle)){ 10113deb3ec6SMatthias Ringwald // report last characteristic 101223d583b8SMatthias Ringwald report_gatt_characteristic_end_found(gatt_client, gatt_client->end_group_handle); 10133deb3ec6SMatthias Ringwald } 10145cf1669fSMatthias Ringwald trigger_next_query(gatt_client, last_result_handle, P_W2_SEND_ALL_CHARACTERISTICS_OF_SERVICE_QUERY); 10153deb3ec6SMatthias Ringwald } 10163deb3ec6SMatthias Ringwald 10175cf1669fSMatthias Ringwald static void trigger_next_characteristic_descriptor_query(gatt_client_t * gatt_client, uint16_t last_result_handle){ 10185cf1669fSMatthias Ringwald trigger_next_query(gatt_client, last_result_handle, P_W2_SEND_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY); 10193deb3ec6SMatthias Ringwald } 10203deb3ec6SMatthias Ringwald 10215cf1669fSMatthias Ringwald static void trigger_next_read_by_type_query(gatt_client_t * gatt_client, uint16_t last_result_handle){ 10225cf1669fSMatthias Ringwald trigger_next_query(gatt_client, last_result_handle, P_W2_SEND_READ_BY_TYPE_REQUEST); 10233deb3ec6SMatthias Ringwald } 10243deb3ec6SMatthias Ringwald 10255cf1669fSMatthias 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){ 10265cf1669fSMatthias Ringwald gatt_client->attribute_offset += write_blob_length(gatt_client); 10275cf1669fSMatthias Ringwald uint16_t next_blob_length = write_blob_length(gatt_client); 10283deb3ec6SMatthias Ringwald 10294ea43905SMatthias Ringwald if (next_blob_length == 0u){ 10305cf1669fSMatthias Ringwald gatt_client->gatt_client_state = done_state; 10313deb3ec6SMatthias Ringwald return; 10323deb3ec6SMatthias Ringwald } 10335cf1669fSMatthias Ringwald gatt_client->gatt_client_state = next_query_state; 10343deb3ec6SMatthias Ringwald } 10353deb3ec6SMatthias Ringwald 10365cf1669fSMatthias Ringwald static void trigger_next_blob_query(gatt_client_t * gatt_client, gatt_client_state_t next_query_state, uint16_t received_blob_length){ 10373deb3ec6SMatthias Ringwald 1038dda77937SMatthias Ringwald uint16_t max_blob_length = gatt_client->mtu - 1u; 10393deb3ec6SMatthias Ringwald if (received_blob_length < max_blob_length){ 1040526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 10413deb3ec6SMatthias Ringwald return; 10423deb3ec6SMatthias Ringwald } 10433deb3ec6SMatthias Ringwald 10445cf1669fSMatthias Ringwald gatt_client->attribute_offset += received_blob_length; 10455cf1669fSMatthias Ringwald gatt_client->gatt_client_state = next_query_state; 10463deb3ec6SMatthias Ringwald } 10473deb3ec6SMatthias Ringwald 104823d583b8SMatthias 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){ 104923d583b8SMatthias Ringwald notification->callback = callback; 105023d583b8SMatthias Ringwald notification->con_handle = con_handle; 105123d583b8SMatthias Ringwald if (characteristic == NULL){ 105223d583b8SMatthias Ringwald notification->attribute_handle = GATT_CLIENT_ANY_VALUE_HANDLE; 105323d583b8SMatthias Ringwald } else { 105423d583b8SMatthias Ringwald notification->attribute_handle = characteristic->value_handle; 105523d583b8SMatthias Ringwald } 105623d583b8SMatthias Ringwald btstack_linked_list_add(&gatt_client_value_listeners, (btstack_linked_item_t*) notification); 105723d583b8SMatthias Ringwald } 105823d583b8SMatthias Ringwald 105923d583b8SMatthias Ringwald void gatt_client_stop_listening_for_characteristic_value_updates(gatt_client_notification_t * notification){ 106023d583b8SMatthias Ringwald btstack_linked_list_remove(&gatt_client_value_listeners, (btstack_linked_item_t*) notification); 106123d583b8SMatthias Ringwald } 10623deb3ec6SMatthias Ringwald 10635cf1669fSMatthias Ringwald static int is_value_valid(gatt_client_t *gatt_client, uint8_t *packet, uint16_t size){ 1064f8fbdce0SMatthias Ringwald uint16_t attribute_handle = little_endian_read_16(packet, 1); 1065f8fbdce0SMatthias Ringwald uint16_t value_offset = little_endian_read_16(packet, 3); 10663deb3ec6SMatthias Ringwald 10675cf1669fSMatthias Ringwald if (gatt_client->attribute_handle != attribute_handle) return 0; 10685cf1669fSMatthias Ringwald if (gatt_client->attribute_offset != value_offset) return 0; 10695cf1669fSMatthias Ringwald return memcmp(&gatt_client->attribute_value[gatt_client->attribute_offset], &packet[5], size - 5u) == 0u; 10703deb3ec6SMatthias Ringwald } 10713deb3ec6SMatthias Ringwald 10720038504eSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 107392a7335eSMatthias Ringwald static void gatt_client_run_for_client_start_signed_write(gatt_client_t *gatt_client) { 107492a7335eSMatthias Ringwald sm_key_t csrk; 107592a7335eSMatthias Ringwald le_device_db_local_csrk_get(gatt_client->le_device_index, csrk); 107692a7335eSMatthias Ringwald uint32_t sign_counter = le_device_db_local_counter_get(gatt_client->le_device_index); 107792a7335eSMatthias Ringwald gatt_client->gatt_client_state = P_W4_CMAC_RESULT; 107892a7335eSMatthias 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); 107992a7335eSMatthias Ringwald } 10800038504eSMatthias Ringwald #endif 108192a7335eSMatthias Ringwald 108292a7335eSMatthias Ringwald // returns true if packet was sent 10831979f09cSMatthias Ringwald static bool gatt_client_run_for_gatt_client(gatt_client_t * gatt_client){ 10843deb3ec6SMatthias Ringwald 1085e4d159baSMatthias Ringwald // wait until re-encryption is complete 10861979f09cSMatthias Ringwald if (gap_reconnect_security_setup_active(gatt_client->con_handle)) return false; 1087d1e1a57fSMatthias Ringwald 1088e4d159baSMatthias Ringwald // wait until re-encryption is complete 10891979f09cSMatthias Ringwald if (gatt_client->reencryption_active) return false; 10906c124bc2SMatthias Ringwald 109111279da7SMatthias Ringwald // wait until pairing complete (either reactive authentication or due to required security level) 10921979f09cSMatthias Ringwald if (gatt_client->wait_for_authentication_complete) return false; 109311279da7SMatthias Ringwald 1094fd14b205SMatthias Ringwald bool client_request_pending = gatt_client->gatt_client_state != P_READY; 1095fd14b205SMatthias Ringwald 10961aa9e3e8SMatthias Ringwald // verify security level for Mandatory Authentication over LE 109746012949SMatthias Ringwald bool check_security; 109846012949SMatthias Ringwald switch (gatt_client->bearer_type){ 109946012949SMatthias Ringwald case ATT_BEARER_UNENHANCED_LE: 110046012949SMatthias Ringwald check_security = true; 110146012949SMatthias Ringwald break; 110246012949SMatthias Ringwald default: 11039ced96e1SMatthias Ringwald check_security = false; 110446012949SMatthias Ringwald break; 11059ced96e1SMatthias Ringwald } 11069ced96e1SMatthias Ringwald if (client_request_pending && (gatt_client_required_security_level > gatt_client->security_level) && check_security){ 11071dfae9c7SMatthias Ringwald log_info("Trigger pairing, current security level %u, required %u\n", gatt_client->security_level, gatt_client_required_security_level); 11083503dc74SMatthias Ringwald gatt_client->wait_for_authentication_complete = 1; 110911279da7SMatthias Ringwald // set att error code for pairing failure based on required level 111011279da7SMatthias Ringwald switch (gatt_client_required_security_level){ 111111279da7SMatthias Ringwald case LEVEL_4: 111211279da7SMatthias Ringwald case LEVEL_3: 111311279da7SMatthias Ringwald gatt_client->pending_error_code = ATT_ERROR_INSUFFICIENT_AUTHENTICATION; 111411279da7SMatthias Ringwald break; 111511279da7SMatthias Ringwald default: 111611279da7SMatthias Ringwald gatt_client->pending_error_code = ATT_ERROR_INSUFFICIENT_ENCRYPTION; 111711279da7SMatthias Ringwald break; 111811279da7SMatthias Ringwald } 111911279da7SMatthias Ringwald sm_request_pairing(gatt_client->con_handle); 112011279da7SMatthias Ringwald // sm probably just sent a pdu 11211979f09cSMatthias Ringwald return true; 112211279da7SMatthias Ringwald } 1123f4b33574SMatthias Ringwald 11245cf1669fSMatthias Ringwald switch (gatt_client->mtu_state) { 1125544128c3SMatthias Ringwald case SEND_MTU_EXCHANGE: 11265cf1669fSMatthias Ringwald gatt_client->mtu_state = SENT_MTU_EXCHANGE; 11276e7b444cSMatthias Ringwald att_exchange_mtu_request(gatt_client); 11281979f09cSMatthias Ringwald return true; 11293deb3ec6SMatthias Ringwald case SENT_MTU_EXCHANGE: 11301979f09cSMatthias Ringwald return false; 11313deb3ec6SMatthias Ringwald default: 11323deb3ec6SMatthias Ringwald break; 11333deb3ec6SMatthias Ringwald } 11343deb3ec6SMatthias Ringwald 11355cf1669fSMatthias Ringwald if (gatt_client->send_confirmation){ 11365cf1669fSMatthias Ringwald gatt_client->send_confirmation = 0; 11376e7b444cSMatthias Ringwald att_confirmation(gatt_client); 11381979f09cSMatthias Ringwald return true; 11393deb3ec6SMatthias Ringwald } 11403deb3ec6SMatthias Ringwald 11413deb3ec6SMatthias Ringwald // check MTU for writes 11425cf1669fSMatthias Ringwald switch (gatt_client->gatt_client_state){ 11433deb3ec6SMatthias Ringwald case P_W2_SEND_WRITE_CHARACTERISTIC_VALUE: 11443deb3ec6SMatthias Ringwald case P_W2_SEND_WRITE_CHARACTERISTIC_DESCRIPTOR: 1145dda77937SMatthias Ringwald if (gatt_client->attribute_length <= (gatt_client->mtu - 3u)) break; 1146dda77937SMatthias Ringwald log_error("gatt_client_run: value len %u > MTU %u - 3\n", gatt_client->attribute_length,gatt_client->mtu); 1147526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_INVALID_ATTRIBUTE_VALUE_LENGTH); 11481979f09cSMatthias Ringwald return false; 11493deb3ec6SMatthias Ringwald default: 11503deb3ec6SMatthias Ringwald break; 11513deb3ec6SMatthias Ringwald } 11523deb3ec6SMatthias Ringwald 11530038504eSMatthias Ringwald bool packet_sent = true; 11540038504eSMatthias Ringwald bool done = true; 11555cf1669fSMatthias Ringwald switch (gatt_client->gatt_client_state){ 11563deb3ec6SMatthias Ringwald case P_W2_SEND_SERVICE_QUERY: 11575cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_SERVICE_QUERY_RESULT; 11585cf1669fSMatthias Ringwald send_gatt_services_request(gatt_client); 11590038504eSMatthias Ringwald break; 11603deb3ec6SMatthias Ringwald 11613deb3ec6SMatthias Ringwald case P_W2_SEND_SERVICE_WITH_UUID_QUERY: 11625cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_SERVICE_WITH_UUID_RESULT; 11635cf1669fSMatthias Ringwald send_gatt_services_by_uuid_request(gatt_client); 11640038504eSMatthias Ringwald break; 11653deb3ec6SMatthias Ringwald 11663deb3ec6SMatthias Ringwald case P_W2_SEND_ALL_CHARACTERISTICS_OF_SERVICE_QUERY: 11675cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_ALL_CHARACTERISTICS_OF_SERVICE_QUERY_RESULT; 11685cf1669fSMatthias Ringwald send_gatt_characteristic_request(gatt_client); 11690038504eSMatthias Ringwald break; 11703deb3ec6SMatthias Ringwald 11713deb3ec6SMatthias Ringwald case P_W2_SEND_CHARACTERISTIC_WITH_UUID_QUERY: 11725cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_CHARACTERISTIC_WITH_UUID_QUERY_RESULT; 11735cf1669fSMatthias Ringwald send_gatt_characteristic_request(gatt_client); 11740038504eSMatthias Ringwald break; 11753deb3ec6SMatthias Ringwald 11763deb3ec6SMatthias Ringwald case P_W2_SEND_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY: 11775cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_CHARACTERISTIC_WITH_UUID_QUERY_RESULT; 11785cf1669fSMatthias Ringwald send_gatt_characteristic_descriptor_request(gatt_client); 11790038504eSMatthias Ringwald break; 11803deb3ec6SMatthias Ringwald 11813deb3ec6SMatthias Ringwald case P_W2_SEND_INCLUDED_SERVICE_QUERY: 11825cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_INCLUDED_SERVICE_QUERY_RESULT; 11835cf1669fSMatthias Ringwald send_gatt_included_service_request(gatt_client); 11840038504eSMatthias Ringwald break; 11853deb3ec6SMatthias Ringwald 11863deb3ec6SMatthias Ringwald case P_W2_SEND_INCLUDED_SERVICE_WITH_UUID_QUERY: 11875cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_INCLUDED_SERVICE_UUID_WITH_QUERY_RESULT; 11885cf1669fSMatthias Ringwald send_gatt_included_service_uuid_request(gatt_client); 11890038504eSMatthias Ringwald break; 11903deb3ec6SMatthias Ringwald 11913deb3ec6SMatthias Ringwald case P_W2_SEND_READ_CHARACTERISTIC_VALUE_QUERY: 11925cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_READ_CHARACTERISTIC_VALUE_RESULT; 11935cf1669fSMatthias Ringwald send_gatt_read_characteristic_value_request(gatt_client); 11940038504eSMatthias Ringwald break; 11953deb3ec6SMatthias Ringwald 11963deb3ec6SMatthias Ringwald case P_W2_SEND_READ_BLOB_QUERY: 11975cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_READ_BLOB_RESULT; 11985cf1669fSMatthias Ringwald send_gatt_read_blob_request(gatt_client); 11990038504eSMatthias Ringwald break; 12003deb3ec6SMatthias Ringwald 12013deb3ec6SMatthias Ringwald case P_W2_SEND_READ_BY_TYPE_REQUEST: 12025cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_READ_BY_TYPE_RESPONSE; 12035cf1669fSMatthias Ringwald send_gatt_read_by_type_request(gatt_client); 12040038504eSMatthias Ringwald break; 12053deb3ec6SMatthias Ringwald 12063deb3ec6SMatthias Ringwald case P_W2_SEND_READ_MULTIPLE_REQUEST: 12075cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_READ_MULTIPLE_RESPONSE; 12085cf1669fSMatthias Ringwald send_gatt_read_multiple_request(gatt_client); 12090038504eSMatthias Ringwald break; 12103deb3ec6SMatthias Ringwald 1211f125a8efSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 1212f125a8efSMatthias Ringwald case P_W2_SEND_READ_MULTIPLE_VARIABLE_REQUEST: 1213f125a8efSMatthias Ringwald gatt_client->gatt_client_state = P_W4_READ_MULTIPLE_VARIABLE_RESPONSE; 1214f125a8efSMatthias Ringwald send_gatt_read_multiple_variable_request(gatt_client); 1215f125a8efSMatthias Ringwald break; 1216f125a8efSMatthias Ringwald #endif 1217f125a8efSMatthias Ringwald 12183deb3ec6SMatthias Ringwald case P_W2_SEND_WRITE_CHARACTERISTIC_VALUE: 12195cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_WRITE_CHARACTERISTIC_VALUE_RESULT; 12205cf1669fSMatthias Ringwald send_gatt_write_attribute_value_request(gatt_client); 12210038504eSMatthias Ringwald break; 12223deb3ec6SMatthias Ringwald 12233deb3ec6SMatthias Ringwald case P_W2_PREPARE_WRITE: 12245cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_PREPARE_WRITE_RESULT; 12255cf1669fSMatthias Ringwald send_gatt_prepare_write_request(gatt_client); 12260038504eSMatthias Ringwald break; 12273deb3ec6SMatthias Ringwald 12283deb3ec6SMatthias Ringwald case P_W2_PREPARE_WRITE_SINGLE: 12295cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_PREPARE_WRITE_SINGLE_RESULT; 12305cf1669fSMatthias Ringwald send_gatt_prepare_write_request(gatt_client); 12310038504eSMatthias Ringwald break; 12323deb3ec6SMatthias Ringwald 12333deb3ec6SMatthias Ringwald case P_W2_PREPARE_RELIABLE_WRITE: 12345cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_PREPARE_RELIABLE_WRITE_RESULT; 12355cf1669fSMatthias Ringwald send_gatt_prepare_write_request(gatt_client); 12360038504eSMatthias Ringwald break; 12373deb3ec6SMatthias Ringwald 12383deb3ec6SMatthias Ringwald case P_W2_EXECUTE_PREPARED_WRITE: 12395cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_EXECUTE_PREPARED_WRITE_RESULT; 12405cf1669fSMatthias Ringwald send_gatt_execute_write_request(gatt_client); 12410038504eSMatthias Ringwald break; 12423deb3ec6SMatthias Ringwald 12433deb3ec6SMatthias Ringwald case P_W2_CANCEL_PREPARED_WRITE: 12445cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_CANCEL_PREPARED_WRITE_RESULT; 12455cf1669fSMatthias Ringwald send_gatt_cancel_prepared_write_request(gatt_client); 12460038504eSMatthias Ringwald break; 12473deb3ec6SMatthias Ringwald 12483deb3ec6SMatthias Ringwald case P_W2_CANCEL_PREPARED_WRITE_DATA_MISMATCH: 12495cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_CANCEL_PREPARED_WRITE_DATA_MISMATCH_RESULT; 12505cf1669fSMatthias Ringwald send_gatt_cancel_prepared_write_request(gatt_client); 12510038504eSMatthias Ringwald break; 12523deb3ec6SMatthias Ringwald 1253abdc9fb5SMatthias Ringwald #ifdef ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY 1254abdc9fb5SMatthias Ringwald case P_W2_SEND_FIND_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY: 1255abdc9fb5SMatthias Ringwald // use Find Information 12565cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_FIND_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY_RESULT; 12575cf1669fSMatthias Ringwald send_gatt_characteristic_descriptor_request(gatt_client); 1258abdc9fb5SMatthias Ringwald #else 12593deb3ec6SMatthias Ringwald case P_W2_SEND_READ_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY: 1260abdc9fb5SMatthias Ringwald // Use Read By Type 12615cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_READ_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY_RESULT; 12625cf1669fSMatthias Ringwald send_gatt_read_client_characteristic_configuration_request(gatt_client); 1263abdc9fb5SMatthias Ringwald #endif 12640038504eSMatthias Ringwald break; 12653deb3ec6SMatthias Ringwald 12663deb3ec6SMatthias Ringwald case P_W2_SEND_READ_CHARACTERISTIC_DESCRIPTOR_QUERY: 12675cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_READ_CHARACTERISTIC_DESCRIPTOR_RESULT; 12685cf1669fSMatthias Ringwald send_gatt_read_characteristic_descriptor_request(gatt_client); 12690038504eSMatthias Ringwald break; 12703deb3ec6SMatthias Ringwald 12713deb3ec6SMatthias Ringwald case P_W2_SEND_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_QUERY: 12725cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_RESULT; 12735cf1669fSMatthias Ringwald send_gatt_read_blob_request(gatt_client); 12740038504eSMatthias Ringwald break; 12753deb3ec6SMatthias Ringwald 12763deb3ec6SMatthias Ringwald case P_W2_SEND_WRITE_CHARACTERISTIC_DESCRIPTOR: 12775cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT; 12785cf1669fSMatthias Ringwald send_gatt_write_attribute_value_request(gatt_client); 12790038504eSMatthias Ringwald break; 12803deb3ec6SMatthias Ringwald 12813deb3ec6SMatthias Ringwald case P_W2_WRITE_CLIENT_CHARACTERISTIC_CONFIGURATION: 12825cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_CLIENT_CHARACTERISTIC_CONFIGURATION_RESULT; 12835cf1669fSMatthias Ringwald send_gatt_write_client_characteristic_configuration_request(gatt_client); 12840038504eSMatthias Ringwald break; 12853deb3ec6SMatthias Ringwald 12863deb3ec6SMatthias Ringwald case P_W2_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR: 12875cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT; 12885cf1669fSMatthias Ringwald send_gatt_prepare_write_request(gatt_client); 12890038504eSMatthias Ringwald break; 12903deb3ec6SMatthias Ringwald 12913deb3ec6SMatthias Ringwald case P_W2_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR: 12925cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT; 12935cf1669fSMatthias Ringwald send_gatt_execute_write_request(gatt_client); 12940038504eSMatthias Ringwald break; 12953deb3ec6SMatthias Ringwald 12967a766ebfSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 1297793cf6ceSMatthias Ringwald case P_W4_IDENTITY_RESOLVING: 12985cf1669fSMatthias Ringwald log_info("P_W4_IDENTITY_RESOLVING - state %x", sm_identity_resolving_state(gatt_client->con_handle)); 12995cf1669fSMatthias Ringwald switch (sm_identity_resolving_state(gatt_client->con_handle)){ 1300793cf6ceSMatthias Ringwald case IRK_LOOKUP_SUCCEEDED: 13015cf1669fSMatthias Ringwald gatt_client->le_device_index = sm_le_device_index(gatt_client->con_handle); 13025cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_CMAC_READY; 130392a7335eSMatthias Ringwald if (sm_cmac_ready()){ 130492a7335eSMatthias Ringwald gatt_client_run_for_client_start_signed_write(gatt_client); 130592a7335eSMatthias Ringwald } 1306793cf6ceSMatthias Ringwald break; 1307793cf6ceSMatthias Ringwald case IRK_LOOKUP_FAILED: 1308526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_BONDING_INFORMATION_MISSING); 130992a7335eSMatthias Ringwald break; 1310793cf6ceSMatthias Ringwald default: 131192a7335eSMatthias Ringwald break; 1312793cf6ceSMatthias Ringwald } 13130038504eSMatthias Ringwald packet_sent = false; 13140038504eSMatthias Ringwald break; 1315793cf6ceSMatthias Ringwald 13163deb3ec6SMatthias Ringwald case P_W4_CMAC_READY: 13173deb3ec6SMatthias Ringwald if (sm_cmac_ready()){ 131892a7335eSMatthias Ringwald gatt_client_run_for_client_start_signed_write(gatt_client); 13193deb3ec6SMatthias Ringwald } 13200038504eSMatthias Ringwald packet_sent = false; 13210038504eSMatthias Ringwald break; 13223deb3ec6SMatthias Ringwald 13233deb3ec6SMatthias Ringwald case P_W2_SEND_SIGNED_WRITE: { 13245cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_SEND_SINGED_WRITE_DONE; 13253deb3ec6SMatthias Ringwald // bump local signing counter 13265cf1669fSMatthias Ringwald uint32_t sign_counter = le_device_db_local_counter_get(gatt_client->le_device_index); 13275cf1669fSMatthias Ringwald le_device_db_local_counter_set(gatt_client->le_device_index, sign_counter + 1); 132864b12680SMatthias Ringwald // send signed write command 13295cf1669fSMatthias Ringwald send_gatt_signed_write_request(gatt_client, sign_counter); 13303deb3ec6SMatthias Ringwald // finally, notifiy client that write is complete 1331526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 1332b68ac7a5SMatthias Ringwald break; 13333deb3ec6SMatthias Ringwald } 13347a766ebfSMatthias Ringwald #endif 13353deb3ec6SMatthias Ringwald default: 1336b68ac7a5SMatthias Ringwald done = false; 13373deb3ec6SMatthias Ringwald break; 13383deb3ec6SMatthias Ringwald } 133947181045SMatthias Ringwald 13400038504eSMatthias Ringwald if (done){ 13410038504eSMatthias Ringwald return packet_sent; 13420038504eSMatthias Ringwald } 13430038504eSMatthias Ringwald 134459d34cd2SMatthias Ringwald // write without response callback 134559d34cd2SMatthias Ringwald btstack_context_callback_registration_t * callback = 134659d34cd2SMatthias Ringwald (btstack_context_callback_registration_t *) btstack_linked_list_pop(&gatt_client->write_without_response_requests); 134759d34cd2SMatthias Ringwald if (callback != NULL){ 134859d34cd2SMatthias Ringwald (*callback->callback)(callback->context); 134959d34cd2SMatthias Ringwald return true; 135059d34cd2SMatthias Ringwald } 135159d34cd2SMatthias Ringwald 135259d34cd2SMatthias Ringwald // requested can send now old 13535cf1669fSMatthias Ringwald if (gatt_client->write_without_response_callback){ 13545cf1669fSMatthias Ringwald btstack_packet_handler_t packet_handler = gatt_client->write_without_response_callback; 13555cf1669fSMatthias Ringwald gatt_client->write_without_response_callback = NULL; 135647181045SMatthias Ringwald uint8_t event[4]; 135747181045SMatthias Ringwald event[0] = GATT_EVENT_CAN_WRITE_WITHOUT_RESPONSE; 13584ea43905SMatthias Ringwald event[1] = sizeof(event) - 2u; 13595cf1669fSMatthias Ringwald little_endian_store_16(event, 2, gatt_client->con_handle); 13605cf1669fSMatthias Ringwald packet_handler(HCI_EVENT_PACKET, gatt_client->con_handle, event, sizeof(event)); 13611979f09cSMatthias Ringwald return true; // to trigger requeueing (even if higher layer didn't sent) 136247181045SMatthias Ringwald } 136347181045SMatthias Ringwald 13641979f09cSMatthias Ringwald return false; 13653deb3ec6SMatthias Ringwald } 13663deb3ec6SMatthias Ringwald 1367544128c3SMatthias Ringwald static void gatt_client_run(void){ 1368544128c3SMatthias Ringwald btstack_linked_item_t *it; 1369*109c2548SMatthias Ringwald bool packet_sent; 13707627a0deSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 13717627a0deSMatthias Ringwald btstack_linked_list_iterator_t it_eatt; 13727627a0deSMatthias Ringwald #endif 1373a0da043fSMatthias Ringwald for (it = (btstack_linked_item_t *) gatt_client_connections; it != NULL; it = it->next){ 13745cf1669fSMatthias Ringwald gatt_client_t * gatt_client = (gatt_client_t *) it; 137546012949SMatthias Ringwald switch (gatt_client->bearer_type){ 137646012949SMatthias Ringwald case ATT_BEARER_UNENHANCED_LE: 13777627a0deSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 13787627a0deSMatthias Ringwald btstack_linked_list_iterator_init(&it_eatt, &gatt_client->eatt_clients); 13797627a0deSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it_eatt)) { 13807627a0deSMatthias Ringwald gatt_client_t * eatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it_eatt); 13817627a0deSMatthias Ringwald if (eatt_client->gatt_client_state != P_READY){ 13827627a0deSMatthias Ringwald if (l2cap_can_send_packet_now(eatt_client->l2cap_cid)){ 13837627a0deSMatthias Ringwald gatt_client_run_for_gatt_client(eatt_client); 13847627a0deSMatthias Ringwald } 13857627a0deSMatthias Ringwald } 13867627a0deSMatthias Ringwald } 13877627a0deSMatthias Ringwald #endif 138846012949SMatthias Ringwald if (!att_dispatch_client_can_send_now(gatt_client->con_handle)) { 138946012949SMatthias Ringwald att_dispatch_client_request_can_send_now_event(gatt_client->con_handle); 139046012949SMatthias Ringwald return; 139146012949SMatthias Ringwald } 1392*109c2548SMatthias Ringwald packet_sent = gatt_client_run_for_gatt_client(gatt_client); 139346012949SMatthias Ringwald if (packet_sent){ 139446012949SMatthias Ringwald // request new permission 139546012949SMatthias Ringwald att_dispatch_client_request_can_send_now_event(gatt_client->con_handle); 139646012949SMatthias Ringwald // requeue client for fairness and exit 139746012949SMatthias Ringwald // note: iterator has become invalid 139846012949SMatthias Ringwald btstack_linked_list_remove(&gatt_client_connections, (btstack_linked_item_t *) gatt_client); 139946012949SMatthias Ringwald btstack_linked_list_add_tail(&gatt_client_connections, (btstack_linked_item_t *) gatt_client); 140046012949SMatthias Ringwald return; 140146012949SMatthias Ringwald } 140246012949SMatthias Ringwald break; 14031450cdc6SMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC 140446012949SMatthias Ringwald case ATT_BEARER_UNENHANCED_CLASSIC: 14051450cdc6SMatthias Ringwald if (gatt_client->con_handle == HCI_CON_HANDLE_INVALID) { 14061450cdc6SMatthias Ringwald continue; 14071450cdc6SMatthias Ringwald } 14081aa9e3e8SMatthias Ringwald 14091aa9e3e8SMatthias Ringwald // handle GATT over BR/EDR 14101aa9e3e8SMatthias Ringwald if (gatt_client->l2cap_psm != 0){ 14111aa9e3e8SMatthias Ringwald if (l2cap_can_send_packet_now(gatt_client->l2cap_cid) == false){ 14121aa9e3e8SMatthias Ringwald l2cap_request_can_send_now_event(gatt_client->l2cap_cid); 14131aa9e3e8SMatthias Ringwald return; 14141aa9e3e8SMatthias Ringwald } 1415*109c2548SMatthias Ringwald packet_sent = gatt_client_run_for_gatt_client(gatt_client); 14161aa9e3e8SMatthias Ringwald if (packet_sent){ 14171aa9e3e8SMatthias Ringwald // request new permission 14181aa9e3e8SMatthias Ringwald att_dispatch_client_request_can_send_now_event(gatt_client->con_handle); 14191aa9e3e8SMatthias Ringwald // requeue client for fairness and exit 14201aa9e3e8SMatthias Ringwald // note: iterator has become invalid 14211aa9e3e8SMatthias Ringwald btstack_linked_list_remove(&gatt_client_connections, (btstack_linked_item_t *) gatt_client); 14221aa9e3e8SMatthias Ringwald btstack_linked_list_add_tail(&gatt_client_connections, (btstack_linked_item_t *) gatt_client); 14231aa9e3e8SMatthias Ringwald return; 14241aa9e3e8SMatthias Ringwald } 14251aa9e3e8SMatthias Ringwald } 142646012949SMatthias Ringwald break; 14271450cdc6SMatthias Ringwald #endif 142846012949SMatthias Ringwald default: 142946012949SMatthias Ringwald btstack_unreachable(); 143046012949SMatthias Ringwald break; 1431544128c3SMatthias Ringwald } 143246012949SMatthias Ringwald 143346012949SMatthias Ringwald 1434544128c3SMatthias Ringwald } 14353deb3ec6SMatthias Ringwald } 14363deb3ec6SMatthias Ringwald 14375cf1669fSMatthias Ringwald static void gatt_client_report_error_if_pending(gatt_client_t *gatt_client, uint8_t att_error_code) { 14385cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 1) return; 1439526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, att_error_code); 14403deb3ec6SMatthias Ringwald } 14413deb3ec6SMatthias Ringwald 144278c4542aSMatthias Ringwald static void gatt_client_handle_reencryption_complete(const uint8_t * packet){ 144378c4542aSMatthias Ringwald hci_con_handle_t con_handle = sm_event_reencryption_complete_get_handle(packet); 144478c4542aSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_get_context_for_handle(con_handle); 144578c4542aSMatthias Ringwald if (gatt_client == NULL) return; 144678c4542aSMatthias Ringwald 144778c4542aSMatthias Ringwald // update security level 144878c4542aSMatthias Ringwald gatt_client->security_level = gatt_client_le_security_level_for_connection(con_handle); 144978c4542aSMatthias Ringwald 145078c4542aSMatthias Ringwald gatt_client->reencryption_result = sm_event_reencryption_complete_get_status(packet); 145178c4542aSMatthias Ringwald gatt_client->reencryption_active = false; 145278c4542aSMatthias Ringwald gatt_client->wait_for_authentication_complete = 0; 145378c4542aSMatthias Ringwald 145478c4542aSMatthias Ringwald if (gatt_client->gatt_client_state == P_READY) return; 145578c4542aSMatthias Ringwald 145678c4542aSMatthias Ringwald switch (sm_event_reencryption_complete_get_status(packet)){ 145778c4542aSMatthias Ringwald case ERROR_CODE_SUCCESS: 145878c4542aSMatthias Ringwald log_info("re-encryption success, retry operation"); 145978c4542aSMatthias Ringwald break; 146078c4542aSMatthias Ringwald case ERROR_CODE_AUTHENTICATION_FAILURE: 146178c4542aSMatthias Ringwald case ERROR_CODE_PIN_OR_KEY_MISSING: 146278c4542aSMatthias Ringwald #if defined(ENABLE_GATT_CLIENT_PAIRING) && !defined(ENABLE_LE_PROACTIVE_AUTHENTICATION) 146378c4542aSMatthias Ringwald if (gatt_client_required_security_level == LEVEL_0) { 146478c4542aSMatthias Ringwald // re-encryption failed for reactive authentication with pairing and we have a pending client request 146578c4542aSMatthias Ringwald // => try to resolve it by deleting bonding information if we started pairing before 146678c4542aSMatthias Ringwald // delete bonding information 146778c4542aSMatthias Ringwald int le_device_db_index = sm_le_device_index(gatt_client->con_handle); 146878c4542aSMatthias Ringwald btstack_assert(le_device_db_index >= 0); 146978c4542aSMatthias Ringwald log_info("reactive auth with pairing: delete bonding and start pairing"); 147078c4542aSMatthias Ringwald #ifdef ENABLE_LE_PRIVACY_ADDRESS_RESOLUTION 147178c4542aSMatthias Ringwald hci_remove_le_device_db_entry_from_resolving_list((uint16_t) le_device_db_index); 147278c4542aSMatthias Ringwald #endif 147378c4542aSMatthias Ringwald le_device_db_remove(le_device_db_index); 147478c4542aSMatthias Ringwald // trigger pairing again 147578c4542aSMatthias Ringwald sm_request_pairing(gatt_client->con_handle); 147678c4542aSMatthias Ringwald break; 147778c4542aSMatthias Ringwald } 147878c4542aSMatthias Ringwald #endif 147978c4542aSMatthias Ringwald // report bonding information missing 1480526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_BONDING_INFORMATION_MISSING); 148178c4542aSMatthias Ringwald break; 148278c4542aSMatthias Ringwald default: 148378c4542aSMatthias Ringwald // report bonding information missing 1484526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, gatt_client->pending_error_code); 148578c4542aSMatthias Ringwald break; 148678c4542aSMatthias Ringwald } 148778c4542aSMatthias Ringwald } 148878c4542aSMatthias Ringwald 148978c4542aSMatthias Ringwald static void gatt_client_handle_disconnection_complete(const uint8_t * packet){ 149078c4542aSMatthias Ringwald log_info("GATT Client: HCI_EVENT_DISCONNECTION_COMPLETE"); 149178c4542aSMatthias Ringwald hci_con_handle_t con_handle = little_endian_read_16(packet,3); 149278c4542aSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_get_context_for_handle(con_handle); 149378c4542aSMatthias Ringwald if (gatt_client == NULL) return; 149478c4542aSMatthias Ringwald 149578c4542aSMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, ATT_ERROR_HCI_DISCONNECT_RECEIVED); 149678c4542aSMatthias Ringwald gatt_client_timeout_stop(gatt_client); 149778c4542aSMatthias Ringwald btstack_linked_list_remove(&gatt_client_connections, (btstack_linked_item_t *) gatt_client); 149878c4542aSMatthias Ringwald btstack_memory_gatt_client_free(gatt_client); 149978c4542aSMatthias Ringwald } 150078c4542aSMatthias Ringwald 1501f4b33574SMatthias Ringwald static void gatt_client_event_packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size){ 15021ac26e06SMatthias Ringwald UNUSED(channel); // ok: handling own l2cap events 15031ac26e06SMatthias Ringwald UNUSED(size); // ok: there is no channel 15049ec2630cSMatthias Ringwald 1505361b1363SMatthias Ringwald if (packet_type != HCI_EVENT_PACKET) return; 1506361b1363SMatthias Ringwald 1507f4b33574SMatthias Ringwald hci_con_handle_t con_handle; 15085cf1669fSMatthias Ringwald gatt_client_t * gatt_client; 15090e2df43fSMatthias Ringwald switch (hci_event_packet_get_type(packet)) { 15103deb3ec6SMatthias Ringwald case HCI_EVENT_DISCONNECTION_COMPLETE: 151178c4542aSMatthias Ringwald gatt_client_handle_disconnection_complete(packet); 15123deb3ec6SMatthias Ringwald break; 1513f4b33574SMatthias Ringwald 1514f4b33574SMatthias Ringwald // Pairing complete (with/without bonding=storing of pairing information) 1515f4b33574SMatthias Ringwald case SM_EVENT_PAIRING_COMPLETE: 1516f4b33574SMatthias Ringwald con_handle = sm_event_pairing_complete_get_handle(packet); 15175cf1669fSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(con_handle); 15185cf1669fSMatthias Ringwald if (gatt_client == NULL) break; 1519f4b33574SMatthias Ringwald 15201dfae9c7SMatthias Ringwald // update security level 15211dfae9c7SMatthias Ringwald gatt_client->security_level = gatt_client_le_security_level_for_connection(con_handle); 15221dfae9c7SMatthias Ringwald 15233503dc74SMatthias Ringwald if (gatt_client->wait_for_authentication_complete){ 15243503dc74SMatthias Ringwald gatt_client->wait_for_authentication_complete = 0; 1525f4b33574SMatthias Ringwald if (sm_event_pairing_complete_get_status(packet)){ 15265cf1669fSMatthias Ringwald log_info("pairing failed, report previous error 0x%x", gatt_client->pending_error_code); 1527ec9babacSMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, gatt_client->pending_error_code); 1528f4b33574SMatthias Ringwald } else { 1529f4b33574SMatthias Ringwald log_info("pairing success, retry operation"); 15303deb3ec6SMatthias Ringwald } 1531f4b33574SMatthias Ringwald } 1532f4b33574SMatthias Ringwald break; 153311279da7SMatthias Ringwald 1534793cf6ceSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 1535793cf6ceSMatthias Ringwald // Identity Resolving completed (no code, gatt_client_run will continue) 1536793cf6ceSMatthias Ringwald case SM_EVENT_IDENTITY_RESOLVING_SUCCEEDED: 1537793cf6ceSMatthias Ringwald case SM_EVENT_IDENTITY_RESOLVING_FAILED: 1538793cf6ceSMatthias Ringwald break; 1539793cf6ceSMatthias Ringwald #endif 1540a95ca902SMatthias Ringwald 15418918bbdaSMatthias Ringwald // re-encryption started 15428918bbdaSMatthias Ringwald case SM_EVENT_REENCRYPTION_STARTED: 15438918bbdaSMatthias Ringwald con_handle = sm_event_reencryption_complete_get_handle(packet); 15448918bbdaSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(con_handle); 15458918bbdaSMatthias Ringwald if (gatt_client == NULL) break; 15468918bbdaSMatthias Ringwald 15478918bbdaSMatthias Ringwald gatt_client->reencryption_active = true; 15488918bbdaSMatthias Ringwald gatt_client->reencryption_result = ERROR_CODE_SUCCESS; 15498918bbdaSMatthias Ringwald break; 15508918bbdaSMatthias Ringwald 1551ec9babacSMatthias Ringwald // re-encryption complete 1552ec9babacSMatthias Ringwald case SM_EVENT_REENCRYPTION_COMPLETE: 155378c4542aSMatthias Ringwald gatt_client_handle_reencryption_complete(packet); 1554ec9babacSMatthias Ringwald break; 15553deb3ec6SMatthias Ringwald default: 15563deb3ec6SMatthias Ringwald break; 15573deb3ec6SMatthias Ringwald } 15583deb3ec6SMatthias Ringwald 1559361b1363SMatthias Ringwald gatt_client_run(); 15603deb3ec6SMatthias Ringwald } 15613deb3ec6SMatthias Ringwald 15622da0d963SMatthias Ringwald static void gatt_client_handle_att_read_response(gatt_client_t *gatt_client, uint8_t *packet, uint16_t size) { 15635cf1669fSMatthias Ringwald switch (gatt_client->gatt_client_state) { 15642da0d963SMatthias Ringwald case P_W4_INCLUDED_SERVICE_UUID_WITH_QUERY_RESULT: 15652da0d963SMatthias Ringwald if (size >= 17) { 15662da0d963SMatthias Ringwald uint8_t uuid128[16]; 15672da0d963SMatthias Ringwald reverse_128(&packet[1], uuid128); 15682da0d963SMatthias Ringwald report_gatt_included_service_uuid128(gatt_client, gatt_client->start_group_handle, uuid128); 15692da0d963SMatthias Ringwald } 15702da0d963SMatthias Ringwald trigger_next_included_service_query(gatt_client, gatt_client->start_group_handle); 15715611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 15723deb3ec6SMatthias Ringwald break; 15732da0d963SMatthias Ringwald 15742da0d963SMatthias Ringwald case P_W4_READ_CHARACTERISTIC_VALUE_RESULT: 15752da0d963SMatthias Ringwald report_gatt_characteristic_value(gatt_client, gatt_client->attribute_handle, &packet[1], size - 1u); 1576526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 15772da0d963SMatthias Ringwald break; 15782da0d963SMatthias Ringwald 15792da0d963SMatthias Ringwald case P_W4_READ_CHARACTERISTIC_DESCRIPTOR_RESULT: 15802da0d963SMatthias Ringwald report_gatt_characteristic_descriptor(gatt_client, gatt_client->attribute_handle, &packet[1], 15812da0d963SMatthias Ringwald size - 1u, 0u); 1582526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 15832da0d963SMatthias Ringwald break; 15842da0d963SMatthias Ringwald 15852da0d963SMatthias Ringwald // Use ATT_READ_REQUEST for first blob of Read Long Characteristic 15862da0d963SMatthias Ringwald case P_W4_READ_BLOB_RESULT: 15872da0d963SMatthias Ringwald report_gatt_long_characteristic_value_blob(gatt_client, gatt_client->attribute_handle, &packet[1], 15882da0d963SMatthias Ringwald size - 1u, gatt_client->attribute_offset); 15892da0d963SMatthias Ringwald trigger_next_blob_query(gatt_client, P_W2_SEND_READ_BLOB_QUERY, size - 1u); 15902da0d963SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 15912da0d963SMatthias Ringwald break; 15922da0d963SMatthias Ringwald 15932da0d963SMatthias Ringwald // Use ATT_READ_REQUEST for first blob of Read Long Characteristic Descriptor 15942da0d963SMatthias Ringwald case P_W4_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_RESULT: 15952da0d963SMatthias Ringwald report_gatt_long_characteristic_descriptor(gatt_client, gatt_client->attribute_handle, &packet[1], 15962da0d963SMatthias Ringwald size - 1u, gatt_client->attribute_offset); 15972da0d963SMatthias Ringwald trigger_next_blob_query(gatt_client, P_W2_SEND_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_QUERY, 15982da0d963SMatthias Ringwald size - 1u); 15992da0d963SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 16002da0d963SMatthias Ringwald break; 16012da0d963SMatthias Ringwald 16023deb3ec6SMatthias Ringwald default: 16033deb3ec6SMatthias Ringwald break; 16043deb3ec6SMatthias Ringwald } 16052da0d963SMatthias Ringwald } 16063deb3ec6SMatthias Ringwald 16072da0d963SMatthias Ringwald static void gatt_client_handle_att_read_by_type_response(gatt_client_t *gatt_client, uint8_t *packet, uint16_t size) { 16085cf1669fSMatthias Ringwald switch (gatt_client->gatt_client_state) { 16093deb3ec6SMatthias Ringwald case P_W4_ALL_CHARACTERISTICS_OF_SERVICE_QUERY_RESULT: 16105cf1669fSMatthias Ringwald report_gatt_characteristics(gatt_client, packet, size); 1611cf8e5718SMatthias Ringwald trigger_next_characteristic_query(gatt_client, 1612cf8e5718SMatthias Ringwald get_last_result_handle_from_characteristics_list(packet, size)); 16135611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done, or by ATT_ERROR 16143deb3ec6SMatthias Ringwald break; 16153deb3ec6SMatthias Ringwald case P_W4_CHARACTERISTIC_WITH_UUID_QUERY_RESULT: 16165cf1669fSMatthias Ringwald report_gatt_characteristics(gatt_client, packet, size); 1617cf8e5718SMatthias Ringwald trigger_next_characteristic_query(gatt_client, 1618cf8e5718SMatthias Ringwald get_last_result_handle_from_characteristics_list(packet, size)); 16195611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done, or by ATT_ERROR 16203deb3ec6SMatthias Ringwald break; 1621cf8e5718SMatthias Ringwald case P_W4_INCLUDED_SERVICE_QUERY_RESULT: { 16224ea43905SMatthias Ringwald if (size < 2u) break; 16233deb3ec6SMatthias Ringwald uint16_t uuid16 = 0; 16243deb3ec6SMatthias Ringwald uint16_t pair_size = packet[1]; 16253deb3ec6SMatthias Ringwald 16264ea43905SMatthias Ringwald if (pair_size == 6u) { 16274ea43905SMatthias Ringwald if (size < 8u) break; 16283deb3ec6SMatthias Ringwald // UUIDs not available, query first included service 16295cf1669fSMatthias Ringwald gatt_client->start_group_handle = little_endian_read_16(packet, 2); // ready for next query 16305cf1669fSMatthias Ringwald gatt_client->query_start_handle = little_endian_read_16(packet, 4); 16315cf1669fSMatthias Ringwald gatt_client->query_end_handle = little_endian_read_16(packet, 6); 16325cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_INCLUDED_SERVICE_WITH_UUID_QUERY; 16333deb3ec6SMatthias Ringwald break; 16343deb3ec6SMatthias Ringwald } 16353deb3ec6SMatthias Ringwald 16364ea43905SMatthias Ringwald if (pair_size != 8u) break; 16379f698c82SMatthias Ringwald 16389f698c82SMatthias Ringwald // UUIDs included, report all of them 16393deb3ec6SMatthias Ringwald uint16_t offset; 16404ea43905SMatthias Ringwald for (offset = 2u; (offset + 8u) <= size; offset += pair_size) { 1641f8fbdce0SMatthias Ringwald uint16_t include_handle = little_endian_read_16(packet, offset); 16425cf1669fSMatthias Ringwald gatt_client->query_start_handle = little_endian_read_16(packet, offset + 2u); 16435cf1669fSMatthias Ringwald gatt_client->query_end_handle = little_endian_read_16(packet, offset + 4u); 16444ea43905SMatthias Ringwald uuid16 = little_endian_read_16(packet, offset + 6u); 16455cf1669fSMatthias Ringwald report_gatt_included_service_uuid16(gatt_client, include_handle, uuid16); 16463deb3ec6SMatthias Ringwald } 16473deb3ec6SMatthias Ringwald 1648cf8e5718SMatthias Ringwald trigger_next_included_service_query(gatt_client, 1649cf8e5718SMatthias Ringwald get_last_result_handle_from_included_services_list(packet, 1650cf8e5718SMatthias Ringwald size)); 16515611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 16523deb3ec6SMatthias Ringwald break; 16533deb3ec6SMatthias Ringwald } 1654abdc9fb5SMatthias Ringwald #ifndef ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY 16553deb3ec6SMatthias Ringwald case P_W4_READ_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY_RESULT: 16565cf1669fSMatthias Ringwald gatt_client->client_characteristic_configuration_handle = little_endian_read_16(packet, 2); 16575cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_WRITE_CLIENT_CHARACTERISTIC_CONFIGURATION; 16583deb3ec6SMatthias Ringwald break; 1659abdc9fb5SMatthias Ringwald #endif 16603deb3ec6SMatthias Ringwald case P_W4_READ_BY_TYPE_RESPONSE: { 16613deb3ec6SMatthias Ringwald uint16_t pair_size = packet[1]; 166239ac9711SMatthias Ringwald // set last result handle to last valid handle, only used if pair_size invalid 166339ac9711SMatthias Ringwald uint16_t last_result_handle = 0xffff; 166439ac9711SMatthias Ringwald if (pair_size > 2) { 16653deb3ec6SMatthias Ringwald uint16_t offset; 16663deb3ec6SMatthias Ringwald for (offset = 2; offset < size; offset += pair_size) { 1667f8fbdce0SMatthias Ringwald uint16_t value_handle = little_endian_read_16(packet, offset); 1668cf8e5718SMatthias Ringwald report_gatt_characteristic_value(gatt_client, value_handle, &packet[offset + 2u], 1669cf8e5718SMatthias Ringwald pair_size - 2u); 16703deb3ec6SMatthias Ringwald last_result_handle = value_handle; 16713deb3ec6SMatthias Ringwald } 167239ac9711SMatthias Ringwald } 16735cf1669fSMatthias Ringwald trigger_next_read_by_type_query(gatt_client, last_result_handle); 16743deb3ec6SMatthias Ringwald break; 16753deb3ec6SMatthias Ringwald } 16763deb3ec6SMatthias Ringwald default: 16773deb3ec6SMatthias Ringwald break; 16783deb3ec6SMatthias Ringwald } 167939ac9711SMatthias Ringwald } 1680dc13fd8dSMatthias Ringwald 16812da0d963SMatthias Ringwald static void gatt_client_handle_att_write_response(gatt_client_t *gatt_client) { 16822da0d963SMatthias Ringwald switch (gatt_client->gatt_client_state) { 16832da0d963SMatthias Ringwald case P_W4_WRITE_CHARACTERISTIC_VALUE_RESULT: 1684526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 16853deb3ec6SMatthias Ringwald break; 16862da0d963SMatthias Ringwald case P_W4_CLIENT_CHARACTERISTIC_CONFIGURATION_RESULT: 1687526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 16883deb3ec6SMatthias Ringwald break; 16892da0d963SMatthias Ringwald case P_W4_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT: 1690526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 16912da0d963SMatthias Ringwald break; 16922da0d963SMatthias Ringwald default: 16932da0d963SMatthias Ringwald break; 16942da0d963SMatthias Ringwald } 16952da0d963SMatthias Ringwald } 1696dc13fd8dSMatthias Ringwald 16972da0d963SMatthias Ringwald static void gatt_client_handle_att_response(gatt_client_t * gatt_client, uint8_t * packet, uint16_t size) { 16984740230fSMatthias Ringwald uint8_t att_status; 16992da0d963SMatthias Ringwald switch (packet[0]) { 17002da0d963SMatthias Ringwald case ATT_EXCHANGE_MTU_RESPONSE: { 17012da0d963SMatthias Ringwald if (size < 3u) break; 170246012949SMatthias Ringwald bool update_gatt_server_att_mtu = false; 17032da0d963SMatthias Ringwald uint16_t remote_rx_mtu = little_endian_read_16(packet, 1); 17042da0d963SMatthias Ringwald uint16_t local_rx_mtu = l2cap_max_le_mtu(); 170546012949SMatthias Ringwald switch (gatt_client->bearer_type){ 170646012949SMatthias Ringwald case ATT_BEARER_UNENHANCED_LE: 170746012949SMatthias Ringwald update_gatt_server_att_mtu = true; 170846012949SMatthias Ringwald break; 17092da0d963SMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC 171046012949SMatthias Ringwald case ATT_BEARER_UNENHANCED_CLASSIC: 17112da0d963SMatthias Ringwald local_rx_mtu = gatt_client->mtu; 171246012949SMatthias Ringwald break; 17132da0d963SMatthias Ringwald #endif 171446012949SMatthias Ringwald default: 171546012949SMatthias Ringwald btstack_unreachable(); 171646012949SMatthias Ringwald break; 171746012949SMatthias Ringwald } 171846012949SMatthias Ringwald 17192da0d963SMatthias Ringwald uint16_t mtu = (remote_rx_mtu < local_rx_mtu) ? remote_rx_mtu : local_rx_mtu; 17202da0d963SMatthias Ringwald 17212da0d963SMatthias Ringwald // set gatt client mtu 17222da0d963SMatthias Ringwald gatt_client->mtu = mtu; 17232da0d963SMatthias Ringwald gatt_client->mtu_state = MTU_EXCHANGED; 17242da0d963SMatthias Ringwald 172546012949SMatthias Ringwald if (update_gatt_server_att_mtu){ 17262da0d963SMatthias Ringwald // set per connection mtu state - for fixed channel 17272da0d963SMatthias Ringwald hci_connection_t *hci_connection = hci_connection_for_handle(gatt_client->con_handle); 17282da0d963SMatthias Ringwald hci_connection->att_connection.mtu = gatt_client->mtu; 17292da0d963SMatthias Ringwald hci_connection->att_connection.mtu_exchanged = true; 17302da0d963SMatthias Ringwald } 17312da0d963SMatthias Ringwald emit_gatt_mtu_exchanged_result_event(gatt_client, gatt_client->mtu); 17322da0d963SMatthias Ringwald break; 17332da0d963SMatthias Ringwald } 17342da0d963SMatthias Ringwald case ATT_READ_BY_GROUP_TYPE_RESPONSE: 17352da0d963SMatthias Ringwald switch (gatt_client->gatt_client_state) { 17362da0d963SMatthias Ringwald case P_W4_SERVICE_QUERY_RESULT: 17372da0d963SMatthias Ringwald report_gatt_services(gatt_client, packet, size); 17382da0d963SMatthias Ringwald trigger_next_service_query(gatt_client, get_last_result_handle_from_service_list(packet, size)); 173930952227SMilanka Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 174030952227SMilanka Ringwald break; 17413deb3ec6SMatthias Ringwald default: 17423deb3ec6SMatthias Ringwald break; 17433deb3ec6SMatthias Ringwald } 17443deb3ec6SMatthias Ringwald break; 17452da0d963SMatthias Ringwald case ATT_HANDLE_VALUE_NOTIFICATION: 17462da0d963SMatthias Ringwald if (size < 3u) return; 17472da0d963SMatthias Ringwald report_gatt_notification(gatt_client, little_endian_read_16(packet, 1u), &packet[3], size - 3u); 17482da0d963SMatthias Ringwald return; 1749cbba69d5SMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 1750cbba69d5SMatthias Ringwald case ATT_MULTIPLE_HANDLE_VALUE_NTF: 1751cbba69d5SMatthias Ringwald if (size >= 5u) { 1752cbba69d5SMatthias Ringwald uint16_t offset = 1; 1753cbba69d5SMatthias Ringwald while (true){ 1754cbba69d5SMatthias Ringwald uint16_t value_handle = little_endian_read_16(packet, offset); 1755cbba69d5SMatthias Ringwald offset += 2; 1756cbba69d5SMatthias Ringwald uint16_t value_length = little_endian_read_16(packet, offset); 1757cbba69d5SMatthias Ringwald offset += 2; 1758cbba69d5SMatthias Ringwald if ((offset + value_length) > size) break; 1759cbba69d5SMatthias Ringwald report_gatt_notification(gatt_client, value_handle, &packet[offset], value_length); 1760cbba69d5SMatthias Ringwald offset += value_length; 1761cbba69d5SMatthias Ringwald } 1762cbba69d5SMatthias Ringwald } 1763cbba69d5SMatthias Ringwald return; 1764cbba69d5SMatthias Ringwald #endif 17652da0d963SMatthias Ringwald case ATT_HANDLE_VALUE_INDICATION: 17662da0d963SMatthias Ringwald if (size < 3u) break; 17672da0d963SMatthias Ringwald report_gatt_indication(gatt_client, little_endian_read_16(packet, 1u), &packet[3], size - 3u); 17682da0d963SMatthias Ringwald gatt_client->send_confirmation = 1; 17692da0d963SMatthias Ringwald break; 17702da0d963SMatthias Ringwald case ATT_READ_BY_TYPE_RESPONSE: 17712da0d963SMatthias Ringwald gatt_client_handle_att_read_by_type_response(gatt_client, packet, size); 17722da0d963SMatthias Ringwald break; 17732da0d963SMatthias Ringwald case ATT_READ_RESPONSE: 17742da0d963SMatthias Ringwald gatt_client_handle_att_read_response(gatt_client, packet, size); 17752da0d963SMatthias Ringwald break; 1776cf8e5718SMatthias Ringwald case ATT_FIND_BY_TYPE_VALUE_RESPONSE: { 17773deb3ec6SMatthias Ringwald uint8_t pair_size = 4; 17783deb3ec6SMatthias Ringwald int i; 17793deb3ec6SMatthias Ringwald uint16_t start_group_handle; 17805611a760SMatthias Ringwald uint16_t end_group_handle = 0xffff; // asserts GATT_EVENT_QUERY_COMPLETE is emitted if no results 17814ea43905SMatthias Ringwald for (i = 1u; (i + pair_size) <= size; i += pair_size) { 1782f8fbdce0SMatthias Ringwald start_group_handle = little_endian_read_16(packet, i); 1783f8fbdce0SMatthias Ringwald end_group_handle = little_endian_read_16(packet, i + 2); 1784cf8e5718SMatthias Ringwald emit_gatt_service_query_result_event(gatt_client, start_group_handle, end_group_handle, 1785cf8e5718SMatthias Ringwald gatt_client->uuid128); 17863deb3ec6SMatthias Ringwald } 17875cf1669fSMatthias Ringwald trigger_next_service_by_uuid_query(gatt_client, end_group_handle); 17885611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 17893deb3ec6SMatthias Ringwald break; 17903deb3ec6SMatthias Ringwald } 1791cf8e5718SMatthias Ringwald case ATT_FIND_INFORMATION_REPLY: { 17924ea43905SMatthias Ringwald if (size < 2u) break; 1793a6121b51SMilanka Ringwald 17943deb3ec6SMatthias Ringwald uint8_t pair_size = 4; 17954ea43905SMatthias Ringwald if (packet[1u] == 2u) { 17963deb3ec6SMatthias Ringwald pair_size = 18; 17973deb3ec6SMatthias Ringwald } 1798a6121b51SMilanka Ringwald uint16_t offset = 2; 1799a6121b51SMilanka Ringwald 1800a6121b51SMilanka Ringwald if (size < (pair_size + offset)) break; 1801f8fbdce0SMatthias Ringwald uint16_t last_descriptor_handle = little_endian_read_16(packet, size - pair_size); 1802abdc9fb5SMatthias Ringwald 1803abdc9fb5SMatthias Ringwald #ifdef ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY 18045cf1669fSMatthias Ringwald log_info("ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY, state %x", gatt_client->gatt_client_state); 18055cf1669fSMatthias Ringwald if (gatt_client->gatt_client_state == P_W4_FIND_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY_RESULT){ 1806abdc9fb5SMatthias Ringwald // iterate over descriptors looking for CCC 1807abdc9fb5SMatthias Ringwald if (pair_size == 4){ 1808a6121b51SMilanka Ringwald while ((offset + 4) <= size){ 1809abdc9fb5SMatthias Ringwald uint16_t uuid16 = little_endian_read_16(packet, offset + 2); 1810abdc9fb5SMatthias Ringwald if (uuid16 == GATT_CLIENT_CHARACTERISTICS_CONFIGURATION){ 18115cf1669fSMatthias Ringwald gatt_client->client_characteristic_configuration_handle = little_endian_read_16(packet, offset); 18125cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_WRITE_CLIENT_CHARACTERISTIC_CONFIGURATION; 18135cf1669fSMatthias Ringwald log_info("CCC found %x", gatt_client->client_characteristic_configuration_handle); 1814abdc9fb5SMatthias Ringwald break; 1815abdc9fb5SMatthias Ringwald } 1816abdc9fb5SMatthias Ringwald offset += pair_size; 1817abdc9fb5SMatthias Ringwald } 1818abdc9fb5SMatthias Ringwald } 18195cf1669fSMatthias Ringwald if (is_query_done(gatt_client, last_descriptor_handle)){ 1820abdc9fb5SMatthias Ringwald 1821abdc9fb5SMatthias Ringwald } else { 1822abdc9fb5SMatthias Ringwald // next 18235cf1669fSMatthias Ringwald gatt_client->start_group_handle = last_descriptor_handle + 1; 18245cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_FIND_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY; 1825abdc9fb5SMatthias Ringwald } 1826abdc9fb5SMatthias Ringwald break; 1827abdc9fb5SMatthias Ringwald } 1828abdc9fb5SMatthias Ringwald #endif 18295cf1669fSMatthias Ringwald report_gatt_all_characteristic_descriptors(gatt_client, &packet[2], size - 2u, pair_size); 18305cf1669fSMatthias Ringwald trigger_next_characteristic_descriptor_query(gatt_client, last_descriptor_handle); 18315611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 18323deb3ec6SMatthias Ringwald break; 18333deb3ec6SMatthias Ringwald } 18343deb3ec6SMatthias Ringwald 18353deb3ec6SMatthias Ringwald case ATT_WRITE_RESPONSE: 18362da0d963SMatthias Ringwald gatt_client_handle_att_write_response(gatt_client); 18373deb3ec6SMatthias Ringwald break; 18383deb3ec6SMatthias Ringwald 18393deb3ec6SMatthias Ringwald case ATT_READ_BLOB_RESPONSE: { 18404ea43905SMatthias Ringwald uint16_t received_blob_length = size - 1u; 18415cf1669fSMatthias Ringwald switch (gatt_client->gatt_client_state) { 18423deb3ec6SMatthias Ringwald case P_W4_READ_BLOB_RESULT: 1843cf8e5718SMatthias Ringwald report_gatt_long_characteristic_value_blob(gatt_client, gatt_client->attribute_handle, &packet[1], 1844cf8e5718SMatthias Ringwald received_blob_length, gatt_client->attribute_offset); 18455cf1669fSMatthias Ringwald trigger_next_blob_query(gatt_client, P_W2_SEND_READ_BLOB_QUERY, received_blob_length); 18465611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 18473deb3ec6SMatthias Ringwald break; 18483deb3ec6SMatthias Ringwald case P_W4_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_RESULT: 18495cf1669fSMatthias Ringwald report_gatt_long_characteristic_descriptor(gatt_client, gatt_client->attribute_handle, 18503deb3ec6SMatthias Ringwald &packet[1], received_blob_length, 18515cf1669fSMatthias Ringwald gatt_client->attribute_offset); 1852cf8e5718SMatthias Ringwald trigger_next_blob_query(gatt_client, P_W2_SEND_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_QUERY, 1853cf8e5718SMatthias Ringwald received_blob_length); 18545611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 18553deb3ec6SMatthias Ringwald break; 18563deb3ec6SMatthias Ringwald default: 18573deb3ec6SMatthias Ringwald break; 18583deb3ec6SMatthias Ringwald } 18593deb3ec6SMatthias Ringwald break; 18603deb3ec6SMatthias Ringwald } 18613deb3ec6SMatthias Ringwald case ATT_PREPARE_WRITE_RESPONSE: 18625cf1669fSMatthias Ringwald switch (gatt_client->gatt_client_state) { 18633deb3ec6SMatthias Ringwald case P_W4_PREPARE_WRITE_SINGLE_RESULT: 18645cf1669fSMatthias Ringwald if (is_value_valid(gatt_client, packet, size)) { 18654740230fSMatthias Ringwald att_status = ATT_ERROR_SUCCESS; 18663deb3ec6SMatthias Ringwald } else { 18674740230fSMatthias Ringwald att_status = ATT_ERROR_DATA_MISMATCH; 18683deb3ec6SMatthias Ringwald } 1869526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, att_status); 18703deb3ec6SMatthias Ringwald break; 18713deb3ec6SMatthias Ringwald 18723deb3ec6SMatthias Ringwald case P_W4_PREPARE_WRITE_RESULT: { 18735cf1669fSMatthias Ringwald gatt_client->attribute_offset = little_endian_read_16(packet, 3); 18745cf1669fSMatthias Ringwald trigger_next_prepare_write_query(gatt_client, P_W2_PREPARE_WRITE, P_W2_EXECUTE_PREPARED_WRITE); 18755611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 18763deb3ec6SMatthias Ringwald break; 18773deb3ec6SMatthias Ringwald } 18783deb3ec6SMatthias Ringwald case P_W4_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT: { 18795cf1669fSMatthias Ringwald gatt_client->attribute_offset = little_endian_read_16(packet, 3); 1880cf8e5718SMatthias Ringwald trigger_next_prepare_write_query(gatt_client, P_W2_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR, 1881cf8e5718SMatthias Ringwald P_W2_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR); 18825611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 18833deb3ec6SMatthias Ringwald break; 18843deb3ec6SMatthias Ringwald } 18853deb3ec6SMatthias Ringwald case P_W4_PREPARE_RELIABLE_WRITE_RESULT: { 18865cf1669fSMatthias Ringwald if (is_value_valid(gatt_client, packet, size)) { 18875cf1669fSMatthias Ringwald gatt_client->attribute_offset = little_endian_read_16(packet, 3); 1888cf8e5718SMatthias Ringwald trigger_next_prepare_write_query(gatt_client, P_W2_PREPARE_RELIABLE_WRITE, 1889cf8e5718SMatthias Ringwald P_W2_EXECUTE_PREPARED_WRITE); 18905611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 18913deb3ec6SMatthias Ringwald break; 18923deb3ec6SMatthias Ringwald } 18935cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_CANCEL_PREPARED_WRITE_DATA_MISMATCH; 18943deb3ec6SMatthias Ringwald break; 18953deb3ec6SMatthias Ringwald } 18963deb3ec6SMatthias Ringwald default: 18973deb3ec6SMatthias Ringwald break; 18983deb3ec6SMatthias Ringwald } 18993deb3ec6SMatthias Ringwald break; 19003deb3ec6SMatthias Ringwald 19013deb3ec6SMatthias Ringwald case ATT_EXECUTE_WRITE_RESPONSE: 19025cf1669fSMatthias Ringwald switch (gatt_client->gatt_client_state) { 19033deb3ec6SMatthias Ringwald case P_W4_EXECUTE_PREPARED_WRITE_RESULT: 1904526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 19053deb3ec6SMatthias Ringwald break; 19063deb3ec6SMatthias Ringwald case P_W4_CANCEL_PREPARED_WRITE_RESULT: 1907526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 19083deb3ec6SMatthias Ringwald break; 19093deb3ec6SMatthias Ringwald case P_W4_CANCEL_PREPARED_WRITE_DATA_MISMATCH_RESULT: 1910526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_DATA_MISMATCH); 19113deb3ec6SMatthias Ringwald break; 19123deb3ec6SMatthias Ringwald case P_W4_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT: 1913526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 19143deb3ec6SMatthias Ringwald break; 19153deb3ec6SMatthias Ringwald default: 19163deb3ec6SMatthias Ringwald break; 19173deb3ec6SMatthias Ringwald 19183deb3ec6SMatthias Ringwald } 19193deb3ec6SMatthias Ringwald break; 19203deb3ec6SMatthias Ringwald 19213deb3ec6SMatthias Ringwald case ATT_READ_MULTIPLE_RESPONSE: 19225cf1669fSMatthias Ringwald switch (gatt_client->gatt_client_state) { 19233deb3ec6SMatthias Ringwald case P_W4_READ_MULTIPLE_RESPONSE: 19245cf1669fSMatthias Ringwald report_gatt_characteristic_value(gatt_client, 0u, &packet[1], size - 1u); 1925526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 19263deb3ec6SMatthias Ringwald break; 19273deb3ec6SMatthias Ringwald default: 19283deb3ec6SMatthias Ringwald break; 19293deb3ec6SMatthias Ringwald } 19303deb3ec6SMatthias Ringwald break; 19313deb3ec6SMatthias Ringwald 1932f125a8efSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 1933f125a8efSMatthias Ringwald case ATT_READ_MULTIPLE_VARIABLE_RSP: 1934f125a8efSMatthias Ringwald switch (gatt_client->gatt_client_state) { 1935169b9876SMatthias Ringwald case P_W4_READ_MULTIPLE_VARIABLE_RESPONSE: 1936f125a8efSMatthias Ringwald report_gatt_characteristic_value(gatt_client, 0u, &packet[1], size - 1u); 1937f125a8efSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 1938f125a8efSMatthias Ringwald break; 1939f125a8efSMatthias Ringwald default: 1940f125a8efSMatthias Ringwald break; 1941f125a8efSMatthias Ringwald } 1942f125a8efSMatthias Ringwald break; 1943f125a8efSMatthias Ringwald #endif 1944f125a8efSMatthias Ringwald 19453deb3ec6SMatthias Ringwald case ATT_ERROR_RESPONSE: 19464ea43905SMatthias Ringwald if (size < 5u) return; 19474740230fSMatthias Ringwald att_status = packet[4]; 19484740230fSMatthias Ringwald switch (att_status) { 19493deb3ec6SMatthias Ringwald case ATT_ERROR_ATTRIBUTE_NOT_FOUND: { 19505cf1669fSMatthias Ringwald switch (gatt_client->gatt_client_state) { 19513deb3ec6SMatthias Ringwald case P_W4_SERVICE_QUERY_RESULT: 19523deb3ec6SMatthias Ringwald case P_W4_SERVICE_WITH_UUID_RESULT: 19533deb3ec6SMatthias Ringwald case P_W4_INCLUDED_SERVICE_QUERY_RESULT: 19543deb3ec6SMatthias Ringwald case P_W4_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY_RESULT: 1955526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 19563deb3ec6SMatthias Ringwald break; 19573deb3ec6SMatthias Ringwald case P_W4_ALL_CHARACTERISTICS_OF_SERVICE_QUERY_RESULT: 19583deb3ec6SMatthias Ringwald case P_W4_CHARACTERISTIC_WITH_UUID_QUERY_RESULT: 195923d583b8SMatthias Ringwald report_gatt_characteristic_end_found(gatt_client, gatt_client->end_group_handle); 1960526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, ATT_ERROR_SUCCESS); 19613deb3ec6SMatthias Ringwald break; 19623deb3ec6SMatthias Ringwald case P_W4_READ_BY_TYPE_RESPONSE: 19635cf1669fSMatthias Ringwald if (gatt_client->start_group_handle == gatt_client->query_start_handle) { 19644740230fSMatthias Ringwald att_status = ATT_ERROR_ATTRIBUTE_NOT_FOUND; 19653deb3ec6SMatthias Ringwald } else { 19664740230fSMatthias Ringwald att_status = ATT_ERROR_SUCCESS; 19673deb3ec6SMatthias Ringwald } 1968526859e7SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client, att_status); 19693deb3ec6SMatthias Ringwald break; 19703deb3ec6SMatthias Ringwald default: 19714740230fSMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, att_status); 19723deb3ec6SMatthias Ringwald break; 19733deb3ec6SMatthias Ringwald } 19743deb3ec6SMatthias Ringwald break; 19753deb3ec6SMatthias Ringwald } 1976f4b33574SMatthias Ringwald 1977f4b33574SMatthias Ringwald #ifdef ENABLE_GATT_CLIENT_PAIRING 1978f4b33574SMatthias Ringwald 1979f4b33574SMatthias Ringwald case ATT_ERROR_INSUFFICIENT_AUTHENTICATION: 1980f4b33574SMatthias Ringwald case ATT_ERROR_INSUFFICIENT_ENCRYPTION_KEY_SIZE: 1981a0e0c2beSMatthias Ringwald case ATT_ERROR_INSUFFICIENT_ENCRYPTION: { 1982a0e0c2beSMatthias Ringwald 1983f4b33574SMatthias Ringwald // security too low 19845cf1669fSMatthias Ringwald if (gatt_client->security_counter > 0) { 19854740230fSMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, att_status); 1986f4b33574SMatthias Ringwald break; 1987f4b33574SMatthias Ringwald } 1988f4b33574SMatthias Ringwald // start security 19895cf1669fSMatthias Ringwald gatt_client->security_counter++; 1990f4b33574SMatthias Ringwald 1991f4b33574SMatthias Ringwald // setup action 1992f4b33574SMatthias Ringwald int retry = 1; 19935cf1669fSMatthias Ringwald switch (gatt_client->gatt_client_state){ 1994f4b33574SMatthias Ringwald case P_W4_READ_CHARACTERISTIC_VALUE_RESULT: 19955cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_CHARACTERISTIC_VALUE_QUERY ; 1996f4b33574SMatthias Ringwald break; 1997f4b33574SMatthias Ringwald case P_W4_READ_BLOB_RESULT: 19985cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_BLOB_QUERY; 1999f4b33574SMatthias Ringwald break; 2000f4b33574SMatthias Ringwald case P_W4_READ_BY_TYPE_RESPONSE: 20015cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_BY_TYPE_REQUEST; 2002f4b33574SMatthias Ringwald break; 2003f4b33574SMatthias Ringwald case P_W4_READ_MULTIPLE_RESPONSE: 20045cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_MULTIPLE_REQUEST; 2005f4b33574SMatthias Ringwald break; 2006f125a8efSMatthias Ringwald case P_W4_READ_MULTIPLE_VARIABLE_RESPONSE: 2007f125a8efSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_MULTIPLE_VARIABLE_REQUEST; 2008f125a8efSMatthias Ringwald break; 2009f4b33574SMatthias Ringwald case P_W4_WRITE_CHARACTERISTIC_VALUE_RESULT: 20105cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_WRITE_CHARACTERISTIC_VALUE; 2011f4b33574SMatthias Ringwald break; 2012f4b33574SMatthias Ringwald case P_W4_PREPARE_WRITE_RESULT: 20135cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_PREPARE_WRITE; 2014f4b33574SMatthias Ringwald break; 2015f4b33574SMatthias Ringwald case P_W4_PREPARE_WRITE_SINGLE_RESULT: 20165cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_PREPARE_WRITE_SINGLE; 2017f4b33574SMatthias Ringwald break; 2018f4b33574SMatthias Ringwald case P_W4_PREPARE_RELIABLE_WRITE_RESULT: 20195cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_PREPARE_RELIABLE_WRITE; 2020f4b33574SMatthias Ringwald break; 2021f4b33574SMatthias Ringwald case P_W4_EXECUTE_PREPARED_WRITE_RESULT: 20225cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_EXECUTE_PREPARED_WRITE; 2023f4b33574SMatthias Ringwald break; 2024f4b33574SMatthias Ringwald case P_W4_CANCEL_PREPARED_WRITE_RESULT: 20255cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_CANCEL_PREPARED_WRITE; 2026f4b33574SMatthias Ringwald break; 2027f4b33574SMatthias Ringwald case P_W4_CANCEL_PREPARED_WRITE_DATA_MISMATCH_RESULT: 20285cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_CANCEL_PREPARED_WRITE_DATA_MISMATCH; 2029f4b33574SMatthias Ringwald break; 2030f4b33574SMatthias Ringwald case P_W4_READ_CHARACTERISTIC_DESCRIPTOR_RESULT: 20315cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_CHARACTERISTIC_DESCRIPTOR_QUERY; 2032f4b33574SMatthias Ringwald break; 2033f4b33574SMatthias Ringwald case P_W4_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_RESULT: 20345cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_QUERY; 2035f4b33574SMatthias Ringwald break; 2036f4b33574SMatthias Ringwald case P_W4_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT: 20375cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_WRITE_CHARACTERISTIC_DESCRIPTOR; 2038f4b33574SMatthias Ringwald break; 2039f4b33574SMatthias Ringwald case P_W4_CLIENT_CHARACTERISTIC_CONFIGURATION_RESULT: 20405cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_WRITE_CLIENT_CHARACTERISTIC_CONFIGURATION; 2041f4b33574SMatthias Ringwald break; 2042f4b33574SMatthias Ringwald case P_W4_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT: 20435cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR; 2044f4b33574SMatthias Ringwald break; 2045f4b33574SMatthias Ringwald case P_W4_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT: 20465cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR; 2047f4b33574SMatthias Ringwald break; 2048f4b33574SMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 2049f4b33574SMatthias Ringwald case P_W4_SEND_SINGED_WRITE_DONE: 20505cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_SIGNED_WRITE; 2051f4b33574SMatthias Ringwald break; 2052f4b33574SMatthias Ringwald #endif 2053f4b33574SMatthias Ringwald default: 20545cf1669fSMatthias Ringwald log_info("retry not supported for state %x", gatt_client->gatt_client_state); 2055f4b33574SMatthias Ringwald retry = 0; 2056f4b33574SMatthias Ringwald break; 2057f4b33574SMatthias Ringwald } 2058f4b33574SMatthias Ringwald 2059f4b33574SMatthias Ringwald if (!retry) { 20604740230fSMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, att_status); 2061f4b33574SMatthias Ringwald break; 2062f4b33574SMatthias Ringwald } 2063f4b33574SMatthias Ringwald 2064f4b33574SMatthias Ringwald log_info("security error, start pairing"); 2065f4b33574SMatthias Ringwald 2066f060f108SMatthias Ringwald // start pairing for higher security level 20673503dc74SMatthias Ringwald gatt_client->wait_for_authentication_complete = 1; 20684740230fSMatthias Ringwald gatt_client->pending_error_code = att_status; 20695cf1669fSMatthias Ringwald sm_request_pairing(gatt_client->con_handle); 2070f4b33574SMatthias Ringwald break; 2071a0e0c2beSMatthias Ringwald } 2072f4b33574SMatthias Ringwald #endif 2073f4b33574SMatthias Ringwald 2074f4b33574SMatthias Ringwald // nothing we can do about that 2075f4b33574SMatthias Ringwald case ATT_ERROR_INSUFFICIENT_AUTHORIZATION: 20763deb3ec6SMatthias Ringwald default: 20774740230fSMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, att_status); 20783deb3ec6SMatthias Ringwald break; 20793deb3ec6SMatthias Ringwald } 20803deb3ec6SMatthias Ringwald break; 20813deb3ec6SMatthias Ringwald 20823deb3ec6SMatthias Ringwald default: 20833deb3ec6SMatthias Ringwald log_info("ATT Handler, unhandled response type 0x%02x", packet[0]); 20843deb3ec6SMatthias Ringwald break; 20853deb3ec6SMatthias Ringwald } 2086cf8e5718SMatthias Ringwald } 2087cf8e5718SMatthias Ringwald 2088cf8e5718SMatthias Ringwald static void gatt_client_att_packet_handler(uint8_t packet_type, uint16_t handle, uint8_t *packet, uint16_t size) { 2089cf8e5718SMatthias Ringwald gatt_client_t *gatt_client; 2090cf8e5718SMatthias Ringwald if (size < 1u) return; 2091cf8e5718SMatthias Ringwald 2092cf8e5718SMatthias Ringwald if (packet_type == HCI_EVENT_PACKET) { 2093cf8e5718SMatthias Ringwald switch (packet[0]) { 2094cf8e5718SMatthias Ringwald case L2CAP_EVENT_CAN_SEND_NOW: 20953deb3ec6SMatthias Ringwald gatt_client_run(); 2096cf8e5718SMatthias Ringwald break; 2097cf8e5718SMatthias Ringwald // att_server has negotiated the mtu for this connection, cache if context exists 2098cf8e5718SMatthias Ringwald case ATT_EVENT_MTU_EXCHANGE_COMPLETE: 2099cf8e5718SMatthias Ringwald if (size < 6u) break; 2100cf8e5718SMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(handle); 2101cf8e5718SMatthias Ringwald if (gatt_client == NULL) break; 2102cf8e5718SMatthias Ringwald gatt_client->mtu = little_endian_read_16(packet, 4); 2103cf8e5718SMatthias Ringwald break; 2104cf8e5718SMatthias Ringwald default: 2105cf8e5718SMatthias Ringwald break; 2106cf8e5718SMatthias Ringwald } 2107cf8e5718SMatthias Ringwald return; 2108cf8e5718SMatthias Ringwald } 2109cf8e5718SMatthias Ringwald 2110cf8e5718SMatthias Ringwald if (packet_type != ATT_DATA_PACKET) return; 2111cf8e5718SMatthias Ringwald 2112cf8e5718SMatthias Ringwald // special cases: notifications & indications motivate creating context 2113cf8e5718SMatthias Ringwald switch (packet[0]) { 2114cf8e5718SMatthias Ringwald case ATT_HANDLE_VALUE_NOTIFICATION: 2115cf8e5718SMatthias Ringwald case ATT_HANDLE_VALUE_INDICATION: 2116cf8e5718SMatthias Ringwald gatt_client_provide_context_for_handle(handle, &gatt_client); 2117cf8e5718SMatthias Ringwald break; 2118cf8e5718SMatthias Ringwald default: 2119cf8e5718SMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(handle); 2120cf8e5718SMatthias Ringwald break; 2121cf8e5718SMatthias Ringwald } 2122cf8e5718SMatthias Ringwald 2123cf8e5718SMatthias Ringwald if (gatt_client != NULL) { 2124cf8e5718SMatthias Ringwald gatt_client_handle_att_response(gatt_client, packet, size); 2125cf8e5718SMatthias Ringwald gatt_client_run(); 2126cf8e5718SMatthias Ringwald } 21273deb3ec6SMatthias Ringwald } 21283deb3ec6SMatthias Ringwald 21297a766ebfSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 21303deb3ec6SMatthias Ringwald static void att_signed_write_handle_cmac_result(uint8_t hash[8]){ 2131665d90f2SMatthias Ringwald btstack_linked_list_iterator_t it; 2132665d90f2SMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client_connections); 2133665d90f2SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 21345cf1669fSMatthias Ringwald gatt_client_t * gatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it); 21355cf1669fSMatthias Ringwald if (gatt_client->gatt_client_state == P_W4_CMAC_RESULT){ 21363deb3ec6SMatthias Ringwald // store result 21375cf1669fSMatthias Ringwald (void)memcpy(gatt_client->cmac, hash, 8); 21385cf1669fSMatthias Ringwald // reverse_64(hash, gatt_client->cmac); 21395cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_SIGNED_WRITE; 21403deb3ec6SMatthias Ringwald gatt_client_run(); 21413deb3ec6SMatthias Ringwald return; 21423deb3ec6SMatthias Ringwald } 21433deb3ec6SMatthias Ringwald } 21443deb3ec6SMatthias Ringwald } 21453deb3ec6SMatthias Ringwald 2146b45b7749SMilanka 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){ 214740faeb84SMilanka Ringwald gatt_client_t * gatt_client; 214840faeb84SMilanka Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 214940faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 215040faeb84SMilanka Ringwald return status; 215140faeb84SMilanka Ringwald } 215240faeb84SMilanka Ringwald if (is_ready(gatt_client) == 0){ 215340faeb84SMilanka Ringwald return GATT_CLIENT_IN_WRONG_STATE; 215440faeb84SMilanka Ringwald } 21553deb3ec6SMatthias Ringwald 21565cf1669fSMatthias Ringwald gatt_client->callback = callback; 2157b45b7749SMilanka Ringwald gatt_client->attribute_handle = value_handle; 21585cf1669fSMatthias Ringwald gatt_client->attribute_length = message_len; 21595cf1669fSMatthias Ringwald gatt_client->attribute_value = message; 21605cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_IDENTITY_RESOLVING; 21613deb3ec6SMatthias Ringwald gatt_client_run(); 216225b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 21633deb3ec6SMatthias Ringwald } 21647a766ebfSMatthias Ringwald #endif 21653deb3ec6SMatthias Ringwald 2166711e6c80SMatthias Ringwald uint8_t gatt_client_discover_primary_services(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 216740faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2168de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 216940faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 217040faeb84SMilanka Ringwald return status; 217140faeb84SMilanka Ringwald } 21723deb3ec6SMatthias Ringwald 21735cf1669fSMatthias Ringwald gatt_client->callback = callback; 21745cf1669fSMatthias Ringwald gatt_client->start_group_handle = 0x0001; 21755cf1669fSMatthias Ringwald gatt_client->end_group_handle = 0xffff; 21765cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_SERVICE_QUERY; 21778d1f34d3SMatheus Eduardo Garbelini gatt_client->uuid16 = GATT_PRIMARY_SERVICE_UUID; 21783deb3ec6SMatthias Ringwald gatt_client_run(); 217925b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 21803deb3ec6SMatthias Ringwald } 21813deb3ec6SMatthias Ringwald 21828d1f34d3SMatheus Eduardo Garbelini uint8_t gatt_client_discover_secondary_services(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 218340faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2184de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 218540faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 218640faeb84SMilanka Ringwald return status; 218740faeb84SMilanka Ringwald } 21888d1f34d3SMatheus Eduardo Garbelini 21898d1f34d3SMatheus Eduardo Garbelini gatt_client->callback = callback; 21908d1f34d3SMatheus Eduardo Garbelini gatt_client->start_group_handle = 0x0001; 21918d1f34d3SMatheus Eduardo Garbelini gatt_client->end_group_handle = 0xffff; 21928d1f34d3SMatheus Eduardo Garbelini gatt_client->gatt_client_state = P_W2_SEND_SERVICE_QUERY; 21938d1f34d3SMatheus Eduardo Garbelini gatt_client->uuid16 = GATT_SECONDARY_SERVICE_UUID; 21948d1f34d3SMatheus Eduardo Garbelini gatt_client_run(); 21958d1f34d3SMatheus Eduardo Garbelini return ERROR_CODE_SUCCESS; 21968d1f34d3SMatheus Eduardo Garbelini } 21973deb3ec6SMatthias Ringwald 2198711e6c80SMatthias Ringwald uint8_t gatt_client_discover_primary_services_by_uuid16(btstack_packet_handler_t callback, hci_con_handle_t con_handle, uint16_t uuid16){ 219940faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2200de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 220140faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 220240faeb84SMilanka Ringwald return status; 220340faeb84SMilanka Ringwald } 22043deb3ec6SMatthias Ringwald 22055cf1669fSMatthias Ringwald gatt_client->callback = callback; 22065cf1669fSMatthias Ringwald gatt_client->start_group_handle = 0x0001; 22075cf1669fSMatthias Ringwald gatt_client->end_group_handle = 0xffff; 22085cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_SERVICE_WITH_UUID_QUERY; 22095cf1669fSMatthias Ringwald gatt_client->uuid16 = uuid16; 22105cf1669fSMatthias Ringwald uuid_add_bluetooth_prefix((uint8_t*) &(gatt_client->uuid128), gatt_client->uuid16); 22113deb3ec6SMatthias Ringwald gatt_client_run(); 221225b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 22133deb3ec6SMatthias Ringwald } 22143deb3ec6SMatthias Ringwald 2215711e6c80SMatthias 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){ 221640faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2217de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 221840faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 221940faeb84SMilanka Ringwald return status; 222040faeb84SMilanka Ringwald } 22213deb3ec6SMatthias Ringwald 22225cf1669fSMatthias Ringwald gatt_client->callback = callback; 22235cf1669fSMatthias Ringwald gatt_client->start_group_handle = 0x0001; 22245cf1669fSMatthias Ringwald gatt_client->end_group_handle = 0xffff; 22255cf1669fSMatthias Ringwald gatt_client->uuid16 = 0; 22265cf1669fSMatthias Ringwald (void)memcpy(gatt_client->uuid128, uuid128, 16); 22275cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_SERVICE_WITH_UUID_QUERY; 22283deb3ec6SMatthias Ringwald gatt_client_run(); 222925b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 22303deb3ec6SMatthias Ringwald } 22313deb3ec6SMatthias Ringwald 2232711e6c80SMatthias 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){ 223340faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2234de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 223540faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 223640faeb84SMilanka Ringwald return status; 223740faeb84SMilanka Ringwald } 22383deb3ec6SMatthias Ringwald 22395cf1669fSMatthias Ringwald gatt_client->callback = callback; 22405cf1669fSMatthias Ringwald gatt_client->start_group_handle = service->start_group_handle; 22415cf1669fSMatthias Ringwald gatt_client->end_group_handle = service->end_group_handle; 22425cf1669fSMatthias Ringwald gatt_client->filter_with_uuid = 0; 22435cf1669fSMatthias Ringwald gatt_client->characteristic_start_handle = 0; 22445cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_ALL_CHARACTERISTICS_OF_SERVICE_QUERY; 22453deb3ec6SMatthias Ringwald gatt_client_run(); 224625b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 22473deb3ec6SMatthias Ringwald } 22483deb3ec6SMatthias Ringwald 2249711e6c80SMatthias 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){ 225040faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2251de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 225240faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 225340faeb84SMilanka Ringwald return status; 225440faeb84SMilanka Ringwald } 2255de27733dSMatthias Ringwald 22565cf1669fSMatthias Ringwald gatt_client->callback = callback; 22575cf1669fSMatthias Ringwald gatt_client->start_group_handle = service->start_group_handle; 22585cf1669fSMatthias Ringwald gatt_client->end_group_handle = service->end_group_handle; 22595cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_INCLUDED_SERVICE_QUERY; 22603deb3ec6SMatthias Ringwald 22613deb3ec6SMatthias Ringwald gatt_client_run(); 226225b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 22633deb3ec6SMatthias Ringwald } 22643deb3ec6SMatthias Ringwald 2265711e6c80SMatthias 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){ 226640faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2267de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 226840faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 226940faeb84SMilanka Ringwald return status; 227040faeb84SMilanka Ringwald } 22713deb3ec6SMatthias Ringwald 22725cf1669fSMatthias Ringwald gatt_client->callback = callback; 22735cf1669fSMatthias Ringwald gatt_client->start_group_handle = start_handle; 22745cf1669fSMatthias Ringwald gatt_client->end_group_handle = end_handle; 22755cf1669fSMatthias Ringwald gatt_client->filter_with_uuid = 1; 22765cf1669fSMatthias Ringwald gatt_client->uuid16 = uuid16; 22775cf1669fSMatthias Ringwald uuid_add_bluetooth_prefix((uint8_t*) &(gatt_client->uuid128), uuid16); 22785cf1669fSMatthias Ringwald gatt_client->characteristic_start_handle = 0; 22795cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_CHARACTERISTIC_WITH_UUID_QUERY; 22803deb3ec6SMatthias Ringwald gatt_client_run(); 228125b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 22823deb3ec6SMatthias Ringwald } 22833deb3ec6SMatthias Ringwald 2284045d700dSDavid 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){ 228540faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2286de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 228740faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 228840faeb84SMilanka Ringwald return status; 228940faeb84SMilanka Ringwald } 22903deb3ec6SMatthias Ringwald 22915cf1669fSMatthias Ringwald gatt_client->callback = callback; 22925cf1669fSMatthias Ringwald gatt_client->start_group_handle = start_handle; 22935cf1669fSMatthias Ringwald gatt_client->end_group_handle = end_handle; 22945cf1669fSMatthias Ringwald gatt_client->filter_with_uuid = 1; 22955cf1669fSMatthias Ringwald gatt_client->uuid16 = 0; 22965cf1669fSMatthias Ringwald (void)memcpy(gatt_client->uuid128, uuid128, 16); 22975cf1669fSMatthias Ringwald gatt_client->characteristic_start_handle = 0; 22985cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_CHARACTERISTIC_WITH_UUID_QUERY; 22993deb3ec6SMatthias Ringwald gatt_client_run(); 230025b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 23013deb3ec6SMatthias Ringwald } 23023deb3ec6SMatthias Ringwald 23033deb3ec6SMatthias Ringwald 2304b45b7749SMilanka 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){ 2305b45b7749SMilanka Ringwald return gatt_client_discover_characteristics_for_handle_range_by_uuid16(callback, con_handle, service->start_group_handle, service->end_group_handle, uuid16); 23063deb3ec6SMatthias Ringwald } 23073deb3ec6SMatthias Ringwald 2308b45b7749SMilanka 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){ 2309b45b7749SMilanka Ringwald return gatt_client_discover_characteristics_for_handle_range_by_uuid128(callback, con_handle, service->start_group_handle, service->end_group_handle, uuid128); 23103deb3ec6SMatthias Ringwald } 23113deb3ec6SMatthias Ringwald 2312711e6c80SMatthias Ringwald uint8_t gatt_client_discover_characteristic_descriptors(btstack_packet_handler_t callback, hci_con_handle_t con_handle, gatt_client_characteristic_t * characteristic){ 231340faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2314de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 231540faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 231640faeb84SMilanka Ringwald return status; 231740faeb84SMilanka Ringwald } 23183deb3ec6SMatthias Ringwald 23193deb3ec6SMatthias Ringwald if (characteristic->value_handle == characteristic->end_handle){ 232025b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 23213deb3ec6SMatthias Ringwald } 23225cf1669fSMatthias Ringwald gatt_client->callback = callback; 23235cf1669fSMatthias Ringwald gatt_client->start_group_handle = characteristic->value_handle + 1u; 23245cf1669fSMatthias Ringwald gatt_client->end_group_handle = characteristic->end_handle; 23255cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY; 23263deb3ec6SMatthias Ringwald gatt_client_run(); 232725b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 23283deb3ec6SMatthias Ringwald } 23293deb3ec6SMatthias Ringwald 2330711e6c80SMatthias 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){ 233140faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2332de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 233340faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 233440faeb84SMilanka Ringwald return status; 233540faeb84SMilanka Ringwald } 23363deb3ec6SMatthias Ringwald 23375cf1669fSMatthias Ringwald gatt_client->callback = callback; 23385cf1669fSMatthias Ringwald gatt_client->attribute_handle = value_handle; 23395cf1669fSMatthias Ringwald gatt_client->attribute_offset = 0; 23405cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_CHARACTERISTIC_VALUE_QUERY; 23413deb3ec6SMatthias Ringwald gatt_client_run(); 234225b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 23433deb3ec6SMatthias Ringwald } 23443deb3ec6SMatthias Ringwald 2345711e6c80SMatthias 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){ 234640faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2347de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 234840faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 234940faeb84SMilanka Ringwald return status; 235040faeb84SMilanka Ringwald } 23513deb3ec6SMatthias Ringwald 23525cf1669fSMatthias Ringwald gatt_client->callback = callback; 23535cf1669fSMatthias Ringwald gatt_client->start_group_handle = start_handle; 23545cf1669fSMatthias Ringwald gatt_client->end_group_handle = end_handle; 23555cf1669fSMatthias Ringwald gatt_client->query_start_handle = start_handle; 23565cf1669fSMatthias Ringwald gatt_client->query_end_handle = end_handle; 23575cf1669fSMatthias Ringwald gatt_client->uuid16 = uuid16; 23585cf1669fSMatthias Ringwald uuid_add_bluetooth_prefix((uint8_t*) &(gatt_client->uuid128), uuid16); 23595cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_BY_TYPE_REQUEST; 23603deb3ec6SMatthias Ringwald gatt_client_run(); 236125b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 23623deb3ec6SMatthias Ringwald } 23633deb3ec6SMatthias Ringwald 2364045d700dSDavid 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){ 236540faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2366de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 236740faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 236840faeb84SMilanka Ringwald return status; 236940faeb84SMilanka Ringwald } 23703deb3ec6SMatthias Ringwald 23715cf1669fSMatthias Ringwald gatt_client->callback = callback; 23725cf1669fSMatthias Ringwald gatt_client->start_group_handle = start_handle; 23735cf1669fSMatthias Ringwald gatt_client->end_group_handle = end_handle; 23745cf1669fSMatthias Ringwald gatt_client->query_start_handle = start_handle; 23755cf1669fSMatthias Ringwald gatt_client->query_end_handle = end_handle; 23765cf1669fSMatthias Ringwald gatt_client->uuid16 = 0; 23775cf1669fSMatthias Ringwald (void)memcpy(gatt_client->uuid128, uuid128, 16); 23785cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_BY_TYPE_REQUEST; 23793deb3ec6SMatthias Ringwald gatt_client_run(); 238025b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 23813deb3ec6SMatthias Ringwald } 23823deb3ec6SMatthias Ringwald 23833deb3ec6SMatthias Ringwald 2384b45b7749SMilanka 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){ 2385b45b7749SMilanka Ringwald return gatt_client_read_value_of_characteristic_using_value_handle(callback, con_handle, characteristic->value_handle); 23863deb3ec6SMatthias Ringwald } 23873deb3ec6SMatthias Ringwald 2388b45b7749SMilanka 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){ 238940faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2390de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 239140faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 239240faeb84SMilanka Ringwald return status; 239340faeb84SMilanka Ringwald } 23943deb3ec6SMatthias Ringwald 23955cf1669fSMatthias Ringwald gatt_client->callback = callback; 2396b45b7749SMilanka Ringwald gatt_client->attribute_handle = value_handle; 23975cf1669fSMatthias Ringwald gatt_client->attribute_offset = offset; 23985cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_BLOB_QUERY; 23993deb3ec6SMatthias Ringwald gatt_client_run(); 240025b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 24013deb3ec6SMatthias Ringwald } 24023deb3ec6SMatthias Ringwald 2403b45b7749SMilanka 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){ 2404b45b7749SMilanka Ringwald return gatt_client_read_long_value_of_characteristic_using_value_handle_with_offset(callback, con_handle, value_handle, 0); 24053deb3ec6SMatthias Ringwald } 24063deb3ec6SMatthias Ringwald 2407b45b7749SMilanka 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){ 2408b45b7749SMilanka Ringwald return gatt_client_read_long_value_of_characteristic_using_value_handle(callback, con_handle, characteristic->value_handle); 24093deb3ec6SMatthias Ringwald } 24103deb3ec6SMatthias Ringwald 2411f125a8efSMatthias 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){ 241240faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2413de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 241440faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 241540faeb84SMilanka Ringwald return status; 241640faeb84SMilanka Ringwald } 24173deb3ec6SMatthias Ringwald 2418f125a8efSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 2419f125a8efSMatthias Ringwald if (state == P_W2_SEND_READ_MULTIPLE_VARIABLE_REQUEST){ 2420f125a8efSMatthias Ringwald if (gatt_client->bearer_type != ATT_BEARER_ENHANCED_LE){ 2421f125a8efSMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 2422f125a8efSMatthias Ringwald } 2423f125a8efSMatthias Ringwald } 2424f125a8efSMatthias Ringwald #endif 2425f125a8efSMatthias Ringwald 24265cf1669fSMatthias Ringwald gatt_client->callback = callback; 24275cf1669fSMatthias Ringwald gatt_client->read_multiple_handle_count = num_value_handles; 24285cf1669fSMatthias Ringwald gatt_client->read_multiple_handles = value_handles; 2429f125a8efSMatthias Ringwald gatt_client->gatt_client_state = state; 24303deb3ec6SMatthias Ringwald gatt_client_run(); 243125b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 24323deb3ec6SMatthias Ringwald } 24333deb3ec6SMatthias Ringwald 2434f125a8efSMatthias 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){ 2435f125a8efSMatthias Ringwald return gatt_client_read_multiple_characteristic_values_with_state(callback, con_handle, num_value_handles, value_handles, P_W2_SEND_READ_MULTIPLE_REQUEST); 2436f125a8efSMatthias Ringwald } 2437f125a8efSMatthias Ringwald 2438f125a8efSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 2439f125a8efSMatthias 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){ 2440f125a8efSMatthias 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); 2441f125a8efSMatthias Ringwald } 2442f125a8efSMatthias Ringwald #endif 2443f125a8efSMatthias Ringwald 2444de9f8e94SMatthias 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){ 244540faeb84SMilanka Ringwald gatt_client_t * gatt_client; 244640faeb84SMilanka Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 244740faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 244840faeb84SMilanka Ringwald return status; 244940faeb84SMilanka Ringwald } 24503deb3ec6SMatthias Ringwald 2451dda77937SMatthias Ringwald if (value_length > (gatt_client->mtu - 3u)) return GATT_CLIENT_VALUE_TOO_LONG; 24525cf1669fSMatthias Ringwald if (!att_dispatch_client_can_send_now(gatt_client->con_handle)) return GATT_CLIENT_BUSY; 24533deb3ec6SMatthias Ringwald 24546e7b444cSMatthias Ringwald return att_write_request(gatt_client, ATT_WRITE_COMMAND, value_handle, value_length, value); 24553deb3ec6SMatthias Ringwald } 24563deb3ec6SMatthias Ringwald 2457b45b7749SMilanka 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){ 245840faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2459de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 246040faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 246140faeb84SMilanka Ringwald return status; 246240faeb84SMilanka Ringwald } 24633deb3ec6SMatthias Ringwald 24645cf1669fSMatthias Ringwald gatt_client->callback = callback; 24655cf1669fSMatthias Ringwald gatt_client->attribute_handle = value_handle; 24665cf1669fSMatthias Ringwald gatt_client->attribute_length = value_length; 2467b45b7749SMilanka Ringwald gatt_client->attribute_value = value; 24685cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_WRITE_CHARACTERISTIC_VALUE; 24693deb3ec6SMatthias Ringwald gatt_client_run(); 247025b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 24713deb3ec6SMatthias Ringwald } 24723deb3ec6SMatthias Ringwald 2473b45b7749SMilanka 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){ 247440faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2475de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 247640faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 247740faeb84SMilanka Ringwald return status; 247840faeb84SMilanka Ringwald } 24793deb3ec6SMatthias Ringwald 24805cf1669fSMatthias Ringwald gatt_client->callback = callback; 24815cf1669fSMatthias Ringwald gatt_client->attribute_handle = value_handle; 24825cf1669fSMatthias Ringwald gatt_client->attribute_length = value_length; 24835cf1669fSMatthias Ringwald gatt_client->attribute_offset = offset; 2484b45b7749SMilanka Ringwald gatt_client->attribute_value = value; 24855cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_PREPARE_WRITE; 24863deb3ec6SMatthias Ringwald gatt_client_run(); 248725b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 24883deb3ec6SMatthias Ringwald } 24893deb3ec6SMatthias Ringwald 2490711e6c80SMatthias 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){ 24919c662c9bSMatthias Ringwald return gatt_client_write_long_value_of_characteristic_with_offset(callback, con_handle, value_handle, 0, value_length, value); 24923deb3ec6SMatthias Ringwald } 24933deb3ec6SMatthias Ringwald 2494711e6c80SMatthias 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){ 249540faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2496de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 249740faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 249840faeb84SMilanka Ringwald return status; 249940faeb84SMilanka Ringwald } 25003deb3ec6SMatthias Ringwald 25015cf1669fSMatthias Ringwald gatt_client->callback = callback; 25025cf1669fSMatthias Ringwald gatt_client->attribute_handle = value_handle; 25035cf1669fSMatthias Ringwald gatt_client->attribute_length = value_length; 25045cf1669fSMatthias Ringwald gatt_client->attribute_offset = 0; 25055cf1669fSMatthias Ringwald gatt_client->attribute_value = value; 25065cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_PREPARE_RELIABLE_WRITE; 25073deb3ec6SMatthias Ringwald gatt_client_run(); 250825b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 25093deb3ec6SMatthias Ringwald } 25103deb3ec6SMatthias Ringwald 2511711e6c80SMatthias 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){ 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 25183deb3ec6SMatthias Ringwald if ( (configuration & GATT_CLIENT_CHARACTERISTICS_CONFIGURATION_NOTIFICATION) && 25194ea43905SMatthias Ringwald ((characteristic->properties & ATT_PROPERTY_NOTIFY) == 0u)) { 2520d8e8f12aSMatthias Ringwald log_info("gatt_client_write_client_characteristic_configuration: GATT_CLIENT_CHARACTERISTIC_NOTIFICATION_NOT_SUPPORTED"); 2521616edd56SMatthias Ringwald return GATT_CLIENT_CHARACTERISTIC_NOTIFICATION_NOT_SUPPORTED; 25223deb3ec6SMatthias Ringwald } else if ( (configuration & GATT_CLIENT_CHARACTERISTICS_CONFIGURATION_INDICATION) && 25234ea43905SMatthias Ringwald ((characteristic->properties & ATT_PROPERTY_INDICATE) == 0u)){ 2524d8e8f12aSMatthias Ringwald log_info("gatt_client_write_client_characteristic_configuration: GATT_CLIENT_CHARACTERISTIC_INDICATION_NOT_SUPPORTED"); 2525616edd56SMatthias Ringwald return GATT_CLIENT_CHARACTERISTIC_INDICATION_NOT_SUPPORTED; 25263deb3ec6SMatthias Ringwald } 25273deb3ec6SMatthias Ringwald 25285cf1669fSMatthias Ringwald gatt_client->callback = callback; 25295cf1669fSMatthias Ringwald gatt_client->start_group_handle = characteristic->value_handle; 25305cf1669fSMatthias Ringwald gatt_client->end_group_handle = characteristic->end_handle; 25315cf1669fSMatthias Ringwald little_endian_store_16(gatt_client->client_characteristic_configuration_value, 0, configuration); 25323deb3ec6SMatthias Ringwald 2533abdc9fb5SMatthias Ringwald #ifdef ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY 25345cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_FIND_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY; 2535abdc9fb5SMatthias Ringwald #else 25365cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY; 2537abdc9fb5SMatthias Ringwald #endif 25383deb3ec6SMatthias Ringwald gatt_client_run(); 25399cb80b17SMilanka Ringwald return ERROR_CODE_SUCCESS; 25403deb3ec6SMatthias Ringwald } 25413deb3ec6SMatthias Ringwald 2542711e6c80SMatthias 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){ 254340faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2544de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 254540faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 254640faeb84SMilanka Ringwald return status; 254740faeb84SMilanka Ringwald } 25483deb3ec6SMatthias Ringwald 25495cf1669fSMatthias Ringwald gatt_client->callback = callback; 25505cf1669fSMatthias Ringwald gatt_client->attribute_handle = descriptor_handle; 25513deb3ec6SMatthias Ringwald 25525cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_CHARACTERISTIC_DESCRIPTOR_QUERY; 25533deb3ec6SMatthias Ringwald gatt_client_run(); 255425b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 25553deb3ec6SMatthias Ringwald } 25563deb3ec6SMatthias Ringwald 2557711e6c80SMatthias 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){ 25589c662c9bSMatthias Ringwald return gatt_client_read_characteristic_descriptor_using_descriptor_handle(callback, con_handle, descriptor->handle); 25593deb3ec6SMatthias Ringwald } 25603deb3ec6SMatthias Ringwald 2561711e6c80SMatthias 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){ 256240faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2563de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 256440faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 256540faeb84SMilanka Ringwald return status; 256640faeb84SMilanka Ringwald } 25673deb3ec6SMatthias Ringwald 25685cf1669fSMatthias Ringwald gatt_client->callback = callback; 25695cf1669fSMatthias Ringwald gatt_client->attribute_handle = descriptor_handle; 25705cf1669fSMatthias Ringwald gatt_client->attribute_offset = offset; 25715cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_QUERY; 25723deb3ec6SMatthias Ringwald gatt_client_run(); 257325b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 25743deb3ec6SMatthias Ringwald } 25753deb3ec6SMatthias Ringwald 2576711e6c80SMatthias 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){ 25779c662c9bSMatthias Ringwald return gatt_client_read_long_characteristic_descriptor_using_descriptor_handle_with_offset(callback, con_handle, descriptor_handle, 0); 25783deb3ec6SMatthias Ringwald } 25793deb3ec6SMatthias Ringwald 2580711e6c80SMatthias 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){ 25819c662c9bSMatthias Ringwald return gatt_client_read_long_characteristic_descriptor_using_descriptor_handle(callback, con_handle, descriptor->handle); 25823deb3ec6SMatthias Ringwald } 25833deb3ec6SMatthias Ringwald 2584b45b7749SMilanka 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){ 258540faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2586de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 258740faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 258840faeb84SMilanka Ringwald return status; 258940faeb84SMilanka Ringwald } 25903deb3ec6SMatthias Ringwald 25915cf1669fSMatthias Ringwald gatt_client->callback = callback; 25925cf1669fSMatthias Ringwald gatt_client->attribute_handle = descriptor_handle; 2593b45b7749SMilanka Ringwald gatt_client->attribute_length = value_length; 25945cf1669fSMatthias Ringwald gatt_client->attribute_offset = 0; 2595b45b7749SMilanka Ringwald gatt_client->attribute_value = value; 25965cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_WRITE_CHARACTERISTIC_DESCRIPTOR; 25973deb3ec6SMatthias Ringwald gatt_client_run(); 259825b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 25993deb3ec6SMatthias Ringwald } 26003deb3ec6SMatthias Ringwald 260148cdff9cSMilanka 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){ 260248cdff9cSMilanka Ringwald return gatt_client_write_characteristic_descriptor_using_descriptor_handle(callback, con_handle, descriptor->handle, value_length, value); 26033deb3ec6SMatthias Ringwald } 26043deb3ec6SMatthias Ringwald 2605b45b7749SMilanka 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){ 260640faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2607de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 260840faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 260940faeb84SMilanka Ringwald return status; 261040faeb84SMilanka Ringwald } 26113deb3ec6SMatthias Ringwald 26125cf1669fSMatthias Ringwald gatt_client->callback = callback; 26135cf1669fSMatthias Ringwald gatt_client->attribute_handle = descriptor_handle; 2614b45b7749SMilanka Ringwald gatt_client->attribute_length = value_length; 26155cf1669fSMatthias Ringwald gatt_client->attribute_offset = offset; 2616b45b7749SMilanka Ringwald gatt_client->attribute_value = value; 26175cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR; 26183deb3ec6SMatthias Ringwald gatt_client_run(); 261925b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 26203deb3ec6SMatthias Ringwald } 26213deb3ec6SMatthias Ringwald 2622b45b7749SMilanka 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){ 2623b45b7749SMilanka Ringwald return gatt_client_write_long_characteristic_descriptor_using_descriptor_handle_with_offset(callback, con_handle, descriptor_handle, 0, value_length, value); 26243deb3ec6SMatthias Ringwald } 26253deb3ec6SMatthias Ringwald 2626b45b7749SMilanka 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){ 2627b45b7749SMilanka Ringwald return gatt_client_write_long_characteristic_descriptor_using_descriptor_handle(callback, con_handle, descriptor->handle, value_length, value); 26283deb3ec6SMatthias Ringwald } 26293deb3ec6SMatthias Ringwald 26303deb3ec6SMatthias Ringwald /** 26313deb3ec6SMatthias Ringwald * @brief -> gatt complete event 26323deb3ec6SMatthias Ringwald */ 2633b45b7749SMilanka 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){ 263440faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2635de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 263640faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 263740faeb84SMilanka Ringwald return status; 263840faeb84SMilanka Ringwald } 26393deb3ec6SMatthias Ringwald 26405cf1669fSMatthias Ringwald gatt_client->callback = callback; 26415cf1669fSMatthias Ringwald gatt_client->attribute_handle = attribute_handle; 2642b45b7749SMilanka Ringwald gatt_client->attribute_length = value_length; 26435cf1669fSMatthias Ringwald gatt_client->attribute_offset = offset; 2644b45b7749SMilanka Ringwald gatt_client->attribute_value = value; 26455cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_PREPARE_WRITE_SINGLE; 26463deb3ec6SMatthias Ringwald gatt_client_run(); 264725b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 26483deb3ec6SMatthias Ringwald } 26493deb3ec6SMatthias Ringwald 26503deb3ec6SMatthias Ringwald /** 26513deb3ec6SMatthias Ringwald * @brief -> gatt complete event 26523deb3ec6SMatthias Ringwald */ 2653711e6c80SMatthias Ringwald uint8_t gatt_client_execute_write(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 265440faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2655de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 265640faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 265740faeb84SMilanka Ringwald return status; 265840faeb84SMilanka Ringwald } 26593deb3ec6SMatthias Ringwald 26605cf1669fSMatthias Ringwald gatt_client->callback = callback; 26615cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_EXECUTE_PREPARED_WRITE; 26623deb3ec6SMatthias Ringwald gatt_client_run(); 266325b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 26643deb3ec6SMatthias Ringwald } 26653deb3ec6SMatthias Ringwald 26663deb3ec6SMatthias Ringwald /** 26673deb3ec6SMatthias Ringwald * @brief -> gatt complete event 26683deb3ec6SMatthias Ringwald */ 2669711e6c80SMatthias Ringwald uint8_t gatt_client_cancel_write(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 267040faeb84SMilanka Ringwald gatt_client_t * gatt_client; 2671de27733dSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_request(con_handle, &gatt_client); 267240faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 267340faeb84SMilanka Ringwald return status; 267440faeb84SMilanka Ringwald } 26753deb3ec6SMatthias Ringwald 26765cf1669fSMatthias Ringwald gatt_client->callback = callback; 26775cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_CANCEL_PREPARED_WRITE; 26783deb3ec6SMatthias Ringwald gatt_client_run(); 26797d2258b3SMilanka Ringwald return ERROR_CODE_SUCCESS; 26803deb3ec6SMatthias Ringwald } 26813deb3ec6SMatthias Ringwald 2682313e337bSMatthias Ringwald void gatt_client_deserialize_service(const uint8_t *packet, int offset, gatt_client_service_t * service){ 26836ba2ad22SMatthias Ringwald service->start_group_handle = little_endian_read_16(packet, offset); 26846ba2ad22SMatthias Ringwald service->end_group_handle = little_endian_read_16(packet, offset + 2); 26856ba2ad22SMatthias Ringwald reverse_128(&packet[offset + 4], service->uuid128); 26866ba2ad22SMatthias Ringwald if (uuid_has_bluetooth_prefix(service->uuid128)){ 26876ba2ad22SMatthias Ringwald service->uuid16 = big_endian_read_32(service->uuid128, 0); 2688c839c6f9SMatthias Ringwald } else { 2689c839c6f9SMatthias Ringwald service->uuid16 = 0; 26906ba2ad22SMatthias Ringwald } 26916ba2ad22SMatthias Ringwald } 26926ba2ad22SMatthias Ringwald 2693313e337bSMatthias Ringwald void gatt_client_deserialize_characteristic(const uint8_t * packet, int offset, gatt_client_characteristic_t * characteristic){ 26946ba2ad22SMatthias Ringwald characteristic->start_handle = little_endian_read_16(packet, offset); 26956ba2ad22SMatthias Ringwald characteristic->value_handle = little_endian_read_16(packet, offset + 2); 26966ba2ad22SMatthias Ringwald characteristic->end_handle = little_endian_read_16(packet, offset + 4); 26976ba2ad22SMatthias Ringwald characteristic->properties = little_endian_read_16(packet, offset + 6); 269886c38559SMatthias Ringwald reverse_128(&packet[offset+8], characteristic->uuid128); 26996ba2ad22SMatthias Ringwald if (uuid_has_bluetooth_prefix(characteristic->uuid128)){ 27006ba2ad22SMatthias Ringwald characteristic->uuid16 = big_endian_read_32(characteristic->uuid128, 0); 2701c839c6f9SMatthias Ringwald } else { 2702c839c6f9SMatthias Ringwald characteristic->uuid16 = 0; 27036ba2ad22SMatthias Ringwald } 27046ba2ad22SMatthias Ringwald } 27056ba2ad22SMatthias Ringwald 2706313e337bSMatthias Ringwald void gatt_client_deserialize_characteristic_descriptor(const uint8_t * packet, int offset, gatt_client_characteristic_descriptor_t * descriptor){ 27076ba2ad22SMatthias Ringwald descriptor->handle = little_endian_read_16(packet, offset); 27086ba2ad22SMatthias Ringwald reverse_128(&packet[offset+2], descriptor->uuid128); 2709b4895529SJakob Krantz if (uuid_has_bluetooth_prefix(descriptor->uuid128)){ 2710b4895529SJakob Krantz descriptor->uuid16 = big_endian_read_32(descriptor->uuid128, 0); 2711c839c6f9SMatthias Ringwald } else { 2712c839c6f9SMatthias Ringwald descriptor->uuid16 = 0; 2713b4895529SJakob Krantz } 27146ba2ad22SMatthias Ringwald } 27155cf6c434SJakob Krantz 27165cf6c434SJakob Krantz void gatt_client_send_mtu_negotiation(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 271740faeb84SMilanka Ringwald gatt_client_t * gatt_client; 271840faeb84SMilanka Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 271940faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 272040faeb84SMilanka Ringwald return; 272140faeb84SMilanka Ringwald } 272240faeb84SMilanka Ringwald if (gatt_client->mtu_state == MTU_AUTO_EXCHANGE_DISABLED){ 272340faeb84SMilanka Ringwald gatt_client->callback = callback; 272440faeb84SMilanka Ringwald gatt_client->mtu_state = SEND_MTU_EXCHANGE; 27255cf6c434SJakob Krantz gatt_client_run(); 27265cf6c434SJakob Krantz } 27275cf6c434SJakob Krantz } 272847181045SMatthias Ringwald 272959d34cd2SMatthias Ringwald uint8_t gatt_client_request_to_write_without_response(btstack_context_callback_registration_t * callback_registration, hci_con_handle_t con_handle){ 273059d34cd2SMatthias Ringwald gatt_client_t * gatt_client; 273159d34cd2SMatthias Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 273259d34cd2SMatthias Ringwald if (status != ERROR_CODE_SUCCESS){ 273359d34cd2SMatthias Ringwald return status; 273459d34cd2SMatthias Ringwald } 273559d34cd2SMatthias Ringwald bool added = btstack_linked_list_add_tail(&gatt_client->write_without_response_requests, (btstack_linked_item_t*) callback_registration); 273659d34cd2SMatthias Ringwald att_dispatch_client_request_can_send_now_event(gatt_client->con_handle); 273759d34cd2SMatthias Ringwald if (added){ 273859d34cd2SMatthias Ringwald return ERROR_CODE_SUCCESS; 273959d34cd2SMatthias Ringwald } else { 274059d34cd2SMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 274159d34cd2SMatthias Ringwald } 274259d34cd2SMatthias Ringwald } 274359d34cd2SMatthias Ringwald 274453e9c18fSMatthias Ringwald uint8_t gatt_client_request_to_send_gatt_query(btstack_context_callback_registration_t * callback_registration, hci_con_handle_t con_handle){ 274553e9c18fSMatthias Ringwald gatt_client_t * gatt_client; 274653e9c18fSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 274753e9c18fSMatthias Ringwald if (status != ERROR_CODE_SUCCESS){ 274853e9c18fSMatthias Ringwald return status; 274953e9c18fSMatthias Ringwald } 275053e9c18fSMatthias Ringwald bool added = btstack_linked_list_add_tail(&gatt_client->query_requests, (btstack_linked_item_t*) callback_registration); 275153e9c18fSMatthias Ringwald gatt_client_notify_can_send_query(gatt_client); 275253e9c18fSMatthias Ringwald if (added){ 275353e9c18fSMatthias Ringwald return ERROR_CODE_SUCCESS; 275453e9c18fSMatthias Ringwald } else { 275553e9c18fSMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 275653e9c18fSMatthias Ringwald } 275753e9c18fSMatthias Ringwald } 275853e9c18fSMatthias Ringwald 275947181045SMatthias Ringwald uint8_t gatt_client_request_can_write_without_response_event(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 276040faeb84SMilanka Ringwald gatt_client_t * gatt_client; 276140faeb84SMilanka Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 276240faeb84SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 276340faeb84SMilanka Ringwald return status; 276440faeb84SMilanka Ringwald } 276540faeb84SMilanka Ringwald if (gatt_client->write_without_response_callback != NULL){ 276640faeb84SMilanka Ringwald return GATT_CLIENT_IN_WRONG_STATE; 276740faeb84SMilanka Ringwald } 276840faeb84SMilanka Ringwald gatt_client->write_without_response_callback = callback; 276940faeb84SMilanka Ringwald att_dispatch_client_request_can_send_now_event(gatt_client->con_handle); 27707d2258b3SMilanka Ringwald return ERROR_CODE_SUCCESS; 277147181045SMatthias Ringwald } 2772a6121b51SMilanka Ringwald 27737627a0deSMatthias Ringwald 27747627a0deSMatthias Ringwald #if defined(ENABLE_GATT_OVER_CLASSIC) || defined(ENABLE_GATT_OVER_EATT) 27751450cdc6SMatthias Ringwald 27761450cdc6SMatthias Ringwald #include "hci_event.h" 27771450cdc6SMatthias Ringwald 27781450cdc6SMatthias Ringwald static const hci_event_t gatt_client_connected = { 27791450cdc6SMatthias Ringwald GATT_EVENT_CONNECTED, 0, "1BH" 27801450cdc6SMatthias Ringwald }; 27811450cdc6SMatthias Ringwald 27826b4a68c3SMatthias Ringwald static const hci_event_t gatt_client_disconnected = { 27836b4a68c3SMatthias Ringwald GATT_EVENT_DISCONNECTED, 0, "H" 27846b4a68c3SMatthias Ringwald }; 27857627a0deSMatthias Ringwald #endif 27867627a0deSMatthias Ringwald 27877627a0deSMatthias Ringwald #ifdef ENABLE_GATT_OVER_CLASSIC 27887627a0deSMatthias Ringwald 27897627a0deSMatthias Ringwald #include "bluetooth_psm.h" 27907627a0deSMatthias Ringwald 27917627a0deSMatthias Ringwald // single active SDP query 27927627a0deSMatthias Ringwald static gatt_client_t * gatt_client_classic_active_sdp_query; 27937627a0deSMatthias Ringwald 27947627a0deSMatthias Ringwald // macos protocol descriptor list requires 16 bytes 27957627a0deSMatthias Ringwald static uint8_t gatt_client_classic_sdp_buffer[32]; 27967627a0deSMatthias Ringwald 27976b4a68c3SMatthias Ringwald 27981450cdc6SMatthias Ringwald static gatt_client_t * gatt_client_get_context_for_classic_addr(bd_addr_t addr){ 27991450cdc6SMatthias Ringwald btstack_linked_item_t *it; 28001450cdc6SMatthias Ringwald for (it = (btstack_linked_item_t *) gatt_client_connections; it != NULL; it = it->next){ 28011450cdc6SMatthias Ringwald gatt_client_t * gatt_client = (gatt_client_t *) it; 28021450cdc6SMatthias Ringwald if (memcmp(gatt_client->addr, addr, 6) == 0){ 28031450cdc6SMatthias Ringwald return gatt_client; 28041450cdc6SMatthias Ringwald } 28051450cdc6SMatthias Ringwald } 28061450cdc6SMatthias Ringwald return NULL; 28071450cdc6SMatthias Ringwald } 28081450cdc6SMatthias Ringwald 28091450cdc6SMatthias Ringwald static gatt_client_t * gatt_client_get_context_for_l2cap_cid(uint16_t l2cap_cid){ 28101450cdc6SMatthias Ringwald btstack_linked_item_t *it; 28111450cdc6SMatthias Ringwald for (it = (btstack_linked_item_t *) gatt_client_connections; it != NULL; it = it->next){ 28121450cdc6SMatthias Ringwald gatt_client_t * gatt_client = (gatt_client_t *) it; 28131450cdc6SMatthias Ringwald if (gatt_client->l2cap_cid == l2cap_cid){ 28141450cdc6SMatthias Ringwald return gatt_client; 28151450cdc6SMatthias Ringwald } 28161450cdc6SMatthias Ringwald } 28171450cdc6SMatthias Ringwald return NULL; 28181450cdc6SMatthias Ringwald } 28191450cdc6SMatthias Ringwald 28201450cdc6SMatthias Ringwald static void gatt_client_classic_handle_connected(gatt_client_t * gatt_client, uint8_t status){ 28211450cdc6SMatthias Ringwald bd_addr_t addr; 2822d5529700SMatthias Ringwald // cppcheck-suppress uninitvar ; addr is reported as uninitialized although it's the destination of the memcpy 28231450cdc6SMatthias Ringwald memcpy(addr, gatt_client->addr, 6); 28241450cdc6SMatthias Ringwald hci_con_handle_t con_handle = gatt_client->con_handle; 28251450cdc6SMatthias Ringwald btstack_packet_handler_t callback = gatt_client->callback; 28261450cdc6SMatthias Ringwald if (status != ERROR_CODE_SUCCESS){ 28271450cdc6SMatthias Ringwald btstack_linked_list_remove(&gatt_client_connections, (btstack_linked_item_t *) gatt_client); 28281450cdc6SMatthias Ringwald btstack_memory_gatt_client_free(gatt_client); 28291450cdc6SMatthias Ringwald } 28301450cdc6SMatthias Ringwald uint8_t buffer[20]; 28311450cdc6SMatthias Ringwald uint16_t len = hci_event_create_from_template_and_arguments(buffer, sizeof(buffer), &gatt_client_connected, status, addr, 28321450cdc6SMatthias Ringwald con_handle); 28331450cdc6SMatthias Ringwald (*callback)(HCI_EVENT_PACKET, 0, buffer, len); 28341450cdc6SMatthias Ringwald } 28351450cdc6SMatthias Ringwald 28366b4a68c3SMatthias Ringwald static void gatt_client_classic_handle_disconnected(gatt_client_t * gatt_client){ 28376b4a68c3SMatthias Ringwald 28386b4a68c3SMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, ATT_ERROR_HCI_DISCONNECT_RECEIVED); 28396b4a68c3SMatthias Ringwald gatt_client_timeout_stop(gatt_client); 28406b4a68c3SMatthias Ringwald 28416b4a68c3SMatthias Ringwald hci_con_handle_t con_handle = gatt_client->con_handle; 28426b4a68c3SMatthias Ringwald btstack_packet_handler_t callback = gatt_client->callback; 28436b4a68c3SMatthias Ringwald btstack_linked_list_remove(&gatt_client_connections, (btstack_linked_item_t *) gatt_client); 28446b4a68c3SMatthias Ringwald btstack_memory_gatt_client_free(gatt_client); 28456b4a68c3SMatthias Ringwald 28466b4a68c3SMatthias Ringwald uint8_t buffer[20]; 28476b4a68c3SMatthias Ringwald uint16_t len = hci_event_create_from_template_and_arguments(buffer, sizeof(buffer), &gatt_client_disconnected, con_handle); 28486b4a68c3SMatthias Ringwald (*callback)(HCI_EVENT_PACKET, 0, buffer, len); 28496b4a68c3SMatthias Ringwald } 28506b4a68c3SMatthias Ringwald 28511450cdc6SMatthias Ringwald static void gatt_client_l2cap_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size){ 28521450cdc6SMatthias Ringwald gatt_client_t * gatt_client = NULL; 28531450cdc6SMatthias Ringwald uint8_t status; 28541450cdc6SMatthias Ringwald switch (packet_type){ 28551450cdc6SMatthias Ringwald case HCI_EVENT_PACKET: 28561450cdc6SMatthias Ringwald switch (hci_event_packet_get_type(packet)) { 28571450cdc6SMatthias Ringwald case L2CAP_EVENT_CHANNEL_OPENED: 28581450cdc6SMatthias Ringwald status = l2cap_event_channel_opened_get_status(packet); 28591450cdc6SMatthias Ringwald gatt_client = gatt_client_get_context_for_l2cap_cid(l2cap_event_channel_opened_get_local_cid(packet)); 28601450cdc6SMatthias Ringwald btstack_assert(gatt_client != NULL); 2861664e1f18SMatthias Ringwald // if status != 0, gatt_client will be discarded 2862664e1f18SMatthias Ringwald gatt_client->gatt_client_state = P_READY; 28631450cdc6SMatthias Ringwald gatt_client->con_handle = l2cap_event_channel_opened_get_handle(packet); 2864ac4c2bc6SMatthias Ringwald gatt_client->mtu = l2cap_event_channel_opened_get_remote_mtu(packet); 28651450cdc6SMatthias Ringwald gatt_client_classic_handle_connected(gatt_client, status); 2866664e1f18SMatthias Ringwald break; 28671450cdc6SMatthias Ringwald case L2CAP_EVENT_CHANNEL_CLOSED: 28686b4a68c3SMatthias Ringwald gatt_client = gatt_client_get_context_for_l2cap_cid(l2cap_event_channel_closed_get_local_cid(packet)); 28696b4a68c3SMatthias Ringwald gatt_client_classic_handle_disconnected(gatt_client); 28701450cdc6SMatthias Ringwald break; 28711450cdc6SMatthias Ringwald default: 28721450cdc6SMatthias Ringwald break; 28731450cdc6SMatthias Ringwald } 28741450cdc6SMatthias Ringwald break; 28751450cdc6SMatthias Ringwald case L2CAP_DATA_PACKET: 28761450cdc6SMatthias Ringwald gatt_client = gatt_client_get_context_for_l2cap_cid(channel); 28771450cdc6SMatthias Ringwald btstack_assert(gatt_client != NULL); 2878664e1f18SMatthias Ringwald gatt_client_handle_att_response(gatt_client, packet, size); 2879664e1f18SMatthias Ringwald gatt_client_run(); 28801450cdc6SMatthias Ringwald break; 288110cae6eaSMatthias Ringwald default: 288210cae6eaSMatthias Ringwald break; 28831450cdc6SMatthias Ringwald } 28841450cdc6SMatthias Ringwald } 28851450cdc6SMatthias Ringwald 28861450cdc6SMatthias Ringwald static void gatt_client_handle_sdp_client_query_attribute_value(gatt_client_t * connection, uint8_t *packet){ 28871450cdc6SMatthias Ringwald des_iterator_t des_list_it; 28881450cdc6SMatthias Ringwald des_iterator_t prot_it; 28891450cdc6SMatthias Ringwald 28901450cdc6SMatthias Ringwald if (sdp_event_query_attribute_byte_get_attribute_length(packet) <= sizeof(gatt_client_classic_sdp_buffer)) { 28911450cdc6SMatthias Ringwald gatt_client_classic_sdp_buffer[sdp_event_query_attribute_byte_get_data_offset(packet)] = sdp_event_query_attribute_byte_get_data(packet); 28921450cdc6SMatthias Ringwald if ((uint16_t)(sdp_event_query_attribute_byte_get_data_offset(packet)+1) == sdp_event_query_attribute_byte_get_attribute_length(packet)) { 28931450cdc6SMatthias Ringwald switch(sdp_event_query_attribute_byte_get_attribute_id(packet)) { 28941450cdc6SMatthias Ringwald case BLUETOOTH_ATTRIBUTE_PROTOCOL_DESCRIPTOR_LIST: 28951450cdc6SMatthias 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)) { 28961450cdc6SMatthias Ringwald uint8_t *des_element; 28971450cdc6SMatthias Ringwald uint8_t *element; 28981450cdc6SMatthias Ringwald uint32_t uuid; 28991450cdc6SMatthias Ringwald 29001450cdc6SMatthias Ringwald if (des_iterator_get_type(&des_list_it) != DE_DES) continue; 29011450cdc6SMatthias Ringwald 29021450cdc6SMatthias Ringwald des_element = des_iterator_get_element(&des_list_it); 29031450cdc6SMatthias Ringwald des_iterator_init(&prot_it, des_element); 29041450cdc6SMatthias Ringwald element = des_iterator_get_element(&prot_it); 29051450cdc6SMatthias Ringwald 29061450cdc6SMatthias Ringwald if (de_get_element_type(element) != DE_UUID) continue; 29071450cdc6SMatthias Ringwald 29081450cdc6SMatthias Ringwald uuid = de_get_uuid32(element); 29091450cdc6SMatthias Ringwald des_iterator_next(&prot_it); 29101450cdc6SMatthias Ringwald // we assume that the even if there are both roles supported, remote device uses the same psm and avdtp version for both 29111450cdc6SMatthias Ringwald switch (uuid){ 29121450cdc6SMatthias Ringwald case BLUETOOTH_PROTOCOL_L2CAP: 29131450cdc6SMatthias Ringwald if (!des_iterator_has_more(&prot_it)) continue; 29141450cdc6SMatthias Ringwald de_element_get_uint16(des_iterator_get_element(&prot_it), &connection->l2cap_psm); 29151450cdc6SMatthias Ringwald break; 29161450cdc6SMatthias Ringwald default: 29171450cdc6SMatthias Ringwald break; 29181450cdc6SMatthias Ringwald } 29191450cdc6SMatthias Ringwald } 29201450cdc6SMatthias Ringwald break; 29211450cdc6SMatthias Ringwald 29221450cdc6SMatthias Ringwald default: 29231450cdc6SMatthias Ringwald break; 29241450cdc6SMatthias Ringwald } 29251450cdc6SMatthias Ringwald } 29261450cdc6SMatthias Ringwald } 29271450cdc6SMatthias Ringwald } 29281450cdc6SMatthias Ringwald 29291450cdc6SMatthias Ringwald static void gatt_client_classic_sdp_handler(uint8_t packet_type, uint16_t handle, uint8_t *packet, uint16_t size){ 29301450cdc6SMatthias Ringwald gatt_client_t * gatt_client = gatt_client_classic_active_sdp_query; 29311450cdc6SMatthias Ringwald btstack_assert(gatt_client != NULL); 29321450cdc6SMatthias Ringwald uint8_t status; 29331450cdc6SMatthias Ringwald 29341450cdc6SMatthias Ringwald // TODO: handle sdp events, get l2cap psm 29351450cdc6SMatthias Ringwald switch (hci_event_packet_get_type(packet)){ 29361450cdc6SMatthias Ringwald case SDP_EVENT_QUERY_ATTRIBUTE_VALUE: 29371450cdc6SMatthias Ringwald gatt_client_handle_sdp_client_query_attribute_value(gatt_client, packet); 29381450cdc6SMatthias Ringwald // TODO: 29391450cdc6SMatthias Ringwald return; 29401450cdc6SMatthias Ringwald case SDP_EVENT_QUERY_COMPLETE: 29411450cdc6SMatthias Ringwald status = sdp_event_query_complete_get_status(packet); 29421450cdc6SMatthias Ringwald gatt_client_classic_active_sdp_query = NULL; 29431450cdc6SMatthias Ringwald log_info("l2cap psm: %0x, status %02x", gatt_client->l2cap_psm, status); 29441450cdc6SMatthias Ringwald if (status != ERROR_CODE_SUCCESS) break; 29451450cdc6SMatthias Ringwald if (gatt_client->l2cap_psm == 0) { 29461450cdc6SMatthias Ringwald status = SDP_SERVICE_NOT_FOUND; 29471450cdc6SMatthias Ringwald break; 29481450cdc6SMatthias Ringwald } 29491450cdc6SMatthias Ringwald break; 29501450cdc6SMatthias Ringwald default: 29511450cdc6SMatthias Ringwald btstack_assert(false); 29521450cdc6SMatthias Ringwald return; 29531450cdc6SMatthias Ringwald } 29541450cdc6SMatthias Ringwald 29551450cdc6SMatthias Ringwald // done 29561450cdc6SMatthias Ringwald if (status == ERROR_CODE_SUCCESS){ 29571450cdc6SMatthias Ringwald gatt_client->gatt_client_state = P_W4_L2CAP_CONNECTION; 29581450cdc6SMatthias Ringwald status = l2cap_create_channel(gatt_client_l2cap_handler, gatt_client->addr, gatt_client->l2cap_psm, 0xffff, 29591450cdc6SMatthias Ringwald &gatt_client->l2cap_cid); 29601450cdc6SMatthias Ringwald } 29611450cdc6SMatthias Ringwald if (status != ERROR_CODE_SUCCESS) { 29621450cdc6SMatthias Ringwald gatt_client_classic_handle_connected(gatt_client, status); 29631450cdc6SMatthias Ringwald } 29641450cdc6SMatthias Ringwald } 29651450cdc6SMatthias Ringwald 29661450cdc6SMatthias Ringwald static void gatt_client_classic_sdp_start(void * context){ 29671450cdc6SMatthias Ringwald gatt_client_classic_active_sdp_query = (gatt_client_t *) context; 29681450cdc6SMatthias Ringwald gatt_client_classic_active_sdp_query->gatt_client_state = P_W4_SDP_QUERY; 29691450cdc6SMatthias Ringwald sdp_client_query_uuid16(gatt_client_classic_sdp_handler, gatt_client_classic_active_sdp_query->addr, ORG_BLUETOOTH_SERVICE_GENERIC_ATTRIBUTE); 29701450cdc6SMatthias Ringwald } 29711450cdc6SMatthias Ringwald 29721450cdc6SMatthias Ringwald uint8_t gatt_client_classic_connect(btstack_packet_handler_t callback, bd_addr_t addr){ 29731450cdc6SMatthias Ringwald gatt_client_t * gatt_client = gatt_client_get_context_for_classic_addr(addr); 29741450cdc6SMatthias Ringwald if (gatt_client != NULL){ 29751450cdc6SMatthias Ringwald return ERROR_CODE_ACL_CONNECTION_ALREADY_EXISTS; 29761450cdc6SMatthias Ringwald } 29771450cdc6SMatthias Ringwald gatt_client = btstack_memory_gatt_client_get(); 29781450cdc6SMatthias Ringwald if (gatt_client == NULL){ 29791450cdc6SMatthias Ringwald return ERROR_CODE_MEMORY_CAPACITY_EXCEEDED; 29801450cdc6SMatthias Ringwald } 29811450cdc6SMatthias Ringwald // init state 2982e9cdf30bSMatthias Ringwald gatt_client->bearer_type = ATT_BEARER_UNENHANCED_CLASSIC; 29831450cdc6SMatthias Ringwald gatt_client->con_handle = HCI_CON_HANDLE_INVALID; 29841450cdc6SMatthias Ringwald memcpy(gatt_client->addr, addr, 6); 29851450cdc6SMatthias Ringwald gatt_client->mtu = ATT_DEFAULT_MTU; 29861450cdc6SMatthias Ringwald gatt_client->security_level = LEVEL_0; 29871450cdc6SMatthias Ringwald gatt_client->mtu_state = MTU_AUTO_EXCHANGE_DISABLED; 29881450cdc6SMatthias Ringwald gatt_client->gatt_client_state = P_W2_SDP_QUERY; 29891450cdc6SMatthias Ringwald gatt_client->sdp_query_request.callback = &gatt_client_classic_sdp_start; 29901450cdc6SMatthias Ringwald gatt_client->sdp_query_request.context = gatt_client; 29911450cdc6SMatthias Ringwald gatt_client->callback = callback; 2992cbd76cecSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 2993cbd76cecSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_IDLE; 2994cbd76cecSMatthias Ringwald #endif 29951450cdc6SMatthias Ringwald btstack_linked_list_add(&gatt_client_connections, (btstack_linked_item_t*)gatt_client); 29961450cdc6SMatthias Ringwald sdp_client_register_query_callback(&gatt_client->sdp_query_request); 2997b7b03a30SMatthias Ringwald return ERROR_CODE_SUCCESS; 29981450cdc6SMatthias Ringwald } 29991450cdc6SMatthias Ringwald 30001450cdc6SMatthias Ringwald uint8_t gatt_client_classic_disconnect(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 30011450cdc6SMatthias Ringwald gatt_client_t * gatt_client = gatt_client_get_context_for_handle(con_handle); 30021450cdc6SMatthias Ringwald if (gatt_client == NULL){ 30031450cdc6SMatthias Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 30041450cdc6SMatthias Ringwald } 30051450cdc6SMatthias Ringwald gatt_client->callback = callback; 30061450cdc6SMatthias Ringwald return l2cap_disconnect(gatt_client->l2cap_cid); 30071450cdc6SMatthias Ringwald } 30081450cdc6SMatthias Ringwald #endif 30091450cdc6SMatthias Ringwald 301026166ecfSMatthias Ringwald #ifdef ENABLE_GATT_OVER_EATT 301126166ecfSMatthias Ringwald 301226166ecfSMatthias Ringwald #define MAX_NR_EATT_CHANNELS 5 30137627a0deSMatthias Ringwald 30147627a0deSMatthias Ringwald static void gatt_client_le_enhanced_packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size); 30157627a0deSMatthias Ringwald 30167627a0deSMatthias Ringwald static void gatt_client_eatt_finalize(gatt_client_t * gatt_client) { 30177627a0deSMatthias Ringwald // free eatt clients 30187627a0deSMatthias Ringwald btstack_linked_list_iterator_t it; 30197627a0deSMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client_connections); 30207627a0deSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)) { 30217627a0deSMatthias Ringwald gatt_client_t *eatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it); 30227627a0deSMatthias Ringwald btstack_linked_list_iterator_remove(&it); 30237627a0deSMatthias Ringwald btstack_memory_gatt_client_free(eatt_client); 30247627a0deSMatthias Ringwald } 30257627a0deSMatthias Ringwald } 30267627a0deSMatthias Ringwald 30277627a0deSMatthias Ringwald // all channels connected 30287627a0deSMatthias Ringwald static void gatt_client_le_enhanced_handle_connected(gatt_client_t * gatt_client, uint8_t status) { 30297627a0deSMatthias Ringwald if (status == ERROR_CODE_SUCCESS){ 30307627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_READY; 30317627a0deSMatthias Ringwald } else { 30327627a0deSMatthias Ringwald gatt_client_eatt_finalize(gatt_client); 30337627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_IDLE; 30347627a0deSMatthias Ringwald } 30357627a0deSMatthias Ringwald 30367627a0deSMatthias Ringwald uint8_t buffer[20]; 30377627a0deSMatthias Ringwald uint16_t len = hci_event_create_from_template_and_arguments(buffer, sizeof(buffer), &gatt_client_connected, status, gatt_client->addr, 30387627a0deSMatthias Ringwald gatt_client->con_handle); 30397627a0deSMatthias Ringwald (*gatt_client->callback)(HCI_EVENT_PACKET, 0, buffer, len); 30407627a0deSMatthias Ringwald } 30417627a0deSMatthias Ringwald 30427627a0deSMatthias Ringwald // single channel disconnected 30437627a0deSMatthias Ringwald static void gatt_client_le_enhanced_handle_ecbm_disconnected(gatt_client_t * gatt_client, gatt_client_t * eatt_client) { 30447627a0deSMatthias Ringwald if (gatt_client->eatt_state == GATT_CLIENT_EATT_READY) { 30457627a0deSMatthias Ringwald 30467627a0deSMatthias Ringwald // report error 30477627a0deSMatthias Ringwald gatt_client_report_error_if_pending(eatt_client, ATT_ERROR_HCI_DISCONNECT_RECEIVED); 30487627a0deSMatthias Ringwald 30497627a0deSMatthias Ringwald // free memory 30507627a0deSMatthias Ringwald btstack_linked_list_remove(&gatt_client->eatt_clients, (btstack_linked_item_t *) eatt_client); 30517627a0deSMatthias Ringwald btstack_memory_gatt_client_free(eatt_client); 30527627a0deSMatthias Ringwald 30537627a0deSMatthias Ringwald // report disconnected if last channel closed 30547627a0deSMatthias Ringwald if (btstack_linked_list_empty(&gatt_client->eatt_clients)){ 30557627a0deSMatthias Ringwald // emit disconnected when last eatt client is gone 30567627a0deSMatthias Ringwald uint8_t buffer[20]; 30577627a0deSMatthias Ringwald uint16_t len = hci_event_create_from_template_and_arguments(buffer, sizeof(buffer), &gatt_client_disconnected, gatt_client->con_handle); 30587627a0deSMatthias Ringwald (*gatt_client->callback)(HCI_EVENT_PACKET, 0, buffer, len); 30597627a0deSMatthias Ringwald } 30607627a0deSMatthias Ringwald } 30617627a0deSMatthias Ringwald } 30627627a0deSMatthias Ringwald 30637627a0deSMatthias Ringwald static gatt_client_t * gatt_client_le_enhanced_get_context_for_l2cap_cid(uint16_t l2cap_cid, gatt_client_t ** out_eatt_client){ 30647627a0deSMatthias Ringwald btstack_linked_list_iterator_t it; 30657627a0deSMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client_connections); 30667627a0deSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)) { 30677627a0deSMatthias Ringwald gatt_client_t * gatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it); 30687627a0deSMatthias Ringwald btstack_linked_list_iterator_t it2; 30697627a0deSMatthias Ringwald btstack_linked_list_iterator_init(&it2, &gatt_client->eatt_clients); 30707627a0deSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it2)) { 30717627a0deSMatthias Ringwald gatt_client_t * eatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it2); 30727627a0deSMatthias Ringwald if (eatt_client->l2cap_cid == l2cap_cid){ 30737627a0deSMatthias Ringwald *out_eatt_client = eatt_client; 30747627a0deSMatthias Ringwald return gatt_client; 30757627a0deSMatthias Ringwald } 30767627a0deSMatthias Ringwald } 30777627a0deSMatthias Ringwald } 30787627a0deSMatthias Ringwald return NULL; 30797627a0deSMatthias Ringwald } 30807627a0deSMatthias Ringwald 30817627a0deSMatthias Ringwald static void gatt_client_le_enhanced_setup_l2cap_channel(gatt_client_t * gatt_client){ 30827627a0deSMatthias Ringwald uint8_t num_channels = gatt_client->eatt_num_clients; 30837627a0deSMatthias Ringwald 30847627a0deSMatthias Ringwald // setup channels 30857627a0deSMatthias Ringwald uint16_t buffer_size_per_client = gatt_client->eatt_storage_size / num_channels; 3086f7a42e72SMatthias Ringwald uint16_t max_mtu = (buffer_size_per_client - REPORT_PREBUFFER_HEADER) / 2; 30877627a0deSMatthias Ringwald uint8_t * receive_buffers[MAX_NR_EATT_CHANNELS]; 30887627a0deSMatthias Ringwald uint16_t new_cids[MAX_NR_EATT_CHANNELS]; 30897627a0deSMatthias Ringwald memset(gatt_client->eatt_storage_buffer, 0, gatt_client->eatt_storage_size); 30907627a0deSMatthias Ringwald uint8_t i; 30917627a0deSMatthias Ringwald for (i=0;i<gatt_client->eatt_num_clients; i++){ 3092f7a42e72SMatthias Ringwald receive_buffers[i] = &gatt_client->eatt_storage_buffer[REPORT_PREBUFFER_HEADER]; 3093f7a42e72SMatthias Ringwald gatt_client->eatt_storage_buffer += REPORT_PREBUFFER_HEADER + max_mtu; 30947627a0deSMatthias Ringwald } 30957627a0deSMatthias Ringwald 30967627a0deSMatthias Ringwald log_info("%u EATT clients with receive buffer size %u", gatt_client->eatt_num_clients, buffer_size_per_client); 30977627a0deSMatthias Ringwald 3098f7a42e72SMatthias Ringwald uint8_t status = l2cap_ecbm_create_channels(&gatt_client_le_enhanced_packet_handler, 3099f7a42e72SMatthias Ringwald gatt_client->con_handle, 31007627a0deSMatthias Ringwald gatt_client->security_level, 3101f7a42e72SMatthias Ringwald BLUETOOTH_PSM_EATT, num_channels, 3102f7a42e72SMatthias Ringwald L2CAP_LE_AUTOMATIC_CREDITS, 31037627a0deSMatthias Ringwald buffer_size_per_client, 3104f7a42e72SMatthias Ringwald receive_buffers, 3105f7a42e72SMatthias Ringwald new_cids); 31067627a0deSMatthias Ringwald 31077627a0deSMatthias Ringwald if (status == ERROR_CODE_SUCCESS){ 31087627a0deSMatthias Ringwald i = 0; 31097627a0deSMatthias Ringwald btstack_linked_list_iterator_t it; 31107627a0deSMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client->eatt_clients); 31117627a0deSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)) { 31127627a0deSMatthias Ringwald gatt_client_t *new_eatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it); 31137627a0deSMatthias Ringwald 31147627a0deSMatthias Ringwald // init state with new cid and transmit buffer 31157627a0deSMatthias Ringwald new_eatt_client->bearer_type = ATT_BEARER_ENHANCED_LE; 31167627a0deSMatthias Ringwald new_eatt_client->con_handle = gatt_client->con_handle; 31177627a0deSMatthias Ringwald new_eatt_client->mtu = 64; 31187627a0deSMatthias Ringwald new_eatt_client->security_level = LEVEL_0; 31197627a0deSMatthias Ringwald new_eatt_client->mtu_state = MTU_AUTO_EXCHANGE_DISABLED; 31207627a0deSMatthias Ringwald new_eatt_client->gatt_client_state = P_W4_L2CAP_CONNECTION; 31217627a0deSMatthias Ringwald new_eatt_client->l2cap_cid = new_cids[i]; 31227627a0deSMatthias Ringwald new_eatt_client->eatt_storage_buffer = gatt_client->eatt_storage_buffer; 3123f7a42e72SMatthias Ringwald gatt_client->eatt_storage_buffer += max_mtu; 31247627a0deSMatthias Ringwald i++; 31257627a0deSMatthias Ringwald } 31267627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_L2CAP_SETUP; 31277627a0deSMatthias Ringwald } else { 31287627a0deSMatthias Ringwald gatt_client_le_enhanced_handle_connected(gatt_client, status); 31297627a0deSMatthias Ringwald } 313026166ecfSMatthias Ringwald } 313126166ecfSMatthias Ringwald 313226166ecfSMatthias Ringwald static void gatt_client_le_enhanced_packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size) { 31337627a0deSMatthias Ringwald gatt_client_t *gatt_client; 31347627a0deSMatthias Ringwald gatt_client_t *eatt_client; 313526166ecfSMatthias Ringwald hci_con_handle_t con_handle; 31367627a0deSMatthias Ringwald uint16_t l2cap_cid; 313726166ecfSMatthias Ringwald uint8_t status; 313826166ecfSMatthias Ringwald gatt_client_characteristic_t characteristic; 31397627a0deSMatthias Ringwald gatt_client_service_t service; 314026166ecfSMatthias Ringwald switch (packet_type) { 314126166ecfSMatthias Ringwald case HCI_EVENT_PACKET: 314226166ecfSMatthias Ringwald switch (hci_event_packet_get_type(packet)) { 31437627a0deSMatthias Ringwald case GATT_EVENT_SERVICE_QUERY_RESULT: 31447627a0deSMatthias Ringwald con_handle = gatt_event_service_query_result_get_handle(packet); 31457627a0deSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(con_handle); 31467627a0deSMatthias Ringwald btstack_assert(gatt_client != NULL); 31477627a0deSMatthias Ringwald btstack_assert(gatt_client->eatt_state == GATT_CLIENT_EATT_DISCOVER_GATT_SERVICE_W4_DONE); 31487627a0deSMatthias Ringwald gatt_event_service_query_result_get_service(packet, &service); 31497627a0deSMatthias Ringwald gatt_client->gatt_service_start_group_handle = service.start_group_handle; 31507627a0deSMatthias Ringwald gatt_client->gatt_service_end_group_handle = service.end_group_handle; 31517627a0deSMatthias Ringwald break; 315226166ecfSMatthias Ringwald case GATT_EVENT_CHARACTERISTIC_VALUE_QUERY_RESULT: 315326166ecfSMatthias Ringwald con_handle = gatt_event_characteristic_value_query_result_get_handle(packet); 315426166ecfSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(con_handle); 315526166ecfSMatthias Ringwald btstack_assert(gatt_client != NULL); 31567627a0deSMatthias Ringwald btstack_assert(gatt_client->eatt_state == GATT_CLIENT_EATT_READ_SERVER_SUPPORTED_FEATURES_W4_DONE); 315726166ecfSMatthias Ringwald if (gatt_event_characteristic_value_query_result_get_value_length(packet) >= 1) { 31587627a0deSMatthias Ringwald gatt_client->gatt_server_supported_features = gatt_event_characteristic_value_query_result_get_value(packet)[0]; 315926166ecfSMatthias Ringwald } 316026166ecfSMatthias Ringwald break; 316126166ecfSMatthias Ringwald case GATT_EVENT_CHARACTERISTIC_QUERY_RESULT: 316226166ecfSMatthias Ringwald con_handle = gatt_event_characteristic_query_result_get_handle(packet); 316326166ecfSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(con_handle); 316426166ecfSMatthias Ringwald btstack_assert(gatt_client != NULL); 31657627a0deSMatthias Ringwald btstack_assert(gatt_client->eatt_state == GATT_CLIENT_EATT_FIND_CLIENT_SUPPORTED_FEATURES_W4_DONE); 31667627a0deSMatthias Ringwald gatt_event_characteristic_query_result_get_characteristic(packet, &characteristic); 316726166ecfSMatthias Ringwald gatt_client->gatt_client_supported_features_handle = characteristic.value_handle; 316826166ecfSMatthias Ringwald break; 316926166ecfSMatthias Ringwald case GATT_EVENT_QUERY_COMPLETE: 317026166ecfSMatthias Ringwald con_handle = gatt_event_query_complete_get_handle(packet); 317126166ecfSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(con_handle); 317226166ecfSMatthias Ringwald btstack_assert(gatt_client != NULL); 31737627a0deSMatthias Ringwald switch (gatt_client->eatt_state){ 31747627a0deSMatthias Ringwald case GATT_CLIENT_EATT_DISCOVER_GATT_SERVICE_W4_DONE: 31757627a0deSMatthias Ringwald if (gatt_client->gatt_service_start_group_handle == 0){ 31767627a0deSMatthias Ringwald gatt_client_le_enhanced_handle_connected(gatt_client, ERROR_CODE_UNSUPPORTED_FEATURE_OR_PARAMETER_VALUE); 31777627a0deSMatthias Ringwald } else { 31787627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_READ_SERVER_SUPPORTED_FEATURES_W2_SEND; 31797627a0deSMatthias Ringwald } 31807627a0deSMatthias Ringwald break; 31817627a0deSMatthias Ringwald case GATT_CLIENT_EATT_READ_SERVER_SUPPORTED_FEATURES_W4_DONE: 31827627a0deSMatthias Ringwald if ((gatt_client->gatt_server_supported_features & 1) == 0) { 31837627a0deSMatthias Ringwald gatt_client_le_enhanced_handle_connected(gatt_client, ERROR_CODE_UNSUPPORTED_FEATURE_OR_PARAMETER_VALUE); 31847627a0deSMatthias Ringwald } else { 31857627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_FIND_CLIENT_SUPPORTED_FEATURES_W2_SEND; 31867627a0deSMatthias Ringwald } 31877627a0deSMatthias Ringwald break; 31887627a0deSMatthias Ringwald case GATT_CLIENT_EATT_FIND_CLIENT_SUPPORTED_FEATURES_W4_DONE: 31897627a0deSMatthias Ringwald if (gatt_client->gatt_client_supported_features_handle == 0){ 31907627a0deSMatthias Ringwald gatt_client_le_enhanced_handle_connected(gatt_client, ERROR_CODE_UNSUPPORTED_FEATURE_OR_PARAMETER_VALUE); 31917627a0deSMatthias Ringwald } else { 31927627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_WRITE_ClIENT_SUPPORTED_FEATURES_W2_SEND; 31937627a0deSMatthias Ringwald } 31947627a0deSMatthias Ringwald break; 31957627a0deSMatthias Ringwald case GATT_CLIENT_EATT_WRITE_ClIENT_SUPPORTED_FEATURES_W4_DONE: 31967627a0deSMatthias Ringwald gatt_client_le_enhanced_setup_l2cap_channel(gatt_client); 319726166ecfSMatthias Ringwald break; 319826166ecfSMatthias Ringwald default: 319926166ecfSMatthias Ringwald break; 320026166ecfSMatthias Ringwald } 320126166ecfSMatthias Ringwald break; 32027627a0deSMatthias Ringwald case L2CAP_EVENT_ECBM_CHANNEL_OPENED: 32037627a0deSMatthias Ringwald l2cap_cid = l2cap_event_ecbm_channel_opened_get_local_cid(packet); 32047627a0deSMatthias Ringwald gatt_client = gatt_client_le_enhanced_get_context_for_l2cap_cid(l2cap_cid, &eatt_client); 32057627a0deSMatthias Ringwald 32067627a0deSMatthias Ringwald btstack_assert(gatt_client != NULL); 32077627a0deSMatthias Ringwald btstack_assert(eatt_client != NULL); 32087627a0deSMatthias Ringwald btstack_assert(eatt_client->gatt_client_state == P_W4_L2CAP_CONNECTION); 32097627a0deSMatthias Ringwald 32107627a0deSMatthias Ringwald status = l2cap_event_channel_opened_get_status(packet); 32117627a0deSMatthias Ringwald if (status == ERROR_CODE_SUCCESS){ 32127627a0deSMatthias Ringwald eatt_client->gatt_client_state = P_READY; 32137627a0deSMatthias Ringwald eatt_client->mtu = l2cap_event_channel_opened_get_remote_mtu(packet); 32147627a0deSMatthias Ringwald } else { 32157627a0deSMatthias Ringwald gatt_client_le_enhanced_handle_ecbm_disconnected(gatt_client, eatt_client); 32167627a0deSMatthias Ringwald } 32177627a0deSMatthias Ringwald // all channels opened? 32187627a0deSMatthias Ringwald gatt_client->eatt_num_clients--; 32197627a0deSMatthias Ringwald if (gatt_client->eatt_num_clients == 0){ 32207627a0deSMatthias Ringwald gatt_client_le_enhanced_handle_connected(gatt_client, ERROR_CODE_SUCCESS); 32217627a0deSMatthias Ringwald } 32227627a0deSMatthias Ringwald break; 32237627a0deSMatthias Ringwald case L2CAP_EVENT_CHANNEL_CLOSED: 32247627a0deSMatthias Ringwald l2cap_cid = l2cap_event_channel_closed_get_local_cid(packet); 32257627a0deSMatthias Ringwald gatt_client = gatt_client_le_enhanced_get_context_for_l2cap_cid(l2cap_cid, &eatt_client); 32267627a0deSMatthias Ringwald btstack_assert(gatt_client != NULL); 32277627a0deSMatthias Ringwald btstack_assert(eatt_client != NULL); 32287627a0deSMatthias Ringwald gatt_client_le_enhanced_handle_ecbm_disconnected(gatt_client, eatt_client); 32297627a0deSMatthias Ringwald break; 32307627a0deSMatthias Ringwald default: 32317627a0deSMatthias Ringwald break; 32327627a0deSMatthias Ringwald } 32337627a0deSMatthias Ringwald break; 32347627a0deSMatthias Ringwald case L2CAP_DATA_PACKET: 32357627a0deSMatthias Ringwald gatt_client = gatt_client_le_enhanced_get_context_for_l2cap_cid(channel, &eatt_client); 32367627a0deSMatthias Ringwald btstack_assert(gatt_client != NULL); 3237ce82ac7fSMatthias Ringwald btstack_assert(eatt_client != NULL); 3238ce82ac7fSMatthias Ringwald gatt_client_handle_att_response(eatt_client, packet, size); 32397627a0deSMatthias Ringwald gatt_client_run(); 32407627a0deSMatthias Ringwald break; 324126166ecfSMatthias Ringwald default: 324226166ecfSMatthias Ringwald break; 324326166ecfSMatthias Ringwald } 324426166ecfSMatthias Ringwald } 324526166ecfSMatthias Ringwald 32467627a0deSMatthias Ringwald static bool gatt_client_le_enhanced_handle_can_send_query(gatt_client_t * gatt_client){ 324726166ecfSMatthias Ringwald uint8_t status = ERROR_CODE_SUCCESS; 324826166ecfSMatthias Ringwald uint8_t gatt_client_supported_features = 0x06; // eatt + multiple value notifications 324926166ecfSMatthias Ringwald switch (gatt_client->eatt_state){ 32507627a0deSMatthias Ringwald case GATT_CLIENT_EATT_DISCOVER_GATT_SERVICE_W2_SEND: 32517627a0deSMatthias Ringwald gatt_client->gatt_service_start_group_handle = 0; 32527627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_DISCOVER_GATT_SERVICE_W4_DONE; 32537627a0deSMatthias Ringwald status = gatt_client_discover_primary_services_by_uuid16(&gatt_client_le_enhanced_packet_handler, 32547627a0deSMatthias Ringwald gatt_client->con_handle, 32557627a0deSMatthias Ringwald ORG_BLUETOOTH_SERVICE_GENERIC_ATTRIBUTE); 32567627a0deSMatthias Ringwald break; 325726166ecfSMatthias Ringwald case GATT_CLIENT_EATT_READ_SERVER_SUPPORTED_FEATURES_W2_SEND: 32587627a0deSMatthias Ringwald gatt_client->gatt_server_supported_features = 0; 32597627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_READ_SERVER_SUPPORTED_FEATURES_W4_DONE; 326026166ecfSMatthias Ringwald status = gatt_client_read_value_of_characteristics_by_uuid16(&gatt_client_le_enhanced_packet_handler, 32617627a0deSMatthias Ringwald gatt_client->con_handle, 32627627a0deSMatthias Ringwald gatt_client->gatt_service_start_group_handle, 32637627a0deSMatthias Ringwald gatt_client->gatt_service_end_group_handle, 326426166ecfSMatthias Ringwald ORG_BLUETOOTH_CHARACTERISTIC_SERVER_SUPPORTED_FEATURES); 326526166ecfSMatthias Ringwald return true; 326626166ecfSMatthias Ringwald case GATT_CLIENT_EATT_FIND_CLIENT_SUPPORTED_FEATURES_W2_SEND: 32677627a0deSMatthias Ringwald gatt_client->gatt_client_supported_features_handle = 0; 32687627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_FIND_CLIENT_SUPPORTED_FEATURES_W4_DONE; 326926166ecfSMatthias Ringwald status = gatt_client_discover_characteristics_for_handle_range_by_uuid16(&gatt_client_le_enhanced_packet_handler, 32707627a0deSMatthias Ringwald gatt_client->con_handle, 32717627a0deSMatthias Ringwald gatt_client->gatt_service_start_group_handle, 32727627a0deSMatthias Ringwald gatt_client->gatt_service_end_group_handle, 32737627a0deSMatthias Ringwald ORG_BLUETOOTH_CHARACTERISTIC_CLIENT_SUPPORTED_FEATURES); 327426166ecfSMatthias Ringwald return true; 327526166ecfSMatthias Ringwald case GATT_CLIENT_EATT_WRITE_ClIENT_SUPPORTED_FEATURES_W2_SEND: 327626166ecfSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_WRITE_ClIENT_SUPPORTED_FEATURES_W4_DONE; 327726166ecfSMatthias Ringwald status = gatt_client_write_value_of_characteristic(&gatt_client_le_enhanced_packet_handler, gatt_client->con_handle, 327826166ecfSMatthias Ringwald gatt_client->gatt_client_supported_features_handle, 1, 327926166ecfSMatthias Ringwald &gatt_client_supported_features); 328026166ecfSMatthias Ringwald return true; 328126166ecfSMatthias Ringwald default: 328226166ecfSMatthias Ringwald break; 328326166ecfSMatthias Ringwald } 32847627a0deSMatthias Ringwald btstack_assert(status == ERROR_CODE_SUCCESS); 32857627a0deSMatthias Ringwald UNUSED(status); 328626166ecfSMatthias Ringwald return false; 328726166ecfSMatthias Ringwald } 328826166ecfSMatthias Ringwald 328926166ecfSMatthias 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) { 329026166ecfSMatthias Ringwald gatt_client_t * gatt_client; 329126166ecfSMatthias Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, &gatt_client); 329226166ecfSMatthias Ringwald if (status != ERROR_CODE_SUCCESS){ 329326166ecfSMatthias Ringwald return status; 329426166ecfSMatthias Ringwald } 329526166ecfSMatthias Ringwald 329626166ecfSMatthias Ringwald if (gatt_client->eatt_state != GATT_CLIENT_EATT_IDLE){ 329726166ecfSMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 329826166ecfSMatthias Ringwald } 329926166ecfSMatthias Ringwald 3300f7a42e72SMatthias Ringwald // need one buffer for sending and one for receiving. Receiving includes pre-buffer for reports 33017627a0deSMatthias Ringwald uint16_t buffer_size_per_client = storage_size / num_channels; 3302f7a42e72SMatthias Ringwald uint16_t max_mtu = (buffer_size_per_client - REPORT_PREBUFFER_HEADER) / 2; 3303f7a42e72SMatthias Ringwald if (max_mtu < 64) { 33047627a0deSMatthias Ringwald return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS; 33057627a0deSMatthias Ringwald } 33067627a0deSMatthias Ringwald 33077627a0deSMatthias Ringwald if ((num_channels == 0) || (num_channels > MAX_NR_EATT_CHANNELS)){ 33087627a0deSMatthias Ringwald return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS; 33097627a0deSMatthias Ringwald } 33107627a0deSMatthias Ringwald 33117627a0deSMatthias Ringwald // create max num_channel eatt clients 33127627a0deSMatthias Ringwald uint8_t i; 33137627a0deSMatthias Ringwald btstack_linked_list_t eatt_clients = NULL; 33147627a0deSMatthias Ringwald for (i=0;i<num_channels;i++) { 33157627a0deSMatthias Ringwald gatt_client_t * new_gatt_client = btstack_memory_gatt_client_get(); 33167627a0deSMatthias Ringwald if (new_gatt_client == NULL) { 33177627a0deSMatthias Ringwald break; 33187627a0deSMatthias Ringwald } 33197627a0deSMatthias Ringwald btstack_linked_list_add(&eatt_clients, (btstack_linked_item_t*)new_gatt_client); 33207627a0deSMatthias Ringwald } 33217627a0deSMatthias Ringwald 33227627a0deSMatthias Ringwald if (i != num_channels){ 33237627a0deSMatthias Ringwald while (true){ 33247627a0deSMatthias Ringwald gatt_client = (gatt_client_t *) btstack_linked_list_pop(&eatt_clients); 33257627a0deSMatthias Ringwald if (gatt_client == NULL) { 33267627a0deSMatthias Ringwald break; 33277627a0deSMatthias Ringwald } 33287627a0deSMatthias Ringwald btstack_memory_gatt_client_free(gatt_client); 33297627a0deSMatthias Ringwald } 33307627a0deSMatthias Ringwald return ERROR_CODE_MEMORY_CAPACITY_EXCEEDED; 33317627a0deSMatthias Ringwald } 33327627a0deSMatthias Ringwald 33337627a0deSMatthias Ringwald gatt_client->callback = callback; 33347627a0deSMatthias Ringwald gatt_client->eatt_num_clients = num_channels; 33357627a0deSMatthias Ringwald gatt_client->eatt_storage_buffer = storage_buffer; 33367627a0deSMatthias Ringwald gatt_client->eatt_storage_size = storage_size; 33377627a0deSMatthias Ringwald gatt_client->eatt_clients = eatt_clients; 33387627a0deSMatthias Ringwald gatt_client->eatt_state = GATT_CLIENT_EATT_DISCOVER_GATT_SERVICE_W2_SEND; 333926166ecfSMatthias Ringwald gatt_client_notify_can_send_query(gatt_client); 334026166ecfSMatthias Ringwald 334126166ecfSMatthias Ringwald return ERROR_CODE_SUCCESS; 334226166ecfSMatthias Ringwald } 334326166ecfSMatthias Ringwald 334426166ecfSMatthias Ringwald #endif 334526166ecfSMatthias Ringwald 3346a6121b51SMilanka Ringwald #ifdef FUZZING_BUILD_MODE_UNSAFE_FOR_PRODUCTION 3347a6121b51SMilanka Ringwald void gatt_client_att_packet_handler_fuzz(uint8_t packet_type, uint16_t handle, uint8_t *packet, uint16_t size){ 3348a6121b51SMilanka Ringwald gatt_client_att_packet_handler(packet_type, handle, packet, size); 3349a6121b51SMilanka Ringwald } 3350ae1ee62dSMilanka Ringwald 335140faeb84SMilanka Ringwald uint8_t gatt_client_get_client(hci_con_handle_t con_handle, gatt_client_t ** out_gatt_client){ 335240faeb84SMilanka Ringwald uint8_t status = gatt_client_provide_context_for_handle(con_handle, out_gatt_client); 335340faeb84SMilanka Ringwald return status; 3354ae1ee62dSMilanka Ringwald } 3355a6121b51SMilanka Ringwald #endif 3356