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 233deb3ec6SMatthias Ringwald * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL MATTHIAS 243deb3ec6SMatthias Ringwald * RINGWALD 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 460e2df43fSMatthias Ringwald #include "att_dispatch.h" 47fac60feaSMatthias Ringwald #include "ad_parser.h" 480e2df43fSMatthias Ringwald #include "ble/att_db.h" 4959c6af15SMatthias Ringwald #include "ble/core.h" 500e2df43fSMatthias Ringwald #include "ble/gatt_client.h" 510e2df43fSMatthias Ringwald #include "ble/le_device_db.h" 520e2df43fSMatthias Ringwald #include "ble/sm.h" 5316ece135SMatthias Ringwald #include "btstack_debug.h" 540e2df43fSMatthias Ringwald #include "btstack_event.h" 553deb3ec6SMatthias Ringwald #include "btstack_memory.h" 560e2df43fSMatthias Ringwald #include "btstack_run_loop.h" 570e2df43fSMatthias Ringwald #include "btstack_util.h" 580e2df43fSMatthias Ringwald #include "classic/sdp_util.h" 593deb3ec6SMatthias Ringwald #include "hci.h" 600e2df43fSMatthias Ringwald #include "hci_cmd.h" 613deb3ec6SMatthias Ringwald #include "hci_dump.h" 623deb3ec6SMatthias Ringwald #include "l2cap.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 813deb3ec6SMatthias Ringwald void gatt_client_init(void){ 823deb3ec6SMatthias Ringwald gatt_client_connections = NULL; 83f4b33574SMatthias Ringwald 8411279da7SMatthias Ringwald // default configuration 8511279da7SMatthias Ringwald gatt_client_mtu_exchange_enabled = true; 8611279da7SMatthias Ringwald gatt_client_required_security_level = LEVEL_0; 8711279da7SMatthias Ringwald 8811279da7SMatthias Ringwald // register for HCI Events 89f4b33574SMatthias Ringwald hci_event_callback_registration.callback = &gatt_client_event_packet_handler; 90361b1363SMatthias Ringwald hci_add_event_handler(&hci_event_callback_registration); 91361b1363SMatthias Ringwald 92f4b33574SMatthias Ringwald // register for SM Events 93f4b33574SMatthias Ringwald sm_event_callback_registration.callback = &gatt_client_event_packet_handler; 94f4b33574SMatthias Ringwald sm_add_event_handler(&sm_event_callback_registration); 95f4b33574SMatthias Ringwald 96361b1363SMatthias Ringwald // and ATT Client PDUs 973deb3ec6SMatthias Ringwald att_dispatch_register_client(gatt_client_att_packet_handler); 983deb3ec6SMatthias Ringwald } 993deb3ec6SMatthias Ringwald 10011279da7SMatthias Ringwald void gatt_client_set_required_security_level(gap_security_level_t level){ 10111279da7SMatthias Ringwald gatt_client_required_security_level = level; 10211279da7SMatthias Ringwald } 10311279da7SMatthias Ringwald 104ec820d77SMatthias Ringwald static gatt_client_t * gatt_client_for_timer(btstack_timer_source_t * ts){ 105665d90f2SMatthias Ringwald btstack_linked_list_iterator_t it; 106665d90f2SMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client_connections); 107665d90f2SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 1085cf1669fSMatthias Ringwald gatt_client_t * gatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it); 1095cf1669fSMatthias Ringwald if (&gatt_client->gc_timeout == ts) { 1105cf1669fSMatthias Ringwald return gatt_client; 1113deb3ec6SMatthias Ringwald } 1123deb3ec6SMatthias Ringwald } 1133deb3ec6SMatthias Ringwald return NULL; 1143deb3ec6SMatthias Ringwald } 1153deb3ec6SMatthias Ringwald 116ec820d77SMatthias Ringwald static void gatt_client_timeout_handler(btstack_timer_source_t * timer){ 1175cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_for_timer(timer); 1185cf1669fSMatthias Ringwald if (gatt_client == NULL) return; 1195cf1669fSMatthias Ringwald log_info("GATT client timeout handle, handle 0x%02x", gatt_client->con_handle); 1205cf1669fSMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, ATT_ERROR_TIMEOUT); 1213deb3ec6SMatthias Ringwald } 1223deb3ec6SMatthias Ringwald 1235cf1669fSMatthias Ringwald static void gatt_client_timeout_start(gatt_client_t * gatt_client){ 1245cf1669fSMatthias Ringwald log_info("GATT client timeout start, handle 0x%02x", gatt_client->con_handle); 1255cf1669fSMatthias Ringwald btstack_run_loop_remove_timer(&gatt_client->gc_timeout); 1265cf1669fSMatthias Ringwald btstack_run_loop_set_timer_handler(&gatt_client->gc_timeout, gatt_client_timeout_handler); 1275cf1669fSMatthias Ringwald btstack_run_loop_set_timer(&gatt_client->gc_timeout, 30000); // 30 seconds sm timeout 1285cf1669fSMatthias Ringwald btstack_run_loop_add_timer(&gatt_client->gc_timeout); 1293deb3ec6SMatthias Ringwald } 1303deb3ec6SMatthias Ringwald 1315cf1669fSMatthias Ringwald static void gatt_client_timeout_stop(gatt_client_t * gatt_client){ 1325cf1669fSMatthias Ringwald log_info("GATT client timeout stop, handle 0x%02x", gatt_client->con_handle); 1335cf1669fSMatthias Ringwald btstack_run_loop_remove_timer(&gatt_client->gc_timeout); 1343deb3ec6SMatthias Ringwald } 1353deb3ec6SMatthias Ringwald 1361dfae9c7SMatthias Ringwald static gap_security_level_t gatt_client_le_security_level_for_connection(hci_con_handle_t con_handle){ 1371dfae9c7SMatthias Ringwald uint8_t encryption_key_size = gap_encryption_key_size(con_handle); 1381dfae9c7SMatthias Ringwald if (encryption_key_size == 0) return LEVEL_0; 1391dfae9c7SMatthias Ringwald 1401dfae9c7SMatthias Ringwald uint8_t authenticated = gap_authenticated(con_handle); 1411dfae9c7SMatthias Ringwald if (!authenticated) return LEVEL_2; 1421dfae9c7SMatthias Ringwald 1431dfae9c7SMatthias Ringwald return encryption_key_size == 16 ? LEVEL_4 : LEVEL_3; 1441dfae9c7SMatthias Ringwald } 1451dfae9c7SMatthias Ringwald 1465cf1669fSMatthias Ringwald static gatt_client_t * gatt_client_get_context_for_handle(uint16_t handle){ 147665d90f2SMatthias Ringwald btstack_linked_item_t *it; 148a0da043fSMatthias Ringwald for (it = (btstack_linked_item_t *) gatt_client_connections; it != NULL; it = it->next){ 1495cf1669fSMatthias Ringwald gatt_client_t * gatt_client = (gatt_client_t *) it; 1505cf1669fSMatthias Ringwald if (gatt_client->con_handle == handle){ 1515cf1669fSMatthias Ringwald return gatt_client; 1523deb3ec6SMatthias Ringwald } 1533deb3ec6SMatthias Ringwald } 1543deb3ec6SMatthias Ringwald return NULL; 1553deb3ec6SMatthias Ringwald } 1563deb3ec6SMatthias Ringwald 1573deb3ec6SMatthias Ringwald 1585cf1669fSMatthias Ringwald // @returns gatt_client context 1593deb3ec6SMatthias Ringwald // returns existing one, or tries to setup new one 1605cf1669fSMatthias Ringwald static gatt_client_t * gatt_client_provide_context_for_handle(hci_con_handle_t con_handle){ 1615cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_get_context_for_handle(con_handle); 1625cf1669fSMatthias Ringwald if (gatt_client) return gatt_client; 1633deb3ec6SMatthias Ringwald 164ae1d1237SMatthias Ringwald // bail if no such hci connection 165ae1d1237SMatthias Ringwald if (!hci_connection_for_handle(con_handle)){ 166ae1d1237SMatthias Ringwald log_error("No connection for handle 0x%04x", con_handle); 167ae1d1237SMatthias Ringwald return NULL; 168ae1d1237SMatthias Ringwald } 1695cf1669fSMatthias Ringwald gatt_client = btstack_memory_gatt_client_get(); 1705cf1669fSMatthias Ringwald if (!gatt_client) return NULL; 1713deb3ec6SMatthias Ringwald // init state 1725cf1669fSMatthias Ringwald gatt_client->con_handle = con_handle; 1735cf1669fSMatthias Ringwald gatt_client->mtu = ATT_DEFAULT_MTU; 1741dfae9c7SMatthias Ringwald gatt_client->security_level = gatt_client_le_security_level_for_connection(con_handle); 17511279da7SMatthias Ringwald if (gatt_client_mtu_exchange_enabled){ 1765cf1669fSMatthias Ringwald gatt_client->mtu_state = SEND_MTU_EXCHANGE; 1775cf6c434SJakob Krantz } else { 1785cf1669fSMatthias Ringwald gatt_client->mtu_state = MTU_AUTO_EXCHANGE_DISABLED; 1795cf6c434SJakob Krantz } 1805cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_READY; 1815cf1669fSMatthias Ringwald btstack_linked_list_add(&gatt_client_connections, (btstack_linked_item_t*)gatt_client); 1825cf1669fSMatthias Ringwald return gatt_client; 1833deb3ec6SMatthias Ringwald } 1843deb3ec6SMatthias Ringwald 1855cf1669fSMatthias Ringwald static gatt_client_t * gatt_client_provide_context_for_handle_and_start_timer(hci_con_handle_t con_handle){ 1865cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle(con_handle); 1875cf1669fSMatthias Ringwald if (gatt_client == NULL) return NULL; 1885cf1669fSMatthias Ringwald gatt_client_timeout_start(gatt_client); 1895cf1669fSMatthias Ringwald return gatt_client; 1903deb3ec6SMatthias Ringwald } 1913deb3ec6SMatthias Ringwald 1925cf1669fSMatthias Ringwald static int is_ready(gatt_client_t * gatt_client){ 1935cf1669fSMatthias Ringwald return gatt_client->gatt_client_state == P_READY; 1943deb3ec6SMatthias Ringwald } 1953deb3ec6SMatthias Ringwald 196fc64f94aSMatthias Ringwald int gatt_client_is_ready(hci_con_handle_t con_handle){ 1975cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle(con_handle); 1985cf1669fSMatthias Ringwald if (gatt_client == NULL) return 0; 1995cf1669fSMatthias Ringwald return is_ready(gatt_client); 2003deb3ec6SMatthias Ringwald } 2013deb3ec6SMatthias Ringwald 2025cf6c434SJakob Krantz void gatt_client_mtu_enable_auto_negotiation(uint8_t enabled){ 20311279da7SMatthias Ringwald gatt_client_mtu_exchange_enabled = enabled != 0; 2045cf6c434SJakob Krantz } 2055cf6c434SJakob Krantz 206fc64f94aSMatthias Ringwald uint8_t gatt_client_get_mtu(hci_con_handle_t con_handle, uint16_t * mtu){ 2075cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle(con_handle); 2085cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 2097d2258b3SMilanka Ringwald 2105cf1669fSMatthias Ringwald if ((gatt_client->mtu_state == MTU_EXCHANGED) || (gatt_client->mtu_state == MTU_AUTO_EXCHANGE_DISABLED)){ 2115cf1669fSMatthias Ringwald *mtu = gatt_client->mtu; 2127d2258b3SMilanka Ringwald return ERROR_CODE_SUCCESS; 2133deb3ec6SMatthias Ringwald } 2143deb3ec6SMatthias Ringwald *mtu = ATT_DEFAULT_MTU; 215616edd56SMatthias Ringwald return GATT_CLIENT_IN_WRONG_STATE; 2163deb3ec6SMatthias Ringwald } 2173deb3ec6SMatthias Ringwald 2183deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 2195cf1669fSMatthias Ringwald static uint8_t att_confirmation(uint16_t con_handle){ 2203deb3ec6SMatthias Ringwald l2cap_reserve_packet_buffer(); 2213deb3ec6SMatthias Ringwald uint8_t * request = l2cap_get_outgoing_buffer(); 2223deb3ec6SMatthias Ringwald request[0] = ATT_HANDLE_VALUE_CONFIRMATION; 22325b7c058SMilanka Ringwald 2245cf1669fSMatthias Ringwald return l2cap_send_prepared_connectionless(con_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL, 1); 2253deb3ec6SMatthias Ringwald } 2263deb3ec6SMatthias Ringwald 2273deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 2285cf1669fSMatthias Ringwald static uint8_t att_find_information_request(uint16_t request_type, uint16_t con_handle, uint16_t start_handle, uint16_t end_handle){ 2293deb3ec6SMatthias Ringwald l2cap_reserve_packet_buffer(); 2303deb3ec6SMatthias Ringwald uint8_t * request = l2cap_get_outgoing_buffer(); 2313deb3ec6SMatthias Ringwald request[0] = request_type; 232f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, start_handle); 233f8fbdce0SMatthias Ringwald little_endian_store_16(request, 3, end_handle); 2343deb3ec6SMatthias Ringwald 2355cf1669fSMatthias Ringwald return l2cap_send_prepared_connectionless(con_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL, 5); 2363deb3ec6SMatthias Ringwald } 2373deb3ec6SMatthias Ringwald 2383deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 2395cf1669fSMatthias Ringwald static uint8_t att_find_by_type_value_request(uint16_t request_type, uint16_t attribute_group_type, uint16_t con_handle, uint16_t start_handle, uint16_t end_handle, uint8_t * value, uint16_t value_size){ 2403deb3ec6SMatthias Ringwald l2cap_reserve_packet_buffer(); 2413deb3ec6SMatthias Ringwald uint8_t * request = l2cap_get_outgoing_buffer(); 2423deb3ec6SMatthias Ringwald 2433deb3ec6SMatthias Ringwald request[0] = request_type; 244f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, start_handle); 245f8fbdce0SMatthias Ringwald little_endian_store_16(request, 3, end_handle); 246f8fbdce0SMatthias Ringwald little_endian_store_16(request, 5, attribute_group_type); 2476535961aSMatthias Ringwald (void)memcpy(&request[7], value, value_size); 2483deb3ec6SMatthias Ringwald 2495cf1669fSMatthias Ringwald return l2cap_send_prepared_connectionless(con_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL, 7u + value_size); 2503deb3ec6SMatthias Ringwald } 2513deb3ec6SMatthias Ringwald 2523deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 2535cf1669fSMatthias Ringwald static uint8_t att_read_by_type_or_group_request_for_uuid16(uint16_t request_type, uint16_t uuid16, uint16_t con_handle, uint16_t start_handle, uint16_t end_handle){ 2543deb3ec6SMatthias Ringwald l2cap_reserve_packet_buffer(); 2553deb3ec6SMatthias Ringwald uint8_t * request = l2cap_get_outgoing_buffer(); 2563deb3ec6SMatthias Ringwald request[0] = request_type; 257f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, start_handle); 258f8fbdce0SMatthias Ringwald little_endian_store_16(request, 3, end_handle); 259f8fbdce0SMatthias Ringwald little_endian_store_16(request, 5, uuid16); 2603deb3ec6SMatthias Ringwald 2615cf1669fSMatthias Ringwald return l2cap_send_prepared_connectionless(con_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL, 7); 2623deb3ec6SMatthias Ringwald } 2633deb3ec6SMatthias Ringwald 2643deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 2655cf1669fSMatthias Ringwald static uint8_t att_read_by_type_or_group_request_for_uuid128(uint16_t request_type, uint8_t * uuid128, uint16_t con_handle, uint16_t start_handle, uint16_t end_handle){ 2663deb3ec6SMatthias Ringwald l2cap_reserve_packet_buffer(); 2673deb3ec6SMatthias Ringwald uint8_t * request = l2cap_get_outgoing_buffer(); 2683deb3ec6SMatthias Ringwald request[0] = request_type; 269f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, start_handle); 270f8fbdce0SMatthias Ringwald little_endian_store_16(request, 3, end_handle); 2719c80e4ccSMatthias Ringwald reverse_128(uuid128, &request[5]); 2723deb3ec6SMatthias Ringwald 2735cf1669fSMatthias Ringwald return l2cap_send_prepared_connectionless(con_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL, 21); 2743deb3ec6SMatthias Ringwald } 2753deb3ec6SMatthias Ringwald 2763deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 2775cf1669fSMatthias Ringwald static uint8_t att_read_request(uint16_t request_type, uint16_t con_handle, uint16_t attribute_handle){ 2783deb3ec6SMatthias Ringwald l2cap_reserve_packet_buffer(); 2793deb3ec6SMatthias Ringwald uint8_t * request = l2cap_get_outgoing_buffer(); 2803deb3ec6SMatthias Ringwald request[0] = request_type; 281f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, attribute_handle); 2823deb3ec6SMatthias Ringwald 2835cf1669fSMatthias Ringwald return l2cap_send_prepared_connectionless(con_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL, 3); 2843deb3ec6SMatthias Ringwald } 2853deb3ec6SMatthias Ringwald 2863deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 2875cf1669fSMatthias Ringwald static uint8_t att_read_blob_request(uint16_t request_type, uint16_t con_handle, uint16_t attribute_handle, uint16_t value_offset){ 2883deb3ec6SMatthias Ringwald l2cap_reserve_packet_buffer(); 2893deb3ec6SMatthias Ringwald uint8_t * request = l2cap_get_outgoing_buffer(); 2903deb3ec6SMatthias Ringwald request[0] = request_type; 291f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, attribute_handle); 292f8fbdce0SMatthias Ringwald little_endian_store_16(request, 3, value_offset); 2933deb3ec6SMatthias Ringwald 2945cf1669fSMatthias Ringwald return l2cap_send_prepared_connectionless(con_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL, 5); 2953deb3ec6SMatthias Ringwald } 2963deb3ec6SMatthias Ringwald 2975cf1669fSMatthias Ringwald static uint8_t att_read_multiple_request(uint16_t con_handle, uint16_t num_value_handles, uint16_t * value_handles){ 2983deb3ec6SMatthias Ringwald l2cap_reserve_packet_buffer(); 2993deb3ec6SMatthias Ringwald uint8_t * request = l2cap_get_outgoing_buffer(); 3003deb3ec6SMatthias Ringwald request[0] = ATT_READ_MULTIPLE_REQUEST; 3013deb3ec6SMatthias Ringwald int i; 3023deb3ec6SMatthias Ringwald int offset = 1; 3033deb3ec6SMatthias Ringwald for (i=0;i<num_value_handles;i++){ 304f8fbdce0SMatthias Ringwald little_endian_store_16(request, offset, value_handles[i]); 3053deb3ec6SMatthias Ringwald offset += 2; 3063deb3ec6SMatthias Ringwald } 30725b7c058SMilanka Ringwald 3085cf1669fSMatthias Ringwald return l2cap_send_prepared_connectionless(con_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL, offset); 3093deb3ec6SMatthias Ringwald } 3103deb3ec6SMatthias Ringwald 3117a766ebfSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 3123deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 3135cf1669fSMatthias Ringwald static uint8_t att_signed_write_request(uint16_t request_type, uint16_t con_handle, uint16_t attribute_handle, uint16_t value_length, uint8_t * value, uint32_t sign_counter, uint8_t sgn[8]){ 3143deb3ec6SMatthias Ringwald l2cap_reserve_packet_buffer(); 3153deb3ec6SMatthias Ringwald uint8_t * request = l2cap_get_outgoing_buffer(); 3163deb3ec6SMatthias Ringwald request[0] = request_type; 317f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, attribute_handle); 3186535961aSMatthias Ringwald (void)memcpy(&request[3], value, value_length); 319f8fbdce0SMatthias Ringwald little_endian_store_32(request, 3 + value_length, sign_counter); 3209c80e4ccSMatthias Ringwald reverse_64(sgn, &request[3 + value_length + 4]); 32125b7c058SMilanka Ringwald 3225cf1669fSMatthias Ringwald return l2cap_send_prepared_connectionless(con_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL, 3 + value_length + 12); 3233deb3ec6SMatthias Ringwald } 3247a766ebfSMatthias Ringwald #endif 3253deb3ec6SMatthias Ringwald 3263deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 3275cf1669fSMatthias Ringwald static uint8_t att_write_request(uint16_t request_type, uint16_t con_handle, uint16_t attribute_handle, uint16_t value_length, uint8_t * value){ 3283deb3ec6SMatthias Ringwald l2cap_reserve_packet_buffer(); 3293deb3ec6SMatthias Ringwald uint8_t * request = l2cap_get_outgoing_buffer(); 3303deb3ec6SMatthias Ringwald request[0] = request_type; 331f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, attribute_handle); 3326535961aSMatthias Ringwald (void)memcpy(&request[3], value, value_length); 3333deb3ec6SMatthias Ringwald 3345cf1669fSMatthias Ringwald return l2cap_send_prepared_connectionless(con_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL, 3u + value_length); 3353deb3ec6SMatthias Ringwald } 3363deb3ec6SMatthias Ringwald 3373deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 3385cf1669fSMatthias Ringwald static uint8_t att_execute_write_request(uint16_t request_type, uint16_t con_handle, uint8_t execute_write){ 3393deb3ec6SMatthias Ringwald l2cap_reserve_packet_buffer(); 3403deb3ec6SMatthias Ringwald uint8_t * request = l2cap_get_outgoing_buffer(); 3413deb3ec6SMatthias Ringwald request[0] = request_type; 3423deb3ec6SMatthias Ringwald request[1] = execute_write; 34325b7c058SMilanka Ringwald 3445cf1669fSMatthias Ringwald return l2cap_send_prepared_connectionless(con_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL, 2); 3453deb3ec6SMatthias Ringwald } 3463deb3ec6SMatthias Ringwald 3473deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 3485cf1669fSMatthias Ringwald static uint8_t att_prepare_write_request(uint16_t request_type, uint16_t con_handle, uint16_t attribute_handle, uint16_t value_offset, uint16_t blob_length, uint8_t * value){ 3493deb3ec6SMatthias Ringwald l2cap_reserve_packet_buffer(); 3503deb3ec6SMatthias Ringwald uint8_t * request = l2cap_get_outgoing_buffer(); 3513deb3ec6SMatthias Ringwald request[0] = request_type; 352f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, attribute_handle); 353f8fbdce0SMatthias Ringwald little_endian_store_16(request, 3, value_offset); 3546535961aSMatthias Ringwald (void)memcpy(&request[5], &value[value_offset], blob_length); 3553deb3ec6SMatthias Ringwald 3565cf1669fSMatthias Ringwald return l2cap_send_prepared_connectionless(con_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL, 5u + blob_length); 3573deb3ec6SMatthias Ringwald } 3583deb3ec6SMatthias Ringwald 3595cf1669fSMatthias Ringwald static uint8_t att_exchange_mtu_request(uint16_t con_handle){ 3603deb3ec6SMatthias Ringwald uint16_t mtu = l2cap_max_le_mtu(); 3613deb3ec6SMatthias Ringwald l2cap_reserve_packet_buffer(); 3623deb3ec6SMatthias Ringwald uint8_t * request = l2cap_get_outgoing_buffer(); 3633deb3ec6SMatthias Ringwald request[0] = ATT_EXCHANGE_MTU_REQUEST; 364f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, mtu); 36525b7c058SMilanka Ringwald 3665cf1669fSMatthias Ringwald return l2cap_send_prepared_connectionless(con_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL, 3); 3673deb3ec6SMatthias Ringwald } 3683deb3ec6SMatthias Ringwald 3695cf1669fSMatthias Ringwald static uint16_t write_blob_length(gatt_client_t * gatt_client){ 370dda77937SMatthias Ringwald uint16_t max_blob_length = gatt_client->mtu - 5u; 3715cf1669fSMatthias Ringwald if (gatt_client->attribute_offset >= gatt_client->attribute_length) { 3723deb3ec6SMatthias Ringwald return 0; 3733deb3ec6SMatthias Ringwald } 3745cf1669fSMatthias Ringwald uint16_t rest_length = gatt_client->attribute_length - gatt_client->attribute_offset; 3753deb3ec6SMatthias Ringwald if (max_blob_length > rest_length){ 3763deb3ec6SMatthias Ringwald return rest_length; 3773deb3ec6SMatthias Ringwald } 3783deb3ec6SMatthias Ringwald return max_blob_length; 3793deb3ec6SMatthias Ringwald } 3803deb3ec6SMatthias Ringwald 3815cf1669fSMatthias Ringwald static void send_gatt_services_request(gatt_client_t *gatt_client){ 3825cf1669fSMatthias Ringwald att_read_by_type_or_group_request_for_uuid16(ATT_READ_BY_GROUP_TYPE_REQUEST, GATT_PRIMARY_SERVICE_UUID, gatt_client->con_handle, gatt_client->start_group_handle, gatt_client->end_group_handle); 3833deb3ec6SMatthias Ringwald } 3843deb3ec6SMatthias Ringwald 3855cf1669fSMatthias Ringwald static void send_gatt_by_uuid_request(gatt_client_t *gatt_client, uint16_t attribute_group_type){ 3865cf1669fSMatthias Ringwald if (gatt_client->uuid16){ 3873deb3ec6SMatthias Ringwald uint8_t uuid16[2]; 3885cf1669fSMatthias Ringwald little_endian_store_16(uuid16, 0, gatt_client->uuid16); 3895cf1669fSMatthias Ringwald att_find_by_type_value_request(ATT_FIND_BY_TYPE_VALUE_REQUEST, attribute_group_type, gatt_client->con_handle, gatt_client->start_group_handle, gatt_client->end_group_handle, uuid16, 2); 3903deb3ec6SMatthias Ringwald return; 3913deb3ec6SMatthias Ringwald } 3923deb3ec6SMatthias Ringwald uint8_t uuid128[16]; 3935cf1669fSMatthias Ringwald reverse_128(gatt_client->uuid128, uuid128); 3945cf1669fSMatthias Ringwald att_find_by_type_value_request(ATT_FIND_BY_TYPE_VALUE_REQUEST, attribute_group_type, gatt_client->con_handle, gatt_client->start_group_handle, gatt_client->end_group_handle, uuid128, 16); 3953deb3ec6SMatthias Ringwald } 3963deb3ec6SMatthias Ringwald 3975cf1669fSMatthias Ringwald static void send_gatt_services_by_uuid_request(gatt_client_t *gatt_client){ 3985cf1669fSMatthias Ringwald send_gatt_by_uuid_request(gatt_client, GATT_PRIMARY_SERVICE_UUID); 3993deb3ec6SMatthias Ringwald } 4003deb3ec6SMatthias Ringwald 4015cf1669fSMatthias Ringwald static void send_gatt_included_service_uuid_request(gatt_client_t *gatt_client){ 4025cf1669fSMatthias Ringwald att_read_request(ATT_READ_REQUEST, gatt_client->con_handle, gatt_client->query_start_handle); 4033deb3ec6SMatthias Ringwald } 4043deb3ec6SMatthias Ringwald 4055cf1669fSMatthias Ringwald static void send_gatt_included_service_request(gatt_client_t *gatt_client){ 4065cf1669fSMatthias Ringwald att_read_by_type_or_group_request_for_uuid16(ATT_READ_BY_TYPE_REQUEST, GATT_INCLUDE_SERVICE_UUID, gatt_client->con_handle, gatt_client->start_group_handle, gatt_client->end_group_handle); 4073deb3ec6SMatthias Ringwald } 4083deb3ec6SMatthias Ringwald 4095cf1669fSMatthias Ringwald static void send_gatt_characteristic_request(gatt_client_t *gatt_client){ 4105cf1669fSMatthias Ringwald att_read_by_type_or_group_request_for_uuid16(ATT_READ_BY_TYPE_REQUEST, GATT_CHARACTERISTICS_UUID, gatt_client->con_handle, gatt_client->start_group_handle, gatt_client->end_group_handle); 4113deb3ec6SMatthias Ringwald } 4123deb3ec6SMatthias Ringwald 4135cf1669fSMatthias Ringwald static void send_gatt_characteristic_descriptor_request(gatt_client_t *gatt_client){ 4145cf1669fSMatthias Ringwald att_find_information_request(ATT_FIND_INFORMATION_REQUEST, gatt_client->con_handle, gatt_client->start_group_handle, gatt_client->end_group_handle); 4153deb3ec6SMatthias Ringwald } 4163deb3ec6SMatthias Ringwald 4175cf1669fSMatthias Ringwald static void send_gatt_read_characteristic_value_request(gatt_client_t *gatt_client){ 4185cf1669fSMatthias Ringwald att_read_request(ATT_READ_REQUEST, gatt_client->con_handle, gatt_client->attribute_handle); 4193deb3ec6SMatthias Ringwald } 4203deb3ec6SMatthias Ringwald 4215cf1669fSMatthias Ringwald static void send_gatt_read_by_type_request(gatt_client_t * gatt_client){ 4225cf1669fSMatthias Ringwald if (gatt_client->uuid16){ 4235cf1669fSMatthias Ringwald att_read_by_type_or_group_request_for_uuid16(ATT_READ_BY_TYPE_REQUEST, gatt_client->uuid16, gatt_client->con_handle, gatt_client->start_group_handle, gatt_client->end_group_handle); 4243deb3ec6SMatthias Ringwald } else { 4255cf1669fSMatthias Ringwald att_read_by_type_or_group_request_for_uuid128(ATT_READ_BY_TYPE_REQUEST, gatt_client->uuid128, gatt_client->con_handle, gatt_client->start_group_handle, gatt_client->end_group_handle); 4263deb3ec6SMatthias Ringwald } 4273deb3ec6SMatthias Ringwald } 4283deb3ec6SMatthias Ringwald 4295cf1669fSMatthias Ringwald static void send_gatt_read_blob_request(gatt_client_t *gatt_client){ 4305cf1669fSMatthias Ringwald att_read_blob_request(ATT_READ_BLOB_REQUEST, gatt_client->con_handle, gatt_client->attribute_handle, gatt_client->attribute_offset); 4313deb3ec6SMatthias Ringwald } 4323deb3ec6SMatthias Ringwald 4335cf1669fSMatthias Ringwald static void send_gatt_read_multiple_request(gatt_client_t * gatt_client){ 4345cf1669fSMatthias Ringwald att_read_multiple_request(gatt_client->con_handle, gatt_client->read_multiple_handle_count, gatt_client->read_multiple_handles); 4353deb3ec6SMatthias Ringwald } 4363deb3ec6SMatthias Ringwald 4375cf1669fSMatthias Ringwald static void send_gatt_write_attribute_value_request(gatt_client_t * gatt_client){ 4385cf1669fSMatthias Ringwald att_write_request(ATT_WRITE_REQUEST, gatt_client->con_handle, gatt_client->attribute_handle, gatt_client->attribute_length, gatt_client->attribute_value); 4393deb3ec6SMatthias Ringwald } 4403deb3ec6SMatthias Ringwald 4415cf1669fSMatthias Ringwald static void send_gatt_write_client_characteristic_configuration_request(gatt_client_t * gatt_client){ 4425cf1669fSMatthias Ringwald att_write_request(ATT_WRITE_REQUEST, gatt_client->con_handle, gatt_client->client_characteristic_configuration_handle, 2, gatt_client->client_characteristic_configuration_value); 4433deb3ec6SMatthias Ringwald } 4443deb3ec6SMatthias Ringwald 4455cf1669fSMatthias Ringwald static void send_gatt_prepare_write_request(gatt_client_t * gatt_client){ 4465cf1669fSMatthias Ringwald att_prepare_write_request(ATT_PREPARE_WRITE_REQUEST, gatt_client->con_handle, gatt_client->attribute_handle, gatt_client->attribute_offset, write_blob_length(gatt_client), gatt_client->attribute_value); 4473deb3ec6SMatthias Ringwald } 4483deb3ec6SMatthias Ringwald 4495cf1669fSMatthias Ringwald static void send_gatt_execute_write_request(gatt_client_t * gatt_client){ 4505cf1669fSMatthias Ringwald att_execute_write_request(ATT_EXECUTE_WRITE_REQUEST, gatt_client->con_handle, 1); 4513deb3ec6SMatthias Ringwald } 4523deb3ec6SMatthias Ringwald 4535cf1669fSMatthias Ringwald static void send_gatt_cancel_prepared_write_request(gatt_client_t * gatt_client){ 4545cf1669fSMatthias Ringwald att_execute_write_request(ATT_EXECUTE_WRITE_REQUEST, gatt_client->con_handle, 0); 4553deb3ec6SMatthias Ringwald } 4563deb3ec6SMatthias Ringwald 457abdc9fb5SMatthias Ringwald #ifndef ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY 4585cf1669fSMatthias Ringwald static void send_gatt_read_client_characteristic_configuration_request(gatt_client_t * gatt_client){ 4595cf1669fSMatthias Ringwald att_read_by_type_or_group_request_for_uuid16(ATT_READ_BY_TYPE_REQUEST, GATT_CLIENT_CHARACTERISTICS_CONFIGURATION, gatt_client->con_handle, gatt_client->start_group_handle, gatt_client->end_group_handle); 4603deb3ec6SMatthias Ringwald } 461abdc9fb5SMatthias Ringwald #endif 4623deb3ec6SMatthias Ringwald 4635cf1669fSMatthias Ringwald static void send_gatt_read_characteristic_descriptor_request(gatt_client_t * gatt_client){ 4645cf1669fSMatthias Ringwald att_read_request(ATT_READ_REQUEST, gatt_client->con_handle, gatt_client->attribute_handle); 4653deb3ec6SMatthias Ringwald } 4663deb3ec6SMatthias Ringwald 4677a766ebfSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 4685cf1669fSMatthias Ringwald static void send_gatt_signed_write_request(gatt_client_t * gatt_client, uint32_t sign_counter){ 4695cf1669fSMatthias Ringwald att_signed_write_request(ATT_SIGNED_WRITE_COMMAND, gatt_client->con_handle, gatt_client->attribute_handle, gatt_client->attribute_length, gatt_client->attribute_value, sign_counter, gatt_client->cmac); 4703deb3ec6SMatthias Ringwald } 4717a766ebfSMatthias Ringwald #endif 4723deb3ec6SMatthias Ringwald 4733deb3ec6SMatthias Ringwald static uint16_t get_last_result_handle_from_service_list(uint8_t * packet, uint16_t size){ 4743deb3ec6SMatthias Ringwald uint8_t attr_length = packet[1]; 4754ea43905SMatthias Ringwald return little_endian_read_16(packet, size - attr_length + 2u); 4763deb3ec6SMatthias Ringwald } 4773deb3ec6SMatthias Ringwald 4783deb3ec6SMatthias Ringwald static uint16_t get_last_result_handle_from_characteristics_list(uint8_t * packet, uint16_t size){ 4793deb3ec6SMatthias Ringwald uint8_t attr_length = packet[1]; 4804ea43905SMatthias Ringwald return little_endian_read_16(packet, size - attr_length + 3u); 4813deb3ec6SMatthias Ringwald } 4823deb3ec6SMatthias Ringwald 4833deb3ec6SMatthias Ringwald static uint16_t get_last_result_handle_from_included_services_list(uint8_t * packet, uint16_t size){ 4843deb3ec6SMatthias Ringwald uint8_t attr_length = packet[1]; 485f8fbdce0SMatthias Ringwald return little_endian_read_16(packet, size - attr_length); 4863deb3ec6SMatthias Ringwald } 4873deb3ec6SMatthias Ringwald 4885cf1669fSMatthias Ringwald static void gatt_client_handle_transaction_complete(gatt_client_t * gatt_client){ 4895cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_READY; 4905cf1669fSMatthias Ringwald gatt_client_timeout_stop(gatt_client); 4913deb3ec6SMatthias Ringwald } 4923deb3ec6SMatthias Ringwald 4939c662c9bSMatthias Ringwald static void emit_event_new(btstack_packet_handler_t callback, uint8_t * packet, uint16_t size){ 4949c662c9bSMatthias Ringwald if (!callback) return; 495b6e003bcSMatthias Ringwald hci_dump_packet(HCI_EVENT_PACKET, 0, packet, size); 4969c662c9bSMatthias Ringwald (*callback)(HCI_EVENT_PACKET, 0, packet, size); 4973deb3ec6SMatthias Ringwald } 4983deb3ec6SMatthias Ringwald 49986c38559SMatthias Ringwald void gatt_client_listen_for_characteristic_value_updates(gatt_client_notification_t * notification, btstack_packet_handler_t packet_handler, hci_con_handle_t con_handle, gatt_client_characteristic_t * characteristic){ 50086c38559SMatthias Ringwald notification->callback = packet_handler; 5019c662c9bSMatthias Ringwald notification->con_handle = con_handle; 502b3f03c84SMatthias Ringwald if (characteristic == NULL){ 503b3f03c84SMatthias Ringwald notification->attribute_handle = GATT_CLIENT_ANY_VALUE_HANDLE; 504b3f03c84SMatthias Ringwald } else { 5059c662c9bSMatthias Ringwald notification->attribute_handle = characteristic->value_handle; 506b3f03c84SMatthias Ringwald } 5079c662c9bSMatthias Ringwald btstack_linked_list_add(&gatt_client_value_listeners, (btstack_linked_item_t*) notification); 5089c662c9bSMatthias Ringwald } 5099c662c9bSMatthias Ringwald 5101f734b5fSMatthias Ringwald void gatt_client_stop_listening_for_characteristic_value_updates(gatt_client_notification_t * notification){ 5111f734b5fSMatthias Ringwald btstack_linked_list_remove(&gatt_client_value_listeners, (btstack_linked_item_t*) notification); 5121f734b5fSMatthias Ringwald } 5131f734b5fSMatthias Ringwald 514711e6c80SMatthias Ringwald static void emit_event_to_registered_listeners(hci_con_handle_t con_handle, uint16_t attribute_handle, uint8_t * packet, uint16_t size){ 515665d90f2SMatthias Ringwald btstack_linked_list_iterator_t it; 5169c662c9bSMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client_value_listeners); 517665d90f2SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 51886c38559SMatthias Ringwald gatt_client_notification_t * notification = (gatt_client_notification_t*) btstack_linked_list_iterator_next(&it); 519b3f03c84SMatthias Ringwald if ((notification->con_handle != GATT_CLIENT_ANY_CONNECTION) && (notification->con_handle != con_handle)) continue; 520b3f03c84SMatthias Ringwald if ((notification->attribute_handle != GATT_CLIENT_ANY_VALUE_HANDLE) && (notification->attribute_handle != attribute_handle)) continue; 52186c38559SMatthias Ringwald (*notification->callback)(HCI_EVENT_PACKET, 0, packet, size); 5223deb3ec6SMatthias Ringwald } 5233deb3ec6SMatthias Ringwald } 5243deb3ec6SMatthias Ringwald 5255cf1669fSMatthias Ringwald static void emit_gatt_complete_event(gatt_client_t * gatt_client, uint8_t att_status){ 5263deb3ec6SMatthias Ringwald // @format H1 5273deb3ec6SMatthias Ringwald uint8_t packet[5]; 5285611a760SMatthias Ringwald packet[0] = GATT_EVENT_QUERY_COMPLETE; 5293deb3ec6SMatthias Ringwald packet[1] = 3; 5305cf1669fSMatthias Ringwald little_endian_store_16(packet, 2, gatt_client->con_handle); 5317d2258b3SMilanka Ringwald packet[4] = att_status; 5325cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, sizeof(packet)); 5333deb3ec6SMatthias Ringwald } 5343deb3ec6SMatthias Ringwald 5355cf1669fSMatthias Ringwald static void emit_gatt_service_query_result_event(gatt_client_t * gatt_client, uint16_t start_group_handle, uint16_t end_group_handle, uint8_t * uuid128){ 5363deb3ec6SMatthias Ringwald // @format HX 5373deb3ec6SMatthias Ringwald uint8_t packet[24]; 5385611a760SMatthias Ringwald packet[0] = GATT_EVENT_SERVICE_QUERY_RESULT; 5394ea43905SMatthias Ringwald packet[1] = sizeof(packet) - 2u; 5405cf1669fSMatthias Ringwald little_endian_store_16(packet, 2, gatt_client->con_handle); 5413deb3ec6SMatthias Ringwald /// 542f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 4, start_group_handle); 543f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 6, end_group_handle); 5449c80e4ccSMatthias Ringwald reverse_128(uuid128, &packet[8]); 5455cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, sizeof(packet)); 5463deb3ec6SMatthias Ringwald } 5473deb3ec6SMatthias Ringwald 5485cf1669fSMatthias Ringwald 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, uint8_t * uuid128){ 5493deb3ec6SMatthias Ringwald // @format HX 5503deb3ec6SMatthias Ringwald uint8_t packet[26]; 5515611a760SMatthias Ringwald packet[0] = GATT_EVENT_INCLUDED_SERVICE_QUERY_RESULT; 5524ea43905SMatthias Ringwald packet[1] = sizeof(packet) - 2u; 5535cf1669fSMatthias Ringwald little_endian_store_16(packet, 2, gatt_client->con_handle); 5543deb3ec6SMatthias Ringwald /// 555f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 4, include_handle); 5563deb3ec6SMatthias Ringwald // 557f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 6, start_group_handle); 558f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 8, end_group_handle); 5599c80e4ccSMatthias Ringwald reverse_128(uuid128, &packet[10]); 5605cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, sizeof(packet)); 5613deb3ec6SMatthias Ringwald } 5623deb3ec6SMatthias Ringwald 5635cf1669fSMatthias 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, 5643deb3ec6SMatthias Ringwald uint16_t properties, uint8_t * uuid128){ 5653deb3ec6SMatthias Ringwald // @format HY 5663deb3ec6SMatthias Ringwald uint8_t packet[28]; 5675611a760SMatthias Ringwald packet[0] = GATT_EVENT_CHARACTERISTIC_QUERY_RESULT; 5684ea43905SMatthias Ringwald packet[1] = sizeof(packet) - 2u; 5695cf1669fSMatthias Ringwald little_endian_store_16(packet, 2, gatt_client->con_handle); 5703deb3ec6SMatthias Ringwald /// 571f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 4, start_handle); 572f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 6, value_handle); 573f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 8, end_handle); 574f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 10, properties); 5759c80e4ccSMatthias Ringwald reverse_128(uuid128, &packet[12]); 5765cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, sizeof(packet)); 5773deb3ec6SMatthias Ringwald } 5783deb3ec6SMatthias Ringwald 5793deb3ec6SMatthias Ringwald static void emit_gatt_all_characteristic_descriptors_result_event( 5805cf1669fSMatthias Ringwald gatt_client_t * gatt_client, uint16_t descriptor_handle, uint8_t * uuid128){ 5813deb3ec6SMatthias Ringwald // @format HZ 5823deb3ec6SMatthias Ringwald uint8_t packet[22]; 5835611a760SMatthias Ringwald packet[0] = GATT_EVENT_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY_RESULT; 5844ea43905SMatthias Ringwald packet[1] = sizeof(packet) - 2u; 5855cf1669fSMatthias Ringwald little_endian_store_16(packet, 2, gatt_client->con_handle); 5863deb3ec6SMatthias Ringwald /// 587f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 4, descriptor_handle); 5889c80e4ccSMatthias Ringwald reverse_128(uuid128, &packet[6]); 5895cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, sizeof(packet)); 5903deb3ec6SMatthias Ringwald } 5913deb3ec6SMatthias Ringwald 5925cf1669fSMatthias Ringwald static void emit_gatt_mtu_exchanged_result_event(gatt_client_t * gatt_client, uint16_t new_mtu){ 5938f37572aSJakob Krantz // @format H2 5948f37572aSJakob Krantz uint8_t packet[6]; 5958f37572aSJakob Krantz packet[0] = GATT_EVENT_MTU; 5964ea43905SMatthias Ringwald packet[1] = sizeof(packet) - 2u; 5975cf1669fSMatthias Ringwald little_endian_store_16(packet, 2, gatt_client->con_handle); 5988f37572aSJakob Krantz little_endian_store_16(packet, 4, new_mtu); 5995cf1669fSMatthias Ringwald att_dispatch_client_mtu_exchanged(gatt_client->con_handle, new_mtu); 6005cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, sizeof(packet)); 6018f37572aSJakob Krantz } 6028f37572aSJakob Krantz /// 6035cf1669fSMatthias Ringwald static void report_gatt_services(gatt_client_t * gatt_client, uint8_t * packet, uint16_t size){ 6043deb3ec6SMatthias Ringwald uint8_t attr_length = packet[1]; 6054ea43905SMatthias Ringwald uint8_t uuid_length = attr_length - 4u; 6063deb3ec6SMatthias Ringwald 6073deb3ec6SMatthias Ringwald int i; 6083deb3ec6SMatthias Ringwald for (i = 2; i < size; i += attr_length){ 609f8fbdce0SMatthias Ringwald uint16_t start_group_handle = little_endian_read_16(packet,i); 610f8fbdce0SMatthias Ringwald uint16_t end_group_handle = little_endian_read_16(packet,i+2); 6113deb3ec6SMatthias Ringwald uint8_t uuid128[16]; 6123deb3ec6SMatthias Ringwald uint16_t uuid16 = 0; 6133deb3ec6SMatthias Ringwald 6144ea43905SMatthias Ringwald if (uuid_length == 2u){ 615f8fbdce0SMatthias Ringwald uuid16 = little_endian_read_16(packet, i+4); 616e1a125dfSMatthias Ringwald uuid_add_bluetooth_prefix((uint8_t*) &uuid128, uuid16); 6173deb3ec6SMatthias Ringwald } else { 6189c80e4ccSMatthias Ringwald reverse_128(&packet[i+4], uuid128); 6193deb3ec6SMatthias Ringwald } 6205cf1669fSMatthias Ringwald emit_gatt_service_query_result_event(gatt_client, start_group_handle, end_group_handle, uuid128); 6213deb3ec6SMatthias Ringwald } 6223deb3ec6SMatthias Ringwald } 6233deb3ec6SMatthias Ringwald 6243deb3ec6SMatthias Ringwald // helper 6255cf1669fSMatthias Ringwald static void 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){ 6263deb3ec6SMatthias Ringwald uint8_t uuid128[16]; 6273deb3ec6SMatthias Ringwald uint16_t uuid16 = 0; 6284ea43905SMatthias Ringwald if (uuid_length == 2u){ 629f8fbdce0SMatthias Ringwald uuid16 = little_endian_read_16(uuid, 0); 630e1a125dfSMatthias Ringwald uuid_add_bluetooth_prefix((uint8_t*) uuid128, uuid16); 6314ea43905SMatthias Ringwald } else if (uuid_length == 16u){ 6329c80e4ccSMatthias Ringwald reverse_128(uuid, uuid128); 633d73c9dbeSMilanka Ringwald } else { 634d73c9dbeSMilanka Ringwald return; 6353deb3ec6SMatthias Ringwald } 6363deb3ec6SMatthias Ringwald 6375cf1669fSMatthias Ringwald if (gatt_client->filter_with_uuid && (memcmp(gatt_client->uuid128, uuid128, 16) != 0)) return; 6383deb3ec6SMatthias Ringwald 6395cf1669fSMatthias Ringwald gatt_client->characteristic_properties = properties; 6405cf1669fSMatthias Ringwald gatt_client->characteristic_start_handle = start_handle; 6415cf1669fSMatthias Ringwald gatt_client->attribute_handle = value_handle; 6423deb3ec6SMatthias Ringwald 6435cf1669fSMatthias Ringwald if (gatt_client->filter_with_uuid) return; 6443deb3ec6SMatthias Ringwald 6455cf1669fSMatthias Ringwald gatt_client->uuid16 = uuid16; 6465cf1669fSMatthias Ringwald (void)memcpy(gatt_client->uuid128, uuid128, 16); 6473deb3ec6SMatthias Ringwald } 6483deb3ec6SMatthias Ringwald 6495cf1669fSMatthias Ringwald static void characteristic_end_found(gatt_client_t * gatt_client, uint16_t end_handle){ 6503deb3ec6SMatthias Ringwald // TODO: stop searching if filter and uuid found 6513deb3ec6SMatthias Ringwald 6525cf1669fSMatthias Ringwald if (!gatt_client->characteristic_start_handle) return; 6533deb3ec6SMatthias Ringwald 6545cf1669fSMatthias Ringwald emit_gatt_characteristic_query_result_event(gatt_client, gatt_client->characteristic_start_handle, gatt_client->attribute_handle, 6555cf1669fSMatthias Ringwald end_handle, gatt_client->characteristic_properties, gatt_client->uuid128); 6563deb3ec6SMatthias Ringwald 6575cf1669fSMatthias Ringwald gatt_client->characteristic_start_handle = 0; 6583deb3ec6SMatthias Ringwald } 6593deb3ec6SMatthias Ringwald 6605cf1669fSMatthias Ringwald static void report_gatt_characteristics(gatt_client_t * gatt_client, uint8_t * packet, uint16_t size){ 6614ea43905SMatthias Ringwald if (size < 2u) return; 6623deb3ec6SMatthias Ringwald uint8_t attr_length = packet[1]; 6634ea43905SMatthias Ringwald if ((attr_length != 7u) && (attr_length != 21u)) return; 6644ea43905SMatthias Ringwald uint8_t uuid_length = attr_length - 5u; 6653deb3ec6SMatthias Ringwald int i; 6664ea43905SMatthias Ringwald for (i = 2u; (i + attr_length) <= size; i += attr_length){ 667f8fbdce0SMatthias Ringwald uint16_t start_handle = little_endian_read_16(packet, i); 6683deb3ec6SMatthias Ringwald uint8_t properties = packet[i+2]; 669f8fbdce0SMatthias Ringwald uint16_t value_handle = little_endian_read_16(packet, i+3); 6705cf1669fSMatthias Ringwald characteristic_end_found(gatt_client, start_handle - 1u); 6715cf1669fSMatthias Ringwald characteristic_start_found(gatt_client, start_handle, properties, value_handle, &packet[i + 5], uuid_length); 6723deb3ec6SMatthias Ringwald } 6733deb3ec6SMatthias Ringwald } 6743deb3ec6SMatthias Ringwald 6755cf1669fSMatthias Ringwald static void report_gatt_included_service_uuid16(gatt_client_t * gatt_client, uint16_t include_handle, uint16_t uuid16){ 6763deb3ec6SMatthias Ringwald uint8_t normalized_uuid128[16]; 677e1a125dfSMatthias Ringwald uuid_add_bluetooth_prefix(normalized_uuid128, uuid16); 6785cf1669fSMatthias Ringwald emit_gatt_included_service_query_result_event(gatt_client, include_handle, gatt_client->query_start_handle, 6795cf1669fSMatthias Ringwald gatt_client->query_end_handle, normalized_uuid128); 6803deb3ec6SMatthias Ringwald } 6813deb3ec6SMatthias Ringwald 6825cf1669fSMatthias Ringwald static void report_gatt_included_service_uuid128(gatt_client_t * gatt_client, uint16_t include_handle, uint8_t *uuid128){ 6835cf1669fSMatthias Ringwald emit_gatt_included_service_query_result_event(gatt_client, include_handle, gatt_client->query_start_handle, 6845cf1669fSMatthias Ringwald gatt_client->query_end_handle, uuid128); 6853deb3ec6SMatthias Ringwald } 6863deb3ec6SMatthias Ringwald 6873deb3ec6SMatthias Ringwald // @returns packet pointer 6883deb3ec6SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite HCI + L2CAP packet headers 6893deb3ec6SMatthias Ringwald static const int characteristic_value_event_header_size = 8; 690711e6c80SMatthias 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){ 691a6121b51SMilanka Ringwald #ifdef FUZZING_BUILD_MODE_UNSAFE_FOR_PRODUCTION 692a6121b51SMilanka Ringwald // avoid using pre ATT headers. 693a6121b51SMilanka Ringwald return NULL; 694a6121b51SMilanka Ringwald #endif 6953deb3ec6SMatthias Ringwald // before the value inside the ATT PDU 6963deb3ec6SMatthias Ringwald uint8_t * packet = value - characteristic_value_event_header_size; 6973deb3ec6SMatthias Ringwald packet[0] = type; 6983deb3ec6SMatthias Ringwald packet[1] = characteristic_value_event_header_size - 2 + length; 699f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 2, con_handle); 700f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 4, attribute_handle); 701f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 6, length); 7023deb3ec6SMatthias Ringwald return packet; 7033deb3ec6SMatthias Ringwald } 7043deb3ec6SMatthias Ringwald 7053deb3ec6SMatthias Ringwald // @returns packet pointer 7063deb3ec6SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite parts of the HCI/L2CAP/ATT packet (4/4/3) bytes 7073deb3ec6SMatthias Ringwald static const int long_characteristic_value_event_header_size = 10; 708711e6c80SMatthias 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){ 709a6121b51SMilanka Ringwald #ifdef FUZZING_BUILD_MODE_UNSAFE_FOR_PRODUCTION 710a6121b51SMilanka Ringwald // avoid using pre ATT headers. 711a6121b51SMilanka Ringwald return NULL; 712a6121b51SMilanka Ringwald #endif 7133deb3ec6SMatthias Ringwald #if defined(HCI_INCOMING_PRE_BUFFER_SIZE) && (HCI_INCOMING_PRE_BUFFER_SIZE >= 10 - 8) // L2CAP Header (4) - ACL Header (4) 7143deb3ec6SMatthias Ringwald // before the value inside the ATT PDU 7153deb3ec6SMatthias Ringwald uint8_t * packet = value - long_characteristic_value_event_header_size; 7163deb3ec6SMatthias Ringwald packet[0] = type; 7173deb3ec6SMatthias Ringwald packet[1] = long_characteristic_value_event_header_size - 2 + length; 718f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 2, con_handle); 719f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 4, attribute_handle); 720f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 6, offset); 721f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 8, length); 7223deb3ec6SMatthias Ringwald return packet; 7233deb3ec6SMatthias Ringwald #else 7243deb3ec6SMatthias Ringwald log_error("HCI_INCOMING_PRE_BUFFER_SIZE >= 2 required for long characteristic reads"); 7253deb3ec6SMatthias Ringwald return NULL; 7263deb3ec6SMatthias Ringwald #endif 7273deb3ec6SMatthias Ringwald } 7283deb3ec6SMatthias Ringwald 729c90e270fSMatthias Ringwald // test if notification/indication should be delivered to application (BLESA) 730c90e270fSMatthias Ringwald static bool gatt_client_accept_server_message(hci_con_handle_t con_handle){ 731b15d5ceaSMatthias Ringwald #ifdef ENABLE_LE_PROACTIVE_AUTHENTICATION 732b15d5ceaSMatthias Ringwald // ignore messages until re-encryption is complete 733c90e270fSMatthias Ringwald if (gap_reconnect_security_setup_active(con_handle)) return false; 734c90e270fSMatthias Ringwald 735c90e270fSMatthias Ringwald // after that ignore if bonded but not encrypted 736c90e270fSMatthias Ringwald return !gap_bonded(con_handle) || (gap_encryption_key_size(con_handle) > 0); 737c90e270fSMatthias Ringwald #else 7383c8fe124SMatthias Ringwald UNUSED(con_handle); 739c90e270fSMatthias Ringwald return true; 740c90e270fSMatthias Ringwald #endif 741c90e270fSMatthias Ringwald } 742c90e270fSMatthias Ringwald 7433deb3ec6SMatthias Ringwald 7443deb3ec6SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite parts of the HCI/L2CAP/ATT packet (4/4/3) bytes 745711e6c80SMatthias Ringwald static void report_gatt_notification(hci_con_handle_t con_handle, uint16_t value_handle, uint8_t * value, int length){ 746c90e270fSMatthias Ringwald if (!gatt_client_accept_server_message(con_handle)) return; 7475611a760SMatthias Ringwald uint8_t * packet = setup_characteristic_value_packet(GATT_EVENT_NOTIFICATION, con_handle, value_handle, value, length); 7489c662c9bSMatthias Ringwald emit_event_to_registered_listeners(con_handle, value_handle, packet, characteristic_value_event_header_size + length); 7493deb3ec6SMatthias Ringwald } 7503deb3ec6SMatthias Ringwald 7513deb3ec6SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite parts of the HCI/L2CAP/ATT packet (4/4/3) bytes 752711e6c80SMatthias Ringwald static void report_gatt_indication(hci_con_handle_t con_handle, uint16_t value_handle, uint8_t * value, int length){ 753c90e270fSMatthias Ringwald if (!gatt_client_accept_server_message(con_handle)) return; 7545611a760SMatthias Ringwald uint8_t * packet = setup_characteristic_value_packet(GATT_EVENT_INDICATION, con_handle, value_handle, value, length); 7559c662c9bSMatthias Ringwald emit_event_to_registered_listeners(con_handle, value_handle, packet, characteristic_value_event_header_size + length); 7563deb3ec6SMatthias Ringwald } 7573deb3ec6SMatthias Ringwald 7583deb3ec6SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite parts of the HCI/L2CAP/ATT packet (4/4/3) bytes 7595cf1669fSMatthias Ringwald static void report_gatt_characteristic_value(gatt_client_t * gatt_client, uint16_t attribute_handle, uint8_t * value, uint16_t length){ 7605cf1669fSMatthias Ringwald uint8_t * packet = setup_characteristic_value_packet(GATT_EVENT_CHARACTERISTIC_VALUE_QUERY_RESULT, gatt_client->con_handle, attribute_handle, value, length); 7615cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, characteristic_value_event_header_size + length); 7623deb3ec6SMatthias Ringwald } 7633deb3ec6SMatthias Ringwald 7643deb3ec6SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite parts of the HCI/L2CAP/ATT packet (4/4/3) bytes 7655cf1669fSMatthias 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){ 7665cf1669fSMatthias 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); 7673deb3ec6SMatthias Ringwald if (!packet) return; 7685cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, blob_length + long_characteristic_value_event_header_size); 7693deb3ec6SMatthias Ringwald } 7703deb3ec6SMatthias Ringwald 7715cf1669fSMatthias 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){ 7729ec2630cSMatthias Ringwald UNUSED(value_offset); 7735cf1669fSMatthias Ringwald uint8_t * packet = setup_characteristic_value_packet(GATT_EVENT_CHARACTERISTIC_DESCRIPTOR_QUERY_RESULT, gatt_client->con_handle, descriptor_handle, value, value_length); 7745cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, value_length + 8u); 7753deb3ec6SMatthias Ringwald } 7763deb3ec6SMatthias Ringwald 7775cf1669fSMatthias 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){ 7785cf1669fSMatthias 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); 7793deb3ec6SMatthias Ringwald if (!packet) return; 7805cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, blob_length + long_characteristic_value_event_header_size); 7813deb3ec6SMatthias Ringwald } 7823deb3ec6SMatthias Ringwald 7835cf1669fSMatthias Ringwald static void report_gatt_all_characteristic_descriptors(gatt_client_t * gatt_client, uint8_t * packet, uint16_t size, uint16_t pair_size){ 7843deb3ec6SMatthias Ringwald int i; 7854ea43905SMatthias Ringwald for (i = 0u; (i + pair_size) <= size; i += pair_size){ 786f8fbdce0SMatthias Ringwald uint16_t descriptor_handle = little_endian_read_16(packet,i); 7873deb3ec6SMatthias Ringwald uint8_t uuid128[16]; 7883deb3ec6SMatthias Ringwald uint16_t uuid16 = 0; 7894ea43905SMatthias Ringwald if (pair_size == 4u){ 790f8fbdce0SMatthias Ringwald uuid16 = little_endian_read_16(packet,i+2); 791e1a125dfSMatthias Ringwald uuid_add_bluetooth_prefix(uuid128, uuid16); 7923deb3ec6SMatthias Ringwald } else { 7939c80e4ccSMatthias Ringwald reverse_128(&packet[i+2], uuid128); 7943deb3ec6SMatthias Ringwald } 7955cf1669fSMatthias Ringwald emit_gatt_all_characteristic_descriptors_result_event(gatt_client, descriptor_handle, uuid128); 7963deb3ec6SMatthias Ringwald } 7973deb3ec6SMatthias Ringwald 7983deb3ec6SMatthias Ringwald } 7993deb3ec6SMatthias Ringwald 8005cf1669fSMatthias Ringwald static int is_query_done(gatt_client_t * gatt_client, uint16_t last_result_handle){ 8015cf1669fSMatthias Ringwald return last_result_handle >= gatt_client->end_group_handle; 8023deb3ec6SMatthias Ringwald } 8033deb3ec6SMatthias Ringwald 8045cf1669fSMatthias Ringwald static void trigger_next_query(gatt_client_t * gatt_client, uint16_t last_result_handle, gatt_client_state_t next_query_state){ 8055cf1669fSMatthias Ringwald if (is_query_done(gatt_client, last_result_handle)){ 8065cf1669fSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 8075cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_SUCCESS); 8083deb3ec6SMatthias Ringwald return; 8093deb3ec6SMatthias Ringwald } 8103deb3ec6SMatthias Ringwald // next 8115cf1669fSMatthias Ringwald gatt_client->start_group_handle = last_result_handle + 1u; 8125cf1669fSMatthias Ringwald gatt_client->gatt_client_state = next_query_state; 8133deb3ec6SMatthias Ringwald } 8143deb3ec6SMatthias Ringwald 8155cf1669fSMatthias Ringwald static void trigger_next_included_service_query(gatt_client_t * gatt_client, uint16_t last_result_handle){ 8165cf1669fSMatthias Ringwald trigger_next_query(gatt_client, last_result_handle, P_W2_SEND_INCLUDED_SERVICE_QUERY); 8173deb3ec6SMatthias Ringwald } 8183deb3ec6SMatthias Ringwald 8195cf1669fSMatthias Ringwald static void trigger_next_service_query(gatt_client_t * gatt_client, uint16_t last_result_handle){ 8205cf1669fSMatthias Ringwald trigger_next_query(gatt_client, last_result_handle, P_W2_SEND_SERVICE_QUERY); 8213deb3ec6SMatthias Ringwald } 8223deb3ec6SMatthias Ringwald 8235cf1669fSMatthias Ringwald static void trigger_next_service_by_uuid_query(gatt_client_t * gatt_client, uint16_t last_result_handle){ 8245cf1669fSMatthias Ringwald trigger_next_query(gatt_client, last_result_handle, P_W2_SEND_SERVICE_WITH_UUID_QUERY); 8253deb3ec6SMatthias Ringwald } 8263deb3ec6SMatthias Ringwald 8275cf1669fSMatthias Ringwald static void trigger_next_characteristic_query(gatt_client_t * gatt_client, uint16_t last_result_handle){ 8285cf1669fSMatthias Ringwald if (is_query_done(gatt_client, last_result_handle)){ 8293deb3ec6SMatthias Ringwald // report last characteristic 8305cf1669fSMatthias Ringwald characteristic_end_found(gatt_client, gatt_client->end_group_handle); 8313deb3ec6SMatthias Ringwald } 8325cf1669fSMatthias Ringwald trigger_next_query(gatt_client, last_result_handle, P_W2_SEND_ALL_CHARACTERISTICS_OF_SERVICE_QUERY); 8333deb3ec6SMatthias Ringwald } 8343deb3ec6SMatthias Ringwald 8355cf1669fSMatthias Ringwald static void trigger_next_characteristic_descriptor_query(gatt_client_t * gatt_client, uint16_t last_result_handle){ 8365cf1669fSMatthias Ringwald trigger_next_query(gatt_client, last_result_handle, P_W2_SEND_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY); 8373deb3ec6SMatthias Ringwald } 8383deb3ec6SMatthias Ringwald 8395cf1669fSMatthias Ringwald static void trigger_next_read_by_type_query(gatt_client_t * gatt_client, uint16_t last_result_handle){ 8405cf1669fSMatthias Ringwald trigger_next_query(gatt_client, last_result_handle, P_W2_SEND_READ_BY_TYPE_REQUEST); 8413deb3ec6SMatthias Ringwald } 8423deb3ec6SMatthias Ringwald 8435cf1669fSMatthias 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){ 8445cf1669fSMatthias Ringwald gatt_client->attribute_offset += write_blob_length(gatt_client); 8455cf1669fSMatthias Ringwald uint16_t next_blob_length = write_blob_length(gatt_client); 8463deb3ec6SMatthias Ringwald 8474ea43905SMatthias Ringwald if (next_blob_length == 0u){ 8485cf1669fSMatthias Ringwald gatt_client->gatt_client_state = done_state; 8493deb3ec6SMatthias Ringwald return; 8503deb3ec6SMatthias Ringwald } 8515cf1669fSMatthias Ringwald gatt_client->gatt_client_state = next_query_state; 8523deb3ec6SMatthias Ringwald } 8533deb3ec6SMatthias Ringwald 8545cf1669fSMatthias Ringwald static void trigger_next_blob_query(gatt_client_t * gatt_client, gatt_client_state_t next_query_state, uint16_t received_blob_length){ 8553deb3ec6SMatthias Ringwald 856dda77937SMatthias Ringwald uint16_t max_blob_length = gatt_client->mtu - 1u; 8573deb3ec6SMatthias Ringwald if (received_blob_length < max_blob_length){ 8585cf1669fSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 8595cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_SUCCESS); 8603deb3ec6SMatthias Ringwald return; 8613deb3ec6SMatthias Ringwald } 8623deb3ec6SMatthias Ringwald 8635cf1669fSMatthias Ringwald gatt_client->attribute_offset += received_blob_length; 8645cf1669fSMatthias Ringwald gatt_client->gatt_client_state = next_query_state; 8653deb3ec6SMatthias Ringwald } 8663deb3ec6SMatthias Ringwald 8673deb3ec6SMatthias Ringwald 8685cf1669fSMatthias Ringwald static int is_value_valid(gatt_client_t *gatt_client, uint8_t *packet, uint16_t size){ 869f8fbdce0SMatthias Ringwald uint16_t attribute_handle = little_endian_read_16(packet, 1); 870f8fbdce0SMatthias Ringwald uint16_t value_offset = little_endian_read_16(packet, 3); 8713deb3ec6SMatthias Ringwald 8725cf1669fSMatthias Ringwald if (gatt_client->attribute_handle != attribute_handle) return 0; 8735cf1669fSMatthias Ringwald if (gatt_client->attribute_offset != value_offset) return 0; 8745cf1669fSMatthias Ringwald return memcmp(&gatt_client->attribute_value[gatt_client->attribute_offset], &packet[5], size - 5u) == 0u; 8753deb3ec6SMatthias Ringwald } 8763deb3ec6SMatthias Ringwald 877544128c3SMatthias Ringwald // returns 1 if packet was sent 8785cf1669fSMatthias Ringwald static int gatt_client_run_for_gatt_client(gatt_client_t * gatt_client){ 8793deb3ec6SMatthias Ringwald 880e4d159baSMatthias Ringwald // wait until re-encryption is complete 8815cf1669fSMatthias Ringwald if (gap_reconnect_security_setup_active(gatt_client->con_handle)) return 0; 882d1e1a57fSMatthias Ringwald 883e4d159baSMatthias Ringwald // wait until re-encryption is complete 8848918bbdaSMatthias Ringwald if (gatt_client->reencryption_active) return 0; 8856c124bc2SMatthias Ringwald 88611279da7SMatthias Ringwald // wait until pairing complete (either reactive authentication or due to required security level) 8873503dc74SMatthias Ringwald if (gatt_client->wait_for_authentication_complete) return 0; 88811279da7SMatthias Ringwald 889*fd14b205SMatthias Ringwald bool client_request_pending = gatt_client->gatt_client_state != P_READY; 890*fd14b205SMatthias Ringwald 891e4d159baSMatthias Ringwald // verify security level for Mandatory Authentication 892798530bdSMatthias Ringwald if (client_request_pending && (gatt_client_required_security_level > gatt_client->security_level)){ 8931dfae9c7SMatthias Ringwald log_info("Trigger pairing, current security level %u, required %u\n", gatt_client->security_level, gatt_client_required_security_level); 8943503dc74SMatthias Ringwald gatt_client->wait_for_authentication_complete = 1; 89511279da7SMatthias Ringwald // set att error code for pairing failure based on required level 89611279da7SMatthias Ringwald switch (gatt_client_required_security_level){ 89711279da7SMatthias Ringwald case LEVEL_4: 89811279da7SMatthias Ringwald case LEVEL_3: 89911279da7SMatthias Ringwald gatt_client->pending_error_code = ATT_ERROR_INSUFFICIENT_AUTHENTICATION; 90011279da7SMatthias Ringwald break; 90111279da7SMatthias Ringwald default: 90211279da7SMatthias Ringwald gatt_client->pending_error_code = ATT_ERROR_INSUFFICIENT_ENCRYPTION; 90311279da7SMatthias Ringwald break; 90411279da7SMatthias Ringwald } 90511279da7SMatthias Ringwald sm_request_pairing(gatt_client->con_handle); 90611279da7SMatthias Ringwald // sm probably just sent a pdu 90711279da7SMatthias Ringwald return 1; 90811279da7SMatthias Ringwald } 909f4b33574SMatthias Ringwald 9105cf1669fSMatthias Ringwald switch (gatt_client->mtu_state) { 911544128c3SMatthias Ringwald case SEND_MTU_EXCHANGE: 9125cf1669fSMatthias Ringwald gatt_client->mtu_state = SENT_MTU_EXCHANGE; 9135cf1669fSMatthias Ringwald att_exchange_mtu_request(gatt_client->con_handle); 914544128c3SMatthias Ringwald return 1; 9153deb3ec6SMatthias Ringwald case SENT_MTU_EXCHANGE: 916544128c3SMatthias Ringwald return 0; 9173deb3ec6SMatthias Ringwald default: 9183deb3ec6SMatthias Ringwald break; 9193deb3ec6SMatthias Ringwald } 9203deb3ec6SMatthias Ringwald 9215cf1669fSMatthias Ringwald if (gatt_client->send_confirmation){ 9225cf1669fSMatthias Ringwald gatt_client->send_confirmation = 0; 9235cf1669fSMatthias Ringwald att_confirmation(gatt_client->con_handle); 924544128c3SMatthias Ringwald return 1; 9253deb3ec6SMatthias Ringwald } 9263deb3ec6SMatthias Ringwald 9273deb3ec6SMatthias Ringwald // check MTU for writes 9285cf1669fSMatthias Ringwald switch (gatt_client->gatt_client_state){ 9293deb3ec6SMatthias Ringwald case P_W2_SEND_WRITE_CHARACTERISTIC_VALUE: 9303deb3ec6SMatthias Ringwald case P_W2_SEND_WRITE_CHARACTERISTIC_DESCRIPTOR: 931dda77937SMatthias Ringwald if (gatt_client->attribute_length <= (gatt_client->mtu - 3u)) break; 932dda77937SMatthias Ringwald log_error("gatt_client_run: value len %u > MTU %u - 3\n", gatt_client->attribute_length,gatt_client->mtu); 9335cf1669fSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 9345cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_INVALID_ATTRIBUTE_VALUE_LENGTH); 935544128c3SMatthias Ringwald return 0; 9363deb3ec6SMatthias Ringwald default: 9373deb3ec6SMatthias Ringwald break; 9383deb3ec6SMatthias Ringwald } 9393deb3ec6SMatthias Ringwald 9405cf1669fSMatthias Ringwald switch (gatt_client->gatt_client_state){ 9413deb3ec6SMatthias Ringwald case P_W2_SEND_SERVICE_QUERY: 9425cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_SERVICE_QUERY_RESULT; 9435cf1669fSMatthias Ringwald send_gatt_services_request(gatt_client); 944544128c3SMatthias Ringwald return 1; 9453deb3ec6SMatthias Ringwald 9463deb3ec6SMatthias Ringwald case P_W2_SEND_SERVICE_WITH_UUID_QUERY: 9475cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_SERVICE_WITH_UUID_RESULT; 9485cf1669fSMatthias Ringwald send_gatt_services_by_uuid_request(gatt_client); 949544128c3SMatthias Ringwald return 1; 9503deb3ec6SMatthias Ringwald 9513deb3ec6SMatthias Ringwald case P_W2_SEND_ALL_CHARACTERISTICS_OF_SERVICE_QUERY: 9525cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_ALL_CHARACTERISTICS_OF_SERVICE_QUERY_RESULT; 9535cf1669fSMatthias Ringwald send_gatt_characteristic_request(gatt_client); 954544128c3SMatthias Ringwald return 1; 9553deb3ec6SMatthias Ringwald 9563deb3ec6SMatthias Ringwald case P_W2_SEND_CHARACTERISTIC_WITH_UUID_QUERY: 9575cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_CHARACTERISTIC_WITH_UUID_QUERY_RESULT; 9585cf1669fSMatthias Ringwald send_gatt_characteristic_request(gatt_client); 959544128c3SMatthias Ringwald return 1; 9603deb3ec6SMatthias Ringwald 9613deb3ec6SMatthias Ringwald case P_W2_SEND_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY: 9625cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_CHARACTERISTIC_WITH_UUID_QUERY_RESULT; 9635cf1669fSMatthias Ringwald send_gatt_characteristic_descriptor_request(gatt_client); 964544128c3SMatthias Ringwald return 1; 9653deb3ec6SMatthias Ringwald 9663deb3ec6SMatthias Ringwald case P_W2_SEND_INCLUDED_SERVICE_QUERY: 9675cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_INCLUDED_SERVICE_QUERY_RESULT; 9685cf1669fSMatthias Ringwald send_gatt_included_service_request(gatt_client); 969544128c3SMatthias Ringwald return 1; 9703deb3ec6SMatthias Ringwald 9713deb3ec6SMatthias Ringwald case P_W2_SEND_INCLUDED_SERVICE_WITH_UUID_QUERY: 9725cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_INCLUDED_SERVICE_UUID_WITH_QUERY_RESULT; 9735cf1669fSMatthias Ringwald send_gatt_included_service_uuid_request(gatt_client); 974544128c3SMatthias Ringwald return 1; 9753deb3ec6SMatthias Ringwald 9763deb3ec6SMatthias Ringwald case P_W2_SEND_READ_CHARACTERISTIC_VALUE_QUERY: 9775cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_READ_CHARACTERISTIC_VALUE_RESULT; 9785cf1669fSMatthias Ringwald send_gatt_read_characteristic_value_request(gatt_client); 979544128c3SMatthias Ringwald return 1; 9803deb3ec6SMatthias Ringwald 9813deb3ec6SMatthias Ringwald case P_W2_SEND_READ_BLOB_QUERY: 9825cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_READ_BLOB_RESULT; 9835cf1669fSMatthias Ringwald send_gatt_read_blob_request(gatt_client); 984544128c3SMatthias Ringwald return 1; 9853deb3ec6SMatthias Ringwald 9863deb3ec6SMatthias Ringwald case P_W2_SEND_READ_BY_TYPE_REQUEST: 9875cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_READ_BY_TYPE_RESPONSE; 9885cf1669fSMatthias Ringwald send_gatt_read_by_type_request(gatt_client); 989544128c3SMatthias Ringwald return 1; 9903deb3ec6SMatthias Ringwald 9913deb3ec6SMatthias Ringwald case P_W2_SEND_READ_MULTIPLE_REQUEST: 9925cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_READ_MULTIPLE_RESPONSE; 9935cf1669fSMatthias Ringwald send_gatt_read_multiple_request(gatt_client); 994544128c3SMatthias Ringwald return 1; 9953deb3ec6SMatthias Ringwald 9963deb3ec6SMatthias Ringwald case P_W2_SEND_WRITE_CHARACTERISTIC_VALUE: 9975cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_WRITE_CHARACTERISTIC_VALUE_RESULT; 9985cf1669fSMatthias Ringwald send_gatt_write_attribute_value_request(gatt_client); 999544128c3SMatthias Ringwald return 1; 10003deb3ec6SMatthias Ringwald 10013deb3ec6SMatthias Ringwald case P_W2_PREPARE_WRITE: 10025cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_PREPARE_WRITE_RESULT; 10035cf1669fSMatthias Ringwald send_gatt_prepare_write_request(gatt_client); 1004544128c3SMatthias Ringwald return 1; 10053deb3ec6SMatthias Ringwald 10063deb3ec6SMatthias Ringwald case P_W2_PREPARE_WRITE_SINGLE: 10075cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_PREPARE_WRITE_SINGLE_RESULT; 10085cf1669fSMatthias Ringwald send_gatt_prepare_write_request(gatt_client); 1009544128c3SMatthias Ringwald return 1; 10103deb3ec6SMatthias Ringwald 10113deb3ec6SMatthias Ringwald case P_W2_PREPARE_RELIABLE_WRITE: 10125cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_PREPARE_RELIABLE_WRITE_RESULT; 10135cf1669fSMatthias Ringwald send_gatt_prepare_write_request(gatt_client); 1014544128c3SMatthias Ringwald return 1; 10153deb3ec6SMatthias Ringwald 10163deb3ec6SMatthias Ringwald case P_W2_EXECUTE_PREPARED_WRITE: 10175cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_EXECUTE_PREPARED_WRITE_RESULT; 10185cf1669fSMatthias Ringwald send_gatt_execute_write_request(gatt_client); 1019544128c3SMatthias Ringwald return 1; 10203deb3ec6SMatthias Ringwald 10213deb3ec6SMatthias Ringwald case P_W2_CANCEL_PREPARED_WRITE: 10225cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_CANCEL_PREPARED_WRITE_RESULT; 10235cf1669fSMatthias Ringwald send_gatt_cancel_prepared_write_request(gatt_client); 1024544128c3SMatthias Ringwald return 1; 10253deb3ec6SMatthias Ringwald 10263deb3ec6SMatthias Ringwald case P_W2_CANCEL_PREPARED_WRITE_DATA_MISMATCH: 10275cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_CANCEL_PREPARED_WRITE_DATA_MISMATCH_RESULT; 10285cf1669fSMatthias Ringwald send_gatt_cancel_prepared_write_request(gatt_client); 1029544128c3SMatthias Ringwald return 1; 10303deb3ec6SMatthias Ringwald 1031abdc9fb5SMatthias Ringwald #ifdef ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY 1032abdc9fb5SMatthias Ringwald case P_W2_SEND_FIND_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY: 1033abdc9fb5SMatthias Ringwald // use Find Information 10345cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_FIND_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY_RESULT; 10355cf1669fSMatthias Ringwald send_gatt_characteristic_descriptor_request(gatt_client); 1036abdc9fb5SMatthias Ringwald #else 10373deb3ec6SMatthias Ringwald case P_W2_SEND_READ_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY: 1038abdc9fb5SMatthias Ringwald // Use Read By Type 10395cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_READ_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY_RESULT; 10405cf1669fSMatthias Ringwald send_gatt_read_client_characteristic_configuration_request(gatt_client); 1041abdc9fb5SMatthias Ringwald #endif 1042544128c3SMatthias Ringwald return 1; 10433deb3ec6SMatthias Ringwald 10443deb3ec6SMatthias Ringwald case P_W2_SEND_READ_CHARACTERISTIC_DESCRIPTOR_QUERY: 10455cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_READ_CHARACTERISTIC_DESCRIPTOR_RESULT; 10465cf1669fSMatthias Ringwald send_gatt_read_characteristic_descriptor_request(gatt_client); 1047544128c3SMatthias Ringwald return 1; 10483deb3ec6SMatthias Ringwald 10493deb3ec6SMatthias Ringwald case P_W2_SEND_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_QUERY: 10505cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_RESULT; 10515cf1669fSMatthias Ringwald send_gatt_read_blob_request(gatt_client); 1052544128c3SMatthias Ringwald return 1; 10533deb3ec6SMatthias Ringwald 10543deb3ec6SMatthias Ringwald case P_W2_SEND_WRITE_CHARACTERISTIC_DESCRIPTOR: 10555cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT; 10565cf1669fSMatthias Ringwald send_gatt_write_attribute_value_request(gatt_client); 1057544128c3SMatthias Ringwald return 1; 10583deb3ec6SMatthias Ringwald 10593deb3ec6SMatthias Ringwald case P_W2_WRITE_CLIENT_CHARACTERISTIC_CONFIGURATION: 10605cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_CLIENT_CHARACTERISTIC_CONFIGURATION_RESULT; 10615cf1669fSMatthias Ringwald send_gatt_write_client_characteristic_configuration_request(gatt_client); 1062544128c3SMatthias Ringwald return 1; 10633deb3ec6SMatthias Ringwald 10643deb3ec6SMatthias Ringwald case P_W2_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR: 10655cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT; 10665cf1669fSMatthias Ringwald send_gatt_prepare_write_request(gatt_client); 1067544128c3SMatthias Ringwald return 1; 10683deb3ec6SMatthias Ringwald 10693deb3ec6SMatthias Ringwald case P_W2_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR: 10705cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT; 10715cf1669fSMatthias Ringwald send_gatt_execute_write_request(gatt_client); 1072544128c3SMatthias Ringwald return 1; 10733deb3ec6SMatthias Ringwald 10747a766ebfSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 1075793cf6ceSMatthias Ringwald case P_W4_IDENTITY_RESOLVING: 10765cf1669fSMatthias Ringwald log_info("P_W4_IDENTITY_RESOLVING - state %x", sm_identity_resolving_state(gatt_client->con_handle)); 10775cf1669fSMatthias Ringwald switch (sm_identity_resolving_state(gatt_client->con_handle)){ 1078793cf6ceSMatthias Ringwald case IRK_LOOKUP_SUCCEEDED: 10795cf1669fSMatthias Ringwald gatt_client->le_device_index = sm_le_device_index(gatt_client->con_handle); 10805cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_CMAC_READY; 1081793cf6ceSMatthias Ringwald break; 1082793cf6ceSMatthias Ringwald case IRK_LOOKUP_FAILED: 10835cf1669fSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 10845cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_BONDING_INFORMATION_MISSING); 1085793cf6ceSMatthias Ringwald return 0; 1086793cf6ceSMatthias Ringwald default: 1087793cf6ceSMatthias Ringwald return 0; 1088793cf6ceSMatthias Ringwald } 1089793cf6ceSMatthias Ringwald 1090793cf6ceSMatthias Ringwald /* Fall through */ 1091793cf6ceSMatthias Ringwald 10923deb3ec6SMatthias Ringwald case P_W4_CMAC_READY: 10933deb3ec6SMatthias Ringwald if (sm_cmac_ready()){ 10943deb3ec6SMatthias Ringwald sm_key_t csrk; 10955cf1669fSMatthias Ringwald le_device_db_local_csrk_get(gatt_client->le_device_index, csrk); 10965cf1669fSMatthias Ringwald uint32_t sign_counter = le_device_db_local_counter_get(gatt_client->le_device_index); 10975cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_CMAC_RESULT; 10985cf1669fSMatthias 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); 10993deb3ec6SMatthias Ringwald } 1100544128c3SMatthias Ringwald return 0; 11013deb3ec6SMatthias Ringwald 11023deb3ec6SMatthias Ringwald case P_W2_SEND_SIGNED_WRITE: { 11035cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_SEND_SINGED_WRITE_DONE; 11043deb3ec6SMatthias Ringwald // bump local signing counter 11055cf1669fSMatthias Ringwald uint32_t sign_counter = le_device_db_local_counter_get(gatt_client->le_device_index); 11065cf1669fSMatthias Ringwald le_device_db_local_counter_set(gatt_client->le_device_index, sign_counter + 1); 110764b12680SMatthias Ringwald // send signed write command 11085cf1669fSMatthias Ringwald send_gatt_signed_write_request(gatt_client, sign_counter); 11093deb3ec6SMatthias Ringwald // finally, notifiy client that write is complete 11105cf1669fSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 11115cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_SUCCESS); 1112544128c3SMatthias Ringwald return 1; 11133deb3ec6SMatthias Ringwald } 11147a766ebfSMatthias Ringwald #endif 11153deb3ec6SMatthias Ringwald default: 11163deb3ec6SMatthias Ringwald break; 11173deb3ec6SMatthias Ringwald } 111847181045SMatthias Ringwald 111947181045SMatthias Ringwald // requested can send snow? 11205cf1669fSMatthias Ringwald if (gatt_client->write_without_response_callback){ 11215cf1669fSMatthias Ringwald btstack_packet_handler_t packet_handler = gatt_client->write_without_response_callback; 11225cf1669fSMatthias Ringwald gatt_client->write_without_response_callback = NULL; 112347181045SMatthias Ringwald uint8_t event[4]; 112447181045SMatthias Ringwald event[0] = GATT_EVENT_CAN_WRITE_WITHOUT_RESPONSE; 11254ea43905SMatthias Ringwald event[1] = sizeof(event) - 2u; 11265cf1669fSMatthias Ringwald little_endian_store_16(event, 2, gatt_client->con_handle); 11275cf1669fSMatthias Ringwald packet_handler(HCI_EVENT_PACKET, gatt_client->con_handle, event, sizeof(event)); 112847181045SMatthias Ringwald return 1; // to trigger requeueing (even if higher layer didn't sent) 112947181045SMatthias Ringwald } 113047181045SMatthias Ringwald 1131544128c3SMatthias Ringwald return 0; 11323deb3ec6SMatthias Ringwald } 11333deb3ec6SMatthias Ringwald 1134544128c3SMatthias Ringwald static void gatt_client_run(void){ 1135544128c3SMatthias Ringwald btstack_linked_item_t *it; 1136a0da043fSMatthias Ringwald for (it = (btstack_linked_item_t *) gatt_client_connections; it != NULL; it = it->next){ 11375cf1669fSMatthias Ringwald gatt_client_t * gatt_client = (gatt_client_t *) it; 11385cf1669fSMatthias Ringwald if (!att_dispatch_client_can_send_now(gatt_client->con_handle)) { 11395cf1669fSMatthias Ringwald att_dispatch_client_request_can_send_now_event(gatt_client->con_handle); 1140544128c3SMatthias Ringwald return; 1141544128c3SMatthias Ringwald } 11425cf1669fSMatthias Ringwald int packet_sent = gatt_client_run_for_gatt_client(gatt_client); 1143544128c3SMatthias Ringwald if (packet_sent){ 114445f2a740SMatthias Ringwald // request new permission 11455cf1669fSMatthias Ringwald att_dispatch_client_request_can_send_now_event(gatt_client->con_handle); 114645f2a740SMatthias Ringwald // requeue client for fairness and exit 114745f2a740SMatthias Ringwald // note: iterator has become invalid 11485cf1669fSMatthias Ringwald btstack_linked_list_remove(&gatt_client_connections, (btstack_linked_item_t *) gatt_client); 11495cf1669fSMatthias Ringwald btstack_linked_list_add_tail(&gatt_client_connections, (btstack_linked_item_t *) gatt_client); 1150544128c3SMatthias Ringwald return; 1151544128c3SMatthias Ringwald } 1152544128c3SMatthias Ringwald } 11533deb3ec6SMatthias Ringwald } 11543deb3ec6SMatthias Ringwald 11555cf1669fSMatthias Ringwald static void gatt_client_report_error_if_pending(gatt_client_t *gatt_client, uint8_t att_error_code) { 11565cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 1) return; 11575cf1669fSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 11585cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, att_error_code); 11593deb3ec6SMatthias Ringwald } 11603deb3ec6SMatthias Ringwald 1161f4b33574SMatthias Ringwald static void gatt_client_event_packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size){ 11621ac26e06SMatthias Ringwald UNUSED(channel); // ok: handling own l2cap events 11631ac26e06SMatthias Ringwald UNUSED(size); // ok: there is no channel 11649ec2630cSMatthias Ringwald 1165361b1363SMatthias Ringwald if (packet_type != HCI_EVENT_PACKET) return; 1166361b1363SMatthias Ringwald 1167f4b33574SMatthias Ringwald hci_con_handle_t con_handle; 11685cf1669fSMatthias Ringwald gatt_client_t * gatt_client; 11690e2df43fSMatthias Ringwald switch (hci_event_packet_get_type(packet)) { 11703deb3ec6SMatthias Ringwald case HCI_EVENT_DISCONNECTION_COMPLETE: 11713deb3ec6SMatthias Ringwald log_info("GATT Client: HCI_EVENT_DISCONNECTION_COMPLETE"); 1172f4b33574SMatthias Ringwald con_handle = little_endian_read_16(packet,3); 11735cf1669fSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(con_handle); 11745cf1669fSMatthias Ringwald if (gatt_client == NULL) break; 11753deb3ec6SMatthias Ringwald 11765cf1669fSMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, ATT_ERROR_HCI_DISCONNECT_RECEIVED); 11775cf1669fSMatthias Ringwald gatt_client_timeout_stop(gatt_client); 11785cf1669fSMatthias Ringwald btstack_linked_list_remove(&gatt_client_connections, (btstack_linked_item_t *) gatt_client); 11795cf1669fSMatthias Ringwald btstack_memory_gatt_client_free(gatt_client); 11803deb3ec6SMatthias Ringwald break; 1181f4b33574SMatthias Ringwald 1182f4b33574SMatthias Ringwald // Pairing complete (with/without bonding=storing of pairing information) 1183f4b33574SMatthias Ringwald case SM_EVENT_PAIRING_COMPLETE: 1184f4b33574SMatthias Ringwald con_handle = sm_event_pairing_complete_get_handle(packet); 11855cf1669fSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(con_handle); 11865cf1669fSMatthias Ringwald if (gatt_client == NULL) break; 1187f4b33574SMatthias Ringwald 11881dfae9c7SMatthias Ringwald // update security level 11891dfae9c7SMatthias Ringwald gatt_client->security_level = gatt_client_le_security_level_for_connection(con_handle); 11901dfae9c7SMatthias Ringwald 11913503dc74SMatthias Ringwald if (gatt_client->wait_for_authentication_complete){ 11923503dc74SMatthias Ringwald gatt_client->wait_for_authentication_complete = 0; 1193f4b33574SMatthias Ringwald if (sm_event_pairing_complete_get_status(packet)){ 11945cf1669fSMatthias Ringwald log_info("pairing failed, report previous error 0x%x", gatt_client->pending_error_code); 1195ec9babacSMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, gatt_client->pending_error_code); 1196f4b33574SMatthias Ringwald } else { 1197f4b33574SMatthias Ringwald log_info("pairing success, retry operation"); 11983deb3ec6SMatthias Ringwald } 1199f4b33574SMatthias Ringwald } 1200f4b33574SMatthias Ringwald break; 120111279da7SMatthias Ringwald 1202793cf6ceSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 1203793cf6ceSMatthias Ringwald // Identity Resolving completed (no code, gatt_client_run will continue) 1204793cf6ceSMatthias Ringwald case SM_EVENT_IDENTITY_RESOLVING_SUCCEEDED: 1205793cf6ceSMatthias Ringwald case SM_EVENT_IDENTITY_RESOLVING_FAILED: 1206793cf6ceSMatthias Ringwald break; 1207793cf6ceSMatthias Ringwald #endif 1208a95ca902SMatthias Ringwald 12098918bbdaSMatthias Ringwald // re-encryption started 12108918bbdaSMatthias Ringwald case SM_EVENT_REENCRYPTION_STARTED: 12118918bbdaSMatthias Ringwald con_handle = sm_event_reencryption_complete_get_handle(packet); 12128918bbdaSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(con_handle); 12138918bbdaSMatthias Ringwald if (gatt_client == NULL) break; 12148918bbdaSMatthias Ringwald 12158918bbdaSMatthias Ringwald gatt_client->reencryption_active = true; 12168918bbdaSMatthias Ringwald gatt_client->reencryption_result = ERROR_CODE_SUCCESS; 12178918bbdaSMatthias Ringwald break; 12188918bbdaSMatthias Ringwald 1219ec9babacSMatthias Ringwald // re-encryption complete 1220ec9babacSMatthias Ringwald case SM_EVENT_REENCRYPTION_COMPLETE: 1221ec9babacSMatthias Ringwald con_handle = sm_event_reencryption_complete_get_handle(packet); 1222ec9babacSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(con_handle); 1223ec9babacSMatthias Ringwald if (gatt_client == NULL) break; 1224f4b33574SMatthias Ringwald 12251dfae9c7SMatthias Ringwald // update security level 12261dfae9c7SMatthias Ringwald gatt_client->security_level = gatt_client_le_security_level_for_connection(con_handle); 12271dfae9c7SMatthias Ringwald 12288918bbdaSMatthias Ringwald gatt_client->reencryption_result = sm_event_reencryption_complete_get_status(packet); 12298918bbdaSMatthias Ringwald gatt_client->reencryption_active = false; 1230*fd14b205SMatthias Ringwald gatt_client->wait_for_authentication_complete = 0; 1231*fd14b205SMatthias Ringwald 1232*fd14b205SMatthias Ringwald bool client_request_pending = gatt_client->gatt_client_state != P_READY; 1233*fd14b205SMatthias Ringwald if (!client_request_pending) break; 1234*fd14b205SMatthias Ringwald 1235*fd14b205SMatthias Ringwald switch (sm_event_reencryption_complete_get_status(packet)){ 1236*fd14b205SMatthias Ringwald case ERROR_CODE_SUCCESS: 1237*fd14b205SMatthias Ringwald log_info("re-encryption success, retry operation"); 1238*fd14b205SMatthias Ringwald break; 1239*fd14b205SMatthias Ringwald case ERROR_CODE_AUTHENTICATION_FAILURE: 1240*fd14b205SMatthias Ringwald case ERROR_CODE_PIN_OR_KEY_MISSING: 1241*fd14b205SMatthias Ringwald #ifndef ENABLE_LE_PROACTIVE_AUTHENTICATION 1242*fd14b205SMatthias Ringwald if (gatt_client_required_security_level == LEVEL_0) { 1243*fd14b205SMatthias Ringwald // re-encryption failed for reactive authentication and we have a pending client request 1244*fd14b205SMatthias Ringwald // => try to resolve it by deleting bonding information if we started pairing before 1245*fd14b205SMatthias Ringwald // delete bonding information 1246*fd14b205SMatthias Ringwald int le_device_db_index = sm_le_device_index(gatt_client->con_handle); 1247*fd14b205SMatthias Ringwald btstack_assert(le_device_db_index >= 0); 1248*fd14b205SMatthias Ringwald log_info("reactive auth with pairing: delete bonding and start pairing"); 1249*fd14b205SMatthias Ringwald #ifdef ENABLE_LE_PRIVACY_ADDRESS_RESOLUTION 1250*fd14b205SMatthias Ringwald hci_remove_le_device_db_entry_from_resolving_list((uint16_t) le_device_db_index); 1251*fd14b205SMatthias Ringwald #endif 1252*fd14b205SMatthias Ringwald le_device_db_remove(le_device_db_index); 1253*fd14b205SMatthias Ringwald // trigger pairing again 1254*fd14b205SMatthias Ringwald sm_request_pairing(gatt_client->con_handle); 1255*fd14b205SMatthias Ringwald break; 1256*fd14b205SMatthias Ringwald } 1257*fd14b205SMatthias Ringwald #endif 1258*fd14b205SMatthias Ringwald // report bonding information missing 1259*fd14b205SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 1260*fd14b205SMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_BONDING_INFORMATION_MISSING); 1261*fd14b205SMatthias Ringwald break; 1262*fd14b205SMatthias Ringwald default: 1263*fd14b205SMatthias Ringwald // report bonding information missing 1264*fd14b205SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 1265*fd14b205SMatthias Ringwald emit_gatt_complete_event(gatt_client, gatt_client->pending_error_code); 1266*fd14b205SMatthias Ringwald break; 1267*fd14b205SMatthias Ringwald } 1268ec9babacSMatthias Ringwald break; 12693deb3ec6SMatthias Ringwald default: 12703deb3ec6SMatthias Ringwald break; 12713deb3ec6SMatthias Ringwald } 12723deb3ec6SMatthias Ringwald 1273361b1363SMatthias Ringwald gatt_client_run(); 12743deb3ec6SMatthias Ringwald } 12753deb3ec6SMatthias Ringwald 12763deb3ec6SMatthias Ringwald static void gatt_client_att_packet_handler(uint8_t packet_type, uint16_t handle, uint8_t *packet, uint16_t size){ 12775cf1669fSMatthias Ringwald gatt_client_t * gatt_client; 12784ea43905SMatthias Ringwald if (size < 1u) return; 12790fbf59a1SMatthias Ringwald 12800fbf59a1SMatthias Ringwald if (packet_type == HCI_EVENT_PACKET) { 12810fbf59a1SMatthias Ringwald switch (packet[0]){ 12820fbf59a1SMatthias Ringwald case L2CAP_EVENT_CAN_SEND_NOW: 128351764b3bSMatthias Ringwald gatt_client_run(); 12840fbf59a1SMatthias Ringwald break; 12850fbf59a1SMatthias Ringwald // att_server has negotiated the mtu for this connection, cache if context exists 12860fbf59a1SMatthias Ringwald case ATT_EVENT_MTU_EXCHANGE_COMPLETE: 12874ea43905SMatthias Ringwald if (size < 6u) break; 12885cf1669fSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(handle); 12895cf1669fSMatthias Ringwald if (gatt_client == NULL) break; 12905cf1669fSMatthias Ringwald gatt_client->mtu = little_endian_read_16(packet, 4); 12910fbf59a1SMatthias Ringwald break; 12920fbf59a1SMatthias Ringwald default: 12930fbf59a1SMatthias Ringwald break; 12940fbf59a1SMatthias Ringwald } 12950fbf59a1SMatthias Ringwald return; 129651764b3bSMatthias Ringwald } 129751764b3bSMatthias Ringwald 12983deb3ec6SMatthias Ringwald if (packet_type != ATT_DATA_PACKET) return; 12993deb3ec6SMatthias Ringwald 13003deb3ec6SMatthias Ringwald // special cases: notifications don't need a context while indications motivate creating one 13013deb3ec6SMatthias Ringwald switch (packet[0]){ 13023deb3ec6SMatthias Ringwald case ATT_HANDLE_VALUE_NOTIFICATION: 13034ea43905SMatthias Ringwald if (size < 3u) return; 13044ea43905SMatthias Ringwald report_gatt_notification(handle, little_endian_read_16(packet,1u), &packet[3], size-3u); 13053deb3ec6SMatthias Ringwald return; 13063deb3ec6SMatthias Ringwald case ATT_HANDLE_VALUE_INDICATION: 13075cf1669fSMatthias Ringwald gatt_client = gatt_client_provide_context_for_handle(handle); 13083deb3ec6SMatthias Ringwald break; 13093deb3ec6SMatthias Ringwald default: 13105cf1669fSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(handle); 13113deb3ec6SMatthias Ringwald break; 13123deb3ec6SMatthias Ringwald } 13133deb3ec6SMatthias Ringwald 13145cf1669fSMatthias Ringwald if (gatt_client == NULL) return; 13153deb3ec6SMatthias Ringwald 1316f060f108SMatthias Ringwald uint8_t error_code; 13173deb3ec6SMatthias Ringwald switch (packet[0]){ 13183deb3ec6SMatthias Ringwald case ATT_EXCHANGE_MTU_RESPONSE: 13193deb3ec6SMatthias Ringwald { 13204ea43905SMatthias Ringwald if (size < 3u) break; 1321f8fbdce0SMatthias Ringwald uint16_t remote_rx_mtu = little_endian_read_16(packet, 1); 13223deb3ec6SMatthias Ringwald uint16_t local_rx_mtu = l2cap_max_le_mtu(); 13235cf1669fSMatthias Ringwald gatt_client->mtu = (remote_rx_mtu < local_rx_mtu) ? remote_rx_mtu : local_rx_mtu; 13245cf1669fSMatthias Ringwald gatt_client->mtu_state = MTU_EXCHANGED; 13255cf1669fSMatthias Ringwald emit_gatt_mtu_exchanged_result_event(gatt_client, gatt_client->mtu); 13263deb3ec6SMatthias Ringwald break; 13273deb3ec6SMatthias Ringwald } 13283deb3ec6SMatthias Ringwald case ATT_READ_BY_GROUP_TYPE_RESPONSE: 13295cf1669fSMatthias Ringwald switch(gatt_client->gatt_client_state){ 13303deb3ec6SMatthias Ringwald case P_W4_SERVICE_QUERY_RESULT: 13315cf1669fSMatthias Ringwald report_gatt_services(gatt_client, packet, size); 13325cf1669fSMatthias Ringwald trigger_next_service_query(gatt_client, get_last_result_handle_from_service_list(packet, size)); 13335611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 13343deb3ec6SMatthias Ringwald break; 13353deb3ec6SMatthias Ringwald default: 13363deb3ec6SMatthias Ringwald break; 13373deb3ec6SMatthias Ringwald } 13383deb3ec6SMatthias Ringwald break; 13393deb3ec6SMatthias Ringwald case ATT_HANDLE_VALUE_INDICATION: 13404ea43905SMatthias Ringwald if (size < 3u) break; 13414ea43905SMatthias Ringwald report_gatt_indication(handle, little_endian_read_16(packet,1u), &packet[3], size-3u); 13425cf1669fSMatthias Ringwald gatt_client->send_confirmation = 1; 13433deb3ec6SMatthias Ringwald break; 13443deb3ec6SMatthias Ringwald 13453deb3ec6SMatthias Ringwald case ATT_READ_BY_TYPE_RESPONSE: 13465cf1669fSMatthias Ringwald switch (gatt_client->gatt_client_state){ 13473deb3ec6SMatthias Ringwald case P_W4_ALL_CHARACTERISTICS_OF_SERVICE_QUERY_RESULT: 13485cf1669fSMatthias Ringwald report_gatt_characteristics(gatt_client, packet, size); 13495cf1669fSMatthias Ringwald trigger_next_characteristic_query(gatt_client, get_last_result_handle_from_characteristics_list(packet, size)); 13505611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done, or by ATT_ERROR 13513deb3ec6SMatthias Ringwald break; 13523deb3ec6SMatthias Ringwald case P_W4_CHARACTERISTIC_WITH_UUID_QUERY_RESULT: 13535cf1669fSMatthias Ringwald report_gatt_characteristics(gatt_client, packet, size); 13545cf1669fSMatthias Ringwald trigger_next_characteristic_query(gatt_client, get_last_result_handle_from_characteristics_list(packet, size)); 13555611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done, or by ATT_ERROR 13563deb3ec6SMatthias Ringwald break; 13573deb3ec6SMatthias Ringwald case P_W4_INCLUDED_SERVICE_QUERY_RESULT: 13583deb3ec6SMatthias Ringwald { 13594ea43905SMatthias Ringwald if (size < 2u) break; 13603deb3ec6SMatthias Ringwald uint16_t uuid16 = 0; 13613deb3ec6SMatthias Ringwald uint16_t pair_size = packet[1]; 13623deb3ec6SMatthias Ringwald 13634ea43905SMatthias Ringwald if (pair_size == 6u){ 13644ea43905SMatthias Ringwald if (size < 8u) break; 13653deb3ec6SMatthias Ringwald // UUIDs not available, query first included service 13665cf1669fSMatthias Ringwald gatt_client->start_group_handle = little_endian_read_16(packet, 2); // ready for next query 13675cf1669fSMatthias Ringwald gatt_client->query_start_handle = little_endian_read_16(packet, 4); 13685cf1669fSMatthias Ringwald gatt_client->query_end_handle = little_endian_read_16(packet, 6); 13695cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_INCLUDED_SERVICE_WITH_UUID_QUERY; 13703deb3ec6SMatthias Ringwald break; 13713deb3ec6SMatthias Ringwald } 13723deb3ec6SMatthias Ringwald 13734ea43905SMatthias Ringwald if (pair_size != 8u) break; 13749f698c82SMatthias Ringwald 13759f698c82SMatthias Ringwald // UUIDs included, report all of them 13763deb3ec6SMatthias Ringwald uint16_t offset; 13774ea43905SMatthias Ringwald for (offset = 2u; (offset + 8u) <= size; offset += pair_size){ 1378f8fbdce0SMatthias Ringwald uint16_t include_handle = little_endian_read_16(packet, offset); 13795cf1669fSMatthias Ringwald gatt_client->query_start_handle = little_endian_read_16(packet, offset + 2u); 13805cf1669fSMatthias Ringwald gatt_client->query_end_handle = little_endian_read_16(packet, offset + 4u); 13814ea43905SMatthias Ringwald uuid16 = little_endian_read_16(packet, offset+6u); 13825cf1669fSMatthias Ringwald report_gatt_included_service_uuid16(gatt_client, include_handle, uuid16); 13833deb3ec6SMatthias Ringwald } 13843deb3ec6SMatthias Ringwald 13855cf1669fSMatthias Ringwald trigger_next_included_service_query(gatt_client, get_last_result_handle_from_included_services_list(packet, size)); 13865611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 13873deb3ec6SMatthias Ringwald break; 13883deb3ec6SMatthias Ringwald } 1389abdc9fb5SMatthias Ringwald #ifndef ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY 13903deb3ec6SMatthias Ringwald case P_W4_READ_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY_RESULT: 13915cf1669fSMatthias Ringwald gatt_client->client_characteristic_configuration_handle = little_endian_read_16(packet, 2); 13925cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_WRITE_CLIENT_CHARACTERISTIC_CONFIGURATION; 13933deb3ec6SMatthias Ringwald break; 1394abdc9fb5SMatthias Ringwald #endif 13953deb3ec6SMatthias Ringwald case P_W4_READ_BY_TYPE_RESPONSE: { 13963deb3ec6SMatthias Ringwald uint16_t pair_size = packet[1]; 13973deb3ec6SMatthias Ringwald uint16_t offset; 13983deb3ec6SMatthias Ringwald uint16_t last_result_handle = 0; 13993deb3ec6SMatthias Ringwald for (offset = 2; offset < size ; offset += pair_size){ 1400f8fbdce0SMatthias Ringwald uint16_t value_handle = little_endian_read_16(packet, offset); 14015cf1669fSMatthias Ringwald report_gatt_characteristic_value(gatt_client, value_handle, &packet[offset + 2u], pair_size - 2u); 14023deb3ec6SMatthias Ringwald last_result_handle = value_handle; 14033deb3ec6SMatthias Ringwald } 14045cf1669fSMatthias Ringwald trigger_next_read_by_type_query(gatt_client, last_result_handle); 14053deb3ec6SMatthias Ringwald break; 14063deb3ec6SMatthias Ringwald } 14073deb3ec6SMatthias Ringwald default: 14083deb3ec6SMatthias Ringwald break; 14093deb3ec6SMatthias Ringwald } 14103deb3ec6SMatthias Ringwald break; 14113deb3ec6SMatthias Ringwald case ATT_READ_RESPONSE: 14125cf1669fSMatthias Ringwald switch (gatt_client->gatt_client_state){ 14133deb3ec6SMatthias Ringwald case P_W4_INCLUDED_SERVICE_UUID_WITH_QUERY_RESULT: { 14143deb3ec6SMatthias Ringwald uint8_t uuid128[16]; 14159c80e4ccSMatthias Ringwald reverse_128(&packet[1], uuid128); 14165cf1669fSMatthias Ringwald report_gatt_included_service_uuid128(gatt_client, gatt_client->start_group_handle, uuid128); 14175cf1669fSMatthias Ringwald trigger_next_included_service_query(gatt_client, gatt_client->start_group_handle); 14185611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 14193deb3ec6SMatthias Ringwald break; 14203deb3ec6SMatthias Ringwald } 14213deb3ec6SMatthias Ringwald case P_W4_READ_CHARACTERISTIC_VALUE_RESULT: 14225cf1669fSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 14235cf1669fSMatthias Ringwald report_gatt_characteristic_value(gatt_client, gatt_client->attribute_handle, &packet[1], size - 1u); 14245cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_SUCCESS); 14253deb3ec6SMatthias Ringwald break; 14263deb3ec6SMatthias Ringwald 14273deb3ec6SMatthias Ringwald case P_W4_READ_CHARACTERISTIC_DESCRIPTOR_RESULT:{ 14285cf1669fSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 14295cf1669fSMatthias Ringwald report_gatt_characteristic_descriptor(gatt_client, gatt_client->attribute_handle, &packet[1], size - 1u, 0u); 14305cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_SUCCESS); 14313deb3ec6SMatthias Ringwald break; 14323deb3ec6SMatthias Ringwald } 14333deb3ec6SMatthias Ringwald default: 14343deb3ec6SMatthias Ringwald break; 14353deb3ec6SMatthias Ringwald } 14363deb3ec6SMatthias Ringwald break; 14373deb3ec6SMatthias Ringwald 14383deb3ec6SMatthias Ringwald case ATT_FIND_BY_TYPE_VALUE_RESPONSE: 14393deb3ec6SMatthias Ringwald { 14403deb3ec6SMatthias Ringwald uint8_t pair_size = 4; 14413deb3ec6SMatthias Ringwald int i; 14423deb3ec6SMatthias Ringwald uint16_t start_group_handle; 14435611a760SMatthias Ringwald uint16_t end_group_handle= 0xffff; // asserts GATT_EVENT_QUERY_COMPLETE is emitted if no results 14444ea43905SMatthias Ringwald for (i = 1u; (i + pair_size) <= size; i += pair_size){ 1445f8fbdce0SMatthias Ringwald start_group_handle = little_endian_read_16(packet,i); 1446f8fbdce0SMatthias Ringwald end_group_handle = little_endian_read_16(packet,i+2); 14475cf1669fSMatthias Ringwald emit_gatt_service_query_result_event(gatt_client, start_group_handle, end_group_handle, gatt_client->uuid128); 14483deb3ec6SMatthias Ringwald } 14495cf1669fSMatthias Ringwald trigger_next_service_by_uuid_query(gatt_client, end_group_handle); 14505611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 14513deb3ec6SMatthias Ringwald break; 14523deb3ec6SMatthias Ringwald } 14533deb3ec6SMatthias Ringwald case ATT_FIND_INFORMATION_REPLY: 14543deb3ec6SMatthias Ringwald { 14554ea43905SMatthias Ringwald if (size < 2u) break; 1456a6121b51SMilanka Ringwald 14573deb3ec6SMatthias Ringwald uint8_t pair_size = 4; 14584ea43905SMatthias Ringwald if (packet[1u] == 2u){ 14593deb3ec6SMatthias Ringwald pair_size = 18; 14603deb3ec6SMatthias Ringwald } 1461a6121b51SMilanka Ringwald uint16_t offset = 2; 1462a6121b51SMilanka Ringwald 1463a6121b51SMilanka Ringwald if (size < (pair_size + offset)) break; 1464f8fbdce0SMatthias Ringwald uint16_t last_descriptor_handle = little_endian_read_16(packet, size - pair_size); 1465abdc9fb5SMatthias Ringwald 1466abdc9fb5SMatthias Ringwald #ifdef ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY 14675cf1669fSMatthias Ringwald log_info("ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY, state %x", gatt_client->gatt_client_state); 14685cf1669fSMatthias Ringwald if (gatt_client->gatt_client_state == P_W4_FIND_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY_RESULT){ 1469abdc9fb5SMatthias Ringwald // iterate over descriptors looking for CCC 1470abdc9fb5SMatthias Ringwald if (pair_size == 4){ 1471a6121b51SMilanka Ringwald while ((offset + 4) <= size){ 1472abdc9fb5SMatthias Ringwald uint16_t uuid16 = little_endian_read_16(packet, offset + 2); 1473abdc9fb5SMatthias Ringwald if (uuid16 == GATT_CLIENT_CHARACTERISTICS_CONFIGURATION){ 14745cf1669fSMatthias Ringwald gatt_client->client_characteristic_configuration_handle = little_endian_read_16(packet, offset); 14755cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_WRITE_CLIENT_CHARACTERISTIC_CONFIGURATION; 14765cf1669fSMatthias Ringwald log_info("CCC found %x", gatt_client->client_characteristic_configuration_handle); 1477abdc9fb5SMatthias Ringwald break; 1478abdc9fb5SMatthias Ringwald } 1479abdc9fb5SMatthias Ringwald offset += pair_size; 1480abdc9fb5SMatthias Ringwald } 1481abdc9fb5SMatthias Ringwald } 14825cf1669fSMatthias Ringwald if (is_query_done(gatt_client, last_descriptor_handle)){ 1483abdc9fb5SMatthias Ringwald 1484abdc9fb5SMatthias Ringwald } else { 1485abdc9fb5SMatthias Ringwald // next 14865cf1669fSMatthias Ringwald gatt_client->start_group_handle = last_descriptor_handle + 1; 14875cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_FIND_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY; 1488abdc9fb5SMatthias Ringwald } 1489abdc9fb5SMatthias Ringwald break; 1490abdc9fb5SMatthias Ringwald } 1491abdc9fb5SMatthias Ringwald #endif 14925cf1669fSMatthias Ringwald report_gatt_all_characteristic_descriptors(gatt_client, &packet[2], size - 2u, pair_size); 14935cf1669fSMatthias Ringwald trigger_next_characteristic_descriptor_query(gatt_client, last_descriptor_handle); 14945611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 14953deb3ec6SMatthias Ringwald break; 14963deb3ec6SMatthias Ringwald } 14973deb3ec6SMatthias Ringwald 14983deb3ec6SMatthias Ringwald case ATT_WRITE_RESPONSE: 14995cf1669fSMatthias Ringwald switch (gatt_client->gatt_client_state){ 15003deb3ec6SMatthias Ringwald case P_W4_WRITE_CHARACTERISTIC_VALUE_RESULT: 15015cf1669fSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 15025cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_SUCCESS); 15033deb3ec6SMatthias Ringwald break; 15043deb3ec6SMatthias Ringwald case P_W4_CLIENT_CHARACTERISTIC_CONFIGURATION_RESULT: 15055cf1669fSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 15065cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_SUCCESS); 15073deb3ec6SMatthias Ringwald break; 15083deb3ec6SMatthias Ringwald case P_W4_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT: 15095cf1669fSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 15105cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_SUCCESS); 15113deb3ec6SMatthias Ringwald break; 15123deb3ec6SMatthias Ringwald default: 15133deb3ec6SMatthias Ringwald break; 15143deb3ec6SMatthias Ringwald } 15153deb3ec6SMatthias Ringwald break; 15163deb3ec6SMatthias Ringwald 15173deb3ec6SMatthias Ringwald case ATT_READ_BLOB_RESPONSE:{ 15184ea43905SMatthias Ringwald uint16_t received_blob_length = size-1u; 15195cf1669fSMatthias Ringwald switch(gatt_client->gatt_client_state){ 15203deb3ec6SMatthias Ringwald case P_W4_READ_BLOB_RESULT: 15215cf1669fSMatthias Ringwald report_gatt_long_characteristic_value_blob(gatt_client, gatt_client->attribute_handle, &packet[1], received_blob_length, gatt_client->attribute_offset); 15225cf1669fSMatthias Ringwald trigger_next_blob_query(gatt_client, P_W2_SEND_READ_BLOB_QUERY, received_blob_length); 15235611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 15243deb3ec6SMatthias Ringwald break; 15253deb3ec6SMatthias Ringwald case P_W4_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_RESULT: 15265cf1669fSMatthias Ringwald report_gatt_long_characteristic_descriptor(gatt_client, gatt_client->attribute_handle, 15273deb3ec6SMatthias Ringwald &packet[1], received_blob_length, 15285cf1669fSMatthias Ringwald gatt_client->attribute_offset); 15295cf1669fSMatthias Ringwald trigger_next_blob_query(gatt_client, P_W2_SEND_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_QUERY, received_blob_length); 15305611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 15313deb3ec6SMatthias Ringwald break; 15323deb3ec6SMatthias Ringwald default: 15333deb3ec6SMatthias Ringwald break; 15343deb3ec6SMatthias Ringwald } 15353deb3ec6SMatthias Ringwald break; 15363deb3ec6SMatthias Ringwald } 15373deb3ec6SMatthias Ringwald case ATT_PREPARE_WRITE_RESPONSE: 15385cf1669fSMatthias Ringwald switch (gatt_client->gatt_client_state){ 15393deb3ec6SMatthias Ringwald case P_W4_PREPARE_WRITE_SINGLE_RESULT: 15405cf1669fSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 15415cf1669fSMatthias Ringwald if (is_value_valid(gatt_client, packet, size)){ 15425cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_SUCCESS); 15433deb3ec6SMatthias Ringwald } else { 15445cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_DATA_MISMATCH); 15453deb3ec6SMatthias Ringwald } 15463deb3ec6SMatthias Ringwald break; 15473deb3ec6SMatthias Ringwald 15483deb3ec6SMatthias Ringwald case P_W4_PREPARE_WRITE_RESULT:{ 15495cf1669fSMatthias Ringwald gatt_client->attribute_offset = little_endian_read_16(packet, 3); 15505cf1669fSMatthias Ringwald trigger_next_prepare_write_query(gatt_client, P_W2_PREPARE_WRITE, P_W2_EXECUTE_PREPARED_WRITE); 15515611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 15523deb3ec6SMatthias Ringwald break; 15533deb3ec6SMatthias Ringwald } 15543deb3ec6SMatthias Ringwald case P_W4_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT:{ 15555cf1669fSMatthias Ringwald gatt_client->attribute_offset = little_endian_read_16(packet, 3); 15565cf1669fSMatthias Ringwald trigger_next_prepare_write_query(gatt_client, P_W2_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR, P_W2_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR); 15575611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 15583deb3ec6SMatthias Ringwald break; 15593deb3ec6SMatthias Ringwald } 15603deb3ec6SMatthias Ringwald case P_W4_PREPARE_RELIABLE_WRITE_RESULT:{ 15615cf1669fSMatthias Ringwald if (is_value_valid(gatt_client, packet, size)){ 15625cf1669fSMatthias Ringwald gatt_client->attribute_offset = little_endian_read_16(packet, 3); 15635cf1669fSMatthias Ringwald trigger_next_prepare_write_query(gatt_client, P_W2_PREPARE_RELIABLE_WRITE, P_W2_EXECUTE_PREPARED_WRITE); 15645611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 15653deb3ec6SMatthias Ringwald break; 15663deb3ec6SMatthias Ringwald } 15675cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_CANCEL_PREPARED_WRITE_DATA_MISMATCH; 15683deb3ec6SMatthias Ringwald break; 15693deb3ec6SMatthias Ringwald } 15703deb3ec6SMatthias Ringwald default: 15713deb3ec6SMatthias Ringwald break; 15723deb3ec6SMatthias Ringwald } 15733deb3ec6SMatthias Ringwald break; 15743deb3ec6SMatthias Ringwald 15753deb3ec6SMatthias Ringwald case ATT_EXECUTE_WRITE_RESPONSE: 15765cf1669fSMatthias Ringwald switch (gatt_client->gatt_client_state){ 15773deb3ec6SMatthias Ringwald case P_W4_EXECUTE_PREPARED_WRITE_RESULT: 15785cf1669fSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 15795cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_SUCCESS); 15803deb3ec6SMatthias Ringwald break; 15813deb3ec6SMatthias Ringwald case P_W4_CANCEL_PREPARED_WRITE_RESULT: 15825cf1669fSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 15835cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_SUCCESS); 15843deb3ec6SMatthias Ringwald break; 15853deb3ec6SMatthias Ringwald case P_W4_CANCEL_PREPARED_WRITE_DATA_MISMATCH_RESULT: 15865cf1669fSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 15875cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_DATA_MISMATCH); 15883deb3ec6SMatthias Ringwald break; 15893deb3ec6SMatthias Ringwald case P_W4_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT: 15905cf1669fSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 15915cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_SUCCESS); 15923deb3ec6SMatthias Ringwald break; 15933deb3ec6SMatthias Ringwald default: 15943deb3ec6SMatthias Ringwald break; 15953deb3ec6SMatthias Ringwald 15963deb3ec6SMatthias Ringwald } 15973deb3ec6SMatthias Ringwald break; 15983deb3ec6SMatthias Ringwald 15993deb3ec6SMatthias Ringwald case ATT_READ_MULTIPLE_RESPONSE: 16005cf1669fSMatthias Ringwald switch(gatt_client->gatt_client_state){ 16013deb3ec6SMatthias Ringwald case P_W4_READ_MULTIPLE_RESPONSE: 16025cf1669fSMatthias Ringwald report_gatt_characteristic_value(gatt_client, 0u, &packet[1], size - 1u); 16035cf1669fSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 16045cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_SUCCESS); 16053deb3ec6SMatthias Ringwald break; 16063deb3ec6SMatthias Ringwald default: 16073deb3ec6SMatthias Ringwald break; 16083deb3ec6SMatthias Ringwald } 16093deb3ec6SMatthias Ringwald break; 16103deb3ec6SMatthias Ringwald 16113deb3ec6SMatthias Ringwald case ATT_ERROR_RESPONSE: 16124ea43905SMatthias Ringwald if (size < 5u) return; 1613f060f108SMatthias Ringwald error_code = packet[4]; 1614f060f108SMatthias Ringwald switch (error_code){ 16153deb3ec6SMatthias Ringwald case ATT_ERROR_ATTRIBUTE_NOT_FOUND: { 16165cf1669fSMatthias Ringwald switch(gatt_client->gatt_client_state){ 16173deb3ec6SMatthias Ringwald case P_W4_SERVICE_QUERY_RESULT: 16183deb3ec6SMatthias Ringwald case P_W4_SERVICE_WITH_UUID_RESULT: 16193deb3ec6SMatthias Ringwald case P_W4_INCLUDED_SERVICE_QUERY_RESULT: 16203deb3ec6SMatthias Ringwald case P_W4_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY_RESULT: 16215cf1669fSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 16225cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_SUCCESS); 16233deb3ec6SMatthias Ringwald break; 16243deb3ec6SMatthias Ringwald case P_W4_ALL_CHARACTERISTICS_OF_SERVICE_QUERY_RESULT: 16253deb3ec6SMatthias Ringwald case P_W4_CHARACTERISTIC_WITH_UUID_QUERY_RESULT: 16265cf1669fSMatthias Ringwald characteristic_end_found(gatt_client, gatt_client->end_group_handle); 16275cf1669fSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 16285cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_SUCCESS); 16293deb3ec6SMatthias Ringwald break; 16303deb3ec6SMatthias Ringwald case P_W4_READ_BY_TYPE_RESPONSE: 16315cf1669fSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 16325cf1669fSMatthias Ringwald if (gatt_client->start_group_handle == gatt_client->query_start_handle){ 16335cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_ATTRIBUTE_NOT_FOUND); 16343deb3ec6SMatthias Ringwald } else { 16355cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_SUCCESS); 16363deb3ec6SMatthias Ringwald } 16373deb3ec6SMatthias Ringwald break; 16383deb3ec6SMatthias Ringwald default: 1639f060f108SMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, error_code); 16403deb3ec6SMatthias Ringwald break; 16413deb3ec6SMatthias Ringwald } 16423deb3ec6SMatthias Ringwald break; 16433deb3ec6SMatthias Ringwald } 1644f4b33574SMatthias Ringwald 1645f4b33574SMatthias Ringwald #ifdef ENABLE_GATT_CLIENT_PAIRING 1646f4b33574SMatthias Ringwald 1647f4b33574SMatthias Ringwald case ATT_ERROR_INSUFFICIENT_AUTHENTICATION: 1648f4b33574SMatthias Ringwald case ATT_ERROR_INSUFFICIENT_ENCRYPTION_KEY_SIZE: 1649a0e0c2beSMatthias Ringwald case ATT_ERROR_INSUFFICIENT_ENCRYPTION: { 1650a0e0c2beSMatthias Ringwald 1651f4b33574SMatthias Ringwald // security too low 16525cf1669fSMatthias Ringwald if (gatt_client->security_counter > 0) { 1653f060f108SMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, error_code); 1654f4b33574SMatthias Ringwald break; 1655f4b33574SMatthias Ringwald } 1656f4b33574SMatthias Ringwald // start security 16575cf1669fSMatthias Ringwald gatt_client->security_counter++; 1658f4b33574SMatthias Ringwald 1659f4b33574SMatthias Ringwald // setup action 1660f4b33574SMatthias Ringwald int retry = 1; 16615cf1669fSMatthias Ringwald switch (gatt_client->gatt_client_state){ 1662f4b33574SMatthias Ringwald case P_W4_READ_CHARACTERISTIC_VALUE_RESULT: 16635cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_CHARACTERISTIC_VALUE_QUERY ; 1664f4b33574SMatthias Ringwald break; 1665f4b33574SMatthias Ringwald case P_W4_READ_BLOB_RESULT: 16665cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_BLOB_QUERY; 1667f4b33574SMatthias Ringwald break; 1668f4b33574SMatthias Ringwald case P_W4_READ_BY_TYPE_RESPONSE: 16695cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_BY_TYPE_REQUEST; 1670f4b33574SMatthias Ringwald break; 1671f4b33574SMatthias Ringwald case P_W4_READ_MULTIPLE_RESPONSE: 16725cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_MULTIPLE_REQUEST; 1673f4b33574SMatthias Ringwald break; 1674f4b33574SMatthias Ringwald case P_W4_WRITE_CHARACTERISTIC_VALUE_RESULT: 16755cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_WRITE_CHARACTERISTIC_VALUE; 1676f4b33574SMatthias Ringwald break; 1677f4b33574SMatthias Ringwald case P_W4_PREPARE_WRITE_RESULT: 16785cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_PREPARE_WRITE; 1679f4b33574SMatthias Ringwald break; 1680f4b33574SMatthias Ringwald case P_W4_PREPARE_WRITE_SINGLE_RESULT: 16815cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_PREPARE_WRITE_SINGLE; 1682f4b33574SMatthias Ringwald break; 1683f4b33574SMatthias Ringwald case P_W4_PREPARE_RELIABLE_WRITE_RESULT: 16845cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_PREPARE_RELIABLE_WRITE; 1685f4b33574SMatthias Ringwald break; 1686f4b33574SMatthias Ringwald case P_W4_EXECUTE_PREPARED_WRITE_RESULT: 16875cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_EXECUTE_PREPARED_WRITE; 1688f4b33574SMatthias Ringwald break; 1689f4b33574SMatthias Ringwald case P_W4_CANCEL_PREPARED_WRITE_RESULT: 16905cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_CANCEL_PREPARED_WRITE; 1691f4b33574SMatthias Ringwald break; 1692f4b33574SMatthias Ringwald case P_W4_CANCEL_PREPARED_WRITE_DATA_MISMATCH_RESULT: 16935cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_CANCEL_PREPARED_WRITE_DATA_MISMATCH; 1694f4b33574SMatthias Ringwald break; 1695f4b33574SMatthias Ringwald case P_W4_READ_CHARACTERISTIC_DESCRIPTOR_RESULT: 16965cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_CHARACTERISTIC_DESCRIPTOR_QUERY; 1697f4b33574SMatthias Ringwald break; 1698f4b33574SMatthias Ringwald case P_W4_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_RESULT: 16995cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_QUERY; 1700f4b33574SMatthias Ringwald break; 1701f4b33574SMatthias Ringwald case P_W4_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT: 17025cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_WRITE_CHARACTERISTIC_DESCRIPTOR; 1703f4b33574SMatthias Ringwald break; 1704f4b33574SMatthias Ringwald case P_W4_CLIENT_CHARACTERISTIC_CONFIGURATION_RESULT: 17055cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_WRITE_CLIENT_CHARACTERISTIC_CONFIGURATION; 1706f4b33574SMatthias Ringwald break; 1707f4b33574SMatthias Ringwald case P_W4_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT: 17085cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR; 1709f4b33574SMatthias Ringwald break; 1710f4b33574SMatthias Ringwald case P_W4_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT: 17115cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR; 1712f4b33574SMatthias Ringwald break; 1713f4b33574SMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 1714f4b33574SMatthias Ringwald case P_W4_SEND_SINGED_WRITE_DONE: 17155cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_SIGNED_WRITE; 1716f4b33574SMatthias Ringwald break; 1717f4b33574SMatthias Ringwald #endif 1718f4b33574SMatthias Ringwald default: 17195cf1669fSMatthias Ringwald log_info("retry not supported for state %x", gatt_client->gatt_client_state); 1720f4b33574SMatthias Ringwald retry = 0; 1721f4b33574SMatthias Ringwald break; 1722f4b33574SMatthias Ringwald } 1723f4b33574SMatthias Ringwald 1724f4b33574SMatthias Ringwald if (!retry) { 1725f060f108SMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, error_code); 1726f4b33574SMatthias Ringwald break; 1727f4b33574SMatthias Ringwald } 1728f4b33574SMatthias Ringwald 1729f4b33574SMatthias Ringwald log_info("security error, start pairing"); 1730f4b33574SMatthias Ringwald 1731f060f108SMatthias Ringwald // start pairing for higher security level 17323503dc74SMatthias Ringwald gatt_client->wait_for_authentication_complete = 1; 1733f060f108SMatthias Ringwald gatt_client->pending_error_code = error_code; 17345cf1669fSMatthias Ringwald sm_request_pairing(gatt_client->con_handle); 1735f4b33574SMatthias Ringwald break; 1736a0e0c2beSMatthias Ringwald } 1737f4b33574SMatthias Ringwald #endif 1738f4b33574SMatthias Ringwald 1739f4b33574SMatthias Ringwald // nothing we can do about that 1740f4b33574SMatthias Ringwald case ATT_ERROR_INSUFFICIENT_AUTHORIZATION: 17413deb3ec6SMatthias Ringwald default: 1742f060f108SMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, error_code); 17433deb3ec6SMatthias Ringwald break; 17443deb3ec6SMatthias Ringwald } 17453deb3ec6SMatthias Ringwald break; 17463deb3ec6SMatthias Ringwald 17473deb3ec6SMatthias Ringwald default: 17483deb3ec6SMatthias Ringwald log_info("ATT Handler, unhandled response type 0x%02x", packet[0]); 17493deb3ec6SMatthias Ringwald break; 17503deb3ec6SMatthias Ringwald } 17513deb3ec6SMatthias Ringwald gatt_client_run(); 17523deb3ec6SMatthias Ringwald } 17533deb3ec6SMatthias Ringwald 17547a766ebfSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 17553deb3ec6SMatthias Ringwald static void att_signed_write_handle_cmac_result(uint8_t hash[8]){ 1756665d90f2SMatthias Ringwald btstack_linked_list_iterator_t it; 1757665d90f2SMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client_connections); 1758665d90f2SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 17595cf1669fSMatthias Ringwald gatt_client_t * gatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it); 17605cf1669fSMatthias Ringwald if (gatt_client->gatt_client_state == P_W4_CMAC_RESULT){ 17613deb3ec6SMatthias Ringwald // store result 17625cf1669fSMatthias Ringwald (void)memcpy(gatt_client->cmac, hash, 8); 17635cf1669fSMatthias Ringwald // reverse_64(hash, gatt_client->cmac); 17645cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_SIGNED_WRITE; 17653deb3ec6SMatthias Ringwald gatt_client_run(); 17663deb3ec6SMatthias Ringwald return; 17673deb3ec6SMatthias Ringwald } 17683deb3ec6SMatthias Ringwald } 17693deb3ec6SMatthias Ringwald } 17703deb3ec6SMatthias Ringwald 1771711e6c80SMatthias Ringwald uint8_t gatt_client_signed_write_without_response(btstack_packet_handler_t callback, hci_con_handle_t con_handle, uint16_t handle, uint16_t message_len, uint8_t * message){ 17725cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle(con_handle); 17735cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 17745cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 17753deb3ec6SMatthias Ringwald 17765cf1669fSMatthias Ringwald gatt_client->callback = callback; 17775cf1669fSMatthias Ringwald gatt_client->attribute_handle = handle; 17785cf1669fSMatthias Ringwald gatt_client->attribute_length = message_len; 17795cf1669fSMatthias Ringwald gatt_client->attribute_value = message; 17805cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_IDENTITY_RESOLVING; 17813deb3ec6SMatthias Ringwald gatt_client_run(); 178225b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 17833deb3ec6SMatthias Ringwald } 17847a766ebfSMatthias Ringwald #endif 17853deb3ec6SMatthias Ringwald 1786711e6c80SMatthias Ringwald uint8_t gatt_client_discover_primary_services(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 17875cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 17885cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 17895cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 17903deb3ec6SMatthias Ringwald 17915cf1669fSMatthias Ringwald gatt_client->callback = callback; 17925cf1669fSMatthias Ringwald gatt_client->start_group_handle = 0x0001; 17935cf1669fSMatthias Ringwald gatt_client->end_group_handle = 0xffff; 17945cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_SERVICE_QUERY; 17955cf1669fSMatthias Ringwald gatt_client->uuid16 = 0; 17963deb3ec6SMatthias Ringwald gatt_client_run(); 179725b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 17983deb3ec6SMatthias Ringwald } 17993deb3ec6SMatthias Ringwald 18003deb3ec6SMatthias Ringwald 1801711e6c80SMatthias Ringwald uint8_t gatt_client_discover_primary_services_by_uuid16(btstack_packet_handler_t callback, hci_con_handle_t con_handle, uint16_t uuid16){ 18025cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 18035cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 18045cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 18053deb3ec6SMatthias Ringwald 18065cf1669fSMatthias Ringwald gatt_client->callback = callback; 18075cf1669fSMatthias Ringwald gatt_client->start_group_handle = 0x0001; 18085cf1669fSMatthias Ringwald gatt_client->end_group_handle = 0xffff; 18095cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_SERVICE_WITH_UUID_QUERY; 18105cf1669fSMatthias Ringwald gatt_client->uuid16 = uuid16; 18115cf1669fSMatthias Ringwald uuid_add_bluetooth_prefix((uint8_t*) &(gatt_client->uuid128), gatt_client->uuid16); 18123deb3ec6SMatthias Ringwald gatt_client_run(); 181325b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 18143deb3ec6SMatthias Ringwald } 18153deb3ec6SMatthias Ringwald 1816711e6c80SMatthias 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){ 18175cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 18185cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 18195cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 18203deb3ec6SMatthias Ringwald 18215cf1669fSMatthias Ringwald gatt_client->callback = callback; 18225cf1669fSMatthias Ringwald gatt_client->start_group_handle = 0x0001; 18235cf1669fSMatthias Ringwald gatt_client->end_group_handle = 0xffff; 18245cf1669fSMatthias Ringwald gatt_client->uuid16 = 0; 18255cf1669fSMatthias Ringwald (void)memcpy(gatt_client->uuid128, uuid128, 16); 18265cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_SERVICE_WITH_UUID_QUERY; 18273deb3ec6SMatthias Ringwald gatt_client_run(); 182825b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 18293deb3ec6SMatthias Ringwald } 18303deb3ec6SMatthias Ringwald 1831711e6c80SMatthias 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){ 18325cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 18335cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 18345cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 18353deb3ec6SMatthias Ringwald 18365cf1669fSMatthias Ringwald gatt_client->callback = callback; 18375cf1669fSMatthias Ringwald gatt_client->start_group_handle = service->start_group_handle; 18385cf1669fSMatthias Ringwald gatt_client->end_group_handle = service->end_group_handle; 18395cf1669fSMatthias Ringwald gatt_client->filter_with_uuid = 0; 18405cf1669fSMatthias Ringwald gatt_client->characteristic_start_handle = 0; 18415cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_ALL_CHARACTERISTICS_OF_SERVICE_QUERY; 18423deb3ec6SMatthias Ringwald gatt_client_run(); 184325b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 18443deb3ec6SMatthias Ringwald } 18453deb3ec6SMatthias Ringwald 1846711e6c80SMatthias 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){ 18475cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 18485cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 18495cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 18505cf1669fSMatthias Ringwald gatt_client->callback = callback; 18515cf1669fSMatthias Ringwald gatt_client->start_group_handle = service->start_group_handle; 18525cf1669fSMatthias Ringwald gatt_client->end_group_handle = service->end_group_handle; 18535cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_INCLUDED_SERVICE_QUERY; 18543deb3ec6SMatthias Ringwald 18553deb3ec6SMatthias Ringwald gatt_client_run(); 185625b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 18573deb3ec6SMatthias Ringwald } 18583deb3ec6SMatthias Ringwald 1859711e6c80SMatthias 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){ 18605cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 18615cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 18625cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 18633deb3ec6SMatthias Ringwald 18645cf1669fSMatthias Ringwald gatt_client->callback = callback; 18655cf1669fSMatthias Ringwald gatt_client->start_group_handle = start_handle; 18665cf1669fSMatthias Ringwald gatt_client->end_group_handle = end_handle; 18675cf1669fSMatthias Ringwald gatt_client->filter_with_uuid = 1; 18685cf1669fSMatthias Ringwald gatt_client->uuid16 = uuid16; 18695cf1669fSMatthias Ringwald uuid_add_bluetooth_prefix((uint8_t*) &(gatt_client->uuid128), uuid16); 18705cf1669fSMatthias Ringwald gatt_client->characteristic_start_handle = 0; 18715cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_CHARACTERISTIC_WITH_UUID_QUERY; 18723deb3ec6SMatthias Ringwald gatt_client_run(); 187325b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 18743deb3ec6SMatthias Ringwald } 18753deb3ec6SMatthias Ringwald 1876711e6c80SMatthias Ringwald 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, uint8_t * uuid128){ 18775cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 18785cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 18795cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 18803deb3ec6SMatthias Ringwald 18815cf1669fSMatthias Ringwald gatt_client->callback = callback; 18825cf1669fSMatthias Ringwald gatt_client->start_group_handle = start_handle; 18835cf1669fSMatthias Ringwald gatt_client->end_group_handle = end_handle; 18845cf1669fSMatthias Ringwald gatt_client->filter_with_uuid = 1; 18855cf1669fSMatthias Ringwald gatt_client->uuid16 = 0; 18865cf1669fSMatthias Ringwald (void)memcpy(gatt_client->uuid128, uuid128, 16); 18875cf1669fSMatthias Ringwald gatt_client->characteristic_start_handle = 0; 18885cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_CHARACTERISTIC_WITH_UUID_QUERY; 18893deb3ec6SMatthias Ringwald gatt_client_run(); 189025b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 18913deb3ec6SMatthias Ringwald } 18923deb3ec6SMatthias Ringwald 18933deb3ec6SMatthias Ringwald 1894d25c33e5SMatthias Ringwald uint8_t gatt_client_discover_characteristics_for_service_by_uuid16(btstack_packet_handler_t callback, uint16_t handle, gatt_client_service_t *service, uint16_t uuid16){ 18959c662c9bSMatthias Ringwald return gatt_client_discover_characteristics_for_handle_range_by_uuid16(callback, handle, service->start_group_handle, service->end_group_handle, uuid16); 18963deb3ec6SMatthias Ringwald } 18973deb3ec6SMatthias Ringwald 1898d25c33e5SMatthias Ringwald uint8_t gatt_client_discover_characteristics_for_service_by_uuid128(btstack_packet_handler_t callback, uint16_t handle, gatt_client_service_t *service, uint8_t * uuid128){ 18999c662c9bSMatthias Ringwald return gatt_client_discover_characteristics_for_handle_range_by_uuid128(callback, handle, service->start_group_handle, service->end_group_handle, uuid128); 19003deb3ec6SMatthias Ringwald } 19013deb3ec6SMatthias Ringwald 1902711e6c80SMatthias Ringwald uint8_t gatt_client_discover_characteristic_descriptors(btstack_packet_handler_t callback, hci_con_handle_t con_handle, gatt_client_characteristic_t *characteristic){ 19035cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 19045cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 19055cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 19063deb3ec6SMatthias Ringwald 19073deb3ec6SMatthias Ringwald if (characteristic->value_handle == characteristic->end_handle){ 19085cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_SUCCESS); 190925b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 19103deb3ec6SMatthias Ringwald } 19115cf1669fSMatthias Ringwald gatt_client->callback = callback; 19125cf1669fSMatthias Ringwald gatt_client->start_group_handle = characteristic->value_handle + 1u; 19135cf1669fSMatthias Ringwald gatt_client->end_group_handle = characteristic->end_handle; 19145cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY; 19153deb3ec6SMatthias Ringwald gatt_client_run(); 191625b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 19173deb3ec6SMatthias Ringwald } 19183deb3ec6SMatthias Ringwald 1919711e6c80SMatthias 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){ 19205cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 19215cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 19225cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 19233deb3ec6SMatthias Ringwald 19245cf1669fSMatthias Ringwald gatt_client->callback = callback; 19255cf1669fSMatthias Ringwald gatt_client->attribute_handle = value_handle; 19265cf1669fSMatthias Ringwald gatt_client->attribute_offset = 0; 19275cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_CHARACTERISTIC_VALUE_QUERY; 19283deb3ec6SMatthias Ringwald gatt_client_run(); 192925b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 19303deb3ec6SMatthias Ringwald } 19313deb3ec6SMatthias Ringwald 1932711e6c80SMatthias 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){ 19335cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 19345cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 19355cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 19363deb3ec6SMatthias Ringwald 19375cf1669fSMatthias Ringwald gatt_client->callback = callback; 19385cf1669fSMatthias Ringwald gatt_client->start_group_handle = start_handle; 19395cf1669fSMatthias Ringwald gatt_client->end_group_handle = end_handle; 19405cf1669fSMatthias Ringwald gatt_client->query_start_handle = start_handle; 19415cf1669fSMatthias Ringwald gatt_client->query_end_handle = end_handle; 19425cf1669fSMatthias Ringwald gatt_client->uuid16 = uuid16; 19435cf1669fSMatthias Ringwald uuid_add_bluetooth_prefix((uint8_t*) &(gatt_client->uuid128), uuid16); 19445cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_BY_TYPE_REQUEST; 19453deb3ec6SMatthias Ringwald gatt_client_run(); 194625b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 19473deb3ec6SMatthias Ringwald } 19483deb3ec6SMatthias Ringwald 1949711e6c80SMatthias Ringwald 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, uint8_t * uuid128){ 19505cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 19515cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 19525cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 19533deb3ec6SMatthias Ringwald 19545cf1669fSMatthias Ringwald gatt_client->callback = callback; 19555cf1669fSMatthias Ringwald gatt_client->start_group_handle = start_handle; 19565cf1669fSMatthias Ringwald gatt_client->end_group_handle = end_handle; 19575cf1669fSMatthias Ringwald gatt_client->query_start_handle = start_handle; 19585cf1669fSMatthias Ringwald gatt_client->query_end_handle = end_handle; 19595cf1669fSMatthias Ringwald gatt_client->uuid16 = 0; 19605cf1669fSMatthias Ringwald (void)memcpy(gatt_client->uuid128, uuid128, 16); 19615cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_BY_TYPE_REQUEST; 19623deb3ec6SMatthias Ringwald gatt_client_run(); 196325b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 19643deb3ec6SMatthias Ringwald } 19653deb3ec6SMatthias Ringwald 19663deb3ec6SMatthias Ringwald 1967d25c33e5SMatthias Ringwald uint8_t gatt_client_read_value_of_characteristic(btstack_packet_handler_t callback, uint16_t handle, gatt_client_characteristic_t *characteristic){ 19689c662c9bSMatthias Ringwald return gatt_client_read_value_of_characteristic_using_value_handle(callback, handle, characteristic->value_handle); 19693deb3ec6SMatthias Ringwald } 19703deb3ec6SMatthias Ringwald 1971711e6c80SMatthias 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 characteristic_value_handle, uint16_t offset){ 19725cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 19735cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 19745cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 19753deb3ec6SMatthias Ringwald 19765cf1669fSMatthias Ringwald gatt_client->callback = callback; 19775cf1669fSMatthias Ringwald gatt_client->attribute_handle = characteristic_value_handle; 19785cf1669fSMatthias Ringwald gatt_client->attribute_offset = offset; 19795cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_BLOB_QUERY; 19803deb3ec6SMatthias Ringwald gatt_client_run(); 198125b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 19823deb3ec6SMatthias Ringwald } 19833deb3ec6SMatthias Ringwald 1984711e6c80SMatthias 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 characteristic_value_handle){ 19859c662c9bSMatthias Ringwald return gatt_client_read_long_value_of_characteristic_using_value_handle_with_offset(callback, con_handle, characteristic_value_handle, 0); 19863deb3ec6SMatthias Ringwald } 19873deb3ec6SMatthias Ringwald 1988d25c33e5SMatthias Ringwald uint8_t gatt_client_read_long_value_of_characteristic(btstack_packet_handler_t callback, uint16_t handle, gatt_client_characteristic_t *characteristic){ 19899c662c9bSMatthias Ringwald return gatt_client_read_long_value_of_characteristic_using_value_handle(callback, handle, characteristic->value_handle); 19903deb3ec6SMatthias Ringwald } 19913deb3ec6SMatthias Ringwald 1992711e6c80SMatthias 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){ 19935cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 19945cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 19955cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 19963deb3ec6SMatthias Ringwald 19975cf1669fSMatthias Ringwald gatt_client->callback = callback; 19985cf1669fSMatthias Ringwald gatt_client->read_multiple_handle_count = num_value_handles; 19995cf1669fSMatthias Ringwald gatt_client->read_multiple_handles = value_handles; 20005cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_MULTIPLE_REQUEST; 20013deb3ec6SMatthias Ringwald gatt_client_run(); 200225b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 20033deb3ec6SMatthias Ringwald } 20043deb3ec6SMatthias Ringwald 2005de9f8e94SMatthias 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){ 20065cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle(con_handle); 20075cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 20083deb3ec6SMatthias Ringwald 2009dda77937SMatthias Ringwald if (value_length > (gatt_client->mtu - 3u)) return GATT_CLIENT_VALUE_TOO_LONG; 20105cf1669fSMatthias Ringwald if (!att_dispatch_client_can_send_now(gatt_client->con_handle)) return GATT_CLIENT_BUSY; 20113deb3ec6SMatthias Ringwald 20125cf1669fSMatthias Ringwald return att_write_request(ATT_WRITE_COMMAND, gatt_client->con_handle, value_handle, value_length, value); 20133deb3ec6SMatthias Ringwald } 20143deb3ec6SMatthias Ringwald 2015711e6c80SMatthias 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 * data){ 20165cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 20175cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 20185cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 20193deb3ec6SMatthias Ringwald 20205cf1669fSMatthias Ringwald gatt_client->callback = callback; 20215cf1669fSMatthias Ringwald gatt_client->attribute_handle = value_handle; 20225cf1669fSMatthias Ringwald gatt_client->attribute_length = value_length; 20235cf1669fSMatthias Ringwald gatt_client->attribute_value = data; 20245cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_WRITE_CHARACTERISTIC_VALUE; 20253deb3ec6SMatthias Ringwald gatt_client_run(); 202625b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 20273deb3ec6SMatthias Ringwald } 20283deb3ec6SMatthias Ringwald 2029711e6c80SMatthias 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 * data){ 20305cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 20315cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 20325cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 20333deb3ec6SMatthias Ringwald 20345cf1669fSMatthias Ringwald gatt_client->callback = callback; 20355cf1669fSMatthias Ringwald gatt_client->attribute_handle = value_handle; 20365cf1669fSMatthias Ringwald gatt_client->attribute_length = value_length; 20375cf1669fSMatthias Ringwald gatt_client->attribute_offset = offset; 20385cf1669fSMatthias Ringwald gatt_client->attribute_value = data; 20395cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_PREPARE_WRITE; 20403deb3ec6SMatthias Ringwald gatt_client_run(); 204125b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 20423deb3ec6SMatthias Ringwald } 20433deb3ec6SMatthias Ringwald 2044711e6c80SMatthias 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){ 20459c662c9bSMatthias Ringwald return gatt_client_write_long_value_of_characteristic_with_offset(callback, con_handle, value_handle, 0, value_length, value); 20463deb3ec6SMatthias Ringwald } 20473deb3ec6SMatthias Ringwald 2048711e6c80SMatthias 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){ 20495cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 20505cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 20515cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 20523deb3ec6SMatthias Ringwald 20535cf1669fSMatthias Ringwald gatt_client->callback = callback; 20545cf1669fSMatthias Ringwald gatt_client->attribute_handle = value_handle; 20555cf1669fSMatthias Ringwald gatt_client->attribute_length = value_length; 20565cf1669fSMatthias Ringwald gatt_client->attribute_offset = 0; 20575cf1669fSMatthias Ringwald gatt_client->attribute_value = value; 20585cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_PREPARE_RELIABLE_WRITE; 20593deb3ec6SMatthias Ringwald gatt_client_run(); 206025b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 20613deb3ec6SMatthias Ringwald } 20623deb3ec6SMatthias Ringwald 2063711e6c80SMatthias 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){ 20645cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 20655cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 20665cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 20673deb3ec6SMatthias Ringwald 20683deb3ec6SMatthias Ringwald if ( (configuration & GATT_CLIENT_CHARACTERISTICS_CONFIGURATION_NOTIFICATION) && 20694ea43905SMatthias Ringwald ((characteristic->properties & ATT_PROPERTY_NOTIFY) == 0u)) { 2070d8e8f12aSMatthias Ringwald log_info("gatt_client_write_client_characteristic_configuration: GATT_CLIENT_CHARACTERISTIC_NOTIFICATION_NOT_SUPPORTED"); 2071616edd56SMatthias Ringwald return GATT_CLIENT_CHARACTERISTIC_NOTIFICATION_NOT_SUPPORTED; 20723deb3ec6SMatthias Ringwald } else if ( (configuration & GATT_CLIENT_CHARACTERISTICS_CONFIGURATION_INDICATION) && 20734ea43905SMatthias Ringwald ((characteristic->properties & ATT_PROPERTY_INDICATE) == 0u)){ 2074d8e8f12aSMatthias Ringwald log_info("gatt_client_write_client_characteristic_configuration: GATT_CLIENT_CHARACTERISTIC_INDICATION_NOT_SUPPORTED"); 2075616edd56SMatthias Ringwald return GATT_CLIENT_CHARACTERISTIC_INDICATION_NOT_SUPPORTED; 20763deb3ec6SMatthias Ringwald } 20773deb3ec6SMatthias Ringwald 20785cf1669fSMatthias Ringwald gatt_client->callback = callback; 20795cf1669fSMatthias Ringwald gatt_client->start_group_handle = characteristic->value_handle; 20805cf1669fSMatthias Ringwald gatt_client->end_group_handle = characteristic->end_handle; 20815cf1669fSMatthias Ringwald little_endian_store_16(gatt_client->client_characteristic_configuration_value, 0, configuration); 20823deb3ec6SMatthias Ringwald 2083abdc9fb5SMatthias Ringwald #ifdef ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY 20845cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_FIND_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY; 2085abdc9fb5SMatthias Ringwald #else 20865cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY; 2087abdc9fb5SMatthias Ringwald #endif 20883deb3ec6SMatthias Ringwald gatt_client_run(); 20899cb80b17SMilanka Ringwald return ERROR_CODE_SUCCESS; 20903deb3ec6SMatthias Ringwald } 20913deb3ec6SMatthias Ringwald 2092711e6c80SMatthias 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){ 20935cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 20945cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 20955cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 20963deb3ec6SMatthias Ringwald 20975cf1669fSMatthias Ringwald gatt_client->callback = callback; 20985cf1669fSMatthias Ringwald gatt_client->attribute_handle = descriptor_handle; 20993deb3ec6SMatthias Ringwald 21005cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_CHARACTERISTIC_DESCRIPTOR_QUERY; 21013deb3ec6SMatthias Ringwald gatt_client_run(); 210225b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 21033deb3ec6SMatthias Ringwald } 21043deb3ec6SMatthias Ringwald 2105711e6c80SMatthias 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){ 21069c662c9bSMatthias Ringwald return gatt_client_read_characteristic_descriptor_using_descriptor_handle(callback, con_handle, descriptor->handle); 21073deb3ec6SMatthias Ringwald } 21083deb3ec6SMatthias Ringwald 2109711e6c80SMatthias 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){ 21105cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 21115cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 21125cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 21133deb3ec6SMatthias Ringwald 21145cf1669fSMatthias Ringwald gatt_client->callback = callback; 21155cf1669fSMatthias Ringwald gatt_client->attribute_handle = descriptor_handle; 21165cf1669fSMatthias Ringwald gatt_client->attribute_offset = offset; 21175cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_QUERY; 21183deb3ec6SMatthias Ringwald gatt_client_run(); 211925b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 21203deb3ec6SMatthias Ringwald } 21213deb3ec6SMatthias Ringwald 2122711e6c80SMatthias 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){ 21239c662c9bSMatthias Ringwald return gatt_client_read_long_characteristic_descriptor_using_descriptor_handle_with_offset(callback, con_handle, descriptor_handle, 0); 21243deb3ec6SMatthias Ringwald } 21253deb3ec6SMatthias Ringwald 2126711e6c80SMatthias 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){ 21279c662c9bSMatthias Ringwald return gatt_client_read_long_characteristic_descriptor_using_descriptor_handle(callback, con_handle, descriptor->handle); 21283deb3ec6SMatthias Ringwald } 21293deb3ec6SMatthias Ringwald 2130711e6c80SMatthias 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 length, uint8_t * data){ 21315cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 21325cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 21335cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 21343deb3ec6SMatthias Ringwald 21355cf1669fSMatthias Ringwald gatt_client->callback = callback; 21365cf1669fSMatthias Ringwald gatt_client->attribute_handle = descriptor_handle; 21375cf1669fSMatthias Ringwald gatt_client->attribute_length = length; 21385cf1669fSMatthias Ringwald gatt_client->attribute_offset = 0; 21395cf1669fSMatthias Ringwald gatt_client->attribute_value = data; 21405cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_WRITE_CHARACTERISTIC_DESCRIPTOR; 21413deb3ec6SMatthias Ringwald gatt_client_run(); 214225b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 21433deb3ec6SMatthias Ringwald } 21443deb3ec6SMatthias Ringwald 2145711e6c80SMatthias 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 length, uint8_t * value){ 21469c662c9bSMatthias Ringwald return gatt_client_write_characteristic_descriptor_using_descriptor_handle(callback, con_handle, descriptor->handle, length, value); 21473deb3ec6SMatthias Ringwald } 21483deb3ec6SMatthias Ringwald 2149711e6c80SMatthias 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 length, uint8_t * data){ 21505cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 21515cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 21525cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 21533deb3ec6SMatthias Ringwald 21545cf1669fSMatthias Ringwald gatt_client->callback = callback; 21555cf1669fSMatthias Ringwald gatt_client->attribute_handle = descriptor_handle; 21565cf1669fSMatthias Ringwald gatt_client->attribute_length = length; 21575cf1669fSMatthias Ringwald gatt_client->attribute_offset = offset; 21585cf1669fSMatthias Ringwald gatt_client->attribute_value = data; 21595cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR; 21603deb3ec6SMatthias Ringwald gatt_client_run(); 216125b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 21623deb3ec6SMatthias Ringwald } 21633deb3ec6SMatthias Ringwald 2164711e6c80SMatthias 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 length, uint8_t * data){ 21659c662c9bSMatthias Ringwald return gatt_client_write_long_characteristic_descriptor_using_descriptor_handle_with_offset(callback, con_handle, descriptor_handle, 0, length, data ); 21663deb3ec6SMatthias Ringwald } 21673deb3ec6SMatthias Ringwald 2168711e6c80SMatthias 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 length, uint8_t * value){ 21699c662c9bSMatthias Ringwald return gatt_client_write_long_characteristic_descriptor_using_descriptor_handle(callback, con_handle, descriptor->handle, length, value); 21703deb3ec6SMatthias Ringwald } 21713deb3ec6SMatthias Ringwald 21723deb3ec6SMatthias Ringwald /** 21733deb3ec6SMatthias Ringwald * @brief -> gatt complete event 21743deb3ec6SMatthias Ringwald */ 2175711e6c80SMatthias 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 length, uint8_t * data){ 21765cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 21775cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 21785cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 21793deb3ec6SMatthias Ringwald 21805cf1669fSMatthias Ringwald gatt_client->callback = callback; 21815cf1669fSMatthias Ringwald gatt_client->attribute_handle = attribute_handle; 21825cf1669fSMatthias Ringwald gatt_client->attribute_length = length; 21835cf1669fSMatthias Ringwald gatt_client->attribute_offset = offset; 21845cf1669fSMatthias Ringwald gatt_client->attribute_value = data; 21855cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_PREPARE_WRITE_SINGLE; 21863deb3ec6SMatthias Ringwald gatt_client_run(); 218725b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 21883deb3ec6SMatthias Ringwald } 21893deb3ec6SMatthias Ringwald 21903deb3ec6SMatthias Ringwald /** 21913deb3ec6SMatthias Ringwald * @brief -> gatt complete event 21923deb3ec6SMatthias Ringwald */ 2193711e6c80SMatthias Ringwald uint8_t gatt_client_execute_write(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 21945cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 21953deb3ec6SMatthias Ringwald 21965cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 21975cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 21983deb3ec6SMatthias Ringwald 21995cf1669fSMatthias Ringwald gatt_client->callback = callback; 22005cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_EXECUTE_PREPARED_WRITE; 22013deb3ec6SMatthias Ringwald gatt_client_run(); 220225b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 22033deb3ec6SMatthias Ringwald } 22043deb3ec6SMatthias Ringwald 22053deb3ec6SMatthias Ringwald /** 22063deb3ec6SMatthias Ringwald * @brief -> gatt complete event 22073deb3ec6SMatthias Ringwald */ 2208711e6c80SMatthias Ringwald uint8_t gatt_client_cancel_write(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 22095cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 22105cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 22115cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 22123deb3ec6SMatthias Ringwald 22135cf1669fSMatthias Ringwald gatt_client->callback = callback; 22145cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_CANCEL_PREPARED_WRITE; 22153deb3ec6SMatthias Ringwald gatt_client_run(); 22167d2258b3SMilanka Ringwald return ERROR_CODE_SUCCESS; 22173deb3ec6SMatthias Ringwald } 22183deb3ec6SMatthias Ringwald 2219313e337bSMatthias Ringwald void gatt_client_deserialize_service(const uint8_t *packet, int offset, gatt_client_service_t *service){ 22206ba2ad22SMatthias Ringwald service->start_group_handle = little_endian_read_16(packet, offset); 22216ba2ad22SMatthias Ringwald service->end_group_handle = little_endian_read_16(packet, offset + 2); 22226ba2ad22SMatthias Ringwald reverse_128(&packet[offset + 4], service->uuid128); 22236ba2ad22SMatthias Ringwald if (uuid_has_bluetooth_prefix(service->uuid128)){ 22246ba2ad22SMatthias Ringwald service->uuid16 = big_endian_read_32(service->uuid128, 0); 2225c839c6f9SMatthias Ringwald } else { 2226c839c6f9SMatthias Ringwald service->uuid16 = 0; 22276ba2ad22SMatthias Ringwald } 22286ba2ad22SMatthias Ringwald } 22296ba2ad22SMatthias Ringwald 2230313e337bSMatthias Ringwald void gatt_client_deserialize_characteristic(const uint8_t * packet, int offset, gatt_client_characteristic_t * characteristic){ 22316ba2ad22SMatthias Ringwald characteristic->start_handle = little_endian_read_16(packet, offset); 22326ba2ad22SMatthias Ringwald characteristic->value_handle = little_endian_read_16(packet, offset + 2); 22336ba2ad22SMatthias Ringwald characteristic->end_handle = little_endian_read_16(packet, offset + 4); 22346ba2ad22SMatthias Ringwald characteristic->properties = little_endian_read_16(packet, offset + 6); 223586c38559SMatthias Ringwald reverse_128(&packet[offset+8], characteristic->uuid128); 22366ba2ad22SMatthias Ringwald if (uuid_has_bluetooth_prefix(characteristic->uuid128)){ 22376ba2ad22SMatthias Ringwald characteristic->uuid16 = big_endian_read_32(characteristic->uuid128, 0); 2238c839c6f9SMatthias Ringwald } else { 2239c839c6f9SMatthias Ringwald characteristic->uuid16 = 0; 22406ba2ad22SMatthias Ringwald } 22416ba2ad22SMatthias Ringwald } 22426ba2ad22SMatthias Ringwald 2243313e337bSMatthias Ringwald void gatt_client_deserialize_characteristic_descriptor(const uint8_t * packet, int offset, gatt_client_characteristic_descriptor_t * descriptor){ 22446ba2ad22SMatthias Ringwald descriptor->handle = little_endian_read_16(packet, offset); 22456ba2ad22SMatthias Ringwald reverse_128(&packet[offset+2], descriptor->uuid128); 2246b4895529SJakob Krantz if (uuid_has_bluetooth_prefix(descriptor->uuid128)){ 2247b4895529SJakob Krantz descriptor->uuid16 = big_endian_read_32(descriptor->uuid128, 0); 2248c839c6f9SMatthias Ringwald } else { 2249c839c6f9SMatthias Ringwald descriptor->uuid16 = 0; 2250b4895529SJakob Krantz } 22516ba2ad22SMatthias Ringwald } 22525cf6c434SJakob Krantz 22535cf6c434SJakob Krantz void gatt_client_send_mtu_negotiation(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 22545cf1669fSMatthias Ringwald gatt_client_t * context = gatt_client_provide_context_for_handle(con_handle); 22557d2258b3SMilanka Ringwald if (context == NULL) return; 22565cf6c434SJakob Krantz if (context->mtu_state == MTU_AUTO_EXCHANGE_DISABLED){ 22575cf6c434SJakob Krantz context->callback = callback; 22585cf6c434SJakob Krantz context->mtu_state = SEND_MTU_EXCHANGE; 22595cf6c434SJakob Krantz gatt_client_run(); 22605cf6c434SJakob Krantz } 22615cf6c434SJakob Krantz } 226247181045SMatthias Ringwald 226347181045SMatthias Ringwald uint8_t gatt_client_request_can_write_without_response_event(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 22645cf1669fSMatthias Ringwald gatt_client_t * context = gatt_client_provide_context_for_handle(con_handle); 22657d2258b3SMilanka Ringwald if (context == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 22667d2258b3SMilanka Ringwald if (context->write_without_response_callback != NULL) return GATT_CLIENT_IN_WRONG_STATE; 226747181045SMatthias Ringwald context->write_without_response_callback = callback; 226847181045SMatthias Ringwald att_dispatch_client_request_can_send_now_event(context->con_handle); 22697d2258b3SMilanka Ringwald return ERROR_CODE_SUCCESS; 227047181045SMatthias Ringwald } 2271a6121b51SMilanka Ringwald 2272a6121b51SMilanka Ringwald #ifdef FUZZING_BUILD_MODE_UNSAFE_FOR_PRODUCTION 2273a6121b51SMilanka Ringwald void gatt_client_att_packet_handler_fuzz(uint8_t packet_type, uint16_t handle, uint8_t *packet, uint16_t size){ 2274a6121b51SMilanka Ringwald gatt_client_att_packet_handler(packet_type, handle, packet, size); 2275a6121b51SMilanka Ringwald } 2276a6121b51SMilanka Ringwald #endif 2277