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> 423deb3ec6SMatthias Ringwald 437907f069SMatthias Ringwald #include "btstack_config.h" 443deb3ec6SMatthias Ringwald 450e2df43fSMatthias Ringwald #include "att_dispatch.h" 46fac60feaSMatthias Ringwald #include "ad_parser.h" 470e2df43fSMatthias Ringwald #include "ble/att_db.h" 4859c6af15SMatthias Ringwald #include "ble/core.h" 490e2df43fSMatthias Ringwald #include "ble/gatt_client.h" 500e2df43fSMatthias Ringwald #include "ble/le_device_db.h" 510e2df43fSMatthias Ringwald #include "ble/sm.h" 5216ece135SMatthias Ringwald #include "btstack_debug.h" 530e2df43fSMatthias Ringwald #include "btstack_event.h" 543deb3ec6SMatthias Ringwald #include "btstack_memory.h" 550e2df43fSMatthias Ringwald #include "btstack_run_loop.h" 560e2df43fSMatthias Ringwald #include "btstack_util.h" 570e2df43fSMatthias Ringwald #include "classic/sdp_util.h" 583deb3ec6SMatthias Ringwald #include "hci.h" 590e2df43fSMatthias Ringwald #include "hci_cmd.h" 603deb3ec6SMatthias Ringwald #include "hci_dump.h" 613deb3ec6SMatthias Ringwald #include "l2cap.h" 623deb3ec6SMatthias Ringwald 639c662c9bSMatthias Ringwald static btstack_linked_list_t gatt_client_connections; 649c662c9bSMatthias Ringwald static btstack_linked_list_t gatt_client_value_listeners; 65361b1363SMatthias Ringwald static btstack_packet_callback_registration_t hci_event_callback_registration; 663deb3ec6SMatthias Ringwald 6772e4a9afSMatthias Ringwald #if defined(ENABLE_GATT_CLIENT_PAIRING) || defined (ENABLE_LE_SIGNED_WRITE) || defined (ENABLE_LE_PROACTIVE_AUTHENTICATION) 68f4b33574SMatthias Ringwald static btstack_packet_callback_registration_t sm_event_callback_registration; 69f4b33574SMatthias Ringwald #endif 70f4b33574SMatthias Ringwald 715cf6c434SJakob Krantz static uint8_t mtu_exchange_enabled; 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; 835cf6c434SJakob Krantz mtu_exchange_enabled = 1; 84f4b33574SMatthias Ringwald 85361b1363SMatthias Ringwald // regsister for HCI Events 86f4b33574SMatthias Ringwald hci_event_callback_registration.callback = &gatt_client_event_packet_handler; 87361b1363SMatthias Ringwald hci_add_event_handler(&hci_event_callback_registration); 88361b1363SMatthias Ringwald 8972e4a9afSMatthias Ringwald #if defined(ENABLE_GATT_CLIENT_PAIRING) || defined (ENABLE_LE_SIGNED_WRITE) || defined (ENABLE_LE_PROACTIVE_AUTHENTICATION) 90f4b33574SMatthias Ringwald // register for SM Events 91f4b33574SMatthias Ringwald sm_event_callback_registration.callback = &gatt_client_event_packet_handler; 92f4b33574SMatthias Ringwald sm_add_event_handler(&sm_event_callback_registration); 93f4b33574SMatthias Ringwald #endif 94f4b33574SMatthias Ringwald 95361b1363SMatthias Ringwald // and ATT Client PDUs 963deb3ec6SMatthias Ringwald att_dispatch_register_client(gatt_client_att_packet_handler); 973deb3ec6SMatthias Ringwald } 983deb3ec6SMatthias Ringwald 99ec820d77SMatthias Ringwald static gatt_client_t * gatt_client_for_timer(btstack_timer_source_t * ts){ 100665d90f2SMatthias Ringwald btstack_linked_list_iterator_t it; 101665d90f2SMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client_connections); 102665d90f2SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 1035cf1669fSMatthias Ringwald gatt_client_t * gatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it); 1045cf1669fSMatthias Ringwald if (&gatt_client->gc_timeout == ts) { 1055cf1669fSMatthias Ringwald return gatt_client; 1063deb3ec6SMatthias Ringwald } 1073deb3ec6SMatthias Ringwald } 1083deb3ec6SMatthias Ringwald return NULL; 1093deb3ec6SMatthias Ringwald } 1103deb3ec6SMatthias Ringwald 111ec820d77SMatthias Ringwald static void gatt_client_timeout_handler(btstack_timer_source_t * timer){ 1125cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_for_timer(timer); 1135cf1669fSMatthias Ringwald if (gatt_client == NULL) return; 1145cf1669fSMatthias Ringwald log_info("GATT client timeout handle, handle 0x%02x", gatt_client->con_handle); 1155cf1669fSMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, ATT_ERROR_TIMEOUT); 1163deb3ec6SMatthias Ringwald } 1173deb3ec6SMatthias Ringwald 1185cf1669fSMatthias Ringwald static void gatt_client_timeout_start(gatt_client_t * gatt_client){ 1195cf1669fSMatthias Ringwald log_info("GATT client timeout start, handle 0x%02x", gatt_client->con_handle); 1205cf1669fSMatthias Ringwald btstack_run_loop_remove_timer(&gatt_client->gc_timeout); 1215cf1669fSMatthias Ringwald btstack_run_loop_set_timer_handler(&gatt_client->gc_timeout, gatt_client_timeout_handler); 1225cf1669fSMatthias Ringwald btstack_run_loop_set_timer(&gatt_client->gc_timeout, 30000); // 30 seconds sm timeout 1235cf1669fSMatthias Ringwald btstack_run_loop_add_timer(&gatt_client->gc_timeout); 1243deb3ec6SMatthias Ringwald } 1253deb3ec6SMatthias Ringwald 1265cf1669fSMatthias Ringwald static void gatt_client_timeout_stop(gatt_client_t * gatt_client){ 1275cf1669fSMatthias Ringwald log_info("GATT client timeout stop, handle 0x%02x", gatt_client->con_handle); 1285cf1669fSMatthias Ringwald btstack_run_loop_remove_timer(&gatt_client->gc_timeout); 1293deb3ec6SMatthias Ringwald } 1303deb3ec6SMatthias Ringwald 1315cf1669fSMatthias Ringwald static gatt_client_t * gatt_client_get_context_for_handle(uint16_t handle){ 132665d90f2SMatthias Ringwald btstack_linked_item_t *it; 133a0da043fSMatthias Ringwald for (it = (btstack_linked_item_t *) gatt_client_connections; it != NULL; it = it->next){ 1345cf1669fSMatthias Ringwald gatt_client_t * gatt_client = (gatt_client_t *) it; 1355cf1669fSMatthias Ringwald if (gatt_client->con_handle == handle){ 1365cf1669fSMatthias Ringwald return gatt_client; 1373deb3ec6SMatthias Ringwald } 1383deb3ec6SMatthias Ringwald } 1393deb3ec6SMatthias Ringwald return NULL; 1403deb3ec6SMatthias Ringwald } 1413deb3ec6SMatthias Ringwald 1423deb3ec6SMatthias Ringwald 1435cf1669fSMatthias Ringwald // @returns gatt_client context 1443deb3ec6SMatthias Ringwald // returns existing one, or tries to setup new one 1455cf1669fSMatthias Ringwald static gatt_client_t * gatt_client_provide_context_for_handle(hci_con_handle_t con_handle){ 1465cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_get_context_for_handle(con_handle); 1475cf1669fSMatthias Ringwald if (gatt_client) return gatt_client; 1483deb3ec6SMatthias Ringwald 149ae1d1237SMatthias Ringwald // bail if no such hci connection 150ae1d1237SMatthias Ringwald if (!hci_connection_for_handle(con_handle)){ 151ae1d1237SMatthias Ringwald log_error("No connection for handle 0x%04x", con_handle); 152ae1d1237SMatthias Ringwald return NULL; 153ae1d1237SMatthias Ringwald } 1545cf1669fSMatthias Ringwald gatt_client = btstack_memory_gatt_client_get(); 1555cf1669fSMatthias Ringwald if (!gatt_client) return NULL; 1563deb3ec6SMatthias Ringwald // init state 1575cf1669fSMatthias Ringwald gatt_client->con_handle = con_handle; 1585cf1669fSMatthias Ringwald gatt_client->mtu = ATT_DEFAULT_MTU; 1595cf6c434SJakob Krantz if (mtu_exchange_enabled){ 1605cf1669fSMatthias Ringwald gatt_client->mtu_state = SEND_MTU_EXCHANGE; 1615cf6c434SJakob Krantz } else { 1625cf1669fSMatthias Ringwald gatt_client->mtu_state = MTU_AUTO_EXCHANGE_DISABLED; 1635cf6c434SJakob Krantz } 1645cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_READY; 1655cf1669fSMatthias Ringwald btstack_linked_list_add(&gatt_client_connections, (btstack_linked_item_t*)gatt_client); 1665cf1669fSMatthias Ringwald return gatt_client; 1673deb3ec6SMatthias Ringwald } 1683deb3ec6SMatthias Ringwald 1695cf1669fSMatthias Ringwald static gatt_client_t * gatt_client_provide_context_for_handle_and_start_timer(hci_con_handle_t con_handle){ 1705cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle(con_handle); 1715cf1669fSMatthias Ringwald if (gatt_client == NULL) return NULL; 1725cf1669fSMatthias Ringwald gatt_client_timeout_start(gatt_client); 1735cf1669fSMatthias Ringwald return gatt_client; 1743deb3ec6SMatthias Ringwald } 1753deb3ec6SMatthias Ringwald 1765cf1669fSMatthias Ringwald static int is_ready(gatt_client_t * gatt_client){ 1775cf1669fSMatthias Ringwald return gatt_client->gatt_client_state == P_READY; 1783deb3ec6SMatthias Ringwald } 1793deb3ec6SMatthias Ringwald 180fc64f94aSMatthias Ringwald int gatt_client_is_ready(hci_con_handle_t con_handle){ 1815cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle(con_handle); 1825cf1669fSMatthias Ringwald if (gatt_client == NULL) return 0; 1835cf1669fSMatthias Ringwald return is_ready(gatt_client); 1843deb3ec6SMatthias Ringwald } 1853deb3ec6SMatthias Ringwald 1865cf6c434SJakob Krantz void gatt_client_mtu_enable_auto_negotiation(uint8_t enabled){ 1875cf6c434SJakob Krantz mtu_exchange_enabled = enabled; 1885cf6c434SJakob Krantz } 1895cf6c434SJakob Krantz 190fc64f94aSMatthias Ringwald uint8_t gatt_client_get_mtu(hci_con_handle_t con_handle, uint16_t * mtu){ 1915cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle(con_handle); 1925cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 1937d2258b3SMilanka Ringwald 1945cf1669fSMatthias Ringwald if ((gatt_client->mtu_state == MTU_EXCHANGED) || (gatt_client->mtu_state == MTU_AUTO_EXCHANGE_DISABLED)){ 1955cf1669fSMatthias Ringwald *mtu = gatt_client->mtu; 1967d2258b3SMilanka Ringwald return ERROR_CODE_SUCCESS; 1973deb3ec6SMatthias Ringwald } 1983deb3ec6SMatthias Ringwald *mtu = ATT_DEFAULT_MTU; 199616edd56SMatthias Ringwald return GATT_CLIENT_IN_WRONG_STATE; 2003deb3ec6SMatthias Ringwald } 2013deb3ec6SMatthias Ringwald 2023deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 2035cf1669fSMatthias Ringwald static uint8_t att_confirmation(uint16_t con_handle){ 2043deb3ec6SMatthias Ringwald l2cap_reserve_packet_buffer(); 2053deb3ec6SMatthias Ringwald uint8_t * request = l2cap_get_outgoing_buffer(); 2063deb3ec6SMatthias Ringwald request[0] = ATT_HANDLE_VALUE_CONFIRMATION; 20725b7c058SMilanka Ringwald 2085cf1669fSMatthias Ringwald return l2cap_send_prepared_connectionless(con_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL, 1); 2093deb3ec6SMatthias Ringwald } 2103deb3ec6SMatthias Ringwald 2113deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 2125cf1669fSMatthias Ringwald static uint8_t att_find_information_request(uint16_t request_type, uint16_t con_handle, uint16_t start_handle, uint16_t end_handle){ 2133deb3ec6SMatthias Ringwald l2cap_reserve_packet_buffer(); 2143deb3ec6SMatthias Ringwald uint8_t * request = l2cap_get_outgoing_buffer(); 2153deb3ec6SMatthias Ringwald request[0] = request_type; 216f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, start_handle); 217f8fbdce0SMatthias Ringwald little_endian_store_16(request, 3, end_handle); 2183deb3ec6SMatthias Ringwald 2195cf1669fSMatthias Ringwald return l2cap_send_prepared_connectionless(con_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL, 5); 2203deb3ec6SMatthias Ringwald } 2213deb3ec6SMatthias Ringwald 2223deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 2235cf1669fSMatthias 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){ 2243deb3ec6SMatthias Ringwald l2cap_reserve_packet_buffer(); 2253deb3ec6SMatthias Ringwald uint8_t * request = l2cap_get_outgoing_buffer(); 2263deb3ec6SMatthias Ringwald 2273deb3ec6SMatthias Ringwald request[0] = request_type; 228f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, start_handle); 229f8fbdce0SMatthias Ringwald little_endian_store_16(request, 3, end_handle); 230f8fbdce0SMatthias Ringwald little_endian_store_16(request, 5, attribute_group_type); 2316535961aSMatthias Ringwald (void)memcpy(&request[7], value, value_size); 2323deb3ec6SMatthias Ringwald 2335cf1669fSMatthias Ringwald return l2cap_send_prepared_connectionless(con_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL, 7u + value_size); 2343deb3ec6SMatthias Ringwald } 2353deb3ec6SMatthias Ringwald 2363deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 2375cf1669fSMatthias 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){ 2383deb3ec6SMatthias Ringwald l2cap_reserve_packet_buffer(); 2393deb3ec6SMatthias Ringwald uint8_t * request = l2cap_get_outgoing_buffer(); 2403deb3ec6SMatthias Ringwald request[0] = request_type; 241f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, start_handle); 242f8fbdce0SMatthias Ringwald little_endian_store_16(request, 3, end_handle); 243f8fbdce0SMatthias Ringwald little_endian_store_16(request, 5, uuid16); 2443deb3ec6SMatthias Ringwald 2455cf1669fSMatthias Ringwald return l2cap_send_prepared_connectionless(con_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL, 7); 2463deb3ec6SMatthias Ringwald } 2473deb3ec6SMatthias Ringwald 2483deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 2495cf1669fSMatthias 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){ 2503deb3ec6SMatthias Ringwald l2cap_reserve_packet_buffer(); 2513deb3ec6SMatthias Ringwald uint8_t * request = l2cap_get_outgoing_buffer(); 2523deb3ec6SMatthias Ringwald request[0] = request_type; 253f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, start_handle); 254f8fbdce0SMatthias Ringwald little_endian_store_16(request, 3, end_handle); 2559c80e4ccSMatthias Ringwald reverse_128(uuid128, &request[5]); 2563deb3ec6SMatthias Ringwald 2575cf1669fSMatthias Ringwald return l2cap_send_prepared_connectionless(con_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL, 21); 2583deb3ec6SMatthias Ringwald } 2593deb3ec6SMatthias Ringwald 2603deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 2615cf1669fSMatthias Ringwald static uint8_t att_read_request(uint16_t request_type, uint16_t con_handle, uint16_t attribute_handle){ 2623deb3ec6SMatthias Ringwald l2cap_reserve_packet_buffer(); 2633deb3ec6SMatthias Ringwald uint8_t * request = l2cap_get_outgoing_buffer(); 2643deb3ec6SMatthias Ringwald request[0] = request_type; 265f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, attribute_handle); 2663deb3ec6SMatthias Ringwald 2675cf1669fSMatthias Ringwald return l2cap_send_prepared_connectionless(con_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL, 3); 2683deb3ec6SMatthias Ringwald } 2693deb3ec6SMatthias Ringwald 2703deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 2715cf1669fSMatthias Ringwald static uint8_t att_read_blob_request(uint16_t request_type, uint16_t con_handle, uint16_t attribute_handle, uint16_t value_offset){ 2723deb3ec6SMatthias Ringwald l2cap_reserve_packet_buffer(); 2733deb3ec6SMatthias Ringwald uint8_t * request = l2cap_get_outgoing_buffer(); 2743deb3ec6SMatthias Ringwald request[0] = request_type; 275f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, attribute_handle); 276f8fbdce0SMatthias Ringwald little_endian_store_16(request, 3, value_offset); 2773deb3ec6SMatthias Ringwald 2785cf1669fSMatthias Ringwald return l2cap_send_prepared_connectionless(con_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL, 5); 2793deb3ec6SMatthias Ringwald } 2803deb3ec6SMatthias Ringwald 2815cf1669fSMatthias Ringwald static uint8_t att_read_multiple_request(uint16_t con_handle, uint16_t num_value_handles, uint16_t * value_handles){ 2823deb3ec6SMatthias Ringwald l2cap_reserve_packet_buffer(); 2833deb3ec6SMatthias Ringwald uint8_t * request = l2cap_get_outgoing_buffer(); 2843deb3ec6SMatthias Ringwald request[0] = ATT_READ_MULTIPLE_REQUEST; 2853deb3ec6SMatthias Ringwald int i; 2863deb3ec6SMatthias Ringwald int offset = 1; 2873deb3ec6SMatthias Ringwald for (i=0;i<num_value_handles;i++){ 288f8fbdce0SMatthias Ringwald little_endian_store_16(request, offset, value_handles[i]); 2893deb3ec6SMatthias Ringwald offset += 2; 2903deb3ec6SMatthias Ringwald } 29125b7c058SMilanka Ringwald 2925cf1669fSMatthias Ringwald return l2cap_send_prepared_connectionless(con_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL, offset); 2933deb3ec6SMatthias Ringwald } 2943deb3ec6SMatthias Ringwald 2957a766ebfSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 2963deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 2975cf1669fSMatthias 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]){ 2983deb3ec6SMatthias Ringwald l2cap_reserve_packet_buffer(); 2993deb3ec6SMatthias Ringwald uint8_t * request = l2cap_get_outgoing_buffer(); 3003deb3ec6SMatthias Ringwald request[0] = request_type; 301f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, attribute_handle); 3026535961aSMatthias Ringwald (void)memcpy(&request[3], value, value_length); 303f8fbdce0SMatthias Ringwald little_endian_store_32(request, 3 + value_length, sign_counter); 3049c80e4ccSMatthias Ringwald reverse_64(sgn, &request[3 + value_length + 4]); 30525b7c058SMilanka Ringwald 3065cf1669fSMatthias Ringwald return l2cap_send_prepared_connectionless(con_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL, 3 + value_length + 12); 3073deb3ec6SMatthias Ringwald } 3087a766ebfSMatthias Ringwald #endif 3093deb3ec6SMatthias Ringwald 3103deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 3115cf1669fSMatthias 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){ 3123deb3ec6SMatthias Ringwald l2cap_reserve_packet_buffer(); 3133deb3ec6SMatthias Ringwald uint8_t * request = l2cap_get_outgoing_buffer(); 3143deb3ec6SMatthias Ringwald request[0] = request_type; 315f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, attribute_handle); 3166535961aSMatthias Ringwald (void)memcpy(&request[3], value, value_length); 3173deb3ec6SMatthias Ringwald 3185cf1669fSMatthias Ringwald return l2cap_send_prepared_connectionless(con_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL, 3u + value_length); 3193deb3ec6SMatthias Ringwald } 3203deb3ec6SMatthias Ringwald 3213deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 3225cf1669fSMatthias Ringwald static uint8_t att_execute_write_request(uint16_t request_type, uint16_t con_handle, uint8_t execute_write){ 3233deb3ec6SMatthias Ringwald l2cap_reserve_packet_buffer(); 3243deb3ec6SMatthias Ringwald uint8_t * request = l2cap_get_outgoing_buffer(); 3253deb3ec6SMatthias Ringwald request[0] = request_type; 3263deb3ec6SMatthias Ringwald request[1] = execute_write; 32725b7c058SMilanka Ringwald 3285cf1669fSMatthias Ringwald return l2cap_send_prepared_connectionless(con_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL, 2); 3293deb3ec6SMatthias Ringwald } 3303deb3ec6SMatthias Ringwald 3313deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 3325cf1669fSMatthias 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){ 3333deb3ec6SMatthias Ringwald l2cap_reserve_packet_buffer(); 3343deb3ec6SMatthias Ringwald uint8_t * request = l2cap_get_outgoing_buffer(); 3353deb3ec6SMatthias Ringwald request[0] = request_type; 336f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, attribute_handle); 337f8fbdce0SMatthias Ringwald little_endian_store_16(request, 3, value_offset); 3386535961aSMatthias Ringwald (void)memcpy(&request[5], &value[value_offset], blob_length); 3393deb3ec6SMatthias Ringwald 3405cf1669fSMatthias Ringwald return l2cap_send_prepared_connectionless(con_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL, 5u + blob_length); 3413deb3ec6SMatthias Ringwald } 3423deb3ec6SMatthias Ringwald 3435cf1669fSMatthias Ringwald static uint8_t att_exchange_mtu_request(uint16_t con_handle){ 3443deb3ec6SMatthias Ringwald uint16_t mtu = l2cap_max_le_mtu(); 3453deb3ec6SMatthias Ringwald l2cap_reserve_packet_buffer(); 3463deb3ec6SMatthias Ringwald uint8_t * request = l2cap_get_outgoing_buffer(); 3473deb3ec6SMatthias Ringwald request[0] = ATT_EXCHANGE_MTU_REQUEST; 348f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, mtu); 34925b7c058SMilanka Ringwald 3505cf1669fSMatthias Ringwald return l2cap_send_prepared_connectionless(con_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL, 3); 3513deb3ec6SMatthias Ringwald } 3523deb3ec6SMatthias Ringwald 3535cf1669fSMatthias Ringwald static uint16_t write_blob_length(gatt_client_t * gatt_client){ 354dda77937SMatthias Ringwald uint16_t max_blob_length = gatt_client->mtu - 5u; 3555cf1669fSMatthias Ringwald if (gatt_client->attribute_offset >= gatt_client->attribute_length) { 3563deb3ec6SMatthias Ringwald return 0; 3573deb3ec6SMatthias Ringwald } 3585cf1669fSMatthias Ringwald uint16_t rest_length = gatt_client->attribute_length - gatt_client->attribute_offset; 3593deb3ec6SMatthias Ringwald if (max_blob_length > rest_length){ 3603deb3ec6SMatthias Ringwald return rest_length; 3613deb3ec6SMatthias Ringwald } 3623deb3ec6SMatthias Ringwald return max_blob_length; 3633deb3ec6SMatthias Ringwald } 3643deb3ec6SMatthias Ringwald 3655cf1669fSMatthias Ringwald static void send_gatt_services_request(gatt_client_t *gatt_client){ 3665cf1669fSMatthias 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); 3673deb3ec6SMatthias Ringwald } 3683deb3ec6SMatthias Ringwald 3695cf1669fSMatthias Ringwald static void send_gatt_by_uuid_request(gatt_client_t *gatt_client, uint16_t attribute_group_type){ 3705cf1669fSMatthias Ringwald if (gatt_client->uuid16){ 3713deb3ec6SMatthias Ringwald uint8_t uuid16[2]; 3725cf1669fSMatthias Ringwald little_endian_store_16(uuid16, 0, gatt_client->uuid16); 3735cf1669fSMatthias 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); 3743deb3ec6SMatthias Ringwald return; 3753deb3ec6SMatthias Ringwald } 3763deb3ec6SMatthias Ringwald uint8_t uuid128[16]; 3775cf1669fSMatthias Ringwald reverse_128(gatt_client->uuid128, uuid128); 3785cf1669fSMatthias 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); 3793deb3ec6SMatthias Ringwald } 3803deb3ec6SMatthias Ringwald 3815cf1669fSMatthias Ringwald static void send_gatt_services_by_uuid_request(gatt_client_t *gatt_client){ 3825cf1669fSMatthias Ringwald send_gatt_by_uuid_request(gatt_client, GATT_PRIMARY_SERVICE_UUID); 3833deb3ec6SMatthias Ringwald } 3843deb3ec6SMatthias Ringwald 3855cf1669fSMatthias Ringwald static void send_gatt_included_service_uuid_request(gatt_client_t *gatt_client){ 3865cf1669fSMatthias Ringwald att_read_request(ATT_READ_REQUEST, gatt_client->con_handle, gatt_client->query_start_handle); 3873deb3ec6SMatthias Ringwald } 3883deb3ec6SMatthias Ringwald 3895cf1669fSMatthias Ringwald static void send_gatt_included_service_request(gatt_client_t *gatt_client){ 3905cf1669fSMatthias 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); 3913deb3ec6SMatthias Ringwald } 3923deb3ec6SMatthias Ringwald 3935cf1669fSMatthias Ringwald static void send_gatt_characteristic_request(gatt_client_t *gatt_client){ 3945cf1669fSMatthias 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); 3953deb3ec6SMatthias Ringwald } 3963deb3ec6SMatthias Ringwald 3975cf1669fSMatthias Ringwald static void send_gatt_characteristic_descriptor_request(gatt_client_t *gatt_client){ 3985cf1669fSMatthias Ringwald att_find_information_request(ATT_FIND_INFORMATION_REQUEST, gatt_client->con_handle, gatt_client->start_group_handle, gatt_client->end_group_handle); 3993deb3ec6SMatthias Ringwald } 4003deb3ec6SMatthias Ringwald 4015cf1669fSMatthias Ringwald static void send_gatt_read_characteristic_value_request(gatt_client_t *gatt_client){ 4025cf1669fSMatthias Ringwald att_read_request(ATT_READ_REQUEST, gatt_client->con_handle, gatt_client->attribute_handle); 4033deb3ec6SMatthias Ringwald } 4043deb3ec6SMatthias Ringwald 4055cf1669fSMatthias Ringwald static void send_gatt_read_by_type_request(gatt_client_t * gatt_client){ 4065cf1669fSMatthias Ringwald if (gatt_client->uuid16){ 4075cf1669fSMatthias 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); 4083deb3ec6SMatthias Ringwald } else { 4095cf1669fSMatthias 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); 4103deb3ec6SMatthias Ringwald } 4113deb3ec6SMatthias Ringwald } 4123deb3ec6SMatthias Ringwald 4135cf1669fSMatthias Ringwald static void send_gatt_read_blob_request(gatt_client_t *gatt_client){ 4145cf1669fSMatthias Ringwald att_read_blob_request(ATT_READ_BLOB_REQUEST, gatt_client->con_handle, gatt_client->attribute_handle, gatt_client->attribute_offset); 4153deb3ec6SMatthias Ringwald } 4163deb3ec6SMatthias Ringwald 4175cf1669fSMatthias Ringwald static void send_gatt_read_multiple_request(gatt_client_t * gatt_client){ 4185cf1669fSMatthias Ringwald att_read_multiple_request(gatt_client->con_handle, gatt_client->read_multiple_handle_count, gatt_client->read_multiple_handles); 4193deb3ec6SMatthias Ringwald } 4203deb3ec6SMatthias Ringwald 4215cf1669fSMatthias Ringwald static void send_gatt_write_attribute_value_request(gatt_client_t * gatt_client){ 4225cf1669fSMatthias Ringwald att_write_request(ATT_WRITE_REQUEST, gatt_client->con_handle, gatt_client->attribute_handle, gatt_client->attribute_length, gatt_client->attribute_value); 4233deb3ec6SMatthias Ringwald } 4243deb3ec6SMatthias Ringwald 4255cf1669fSMatthias Ringwald static void send_gatt_write_client_characteristic_configuration_request(gatt_client_t * gatt_client){ 4265cf1669fSMatthias Ringwald att_write_request(ATT_WRITE_REQUEST, gatt_client->con_handle, gatt_client->client_characteristic_configuration_handle, 2, gatt_client->client_characteristic_configuration_value); 4273deb3ec6SMatthias Ringwald } 4283deb3ec6SMatthias Ringwald 4295cf1669fSMatthias Ringwald static void send_gatt_prepare_write_request(gatt_client_t * gatt_client){ 4305cf1669fSMatthias 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); 4313deb3ec6SMatthias Ringwald } 4323deb3ec6SMatthias Ringwald 4335cf1669fSMatthias Ringwald static void send_gatt_execute_write_request(gatt_client_t * gatt_client){ 4345cf1669fSMatthias Ringwald att_execute_write_request(ATT_EXECUTE_WRITE_REQUEST, gatt_client->con_handle, 1); 4353deb3ec6SMatthias Ringwald } 4363deb3ec6SMatthias Ringwald 4375cf1669fSMatthias Ringwald static void send_gatt_cancel_prepared_write_request(gatt_client_t * gatt_client){ 4385cf1669fSMatthias Ringwald att_execute_write_request(ATT_EXECUTE_WRITE_REQUEST, gatt_client->con_handle, 0); 4393deb3ec6SMatthias Ringwald } 4403deb3ec6SMatthias Ringwald 441abdc9fb5SMatthias Ringwald #ifndef ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY 4425cf1669fSMatthias Ringwald static void send_gatt_read_client_characteristic_configuration_request(gatt_client_t * gatt_client){ 4435cf1669fSMatthias 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); 4443deb3ec6SMatthias Ringwald } 445abdc9fb5SMatthias Ringwald #endif 4463deb3ec6SMatthias Ringwald 4475cf1669fSMatthias Ringwald static void send_gatt_read_characteristic_descriptor_request(gatt_client_t * gatt_client){ 4485cf1669fSMatthias Ringwald att_read_request(ATT_READ_REQUEST, gatt_client->con_handle, gatt_client->attribute_handle); 4493deb3ec6SMatthias Ringwald } 4503deb3ec6SMatthias Ringwald 4517a766ebfSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 4525cf1669fSMatthias Ringwald static void send_gatt_signed_write_request(gatt_client_t * gatt_client, uint32_t sign_counter){ 4535cf1669fSMatthias 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); 4543deb3ec6SMatthias Ringwald } 4557a766ebfSMatthias Ringwald #endif 4563deb3ec6SMatthias Ringwald 4573deb3ec6SMatthias Ringwald static uint16_t get_last_result_handle_from_service_list(uint8_t * packet, uint16_t size){ 4583deb3ec6SMatthias Ringwald uint8_t attr_length = packet[1]; 4594ea43905SMatthias Ringwald return little_endian_read_16(packet, size - attr_length + 2u); 4603deb3ec6SMatthias Ringwald } 4613deb3ec6SMatthias Ringwald 4623deb3ec6SMatthias Ringwald static uint16_t get_last_result_handle_from_characteristics_list(uint8_t * packet, uint16_t size){ 4633deb3ec6SMatthias Ringwald uint8_t attr_length = packet[1]; 4644ea43905SMatthias Ringwald return little_endian_read_16(packet, size - attr_length + 3u); 4653deb3ec6SMatthias Ringwald } 4663deb3ec6SMatthias Ringwald 4673deb3ec6SMatthias Ringwald static uint16_t get_last_result_handle_from_included_services_list(uint8_t * packet, uint16_t size){ 4683deb3ec6SMatthias Ringwald uint8_t attr_length = packet[1]; 469f8fbdce0SMatthias Ringwald return little_endian_read_16(packet, size - attr_length); 4703deb3ec6SMatthias Ringwald } 4713deb3ec6SMatthias Ringwald 4725cf1669fSMatthias Ringwald static void gatt_client_handle_transaction_complete(gatt_client_t * gatt_client){ 4735cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_READY; 4745cf1669fSMatthias Ringwald gatt_client_timeout_stop(gatt_client); 4753deb3ec6SMatthias Ringwald } 4763deb3ec6SMatthias Ringwald 4779c662c9bSMatthias Ringwald static void emit_event_new(btstack_packet_handler_t callback, uint8_t * packet, uint16_t size){ 4789c662c9bSMatthias Ringwald if (!callback) return; 479b6e003bcSMatthias Ringwald hci_dump_packet(HCI_EVENT_PACKET, 0, packet, size); 4809c662c9bSMatthias Ringwald (*callback)(HCI_EVENT_PACKET, 0, packet, size); 4813deb3ec6SMatthias Ringwald } 4823deb3ec6SMatthias Ringwald 48386c38559SMatthias 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){ 48486c38559SMatthias Ringwald notification->callback = packet_handler; 4859c662c9bSMatthias Ringwald notification->con_handle = con_handle; 486b3f03c84SMatthias Ringwald if (characteristic == NULL){ 487b3f03c84SMatthias Ringwald notification->attribute_handle = GATT_CLIENT_ANY_VALUE_HANDLE; 488b3f03c84SMatthias Ringwald } else { 4899c662c9bSMatthias Ringwald notification->attribute_handle = characteristic->value_handle; 490b3f03c84SMatthias Ringwald } 4919c662c9bSMatthias Ringwald btstack_linked_list_add(&gatt_client_value_listeners, (btstack_linked_item_t*) notification); 4929c662c9bSMatthias Ringwald } 4939c662c9bSMatthias Ringwald 4941f734b5fSMatthias Ringwald void gatt_client_stop_listening_for_characteristic_value_updates(gatt_client_notification_t * notification){ 4951f734b5fSMatthias Ringwald btstack_linked_list_remove(&gatt_client_value_listeners, (btstack_linked_item_t*) notification); 4961f734b5fSMatthias Ringwald } 4971f734b5fSMatthias Ringwald 498711e6c80SMatthias Ringwald static void emit_event_to_registered_listeners(hci_con_handle_t con_handle, uint16_t attribute_handle, uint8_t * packet, uint16_t size){ 499665d90f2SMatthias Ringwald btstack_linked_list_iterator_t it; 5009c662c9bSMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client_value_listeners); 501665d90f2SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 50286c38559SMatthias Ringwald gatt_client_notification_t * notification = (gatt_client_notification_t*) btstack_linked_list_iterator_next(&it); 503b3f03c84SMatthias Ringwald if ((notification->con_handle != GATT_CLIENT_ANY_CONNECTION) && (notification->con_handle != con_handle)) continue; 504b3f03c84SMatthias Ringwald if ((notification->attribute_handle != GATT_CLIENT_ANY_VALUE_HANDLE) && (notification->attribute_handle != attribute_handle)) continue; 50586c38559SMatthias Ringwald (*notification->callback)(HCI_EVENT_PACKET, 0, packet, size); 5063deb3ec6SMatthias Ringwald } 5073deb3ec6SMatthias Ringwald } 5083deb3ec6SMatthias Ringwald 5095cf1669fSMatthias Ringwald static void emit_gatt_complete_event(gatt_client_t * gatt_client, uint8_t att_status){ 5103deb3ec6SMatthias Ringwald // @format H1 5113deb3ec6SMatthias Ringwald uint8_t packet[5]; 5125611a760SMatthias Ringwald packet[0] = GATT_EVENT_QUERY_COMPLETE; 5133deb3ec6SMatthias Ringwald packet[1] = 3; 5145cf1669fSMatthias Ringwald little_endian_store_16(packet, 2, gatt_client->con_handle); 5157d2258b3SMilanka Ringwald packet[4] = att_status; 5165cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, sizeof(packet)); 5173deb3ec6SMatthias Ringwald } 5183deb3ec6SMatthias Ringwald 5195cf1669fSMatthias 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){ 5203deb3ec6SMatthias Ringwald // @format HX 5213deb3ec6SMatthias Ringwald uint8_t packet[24]; 5225611a760SMatthias Ringwald packet[0] = GATT_EVENT_SERVICE_QUERY_RESULT; 5234ea43905SMatthias Ringwald packet[1] = sizeof(packet) - 2u; 5245cf1669fSMatthias Ringwald little_endian_store_16(packet, 2, gatt_client->con_handle); 5253deb3ec6SMatthias Ringwald /// 526f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 4, start_group_handle); 527f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 6, end_group_handle); 5289c80e4ccSMatthias Ringwald reverse_128(uuid128, &packet[8]); 5295cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, sizeof(packet)); 5303deb3ec6SMatthias Ringwald } 5313deb3ec6SMatthias Ringwald 5325cf1669fSMatthias 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){ 5333deb3ec6SMatthias Ringwald // @format HX 5343deb3ec6SMatthias Ringwald uint8_t packet[26]; 5355611a760SMatthias Ringwald packet[0] = GATT_EVENT_INCLUDED_SERVICE_QUERY_RESULT; 5364ea43905SMatthias Ringwald packet[1] = sizeof(packet) - 2u; 5375cf1669fSMatthias Ringwald little_endian_store_16(packet, 2, gatt_client->con_handle); 5383deb3ec6SMatthias Ringwald /// 539f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 4, include_handle); 5403deb3ec6SMatthias Ringwald // 541f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 6, start_group_handle); 542f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 8, end_group_handle); 5439c80e4ccSMatthias Ringwald reverse_128(uuid128, &packet[10]); 5445cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, sizeof(packet)); 5453deb3ec6SMatthias Ringwald } 5463deb3ec6SMatthias Ringwald 5475cf1669fSMatthias 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, 5483deb3ec6SMatthias Ringwald uint16_t properties, uint8_t * uuid128){ 5493deb3ec6SMatthias Ringwald // @format HY 5503deb3ec6SMatthias Ringwald uint8_t packet[28]; 5515611a760SMatthias Ringwald packet[0] = GATT_EVENT_CHARACTERISTIC_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, start_handle); 556f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 6, value_handle); 557f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 8, end_handle); 558f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 10, properties); 5599c80e4ccSMatthias Ringwald reverse_128(uuid128, &packet[12]); 5605cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, sizeof(packet)); 5613deb3ec6SMatthias Ringwald } 5623deb3ec6SMatthias Ringwald 5633deb3ec6SMatthias Ringwald static void emit_gatt_all_characteristic_descriptors_result_event( 5645cf1669fSMatthias Ringwald gatt_client_t * gatt_client, uint16_t descriptor_handle, uint8_t * uuid128){ 5653deb3ec6SMatthias Ringwald // @format HZ 5663deb3ec6SMatthias Ringwald uint8_t packet[22]; 5675611a760SMatthias Ringwald packet[0] = GATT_EVENT_ALL_CHARACTERISTIC_DESCRIPTORS_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, descriptor_handle); 5729c80e4ccSMatthias Ringwald reverse_128(uuid128, &packet[6]); 5735cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, sizeof(packet)); 5743deb3ec6SMatthias Ringwald } 5753deb3ec6SMatthias Ringwald 5765cf1669fSMatthias Ringwald static void emit_gatt_mtu_exchanged_result_event(gatt_client_t * gatt_client, uint16_t new_mtu){ 5778f37572aSJakob Krantz // @format H2 5788f37572aSJakob Krantz uint8_t packet[6]; 5798f37572aSJakob Krantz packet[0] = GATT_EVENT_MTU; 5804ea43905SMatthias Ringwald packet[1] = sizeof(packet) - 2u; 5815cf1669fSMatthias Ringwald little_endian_store_16(packet, 2, gatt_client->con_handle); 5828f37572aSJakob Krantz little_endian_store_16(packet, 4, new_mtu); 5835cf1669fSMatthias Ringwald att_dispatch_client_mtu_exchanged(gatt_client->con_handle, new_mtu); 5845cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, sizeof(packet)); 5858f37572aSJakob Krantz } 5868f37572aSJakob Krantz /// 5875cf1669fSMatthias Ringwald static void report_gatt_services(gatt_client_t * gatt_client, uint8_t * packet, uint16_t size){ 5883deb3ec6SMatthias Ringwald uint8_t attr_length = packet[1]; 5894ea43905SMatthias Ringwald uint8_t uuid_length = attr_length - 4u; 5903deb3ec6SMatthias Ringwald 5913deb3ec6SMatthias Ringwald int i; 5923deb3ec6SMatthias Ringwald for (i = 2; i < size; i += attr_length){ 593f8fbdce0SMatthias Ringwald uint16_t start_group_handle = little_endian_read_16(packet,i); 594f8fbdce0SMatthias Ringwald uint16_t end_group_handle = little_endian_read_16(packet,i+2); 5953deb3ec6SMatthias Ringwald uint8_t uuid128[16]; 5963deb3ec6SMatthias Ringwald uint16_t uuid16 = 0; 5973deb3ec6SMatthias Ringwald 5984ea43905SMatthias Ringwald if (uuid_length == 2u){ 599f8fbdce0SMatthias Ringwald uuid16 = little_endian_read_16(packet, i+4); 600e1a125dfSMatthias Ringwald uuid_add_bluetooth_prefix((uint8_t*) &uuid128, uuid16); 6013deb3ec6SMatthias Ringwald } else { 6029c80e4ccSMatthias Ringwald reverse_128(&packet[i+4], uuid128); 6033deb3ec6SMatthias Ringwald } 6045cf1669fSMatthias Ringwald emit_gatt_service_query_result_event(gatt_client, start_group_handle, end_group_handle, uuid128); 6053deb3ec6SMatthias Ringwald } 6063deb3ec6SMatthias Ringwald } 6073deb3ec6SMatthias Ringwald 6083deb3ec6SMatthias Ringwald // helper 6095cf1669fSMatthias 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){ 6103deb3ec6SMatthias Ringwald uint8_t uuid128[16]; 6113deb3ec6SMatthias Ringwald uint16_t uuid16 = 0; 6124ea43905SMatthias Ringwald if (uuid_length == 2u){ 613f8fbdce0SMatthias Ringwald uuid16 = little_endian_read_16(uuid, 0); 614e1a125dfSMatthias Ringwald uuid_add_bluetooth_prefix((uint8_t*) uuid128, uuid16); 6154ea43905SMatthias Ringwald } else if (uuid_length == 16u){ 6169c80e4ccSMatthias Ringwald reverse_128(uuid, uuid128); 617d73c9dbeSMilanka Ringwald } else { 618d73c9dbeSMilanka Ringwald return; 6193deb3ec6SMatthias Ringwald } 6203deb3ec6SMatthias Ringwald 6215cf1669fSMatthias Ringwald if (gatt_client->filter_with_uuid && (memcmp(gatt_client->uuid128, uuid128, 16) != 0)) return; 6223deb3ec6SMatthias Ringwald 6235cf1669fSMatthias Ringwald gatt_client->characteristic_properties = properties; 6245cf1669fSMatthias Ringwald gatt_client->characteristic_start_handle = start_handle; 6255cf1669fSMatthias Ringwald gatt_client->attribute_handle = value_handle; 6263deb3ec6SMatthias Ringwald 6275cf1669fSMatthias Ringwald if (gatt_client->filter_with_uuid) return; 6283deb3ec6SMatthias Ringwald 6295cf1669fSMatthias Ringwald gatt_client->uuid16 = uuid16; 6305cf1669fSMatthias Ringwald (void)memcpy(gatt_client->uuid128, uuid128, 16); 6313deb3ec6SMatthias Ringwald } 6323deb3ec6SMatthias Ringwald 6335cf1669fSMatthias Ringwald static void characteristic_end_found(gatt_client_t * gatt_client, uint16_t end_handle){ 6343deb3ec6SMatthias Ringwald // TODO: stop searching if filter and uuid found 6353deb3ec6SMatthias Ringwald 6365cf1669fSMatthias Ringwald if (!gatt_client->characteristic_start_handle) return; 6373deb3ec6SMatthias Ringwald 6385cf1669fSMatthias Ringwald emit_gatt_characteristic_query_result_event(gatt_client, gatt_client->characteristic_start_handle, gatt_client->attribute_handle, 6395cf1669fSMatthias Ringwald end_handle, gatt_client->characteristic_properties, gatt_client->uuid128); 6403deb3ec6SMatthias Ringwald 6415cf1669fSMatthias Ringwald gatt_client->characteristic_start_handle = 0; 6423deb3ec6SMatthias Ringwald } 6433deb3ec6SMatthias Ringwald 6445cf1669fSMatthias Ringwald static void report_gatt_characteristics(gatt_client_t * gatt_client, uint8_t * packet, uint16_t size){ 6454ea43905SMatthias Ringwald if (size < 2u) return; 6463deb3ec6SMatthias Ringwald uint8_t attr_length = packet[1]; 6474ea43905SMatthias Ringwald if ((attr_length != 7u) && (attr_length != 21u)) return; 6484ea43905SMatthias Ringwald uint8_t uuid_length = attr_length - 5u; 6493deb3ec6SMatthias Ringwald int i; 6504ea43905SMatthias Ringwald for (i = 2u; (i + attr_length) <= size; i += attr_length){ 651f8fbdce0SMatthias Ringwald uint16_t start_handle = little_endian_read_16(packet, i); 6523deb3ec6SMatthias Ringwald uint8_t properties = packet[i+2]; 653f8fbdce0SMatthias Ringwald uint16_t value_handle = little_endian_read_16(packet, i+3); 6545cf1669fSMatthias Ringwald characteristic_end_found(gatt_client, start_handle - 1u); 6555cf1669fSMatthias Ringwald characteristic_start_found(gatt_client, start_handle, properties, value_handle, &packet[i + 5], uuid_length); 6563deb3ec6SMatthias Ringwald } 6573deb3ec6SMatthias Ringwald } 6583deb3ec6SMatthias Ringwald 6595cf1669fSMatthias Ringwald static void report_gatt_included_service_uuid16(gatt_client_t * gatt_client, uint16_t include_handle, uint16_t uuid16){ 6603deb3ec6SMatthias Ringwald uint8_t normalized_uuid128[16]; 661e1a125dfSMatthias Ringwald uuid_add_bluetooth_prefix(normalized_uuid128, uuid16); 6625cf1669fSMatthias Ringwald emit_gatt_included_service_query_result_event(gatt_client, include_handle, gatt_client->query_start_handle, 6635cf1669fSMatthias Ringwald gatt_client->query_end_handle, normalized_uuid128); 6643deb3ec6SMatthias Ringwald } 6653deb3ec6SMatthias Ringwald 6665cf1669fSMatthias Ringwald static void report_gatt_included_service_uuid128(gatt_client_t * gatt_client, uint16_t include_handle, uint8_t *uuid128){ 6675cf1669fSMatthias Ringwald emit_gatt_included_service_query_result_event(gatt_client, include_handle, gatt_client->query_start_handle, 6685cf1669fSMatthias Ringwald gatt_client->query_end_handle, uuid128); 6693deb3ec6SMatthias Ringwald } 6703deb3ec6SMatthias Ringwald 6713deb3ec6SMatthias Ringwald // @returns packet pointer 6723deb3ec6SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite HCI + L2CAP packet headers 6733deb3ec6SMatthias Ringwald static const int characteristic_value_event_header_size = 8; 674711e6c80SMatthias 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){ 675a6121b51SMilanka Ringwald #ifdef FUZZING_BUILD_MODE_UNSAFE_FOR_PRODUCTION 676a6121b51SMilanka Ringwald // avoid using pre ATT headers. 677a6121b51SMilanka Ringwald return NULL; 678a6121b51SMilanka Ringwald #endif 6793deb3ec6SMatthias Ringwald // before the value inside the ATT PDU 6803deb3ec6SMatthias Ringwald uint8_t * packet = value - characteristic_value_event_header_size; 6813deb3ec6SMatthias Ringwald packet[0] = type; 6823deb3ec6SMatthias Ringwald packet[1] = characteristic_value_event_header_size - 2 + length; 683f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 2, con_handle); 684f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 4, attribute_handle); 685f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 6, length); 6863deb3ec6SMatthias Ringwald return packet; 6873deb3ec6SMatthias Ringwald } 6883deb3ec6SMatthias Ringwald 6893deb3ec6SMatthias Ringwald // @returns packet pointer 6903deb3ec6SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite parts of the HCI/L2CAP/ATT packet (4/4/3) bytes 6913deb3ec6SMatthias Ringwald static const int long_characteristic_value_event_header_size = 10; 692711e6c80SMatthias 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){ 693a6121b51SMilanka Ringwald #ifdef FUZZING_BUILD_MODE_UNSAFE_FOR_PRODUCTION 694a6121b51SMilanka Ringwald // avoid using pre ATT headers. 695a6121b51SMilanka Ringwald return NULL; 696a6121b51SMilanka Ringwald #endif 6973deb3ec6SMatthias Ringwald #if defined(HCI_INCOMING_PRE_BUFFER_SIZE) && (HCI_INCOMING_PRE_BUFFER_SIZE >= 10 - 8) // L2CAP Header (4) - ACL Header (4) 6983deb3ec6SMatthias Ringwald // before the value inside the ATT PDU 6993deb3ec6SMatthias Ringwald uint8_t * packet = value - long_characteristic_value_event_header_size; 7003deb3ec6SMatthias Ringwald packet[0] = type; 7013deb3ec6SMatthias Ringwald packet[1] = long_characteristic_value_event_header_size - 2 + length; 702f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 2, con_handle); 703f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 4, attribute_handle); 704f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 6, offset); 705f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 8, length); 7063deb3ec6SMatthias Ringwald return packet; 7073deb3ec6SMatthias Ringwald #else 7083deb3ec6SMatthias Ringwald log_error("HCI_INCOMING_PRE_BUFFER_SIZE >= 2 required for long characteristic reads"); 7093deb3ec6SMatthias Ringwald return NULL; 7103deb3ec6SMatthias Ringwald #endif 7113deb3ec6SMatthias Ringwald } 7123deb3ec6SMatthias Ringwald 713c90e270fSMatthias Ringwald // test if notification/indication should be delivered to application (BLESA) 714c90e270fSMatthias Ringwald static bool gatt_client_accept_server_message(hci_con_handle_t con_handle){ 715b15d5ceaSMatthias Ringwald #ifdef ENABLE_LE_PROACTIVE_AUTHENTICATION 716b15d5ceaSMatthias Ringwald // ignore messages until re-encryption is complete 717c90e270fSMatthias Ringwald if (gap_reconnect_security_setup_active(con_handle)) return false; 718c90e270fSMatthias Ringwald 719c90e270fSMatthias Ringwald // after that ignore if bonded but not encrypted 720c90e270fSMatthias Ringwald return !gap_bonded(con_handle) || (gap_encryption_key_size(con_handle) > 0); 721c90e270fSMatthias Ringwald #else 722c90e270fSMatthias Ringwald return true; 723c90e270fSMatthias Ringwald #endif 724c90e270fSMatthias Ringwald } 725c90e270fSMatthias Ringwald 7263deb3ec6SMatthias Ringwald 7273deb3ec6SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite parts of the HCI/L2CAP/ATT packet (4/4/3) bytes 728711e6c80SMatthias Ringwald static void report_gatt_notification(hci_con_handle_t con_handle, uint16_t value_handle, uint8_t * value, int length){ 729c90e270fSMatthias Ringwald if (!gatt_client_accept_server_message(con_handle)) return; 7305611a760SMatthias Ringwald uint8_t * packet = setup_characteristic_value_packet(GATT_EVENT_NOTIFICATION, con_handle, value_handle, value, length); 7319c662c9bSMatthias Ringwald emit_event_to_registered_listeners(con_handle, value_handle, packet, characteristic_value_event_header_size + length); 7323deb3ec6SMatthias Ringwald } 7333deb3ec6SMatthias Ringwald 7343deb3ec6SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite parts of the HCI/L2CAP/ATT packet (4/4/3) bytes 735711e6c80SMatthias Ringwald static void report_gatt_indication(hci_con_handle_t con_handle, uint16_t value_handle, uint8_t * value, int length){ 736c90e270fSMatthias Ringwald if (!gatt_client_accept_server_message(con_handle)) return; 7375611a760SMatthias Ringwald uint8_t * packet = setup_characteristic_value_packet(GATT_EVENT_INDICATION, con_handle, value_handle, value, length); 7389c662c9bSMatthias Ringwald emit_event_to_registered_listeners(con_handle, value_handle, packet, characteristic_value_event_header_size + length); 7393deb3ec6SMatthias Ringwald } 7403deb3ec6SMatthias Ringwald 7413deb3ec6SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite parts of the HCI/L2CAP/ATT packet (4/4/3) bytes 7425cf1669fSMatthias Ringwald static void report_gatt_characteristic_value(gatt_client_t * gatt_client, uint16_t attribute_handle, uint8_t * value, uint16_t length){ 7435cf1669fSMatthias Ringwald uint8_t * packet = setup_characteristic_value_packet(GATT_EVENT_CHARACTERISTIC_VALUE_QUERY_RESULT, gatt_client->con_handle, attribute_handle, value, length); 7445cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, characteristic_value_event_header_size + length); 7453deb3ec6SMatthias Ringwald } 7463deb3ec6SMatthias Ringwald 7473deb3ec6SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite parts of the HCI/L2CAP/ATT packet (4/4/3) bytes 7485cf1669fSMatthias 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){ 7495cf1669fSMatthias 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); 7503deb3ec6SMatthias Ringwald if (!packet) return; 7515cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, blob_length + long_characteristic_value_event_header_size); 7523deb3ec6SMatthias Ringwald } 7533deb3ec6SMatthias Ringwald 7545cf1669fSMatthias 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){ 7559ec2630cSMatthias Ringwald UNUSED(value_offset); 7565cf1669fSMatthias Ringwald uint8_t * packet = setup_characteristic_value_packet(GATT_EVENT_CHARACTERISTIC_DESCRIPTOR_QUERY_RESULT, gatt_client->con_handle, descriptor_handle, value, value_length); 7575cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, value_length + 8u); 7583deb3ec6SMatthias Ringwald } 7593deb3ec6SMatthias Ringwald 7605cf1669fSMatthias 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){ 7615cf1669fSMatthias 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); 7623deb3ec6SMatthias Ringwald if (!packet) return; 7635cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, blob_length + long_characteristic_value_event_header_size); 7643deb3ec6SMatthias Ringwald } 7653deb3ec6SMatthias Ringwald 7665cf1669fSMatthias Ringwald static void report_gatt_all_characteristic_descriptors(gatt_client_t * gatt_client, uint8_t * packet, uint16_t size, uint16_t pair_size){ 7673deb3ec6SMatthias Ringwald int i; 7684ea43905SMatthias Ringwald for (i = 0u; (i + pair_size) <= size; i += pair_size){ 769f8fbdce0SMatthias Ringwald uint16_t descriptor_handle = little_endian_read_16(packet,i); 7703deb3ec6SMatthias Ringwald uint8_t uuid128[16]; 7713deb3ec6SMatthias Ringwald uint16_t uuid16 = 0; 7724ea43905SMatthias Ringwald if (pair_size == 4u){ 773f8fbdce0SMatthias Ringwald uuid16 = little_endian_read_16(packet,i+2); 774e1a125dfSMatthias Ringwald uuid_add_bluetooth_prefix(uuid128, uuid16); 7753deb3ec6SMatthias Ringwald } else { 7769c80e4ccSMatthias Ringwald reverse_128(&packet[i+2], uuid128); 7773deb3ec6SMatthias Ringwald } 7785cf1669fSMatthias Ringwald emit_gatt_all_characteristic_descriptors_result_event(gatt_client, descriptor_handle, uuid128); 7793deb3ec6SMatthias Ringwald } 7803deb3ec6SMatthias Ringwald 7813deb3ec6SMatthias Ringwald } 7823deb3ec6SMatthias Ringwald 7835cf1669fSMatthias Ringwald static int is_query_done(gatt_client_t * gatt_client, uint16_t last_result_handle){ 7845cf1669fSMatthias Ringwald return last_result_handle >= gatt_client->end_group_handle; 7853deb3ec6SMatthias Ringwald } 7863deb3ec6SMatthias Ringwald 7875cf1669fSMatthias Ringwald static void trigger_next_query(gatt_client_t * gatt_client, uint16_t last_result_handle, gatt_client_state_t next_query_state){ 7885cf1669fSMatthias Ringwald if (is_query_done(gatt_client, last_result_handle)){ 7895cf1669fSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 7905cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_SUCCESS); 7913deb3ec6SMatthias Ringwald return; 7923deb3ec6SMatthias Ringwald } 7933deb3ec6SMatthias Ringwald // next 7945cf1669fSMatthias Ringwald gatt_client->start_group_handle = last_result_handle + 1u; 7955cf1669fSMatthias Ringwald gatt_client->gatt_client_state = next_query_state; 7963deb3ec6SMatthias Ringwald } 7973deb3ec6SMatthias Ringwald 7985cf1669fSMatthias Ringwald static void trigger_next_included_service_query(gatt_client_t * gatt_client, uint16_t last_result_handle){ 7995cf1669fSMatthias Ringwald trigger_next_query(gatt_client, last_result_handle, P_W2_SEND_INCLUDED_SERVICE_QUERY); 8003deb3ec6SMatthias Ringwald } 8013deb3ec6SMatthias Ringwald 8025cf1669fSMatthias Ringwald static void trigger_next_service_query(gatt_client_t * gatt_client, uint16_t last_result_handle){ 8035cf1669fSMatthias Ringwald trigger_next_query(gatt_client, last_result_handle, P_W2_SEND_SERVICE_QUERY); 8043deb3ec6SMatthias Ringwald } 8053deb3ec6SMatthias Ringwald 8065cf1669fSMatthias Ringwald static void trigger_next_service_by_uuid_query(gatt_client_t * gatt_client, uint16_t last_result_handle){ 8075cf1669fSMatthias Ringwald trigger_next_query(gatt_client, last_result_handle, P_W2_SEND_SERVICE_WITH_UUID_QUERY); 8083deb3ec6SMatthias Ringwald } 8093deb3ec6SMatthias Ringwald 8105cf1669fSMatthias Ringwald static void trigger_next_characteristic_query(gatt_client_t * gatt_client, uint16_t last_result_handle){ 8115cf1669fSMatthias Ringwald if (is_query_done(gatt_client, last_result_handle)){ 8123deb3ec6SMatthias Ringwald // report last characteristic 8135cf1669fSMatthias Ringwald characteristic_end_found(gatt_client, gatt_client->end_group_handle); 8143deb3ec6SMatthias Ringwald } 8155cf1669fSMatthias Ringwald trigger_next_query(gatt_client, last_result_handle, P_W2_SEND_ALL_CHARACTERISTICS_OF_SERVICE_QUERY); 8163deb3ec6SMatthias Ringwald } 8173deb3ec6SMatthias Ringwald 8185cf1669fSMatthias Ringwald static void trigger_next_characteristic_descriptor_query(gatt_client_t * gatt_client, uint16_t last_result_handle){ 8195cf1669fSMatthias Ringwald trigger_next_query(gatt_client, last_result_handle, P_W2_SEND_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY); 8203deb3ec6SMatthias Ringwald } 8213deb3ec6SMatthias Ringwald 8225cf1669fSMatthias Ringwald static void trigger_next_read_by_type_query(gatt_client_t * gatt_client, uint16_t last_result_handle){ 8235cf1669fSMatthias Ringwald trigger_next_query(gatt_client, last_result_handle, P_W2_SEND_READ_BY_TYPE_REQUEST); 8243deb3ec6SMatthias Ringwald } 8253deb3ec6SMatthias Ringwald 8265cf1669fSMatthias 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){ 8275cf1669fSMatthias Ringwald gatt_client->attribute_offset += write_blob_length(gatt_client); 8285cf1669fSMatthias Ringwald uint16_t next_blob_length = write_blob_length(gatt_client); 8293deb3ec6SMatthias Ringwald 8304ea43905SMatthias Ringwald if (next_blob_length == 0u){ 8315cf1669fSMatthias Ringwald gatt_client->gatt_client_state = done_state; 8323deb3ec6SMatthias Ringwald return; 8333deb3ec6SMatthias Ringwald } 8345cf1669fSMatthias Ringwald gatt_client->gatt_client_state = next_query_state; 8353deb3ec6SMatthias Ringwald } 8363deb3ec6SMatthias Ringwald 8375cf1669fSMatthias Ringwald static void trigger_next_blob_query(gatt_client_t * gatt_client, gatt_client_state_t next_query_state, uint16_t received_blob_length){ 8383deb3ec6SMatthias Ringwald 839dda77937SMatthias Ringwald uint16_t max_blob_length = gatt_client->mtu - 1u; 8403deb3ec6SMatthias Ringwald if (received_blob_length < max_blob_length){ 8415cf1669fSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 8425cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_SUCCESS); 8433deb3ec6SMatthias Ringwald return; 8443deb3ec6SMatthias Ringwald } 8453deb3ec6SMatthias Ringwald 8465cf1669fSMatthias Ringwald gatt_client->attribute_offset += received_blob_length; 8475cf1669fSMatthias Ringwald gatt_client->gatt_client_state = next_query_state; 8483deb3ec6SMatthias Ringwald } 8493deb3ec6SMatthias Ringwald 8503deb3ec6SMatthias Ringwald 8515cf1669fSMatthias Ringwald static int is_value_valid(gatt_client_t *gatt_client, uint8_t *packet, uint16_t size){ 852f8fbdce0SMatthias Ringwald uint16_t attribute_handle = little_endian_read_16(packet, 1); 853f8fbdce0SMatthias Ringwald uint16_t value_offset = little_endian_read_16(packet, 3); 8543deb3ec6SMatthias Ringwald 8555cf1669fSMatthias Ringwald if (gatt_client->attribute_handle != attribute_handle) return 0; 8565cf1669fSMatthias Ringwald if (gatt_client->attribute_offset != value_offset) return 0; 8575cf1669fSMatthias Ringwald return memcmp(&gatt_client->attribute_value[gatt_client->attribute_offset], &packet[5], size - 5u) == 0u; 8583deb3ec6SMatthias Ringwald } 8593deb3ec6SMatthias Ringwald 860544128c3SMatthias Ringwald // returns 1 if packet was sent 8615cf1669fSMatthias Ringwald static int gatt_client_run_for_gatt_client(gatt_client_t * gatt_client){ 8623deb3ec6SMatthias Ringwald 863d1e1a57fSMatthias Ringwald // wait until re-encryption as central is complete 8645cf1669fSMatthias Ringwald if (gap_reconnect_security_setup_active(gatt_client->con_handle)) return 0; 865d1e1a57fSMatthias Ringwald 8668918bbdaSMatthias Ringwald #ifdef ENABLE_LE_PROACTIVE_AUTHENTICATION 8678918bbdaSMatthias Ringwald // wait until re-encryption complete 8688918bbdaSMatthias Ringwald if (gatt_client->reencryption_active) return 0; 869*6c124bc2SMatthias Ringwald 870*6c124bc2SMatthias Ringwald // report bonding information missing, if re-encryption failed 871*6c124bc2SMatthias Ringwald if ((gatt_client->reencryption_result != ERROR_CODE_SUCCESS) && (gatt_client->gatt_client_state != P_READY)){ 872*6c124bc2SMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 873*6c124bc2SMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_BONDING_INFORMATION_MISSING); 874*6c124bc2SMatthias Ringwald return 0; 875*6c124bc2SMatthias Ringwald } 8768918bbdaSMatthias Ringwald #endif 8778918bbdaSMatthias Ringwald 878f4b33574SMatthias Ringwald #ifdef ENABLE_GATT_CLIENT_PAIRING 879f4b33574SMatthias Ringwald // wait until pairing complete 8805cf1669fSMatthias Ringwald if (gatt_client->wait_for_pairing_complete) return 0; 881f4b33574SMatthias Ringwald #endif 882f4b33574SMatthias Ringwald 8835cf1669fSMatthias Ringwald switch (gatt_client->mtu_state) { 884544128c3SMatthias Ringwald case SEND_MTU_EXCHANGE: 8855cf1669fSMatthias Ringwald gatt_client->mtu_state = SENT_MTU_EXCHANGE; 8865cf1669fSMatthias Ringwald att_exchange_mtu_request(gatt_client->con_handle); 887544128c3SMatthias Ringwald return 1; 8883deb3ec6SMatthias Ringwald case SENT_MTU_EXCHANGE: 889544128c3SMatthias Ringwald return 0; 8903deb3ec6SMatthias Ringwald default: 8913deb3ec6SMatthias Ringwald break; 8923deb3ec6SMatthias Ringwald } 8933deb3ec6SMatthias Ringwald 8945cf1669fSMatthias Ringwald if (gatt_client->send_confirmation){ 8955cf1669fSMatthias Ringwald gatt_client->send_confirmation = 0; 8965cf1669fSMatthias Ringwald att_confirmation(gatt_client->con_handle); 897544128c3SMatthias Ringwald return 1; 8983deb3ec6SMatthias Ringwald } 8993deb3ec6SMatthias Ringwald 9003deb3ec6SMatthias Ringwald // check MTU for writes 9015cf1669fSMatthias Ringwald switch (gatt_client->gatt_client_state){ 9023deb3ec6SMatthias Ringwald case P_W2_SEND_WRITE_CHARACTERISTIC_VALUE: 9033deb3ec6SMatthias Ringwald case P_W2_SEND_WRITE_CHARACTERISTIC_DESCRIPTOR: 904dda77937SMatthias Ringwald if (gatt_client->attribute_length <= (gatt_client->mtu - 3u)) break; 905dda77937SMatthias Ringwald log_error("gatt_client_run: value len %u > MTU %u - 3\n", gatt_client->attribute_length,gatt_client->mtu); 9065cf1669fSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 9075cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_INVALID_ATTRIBUTE_VALUE_LENGTH); 908544128c3SMatthias Ringwald return 0; 9093deb3ec6SMatthias Ringwald default: 9103deb3ec6SMatthias Ringwald break; 9113deb3ec6SMatthias Ringwald } 9123deb3ec6SMatthias Ringwald 9135cf1669fSMatthias Ringwald switch (gatt_client->gatt_client_state){ 9143deb3ec6SMatthias Ringwald case P_W2_SEND_SERVICE_QUERY: 9155cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_SERVICE_QUERY_RESULT; 9165cf1669fSMatthias Ringwald send_gatt_services_request(gatt_client); 917544128c3SMatthias Ringwald return 1; 9183deb3ec6SMatthias Ringwald 9193deb3ec6SMatthias Ringwald case P_W2_SEND_SERVICE_WITH_UUID_QUERY: 9205cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_SERVICE_WITH_UUID_RESULT; 9215cf1669fSMatthias Ringwald send_gatt_services_by_uuid_request(gatt_client); 922544128c3SMatthias Ringwald return 1; 9233deb3ec6SMatthias Ringwald 9243deb3ec6SMatthias Ringwald case P_W2_SEND_ALL_CHARACTERISTICS_OF_SERVICE_QUERY: 9255cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_ALL_CHARACTERISTICS_OF_SERVICE_QUERY_RESULT; 9265cf1669fSMatthias Ringwald send_gatt_characteristic_request(gatt_client); 927544128c3SMatthias Ringwald return 1; 9283deb3ec6SMatthias Ringwald 9293deb3ec6SMatthias Ringwald case P_W2_SEND_CHARACTERISTIC_WITH_UUID_QUERY: 9305cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_CHARACTERISTIC_WITH_UUID_QUERY_RESULT; 9315cf1669fSMatthias Ringwald send_gatt_characteristic_request(gatt_client); 932544128c3SMatthias Ringwald return 1; 9333deb3ec6SMatthias Ringwald 9343deb3ec6SMatthias Ringwald case P_W2_SEND_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY: 9355cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_CHARACTERISTIC_WITH_UUID_QUERY_RESULT; 9365cf1669fSMatthias Ringwald send_gatt_characteristic_descriptor_request(gatt_client); 937544128c3SMatthias Ringwald return 1; 9383deb3ec6SMatthias Ringwald 9393deb3ec6SMatthias Ringwald case P_W2_SEND_INCLUDED_SERVICE_QUERY: 9405cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_INCLUDED_SERVICE_QUERY_RESULT; 9415cf1669fSMatthias Ringwald send_gatt_included_service_request(gatt_client); 942544128c3SMatthias Ringwald return 1; 9433deb3ec6SMatthias Ringwald 9443deb3ec6SMatthias Ringwald case P_W2_SEND_INCLUDED_SERVICE_WITH_UUID_QUERY: 9455cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_INCLUDED_SERVICE_UUID_WITH_QUERY_RESULT; 9465cf1669fSMatthias Ringwald send_gatt_included_service_uuid_request(gatt_client); 947544128c3SMatthias Ringwald return 1; 9483deb3ec6SMatthias Ringwald 9493deb3ec6SMatthias Ringwald case P_W2_SEND_READ_CHARACTERISTIC_VALUE_QUERY: 9505cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_READ_CHARACTERISTIC_VALUE_RESULT; 9515cf1669fSMatthias Ringwald send_gatt_read_characteristic_value_request(gatt_client); 952544128c3SMatthias Ringwald return 1; 9533deb3ec6SMatthias Ringwald 9543deb3ec6SMatthias Ringwald case P_W2_SEND_READ_BLOB_QUERY: 9555cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_READ_BLOB_RESULT; 9565cf1669fSMatthias Ringwald send_gatt_read_blob_request(gatt_client); 957544128c3SMatthias Ringwald return 1; 9583deb3ec6SMatthias Ringwald 9593deb3ec6SMatthias Ringwald case P_W2_SEND_READ_BY_TYPE_REQUEST: 9605cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_READ_BY_TYPE_RESPONSE; 9615cf1669fSMatthias Ringwald send_gatt_read_by_type_request(gatt_client); 962544128c3SMatthias Ringwald return 1; 9633deb3ec6SMatthias Ringwald 9643deb3ec6SMatthias Ringwald case P_W2_SEND_READ_MULTIPLE_REQUEST: 9655cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_READ_MULTIPLE_RESPONSE; 9665cf1669fSMatthias Ringwald send_gatt_read_multiple_request(gatt_client); 967544128c3SMatthias Ringwald return 1; 9683deb3ec6SMatthias Ringwald 9693deb3ec6SMatthias Ringwald case P_W2_SEND_WRITE_CHARACTERISTIC_VALUE: 9705cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_WRITE_CHARACTERISTIC_VALUE_RESULT; 9715cf1669fSMatthias Ringwald send_gatt_write_attribute_value_request(gatt_client); 972544128c3SMatthias Ringwald return 1; 9733deb3ec6SMatthias Ringwald 9743deb3ec6SMatthias Ringwald case P_W2_PREPARE_WRITE: 9755cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_PREPARE_WRITE_RESULT; 9765cf1669fSMatthias Ringwald send_gatt_prepare_write_request(gatt_client); 977544128c3SMatthias Ringwald return 1; 9783deb3ec6SMatthias Ringwald 9793deb3ec6SMatthias Ringwald case P_W2_PREPARE_WRITE_SINGLE: 9805cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_PREPARE_WRITE_SINGLE_RESULT; 9815cf1669fSMatthias Ringwald send_gatt_prepare_write_request(gatt_client); 982544128c3SMatthias Ringwald return 1; 9833deb3ec6SMatthias Ringwald 9843deb3ec6SMatthias Ringwald case P_W2_PREPARE_RELIABLE_WRITE: 9855cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_PREPARE_RELIABLE_WRITE_RESULT; 9865cf1669fSMatthias Ringwald send_gatt_prepare_write_request(gatt_client); 987544128c3SMatthias Ringwald return 1; 9883deb3ec6SMatthias Ringwald 9893deb3ec6SMatthias Ringwald case P_W2_EXECUTE_PREPARED_WRITE: 9905cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_EXECUTE_PREPARED_WRITE_RESULT; 9915cf1669fSMatthias Ringwald send_gatt_execute_write_request(gatt_client); 992544128c3SMatthias Ringwald return 1; 9933deb3ec6SMatthias Ringwald 9943deb3ec6SMatthias Ringwald case P_W2_CANCEL_PREPARED_WRITE: 9955cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_CANCEL_PREPARED_WRITE_RESULT; 9965cf1669fSMatthias Ringwald send_gatt_cancel_prepared_write_request(gatt_client); 997544128c3SMatthias Ringwald return 1; 9983deb3ec6SMatthias Ringwald 9993deb3ec6SMatthias Ringwald case P_W2_CANCEL_PREPARED_WRITE_DATA_MISMATCH: 10005cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_CANCEL_PREPARED_WRITE_DATA_MISMATCH_RESULT; 10015cf1669fSMatthias Ringwald send_gatt_cancel_prepared_write_request(gatt_client); 1002544128c3SMatthias Ringwald return 1; 10033deb3ec6SMatthias Ringwald 1004abdc9fb5SMatthias Ringwald #ifdef ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY 1005abdc9fb5SMatthias Ringwald case P_W2_SEND_FIND_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY: 1006abdc9fb5SMatthias Ringwald // use Find Information 10075cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_FIND_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY_RESULT; 10085cf1669fSMatthias Ringwald send_gatt_characteristic_descriptor_request(gatt_client); 1009abdc9fb5SMatthias Ringwald #else 10103deb3ec6SMatthias Ringwald case P_W2_SEND_READ_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY: 1011abdc9fb5SMatthias Ringwald // Use Read By Type 10125cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_READ_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY_RESULT; 10135cf1669fSMatthias Ringwald send_gatt_read_client_characteristic_configuration_request(gatt_client); 1014abdc9fb5SMatthias Ringwald #endif 1015544128c3SMatthias Ringwald return 1; 10163deb3ec6SMatthias Ringwald 10173deb3ec6SMatthias Ringwald case P_W2_SEND_READ_CHARACTERISTIC_DESCRIPTOR_QUERY: 10185cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_READ_CHARACTERISTIC_DESCRIPTOR_RESULT; 10195cf1669fSMatthias Ringwald send_gatt_read_characteristic_descriptor_request(gatt_client); 1020544128c3SMatthias Ringwald return 1; 10213deb3ec6SMatthias Ringwald 10223deb3ec6SMatthias Ringwald case P_W2_SEND_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_QUERY: 10235cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_RESULT; 10245cf1669fSMatthias Ringwald send_gatt_read_blob_request(gatt_client); 1025544128c3SMatthias Ringwald return 1; 10263deb3ec6SMatthias Ringwald 10273deb3ec6SMatthias Ringwald case P_W2_SEND_WRITE_CHARACTERISTIC_DESCRIPTOR: 10285cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT; 10295cf1669fSMatthias Ringwald send_gatt_write_attribute_value_request(gatt_client); 1030544128c3SMatthias Ringwald return 1; 10313deb3ec6SMatthias Ringwald 10323deb3ec6SMatthias Ringwald case P_W2_WRITE_CLIENT_CHARACTERISTIC_CONFIGURATION: 10335cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_CLIENT_CHARACTERISTIC_CONFIGURATION_RESULT; 10345cf1669fSMatthias Ringwald send_gatt_write_client_characteristic_configuration_request(gatt_client); 1035544128c3SMatthias Ringwald return 1; 10363deb3ec6SMatthias Ringwald 10373deb3ec6SMatthias Ringwald case P_W2_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR: 10385cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT; 10395cf1669fSMatthias Ringwald send_gatt_prepare_write_request(gatt_client); 1040544128c3SMatthias Ringwald return 1; 10413deb3ec6SMatthias Ringwald 10423deb3ec6SMatthias Ringwald case P_W2_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR: 10435cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT; 10445cf1669fSMatthias Ringwald send_gatt_execute_write_request(gatt_client); 1045544128c3SMatthias Ringwald return 1; 10463deb3ec6SMatthias Ringwald 10477a766ebfSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 1048793cf6ceSMatthias Ringwald case P_W4_IDENTITY_RESOLVING: 10495cf1669fSMatthias Ringwald log_info("P_W4_IDENTITY_RESOLVING - state %x", sm_identity_resolving_state(gatt_client->con_handle)); 10505cf1669fSMatthias Ringwald switch (sm_identity_resolving_state(gatt_client->con_handle)){ 1051793cf6ceSMatthias Ringwald case IRK_LOOKUP_SUCCEEDED: 10525cf1669fSMatthias Ringwald gatt_client->le_device_index = sm_le_device_index(gatt_client->con_handle); 10535cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_CMAC_READY; 1054793cf6ceSMatthias Ringwald break; 1055793cf6ceSMatthias Ringwald case IRK_LOOKUP_FAILED: 10565cf1669fSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 10575cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_BONDING_INFORMATION_MISSING); 1058793cf6ceSMatthias Ringwald return 0; 1059793cf6ceSMatthias Ringwald default: 1060793cf6ceSMatthias Ringwald return 0; 1061793cf6ceSMatthias Ringwald } 1062793cf6ceSMatthias Ringwald 1063793cf6ceSMatthias Ringwald /* Fall through */ 1064793cf6ceSMatthias Ringwald 10653deb3ec6SMatthias Ringwald case P_W4_CMAC_READY: 10663deb3ec6SMatthias Ringwald if (sm_cmac_ready()){ 10673deb3ec6SMatthias Ringwald sm_key_t csrk; 10685cf1669fSMatthias Ringwald le_device_db_local_csrk_get(gatt_client->le_device_index, csrk); 10695cf1669fSMatthias Ringwald uint32_t sign_counter = le_device_db_local_counter_get(gatt_client->le_device_index); 10705cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_CMAC_RESULT; 10715cf1669fSMatthias 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); 10723deb3ec6SMatthias Ringwald } 1073544128c3SMatthias Ringwald return 0; 10743deb3ec6SMatthias Ringwald 10753deb3ec6SMatthias Ringwald case P_W2_SEND_SIGNED_WRITE: { 10765cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_SEND_SINGED_WRITE_DONE; 10773deb3ec6SMatthias Ringwald // bump local signing counter 10785cf1669fSMatthias Ringwald uint32_t sign_counter = le_device_db_local_counter_get(gatt_client->le_device_index); 10795cf1669fSMatthias Ringwald le_device_db_local_counter_set(gatt_client->le_device_index, sign_counter + 1); 108064b12680SMatthias Ringwald // send signed write command 10815cf1669fSMatthias Ringwald send_gatt_signed_write_request(gatt_client, sign_counter); 10823deb3ec6SMatthias Ringwald // finally, notifiy client that write is complete 10835cf1669fSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 10845cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_SUCCESS); 1085544128c3SMatthias Ringwald return 1; 10863deb3ec6SMatthias Ringwald } 10877a766ebfSMatthias Ringwald #endif 10883deb3ec6SMatthias Ringwald default: 10893deb3ec6SMatthias Ringwald break; 10903deb3ec6SMatthias Ringwald } 109147181045SMatthias Ringwald 109247181045SMatthias Ringwald // requested can send snow? 10935cf1669fSMatthias Ringwald if (gatt_client->write_without_response_callback){ 10945cf1669fSMatthias Ringwald btstack_packet_handler_t packet_handler = gatt_client->write_without_response_callback; 10955cf1669fSMatthias Ringwald gatt_client->write_without_response_callback = NULL; 109647181045SMatthias Ringwald uint8_t event[4]; 109747181045SMatthias Ringwald event[0] = GATT_EVENT_CAN_WRITE_WITHOUT_RESPONSE; 10984ea43905SMatthias Ringwald event[1] = sizeof(event) - 2u; 10995cf1669fSMatthias Ringwald little_endian_store_16(event, 2, gatt_client->con_handle); 11005cf1669fSMatthias Ringwald packet_handler(HCI_EVENT_PACKET, gatt_client->con_handle, event, sizeof(event)); 110147181045SMatthias Ringwald return 1; // to trigger requeueing (even if higher layer didn't sent) 110247181045SMatthias Ringwald } 110347181045SMatthias Ringwald 1104544128c3SMatthias Ringwald return 0; 11053deb3ec6SMatthias Ringwald } 11063deb3ec6SMatthias Ringwald 1107544128c3SMatthias Ringwald static void gatt_client_run(void){ 1108544128c3SMatthias Ringwald btstack_linked_item_t *it; 1109a0da043fSMatthias Ringwald for (it = (btstack_linked_item_t *) gatt_client_connections; it != NULL; it = it->next){ 11105cf1669fSMatthias Ringwald gatt_client_t * gatt_client = (gatt_client_t *) it; 11115cf1669fSMatthias Ringwald if (!att_dispatch_client_can_send_now(gatt_client->con_handle)) { 11125cf1669fSMatthias Ringwald att_dispatch_client_request_can_send_now_event(gatt_client->con_handle); 1113544128c3SMatthias Ringwald return; 1114544128c3SMatthias Ringwald } 11155cf1669fSMatthias Ringwald int packet_sent = gatt_client_run_for_gatt_client(gatt_client); 1116544128c3SMatthias Ringwald if (packet_sent){ 111745f2a740SMatthias Ringwald // request new permission 11185cf1669fSMatthias Ringwald att_dispatch_client_request_can_send_now_event(gatt_client->con_handle); 111945f2a740SMatthias Ringwald // requeue client for fairness and exit 112045f2a740SMatthias Ringwald // note: iterator has become invalid 11215cf1669fSMatthias Ringwald btstack_linked_list_remove(&gatt_client_connections, (btstack_linked_item_t *) gatt_client); 11225cf1669fSMatthias Ringwald btstack_linked_list_add_tail(&gatt_client_connections, (btstack_linked_item_t *) gatt_client); 1123544128c3SMatthias Ringwald return; 1124544128c3SMatthias Ringwald } 1125544128c3SMatthias Ringwald } 11263deb3ec6SMatthias Ringwald } 11273deb3ec6SMatthias Ringwald 11285cf1669fSMatthias Ringwald static void gatt_client_report_error_if_pending(gatt_client_t *gatt_client, uint8_t att_error_code) { 11295cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 1) return; 11305cf1669fSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 11315cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, att_error_code); 11323deb3ec6SMatthias Ringwald } 11333deb3ec6SMatthias Ringwald 1134f4b33574SMatthias Ringwald static void gatt_client_event_packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size){ 11351ac26e06SMatthias Ringwald UNUSED(channel); // ok: handling own l2cap events 11361ac26e06SMatthias Ringwald UNUSED(size); // ok: there is no channel 11379ec2630cSMatthias Ringwald 1138361b1363SMatthias Ringwald if (packet_type != HCI_EVENT_PACKET) return; 1139361b1363SMatthias Ringwald 1140f4b33574SMatthias Ringwald hci_con_handle_t con_handle; 11415cf1669fSMatthias Ringwald gatt_client_t * gatt_client; 11420e2df43fSMatthias Ringwald switch (hci_event_packet_get_type(packet)) { 11433deb3ec6SMatthias Ringwald case HCI_EVENT_DISCONNECTION_COMPLETE: 11443deb3ec6SMatthias Ringwald log_info("GATT Client: HCI_EVENT_DISCONNECTION_COMPLETE"); 1145f4b33574SMatthias Ringwald con_handle = little_endian_read_16(packet,3); 11465cf1669fSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(con_handle); 11475cf1669fSMatthias Ringwald if (gatt_client == NULL) break; 11483deb3ec6SMatthias Ringwald 11495cf1669fSMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, ATT_ERROR_HCI_DISCONNECT_RECEIVED); 11505cf1669fSMatthias Ringwald gatt_client_timeout_stop(gatt_client); 11515cf1669fSMatthias Ringwald btstack_linked_list_remove(&gatt_client_connections, (btstack_linked_item_t *) gatt_client); 11525cf1669fSMatthias Ringwald btstack_memory_gatt_client_free(gatt_client); 11533deb3ec6SMatthias Ringwald break; 1154f4b33574SMatthias Ringwald 1155f4b33574SMatthias Ringwald #ifdef ENABLE_GATT_CLIENT_PAIRING 1156f4b33574SMatthias Ringwald // Pairing complete (with/without bonding=storing of pairing information) 1157f4b33574SMatthias Ringwald case SM_EVENT_PAIRING_COMPLETE: 1158f4b33574SMatthias Ringwald con_handle = sm_event_pairing_complete_get_handle(packet); 11595cf1669fSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(con_handle); 11605cf1669fSMatthias Ringwald if (gatt_client == NULL) break; 1161f4b33574SMatthias Ringwald 11625cf1669fSMatthias Ringwald if (gatt_client->wait_for_pairing_complete){ 11635cf1669fSMatthias Ringwald gatt_client->wait_for_pairing_complete = 0; 1164f4b33574SMatthias Ringwald if (sm_event_pairing_complete_get_status(packet)){ 11655cf1669fSMatthias Ringwald log_info("pairing failed, report previous error 0x%x", gatt_client->pending_error_code); 1166ec9babacSMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, gatt_client->pending_error_code); 1167f4b33574SMatthias Ringwald } else { 1168f4b33574SMatthias Ringwald log_info("pairing success, retry operation"); 11693deb3ec6SMatthias Ringwald } 1170f4b33574SMatthias Ringwald } 1171f4b33574SMatthias Ringwald break; 1172f4b33574SMatthias Ringwald #endif 1173793cf6ceSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 1174793cf6ceSMatthias Ringwald // Identity Resolving completed (no code, gatt_client_run will continue) 1175793cf6ceSMatthias Ringwald case SM_EVENT_IDENTITY_RESOLVING_SUCCEEDED: 1176793cf6ceSMatthias Ringwald case SM_EVENT_IDENTITY_RESOLVING_FAILED: 1177793cf6ceSMatthias Ringwald break; 1178793cf6ceSMatthias Ringwald #endif 1179ec9babacSMatthias Ringwald #ifdef ENABLE_LE_PROACTIVE_AUTHENTICATION 11808918bbdaSMatthias Ringwald // re-encryption started 11818918bbdaSMatthias Ringwald case SM_EVENT_REENCRYPTION_STARTED: 11828918bbdaSMatthias Ringwald con_handle = sm_event_reencryption_complete_get_handle(packet); 11838918bbdaSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(con_handle); 11848918bbdaSMatthias Ringwald if (gatt_client == NULL) break; 11858918bbdaSMatthias Ringwald 11868918bbdaSMatthias Ringwald gatt_client->reencryption_active = true; 11878918bbdaSMatthias Ringwald gatt_client->reencryption_result = ERROR_CODE_SUCCESS; 11888918bbdaSMatthias Ringwald break; 11898918bbdaSMatthias Ringwald 1190ec9babacSMatthias Ringwald // re-encryption complete 1191ec9babacSMatthias Ringwald case SM_EVENT_REENCRYPTION_COMPLETE: 1192ec9babacSMatthias Ringwald con_handle = sm_event_reencryption_complete_get_handle(packet); 1193ec9babacSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(con_handle); 1194ec9babacSMatthias Ringwald if (gatt_client == NULL) break; 1195f4b33574SMatthias Ringwald 11968918bbdaSMatthias Ringwald gatt_client->reencryption_result = sm_event_reencryption_complete_get_status(packet); 11978918bbdaSMatthias Ringwald gatt_client->reencryption_active = false; 1198ec9babacSMatthias Ringwald break; 1199ec9babacSMatthias Ringwald #endif 12003deb3ec6SMatthias Ringwald default: 12013deb3ec6SMatthias Ringwald break; 12023deb3ec6SMatthias Ringwald } 12033deb3ec6SMatthias Ringwald 1204361b1363SMatthias Ringwald gatt_client_run(); 12053deb3ec6SMatthias Ringwald } 12063deb3ec6SMatthias Ringwald 12073deb3ec6SMatthias Ringwald static void gatt_client_att_packet_handler(uint8_t packet_type, uint16_t handle, uint8_t *packet, uint16_t size){ 12085cf1669fSMatthias Ringwald gatt_client_t * gatt_client; 12094ea43905SMatthias Ringwald if (size < 1u) return; 12100fbf59a1SMatthias Ringwald 12110fbf59a1SMatthias Ringwald if (packet_type == HCI_EVENT_PACKET) { 12120fbf59a1SMatthias Ringwald switch (packet[0]){ 12130fbf59a1SMatthias Ringwald case L2CAP_EVENT_CAN_SEND_NOW: 121451764b3bSMatthias Ringwald gatt_client_run(); 12150fbf59a1SMatthias Ringwald break; 12160fbf59a1SMatthias Ringwald // att_server has negotiated the mtu for this connection, cache if context exists 12170fbf59a1SMatthias Ringwald case ATT_EVENT_MTU_EXCHANGE_COMPLETE: 12184ea43905SMatthias Ringwald if (size < 6u) break; 12195cf1669fSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(handle); 12205cf1669fSMatthias Ringwald if (gatt_client == NULL) break; 12215cf1669fSMatthias Ringwald gatt_client->mtu = little_endian_read_16(packet, 4); 12220fbf59a1SMatthias Ringwald break; 12230fbf59a1SMatthias Ringwald default: 12240fbf59a1SMatthias Ringwald break; 12250fbf59a1SMatthias Ringwald } 12260fbf59a1SMatthias Ringwald return; 122751764b3bSMatthias Ringwald } 122851764b3bSMatthias Ringwald 12293deb3ec6SMatthias Ringwald if (packet_type != ATT_DATA_PACKET) return; 12303deb3ec6SMatthias Ringwald 12313deb3ec6SMatthias Ringwald // special cases: notifications don't need a context while indications motivate creating one 12323deb3ec6SMatthias Ringwald switch (packet[0]){ 12333deb3ec6SMatthias Ringwald case ATT_HANDLE_VALUE_NOTIFICATION: 12344ea43905SMatthias Ringwald if (size < 3u) return; 12354ea43905SMatthias Ringwald report_gatt_notification(handle, little_endian_read_16(packet,1u), &packet[3], size-3u); 12363deb3ec6SMatthias Ringwald return; 12373deb3ec6SMatthias Ringwald case ATT_HANDLE_VALUE_INDICATION: 12385cf1669fSMatthias Ringwald gatt_client = gatt_client_provide_context_for_handle(handle); 12393deb3ec6SMatthias Ringwald break; 12403deb3ec6SMatthias Ringwald default: 12415cf1669fSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(handle); 12423deb3ec6SMatthias Ringwald break; 12433deb3ec6SMatthias Ringwald } 12443deb3ec6SMatthias Ringwald 12455cf1669fSMatthias Ringwald if (gatt_client == NULL) return; 12463deb3ec6SMatthias Ringwald 1247f060f108SMatthias Ringwald uint8_t error_code; 12483deb3ec6SMatthias Ringwald switch (packet[0]){ 12493deb3ec6SMatthias Ringwald case ATT_EXCHANGE_MTU_RESPONSE: 12503deb3ec6SMatthias Ringwald { 12514ea43905SMatthias Ringwald if (size < 3u) break; 1252f8fbdce0SMatthias Ringwald uint16_t remote_rx_mtu = little_endian_read_16(packet, 1); 12533deb3ec6SMatthias Ringwald uint16_t local_rx_mtu = l2cap_max_le_mtu(); 12545cf1669fSMatthias Ringwald gatt_client->mtu = (remote_rx_mtu < local_rx_mtu) ? remote_rx_mtu : local_rx_mtu; 12555cf1669fSMatthias Ringwald gatt_client->mtu_state = MTU_EXCHANGED; 12565cf1669fSMatthias Ringwald emit_gatt_mtu_exchanged_result_event(gatt_client, gatt_client->mtu); 12573deb3ec6SMatthias Ringwald break; 12583deb3ec6SMatthias Ringwald } 12593deb3ec6SMatthias Ringwald case ATT_READ_BY_GROUP_TYPE_RESPONSE: 12605cf1669fSMatthias Ringwald switch(gatt_client->gatt_client_state){ 12613deb3ec6SMatthias Ringwald case P_W4_SERVICE_QUERY_RESULT: 12625cf1669fSMatthias Ringwald report_gatt_services(gatt_client, packet, size); 12635cf1669fSMatthias Ringwald trigger_next_service_query(gatt_client, get_last_result_handle_from_service_list(packet, size)); 12645611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 12653deb3ec6SMatthias Ringwald break; 12663deb3ec6SMatthias Ringwald default: 12673deb3ec6SMatthias Ringwald break; 12683deb3ec6SMatthias Ringwald } 12693deb3ec6SMatthias Ringwald break; 12703deb3ec6SMatthias Ringwald case ATT_HANDLE_VALUE_INDICATION: 12714ea43905SMatthias Ringwald if (size < 3u) break; 12724ea43905SMatthias Ringwald report_gatt_indication(handle, little_endian_read_16(packet,1u), &packet[3], size-3u); 12735cf1669fSMatthias Ringwald gatt_client->send_confirmation = 1; 12743deb3ec6SMatthias Ringwald break; 12753deb3ec6SMatthias Ringwald 12763deb3ec6SMatthias Ringwald case ATT_READ_BY_TYPE_RESPONSE: 12775cf1669fSMatthias Ringwald switch (gatt_client->gatt_client_state){ 12783deb3ec6SMatthias Ringwald case P_W4_ALL_CHARACTERISTICS_OF_SERVICE_QUERY_RESULT: 12795cf1669fSMatthias Ringwald report_gatt_characteristics(gatt_client, packet, size); 12805cf1669fSMatthias Ringwald trigger_next_characteristic_query(gatt_client, get_last_result_handle_from_characteristics_list(packet, size)); 12815611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done, or by ATT_ERROR 12823deb3ec6SMatthias Ringwald break; 12833deb3ec6SMatthias Ringwald case P_W4_CHARACTERISTIC_WITH_UUID_QUERY_RESULT: 12845cf1669fSMatthias Ringwald report_gatt_characteristics(gatt_client, packet, size); 12855cf1669fSMatthias Ringwald trigger_next_characteristic_query(gatt_client, get_last_result_handle_from_characteristics_list(packet, size)); 12865611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done, or by ATT_ERROR 12873deb3ec6SMatthias Ringwald break; 12883deb3ec6SMatthias Ringwald case P_W4_INCLUDED_SERVICE_QUERY_RESULT: 12893deb3ec6SMatthias Ringwald { 12904ea43905SMatthias Ringwald if (size < 2u) break; 12913deb3ec6SMatthias Ringwald uint16_t uuid16 = 0; 12923deb3ec6SMatthias Ringwald uint16_t pair_size = packet[1]; 12933deb3ec6SMatthias Ringwald 12944ea43905SMatthias Ringwald if (pair_size == 6u){ 12954ea43905SMatthias Ringwald if (size < 8u) break; 12963deb3ec6SMatthias Ringwald // UUIDs not available, query first included service 12975cf1669fSMatthias Ringwald gatt_client->start_group_handle = little_endian_read_16(packet, 2); // ready for next query 12985cf1669fSMatthias Ringwald gatt_client->query_start_handle = little_endian_read_16(packet, 4); 12995cf1669fSMatthias Ringwald gatt_client->query_end_handle = little_endian_read_16(packet, 6); 13005cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_INCLUDED_SERVICE_WITH_UUID_QUERY; 13013deb3ec6SMatthias Ringwald break; 13023deb3ec6SMatthias Ringwald } 13033deb3ec6SMatthias Ringwald 13044ea43905SMatthias Ringwald if (pair_size != 8u) break; 13059f698c82SMatthias Ringwald 13069f698c82SMatthias Ringwald // UUIDs included, report all of them 13073deb3ec6SMatthias Ringwald uint16_t offset; 13084ea43905SMatthias Ringwald for (offset = 2u; (offset + 8u) <= size; offset += pair_size){ 1309f8fbdce0SMatthias Ringwald uint16_t include_handle = little_endian_read_16(packet, offset); 13105cf1669fSMatthias Ringwald gatt_client->query_start_handle = little_endian_read_16(packet, offset + 2u); 13115cf1669fSMatthias Ringwald gatt_client->query_end_handle = little_endian_read_16(packet, offset + 4u); 13124ea43905SMatthias Ringwald uuid16 = little_endian_read_16(packet, offset+6u); 13135cf1669fSMatthias Ringwald report_gatt_included_service_uuid16(gatt_client, include_handle, uuid16); 13143deb3ec6SMatthias Ringwald } 13153deb3ec6SMatthias Ringwald 13165cf1669fSMatthias Ringwald trigger_next_included_service_query(gatt_client, get_last_result_handle_from_included_services_list(packet, size)); 13175611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 13183deb3ec6SMatthias Ringwald break; 13193deb3ec6SMatthias Ringwald } 1320abdc9fb5SMatthias Ringwald #ifndef ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY 13213deb3ec6SMatthias Ringwald case P_W4_READ_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY_RESULT: 13225cf1669fSMatthias Ringwald gatt_client->client_characteristic_configuration_handle = little_endian_read_16(packet, 2); 13235cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_WRITE_CLIENT_CHARACTERISTIC_CONFIGURATION; 13243deb3ec6SMatthias Ringwald break; 1325abdc9fb5SMatthias Ringwald #endif 13263deb3ec6SMatthias Ringwald case P_W4_READ_BY_TYPE_RESPONSE: { 13273deb3ec6SMatthias Ringwald uint16_t pair_size = packet[1]; 13283deb3ec6SMatthias Ringwald uint16_t offset; 13293deb3ec6SMatthias Ringwald uint16_t last_result_handle = 0; 13303deb3ec6SMatthias Ringwald for (offset = 2; offset < size ; offset += pair_size){ 1331f8fbdce0SMatthias Ringwald uint16_t value_handle = little_endian_read_16(packet, offset); 13325cf1669fSMatthias Ringwald report_gatt_characteristic_value(gatt_client, value_handle, &packet[offset + 2u], pair_size - 2u); 13333deb3ec6SMatthias Ringwald last_result_handle = value_handle; 13343deb3ec6SMatthias Ringwald } 13355cf1669fSMatthias Ringwald trigger_next_read_by_type_query(gatt_client, last_result_handle); 13363deb3ec6SMatthias Ringwald break; 13373deb3ec6SMatthias Ringwald } 13383deb3ec6SMatthias Ringwald default: 13393deb3ec6SMatthias Ringwald break; 13403deb3ec6SMatthias Ringwald } 13413deb3ec6SMatthias Ringwald break; 13423deb3ec6SMatthias Ringwald case ATT_READ_RESPONSE: 13435cf1669fSMatthias Ringwald switch (gatt_client->gatt_client_state){ 13443deb3ec6SMatthias Ringwald case P_W4_INCLUDED_SERVICE_UUID_WITH_QUERY_RESULT: { 13453deb3ec6SMatthias Ringwald uint8_t uuid128[16]; 13469c80e4ccSMatthias Ringwald reverse_128(&packet[1], uuid128); 13475cf1669fSMatthias Ringwald report_gatt_included_service_uuid128(gatt_client, gatt_client->start_group_handle, uuid128); 13485cf1669fSMatthias Ringwald trigger_next_included_service_query(gatt_client, gatt_client->start_group_handle); 13495611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 13503deb3ec6SMatthias Ringwald break; 13513deb3ec6SMatthias Ringwald } 13523deb3ec6SMatthias Ringwald case P_W4_READ_CHARACTERISTIC_VALUE_RESULT: 13535cf1669fSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 13545cf1669fSMatthias Ringwald report_gatt_characteristic_value(gatt_client, gatt_client->attribute_handle, &packet[1], size - 1u); 13555cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_SUCCESS); 13563deb3ec6SMatthias Ringwald break; 13573deb3ec6SMatthias Ringwald 13583deb3ec6SMatthias Ringwald case P_W4_READ_CHARACTERISTIC_DESCRIPTOR_RESULT:{ 13595cf1669fSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 13605cf1669fSMatthias Ringwald report_gatt_characteristic_descriptor(gatt_client, gatt_client->attribute_handle, &packet[1], size - 1u, 0u); 13615cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_SUCCESS); 13623deb3ec6SMatthias Ringwald break; 13633deb3ec6SMatthias Ringwald } 13643deb3ec6SMatthias Ringwald default: 13653deb3ec6SMatthias Ringwald break; 13663deb3ec6SMatthias Ringwald } 13673deb3ec6SMatthias Ringwald break; 13683deb3ec6SMatthias Ringwald 13693deb3ec6SMatthias Ringwald case ATT_FIND_BY_TYPE_VALUE_RESPONSE: 13703deb3ec6SMatthias Ringwald { 13713deb3ec6SMatthias Ringwald uint8_t pair_size = 4; 13723deb3ec6SMatthias Ringwald int i; 13733deb3ec6SMatthias Ringwald uint16_t start_group_handle; 13745611a760SMatthias Ringwald uint16_t end_group_handle= 0xffff; // asserts GATT_EVENT_QUERY_COMPLETE is emitted if no results 13754ea43905SMatthias Ringwald for (i = 1u; (i + pair_size) <= size; i += pair_size){ 1376f8fbdce0SMatthias Ringwald start_group_handle = little_endian_read_16(packet,i); 1377f8fbdce0SMatthias Ringwald end_group_handle = little_endian_read_16(packet,i+2); 13785cf1669fSMatthias Ringwald emit_gatt_service_query_result_event(gatt_client, start_group_handle, end_group_handle, gatt_client->uuid128); 13793deb3ec6SMatthias Ringwald } 13805cf1669fSMatthias Ringwald trigger_next_service_by_uuid_query(gatt_client, end_group_handle); 13815611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 13823deb3ec6SMatthias Ringwald break; 13833deb3ec6SMatthias Ringwald } 13843deb3ec6SMatthias Ringwald case ATT_FIND_INFORMATION_REPLY: 13853deb3ec6SMatthias Ringwald { 13864ea43905SMatthias Ringwald if (size < 2u) break; 1387a6121b51SMilanka Ringwald 13883deb3ec6SMatthias Ringwald uint8_t pair_size = 4; 13894ea43905SMatthias Ringwald if (packet[1u] == 2u){ 13903deb3ec6SMatthias Ringwald pair_size = 18; 13913deb3ec6SMatthias Ringwald } 1392a6121b51SMilanka Ringwald uint16_t offset = 2; 1393a6121b51SMilanka Ringwald 1394a6121b51SMilanka Ringwald if (size < (pair_size + offset)) break; 1395f8fbdce0SMatthias Ringwald uint16_t last_descriptor_handle = little_endian_read_16(packet, size - pair_size); 1396abdc9fb5SMatthias Ringwald 1397abdc9fb5SMatthias Ringwald #ifdef ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY 13985cf1669fSMatthias Ringwald log_info("ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY, state %x", gatt_client->gatt_client_state); 13995cf1669fSMatthias Ringwald if (gatt_client->gatt_client_state == P_W4_FIND_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY_RESULT){ 1400abdc9fb5SMatthias Ringwald // iterate over descriptors looking for CCC 1401abdc9fb5SMatthias Ringwald if (pair_size == 4){ 1402a6121b51SMilanka Ringwald while ((offset + 4) <= size){ 1403abdc9fb5SMatthias Ringwald uint16_t uuid16 = little_endian_read_16(packet, offset + 2); 1404abdc9fb5SMatthias Ringwald if (uuid16 == GATT_CLIENT_CHARACTERISTICS_CONFIGURATION){ 14055cf1669fSMatthias Ringwald gatt_client->client_characteristic_configuration_handle = little_endian_read_16(packet, offset); 14065cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_WRITE_CLIENT_CHARACTERISTIC_CONFIGURATION; 14075cf1669fSMatthias Ringwald log_info("CCC found %x", gatt_client->client_characteristic_configuration_handle); 1408abdc9fb5SMatthias Ringwald break; 1409abdc9fb5SMatthias Ringwald } 1410abdc9fb5SMatthias Ringwald offset += pair_size; 1411abdc9fb5SMatthias Ringwald } 1412abdc9fb5SMatthias Ringwald } 14135cf1669fSMatthias Ringwald if (is_query_done(gatt_client, last_descriptor_handle)){ 1414abdc9fb5SMatthias Ringwald 1415abdc9fb5SMatthias Ringwald } else { 1416abdc9fb5SMatthias Ringwald // next 14175cf1669fSMatthias Ringwald gatt_client->start_group_handle = last_descriptor_handle + 1; 14185cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_FIND_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY; 1419abdc9fb5SMatthias Ringwald } 1420abdc9fb5SMatthias Ringwald break; 1421abdc9fb5SMatthias Ringwald } 1422abdc9fb5SMatthias Ringwald #endif 14235cf1669fSMatthias Ringwald report_gatt_all_characteristic_descriptors(gatt_client, &packet[2], size - 2u, pair_size); 14245cf1669fSMatthias Ringwald trigger_next_characteristic_descriptor_query(gatt_client, last_descriptor_handle); 14255611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 14263deb3ec6SMatthias Ringwald break; 14273deb3ec6SMatthias Ringwald } 14283deb3ec6SMatthias Ringwald 14293deb3ec6SMatthias Ringwald case ATT_WRITE_RESPONSE: 14305cf1669fSMatthias Ringwald switch (gatt_client->gatt_client_state){ 14313deb3ec6SMatthias Ringwald case P_W4_WRITE_CHARACTERISTIC_VALUE_RESULT: 14325cf1669fSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 14335cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_SUCCESS); 14343deb3ec6SMatthias Ringwald break; 14353deb3ec6SMatthias Ringwald case P_W4_CLIENT_CHARACTERISTIC_CONFIGURATION_RESULT: 14365cf1669fSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 14375cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_SUCCESS); 14383deb3ec6SMatthias Ringwald break; 14393deb3ec6SMatthias Ringwald case P_W4_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT: 14405cf1669fSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 14415cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_SUCCESS); 14423deb3ec6SMatthias Ringwald break; 14433deb3ec6SMatthias Ringwald default: 14443deb3ec6SMatthias Ringwald break; 14453deb3ec6SMatthias Ringwald } 14463deb3ec6SMatthias Ringwald break; 14473deb3ec6SMatthias Ringwald 14483deb3ec6SMatthias Ringwald case ATT_READ_BLOB_RESPONSE:{ 14494ea43905SMatthias Ringwald uint16_t received_blob_length = size-1u; 14505cf1669fSMatthias Ringwald switch(gatt_client->gatt_client_state){ 14513deb3ec6SMatthias Ringwald case P_W4_READ_BLOB_RESULT: 14525cf1669fSMatthias Ringwald report_gatt_long_characteristic_value_blob(gatt_client, gatt_client->attribute_handle, &packet[1], received_blob_length, gatt_client->attribute_offset); 14535cf1669fSMatthias Ringwald trigger_next_blob_query(gatt_client, P_W2_SEND_READ_BLOB_QUERY, received_blob_length); 14545611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 14553deb3ec6SMatthias Ringwald break; 14563deb3ec6SMatthias Ringwald case P_W4_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_RESULT: 14575cf1669fSMatthias Ringwald report_gatt_long_characteristic_descriptor(gatt_client, gatt_client->attribute_handle, 14583deb3ec6SMatthias Ringwald &packet[1], received_blob_length, 14595cf1669fSMatthias Ringwald gatt_client->attribute_offset); 14605cf1669fSMatthias Ringwald trigger_next_blob_query(gatt_client, P_W2_SEND_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_QUERY, received_blob_length); 14615611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 14623deb3ec6SMatthias Ringwald break; 14633deb3ec6SMatthias Ringwald default: 14643deb3ec6SMatthias Ringwald break; 14653deb3ec6SMatthias Ringwald } 14663deb3ec6SMatthias Ringwald break; 14673deb3ec6SMatthias Ringwald } 14683deb3ec6SMatthias Ringwald case ATT_PREPARE_WRITE_RESPONSE: 14695cf1669fSMatthias Ringwald switch (gatt_client->gatt_client_state){ 14703deb3ec6SMatthias Ringwald case P_W4_PREPARE_WRITE_SINGLE_RESULT: 14715cf1669fSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 14725cf1669fSMatthias Ringwald if (is_value_valid(gatt_client, packet, size)){ 14735cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_SUCCESS); 14743deb3ec6SMatthias Ringwald } else { 14755cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_DATA_MISMATCH); 14763deb3ec6SMatthias Ringwald } 14773deb3ec6SMatthias Ringwald break; 14783deb3ec6SMatthias Ringwald 14793deb3ec6SMatthias Ringwald case P_W4_PREPARE_WRITE_RESULT:{ 14805cf1669fSMatthias Ringwald gatt_client->attribute_offset = little_endian_read_16(packet, 3); 14815cf1669fSMatthias Ringwald trigger_next_prepare_write_query(gatt_client, P_W2_PREPARE_WRITE, P_W2_EXECUTE_PREPARED_WRITE); 14825611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 14833deb3ec6SMatthias Ringwald break; 14843deb3ec6SMatthias Ringwald } 14853deb3ec6SMatthias Ringwald case P_W4_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT:{ 14865cf1669fSMatthias Ringwald gatt_client->attribute_offset = little_endian_read_16(packet, 3); 14875cf1669fSMatthias Ringwald trigger_next_prepare_write_query(gatt_client, P_W2_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR, P_W2_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR); 14885611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 14893deb3ec6SMatthias Ringwald break; 14903deb3ec6SMatthias Ringwald } 14913deb3ec6SMatthias Ringwald case P_W4_PREPARE_RELIABLE_WRITE_RESULT:{ 14925cf1669fSMatthias Ringwald if (is_value_valid(gatt_client, packet, size)){ 14935cf1669fSMatthias Ringwald gatt_client->attribute_offset = little_endian_read_16(packet, 3); 14945cf1669fSMatthias Ringwald trigger_next_prepare_write_query(gatt_client, P_W2_PREPARE_RELIABLE_WRITE, P_W2_EXECUTE_PREPARED_WRITE); 14955611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 14963deb3ec6SMatthias Ringwald break; 14973deb3ec6SMatthias Ringwald } 14985cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_CANCEL_PREPARED_WRITE_DATA_MISMATCH; 14993deb3ec6SMatthias Ringwald break; 15003deb3ec6SMatthias Ringwald } 15013deb3ec6SMatthias Ringwald default: 15023deb3ec6SMatthias Ringwald break; 15033deb3ec6SMatthias Ringwald } 15043deb3ec6SMatthias Ringwald break; 15053deb3ec6SMatthias Ringwald 15063deb3ec6SMatthias Ringwald case ATT_EXECUTE_WRITE_RESPONSE: 15075cf1669fSMatthias Ringwald switch (gatt_client->gatt_client_state){ 15083deb3ec6SMatthias Ringwald case P_W4_EXECUTE_PREPARED_WRITE_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_CANCEL_PREPARED_WRITE_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_CANCEL_PREPARED_WRITE_DATA_MISMATCH_RESULT: 15175cf1669fSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 15185cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_DATA_MISMATCH); 15193deb3ec6SMatthias Ringwald break; 15203deb3ec6SMatthias Ringwald case P_W4_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT: 15215cf1669fSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 15225cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_SUCCESS); 15233deb3ec6SMatthias Ringwald break; 15243deb3ec6SMatthias Ringwald default: 15253deb3ec6SMatthias Ringwald break; 15263deb3ec6SMatthias Ringwald 15273deb3ec6SMatthias Ringwald } 15283deb3ec6SMatthias Ringwald break; 15293deb3ec6SMatthias Ringwald 15303deb3ec6SMatthias Ringwald case ATT_READ_MULTIPLE_RESPONSE: 15315cf1669fSMatthias Ringwald switch(gatt_client->gatt_client_state){ 15323deb3ec6SMatthias Ringwald case P_W4_READ_MULTIPLE_RESPONSE: 15335cf1669fSMatthias Ringwald report_gatt_characteristic_value(gatt_client, 0u, &packet[1], size - 1u); 15345cf1669fSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 15355cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_SUCCESS); 15363deb3ec6SMatthias Ringwald break; 15373deb3ec6SMatthias Ringwald default: 15383deb3ec6SMatthias Ringwald break; 15393deb3ec6SMatthias Ringwald } 15403deb3ec6SMatthias Ringwald break; 15413deb3ec6SMatthias Ringwald 15423deb3ec6SMatthias Ringwald case ATT_ERROR_RESPONSE: 15434ea43905SMatthias Ringwald if (size < 5u) return; 1544f060f108SMatthias Ringwald error_code = packet[4]; 1545f060f108SMatthias Ringwald switch (error_code){ 15463deb3ec6SMatthias Ringwald case ATT_ERROR_ATTRIBUTE_NOT_FOUND: { 15475cf1669fSMatthias Ringwald switch(gatt_client->gatt_client_state){ 15483deb3ec6SMatthias Ringwald case P_W4_SERVICE_QUERY_RESULT: 15493deb3ec6SMatthias Ringwald case P_W4_SERVICE_WITH_UUID_RESULT: 15503deb3ec6SMatthias Ringwald case P_W4_INCLUDED_SERVICE_QUERY_RESULT: 15513deb3ec6SMatthias Ringwald case P_W4_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY_RESULT: 15525cf1669fSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 15535cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_SUCCESS); 15543deb3ec6SMatthias Ringwald break; 15553deb3ec6SMatthias Ringwald case P_W4_ALL_CHARACTERISTICS_OF_SERVICE_QUERY_RESULT: 15563deb3ec6SMatthias Ringwald case P_W4_CHARACTERISTIC_WITH_UUID_QUERY_RESULT: 15575cf1669fSMatthias Ringwald characteristic_end_found(gatt_client, gatt_client->end_group_handle); 15585cf1669fSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 15595cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_SUCCESS); 15603deb3ec6SMatthias Ringwald break; 15613deb3ec6SMatthias Ringwald case P_W4_READ_BY_TYPE_RESPONSE: 15625cf1669fSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 15635cf1669fSMatthias Ringwald if (gatt_client->start_group_handle == gatt_client->query_start_handle){ 15645cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_ATTRIBUTE_NOT_FOUND); 15653deb3ec6SMatthias Ringwald } else { 15665cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_SUCCESS); 15673deb3ec6SMatthias Ringwald } 15683deb3ec6SMatthias Ringwald break; 15693deb3ec6SMatthias Ringwald default: 1570f060f108SMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, error_code); 15713deb3ec6SMatthias Ringwald break; 15723deb3ec6SMatthias Ringwald } 15733deb3ec6SMatthias Ringwald break; 15743deb3ec6SMatthias Ringwald } 1575f4b33574SMatthias Ringwald 1576f4b33574SMatthias Ringwald #ifdef ENABLE_GATT_CLIENT_PAIRING 1577f4b33574SMatthias Ringwald 1578f4b33574SMatthias Ringwald case ATT_ERROR_INSUFFICIENT_AUTHENTICATION: 1579f4b33574SMatthias Ringwald case ATT_ERROR_INSUFFICIENT_ENCRYPTION_KEY_SIZE: 1580a0e0c2beSMatthias Ringwald case ATT_ERROR_INSUFFICIENT_ENCRYPTION: { 1581a0e0c2beSMatthias Ringwald 1582f4b33574SMatthias Ringwald // security too low 15835cf1669fSMatthias Ringwald if (gatt_client->security_counter > 0) { 1584f060f108SMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, error_code); 1585f4b33574SMatthias Ringwald break; 1586f4b33574SMatthias Ringwald } 1587f4b33574SMatthias Ringwald // start security 15885cf1669fSMatthias Ringwald gatt_client->security_counter++; 1589f4b33574SMatthias Ringwald 1590f4b33574SMatthias Ringwald // setup action 1591f4b33574SMatthias Ringwald int retry = 1; 15925cf1669fSMatthias Ringwald switch (gatt_client->gatt_client_state){ 1593f4b33574SMatthias Ringwald case P_W4_READ_CHARACTERISTIC_VALUE_RESULT: 15945cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_CHARACTERISTIC_VALUE_QUERY ; 1595f4b33574SMatthias Ringwald break; 1596f4b33574SMatthias Ringwald case P_W4_READ_BLOB_RESULT: 15975cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_BLOB_QUERY; 1598f4b33574SMatthias Ringwald break; 1599f4b33574SMatthias Ringwald case P_W4_READ_BY_TYPE_RESPONSE: 16005cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_BY_TYPE_REQUEST; 1601f4b33574SMatthias Ringwald break; 1602f4b33574SMatthias Ringwald case P_W4_READ_MULTIPLE_RESPONSE: 16035cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_MULTIPLE_REQUEST; 1604f4b33574SMatthias Ringwald break; 1605f4b33574SMatthias Ringwald case P_W4_WRITE_CHARACTERISTIC_VALUE_RESULT: 16065cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_WRITE_CHARACTERISTIC_VALUE; 1607f4b33574SMatthias Ringwald break; 1608f4b33574SMatthias Ringwald case P_W4_PREPARE_WRITE_RESULT: 16095cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_PREPARE_WRITE; 1610f4b33574SMatthias Ringwald break; 1611f4b33574SMatthias Ringwald case P_W4_PREPARE_WRITE_SINGLE_RESULT: 16125cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_PREPARE_WRITE_SINGLE; 1613f4b33574SMatthias Ringwald break; 1614f4b33574SMatthias Ringwald case P_W4_PREPARE_RELIABLE_WRITE_RESULT: 16155cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_PREPARE_RELIABLE_WRITE; 1616f4b33574SMatthias Ringwald break; 1617f4b33574SMatthias Ringwald case P_W4_EXECUTE_PREPARED_WRITE_RESULT: 16185cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_EXECUTE_PREPARED_WRITE; 1619f4b33574SMatthias Ringwald break; 1620f4b33574SMatthias Ringwald case P_W4_CANCEL_PREPARED_WRITE_RESULT: 16215cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_CANCEL_PREPARED_WRITE; 1622f4b33574SMatthias Ringwald break; 1623f4b33574SMatthias Ringwald case P_W4_CANCEL_PREPARED_WRITE_DATA_MISMATCH_RESULT: 16245cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_CANCEL_PREPARED_WRITE_DATA_MISMATCH; 1625f4b33574SMatthias Ringwald break; 1626f4b33574SMatthias Ringwald case P_W4_READ_CHARACTERISTIC_DESCRIPTOR_RESULT: 16275cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_CHARACTERISTIC_DESCRIPTOR_QUERY; 1628f4b33574SMatthias Ringwald break; 1629f4b33574SMatthias Ringwald case P_W4_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_RESULT: 16305cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_QUERY; 1631f4b33574SMatthias Ringwald break; 1632f4b33574SMatthias Ringwald case P_W4_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT: 16335cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_WRITE_CHARACTERISTIC_DESCRIPTOR; 1634f4b33574SMatthias Ringwald break; 1635f4b33574SMatthias Ringwald case P_W4_CLIENT_CHARACTERISTIC_CONFIGURATION_RESULT: 16365cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_WRITE_CLIENT_CHARACTERISTIC_CONFIGURATION; 1637f4b33574SMatthias Ringwald break; 1638f4b33574SMatthias Ringwald case P_W4_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT: 16395cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR; 1640f4b33574SMatthias Ringwald break; 1641f4b33574SMatthias Ringwald case P_W4_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT: 16425cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR; 1643f4b33574SMatthias Ringwald break; 1644f4b33574SMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 1645f4b33574SMatthias Ringwald case P_W4_SEND_SINGED_WRITE_DONE: 16465cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_SIGNED_WRITE; 1647f4b33574SMatthias Ringwald break; 1648f4b33574SMatthias Ringwald #endif 1649f4b33574SMatthias Ringwald default: 16505cf1669fSMatthias Ringwald log_info("retry not supported for state %x", gatt_client->gatt_client_state); 1651f4b33574SMatthias Ringwald retry = 0; 1652f4b33574SMatthias Ringwald break; 1653f4b33574SMatthias Ringwald } 1654f4b33574SMatthias Ringwald 1655f4b33574SMatthias Ringwald if (!retry) { 1656f060f108SMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, error_code); 1657f4b33574SMatthias Ringwald break; 1658f4b33574SMatthias Ringwald } 1659f4b33574SMatthias Ringwald 1660f4b33574SMatthias Ringwald log_info("security error, start pairing"); 1661f4b33574SMatthias Ringwald 1662f060f108SMatthias Ringwald // start pairing for higher security level 16635cf1669fSMatthias Ringwald gatt_client->wait_for_pairing_complete = 1; 1664f060f108SMatthias Ringwald gatt_client->pending_error_code = error_code; 16655cf1669fSMatthias Ringwald sm_request_pairing(gatt_client->con_handle); 1666f4b33574SMatthias Ringwald break; 1667a0e0c2beSMatthias Ringwald } 1668f4b33574SMatthias Ringwald #endif 1669f4b33574SMatthias Ringwald 1670f4b33574SMatthias Ringwald // nothing we can do about that 1671f4b33574SMatthias Ringwald case ATT_ERROR_INSUFFICIENT_AUTHORIZATION: 16723deb3ec6SMatthias Ringwald default: 1673f060f108SMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, error_code); 16743deb3ec6SMatthias Ringwald break; 16753deb3ec6SMatthias Ringwald } 16763deb3ec6SMatthias Ringwald break; 16773deb3ec6SMatthias Ringwald 16783deb3ec6SMatthias Ringwald default: 16793deb3ec6SMatthias Ringwald log_info("ATT Handler, unhandled response type 0x%02x", packet[0]); 16803deb3ec6SMatthias Ringwald break; 16813deb3ec6SMatthias Ringwald } 16823deb3ec6SMatthias Ringwald gatt_client_run(); 16833deb3ec6SMatthias Ringwald } 16843deb3ec6SMatthias Ringwald 16857a766ebfSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 16863deb3ec6SMatthias Ringwald static void att_signed_write_handle_cmac_result(uint8_t hash[8]){ 1687665d90f2SMatthias Ringwald btstack_linked_list_iterator_t it; 1688665d90f2SMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client_connections); 1689665d90f2SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 16905cf1669fSMatthias Ringwald gatt_client_t * gatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it); 16915cf1669fSMatthias Ringwald if (gatt_client->gatt_client_state == P_W4_CMAC_RESULT){ 16923deb3ec6SMatthias Ringwald // store result 16935cf1669fSMatthias Ringwald (void)memcpy(gatt_client->cmac, hash, 8); 16945cf1669fSMatthias Ringwald // reverse_64(hash, gatt_client->cmac); 16955cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_SIGNED_WRITE; 16963deb3ec6SMatthias Ringwald gatt_client_run(); 16973deb3ec6SMatthias Ringwald return; 16983deb3ec6SMatthias Ringwald } 16993deb3ec6SMatthias Ringwald } 17003deb3ec6SMatthias Ringwald } 17013deb3ec6SMatthias Ringwald 1702711e6c80SMatthias 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){ 17035cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle(con_handle); 17045cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 17055cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 17063deb3ec6SMatthias Ringwald 17075cf1669fSMatthias Ringwald gatt_client->callback = callback; 17085cf1669fSMatthias Ringwald gatt_client->attribute_handle = handle; 17095cf1669fSMatthias Ringwald gatt_client->attribute_length = message_len; 17105cf1669fSMatthias Ringwald gatt_client->attribute_value = message; 17115cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_IDENTITY_RESOLVING; 17123deb3ec6SMatthias Ringwald gatt_client_run(); 171325b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 17143deb3ec6SMatthias Ringwald } 17157a766ebfSMatthias Ringwald #endif 17163deb3ec6SMatthias Ringwald 1717711e6c80SMatthias Ringwald uint8_t gatt_client_discover_primary_services(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 17185cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 17195cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 17205cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 17213deb3ec6SMatthias Ringwald 17225cf1669fSMatthias Ringwald gatt_client->callback = callback; 17235cf1669fSMatthias Ringwald gatt_client->start_group_handle = 0x0001; 17245cf1669fSMatthias Ringwald gatt_client->end_group_handle = 0xffff; 17255cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_SERVICE_QUERY; 17265cf1669fSMatthias Ringwald gatt_client->uuid16 = 0; 17273deb3ec6SMatthias Ringwald gatt_client_run(); 172825b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 17293deb3ec6SMatthias Ringwald } 17303deb3ec6SMatthias Ringwald 17313deb3ec6SMatthias Ringwald 1732711e6c80SMatthias Ringwald uint8_t gatt_client_discover_primary_services_by_uuid16(btstack_packet_handler_t callback, hci_con_handle_t con_handle, uint16_t uuid16){ 17335cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 17345cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 17355cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 17363deb3ec6SMatthias Ringwald 17375cf1669fSMatthias Ringwald gatt_client->callback = callback; 17385cf1669fSMatthias Ringwald gatt_client->start_group_handle = 0x0001; 17395cf1669fSMatthias Ringwald gatt_client->end_group_handle = 0xffff; 17405cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_SERVICE_WITH_UUID_QUERY; 17415cf1669fSMatthias Ringwald gatt_client->uuid16 = uuid16; 17425cf1669fSMatthias Ringwald uuid_add_bluetooth_prefix((uint8_t*) &(gatt_client->uuid128), gatt_client->uuid16); 17433deb3ec6SMatthias Ringwald gatt_client_run(); 174425b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 17453deb3ec6SMatthias Ringwald } 17463deb3ec6SMatthias Ringwald 1747711e6c80SMatthias 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){ 17485cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 17495cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 17505cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 17513deb3ec6SMatthias Ringwald 17525cf1669fSMatthias Ringwald gatt_client->callback = callback; 17535cf1669fSMatthias Ringwald gatt_client->start_group_handle = 0x0001; 17545cf1669fSMatthias Ringwald gatt_client->end_group_handle = 0xffff; 17555cf1669fSMatthias Ringwald gatt_client->uuid16 = 0; 17565cf1669fSMatthias Ringwald (void)memcpy(gatt_client->uuid128, uuid128, 16); 17575cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_SERVICE_WITH_UUID_QUERY; 17583deb3ec6SMatthias Ringwald gatt_client_run(); 175925b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 17603deb3ec6SMatthias Ringwald } 17613deb3ec6SMatthias Ringwald 1762711e6c80SMatthias 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){ 17635cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 17645cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 17655cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 17663deb3ec6SMatthias Ringwald 17675cf1669fSMatthias Ringwald gatt_client->callback = callback; 17685cf1669fSMatthias Ringwald gatt_client->start_group_handle = service->start_group_handle; 17695cf1669fSMatthias Ringwald gatt_client->end_group_handle = service->end_group_handle; 17705cf1669fSMatthias Ringwald gatt_client->filter_with_uuid = 0; 17715cf1669fSMatthias Ringwald gatt_client->characteristic_start_handle = 0; 17725cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_ALL_CHARACTERISTICS_OF_SERVICE_QUERY; 17733deb3ec6SMatthias Ringwald gatt_client_run(); 177425b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 17753deb3ec6SMatthias Ringwald } 17763deb3ec6SMatthias Ringwald 1777711e6c80SMatthias 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){ 17785cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 17795cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 17805cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 17815cf1669fSMatthias Ringwald gatt_client->callback = callback; 17825cf1669fSMatthias Ringwald gatt_client->start_group_handle = service->start_group_handle; 17835cf1669fSMatthias Ringwald gatt_client->end_group_handle = service->end_group_handle; 17845cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_INCLUDED_SERVICE_QUERY; 17853deb3ec6SMatthias Ringwald 17863deb3ec6SMatthias Ringwald gatt_client_run(); 178725b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 17883deb3ec6SMatthias Ringwald } 17893deb3ec6SMatthias Ringwald 1790711e6c80SMatthias 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){ 17915cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 17925cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 17935cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 17943deb3ec6SMatthias Ringwald 17955cf1669fSMatthias Ringwald gatt_client->callback = callback; 17965cf1669fSMatthias Ringwald gatt_client->start_group_handle = start_handle; 17975cf1669fSMatthias Ringwald gatt_client->end_group_handle = end_handle; 17985cf1669fSMatthias Ringwald gatt_client->filter_with_uuid = 1; 17995cf1669fSMatthias Ringwald gatt_client->uuid16 = uuid16; 18005cf1669fSMatthias Ringwald uuid_add_bluetooth_prefix((uint8_t*) &(gatt_client->uuid128), uuid16); 18015cf1669fSMatthias Ringwald gatt_client->characteristic_start_handle = 0; 18025cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_CHARACTERISTIC_WITH_UUID_QUERY; 18033deb3ec6SMatthias Ringwald gatt_client_run(); 180425b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 18053deb3ec6SMatthias Ringwald } 18063deb3ec6SMatthias Ringwald 1807711e6c80SMatthias 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){ 18085cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 18095cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 18105cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 18113deb3ec6SMatthias Ringwald 18125cf1669fSMatthias Ringwald gatt_client->callback = callback; 18135cf1669fSMatthias Ringwald gatt_client->start_group_handle = start_handle; 18145cf1669fSMatthias Ringwald gatt_client->end_group_handle = end_handle; 18155cf1669fSMatthias Ringwald gatt_client->filter_with_uuid = 1; 18165cf1669fSMatthias Ringwald gatt_client->uuid16 = 0; 18175cf1669fSMatthias Ringwald (void)memcpy(gatt_client->uuid128, uuid128, 16); 18185cf1669fSMatthias Ringwald gatt_client->characteristic_start_handle = 0; 18195cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_CHARACTERISTIC_WITH_UUID_QUERY; 18203deb3ec6SMatthias Ringwald gatt_client_run(); 182125b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 18223deb3ec6SMatthias Ringwald } 18233deb3ec6SMatthias Ringwald 18243deb3ec6SMatthias Ringwald 1825d25c33e5SMatthias 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){ 18269c662c9bSMatthias Ringwald return gatt_client_discover_characteristics_for_handle_range_by_uuid16(callback, handle, service->start_group_handle, service->end_group_handle, uuid16); 18273deb3ec6SMatthias Ringwald } 18283deb3ec6SMatthias Ringwald 1829d25c33e5SMatthias 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){ 18309c662c9bSMatthias Ringwald return gatt_client_discover_characteristics_for_handle_range_by_uuid128(callback, handle, service->start_group_handle, service->end_group_handle, uuid128); 18313deb3ec6SMatthias Ringwald } 18323deb3ec6SMatthias Ringwald 1833711e6c80SMatthias Ringwald uint8_t gatt_client_discover_characteristic_descriptors(btstack_packet_handler_t callback, hci_con_handle_t con_handle, gatt_client_characteristic_t *characteristic){ 18345cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 18355cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 18365cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 18373deb3ec6SMatthias Ringwald 18383deb3ec6SMatthias Ringwald if (characteristic->value_handle == characteristic->end_handle){ 18395cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_SUCCESS); 184025b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 18413deb3ec6SMatthias Ringwald } 18425cf1669fSMatthias Ringwald gatt_client->callback = callback; 18435cf1669fSMatthias Ringwald gatt_client->start_group_handle = characteristic->value_handle + 1u; 18445cf1669fSMatthias Ringwald gatt_client->end_group_handle = characteristic->end_handle; 18455cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY; 18463deb3ec6SMatthias Ringwald gatt_client_run(); 184725b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 18483deb3ec6SMatthias Ringwald } 18493deb3ec6SMatthias Ringwald 1850711e6c80SMatthias 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){ 18515cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 18525cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 18535cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 18543deb3ec6SMatthias Ringwald 18555cf1669fSMatthias Ringwald gatt_client->callback = callback; 18565cf1669fSMatthias Ringwald gatt_client->attribute_handle = value_handle; 18575cf1669fSMatthias Ringwald gatt_client->attribute_offset = 0; 18585cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_CHARACTERISTIC_VALUE_QUERY; 18593deb3ec6SMatthias Ringwald gatt_client_run(); 186025b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 18613deb3ec6SMatthias Ringwald } 18623deb3ec6SMatthias Ringwald 1863711e6c80SMatthias 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){ 18645cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 18655cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 18665cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 18673deb3ec6SMatthias Ringwald 18685cf1669fSMatthias Ringwald gatt_client->callback = callback; 18695cf1669fSMatthias Ringwald gatt_client->start_group_handle = start_handle; 18705cf1669fSMatthias Ringwald gatt_client->end_group_handle = end_handle; 18715cf1669fSMatthias Ringwald gatt_client->query_start_handle = start_handle; 18725cf1669fSMatthias Ringwald gatt_client->query_end_handle = end_handle; 18735cf1669fSMatthias Ringwald gatt_client->uuid16 = uuid16; 18745cf1669fSMatthias Ringwald uuid_add_bluetooth_prefix((uint8_t*) &(gatt_client->uuid128), uuid16); 18755cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_BY_TYPE_REQUEST; 18763deb3ec6SMatthias Ringwald gatt_client_run(); 187725b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 18783deb3ec6SMatthias Ringwald } 18793deb3ec6SMatthias Ringwald 1880711e6c80SMatthias 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){ 18815cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 18825cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 18835cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 18843deb3ec6SMatthias Ringwald 18855cf1669fSMatthias Ringwald gatt_client->callback = callback; 18865cf1669fSMatthias Ringwald gatt_client->start_group_handle = start_handle; 18875cf1669fSMatthias Ringwald gatt_client->end_group_handle = end_handle; 18885cf1669fSMatthias Ringwald gatt_client->query_start_handle = start_handle; 18895cf1669fSMatthias Ringwald gatt_client->query_end_handle = end_handle; 18905cf1669fSMatthias Ringwald gatt_client->uuid16 = 0; 18915cf1669fSMatthias Ringwald (void)memcpy(gatt_client->uuid128, uuid128, 16); 18925cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_BY_TYPE_REQUEST; 18933deb3ec6SMatthias Ringwald gatt_client_run(); 189425b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 18953deb3ec6SMatthias Ringwald } 18963deb3ec6SMatthias Ringwald 18973deb3ec6SMatthias Ringwald 1898d25c33e5SMatthias Ringwald uint8_t gatt_client_read_value_of_characteristic(btstack_packet_handler_t callback, uint16_t handle, gatt_client_characteristic_t *characteristic){ 18999c662c9bSMatthias Ringwald return gatt_client_read_value_of_characteristic_using_value_handle(callback, handle, characteristic->value_handle); 19003deb3ec6SMatthias Ringwald } 19013deb3ec6SMatthias Ringwald 1902711e6c80SMatthias 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){ 19035cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 19045cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 19055cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 19063deb3ec6SMatthias Ringwald 19075cf1669fSMatthias Ringwald gatt_client->callback = callback; 19085cf1669fSMatthias Ringwald gatt_client->attribute_handle = characteristic_value_handle; 19095cf1669fSMatthias Ringwald gatt_client->attribute_offset = offset; 19105cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_BLOB_QUERY; 19113deb3ec6SMatthias Ringwald gatt_client_run(); 191225b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 19133deb3ec6SMatthias Ringwald } 19143deb3ec6SMatthias Ringwald 1915711e6c80SMatthias 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){ 19169c662c9bSMatthias Ringwald return gatt_client_read_long_value_of_characteristic_using_value_handle_with_offset(callback, con_handle, characteristic_value_handle, 0); 19173deb3ec6SMatthias Ringwald } 19183deb3ec6SMatthias Ringwald 1919d25c33e5SMatthias Ringwald uint8_t gatt_client_read_long_value_of_characteristic(btstack_packet_handler_t callback, uint16_t handle, gatt_client_characteristic_t *characteristic){ 19209c662c9bSMatthias Ringwald return gatt_client_read_long_value_of_characteristic_using_value_handle(callback, handle, characteristic->value_handle); 19213deb3ec6SMatthias Ringwald } 19223deb3ec6SMatthias Ringwald 1923711e6c80SMatthias 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){ 19245cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 19255cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 19265cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 19273deb3ec6SMatthias Ringwald 19285cf1669fSMatthias Ringwald gatt_client->callback = callback; 19295cf1669fSMatthias Ringwald gatt_client->read_multiple_handle_count = num_value_handles; 19305cf1669fSMatthias Ringwald gatt_client->read_multiple_handles = value_handles; 19315cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_MULTIPLE_REQUEST; 19323deb3ec6SMatthias Ringwald gatt_client_run(); 193325b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 19343deb3ec6SMatthias Ringwald } 19353deb3ec6SMatthias Ringwald 1936de9f8e94SMatthias 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){ 19375cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle(con_handle); 19385cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 19393deb3ec6SMatthias Ringwald 1940dda77937SMatthias Ringwald if (value_length > (gatt_client->mtu - 3u)) return GATT_CLIENT_VALUE_TOO_LONG; 19415cf1669fSMatthias Ringwald if (!att_dispatch_client_can_send_now(gatt_client->con_handle)) return GATT_CLIENT_BUSY; 19423deb3ec6SMatthias Ringwald 19435cf1669fSMatthias Ringwald return att_write_request(ATT_WRITE_COMMAND, gatt_client->con_handle, value_handle, value_length, value); 19443deb3ec6SMatthias Ringwald } 19453deb3ec6SMatthias Ringwald 1946711e6c80SMatthias 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){ 19475cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 19485cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 19495cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 19503deb3ec6SMatthias Ringwald 19515cf1669fSMatthias Ringwald gatt_client->callback = callback; 19525cf1669fSMatthias Ringwald gatt_client->attribute_handle = value_handle; 19535cf1669fSMatthias Ringwald gatt_client->attribute_length = value_length; 19545cf1669fSMatthias Ringwald gatt_client->attribute_value = data; 19555cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_WRITE_CHARACTERISTIC_VALUE; 19563deb3ec6SMatthias Ringwald gatt_client_run(); 195725b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 19583deb3ec6SMatthias Ringwald } 19593deb3ec6SMatthias Ringwald 1960711e6c80SMatthias 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){ 19615cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 19625cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 19635cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 19643deb3ec6SMatthias Ringwald 19655cf1669fSMatthias Ringwald gatt_client->callback = callback; 19665cf1669fSMatthias Ringwald gatt_client->attribute_handle = value_handle; 19675cf1669fSMatthias Ringwald gatt_client->attribute_length = value_length; 19685cf1669fSMatthias Ringwald gatt_client->attribute_offset = offset; 19695cf1669fSMatthias Ringwald gatt_client->attribute_value = data; 19705cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_PREPARE_WRITE; 19713deb3ec6SMatthias Ringwald gatt_client_run(); 197225b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 19733deb3ec6SMatthias Ringwald } 19743deb3ec6SMatthias Ringwald 1975711e6c80SMatthias 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){ 19769c662c9bSMatthias Ringwald return gatt_client_write_long_value_of_characteristic_with_offset(callback, con_handle, value_handle, 0, value_length, value); 19773deb3ec6SMatthias Ringwald } 19783deb3ec6SMatthias Ringwald 1979711e6c80SMatthias 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){ 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 = value_handle; 19865cf1669fSMatthias Ringwald gatt_client->attribute_length = value_length; 19875cf1669fSMatthias Ringwald gatt_client->attribute_offset = 0; 19885cf1669fSMatthias Ringwald gatt_client->attribute_value = value; 19895cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_PREPARE_RELIABLE_WRITE; 19903deb3ec6SMatthias Ringwald gatt_client_run(); 199125b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 19923deb3ec6SMatthias Ringwald } 19933deb3ec6SMatthias Ringwald 1994711e6c80SMatthias 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){ 19955cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 19965cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 19975cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 19983deb3ec6SMatthias Ringwald 19993deb3ec6SMatthias Ringwald if ( (configuration & GATT_CLIENT_CHARACTERISTICS_CONFIGURATION_NOTIFICATION) && 20004ea43905SMatthias Ringwald ((characteristic->properties & ATT_PROPERTY_NOTIFY) == 0u)) { 2001d8e8f12aSMatthias Ringwald log_info("gatt_client_write_client_characteristic_configuration: GATT_CLIENT_CHARACTERISTIC_NOTIFICATION_NOT_SUPPORTED"); 2002616edd56SMatthias Ringwald return GATT_CLIENT_CHARACTERISTIC_NOTIFICATION_NOT_SUPPORTED; 20033deb3ec6SMatthias Ringwald } else if ( (configuration & GATT_CLIENT_CHARACTERISTICS_CONFIGURATION_INDICATION) && 20044ea43905SMatthias Ringwald ((characteristic->properties & ATT_PROPERTY_INDICATE) == 0u)){ 2005d8e8f12aSMatthias Ringwald log_info("gatt_client_write_client_characteristic_configuration: GATT_CLIENT_CHARACTERISTIC_INDICATION_NOT_SUPPORTED"); 2006616edd56SMatthias Ringwald return GATT_CLIENT_CHARACTERISTIC_INDICATION_NOT_SUPPORTED; 20073deb3ec6SMatthias Ringwald } 20083deb3ec6SMatthias Ringwald 20095cf1669fSMatthias Ringwald gatt_client->callback = callback; 20105cf1669fSMatthias Ringwald gatt_client->start_group_handle = characteristic->value_handle; 20115cf1669fSMatthias Ringwald gatt_client->end_group_handle = characteristic->end_handle; 20125cf1669fSMatthias Ringwald little_endian_store_16(gatt_client->client_characteristic_configuration_value, 0, configuration); 20133deb3ec6SMatthias Ringwald 2014abdc9fb5SMatthias Ringwald #ifdef ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY 20155cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_FIND_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY; 2016abdc9fb5SMatthias Ringwald #else 20175cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY; 2018abdc9fb5SMatthias Ringwald #endif 20193deb3ec6SMatthias Ringwald gatt_client_run(); 20209cb80b17SMilanka Ringwald return ERROR_CODE_SUCCESS; 20213deb3ec6SMatthias Ringwald } 20223deb3ec6SMatthias Ringwald 2023711e6c80SMatthias 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){ 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 = descriptor_handle; 20303deb3ec6SMatthias Ringwald 20315cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_CHARACTERISTIC_DESCRIPTOR_QUERY; 20323deb3ec6SMatthias Ringwald gatt_client_run(); 203325b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 20343deb3ec6SMatthias Ringwald } 20353deb3ec6SMatthias Ringwald 2036711e6c80SMatthias 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){ 20379c662c9bSMatthias Ringwald return gatt_client_read_characteristic_descriptor_using_descriptor_handle(callback, con_handle, descriptor->handle); 20383deb3ec6SMatthias Ringwald } 20393deb3ec6SMatthias Ringwald 2040711e6c80SMatthias 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){ 20415cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 20425cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 20435cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 20443deb3ec6SMatthias Ringwald 20455cf1669fSMatthias Ringwald gatt_client->callback = callback; 20465cf1669fSMatthias Ringwald gatt_client->attribute_handle = descriptor_handle; 20475cf1669fSMatthias Ringwald gatt_client->attribute_offset = offset; 20485cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_QUERY; 20493deb3ec6SMatthias Ringwald gatt_client_run(); 205025b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 20513deb3ec6SMatthias Ringwald } 20523deb3ec6SMatthias Ringwald 2053711e6c80SMatthias 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){ 20549c662c9bSMatthias Ringwald return gatt_client_read_long_characteristic_descriptor_using_descriptor_handle_with_offset(callback, con_handle, descriptor_handle, 0); 20553deb3ec6SMatthias Ringwald } 20563deb3ec6SMatthias Ringwald 2057711e6c80SMatthias 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){ 20589c662c9bSMatthias Ringwald return gatt_client_read_long_characteristic_descriptor_using_descriptor_handle(callback, con_handle, descriptor->handle); 20593deb3ec6SMatthias Ringwald } 20603deb3ec6SMatthias Ringwald 2061711e6c80SMatthias 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){ 20625cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 20635cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 20645cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 20653deb3ec6SMatthias Ringwald 20665cf1669fSMatthias Ringwald gatt_client->callback = callback; 20675cf1669fSMatthias Ringwald gatt_client->attribute_handle = descriptor_handle; 20685cf1669fSMatthias Ringwald gatt_client->attribute_length = length; 20695cf1669fSMatthias Ringwald gatt_client->attribute_offset = 0; 20705cf1669fSMatthias Ringwald gatt_client->attribute_value = data; 20715cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_WRITE_CHARACTERISTIC_DESCRIPTOR; 20723deb3ec6SMatthias Ringwald gatt_client_run(); 207325b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 20743deb3ec6SMatthias Ringwald } 20753deb3ec6SMatthias Ringwald 2076711e6c80SMatthias 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){ 20779c662c9bSMatthias Ringwald return gatt_client_write_characteristic_descriptor_using_descriptor_handle(callback, con_handle, descriptor->handle, length, value); 20783deb3ec6SMatthias Ringwald } 20793deb3ec6SMatthias Ringwald 2080711e6c80SMatthias 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){ 20815cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 20825cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 20835cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 20843deb3ec6SMatthias Ringwald 20855cf1669fSMatthias Ringwald gatt_client->callback = callback; 20865cf1669fSMatthias Ringwald gatt_client->attribute_handle = descriptor_handle; 20875cf1669fSMatthias Ringwald gatt_client->attribute_length = length; 20885cf1669fSMatthias Ringwald gatt_client->attribute_offset = offset; 20895cf1669fSMatthias Ringwald gatt_client->attribute_value = data; 20905cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR; 20913deb3ec6SMatthias Ringwald gatt_client_run(); 209225b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 20933deb3ec6SMatthias Ringwald } 20943deb3ec6SMatthias Ringwald 2095711e6c80SMatthias 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){ 20969c662c9bSMatthias Ringwald return gatt_client_write_long_characteristic_descriptor_using_descriptor_handle_with_offset(callback, con_handle, descriptor_handle, 0, length, data ); 20973deb3ec6SMatthias Ringwald } 20983deb3ec6SMatthias Ringwald 2099711e6c80SMatthias 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){ 21009c662c9bSMatthias Ringwald return gatt_client_write_long_characteristic_descriptor_using_descriptor_handle(callback, con_handle, descriptor->handle, length, value); 21013deb3ec6SMatthias Ringwald } 21023deb3ec6SMatthias Ringwald 21033deb3ec6SMatthias Ringwald /** 21043deb3ec6SMatthias Ringwald * @brief -> gatt complete event 21053deb3ec6SMatthias Ringwald */ 2106711e6c80SMatthias 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){ 21075cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 21085cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 21095cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 21103deb3ec6SMatthias Ringwald 21115cf1669fSMatthias Ringwald gatt_client->callback = callback; 21125cf1669fSMatthias Ringwald gatt_client->attribute_handle = attribute_handle; 21135cf1669fSMatthias Ringwald gatt_client->attribute_length = length; 21145cf1669fSMatthias Ringwald gatt_client->attribute_offset = offset; 21155cf1669fSMatthias Ringwald gatt_client->attribute_value = data; 21165cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_PREPARE_WRITE_SINGLE; 21173deb3ec6SMatthias Ringwald gatt_client_run(); 211825b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 21193deb3ec6SMatthias Ringwald } 21203deb3ec6SMatthias Ringwald 21213deb3ec6SMatthias Ringwald /** 21223deb3ec6SMatthias Ringwald * @brief -> gatt complete event 21233deb3ec6SMatthias Ringwald */ 2124711e6c80SMatthias Ringwald uint8_t gatt_client_execute_write(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 21255cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 21263deb3ec6SMatthias Ringwald 21275cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 21285cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 21293deb3ec6SMatthias Ringwald 21305cf1669fSMatthias Ringwald gatt_client->callback = callback; 21315cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_EXECUTE_PREPARED_WRITE; 21323deb3ec6SMatthias Ringwald gatt_client_run(); 213325b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 21343deb3ec6SMatthias Ringwald } 21353deb3ec6SMatthias Ringwald 21363deb3ec6SMatthias Ringwald /** 21373deb3ec6SMatthias Ringwald * @brief -> gatt complete event 21383deb3ec6SMatthias Ringwald */ 2139711e6c80SMatthias Ringwald uint8_t gatt_client_cancel_write(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 21405cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 21415cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 21425cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 21433deb3ec6SMatthias Ringwald 21445cf1669fSMatthias Ringwald gatt_client->callback = callback; 21455cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_CANCEL_PREPARED_WRITE; 21463deb3ec6SMatthias Ringwald gatt_client_run(); 21477d2258b3SMilanka Ringwald return ERROR_CODE_SUCCESS; 21483deb3ec6SMatthias Ringwald } 21493deb3ec6SMatthias Ringwald 2150313e337bSMatthias Ringwald void gatt_client_deserialize_service(const uint8_t *packet, int offset, gatt_client_service_t *service){ 21516ba2ad22SMatthias Ringwald service->start_group_handle = little_endian_read_16(packet, offset); 21526ba2ad22SMatthias Ringwald service->end_group_handle = little_endian_read_16(packet, offset + 2); 21536ba2ad22SMatthias Ringwald reverse_128(&packet[offset + 4], service->uuid128); 21546ba2ad22SMatthias Ringwald if (uuid_has_bluetooth_prefix(service->uuid128)){ 21556ba2ad22SMatthias Ringwald service->uuid16 = big_endian_read_32(service->uuid128, 0); 2156c839c6f9SMatthias Ringwald } else { 2157c839c6f9SMatthias Ringwald service->uuid16 = 0; 21586ba2ad22SMatthias Ringwald } 21596ba2ad22SMatthias Ringwald } 21606ba2ad22SMatthias Ringwald 2161313e337bSMatthias Ringwald void gatt_client_deserialize_characteristic(const uint8_t * packet, int offset, gatt_client_characteristic_t * characteristic){ 21626ba2ad22SMatthias Ringwald characteristic->start_handle = little_endian_read_16(packet, offset); 21636ba2ad22SMatthias Ringwald characteristic->value_handle = little_endian_read_16(packet, offset + 2); 21646ba2ad22SMatthias Ringwald characteristic->end_handle = little_endian_read_16(packet, offset + 4); 21656ba2ad22SMatthias Ringwald characteristic->properties = little_endian_read_16(packet, offset + 6); 216686c38559SMatthias Ringwald reverse_128(&packet[offset+8], characteristic->uuid128); 21676ba2ad22SMatthias Ringwald if (uuid_has_bluetooth_prefix(characteristic->uuid128)){ 21686ba2ad22SMatthias Ringwald characteristic->uuid16 = big_endian_read_32(characteristic->uuid128, 0); 2169c839c6f9SMatthias Ringwald } else { 2170c839c6f9SMatthias Ringwald characteristic->uuid16 = 0; 21716ba2ad22SMatthias Ringwald } 21726ba2ad22SMatthias Ringwald } 21736ba2ad22SMatthias Ringwald 2174313e337bSMatthias Ringwald void gatt_client_deserialize_characteristic_descriptor(const uint8_t * packet, int offset, gatt_client_characteristic_descriptor_t * descriptor){ 21756ba2ad22SMatthias Ringwald descriptor->handle = little_endian_read_16(packet, offset); 21766ba2ad22SMatthias Ringwald reverse_128(&packet[offset+2], descriptor->uuid128); 2177b4895529SJakob Krantz if (uuid_has_bluetooth_prefix(descriptor->uuid128)){ 2178b4895529SJakob Krantz descriptor->uuid16 = big_endian_read_32(descriptor->uuid128, 0); 2179c839c6f9SMatthias Ringwald } else { 2180c839c6f9SMatthias Ringwald descriptor->uuid16 = 0; 2181b4895529SJakob Krantz } 21826ba2ad22SMatthias Ringwald } 21835cf6c434SJakob Krantz 21845cf6c434SJakob Krantz void gatt_client_send_mtu_negotiation(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 21855cf1669fSMatthias Ringwald gatt_client_t * context = gatt_client_provide_context_for_handle(con_handle); 21867d2258b3SMilanka Ringwald if (context == NULL) return; 21875cf6c434SJakob Krantz if (context->mtu_state == MTU_AUTO_EXCHANGE_DISABLED){ 21885cf6c434SJakob Krantz context->callback = callback; 21895cf6c434SJakob Krantz context->mtu_state = SEND_MTU_EXCHANGE; 21905cf6c434SJakob Krantz gatt_client_run(); 21915cf6c434SJakob Krantz } 21925cf6c434SJakob Krantz } 219347181045SMatthias Ringwald 219447181045SMatthias Ringwald uint8_t gatt_client_request_can_write_without_response_event(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 21955cf1669fSMatthias Ringwald gatt_client_t * context = gatt_client_provide_context_for_handle(con_handle); 21967d2258b3SMilanka Ringwald if (context == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 21977d2258b3SMilanka Ringwald if (context->write_without_response_callback != NULL) return GATT_CLIENT_IN_WRONG_STATE; 219847181045SMatthias Ringwald context->write_without_response_callback = callback; 219947181045SMatthias Ringwald att_dispatch_client_request_can_send_now_event(context->con_handle); 22007d2258b3SMilanka Ringwald return ERROR_CODE_SUCCESS; 220147181045SMatthias Ringwald } 2202a6121b51SMilanka Ringwald 2203a6121b51SMilanka Ringwald #ifdef FUZZING_BUILD_MODE_UNSAFE_FOR_PRODUCTION 2204a6121b51SMilanka Ringwald void gatt_client_att_packet_handler_fuzz(uint8_t packet_type, uint16_t handle, uint8_t *packet, uint16_t size){ 2205a6121b51SMilanka Ringwald gatt_client_att_packet_handler(packet_type, handle, packet, size); 2206a6121b51SMilanka Ringwald } 2207a6121b51SMilanka Ringwald #endif 2208