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 889fd14b205SMatthias Ringwald bool client_request_pending = gatt_client->gatt_client_state != P_READY; 890fd14b205SMatthias 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; 1230fd14b205SMatthias Ringwald gatt_client->wait_for_authentication_complete = 0; 1231fd14b205SMatthias Ringwald 1232cf31ef9bSMatthias Ringwald if (gatt_client->gatt_client_state == P_READY) break; 1233fd14b205SMatthias Ringwald 1234fd14b205SMatthias Ringwald switch (sm_event_reencryption_complete_get_status(packet)){ 1235fd14b205SMatthias Ringwald case ERROR_CODE_SUCCESS: 1236fd14b205SMatthias Ringwald log_info("re-encryption success, retry operation"); 1237fd14b205SMatthias Ringwald break; 1238fd14b205SMatthias Ringwald case ERROR_CODE_AUTHENTICATION_FAILURE: 1239fd14b205SMatthias Ringwald case ERROR_CODE_PIN_OR_KEY_MISSING: 1240cf31ef9bSMatthias Ringwald #if defined(ENABLE_GATT_CLIENT_PAIRING) && !defined(ENABLE_LE_PROACTIVE_AUTHENTICATION) 1241fd14b205SMatthias Ringwald if (gatt_client_required_security_level == LEVEL_0) { 1242cf31ef9bSMatthias Ringwald // re-encryption failed for reactive authentication with pairing and we have a pending client request 1243fd14b205SMatthias Ringwald // => try to resolve it by deleting bonding information if we started pairing before 1244fd14b205SMatthias Ringwald // delete bonding information 1245fd14b205SMatthias Ringwald int le_device_db_index = sm_le_device_index(gatt_client->con_handle); 1246fd14b205SMatthias Ringwald btstack_assert(le_device_db_index >= 0); 1247fd14b205SMatthias Ringwald log_info("reactive auth with pairing: delete bonding and start pairing"); 1248fd14b205SMatthias Ringwald #ifdef ENABLE_LE_PRIVACY_ADDRESS_RESOLUTION 1249fd14b205SMatthias Ringwald hci_remove_le_device_db_entry_from_resolving_list((uint16_t) le_device_db_index); 1250fd14b205SMatthias Ringwald #endif 1251fd14b205SMatthias Ringwald le_device_db_remove(le_device_db_index); 1252fd14b205SMatthias Ringwald // trigger pairing again 1253fd14b205SMatthias Ringwald sm_request_pairing(gatt_client->con_handle); 1254fd14b205SMatthias Ringwald break; 1255fd14b205SMatthias Ringwald } 1256fd14b205SMatthias Ringwald #endif 1257fd14b205SMatthias Ringwald // report bonding information missing 1258fd14b205SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 1259fd14b205SMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_BONDING_INFORMATION_MISSING); 1260fd14b205SMatthias Ringwald break; 1261fd14b205SMatthias Ringwald default: 1262fd14b205SMatthias Ringwald // report bonding information missing 1263fd14b205SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 1264fd14b205SMatthias Ringwald emit_gatt_complete_event(gatt_client, gatt_client->pending_error_code); 1265fd14b205SMatthias Ringwald break; 1266fd14b205SMatthias Ringwald } 1267ec9babacSMatthias Ringwald break; 12683deb3ec6SMatthias Ringwald default: 12693deb3ec6SMatthias Ringwald break; 12703deb3ec6SMatthias Ringwald } 12713deb3ec6SMatthias Ringwald 1272361b1363SMatthias Ringwald gatt_client_run(); 12733deb3ec6SMatthias Ringwald } 12743deb3ec6SMatthias Ringwald 12753deb3ec6SMatthias Ringwald static void gatt_client_att_packet_handler(uint8_t packet_type, uint16_t handle, uint8_t *packet, uint16_t size){ 12765cf1669fSMatthias Ringwald gatt_client_t * gatt_client; 12774ea43905SMatthias Ringwald if (size < 1u) return; 12780fbf59a1SMatthias Ringwald 12790fbf59a1SMatthias Ringwald if (packet_type == HCI_EVENT_PACKET) { 12800fbf59a1SMatthias Ringwald switch (packet[0]){ 12810fbf59a1SMatthias Ringwald case L2CAP_EVENT_CAN_SEND_NOW: 128251764b3bSMatthias Ringwald gatt_client_run(); 12830fbf59a1SMatthias Ringwald break; 12840fbf59a1SMatthias Ringwald // att_server has negotiated the mtu for this connection, cache if context exists 12850fbf59a1SMatthias Ringwald case ATT_EVENT_MTU_EXCHANGE_COMPLETE: 12864ea43905SMatthias Ringwald if (size < 6u) break; 12875cf1669fSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(handle); 12885cf1669fSMatthias Ringwald if (gatt_client == NULL) break; 12895cf1669fSMatthias Ringwald gatt_client->mtu = little_endian_read_16(packet, 4); 12900fbf59a1SMatthias Ringwald break; 12910fbf59a1SMatthias Ringwald default: 12920fbf59a1SMatthias Ringwald break; 12930fbf59a1SMatthias Ringwald } 12940fbf59a1SMatthias Ringwald return; 129551764b3bSMatthias Ringwald } 129651764b3bSMatthias Ringwald 12973deb3ec6SMatthias Ringwald if (packet_type != ATT_DATA_PACKET) return; 12983deb3ec6SMatthias Ringwald 12993deb3ec6SMatthias Ringwald // special cases: notifications don't need a context while indications motivate creating one 13003deb3ec6SMatthias Ringwald switch (packet[0]){ 13013deb3ec6SMatthias Ringwald case ATT_HANDLE_VALUE_NOTIFICATION: 13024ea43905SMatthias Ringwald if (size < 3u) return; 13034ea43905SMatthias Ringwald report_gatt_notification(handle, little_endian_read_16(packet,1u), &packet[3], size-3u); 13043deb3ec6SMatthias Ringwald return; 13053deb3ec6SMatthias Ringwald case ATT_HANDLE_VALUE_INDICATION: 13065cf1669fSMatthias Ringwald gatt_client = gatt_client_provide_context_for_handle(handle); 13073deb3ec6SMatthias Ringwald break; 13083deb3ec6SMatthias Ringwald default: 13095cf1669fSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(handle); 13103deb3ec6SMatthias Ringwald break; 13113deb3ec6SMatthias Ringwald } 13123deb3ec6SMatthias Ringwald 13135cf1669fSMatthias Ringwald if (gatt_client == NULL) return; 13143deb3ec6SMatthias Ringwald 1315f060f108SMatthias Ringwald uint8_t error_code; 13163deb3ec6SMatthias Ringwald switch (packet[0]){ 13173deb3ec6SMatthias Ringwald case ATT_EXCHANGE_MTU_RESPONSE: 13183deb3ec6SMatthias Ringwald { 13194ea43905SMatthias Ringwald if (size < 3u) break; 1320f8fbdce0SMatthias Ringwald uint16_t remote_rx_mtu = little_endian_read_16(packet, 1); 13213deb3ec6SMatthias Ringwald uint16_t local_rx_mtu = l2cap_max_le_mtu(); 1322*dde9ff1eSMatthias Ringwald uint16_t mtu = (remote_rx_mtu < local_rx_mtu) ? remote_rx_mtu : local_rx_mtu; 1323*dde9ff1eSMatthias Ringwald 1324*dde9ff1eSMatthias Ringwald // set gatt client mtu 1325*dde9ff1eSMatthias Ringwald gatt_client->mtu = mtu; 13265cf1669fSMatthias Ringwald gatt_client->mtu_state = MTU_EXCHANGED; 1327*dde9ff1eSMatthias Ringwald 1328*dde9ff1eSMatthias Ringwald // set per connection mtu state 1329*dde9ff1eSMatthias Ringwald hci_connection_t * hci_connection = hci_connection_for_handle(handle); 1330*dde9ff1eSMatthias Ringwald hci_connection->att_connection.mtu = gatt_client->mtu; 1331*dde9ff1eSMatthias Ringwald hci_connection->att_connection.mtu_exchanged = true; 1332*dde9ff1eSMatthias Ringwald 13335cf1669fSMatthias Ringwald emit_gatt_mtu_exchanged_result_event(gatt_client, gatt_client->mtu); 13343deb3ec6SMatthias Ringwald break; 13353deb3ec6SMatthias Ringwald } 13363deb3ec6SMatthias Ringwald case ATT_READ_BY_GROUP_TYPE_RESPONSE: 13375cf1669fSMatthias Ringwald switch(gatt_client->gatt_client_state){ 13383deb3ec6SMatthias Ringwald case P_W4_SERVICE_QUERY_RESULT: 13395cf1669fSMatthias Ringwald report_gatt_services(gatt_client, packet, size); 13405cf1669fSMatthias Ringwald trigger_next_service_query(gatt_client, get_last_result_handle_from_service_list(packet, size)); 13415611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 13423deb3ec6SMatthias Ringwald break; 13433deb3ec6SMatthias Ringwald default: 13443deb3ec6SMatthias Ringwald break; 13453deb3ec6SMatthias Ringwald } 13463deb3ec6SMatthias Ringwald break; 13473deb3ec6SMatthias Ringwald case ATT_HANDLE_VALUE_INDICATION: 13484ea43905SMatthias Ringwald if (size < 3u) break; 13494ea43905SMatthias Ringwald report_gatt_indication(handle, little_endian_read_16(packet,1u), &packet[3], size-3u); 13505cf1669fSMatthias Ringwald gatt_client->send_confirmation = 1; 13513deb3ec6SMatthias Ringwald break; 13523deb3ec6SMatthias Ringwald 13533deb3ec6SMatthias Ringwald case ATT_READ_BY_TYPE_RESPONSE: 13545cf1669fSMatthias Ringwald switch (gatt_client->gatt_client_state){ 13553deb3ec6SMatthias Ringwald case P_W4_ALL_CHARACTERISTICS_OF_SERVICE_QUERY_RESULT: 13565cf1669fSMatthias Ringwald report_gatt_characteristics(gatt_client, packet, size); 13575cf1669fSMatthias Ringwald trigger_next_characteristic_query(gatt_client, get_last_result_handle_from_characteristics_list(packet, size)); 13585611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done, or by ATT_ERROR 13593deb3ec6SMatthias Ringwald break; 13603deb3ec6SMatthias Ringwald case P_W4_CHARACTERISTIC_WITH_UUID_QUERY_RESULT: 13615cf1669fSMatthias Ringwald report_gatt_characteristics(gatt_client, packet, size); 13625cf1669fSMatthias Ringwald trigger_next_characteristic_query(gatt_client, get_last_result_handle_from_characteristics_list(packet, size)); 13635611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done, or by ATT_ERROR 13643deb3ec6SMatthias Ringwald break; 13653deb3ec6SMatthias Ringwald case P_W4_INCLUDED_SERVICE_QUERY_RESULT: 13663deb3ec6SMatthias Ringwald { 13674ea43905SMatthias Ringwald if (size < 2u) break; 13683deb3ec6SMatthias Ringwald uint16_t uuid16 = 0; 13693deb3ec6SMatthias Ringwald uint16_t pair_size = packet[1]; 13703deb3ec6SMatthias Ringwald 13714ea43905SMatthias Ringwald if (pair_size == 6u){ 13724ea43905SMatthias Ringwald if (size < 8u) break; 13733deb3ec6SMatthias Ringwald // UUIDs not available, query first included service 13745cf1669fSMatthias Ringwald gatt_client->start_group_handle = little_endian_read_16(packet, 2); // ready for next query 13755cf1669fSMatthias Ringwald gatt_client->query_start_handle = little_endian_read_16(packet, 4); 13765cf1669fSMatthias Ringwald gatt_client->query_end_handle = little_endian_read_16(packet, 6); 13775cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_INCLUDED_SERVICE_WITH_UUID_QUERY; 13783deb3ec6SMatthias Ringwald break; 13793deb3ec6SMatthias Ringwald } 13803deb3ec6SMatthias Ringwald 13814ea43905SMatthias Ringwald if (pair_size != 8u) break; 13829f698c82SMatthias Ringwald 13839f698c82SMatthias Ringwald // UUIDs included, report all of them 13843deb3ec6SMatthias Ringwald uint16_t offset; 13854ea43905SMatthias Ringwald for (offset = 2u; (offset + 8u) <= size; offset += pair_size){ 1386f8fbdce0SMatthias Ringwald uint16_t include_handle = little_endian_read_16(packet, offset); 13875cf1669fSMatthias Ringwald gatt_client->query_start_handle = little_endian_read_16(packet, offset + 2u); 13885cf1669fSMatthias Ringwald gatt_client->query_end_handle = little_endian_read_16(packet, offset + 4u); 13894ea43905SMatthias Ringwald uuid16 = little_endian_read_16(packet, offset+6u); 13905cf1669fSMatthias Ringwald report_gatt_included_service_uuid16(gatt_client, include_handle, uuid16); 13913deb3ec6SMatthias Ringwald } 13923deb3ec6SMatthias Ringwald 13935cf1669fSMatthias Ringwald trigger_next_included_service_query(gatt_client, get_last_result_handle_from_included_services_list(packet, size)); 13945611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 13953deb3ec6SMatthias Ringwald break; 13963deb3ec6SMatthias Ringwald } 1397abdc9fb5SMatthias Ringwald #ifndef ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY 13983deb3ec6SMatthias Ringwald case P_W4_READ_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY_RESULT: 13995cf1669fSMatthias Ringwald gatt_client->client_characteristic_configuration_handle = little_endian_read_16(packet, 2); 14005cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_WRITE_CLIENT_CHARACTERISTIC_CONFIGURATION; 14013deb3ec6SMatthias Ringwald break; 1402abdc9fb5SMatthias Ringwald #endif 14033deb3ec6SMatthias Ringwald case P_W4_READ_BY_TYPE_RESPONSE: { 14043deb3ec6SMatthias Ringwald uint16_t pair_size = packet[1]; 14053deb3ec6SMatthias Ringwald uint16_t offset; 14063deb3ec6SMatthias Ringwald uint16_t last_result_handle = 0; 14073deb3ec6SMatthias Ringwald for (offset = 2; offset < size ; offset += pair_size){ 1408f8fbdce0SMatthias Ringwald uint16_t value_handle = little_endian_read_16(packet, offset); 14095cf1669fSMatthias Ringwald report_gatt_characteristic_value(gatt_client, value_handle, &packet[offset + 2u], pair_size - 2u); 14103deb3ec6SMatthias Ringwald last_result_handle = value_handle; 14113deb3ec6SMatthias Ringwald } 14125cf1669fSMatthias Ringwald trigger_next_read_by_type_query(gatt_client, last_result_handle); 14133deb3ec6SMatthias Ringwald break; 14143deb3ec6SMatthias Ringwald } 14153deb3ec6SMatthias Ringwald default: 14163deb3ec6SMatthias Ringwald break; 14173deb3ec6SMatthias Ringwald } 14183deb3ec6SMatthias Ringwald break; 14193deb3ec6SMatthias Ringwald case ATT_READ_RESPONSE: 14205cf1669fSMatthias Ringwald switch (gatt_client->gatt_client_state){ 14213deb3ec6SMatthias Ringwald case P_W4_INCLUDED_SERVICE_UUID_WITH_QUERY_RESULT: { 14223deb3ec6SMatthias Ringwald uint8_t uuid128[16]; 14239c80e4ccSMatthias Ringwald reverse_128(&packet[1], uuid128); 14245cf1669fSMatthias Ringwald report_gatt_included_service_uuid128(gatt_client, gatt_client->start_group_handle, uuid128); 14255cf1669fSMatthias Ringwald trigger_next_included_service_query(gatt_client, gatt_client->start_group_handle); 14265611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 14273deb3ec6SMatthias Ringwald break; 14283deb3ec6SMatthias Ringwald } 14293deb3ec6SMatthias Ringwald case P_W4_READ_CHARACTERISTIC_VALUE_RESULT: 14305cf1669fSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 14315cf1669fSMatthias Ringwald report_gatt_characteristic_value(gatt_client, gatt_client->attribute_handle, &packet[1], size - 1u); 14325cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_SUCCESS); 14333deb3ec6SMatthias Ringwald break; 14343deb3ec6SMatthias Ringwald 14353deb3ec6SMatthias Ringwald case P_W4_READ_CHARACTERISTIC_DESCRIPTOR_RESULT:{ 14365cf1669fSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 14375cf1669fSMatthias Ringwald report_gatt_characteristic_descriptor(gatt_client, gatt_client->attribute_handle, &packet[1], size - 1u, 0u); 14385cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_SUCCESS); 14393deb3ec6SMatthias Ringwald break; 14403deb3ec6SMatthias Ringwald } 14413deb3ec6SMatthias Ringwald default: 14423deb3ec6SMatthias Ringwald break; 14433deb3ec6SMatthias Ringwald } 14443deb3ec6SMatthias Ringwald break; 14453deb3ec6SMatthias Ringwald 14463deb3ec6SMatthias Ringwald case ATT_FIND_BY_TYPE_VALUE_RESPONSE: 14473deb3ec6SMatthias Ringwald { 14483deb3ec6SMatthias Ringwald uint8_t pair_size = 4; 14493deb3ec6SMatthias Ringwald int i; 14503deb3ec6SMatthias Ringwald uint16_t start_group_handle; 14515611a760SMatthias Ringwald uint16_t end_group_handle= 0xffff; // asserts GATT_EVENT_QUERY_COMPLETE is emitted if no results 14524ea43905SMatthias Ringwald for (i = 1u; (i + pair_size) <= size; i += pair_size){ 1453f8fbdce0SMatthias Ringwald start_group_handle = little_endian_read_16(packet,i); 1454f8fbdce0SMatthias Ringwald end_group_handle = little_endian_read_16(packet,i+2); 14555cf1669fSMatthias Ringwald emit_gatt_service_query_result_event(gatt_client, start_group_handle, end_group_handle, gatt_client->uuid128); 14563deb3ec6SMatthias Ringwald } 14575cf1669fSMatthias Ringwald trigger_next_service_by_uuid_query(gatt_client, end_group_handle); 14585611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 14593deb3ec6SMatthias Ringwald break; 14603deb3ec6SMatthias Ringwald } 14613deb3ec6SMatthias Ringwald case ATT_FIND_INFORMATION_REPLY: 14623deb3ec6SMatthias Ringwald { 14634ea43905SMatthias Ringwald if (size < 2u) break; 1464a6121b51SMilanka Ringwald 14653deb3ec6SMatthias Ringwald uint8_t pair_size = 4; 14664ea43905SMatthias Ringwald if (packet[1u] == 2u){ 14673deb3ec6SMatthias Ringwald pair_size = 18; 14683deb3ec6SMatthias Ringwald } 1469a6121b51SMilanka Ringwald uint16_t offset = 2; 1470a6121b51SMilanka Ringwald 1471a6121b51SMilanka Ringwald if (size < (pair_size + offset)) break; 1472f8fbdce0SMatthias Ringwald uint16_t last_descriptor_handle = little_endian_read_16(packet, size - pair_size); 1473abdc9fb5SMatthias Ringwald 1474abdc9fb5SMatthias Ringwald #ifdef ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY 14755cf1669fSMatthias Ringwald log_info("ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY, state %x", gatt_client->gatt_client_state); 14765cf1669fSMatthias Ringwald if (gatt_client->gatt_client_state == P_W4_FIND_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY_RESULT){ 1477abdc9fb5SMatthias Ringwald // iterate over descriptors looking for CCC 1478abdc9fb5SMatthias Ringwald if (pair_size == 4){ 1479a6121b51SMilanka Ringwald while ((offset + 4) <= size){ 1480abdc9fb5SMatthias Ringwald uint16_t uuid16 = little_endian_read_16(packet, offset + 2); 1481abdc9fb5SMatthias Ringwald if (uuid16 == GATT_CLIENT_CHARACTERISTICS_CONFIGURATION){ 14825cf1669fSMatthias Ringwald gatt_client->client_characteristic_configuration_handle = little_endian_read_16(packet, offset); 14835cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_WRITE_CLIENT_CHARACTERISTIC_CONFIGURATION; 14845cf1669fSMatthias Ringwald log_info("CCC found %x", gatt_client->client_characteristic_configuration_handle); 1485abdc9fb5SMatthias Ringwald break; 1486abdc9fb5SMatthias Ringwald } 1487abdc9fb5SMatthias Ringwald offset += pair_size; 1488abdc9fb5SMatthias Ringwald } 1489abdc9fb5SMatthias Ringwald } 14905cf1669fSMatthias Ringwald if (is_query_done(gatt_client, last_descriptor_handle)){ 1491abdc9fb5SMatthias Ringwald 1492abdc9fb5SMatthias Ringwald } else { 1493abdc9fb5SMatthias Ringwald // next 14945cf1669fSMatthias Ringwald gatt_client->start_group_handle = last_descriptor_handle + 1; 14955cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_FIND_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY; 1496abdc9fb5SMatthias Ringwald } 1497abdc9fb5SMatthias Ringwald break; 1498abdc9fb5SMatthias Ringwald } 1499abdc9fb5SMatthias Ringwald #endif 15005cf1669fSMatthias Ringwald report_gatt_all_characteristic_descriptors(gatt_client, &packet[2], size - 2u, pair_size); 15015cf1669fSMatthias Ringwald trigger_next_characteristic_descriptor_query(gatt_client, last_descriptor_handle); 15025611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 15033deb3ec6SMatthias Ringwald break; 15043deb3ec6SMatthias Ringwald } 15053deb3ec6SMatthias Ringwald 15063deb3ec6SMatthias Ringwald case ATT_WRITE_RESPONSE: 15075cf1669fSMatthias Ringwald switch (gatt_client->gatt_client_state){ 15083deb3ec6SMatthias Ringwald case P_W4_WRITE_CHARACTERISTIC_VALUE_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 case P_W4_CLIENT_CHARACTERISTIC_CONFIGURATION_RESULT: 15135cf1669fSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 15145cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_SUCCESS); 15153deb3ec6SMatthias Ringwald break; 15163deb3ec6SMatthias Ringwald case P_W4_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT: 15175cf1669fSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 15185cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_SUCCESS); 15193deb3ec6SMatthias Ringwald break; 15203deb3ec6SMatthias Ringwald default: 15213deb3ec6SMatthias Ringwald break; 15223deb3ec6SMatthias Ringwald } 15233deb3ec6SMatthias Ringwald break; 15243deb3ec6SMatthias Ringwald 15253deb3ec6SMatthias Ringwald case ATT_READ_BLOB_RESPONSE:{ 15264ea43905SMatthias Ringwald uint16_t received_blob_length = size-1u; 15275cf1669fSMatthias Ringwald switch(gatt_client->gatt_client_state){ 15283deb3ec6SMatthias Ringwald case P_W4_READ_BLOB_RESULT: 15295cf1669fSMatthias Ringwald report_gatt_long_characteristic_value_blob(gatt_client, gatt_client->attribute_handle, &packet[1], received_blob_length, gatt_client->attribute_offset); 15305cf1669fSMatthias Ringwald trigger_next_blob_query(gatt_client, P_W2_SEND_READ_BLOB_QUERY, received_blob_length); 15315611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 15323deb3ec6SMatthias Ringwald break; 15333deb3ec6SMatthias Ringwald case P_W4_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_RESULT: 15345cf1669fSMatthias Ringwald report_gatt_long_characteristic_descriptor(gatt_client, gatt_client->attribute_handle, 15353deb3ec6SMatthias Ringwald &packet[1], received_blob_length, 15365cf1669fSMatthias Ringwald gatt_client->attribute_offset); 15375cf1669fSMatthias Ringwald trigger_next_blob_query(gatt_client, P_W2_SEND_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_QUERY, received_blob_length); 15385611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 15393deb3ec6SMatthias Ringwald break; 15403deb3ec6SMatthias Ringwald default: 15413deb3ec6SMatthias Ringwald break; 15423deb3ec6SMatthias Ringwald } 15433deb3ec6SMatthias Ringwald break; 15443deb3ec6SMatthias Ringwald } 15453deb3ec6SMatthias Ringwald case ATT_PREPARE_WRITE_RESPONSE: 15465cf1669fSMatthias Ringwald switch (gatt_client->gatt_client_state){ 15473deb3ec6SMatthias Ringwald case P_W4_PREPARE_WRITE_SINGLE_RESULT: 15485cf1669fSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 15495cf1669fSMatthias Ringwald if (is_value_valid(gatt_client, packet, size)){ 15505cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_SUCCESS); 15513deb3ec6SMatthias Ringwald } else { 15525cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_DATA_MISMATCH); 15533deb3ec6SMatthias Ringwald } 15543deb3ec6SMatthias Ringwald break; 15553deb3ec6SMatthias Ringwald 15563deb3ec6SMatthias Ringwald case P_W4_PREPARE_WRITE_RESULT:{ 15575cf1669fSMatthias Ringwald gatt_client->attribute_offset = little_endian_read_16(packet, 3); 15585cf1669fSMatthias Ringwald trigger_next_prepare_write_query(gatt_client, P_W2_PREPARE_WRITE, P_W2_EXECUTE_PREPARED_WRITE); 15595611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 15603deb3ec6SMatthias Ringwald break; 15613deb3ec6SMatthias Ringwald } 15623deb3ec6SMatthias Ringwald case P_W4_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT:{ 15635cf1669fSMatthias Ringwald gatt_client->attribute_offset = little_endian_read_16(packet, 3); 15645cf1669fSMatthias Ringwald trigger_next_prepare_write_query(gatt_client, P_W2_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR, P_W2_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR); 15655611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 15663deb3ec6SMatthias Ringwald break; 15673deb3ec6SMatthias Ringwald } 15683deb3ec6SMatthias Ringwald case P_W4_PREPARE_RELIABLE_WRITE_RESULT:{ 15695cf1669fSMatthias Ringwald if (is_value_valid(gatt_client, packet, size)){ 15705cf1669fSMatthias Ringwald gatt_client->attribute_offset = little_endian_read_16(packet, 3); 15715cf1669fSMatthias Ringwald trigger_next_prepare_write_query(gatt_client, P_W2_PREPARE_RELIABLE_WRITE, P_W2_EXECUTE_PREPARED_WRITE); 15725611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 15733deb3ec6SMatthias Ringwald break; 15743deb3ec6SMatthias Ringwald } 15755cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_CANCEL_PREPARED_WRITE_DATA_MISMATCH; 15763deb3ec6SMatthias Ringwald break; 15773deb3ec6SMatthias Ringwald } 15783deb3ec6SMatthias Ringwald default: 15793deb3ec6SMatthias Ringwald break; 15803deb3ec6SMatthias Ringwald } 15813deb3ec6SMatthias Ringwald break; 15823deb3ec6SMatthias Ringwald 15833deb3ec6SMatthias Ringwald case ATT_EXECUTE_WRITE_RESPONSE: 15845cf1669fSMatthias Ringwald switch (gatt_client->gatt_client_state){ 15853deb3ec6SMatthias Ringwald case P_W4_EXECUTE_PREPARED_WRITE_RESULT: 15865cf1669fSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 15875cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_SUCCESS); 15883deb3ec6SMatthias Ringwald break; 15893deb3ec6SMatthias Ringwald case P_W4_CANCEL_PREPARED_WRITE_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 case P_W4_CANCEL_PREPARED_WRITE_DATA_MISMATCH_RESULT: 15945cf1669fSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 15955cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_DATA_MISMATCH); 15963deb3ec6SMatthias Ringwald break; 15973deb3ec6SMatthias Ringwald case P_W4_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT: 15985cf1669fSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 15995cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_SUCCESS); 16003deb3ec6SMatthias Ringwald break; 16013deb3ec6SMatthias Ringwald default: 16023deb3ec6SMatthias Ringwald break; 16033deb3ec6SMatthias Ringwald 16043deb3ec6SMatthias Ringwald } 16053deb3ec6SMatthias Ringwald break; 16063deb3ec6SMatthias Ringwald 16073deb3ec6SMatthias Ringwald case ATT_READ_MULTIPLE_RESPONSE: 16085cf1669fSMatthias Ringwald switch(gatt_client->gatt_client_state){ 16093deb3ec6SMatthias Ringwald case P_W4_READ_MULTIPLE_RESPONSE: 16105cf1669fSMatthias Ringwald report_gatt_characteristic_value(gatt_client, 0u, &packet[1], size - 1u); 16115cf1669fSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 16125cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_SUCCESS); 16133deb3ec6SMatthias Ringwald break; 16143deb3ec6SMatthias Ringwald default: 16153deb3ec6SMatthias Ringwald break; 16163deb3ec6SMatthias Ringwald } 16173deb3ec6SMatthias Ringwald break; 16183deb3ec6SMatthias Ringwald 16193deb3ec6SMatthias Ringwald case ATT_ERROR_RESPONSE: 16204ea43905SMatthias Ringwald if (size < 5u) return; 1621f060f108SMatthias Ringwald error_code = packet[4]; 1622f060f108SMatthias Ringwald switch (error_code){ 16233deb3ec6SMatthias Ringwald case ATT_ERROR_ATTRIBUTE_NOT_FOUND: { 16245cf1669fSMatthias Ringwald switch(gatt_client->gatt_client_state){ 16253deb3ec6SMatthias Ringwald case P_W4_SERVICE_QUERY_RESULT: 16263deb3ec6SMatthias Ringwald case P_W4_SERVICE_WITH_UUID_RESULT: 16273deb3ec6SMatthias Ringwald case P_W4_INCLUDED_SERVICE_QUERY_RESULT: 16283deb3ec6SMatthias Ringwald case P_W4_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY_RESULT: 16295cf1669fSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 16305cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_SUCCESS); 16313deb3ec6SMatthias Ringwald break; 16323deb3ec6SMatthias Ringwald case P_W4_ALL_CHARACTERISTICS_OF_SERVICE_QUERY_RESULT: 16333deb3ec6SMatthias Ringwald case P_W4_CHARACTERISTIC_WITH_UUID_QUERY_RESULT: 16345cf1669fSMatthias Ringwald characteristic_end_found(gatt_client, gatt_client->end_group_handle); 16355cf1669fSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 16365cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_SUCCESS); 16373deb3ec6SMatthias Ringwald break; 16383deb3ec6SMatthias Ringwald case P_W4_READ_BY_TYPE_RESPONSE: 16395cf1669fSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 16405cf1669fSMatthias Ringwald if (gatt_client->start_group_handle == gatt_client->query_start_handle){ 16415cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_ATTRIBUTE_NOT_FOUND); 16423deb3ec6SMatthias Ringwald } else { 16435cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_SUCCESS); 16443deb3ec6SMatthias Ringwald } 16453deb3ec6SMatthias Ringwald break; 16463deb3ec6SMatthias Ringwald default: 1647f060f108SMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, error_code); 16483deb3ec6SMatthias Ringwald break; 16493deb3ec6SMatthias Ringwald } 16503deb3ec6SMatthias Ringwald break; 16513deb3ec6SMatthias Ringwald } 1652f4b33574SMatthias Ringwald 1653f4b33574SMatthias Ringwald #ifdef ENABLE_GATT_CLIENT_PAIRING 1654f4b33574SMatthias Ringwald 1655f4b33574SMatthias Ringwald case ATT_ERROR_INSUFFICIENT_AUTHENTICATION: 1656f4b33574SMatthias Ringwald case ATT_ERROR_INSUFFICIENT_ENCRYPTION_KEY_SIZE: 1657a0e0c2beSMatthias Ringwald case ATT_ERROR_INSUFFICIENT_ENCRYPTION: { 1658a0e0c2beSMatthias Ringwald 1659f4b33574SMatthias Ringwald // security too low 16605cf1669fSMatthias Ringwald if (gatt_client->security_counter > 0) { 1661f060f108SMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, error_code); 1662f4b33574SMatthias Ringwald break; 1663f4b33574SMatthias Ringwald } 1664f4b33574SMatthias Ringwald // start security 16655cf1669fSMatthias Ringwald gatt_client->security_counter++; 1666f4b33574SMatthias Ringwald 1667f4b33574SMatthias Ringwald // setup action 1668f4b33574SMatthias Ringwald int retry = 1; 16695cf1669fSMatthias Ringwald switch (gatt_client->gatt_client_state){ 1670f4b33574SMatthias Ringwald case P_W4_READ_CHARACTERISTIC_VALUE_RESULT: 16715cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_CHARACTERISTIC_VALUE_QUERY ; 1672f4b33574SMatthias Ringwald break; 1673f4b33574SMatthias Ringwald case P_W4_READ_BLOB_RESULT: 16745cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_BLOB_QUERY; 1675f4b33574SMatthias Ringwald break; 1676f4b33574SMatthias Ringwald case P_W4_READ_BY_TYPE_RESPONSE: 16775cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_BY_TYPE_REQUEST; 1678f4b33574SMatthias Ringwald break; 1679f4b33574SMatthias Ringwald case P_W4_READ_MULTIPLE_RESPONSE: 16805cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_MULTIPLE_REQUEST; 1681f4b33574SMatthias Ringwald break; 1682f4b33574SMatthias Ringwald case P_W4_WRITE_CHARACTERISTIC_VALUE_RESULT: 16835cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_WRITE_CHARACTERISTIC_VALUE; 1684f4b33574SMatthias Ringwald break; 1685f4b33574SMatthias Ringwald case P_W4_PREPARE_WRITE_RESULT: 16865cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_PREPARE_WRITE; 1687f4b33574SMatthias Ringwald break; 1688f4b33574SMatthias Ringwald case P_W4_PREPARE_WRITE_SINGLE_RESULT: 16895cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_PREPARE_WRITE_SINGLE; 1690f4b33574SMatthias Ringwald break; 1691f4b33574SMatthias Ringwald case P_W4_PREPARE_RELIABLE_WRITE_RESULT: 16925cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_PREPARE_RELIABLE_WRITE; 1693f4b33574SMatthias Ringwald break; 1694f4b33574SMatthias Ringwald case P_W4_EXECUTE_PREPARED_WRITE_RESULT: 16955cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_EXECUTE_PREPARED_WRITE; 1696f4b33574SMatthias Ringwald break; 1697f4b33574SMatthias Ringwald case P_W4_CANCEL_PREPARED_WRITE_RESULT: 16985cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_CANCEL_PREPARED_WRITE; 1699f4b33574SMatthias Ringwald break; 1700f4b33574SMatthias Ringwald case P_W4_CANCEL_PREPARED_WRITE_DATA_MISMATCH_RESULT: 17015cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_CANCEL_PREPARED_WRITE_DATA_MISMATCH; 1702f4b33574SMatthias Ringwald break; 1703f4b33574SMatthias Ringwald case P_W4_READ_CHARACTERISTIC_DESCRIPTOR_RESULT: 17045cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_CHARACTERISTIC_DESCRIPTOR_QUERY; 1705f4b33574SMatthias Ringwald break; 1706f4b33574SMatthias Ringwald case P_W4_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_RESULT: 17075cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_QUERY; 1708f4b33574SMatthias Ringwald break; 1709f4b33574SMatthias Ringwald case P_W4_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT: 17105cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_WRITE_CHARACTERISTIC_DESCRIPTOR; 1711f4b33574SMatthias Ringwald break; 1712f4b33574SMatthias Ringwald case P_W4_CLIENT_CHARACTERISTIC_CONFIGURATION_RESULT: 17135cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_WRITE_CLIENT_CHARACTERISTIC_CONFIGURATION; 1714f4b33574SMatthias Ringwald break; 1715f4b33574SMatthias Ringwald case P_W4_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT: 17165cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR; 1717f4b33574SMatthias Ringwald break; 1718f4b33574SMatthias Ringwald case P_W4_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT: 17195cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR; 1720f4b33574SMatthias Ringwald break; 1721f4b33574SMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 1722f4b33574SMatthias Ringwald case P_W4_SEND_SINGED_WRITE_DONE: 17235cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_SIGNED_WRITE; 1724f4b33574SMatthias Ringwald break; 1725f4b33574SMatthias Ringwald #endif 1726f4b33574SMatthias Ringwald default: 17275cf1669fSMatthias Ringwald log_info("retry not supported for state %x", gatt_client->gatt_client_state); 1728f4b33574SMatthias Ringwald retry = 0; 1729f4b33574SMatthias Ringwald break; 1730f4b33574SMatthias Ringwald } 1731f4b33574SMatthias Ringwald 1732f4b33574SMatthias Ringwald if (!retry) { 1733f060f108SMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, error_code); 1734f4b33574SMatthias Ringwald break; 1735f4b33574SMatthias Ringwald } 1736f4b33574SMatthias Ringwald 1737f4b33574SMatthias Ringwald log_info("security error, start pairing"); 1738f4b33574SMatthias Ringwald 1739f060f108SMatthias Ringwald // start pairing for higher security level 17403503dc74SMatthias Ringwald gatt_client->wait_for_authentication_complete = 1; 1741f060f108SMatthias Ringwald gatt_client->pending_error_code = error_code; 17425cf1669fSMatthias Ringwald sm_request_pairing(gatt_client->con_handle); 1743f4b33574SMatthias Ringwald break; 1744a0e0c2beSMatthias Ringwald } 1745f4b33574SMatthias Ringwald #endif 1746f4b33574SMatthias Ringwald 1747f4b33574SMatthias Ringwald // nothing we can do about that 1748f4b33574SMatthias Ringwald case ATT_ERROR_INSUFFICIENT_AUTHORIZATION: 17493deb3ec6SMatthias Ringwald default: 1750f060f108SMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, error_code); 17513deb3ec6SMatthias Ringwald break; 17523deb3ec6SMatthias Ringwald } 17533deb3ec6SMatthias Ringwald break; 17543deb3ec6SMatthias Ringwald 17553deb3ec6SMatthias Ringwald default: 17563deb3ec6SMatthias Ringwald log_info("ATT Handler, unhandled response type 0x%02x", packet[0]); 17573deb3ec6SMatthias Ringwald break; 17583deb3ec6SMatthias Ringwald } 17593deb3ec6SMatthias Ringwald gatt_client_run(); 17603deb3ec6SMatthias Ringwald } 17613deb3ec6SMatthias Ringwald 17627a766ebfSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 17633deb3ec6SMatthias Ringwald static void att_signed_write_handle_cmac_result(uint8_t hash[8]){ 1764665d90f2SMatthias Ringwald btstack_linked_list_iterator_t it; 1765665d90f2SMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client_connections); 1766665d90f2SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 17675cf1669fSMatthias Ringwald gatt_client_t * gatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it); 17685cf1669fSMatthias Ringwald if (gatt_client->gatt_client_state == P_W4_CMAC_RESULT){ 17693deb3ec6SMatthias Ringwald // store result 17705cf1669fSMatthias Ringwald (void)memcpy(gatt_client->cmac, hash, 8); 17715cf1669fSMatthias Ringwald // reverse_64(hash, gatt_client->cmac); 17725cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_SIGNED_WRITE; 17733deb3ec6SMatthias Ringwald gatt_client_run(); 17743deb3ec6SMatthias Ringwald return; 17753deb3ec6SMatthias Ringwald } 17763deb3ec6SMatthias Ringwald } 17773deb3ec6SMatthias Ringwald } 17783deb3ec6SMatthias Ringwald 1779711e6c80SMatthias 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){ 17805cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle(con_handle); 17815cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 17825cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 17833deb3ec6SMatthias Ringwald 17845cf1669fSMatthias Ringwald gatt_client->callback = callback; 17855cf1669fSMatthias Ringwald gatt_client->attribute_handle = handle; 17865cf1669fSMatthias Ringwald gatt_client->attribute_length = message_len; 17875cf1669fSMatthias Ringwald gatt_client->attribute_value = message; 17885cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_IDENTITY_RESOLVING; 17893deb3ec6SMatthias Ringwald gatt_client_run(); 179025b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 17913deb3ec6SMatthias Ringwald } 17927a766ebfSMatthias Ringwald #endif 17933deb3ec6SMatthias Ringwald 1794711e6c80SMatthias Ringwald uint8_t gatt_client_discover_primary_services(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 17955cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 17965cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 17975cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 17983deb3ec6SMatthias Ringwald 17995cf1669fSMatthias Ringwald gatt_client->callback = callback; 18005cf1669fSMatthias Ringwald gatt_client->start_group_handle = 0x0001; 18015cf1669fSMatthias Ringwald gatt_client->end_group_handle = 0xffff; 18025cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_SERVICE_QUERY; 18035cf1669fSMatthias Ringwald gatt_client->uuid16 = 0; 18043deb3ec6SMatthias Ringwald gatt_client_run(); 180525b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 18063deb3ec6SMatthias Ringwald } 18073deb3ec6SMatthias Ringwald 18083deb3ec6SMatthias Ringwald 1809711e6c80SMatthias Ringwald uint8_t gatt_client_discover_primary_services_by_uuid16(btstack_packet_handler_t callback, hci_con_handle_t con_handle, uint16_t uuid16){ 18105cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 18115cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 18125cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 18133deb3ec6SMatthias Ringwald 18145cf1669fSMatthias Ringwald gatt_client->callback = callback; 18155cf1669fSMatthias Ringwald gatt_client->start_group_handle = 0x0001; 18165cf1669fSMatthias Ringwald gatt_client->end_group_handle = 0xffff; 18175cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_SERVICE_WITH_UUID_QUERY; 18185cf1669fSMatthias Ringwald gatt_client->uuid16 = uuid16; 18195cf1669fSMatthias Ringwald uuid_add_bluetooth_prefix((uint8_t*) &(gatt_client->uuid128), gatt_client->uuid16); 18203deb3ec6SMatthias Ringwald gatt_client_run(); 182125b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 18223deb3ec6SMatthias Ringwald } 18233deb3ec6SMatthias Ringwald 1824711e6c80SMatthias 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){ 18255cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 18265cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 18275cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 18283deb3ec6SMatthias Ringwald 18295cf1669fSMatthias Ringwald gatt_client->callback = callback; 18305cf1669fSMatthias Ringwald gatt_client->start_group_handle = 0x0001; 18315cf1669fSMatthias Ringwald gatt_client->end_group_handle = 0xffff; 18325cf1669fSMatthias Ringwald gatt_client->uuid16 = 0; 18335cf1669fSMatthias Ringwald (void)memcpy(gatt_client->uuid128, uuid128, 16); 18345cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_SERVICE_WITH_UUID_QUERY; 18353deb3ec6SMatthias Ringwald gatt_client_run(); 183625b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 18373deb3ec6SMatthias Ringwald } 18383deb3ec6SMatthias Ringwald 1839711e6c80SMatthias 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){ 18405cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 18415cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 18425cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 18433deb3ec6SMatthias Ringwald 18445cf1669fSMatthias Ringwald gatt_client->callback = callback; 18455cf1669fSMatthias Ringwald gatt_client->start_group_handle = service->start_group_handle; 18465cf1669fSMatthias Ringwald gatt_client->end_group_handle = service->end_group_handle; 18475cf1669fSMatthias Ringwald gatt_client->filter_with_uuid = 0; 18485cf1669fSMatthias Ringwald gatt_client->characteristic_start_handle = 0; 18495cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_ALL_CHARACTERISTICS_OF_SERVICE_QUERY; 18503deb3ec6SMatthias Ringwald gatt_client_run(); 185125b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 18523deb3ec6SMatthias Ringwald } 18533deb3ec6SMatthias Ringwald 1854711e6c80SMatthias 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){ 18555cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 18565cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 18575cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 18585cf1669fSMatthias Ringwald gatt_client->callback = callback; 18595cf1669fSMatthias Ringwald gatt_client->start_group_handle = service->start_group_handle; 18605cf1669fSMatthias Ringwald gatt_client->end_group_handle = service->end_group_handle; 18615cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_INCLUDED_SERVICE_QUERY; 18623deb3ec6SMatthias Ringwald 18633deb3ec6SMatthias Ringwald gatt_client_run(); 186425b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 18653deb3ec6SMatthias Ringwald } 18663deb3ec6SMatthias Ringwald 1867711e6c80SMatthias 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){ 18685cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 18695cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 18705cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 18713deb3ec6SMatthias Ringwald 18725cf1669fSMatthias Ringwald gatt_client->callback = callback; 18735cf1669fSMatthias Ringwald gatt_client->start_group_handle = start_handle; 18745cf1669fSMatthias Ringwald gatt_client->end_group_handle = end_handle; 18755cf1669fSMatthias Ringwald gatt_client->filter_with_uuid = 1; 18765cf1669fSMatthias Ringwald gatt_client->uuid16 = uuid16; 18775cf1669fSMatthias Ringwald uuid_add_bluetooth_prefix((uint8_t*) &(gatt_client->uuid128), uuid16); 18785cf1669fSMatthias Ringwald gatt_client->characteristic_start_handle = 0; 18795cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_CHARACTERISTIC_WITH_UUID_QUERY; 18803deb3ec6SMatthias Ringwald gatt_client_run(); 188125b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 18823deb3ec6SMatthias Ringwald } 18833deb3ec6SMatthias Ringwald 1884711e6c80SMatthias 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){ 18855cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 18865cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 18875cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 18883deb3ec6SMatthias Ringwald 18895cf1669fSMatthias Ringwald gatt_client->callback = callback; 18905cf1669fSMatthias Ringwald gatt_client->start_group_handle = start_handle; 18915cf1669fSMatthias Ringwald gatt_client->end_group_handle = end_handle; 18925cf1669fSMatthias Ringwald gatt_client->filter_with_uuid = 1; 18935cf1669fSMatthias Ringwald gatt_client->uuid16 = 0; 18945cf1669fSMatthias Ringwald (void)memcpy(gatt_client->uuid128, uuid128, 16); 18955cf1669fSMatthias Ringwald gatt_client->characteristic_start_handle = 0; 18965cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_CHARACTERISTIC_WITH_UUID_QUERY; 18973deb3ec6SMatthias Ringwald gatt_client_run(); 189825b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 18993deb3ec6SMatthias Ringwald } 19003deb3ec6SMatthias Ringwald 19013deb3ec6SMatthias Ringwald 1902d25c33e5SMatthias 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){ 19039c662c9bSMatthias Ringwald return gatt_client_discover_characteristics_for_handle_range_by_uuid16(callback, handle, service->start_group_handle, service->end_group_handle, uuid16); 19043deb3ec6SMatthias Ringwald } 19053deb3ec6SMatthias Ringwald 1906d25c33e5SMatthias 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){ 19079c662c9bSMatthias Ringwald return gatt_client_discover_characteristics_for_handle_range_by_uuid128(callback, handle, service->start_group_handle, service->end_group_handle, uuid128); 19083deb3ec6SMatthias Ringwald } 19093deb3ec6SMatthias Ringwald 1910711e6c80SMatthias Ringwald uint8_t gatt_client_discover_characteristic_descriptors(btstack_packet_handler_t callback, hci_con_handle_t con_handle, gatt_client_characteristic_t *characteristic){ 19115cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 19125cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 19135cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 19143deb3ec6SMatthias Ringwald 19153deb3ec6SMatthias Ringwald if (characteristic->value_handle == characteristic->end_handle){ 19165cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_SUCCESS); 191725b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 19183deb3ec6SMatthias Ringwald } 19195cf1669fSMatthias Ringwald gatt_client->callback = callback; 19205cf1669fSMatthias Ringwald gatt_client->start_group_handle = characteristic->value_handle + 1u; 19215cf1669fSMatthias Ringwald gatt_client->end_group_handle = characteristic->end_handle; 19225cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY; 19233deb3ec6SMatthias Ringwald gatt_client_run(); 192425b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 19253deb3ec6SMatthias Ringwald } 19263deb3ec6SMatthias Ringwald 1927711e6c80SMatthias 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){ 19285cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 19295cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 19305cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 19313deb3ec6SMatthias Ringwald 19325cf1669fSMatthias Ringwald gatt_client->callback = callback; 19335cf1669fSMatthias Ringwald gatt_client->attribute_handle = value_handle; 19345cf1669fSMatthias Ringwald gatt_client->attribute_offset = 0; 19355cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_CHARACTERISTIC_VALUE_QUERY; 19363deb3ec6SMatthias Ringwald gatt_client_run(); 193725b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 19383deb3ec6SMatthias Ringwald } 19393deb3ec6SMatthias Ringwald 1940711e6c80SMatthias 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){ 19415cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 19425cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 19435cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 19443deb3ec6SMatthias Ringwald 19455cf1669fSMatthias Ringwald gatt_client->callback = callback; 19465cf1669fSMatthias Ringwald gatt_client->start_group_handle = start_handle; 19475cf1669fSMatthias Ringwald gatt_client->end_group_handle = end_handle; 19485cf1669fSMatthias Ringwald gatt_client->query_start_handle = start_handle; 19495cf1669fSMatthias Ringwald gatt_client->query_end_handle = end_handle; 19505cf1669fSMatthias Ringwald gatt_client->uuid16 = uuid16; 19515cf1669fSMatthias Ringwald uuid_add_bluetooth_prefix((uint8_t*) &(gatt_client->uuid128), uuid16); 19525cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_BY_TYPE_REQUEST; 19533deb3ec6SMatthias Ringwald gatt_client_run(); 195425b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 19553deb3ec6SMatthias Ringwald } 19563deb3ec6SMatthias Ringwald 1957711e6c80SMatthias 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){ 19585cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 19595cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 19605cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 19613deb3ec6SMatthias Ringwald 19625cf1669fSMatthias Ringwald gatt_client->callback = callback; 19635cf1669fSMatthias Ringwald gatt_client->start_group_handle = start_handle; 19645cf1669fSMatthias Ringwald gatt_client->end_group_handle = end_handle; 19655cf1669fSMatthias Ringwald gatt_client->query_start_handle = start_handle; 19665cf1669fSMatthias Ringwald gatt_client->query_end_handle = end_handle; 19675cf1669fSMatthias Ringwald gatt_client->uuid16 = 0; 19685cf1669fSMatthias Ringwald (void)memcpy(gatt_client->uuid128, uuid128, 16); 19695cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_BY_TYPE_REQUEST; 19703deb3ec6SMatthias Ringwald gatt_client_run(); 197125b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 19723deb3ec6SMatthias Ringwald } 19733deb3ec6SMatthias Ringwald 19743deb3ec6SMatthias Ringwald 1975d25c33e5SMatthias Ringwald uint8_t gatt_client_read_value_of_characteristic(btstack_packet_handler_t callback, uint16_t handle, gatt_client_characteristic_t *characteristic){ 19769c662c9bSMatthias Ringwald return gatt_client_read_value_of_characteristic_using_value_handle(callback, handle, characteristic->value_handle); 19773deb3ec6SMatthias Ringwald } 19783deb3ec6SMatthias Ringwald 1979711e6c80SMatthias 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){ 19805cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 19815cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 19825cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 19833deb3ec6SMatthias Ringwald 19845cf1669fSMatthias Ringwald gatt_client->callback = callback; 19855cf1669fSMatthias Ringwald gatt_client->attribute_handle = characteristic_value_handle; 19865cf1669fSMatthias Ringwald gatt_client->attribute_offset = offset; 19875cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_BLOB_QUERY; 19883deb3ec6SMatthias Ringwald gatt_client_run(); 198925b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 19903deb3ec6SMatthias Ringwald } 19913deb3ec6SMatthias Ringwald 1992711e6c80SMatthias 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){ 19939c662c9bSMatthias Ringwald return gatt_client_read_long_value_of_characteristic_using_value_handle_with_offset(callback, con_handle, characteristic_value_handle, 0); 19943deb3ec6SMatthias Ringwald } 19953deb3ec6SMatthias Ringwald 1996d25c33e5SMatthias Ringwald uint8_t gatt_client_read_long_value_of_characteristic(btstack_packet_handler_t callback, uint16_t handle, gatt_client_characteristic_t *characteristic){ 19979c662c9bSMatthias Ringwald return gatt_client_read_long_value_of_characteristic_using_value_handle(callback, handle, characteristic->value_handle); 19983deb3ec6SMatthias Ringwald } 19993deb3ec6SMatthias Ringwald 2000711e6c80SMatthias 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){ 20015cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 20025cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 20035cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 20043deb3ec6SMatthias Ringwald 20055cf1669fSMatthias Ringwald gatt_client->callback = callback; 20065cf1669fSMatthias Ringwald gatt_client->read_multiple_handle_count = num_value_handles; 20075cf1669fSMatthias Ringwald gatt_client->read_multiple_handles = value_handles; 20085cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_MULTIPLE_REQUEST; 20093deb3ec6SMatthias Ringwald gatt_client_run(); 201025b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 20113deb3ec6SMatthias Ringwald } 20123deb3ec6SMatthias Ringwald 2013de9f8e94SMatthias 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){ 20145cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle(con_handle); 20155cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 20163deb3ec6SMatthias Ringwald 2017dda77937SMatthias Ringwald if (value_length > (gatt_client->mtu - 3u)) return GATT_CLIENT_VALUE_TOO_LONG; 20185cf1669fSMatthias Ringwald if (!att_dispatch_client_can_send_now(gatt_client->con_handle)) return GATT_CLIENT_BUSY; 20193deb3ec6SMatthias Ringwald 20205cf1669fSMatthias Ringwald return att_write_request(ATT_WRITE_COMMAND, gatt_client->con_handle, value_handle, value_length, value); 20213deb3ec6SMatthias Ringwald } 20223deb3ec6SMatthias Ringwald 2023711e6c80SMatthias 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){ 20245cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 20255cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 20265cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 20273deb3ec6SMatthias Ringwald 20285cf1669fSMatthias Ringwald gatt_client->callback = callback; 20295cf1669fSMatthias Ringwald gatt_client->attribute_handle = value_handle; 20305cf1669fSMatthias Ringwald gatt_client->attribute_length = value_length; 20315cf1669fSMatthias Ringwald gatt_client->attribute_value = data; 20325cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_WRITE_CHARACTERISTIC_VALUE; 20333deb3ec6SMatthias Ringwald gatt_client_run(); 203425b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 20353deb3ec6SMatthias Ringwald } 20363deb3ec6SMatthias Ringwald 2037711e6c80SMatthias 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){ 20385cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 20395cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 20405cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 20413deb3ec6SMatthias Ringwald 20425cf1669fSMatthias Ringwald gatt_client->callback = callback; 20435cf1669fSMatthias Ringwald gatt_client->attribute_handle = value_handle; 20445cf1669fSMatthias Ringwald gatt_client->attribute_length = value_length; 20455cf1669fSMatthias Ringwald gatt_client->attribute_offset = offset; 20465cf1669fSMatthias Ringwald gatt_client->attribute_value = data; 20475cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_PREPARE_WRITE; 20483deb3ec6SMatthias Ringwald gatt_client_run(); 204925b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 20503deb3ec6SMatthias Ringwald } 20513deb3ec6SMatthias Ringwald 2052711e6c80SMatthias 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){ 20539c662c9bSMatthias Ringwald return gatt_client_write_long_value_of_characteristic_with_offset(callback, con_handle, value_handle, 0, value_length, value); 20543deb3ec6SMatthias Ringwald } 20553deb3ec6SMatthias Ringwald 2056711e6c80SMatthias 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){ 20575cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 20585cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 20595cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 20603deb3ec6SMatthias Ringwald 20615cf1669fSMatthias Ringwald gatt_client->callback = callback; 20625cf1669fSMatthias Ringwald gatt_client->attribute_handle = value_handle; 20635cf1669fSMatthias Ringwald gatt_client->attribute_length = value_length; 20645cf1669fSMatthias Ringwald gatt_client->attribute_offset = 0; 20655cf1669fSMatthias Ringwald gatt_client->attribute_value = value; 20665cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_PREPARE_RELIABLE_WRITE; 20673deb3ec6SMatthias Ringwald gatt_client_run(); 206825b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 20693deb3ec6SMatthias Ringwald } 20703deb3ec6SMatthias Ringwald 2071711e6c80SMatthias 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){ 20725cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 20735cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 20745cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 20753deb3ec6SMatthias Ringwald 20763deb3ec6SMatthias Ringwald if ( (configuration & GATT_CLIENT_CHARACTERISTICS_CONFIGURATION_NOTIFICATION) && 20774ea43905SMatthias Ringwald ((characteristic->properties & ATT_PROPERTY_NOTIFY) == 0u)) { 2078d8e8f12aSMatthias Ringwald log_info("gatt_client_write_client_characteristic_configuration: GATT_CLIENT_CHARACTERISTIC_NOTIFICATION_NOT_SUPPORTED"); 2079616edd56SMatthias Ringwald return GATT_CLIENT_CHARACTERISTIC_NOTIFICATION_NOT_SUPPORTED; 20803deb3ec6SMatthias Ringwald } else if ( (configuration & GATT_CLIENT_CHARACTERISTICS_CONFIGURATION_INDICATION) && 20814ea43905SMatthias Ringwald ((characteristic->properties & ATT_PROPERTY_INDICATE) == 0u)){ 2082d8e8f12aSMatthias Ringwald log_info("gatt_client_write_client_characteristic_configuration: GATT_CLIENT_CHARACTERISTIC_INDICATION_NOT_SUPPORTED"); 2083616edd56SMatthias Ringwald return GATT_CLIENT_CHARACTERISTIC_INDICATION_NOT_SUPPORTED; 20843deb3ec6SMatthias Ringwald } 20853deb3ec6SMatthias Ringwald 20865cf1669fSMatthias Ringwald gatt_client->callback = callback; 20875cf1669fSMatthias Ringwald gatt_client->start_group_handle = characteristic->value_handle; 20885cf1669fSMatthias Ringwald gatt_client->end_group_handle = characteristic->end_handle; 20895cf1669fSMatthias Ringwald little_endian_store_16(gatt_client->client_characteristic_configuration_value, 0, configuration); 20903deb3ec6SMatthias Ringwald 2091abdc9fb5SMatthias Ringwald #ifdef ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY 20925cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_FIND_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY; 2093abdc9fb5SMatthias Ringwald #else 20945cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY; 2095abdc9fb5SMatthias Ringwald #endif 20963deb3ec6SMatthias Ringwald gatt_client_run(); 20979cb80b17SMilanka Ringwald return ERROR_CODE_SUCCESS; 20983deb3ec6SMatthias Ringwald } 20993deb3ec6SMatthias Ringwald 2100711e6c80SMatthias 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){ 21015cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 21025cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 21035cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 21043deb3ec6SMatthias Ringwald 21055cf1669fSMatthias Ringwald gatt_client->callback = callback; 21065cf1669fSMatthias Ringwald gatt_client->attribute_handle = descriptor_handle; 21073deb3ec6SMatthias Ringwald 21085cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_CHARACTERISTIC_DESCRIPTOR_QUERY; 21093deb3ec6SMatthias Ringwald gatt_client_run(); 211025b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 21113deb3ec6SMatthias Ringwald } 21123deb3ec6SMatthias Ringwald 2113711e6c80SMatthias 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){ 21149c662c9bSMatthias Ringwald return gatt_client_read_characteristic_descriptor_using_descriptor_handle(callback, con_handle, descriptor->handle); 21153deb3ec6SMatthias Ringwald } 21163deb3ec6SMatthias Ringwald 2117711e6c80SMatthias 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){ 21185cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 21195cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 21205cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 21213deb3ec6SMatthias Ringwald 21225cf1669fSMatthias Ringwald gatt_client->callback = callback; 21235cf1669fSMatthias Ringwald gatt_client->attribute_handle = descriptor_handle; 21245cf1669fSMatthias Ringwald gatt_client->attribute_offset = offset; 21255cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_QUERY; 21263deb3ec6SMatthias Ringwald gatt_client_run(); 212725b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 21283deb3ec6SMatthias Ringwald } 21293deb3ec6SMatthias Ringwald 2130711e6c80SMatthias 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){ 21319c662c9bSMatthias Ringwald return gatt_client_read_long_characteristic_descriptor_using_descriptor_handle_with_offset(callback, con_handle, descriptor_handle, 0); 21323deb3ec6SMatthias Ringwald } 21333deb3ec6SMatthias Ringwald 2134711e6c80SMatthias 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){ 21359c662c9bSMatthias Ringwald return gatt_client_read_long_characteristic_descriptor_using_descriptor_handle(callback, con_handle, descriptor->handle); 21363deb3ec6SMatthias Ringwald } 21373deb3ec6SMatthias Ringwald 2138711e6c80SMatthias 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){ 21395cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 21405cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 21415cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 21423deb3ec6SMatthias Ringwald 21435cf1669fSMatthias Ringwald gatt_client->callback = callback; 21445cf1669fSMatthias Ringwald gatt_client->attribute_handle = descriptor_handle; 21455cf1669fSMatthias Ringwald gatt_client->attribute_length = length; 21465cf1669fSMatthias Ringwald gatt_client->attribute_offset = 0; 21475cf1669fSMatthias Ringwald gatt_client->attribute_value = data; 21485cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_WRITE_CHARACTERISTIC_DESCRIPTOR; 21493deb3ec6SMatthias Ringwald gatt_client_run(); 215025b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 21513deb3ec6SMatthias Ringwald } 21523deb3ec6SMatthias Ringwald 2153711e6c80SMatthias 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){ 21549c662c9bSMatthias Ringwald return gatt_client_write_characteristic_descriptor_using_descriptor_handle(callback, con_handle, descriptor->handle, length, value); 21553deb3ec6SMatthias Ringwald } 21563deb3ec6SMatthias Ringwald 2157711e6c80SMatthias 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){ 21585cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 21595cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 21605cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 21613deb3ec6SMatthias Ringwald 21625cf1669fSMatthias Ringwald gatt_client->callback = callback; 21635cf1669fSMatthias Ringwald gatt_client->attribute_handle = descriptor_handle; 21645cf1669fSMatthias Ringwald gatt_client->attribute_length = length; 21655cf1669fSMatthias Ringwald gatt_client->attribute_offset = offset; 21665cf1669fSMatthias Ringwald gatt_client->attribute_value = data; 21675cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR; 21683deb3ec6SMatthias Ringwald gatt_client_run(); 216925b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 21703deb3ec6SMatthias Ringwald } 21713deb3ec6SMatthias Ringwald 2172711e6c80SMatthias 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){ 21739c662c9bSMatthias Ringwald return gatt_client_write_long_characteristic_descriptor_using_descriptor_handle_with_offset(callback, con_handle, descriptor_handle, 0, length, data ); 21743deb3ec6SMatthias Ringwald } 21753deb3ec6SMatthias Ringwald 2176711e6c80SMatthias 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){ 21779c662c9bSMatthias Ringwald return gatt_client_write_long_characteristic_descriptor_using_descriptor_handle(callback, con_handle, descriptor->handle, length, value); 21783deb3ec6SMatthias Ringwald } 21793deb3ec6SMatthias Ringwald 21803deb3ec6SMatthias Ringwald /** 21813deb3ec6SMatthias Ringwald * @brief -> gatt complete event 21823deb3ec6SMatthias Ringwald */ 2183711e6c80SMatthias 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){ 21845cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 21855cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 21865cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 21873deb3ec6SMatthias Ringwald 21885cf1669fSMatthias Ringwald gatt_client->callback = callback; 21895cf1669fSMatthias Ringwald gatt_client->attribute_handle = attribute_handle; 21905cf1669fSMatthias Ringwald gatt_client->attribute_length = length; 21915cf1669fSMatthias Ringwald gatt_client->attribute_offset = offset; 21925cf1669fSMatthias Ringwald gatt_client->attribute_value = data; 21935cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_PREPARE_WRITE_SINGLE; 21943deb3ec6SMatthias Ringwald gatt_client_run(); 219525b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 21963deb3ec6SMatthias Ringwald } 21973deb3ec6SMatthias Ringwald 21983deb3ec6SMatthias Ringwald /** 21993deb3ec6SMatthias Ringwald * @brief -> gatt complete event 22003deb3ec6SMatthias Ringwald */ 2201711e6c80SMatthias Ringwald uint8_t gatt_client_execute_write(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 22025cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 22033deb3ec6SMatthias Ringwald 22045cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 22055cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 22063deb3ec6SMatthias Ringwald 22075cf1669fSMatthias Ringwald gatt_client->callback = callback; 22085cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_EXECUTE_PREPARED_WRITE; 22093deb3ec6SMatthias Ringwald gatt_client_run(); 221025b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 22113deb3ec6SMatthias Ringwald } 22123deb3ec6SMatthias Ringwald 22133deb3ec6SMatthias Ringwald /** 22143deb3ec6SMatthias Ringwald * @brief -> gatt complete event 22153deb3ec6SMatthias Ringwald */ 2216711e6c80SMatthias Ringwald uint8_t gatt_client_cancel_write(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 22175cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 22185cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 22195cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 22203deb3ec6SMatthias Ringwald 22215cf1669fSMatthias Ringwald gatt_client->callback = callback; 22225cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_CANCEL_PREPARED_WRITE; 22233deb3ec6SMatthias Ringwald gatt_client_run(); 22247d2258b3SMilanka Ringwald return ERROR_CODE_SUCCESS; 22253deb3ec6SMatthias Ringwald } 22263deb3ec6SMatthias Ringwald 2227313e337bSMatthias Ringwald void gatt_client_deserialize_service(const uint8_t *packet, int offset, gatt_client_service_t *service){ 22286ba2ad22SMatthias Ringwald service->start_group_handle = little_endian_read_16(packet, offset); 22296ba2ad22SMatthias Ringwald service->end_group_handle = little_endian_read_16(packet, offset + 2); 22306ba2ad22SMatthias Ringwald reverse_128(&packet[offset + 4], service->uuid128); 22316ba2ad22SMatthias Ringwald if (uuid_has_bluetooth_prefix(service->uuid128)){ 22326ba2ad22SMatthias Ringwald service->uuid16 = big_endian_read_32(service->uuid128, 0); 2233c839c6f9SMatthias Ringwald } else { 2234c839c6f9SMatthias Ringwald service->uuid16 = 0; 22356ba2ad22SMatthias Ringwald } 22366ba2ad22SMatthias Ringwald } 22376ba2ad22SMatthias Ringwald 2238313e337bSMatthias Ringwald void gatt_client_deserialize_characteristic(const uint8_t * packet, int offset, gatt_client_characteristic_t * characteristic){ 22396ba2ad22SMatthias Ringwald characteristic->start_handle = little_endian_read_16(packet, offset); 22406ba2ad22SMatthias Ringwald characteristic->value_handle = little_endian_read_16(packet, offset + 2); 22416ba2ad22SMatthias Ringwald characteristic->end_handle = little_endian_read_16(packet, offset + 4); 22426ba2ad22SMatthias Ringwald characteristic->properties = little_endian_read_16(packet, offset + 6); 224386c38559SMatthias Ringwald reverse_128(&packet[offset+8], characteristic->uuid128); 22446ba2ad22SMatthias Ringwald if (uuid_has_bluetooth_prefix(characteristic->uuid128)){ 22456ba2ad22SMatthias Ringwald characteristic->uuid16 = big_endian_read_32(characteristic->uuid128, 0); 2246c839c6f9SMatthias Ringwald } else { 2247c839c6f9SMatthias Ringwald characteristic->uuid16 = 0; 22486ba2ad22SMatthias Ringwald } 22496ba2ad22SMatthias Ringwald } 22506ba2ad22SMatthias Ringwald 2251313e337bSMatthias Ringwald void gatt_client_deserialize_characteristic_descriptor(const uint8_t * packet, int offset, gatt_client_characteristic_descriptor_t * descriptor){ 22526ba2ad22SMatthias Ringwald descriptor->handle = little_endian_read_16(packet, offset); 22536ba2ad22SMatthias Ringwald reverse_128(&packet[offset+2], descriptor->uuid128); 2254b4895529SJakob Krantz if (uuid_has_bluetooth_prefix(descriptor->uuid128)){ 2255b4895529SJakob Krantz descriptor->uuid16 = big_endian_read_32(descriptor->uuid128, 0); 2256c839c6f9SMatthias Ringwald } else { 2257c839c6f9SMatthias Ringwald descriptor->uuid16 = 0; 2258b4895529SJakob Krantz } 22596ba2ad22SMatthias Ringwald } 22605cf6c434SJakob Krantz 22615cf6c434SJakob Krantz void gatt_client_send_mtu_negotiation(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 22625cf1669fSMatthias Ringwald gatt_client_t * context = gatt_client_provide_context_for_handle(con_handle); 22637d2258b3SMilanka Ringwald if (context == NULL) return; 22645cf6c434SJakob Krantz if (context->mtu_state == MTU_AUTO_EXCHANGE_DISABLED){ 22655cf6c434SJakob Krantz context->callback = callback; 22665cf6c434SJakob Krantz context->mtu_state = SEND_MTU_EXCHANGE; 22675cf6c434SJakob Krantz gatt_client_run(); 22685cf6c434SJakob Krantz } 22695cf6c434SJakob Krantz } 227047181045SMatthias Ringwald 227147181045SMatthias Ringwald uint8_t gatt_client_request_can_write_without_response_event(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 22725cf1669fSMatthias Ringwald gatt_client_t * context = gatt_client_provide_context_for_handle(con_handle); 22737d2258b3SMilanka Ringwald if (context == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 22747d2258b3SMilanka Ringwald if (context->write_without_response_callback != NULL) return GATT_CLIENT_IN_WRONG_STATE; 227547181045SMatthias Ringwald context->write_without_response_callback = callback; 227647181045SMatthias Ringwald att_dispatch_client_request_can_send_now_event(context->con_handle); 22777d2258b3SMilanka Ringwald return ERROR_CODE_SUCCESS; 227847181045SMatthias Ringwald } 2279a6121b51SMilanka Ringwald 2280a6121b51SMilanka Ringwald #ifdef FUZZING_BUILD_MODE_UNSAFE_FOR_PRODUCTION 2281a6121b51SMilanka Ringwald void gatt_client_att_packet_handler_fuzz(uint8_t packet_type, uint16_t handle, uint8_t *packet, uint16_t size){ 2282a6121b51SMilanka Ringwald gatt_client_att_packet_handler(packet_type, handle, packet, size); 2283a6121b51SMilanka Ringwald } 2284a6121b51SMilanka Ringwald #endif 2285