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 67793cf6ceSMatthias Ringwald #if defined(ENABLE_GATT_CLIENT_PAIRING) || defined (ENABLE_LE_SIGNED_WRITE) 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); 75*5cf1669fSMatthias Ringwald static void gatt_client_report_error_if_pending(gatt_client_t *gatt_client, uint8_t att_error_code); 767a766ebfSMatthias Ringwald 777a766ebfSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 783deb3ec6SMatthias Ringwald static void att_signed_write_handle_cmac_result(uint8_t hash[8]); 797a766ebfSMatthias Ringwald #endif 803deb3ec6SMatthias Ringwald 81*5cf1669fSMatthias Ringwald static uint16_t gatt_client_mtu(gatt_client_t *gatt_client){ 82*5cf1669fSMatthias Ringwald if (gatt_client->mtu > l2cap_max_le_mtu()){ 83*5cf1669fSMatthias Ringwald log_error("Remote MTU is not initialized"); 843deb3ec6SMatthias Ringwald return l2cap_max_le_mtu(); 853deb3ec6SMatthias Ringwald } 86*5cf1669fSMatthias Ringwald return gatt_client->mtu; 873deb3ec6SMatthias Ringwald } 883deb3ec6SMatthias Ringwald 893deb3ec6SMatthias Ringwald void gatt_client_init(void){ 903deb3ec6SMatthias Ringwald gatt_client_connections = NULL; 915cf6c434SJakob Krantz mtu_exchange_enabled = 1; 92f4b33574SMatthias Ringwald 93361b1363SMatthias Ringwald // regsister for HCI Events 94f4b33574SMatthias Ringwald hci_event_callback_registration.callback = &gatt_client_event_packet_handler; 95361b1363SMatthias Ringwald hci_add_event_handler(&hci_event_callback_registration); 96361b1363SMatthias Ringwald 97793cf6ceSMatthias Ringwald #if defined(ENABLE_GATT_CLIENT_PAIRING) || defined (ENABLE_LE_SIGNED_WRITE) 98f4b33574SMatthias Ringwald // register for SM Events 99f4b33574SMatthias Ringwald sm_event_callback_registration.callback = &gatt_client_event_packet_handler; 100f4b33574SMatthias Ringwald sm_add_event_handler(&sm_event_callback_registration); 101f4b33574SMatthias Ringwald #endif 102f4b33574SMatthias Ringwald 103361b1363SMatthias Ringwald // and ATT Client PDUs 1043deb3ec6SMatthias Ringwald att_dispatch_register_client(gatt_client_att_packet_handler); 1053deb3ec6SMatthias Ringwald } 1063deb3ec6SMatthias Ringwald 107ec820d77SMatthias Ringwald static gatt_client_t * gatt_client_for_timer(btstack_timer_source_t * ts){ 108665d90f2SMatthias Ringwald btstack_linked_list_iterator_t it; 109665d90f2SMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client_connections); 110665d90f2SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 111*5cf1669fSMatthias Ringwald gatt_client_t * gatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it); 112*5cf1669fSMatthias Ringwald if (&gatt_client->gc_timeout == ts) { 113*5cf1669fSMatthias Ringwald return gatt_client; 1143deb3ec6SMatthias Ringwald } 1153deb3ec6SMatthias Ringwald } 1163deb3ec6SMatthias Ringwald return NULL; 1173deb3ec6SMatthias Ringwald } 1183deb3ec6SMatthias Ringwald 119ec820d77SMatthias Ringwald static void gatt_client_timeout_handler(btstack_timer_source_t * timer){ 120*5cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_for_timer(timer); 121*5cf1669fSMatthias Ringwald if (gatt_client == NULL) return; 122*5cf1669fSMatthias Ringwald log_info("GATT client timeout handle, handle 0x%02x", gatt_client->con_handle); 123*5cf1669fSMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, ATT_ERROR_TIMEOUT); 1243deb3ec6SMatthias Ringwald } 1253deb3ec6SMatthias Ringwald 126*5cf1669fSMatthias Ringwald static void gatt_client_timeout_start(gatt_client_t * gatt_client){ 127*5cf1669fSMatthias Ringwald log_info("GATT client timeout start, handle 0x%02x", gatt_client->con_handle); 128*5cf1669fSMatthias Ringwald btstack_run_loop_remove_timer(&gatt_client->gc_timeout); 129*5cf1669fSMatthias Ringwald btstack_run_loop_set_timer_handler(&gatt_client->gc_timeout, gatt_client_timeout_handler); 130*5cf1669fSMatthias Ringwald btstack_run_loop_set_timer(&gatt_client->gc_timeout, 30000); // 30 seconds sm timeout 131*5cf1669fSMatthias Ringwald btstack_run_loop_add_timer(&gatt_client->gc_timeout); 1323deb3ec6SMatthias Ringwald } 1333deb3ec6SMatthias Ringwald 134*5cf1669fSMatthias Ringwald static void gatt_client_timeout_stop(gatt_client_t * gatt_client){ 135*5cf1669fSMatthias Ringwald log_info("GATT client timeout stop, handle 0x%02x", gatt_client->con_handle); 136*5cf1669fSMatthias Ringwald btstack_run_loop_remove_timer(&gatt_client->gc_timeout); 1373deb3ec6SMatthias Ringwald } 1383deb3ec6SMatthias Ringwald 139*5cf1669fSMatthias Ringwald static gatt_client_t * gatt_client_get_context_for_handle(uint16_t handle){ 140665d90f2SMatthias Ringwald btstack_linked_item_t *it; 141a0da043fSMatthias Ringwald for (it = (btstack_linked_item_t *) gatt_client_connections; it != NULL; it = it->next){ 142*5cf1669fSMatthias Ringwald gatt_client_t * gatt_client = (gatt_client_t *) it; 143*5cf1669fSMatthias Ringwald if (gatt_client->con_handle == handle){ 144*5cf1669fSMatthias Ringwald return gatt_client; 1453deb3ec6SMatthias Ringwald } 1463deb3ec6SMatthias Ringwald } 1473deb3ec6SMatthias Ringwald return NULL; 1483deb3ec6SMatthias Ringwald } 1493deb3ec6SMatthias Ringwald 1503deb3ec6SMatthias Ringwald 151*5cf1669fSMatthias Ringwald // @returns gatt_client context 1523deb3ec6SMatthias Ringwald // returns existing one, or tries to setup new one 153*5cf1669fSMatthias Ringwald static gatt_client_t * gatt_client_provide_context_for_handle(hci_con_handle_t con_handle){ 154*5cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_get_context_for_handle(con_handle); 155*5cf1669fSMatthias Ringwald if (gatt_client) return gatt_client; 1563deb3ec6SMatthias Ringwald 157ae1d1237SMatthias Ringwald // bail if no such hci connection 158ae1d1237SMatthias Ringwald if (!hci_connection_for_handle(con_handle)){ 159ae1d1237SMatthias Ringwald log_error("No connection for handle 0x%04x", con_handle); 160ae1d1237SMatthias Ringwald return NULL; 161ae1d1237SMatthias Ringwald } 162*5cf1669fSMatthias Ringwald gatt_client = btstack_memory_gatt_client_get(); 163*5cf1669fSMatthias Ringwald if (!gatt_client) return NULL; 1643deb3ec6SMatthias Ringwald // init state 165*5cf1669fSMatthias Ringwald gatt_client->con_handle = con_handle; 166*5cf1669fSMatthias Ringwald gatt_client->mtu = ATT_DEFAULT_MTU; 1675cf6c434SJakob Krantz if (mtu_exchange_enabled){ 168*5cf1669fSMatthias Ringwald gatt_client->mtu_state = SEND_MTU_EXCHANGE; 1695cf6c434SJakob Krantz } else { 170*5cf1669fSMatthias Ringwald gatt_client->mtu_state = MTU_AUTO_EXCHANGE_DISABLED; 1715cf6c434SJakob Krantz } 172*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_READY; 173*5cf1669fSMatthias Ringwald btstack_linked_list_add(&gatt_client_connections, (btstack_linked_item_t*)gatt_client); 174*5cf1669fSMatthias Ringwald return gatt_client; 1753deb3ec6SMatthias Ringwald } 1763deb3ec6SMatthias Ringwald 177*5cf1669fSMatthias Ringwald static gatt_client_t * gatt_client_provide_context_for_handle_and_start_timer(hci_con_handle_t con_handle){ 178*5cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle(con_handle); 179*5cf1669fSMatthias Ringwald if (gatt_client == NULL) return NULL; 180*5cf1669fSMatthias Ringwald gatt_client_timeout_start(gatt_client); 181*5cf1669fSMatthias Ringwald return gatt_client; 1823deb3ec6SMatthias Ringwald } 1833deb3ec6SMatthias Ringwald 184*5cf1669fSMatthias Ringwald static int is_ready(gatt_client_t * gatt_client){ 185*5cf1669fSMatthias Ringwald return gatt_client->gatt_client_state == P_READY; 1863deb3ec6SMatthias Ringwald } 1873deb3ec6SMatthias Ringwald 188fc64f94aSMatthias Ringwald int gatt_client_is_ready(hci_con_handle_t con_handle){ 189*5cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle(con_handle); 190*5cf1669fSMatthias Ringwald if (gatt_client == NULL) return 0; 191*5cf1669fSMatthias Ringwald return is_ready(gatt_client); 1923deb3ec6SMatthias Ringwald } 1933deb3ec6SMatthias Ringwald 1945cf6c434SJakob Krantz void gatt_client_mtu_enable_auto_negotiation(uint8_t enabled){ 1955cf6c434SJakob Krantz mtu_exchange_enabled = enabled; 1965cf6c434SJakob Krantz } 1975cf6c434SJakob Krantz 198fc64f94aSMatthias Ringwald uint8_t gatt_client_get_mtu(hci_con_handle_t con_handle, uint16_t * mtu){ 199*5cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle(con_handle); 200*5cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 2017d2258b3SMilanka Ringwald 202*5cf1669fSMatthias Ringwald if ((gatt_client->mtu_state == MTU_EXCHANGED) || (gatt_client->mtu_state == MTU_AUTO_EXCHANGE_DISABLED)){ 203*5cf1669fSMatthias Ringwald *mtu = gatt_client->mtu; 2047d2258b3SMilanka Ringwald return ERROR_CODE_SUCCESS; 2053deb3ec6SMatthias Ringwald } 2063deb3ec6SMatthias Ringwald *mtu = ATT_DEFAULT_MTU; 207616edd56SMatthias Ringwald return GATT_CLIENT_IN_WRONG_STATE; 2083deb3ec6SMatthias Ringwald } 2093deb3ec6SMatthias Ringwald 2103deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 211*5cf1669fSMatthias Ringwald static uint8_t att_confirmation(uint16_t con_handle){ 2123deb3ec6SMatthias Ringwald l2cap_reserve_packet_buffer(); 2133deb3ec6SMatthias Ringwald uint8_t * request = l2cap_get_outgoing_buffer(); 2143deb3ec6SMatthias Ringwald request[0] = ATT_HANDLE_VALUE_CONFIRMATION; 21525b7c058SMilanka Ringwald 216*5cf1669fSMatthias Ringwald return l2cap_send_prepared_connectionless(con_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL, 1); 2173deb3ec6SMatthias Ringwald } 2183deb3ec6SMatthias Ringwald 2193deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 220*5cf1669fSMatthias Ringwald static uint8_t att_find_information_request(uint16_t request_type, uint16_t con_handle, uint16_t start_handle, uint16_t end_handle){ 2213deb3ec6SMatthias Ringwald l2cap_reserve_packet_buffer(); 2223deb3ec6SMatthias Ringwald uint8_t * request = l2cap_get_outgoing_buffer(); 2233deb3ec6SMatthias Ringwald request[0] = request_type; 224f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, start_handle); 225f8fbdce0SMatthias Ringwald little_endian_store_16(request, 3, end_handle); 2263deb3ec6SMatthias Ringwald 227*5cf1669fSMatthias Ringwald return l2cap_send_prepared_connectionless(con_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL, 5); 2283deb3ec6SMatthias Ringwald } 2293deb3ec6SMatthias Ringwald 2303deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 231*5cf1669fSMatthias 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){ 2323deb3ec6SMatthias Ringwald l2cap_reserve_packet_buffer(); 2333deb3ec6SMatthias Ringwald uint8_t * request = l2cap_get_outgoing_buffer(); 2343deb3ec6SMatthias Ringwald 2353deb3ec6SMatthias Ringwald request[0] = request_type; 236f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, start_handle); 237f8fbdce0SMatthias Ringwald little_endian_store_16(request, 3, end_handle); 238f8fbdce0SMatthias Ringwald little_endian_store_16(request, 5, attribute_group_type); 2396535961aSMatthias Ringwald (void)memcpy(&request[7], value, value_size); 2403deb3ec6SMatthias Ringwald 241*5cf1669fSMatthias Ringwald return l2cap_send_prepared_connectionless(con_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL, 7u + value_size); 2423deb3ec6SMatthias Ringwald } 2433deb3ec6SMatthias Ringwald 2443deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 245*5cf1669fSMatthias 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){ 2463deb3ec6SMatthias Ringwald l2cap_reserve_packet_buffer(); 2473deb3ec6SMatthias Ringwald uint8_t * request = l2cap_get_outgoing_buffer(); 2483deb3ec6SMatthias Ringwald request[0] = request_type; 249f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, start_handle); 250f8fbdce0SMatthias Ringwald little_endian_store_16(request, 3, end_handle); 251f8fbdce0SMatthias Ringwald little_endian_store_16(request, 5, uuid16); 2523deb3ec6SMatthias Ringwald 253*5cf1669fSMatthias Ringwald return l2cap_send_prepared_connectionless(con_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL, 7); 2543deb3ec6SMatthias Ringwald } 2553deb3ec6SMatthias Ringwald 2563deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 257*5cf1669fSMatthias 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){ 2583deb3ec6SMatthias Ringwald l2cap_reserve_packet_buffer(); 2593deb3ec6SMatthias Ringwald uint8_t * request = l2cap_get_outgoing_buffer(); 2603deb3ec6SMatthias Ringwald request[0] = request_type; 261f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, start_handle); 262f8fbdce0SMatthias Ringwald little_endian_store_16(request, 3, end_handle); 2639c80e4ccSMatthias Ringwald reverse_128(uuid128, &request[5]); 2643deb3ec6SMatthias Ringwald 265*5cf1669fSMatthias Ringwald return l2cap_send_prepared_connectionless(con_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL, 21); 2663deb3ec6SMatthias Ringwald } 2673deb3ec6SMatthias Ringwald 2683deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 269*5cf1669fSMatthias Ringwald static uint8_t att_read_request(uint16_t request_type, uint16_t con_handle, uint16_t attribute_handle){ 2703deb3ec6SMatthias Ringwald l2cap_reserve_packet_buffer(); 2713deb3ec6SMatthias Ringwald uint8_t * request = l2cap_get_outgoing_buffer(); 2723deb3ec6SMatthias Ringwald request[0] = request_type; 273f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, attribute_handle); 2743deb3ec6SMatthias Ringwald 275*5cf1669fSMatthias Ringwald return l2cap_send_prepared_connectionless(con_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL, 3); 2763deb3ec6SMatthias Ringwald } 2773deb3ec6SMatthias Ringwald 2783deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 279*5cf1669fSMatthias Ringwald static uint8_t att_read_blob_request(uint16_t request_type, uint16_t con_handle, uint16_t attribute_handle, uint16_t value_offset){ 2803deb3ec6SMatthias Ringwald l2cap_reserve_packet_buffer(); 2813deb3ec6SMatthias Ringwald uint8_t * request = l2cap_get_outgoing_buffer(); 2823deb3ec6SMatthias Ringwald request[0] = request_type; 283f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, attribute_handle); 284f8fbdce0SMatthias Ringwald little_endian_store_16(request, 3, value_offset); 2853deb3ec6SMatthias Ringwald 286*5cf1669fSMatthias Ringwald return l2cap_send_prepared_connectionless(con_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL, 5); 2873deb3ec6SMatthias Ringwald } 2883deb3ec6SMatthias Ringwald 289*5cf1669fSMatthias Ringwald static uint8_t att_read_multiple_request(uint16_t con_handle, uint16_t num_value_handles, uint16_t * value_handles){ 2903deb3ec6SMatthias Ringwald l2cap_reserve_packet_buffer(); 2913deb3ec6SMatthias Ringwald uint8_t * request = l2cap_get_outgoing_buffer(); 2923deb3ec6SMatthias Ringwald request[0] = ATT_READ_MULTIPLE_REQUEST; 2933deb3ec6SMatthias Ringwald int i; 2943deb3ec6SMatthias Ringwald int offset = 1; 2953deb3ec6SMatthias Ringwald for (i=0;i<num_value_handles;i++){ 296f8fbdce0SMatthias Ringwald little_endian_store_16(request, offset, value_handles[i]); 2973deb3ec6SMatthias Ringwald offset += 2; 2983deb3ec6SMatthias Ringwald } 29925b7c058SMilanka Ringwald 300*5cf1669fSMatthias Ringwald return l2cap_send_prepared_connectionless(con_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL, offset); 3013deb3ec6SMatthias Ringwald } 3023deb3ec6SMatthias Ringwald 3037a766ebfSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 3043deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 305*5cf1669fSMatthias 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]){ 3063deb3ec6SMatthias Ringwald l2cap_reserve_packet_buffer(); 3073deb3ec6SMatthias Ringwald uint8_t * request = l2cap_get_outgoing_buffer(); 3083deb3ec6SMatthias Ringwald request[0] = request_type; 309f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, attribute_handle); 3106535961aSMatthias Ringwald (void)memcpy(&request[3], value, value_length); 311f8fbdce0SMatthias Ringwald little_endian_store_32(request, 3 + value_length, sign_counter); 3129c80e4ccSMatthias Ringwald reverse_64(sgn, &request[3 + value_length + 4]); 31325b7c058SMilanka Ringwald 314*5cf1669fSMatthias Ringwald return l2cap_send_prepared_connectionless(con_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL, 3 + value_length + 12); 3153deb3ec6SMatthias Ringwald } 3167a766ebfSMatthias Ringwald #endif 3173deb3ec6SMatthias Ringwald 3183deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 319*5cf1669fSMatthias 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){ 3203deb3ec6SMatthias Ringwald l2cap_reserve_packet_buffer(); 3213deb3ec6SMatthias Ringwald uint8_t * request = l2cap_get_outgoing_buffer(); 3223deb3ec6SMatthias Ringwald request[0] = request_type; 323f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, attribute_handle); 3246535961aSMatthias Ringwald (void)memcpy(&request[3], value, value_length); 3253deb3ec6SMatthias Ringwald 326*5cf1669fSMatthias Ringwald return l2cap_send_prepared_connectionless(con_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL, 3u + value_length); 3273deb3ec6SMatthias Ringwald } 3283deb3ec6SMatthias Ringwald 3293deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 330*5cf1669fSMatthias Ringwald static uint8_t att_execute_write_request(uint16_t request_type, uint16_t con_handle, uint8_t execute_write){ 3313deb3ec6SMatthias Ringwald l2cap_reserve_packet_buffer(); 3323deb3ec6SMatthias Ringwald uint8_t * request = l2cap_get_outgoing_buffer(); 3333deb3ec6SMatthias Ringwald request[0] = request_type; 3343deb3ec6SMatthias Ringwald request[1] = execute_write; 33525b7c058SMilanka Ringwald 336*5cf1669fSMatthias Ringwald return l2cap_send_prepared_connectionless(con_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL, 2); 3373deb3ec6SMatthias Ringwald } 3383deb3ec6SMatthias Ringwald 3393deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 340*5cf1669fSMatthias 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){ 3413deb3ec6SMatthias Ringwald l2cap_reserve_packet_buffer(); 3423deb3ec6SMatthias Ringwald uint8_t * request = l2cap_get_outgoing_buffer(); 3433deb3ec6SMatthias Ringwald request[0] = request_type; 344f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, attribute_handle); 345f8fbdce0SMatthias Ringwald little_endian_store_16(request, 3, value_offset); 3466535961aSMatthias Ringwald (void)memcpy(&request[5], &value[value_offset], blob_length); 3473deb3ec6SMatthias Ringwald 348*5cf1669fSMatthias Ringwald return l2cap_send_prepared_connectionless(con_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL, 5u + blob_length); 3493deb3ec6SMatthias Ringwald } 3503deb3ec6SMatthias Ringwald 351*5cf1669fSMatthias Ringwald static uint8_t att_exchange_mtu_request(uint16_t con_handle){ 3523deb3ec6SMatthias Ringwald uint16_t mtu = l2cap_max_le_mtu(); 3533deb3ec6SMatthias Ringwald l2cap_reserve_packet_buffer(); 3543deb3ec6SMatthias Ringwald uint8_t * request = l2cap_get_outgoing_buffer(); 3553deb3ec6SMatthias Ringwald request[0] = ATT_EXCHANGE_MTU_REQUEST; 356f8fbdce0SMatthias Ringwald little_endian_store_16(request, 1, mtu); 35725b7c058SMilanka Ringwald 358*5cf1669fSMatthias Ringwald return l2cap_send_prepared_connectionless(con_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL, 3); 3593deb3ec6SMatthias Ringwald } 3603deb3ec6SMatthias Ringwald 361*5cf1669fSMatthias Ringwald static uint16_t write_blob_length(gatt_client_t * gatt_client){ 362*5cf1669fSMatthias Ringwald uint16_t max_blob_length = gatt_client_mtu(gatt_client) - 5u; 363*5cf1669fSMatthias Ringwald if (gatt_client->attribute_offset >= gatt_client->attribute_length) { 3643deb3ec6SMatthias Ringwald return 0; 3653deb3ec6SMatthias Ringwald } 366*5cf1669fSMatthias Ringwald uint16_t rest_length = gatt_client->attribute_length - gatt_client->attribute_offset; 3673deb3ec6SMatthias Ringwald if (max_blob_length > rest_length){ 3683deb3ec6SMatthias Ringwald return rest_length; 3693deb3ec6SMatthias Ringwald } 3703deb3ec6SMatthias Ringwald return max_blob_length; 3713deb3ec6SMatthias Ringwald } 3723deb3ec6SMatthias Ringwald 373*5cf1669fSMatthias Ringwald static void send_gatt_services_request(gatt_client_t *gatt_client){ 374*5cf1669fSMatthias 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); 3753deb3ec6SMatthias Ringwald } 3763deb3ec6SMatthias Ringwald 377*5cf1669fSMatthias Ringwald static void send_gatt_by_uuid_request(gatt_client_t *gatt_client, uint16_t attribute_group_type){ 378*5cf1669fSMatthias Ringwald if (gatt_client->uuid16){ 3793deb3ec6SMatthias Ringwald uint8_t uuid16[2]; 380*5cf1669fSMatthias Ringwald little_endian_store_16(uuid16, 0, gatt_client->uuid16); 381*5cf1669fSMatthias 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); 3823deb3ec6SMatthias Ringwald return; 3833deb3ec6SMatthias Ringwald } 3843deb3ec6SMatthias Ringwald uint8_t uuid128[16]; 385*5cf1669fSMatthias Ringwald reverse_128(gatt_client->uuid128, uuid128); 386*5cf1669fSMatthias 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); 3873deb3ec6SMatthias Ringwald } 3883deb3ec6SMatthias Ringwald 389*5cf1669fSMatthias Ringwald static void send_gatt_services_by_uuid_request(gatt_client_t *gatt_client){ 390*5cf1669fSMatthias Ringwald send_gatt_by_uuid_request(gatt_client, GATT_PRIMARY_SERVICE_UUID); 3913deb3ec6SMatthias Ringwald } 3923deb3ec6SMatthias Ringwald 393*5cf1669fSMatthias Ringwald static void send_gatt_included_service_uuid_request(gatt_client_t *gatt_client){ 394*5cf1669fSMatthias Ringwald att_read_request(ATT_READ_REQUEST, gatt_client->con_handle, gatt_client->query_start_handle); 3953deb3ec6SMatthias Ringwald } 3963deb3ec6SMatthias Ringwald 397*5cf1669fSMatthias Ringwald static void send_gatt_included_service_request(gatt_client_t *gatt_client){ 398*5cf1669fSMatthias 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); 3993deb3ec6SMatthias Ringwald } 4003deb3ec6SMatthias Ringwald 401*5cf1669fSMatthias Ringwald static void send_gatt_characteristic_request(gatt_client_t *gatt_client){ 402*5cf1669fSMatthias 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); 4033deb3ec6SMatthias Ringwald } 4043deb3ec6SMatthias Ringwald 405*5cf1669fSMatthias Ringwald static void send_gatt_characteristic_descriptor_request(gatt_client_t *gatt_client){ 406*5cf1669fSMatthias Ringwald att_find_information_request(ATT_FIND_INFORMATION_REQUEST, gatt_client->con_handle, gatt_client->start_group_handle, gatt_client->end_group_handle); 4073deb3ec6SMatthias Ringwald } 4083deb3ec6SMatthias Ringwald 409*5cf1669fSMatthias Ringwald static void send_gatt_read_characteristic_value_request(gatt_client_t *gatt_client){ 410*5cf1669fSMatthias Ringwald att_read_request(ATT_READ_REQUEST, gatt_client->con_handle, gatt_client->attribute_handle); 4113deb3ec6SMatthias Ringwald } 4123deb3ec6SMatthias Ringwald 413*5cf1669fSMatthias Ringwald static void send_gatt_read_by_type_request(gatt_client_t * gatt_client){ 414*5cf1669fSMatthias Ringwald if (gatt_client->uuid16){ 415*5cf1669fSMatthias 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); 4163deb3ec6SMatthias Ringwald } else { 417*5cf1669fSMatthias 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); 4183deb3ec6SMatthias Ringwald } 4193deb3ec6SMatthias Ringwald } 4203deb3ec6SMatthias Ringwald 421*5cf1669fSMatthias Ringwald static void send_gatt_read_blob_request(gatt_client_t *gatt_client){ 422*5cf1669fSMatthias Ringwald att_read_blob_request(ATT_READ_BLOB_REQUEST, gatt_client->con_handle, gatt_client->attribute_handle, gatt_client->attribute_offset); 4233deb3ec6SMatthias Ringwald } 4243deb3ec6SMatthias Ringwald 425*5cf1669fSMatthias Ringwald static void send_gatt_read_multiple_request(gatt_client_t * gatt_client){ 426*5cf1669fSMatthias Ringwald att_read_multiple_request(gatt_client->con_handle, gatt_client->read_multiple_handle_count, gatt_client->read_multiple_handles); 4273deb3ec6SMatthias Ringwald } 4283deb3ec6SMatthias Ringwald 429*5cf1669fSMatthias Ringwald static void send_gatt_write_attribute_value_request(gatt_client_t * gatt_client){ 430*5cf1669fSMatthias Ringwald att_write_request(ATT_WRITE_REQUEST, gatt_client->con_handle, gatt_client->attribute_handle, gatt_client->attribute_length, gatt_client->attribute_value); 4313deb3ec6SMatthias Ringwald } 4323deb3ec6SMatthias Ringwald 433*5cf1669fSMatthias Ringwald static void send_gatt_write_client_characteristic_configuration_request(gatt_client_t * gatt_client){ 434*5cf1669fSMatthias Ringwald att_write_request(ATT_WRITE_REQUEST, gatt_client->con_handle, gatt_client->client_characteristic_configuration_handle, 2, gatt_client->client_characteristic_configuration_value); 4353deb3ec6SMatthias Ringwald } 4363deb3ec6SMatthias Ringwald 437*5cf1669fSMatthias Ringwald static void send_gatt_prepare_write_request(gatt_client_t * gatt_client){ 438*5cf1669fSMatthias 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); 4393deb3ec6SMatthias Ringwald } 4403deb3ec6SMatthias Ringwald 441*5cf1669fSMatthias Ringwald static void send_gatt_execute_write_request(gatt_client_t * gatt_client){ 442*5cf1669fSMatthias Ringwald att_execute_write_request(ATT_EXECUTE_WRITE_REQUEST, gatt_client->con_handle, 1); 4433deb3ec6SMatthias Ringwald } 4443deb3ec6SMatthias Ringwald 445*5cf1669fSMatthias Ringwald static void send_gatt_cancel_prepared_write_request(gatt_client_t * gatt_client){ 446*5cf1669fSMatthias Ringwald att_execute_write_request(ATT_EXECUTE_WRITE_REQUEST, gatt_client->con_handle, 0); 4473deb3ec6SMatthias Ringwald } 4483deb3ec6SMatthias Ringwald 449abdc9fb5SMatthias Ringwald #ifndef ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY 450*5cf1669fSMatthias Ringwald static void send_gatt_read_client_characteristic_configuration_request(gatt_client_t * gatt_client){ 451*5cf1669fSMatthias 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); 4523deb3ec6SMatthias Ringwald } 453abdc9fb5SMatthias Ringwald #endif 4543deb3ec6SMatthias Ringwald 455*5cf1669fSMatthias Ringwald static void send_gatt_read_characteristic_descriptor_request(gatt_client_t * gatt_client){ 456*5cf1669fSMatthias Ringwald att_read_request(ATT_READ_REQUEST, gatt_client->con_handle, gatt_client->attribute_handle); 4573deb3ec6SMatthias Ringwald } 4583deb3ec6SMatthias Ringwald 4597a766ebfSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 460*5cf1669fSMatthias Ringwald static void send_gatt_signed_write_request(gatt_client_t * gatt_client, uint32_t sign_counter){ 461*5cf1669fSMatthias 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); 4623deb3ec6SMatthias Ringwald } 4637a766ebfSMatthias Ringwald #endif 4643deb3ec6SMatthias Ringwald 4653deb3ec6SMatthias Ringwald static uint16_t get_last_result_handle_from_service_list(uint8_t * packet, uint16_t size){ 4663deb3ec6SMatthias Ringwald uint8_t attr_length = packet[1]; 4674ea43905SMatthias Ringwald return little_endian_read_16(packet, size - attr_length + 2u); 4683deb3ec6SMatthias Ringwald } 4693deb3ec6SMatthias Ringwald 4703deb3ec6SMatthias Ringwald static uint16_t get_last_result_handle_from_characteristics_list(uint8_t * packet, uint16_t size){ 4713deb3ec6SMatthias Ringwald uint8_t attr_length = packet[1]; 4724ea43905SMatthias Ringwald return little_endian_read_16(packet, size - attr_length + 3u); 4733deb3ec6SMatthias Ringwald } 4743deb3ec6SMatthias Ringwald 4753deb3ec6SMatthias Ringwald static uint16_t get_last_result_handle_from_included_services_list(uint8_t * packet, uint16_t size){ 4763deb3ec6SMatthias Ringwald uint8_t attr_length = packet[1]; 477f8fbdce0SMatthias Ringwald return little_endian_read_16(packet, size - attr_length); 4783deb3ec6SMatthias Ringwald } 4793deb3ec6SMatthias Ringwald 480*5cf1669fSMatthias Ringwald static void gatt_client_handle_transaction_complete(gatt_client_t * gatt_client){ 481*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_READY; 482*5cf1669fSMatthias Ringwald gatt_client_timeout_stop(gatt_client); 4833deb3ec6SMatthias Ringwald } 4843deb3ec6SMatthias Ringwald 4859c662c9bSMatthias Ringwald static void emit_event_new(btstack_packet_handler_t callback, uint8_t * packet, uint16_t size){ 4869c662c9bSMatthias Ringwald if (!callback) return; 487b6e003bcSMatthias Ringwald hci_dump_packet(HCI_EVENT_PACKET, 0, packet, size); 4889c662c9bSMatthias Ringwald (*callback)(HCI_EVENT_PACKET, 0, packet, size); 4893deb3ec6SMatthias Ringwald } 4903deb3ec6SMatthias Ringwald 49186c38559SMatthias 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){ 49286c38559SMatthias Ringwald notification->callback = packet_handler; 4939c662c9bSMatthias Ringwald notification->con_handle = con_handle; 494b3f03c84SMatthias Ringwald if (characteristic == NULL){ 495b3f03c84SMatthias Ringwald notification->attribute_handle = GATT_CLIENT_ANY_VALUE_HANDLE; 496b3f03c84SMatthias Ringwald } else { 4979c662c9bSMatthias Ringwald notification->attribute_handle = characteristic->value_handle; 498b3f03c84SMatthias Ringwald } 4999c662c9bSMatthias Ringwald btstack_linked_list_add(&gatt_client_value_listeners, (btstack_linked_item_t*) notification); 5009c662c9bSMatthias Ringwald } 5019c662c9bSMatthias Ringwald 5021f734b5fSMatthias Ringwald void gatt_client_stop_listening_for_characteristic_value_updates(gatt_client_notification_t * notification){ 5031f734b5fSMatthias Ringwald btstack_linked_list_remove(&gatt_client_value_listeners, (btstack_linked_item_t*) notification); 5041f734b5fSMatthias Ringwald } 5051f734b5fSMatthias Ringwald 506711e6c80SMatthias Ringwald static void emit_event_to_registered_listeners(hci_con_handle_t con_handle, uint16_t attribute_handle, uint8_t * packet, uint16_t size){ 507665d90f2SMatthias Ringwald btstack_linked_list_iterator_t it; 5089c662c9bSMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client_value_listeners); 509665d90f2SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 51086c38559SMatthias Ringwald gatt_client_notification_t * notification = (gatt_client_notification_t*) btstack_linked_list_iterator_next(&it); 511b3f03c84SMatthias Ringwald if ((notification->con_handle != GATT_CLIENT_ANY_CONNECTION) && (notification->con_handle != con_handle)) continue; 512b3f03c84SMatthias Ringwald if ((notification->attribute_handle != GATT_CLIENT_ANY_VALUE_HANDLE) && (notification->attribute_handle != attribute_handle)) continue; 51386c38559SMatthias Ringwald (*notification->callback)(HCI_EVENT_PACKET, 0, packet, size); 5143deb3ec6SMatthias Ringwald } 5153deb3ec6SMatthias Ringwald } 5163deb3ec6SMatthias Ringwald 517*5cf1669fSMatthias Ringwald static void emit_gatt_complete_event(gatt_client_t * gatt_client, uint8_t att_status){ 5183deb3ec6SMatthias Ringwald // @format H1 5193deb3ec6SMatthias Ringwald uint8_t packet[5]; 5205611a760SMatthias Ringwald packet[0] = GATT_EVENT_QUERY_COMPLETE; 5213deb3ec6SMatthias Ringwald packet[1] = 3; 522*5cf1669fSMatthias Ringwald little_endian_store_16(packet, 2, gatt_client->con_handle); 5237d2258b3SMilanka Ringwald packet[4] = att_status; 524*5cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, sizeof(packet)); 5253deb3ec6SMatthias Ringwald } 5263deb3ec6SMatthias Ringwald 527*5cf1669fSMatthias 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){ 5283deb3ec6SMatthias Ringwald // @format HX 5293deb3ec6SMatthias Ringwald uint8_t packet[24]; 5305611a760SMatthias Ringwald packet[0] = GATT_EVENT_SERVICE_QUERY_RESULT; 5314ea43905SMatthias Ringwald packet[1] = sizeof(packet) - 2u; 532*5cf1669fSMatthias Ringwald little_endian_store_16(packet, 2, gatt_client->con_handle); 5333deb3ec6SMatthias Ringwald /// 534f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 4, start_group_handle); 535f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 6, end_group_handle); 5369c80e4ccSMatthias Ringwald reverse_128(uuid128, &packet[8]); 537*5cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, sizeof(packet)); 5383deb3ec6SMatthias Ringwald } 5393deb3ec6SMatthias Ringwald 540*5cf1669fSMatthias 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){ 5413deb3ec6SMatthias Ringwald // @format HX 5423deb3ec6SMatthias Ringwald uint8_t packet[26]; 5435611a760SMatthias Ringwald packet[0] = GATT_EVENT_INCLUDED_SERVICE_QUERY_RESULT; 5444ea43905SMatthias Ringwald packet[1] = sizeof(packet) - 2u; 545*5cf1669fSMatthias Ringwald little_endian_store_16(packet, 2, gatt_client->con_handle); 5463deb3ec6SMatthias Ringwald /// 547f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 4, include_handle); 5483deb3ec6SMatthias Ringwald // 549f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 6, start_group_handle); 550f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 8, end_group_handle); 5519c80e4ccSMatthias Ringwald reverse_128(uuid128, &packet[10]); 552*5cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, sizeof(packet)); 5533deb3ec6SMatthias Ringwald } 5543deb3ec6SMatthias Ringwald 555*5cf1669fSMatthias 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, 5563deb3ec6SMatthias Ringwald uint16_t properties, uint8_t * uuid128){ 5573deb3ec6SMatthias Ringwald // @format HY 5583deb3ec6SMatthias Ringwald uint8_t packet[28]; 5595611a760SMatthias Ringwald packet[0] = GATT_EVENT_CHARACTERISTIC_QUERY_RESULT; 5604ea43905SMatthias Ringwald packet[1] = sizeof(packet) - 2u; 561*5cf1669fSMatthias Ringwald little_endian_store_16(packet, 2, gatt_client->con_handle); 5623deb3ec6SMatthias Ringwald /// 563f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 4, start_handle); 564f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 6, value_handle); 565f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 8, end_handle); 566f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 10, properties); 5679c80e4ccSMatthias Ringwald reverse_128(uuid128, &packet[12]); 568*5cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, sizeof(packet)); 5693deb3ec6SMatthias Ringwald } 5703deb3ec6SMatthias Ringwald 5713deb3ec6SMatthias Ringwald static void emit_gatt_all_characteristic_descriptors_result_event( 572*5cf1669fSMatthias Ringwald gatt_client_t * gatt_client, uint16_t descriptor_handle, uint8_t * uuid128){ 5733deb3ec6SMatthias Ringwald // @format HZ 5743deb3ec6SMatthias Ringwald uint8_t packet[22]; 5755611a760SMatthias Ringwald packet[0] = GATT_EVENT_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY_RESULT; 5764ea43905SMatthias Ringwald packet[1] = sizeof(packet) - 2u; 577*5cf1669fSMatthias Ringwald little_endian_store_16(packet, 2, gatt_client->con_handle); 5783deb3ec6SMatthias Ringwald /// 579f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 4, descriptor_handle); 5809c80e4ccSMatthias Ringwald reverse_128(uuid128, &packet[6]); 581*5cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, sizeof(packet)); 5823deb3ec6SMatthias Ringwald } 5833deb3ec6SMatthias Ringwald 584*5cf1669fSMatthias Ringwald static void emit_gatt_mtu_exchanged_result_event(gatt_client_t * gatt_client, uint16_t new_mtu){ 5858f37572aSJakob Krantz // @format H2 5868f37572aSJakob Krantz uint8_t packet[6]; 5878f37572aSJakob Krantz packet[0] = GATT_EVENT_MTU; 5884ea43905SMatthias Ringwald packet[1] = sizeof(packet) - 2u; 589*5cf1669fSMatthias Ringwald little_endian_store_16(packet, 2, gatt_client->con_handle); 5908f37572aSJakob Krantz little_endian_store_16(packet, 4, new_mtu); 591*5cf1669fSMatthias Ringwald att_dispatch_client_mtu_exchanged(gatt_client->con_handle, new_mtu); 592*5cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, sizeof(packet)); 5938f37572aSJakob Krantz } 5948f37572aSJakob Krantz /// 595*5cf1669fSMatthias Ringwald static void report_gatt_services(gatt_client_t * gatt_client, uint8_t * packet, uint16_t size){ 5963deb3ec6SMatthias Ringwald uint8_t attr_length = packet[1]; 5974ea43905SMatthias Ringwald uint8_t uuid_length = attr_length - 4u; 5983deb3ec6SMatthias Ringwald 5993deb3ec6SMatthias Ringwald int i; 6003deb3ec6SMatthias Ringwald for (i = 2; i < size; i += attr_length){ 601f8fbdce0SMatthias Ringwald uint16_t start_group_handle = little_endian_read_16(packet,i); 602f8fbdce0SMatthias Ringwald uint16_t end_group_handle = little_endian_read_16(packet,i+2); 6033deb3ec6SMatthias Ringwald uint8_t uuid128[16]; 6043deb3ec6SMatthias Ringwald uint16_t uuid16 = 0; 6053deb3ec6SMatthias Ringwald 6064ea43905SMatthias Ringwald if (uuid_length == 2u){ 607f8fbdce0SMatthias Ringwald uuid16 = little_endian_read_16(packet, i+4); 608e1a125dfSMatthias Ringwald uuid_add_bluetooth_prefix((uint8_t*) &uuid128, uuid16); 6093deb3ec6SMatthias Ringwald } else { 6109c80e4ccSMatthias Ringwald reverse_128(&packet[i+4], uuid128); 6113deb3ec6SMatthias Ringwald } 612*5cf1669fSMatthias Ringwald emit_gatt_service_query_result_event(gatt_client, start_group_handle, end_group_handle, uuid128); 6133deb3ec6SMatthias Ringwald } 6143deb3ec6SMatthias Ringwald } 6153deb3ec6SMatthias Ringwald 6163deb3ec6SMatthias Ringwald // helper 617*5cf1669fSMatthias 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){ 6183deb3ec6SMatthias Ringwald uint8_t uuid128[16]; 6193deb3ec6SMatthias Ringwald uint16_t uuid16 = 0; 6204ea43905SMatthias Ringwald if (uuid_length == 2u){ 621f8fbdce0SMatthias Ringwald uuid16 = little_endian_read_16(uuid, 0); 622e1a125dfSMatthias Ringwald uuid_add_bluetooth_prefix((uint8_t*) uuid128, uuid16); 6234ea43905SMatthias Ringwald } else if (uuid_length == 16u){ 6249c80e4ccSMatthias Ringwald reverse_128(uuid, uuid128); 625d73c9dbeSMilanka Ringwald } else { 626d73c9dbeSMilanka Ringwald return; 6273deb3ec6SMatthias Ringwald } 6283deb3ec6SMatthias Ringwald 629*5cf1669fSMatthias Ringwald if (gatt_client->filter_with_uuid && (memcmp(gatt_client->uuid128, uuid128, 16) != 0)) return; 6303deb3ec6SMatthias Ringwald 631*5cf1669fSMatthias Ringwald gatt_client->characteristic_properties = properties; 632*5cf1669fSMatthias Ringwald gatt_client->characteristic_start_handle = start_handle; 633*5cf1669fSMatthias Ringwald gatt_client->attribute_handle = value_handle; 6343deb3ec6SMatthias Ringwald 635*5cf1669fSMatthias Ringwald if (gatt_client->filter_with_uuid) return; 6363deb3ec6SMatthias Ringwald 637*5cf1669fSMatthias Ringwald gatt_client->uuid16 = uuid16; 638*5cf1669fSMatthias Ringwald (void)memcpy(gatt_client->uuid128, uuid128, 16); 6393deb3ec6SMatthias Ringwald } 6403deb3ec6SMatthias Ringwald 641*5cf1669fSMatthias Ringwald static void characteristic_end_found(gatt_client_t * gatt_client, uint16_t end_handle){ 6423deb3ec6SMatthias Ringwald // TODO: stop searching if filter and uuid found 6433deb3ec6SMatthias Ringwald 644*5cf1669fSMatthias Ringwald if (!gatt_client->characteristic_start_handle) return; 6453deb3ec6SMatthias Ringwald 646*5cf1669fSMatthias Ringwald emit_gatt_characteristic_query_result_event(gatt_client, gatt_client->characteristic_start_handle, gatt_client->attribute_handle, 647*5cf1669fSMatthias Ringwald end_handle, gatt_client->characteristic_properties, gatt_client->uuid128); 6483deb3ec6SMatthias Ringwald 649*5cf1669fSMatthias Ringwald gatt_client->characteristic_start_handle = 0; 6503deb3ec6SMatthias Ringwald } 6513deb3ec6SMatthias Ringwald 652*5cf1669fSMatthias Ringwald static void report_gatt_characteristics(gatt_client_t * gatt_client, uint8_t * packet, uint16_t size){ 6534ea43905SMatthias Ringwald if (size < 2u) return; 6543deb3ec6SMatthias Ringwald uint8_t attr_length = packet[1]; 6554ea43905SMatthias Ringwald if ((attr_length != 7u) && (attr_length != 21u)) return; 6564ea43905SMatthias Ringwald uint8_t uuid_length = attr_length - 5u; 6573deb3ec6SMatthias Ringwald int i; 6584ea43905SMatthias Ringwald for (i = 2u; (i + attr_length) <= size; i += attr_length){ 659f8fbdce0SMatthias Ringwald uint16_t start_handle = little_endian_read_16(packet, i); 6603deb3ec6SMatthias Ringwald uint8_t properties = packet[i+2]; 661f8fbdce0SMatthias Ringwald uint16_t value_handle = little_endian_read_16(packet, i+3); 662*5cf1669fSMatthias Ringwald characteristic_end_found(gatt_client, start_handle - 1u); 663*5cf1669fSMatthias Ringwald characteristic_start_found(gatt_client, start_handle, properties, value_handle, &packet[i + 5], uuid_length); 6643deb3ec6SMatthias Ringwald } 6653deb3ec6SMatthias Ringwald } 6663deb3ec6SMatthias Ringwald 667*5cf1669fSMatthias Ringwald static void report_gatt_included_service_uuid16(gatt_client_t * gatt_client, uint16_t include_handle, uint16_t uuid16){ 6683deb3ec6SMatthias Ringwald uint8_t normalized_uuid128[16]; 669e1a125dfSMatthias Ringwald uuid_add_bluetooth_prefix(normalized_uuid128, uuid16); 670*5cf1669fSMatthias Ringwald emit_gatt_included_service_query_result_event(gatt_client, include_handle, gatt_client->query_start_handle, 671*5cf1669fSMatthias Ringwald gatt_client->query_end_handle, normalized_uuid128); 6723deb3ec6SMatthias Ringwald } 6733deb3ec6SMatthias Ringwald 674*5cf1669fSMatthias Ringwald static void report_gatt_included_service_uuid128(gatt_client_t * gatt_client, uint16_t include_handle, uint8_t *uuid128){ 675*5cf1669fSMatthias Ringwald emit_gatt_included_service_query_result_event(gatt_client, include_handle, gatt_client->query_start_handle, 676*5cf1669fSMatthias Ringwald gatt_client->query_end_handle, uuid128); 6773deb3ec6SMatthias Ringwald } 6783deb3ec6SMatthias Ringwald 6793deb3ec6SMatthias Ringwald // @returns packet pointer 6803deb3ec6SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite HCI + L2CAP packet headers 6813deb3ec6SMatthias Ringwald static const int characteristic_value_event_header_size = 8; 682711e6c80SMatthias 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){ 683a6121b51SMilanka Ringwald #ifdef FUZZING_BUILD_MODE_UNSAFE_FOR_PRODUCTION 684a6121b51SMilanka Ringwald // avoid using pre ATT headers. 685a6121b51SMilanka Ringwald return NULL; 686a6121b51SMilanka Ringwald #endif 6873deb3ec6SMatthias Ringwald // before the value inside the ATT PDU 6883deb3ec6SMatthias Ringwald uint8_t * packet = value - characteristic_value_event_header_size; 6893deb3ec6SMatthias Ringwald packet[0] = type; 6903deb3ec6SMatthias Ringwald packet[1] = characteristic_value_event_header_size - 2 + length; 691f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 2, con_handle); 692f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 4, attribute_handle); 693f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 6, length); 6943deb3ec6SMatthias Ringwald return packet; 6953deb3ec6SMatthias Ringwald } 6963deb3ec6SMatthias Ringwald 6973deb3ec6SMatthias Ringwald // @returns packet pointer 6983deb3ec6SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite parts of the HCI/L2CAP/ATT packet (4/4/3) bytes 6993deb3ec6SMatthias Ringwald static const int long_characteristic_value_event_header_size = 10; 700711e6c80SMatthias 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){ 701a6121b51SMilanka Ringwald #ifdef FUZZING_BUILD_MODE_UNSAFE_FOR_PRODUCTION 702a6121b51SMilanka Ringwald // avoid using pre ATT headers. 703a6121b51SMilanka Ringwald return NULL; 704a6121b51SMilanka Ringwald #endif 7053deb3ec6SMatthias Ringwald #if defined(HCI_INCOMING_PRE_BUFFER_SIZE) && (HCI_INCOMING_PRE_BUFFER_SIZE >= 10 - 8) // L2CAP Header (4) - ACL Header (4) 7063deb3ec6SMatthias Ringwald // before the value inside the ATT PDU 7073deb3ec6SMatthias Ringwald uint8_t * packet = value - long_characteristic_value_event_header_size; 7083deb3ec6SMatthias Ringwald packet[0] = type; 7093deb3ec6SMatthias Ringwald packet[1] = long_characteristic_value_event_header_size - 2 + length; 710f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 2, con_handle); 711f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 4, attribute_handle); 712f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 6, offset); 713f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 8, length); 7143deb3ec6SMatthias Ringwald return packet; 7153deb3ec6SMatthias Ringwald #else 7163deb3ec6SMatthias Ringwald log_error("HCI_INCOMING_PRE_BUFFER_SIZE >= 2 required for long characteristic reads"); 7173deb3ec6SMatthias Ringwald return NULL; 7183deb3ec6SMatthias Ringwald #endif 7193deb3ec6SMatthias Ringwald } 7203deb3ec6SMatthias Ringwald 7213deb3ec6SMatthias Ringwald 7223deb3ec6SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite parts of the HCI/L2CAP/ATT packet (4/4/3) bytes 723711e6c80SMatthias Ringwald static void report_gatt_notification(hci_con_handle_t con_handle, uint16_t value_handle, uint8_t * value, int length){ 7245611a760SMatthias Ringwald uint8_t * packet = setup_characteristic_value_packet(GATT_EVENT_NOTIFICATION, con_handle, value_handle, value, length); 7259c662c9bSMatthias Ringwald emit_event_to_registered_listeners(con_handle, value_handle, packet, characteristic_value_event_header_size + length); 7263deb3ec6SMatthias Ringwald } 7273deb3ec6SMatthias Ringwald 7283deb3ec6SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite parts of the HCI/L2CAP/ATT packet (4/4/3) bytes 729711e6c80SMatthias Ringwald static void report_gatt_indication(hci_con_handle_t con_handle, uint16_t value_handle, uint8_t * value, int length){ 7305611a760SMatthias Ringwald uint8_t * packet = setup_characteristic_value_packet(GATT_EVENT_INDICATION, 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 735*5cf1669fSMatthias Ringwald static void report_gatt_characteristic_value(gatt_client_t * gatt_client, uint16_t attribute_handle, uint8_t * value, uint16_t length){ 736*5cf1669fSMatthias Ringwald uint8_t * packet = setup_characteristic_value_packet(GATT_EVENT_CHARACTERISTIC_VALUE_QUERY_RESULT, gatt_client->con_handle, attribute_handle, value, length); 737*5cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, characteristic_value_event_header_size + length); 7383deb3ec6SMatthias Ringwald } 7393deb3ec6SMatthias Ringwald 7403deb3ec6SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite parts of the HCI/L2CAP/ATT packet (4/4/3) bytes 741*5cf1669fSMatthias 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){ 742*5cf1669fSMatthias 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); 7433deb3ec6SMatthias Ringwald if (!packet) return; 744*5cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, blob_length + long_characteristic_value_event_header_size); 7453deb3ec6SMatthias Ringwald } 7463deb3ec6SMatthias Ringwald 747*5cf1669fSMatthias 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){ 7489ec2630cSMatthias Ringwald UNUSED(value_offset); 749*5cf1669fSMatthias Ringwald uint8_t * packet = setup_characteristic_value_packet(GATT_EVENT_CHARACTERISTIC_DESCRIPTOR_QUERY_RESULT, gatt_client->con_handle, descriptor_handle, value, value_length); 750*5cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, value_length + 8u); 7513deb3ec6SMatthias Ringwald } 7523deb3ec6SMatthias Ringwald 753*5cf1669fSMatthias 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){ 754*5cf1669fSMatthias 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); 7553deb3ec6SMatthias Ringwald if (!packet) return; 756*5cf1669fSMatthias Ringwald emit_event_new(gatt_client->callback, packet, blob_length + long_characteristic_value_event_header_size); 7573deb3ec6SMatthias Ringwald } 7583deb3ec6SMatthias Ringwald 759*5cf1669fSMatthias Ringwald static void report_gatt_all_characteristic_descriptors(gatt_client_t * gatt_client, uint8_t * packet, uint16_t size, uint16_t pair_size){ 7603deb3ec6SMatthias Ringwald int i; 7614ea43905SMatthias Ringwald for (i = 0u; (i + pair_size) <= size; i += pair_size){ 762f8fbdce0SMatthias Ringwald uint16_t descriptor_handle = little_endian_read_16(packet,i); 7633deb3ec6SMatthias Ringwald uint8_t uuid128[16]; 7643deb3ec6SMatthias Ringwald uint16_t uuid16 = 0; 7654ea43905SMatthias Ringwald if (pair_size == 4u){ 766f8fbdce0SMatthias Ringwald uuid16 = little_endian_read_16(packet,i+2); 767e1a125dfSMatthias Ringwald uuid_add_bluetooth_prefix(uuid128, uuid16); 7683deb3ec6SMatthias Ringwald } else { 7699c80e4ccSMatthias Ringwald reverse_128(&packet[i+2], uuid128); 7703deb3ec6SMatthias Ringwald } 771*5cf1669fSMatthias Ringwald emit_gatt_all_characteristic_descriptors_result_event(gatt_client, descriptor_handle, uuid128); 7723deb3ec6SMatthias Ringwald } 7733deb3ec6SMatthias Ringwald 7743deb3ec6SMatthias Ringwald } 7753deb3ec6SMatthias Ringwald 776*5cf1669fSMatthias Ringwald static int is_query_done(gatt_client_t * gatt_client, uint16_t last_result_handle){ 777*5cf1669fSMatthias Ringwald return last_result_handle >= gatt_client->end_group_handle; 7783deb3ec6SMatthias Ringwald } 7793deb3ec6SMatthias Ringwald 780*5cf1669fSMatthias Ringwald static void trigger_next_query(gatt_client_t * gatt_client, uint16_t last_result_handle, gatt_client_state_t next_query_state){ 781*5cf1669fSMatthias Ringwald if (is_query_done(gatt_client, last_result_handle)){ 782*5cf1669fSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 783*5cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_SUCCESS); 7843deb3ec6SMatthias Ringwald return; 7853deb3ec6SMatthias Ringwald } 7863deb3ec6SMatthias Ringwald // next 787*5cf1669fSMatthias Ringwald gatt_client->start_group_handle = last_result_handle + 1u; 788*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = next_query_state; 7893deb3ec6SMatthias Ringwald } 7903deb3ec6SMatthias Ringwald 791*5cf1669fSMatthias Ringwald static void trigger_next_included_service_query(gatt_client_t * gatt_client, uint16_t last_result_handle){ 792*5cf1669fSMatthias Ringwald trigger_next_query(gatt_client, last_result_handle, P_W2_SEND_INCLUDED_SERVICE_QUERY); 7933deb3ec6SMatthias Ringwald } 7943deb3ec6SMatthias Ringwald 795*5cf1669fSMatthias Ringwald static void trigger_next_service_query(gatt_client_t * gatt_client, uint16_t last_result_handle){ 796*5cf1669fSMatthias Ringwald trigger_next_query(gatt_client, last_result_handle, P_W2_SEND_SERVICE_QUERY); 7973deb3ec6SMatthias Ringwald } 7983deb3ec6SMatthias Ringwald 799*5cf1669fSMatthias Ringwald static void trigger_next_service_by_uuid_query(gatt_client_t * gatt_client, uint16_t last_result_handle){ 800*5cf1669fSMatthias Ringwald trigger_next_query(gatt_client, last_result_handle, P_W2_SEND_SERVICE_WITH_UUID_QUERY); 8013deb3ec6SMatthias Ringwald } 8023deb3ec6SMatthias Ringwald 803*5cf1669fSMatthias Ringwald static void trigger_next_characteristic_query(gatt_client_t * gatt_client, uint16_t last_result_handle){ 804*5cf1669fSMatthias Ringwald if (is_query_done(gatt_client, last_result_handle)){ 8053deb3ec6SMatthias Ringwald // report last characteristic 806*5cf1669fSMatthias Ringwald characteristic_end_found(gatt_client, gatt_client->end_group_handle); 8073deb3ec6SMatthias Ringwald } 808*5cf1669fSMatthias Ringwald trigger_next_query(gatt_client, last_result_handle, P_W2_SEND_ALL_CHARACTERISTICS_OF_SERVICE_QUERY); 8093deb3ec6SMatthias Ringwald } 8103deb3ec6SMatthias Ringwald 811*5cf1669fSMatthias Ringwald static void trigger_next_characteristic_descriptor_query(gatt_client_t * gatt_client, uint16_t last_result_handle){ 812*5cf1669fSMatthias Ringwald trigger_next_query(gatt_client, last_result_handle, P_W2_SEND_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY); 8133deb3ec6SMatthias Ringwald } 8143deb3ec6SMatthias Ringwald 815*5cf1669fSMatthias Ringwald static void trigger_next_read_by_type_query(gatt_client_t * gatt_client, uint16_t last_result_handle){ 816*5cf1669fSMatthias Ringwald trigger_next_query(gatt_client, last_result_handle, P_W2_SEND_READ_BY_TYPE_REQUEST); 8173deb3ec6SMatthias Ringwald } 8183deb3ec6SMatthias Ringwald 819*5cf1669fSMatthias 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){ 820*5cf1669fSMatthias Ringwald gatt_client->attribute_offset += write_blob_length(gatt_client); 821*5cf1669fSMatthias Ringwald uint16_t next_blob_length = write_blob_length(gatt_client); 8223deb3ec6SMatthias Ringwald 8234ea43905SMatthias Ringwald if (next_blob_length == 0u){ 824*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = done_state; 8253deb3ec6SMatthias Ringwald return; 8263deb3ec6SMatthias Ringwald } 827*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = next_query_state; 8283deb3ec6SMatthias Ringwald } 8293deb3ec6SMatthias Ringwald 830*5cf1669fSMatthias Ringwald static void trigger_next_blob_query(gatt_client_t * gatt_client, gatt_client_state_t next_query_state, uint16_t received_blob_length){ 8313deb3ec6SMatthias Ringwald 832*5cf1669fSMatthias Ringwald uint16_t max_blob_length = gatt_client_mtu(gatt_client) - 1u; 8333deb3ec6SMatthias Ringwald if (received_blob_length < max_blob_length){ 834*5cf1669fSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 835*5cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_SUCCESS); 8363deb3ec6SMatthias Ringwald return; 8373deb3ec6SMatthias Ringwald } 8383deb3ec6SMatthias Ringwald 839*5cf1669fSMatthias Ringwald gatt_client->attribute_offset += received_blob_length; 840*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = next_query_state; 8413deb3ec6SMatthias Ringwald } 8423deb3ec6SMatthias Ringwald 8433deb3ec6SMatthias Ringwald 844*5cf1669fSMatthias Ringwald static int is_value_valid(gatt_client_t *gatt_client, uint8_t *packet, uint16_t size){ 845f8fbdce0SMatthias Ringwald uint16_t attribute_handle = little_endian_read_16(packet, 1); 846f8fbdce0SMatthias Ringwald uint16_t value_offset = little_endian_read_16(packet, 3); 8473deb3ec6SMatthias Ringwald 848*5cf1669fSMatthias Ringwald if (gatt_client->attribute_handle != attribute_handle) return 0; 849*5cf1669fSMatthias Ringwald if (gatt_client->attribute_offset != value_offset) return 0; 850*5cf1669fSMatthias Ringwald return memcmp(&gatt_client->attribute_value[gatt_client->attribute_offset], &packet[5], size - 5u) == 0u; 8513deb3ec6SMatthias Ringwald } 8523deb3ec6SMatthias Ringwald 853544128c3SMatthias Ringwald // returns 1 if packet was sent 854*5cf1669fSMatthias Ringwald static int gatt_client_run_for_gatt_client(gatt_client_t * gatt_client){ 8553deb3ec6SMatthias Ringwald 856d1e1a57fSMatthias Ringwald // wait until re-encryption as central is complete 857*5cf1669fSMatthias Ringwald if (gap_reconnect_security_setup_active(gatt_client->con_handle)) return 0; 858d1e1a57fSMatthias Ringwald 859f4b33574SMatthias Ringwald #ifdef ENABLE_GATT_CLIENT_PAIRING 860f4b33574SMatthias Ringwald // wait until pairing complete 861*5cf1669fSMatthias Ringwald if (gatt_client->wait_for_pairing_complete) return 0; 862f4b33574SMatthias Ringwald #endif 863f4b33574SMatthias Ringwald 864*5cf1669fSMatthias Ringwald switch (gatt_client->mtu_state) { 865544128c3SMatthias Ringwald case SEND_MTU_EXCHANGE: 866*5cf1669fSMatthias Ringwald gatt_client->mtu_state = SENT_MTU_EXCHANGE; 867*5cf1669fSMatthias Ringwald att_exchange_mtu_request(gatt_client->con_handle); 868544128c3SMatthias Ringwald return 1; 8693deb3ec6SMatthias Ringwald case SENT_MTU_EXCHANGE: 870544128c3SMatthias Ringwald return 0; 8713deb3ec6SMatthias Ringwald default: 8723deb3ec6SMatthias Ringwald break; 8733deb3ec6SMatthias Ringwald } 8743deb3ec6SMatthias Ringwald 875*5cf1669fSMatthias Ringwald if (gatt_client->send_confirmation){ 876*5cf1669fSMatthias Ringwald gatt_client->send_confirmation = 0; 877*5cf1669fSMatthias Ringwald att_confirmation(gatt_client->con_handle); 878544128c3SMatthias Ringwald return 1; 8793deb3ec6SMatthias Ringwald } 8803deb3ec6SMatthias Ringwald 8813deb3ec6SMatthias Ringwald // check MTU for writes 882*5cf1669fSMatthias Ringwald switch (gatt_client->gatt_client_state){ 8833deb3ec6SMatthias Ringwald case P_W2_SEND_WRITE_CHARACTERISTIC_VALUE: 8843deb3ec6SMatthias Ringwald case P_W2_SEND_WRITE_CHARACTERISTIC_DESCRIPTOR: 885*5cf1669fSMatthias Ringwald if (gatt_client->attribute_length <= (gatt_client_mtu(gatt_client) - 3u)) break; 886*5cf1669fSMatthias Ringwald log_error("gatt_client_run: value len %u > MTU %u - 3\n", gatt_client->attribute_length, 887*5cf1669fSMatthias Ringwald gatt_client_mtu(gatt_client)); 888*5cf1669fSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 889*5cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_INVALID_ATTRIBUTE_VALUE_LENGTH); 890544128c3SMatthias Ringwald return 0; 8913deb3ec6SMatthias Ringwald default: 8923deb3ec6SMatthias Ringwald break; 8933deb3ec6SMatthias Ringwald } 8943deb3ec6SMatthias Ringwald 895*5cf1669fSMatthias Ringwald switch (gatt_client->gatt_client_state){ 8963deb3ec6SMatthias Ringwald case P_W2_SEND_SERVICE_QUERY: 897*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_SERVICE_QUERY_RESULT; 898*5cf1669fSMatthias Ringwald send_gatt_services_request(gatt_client); 899544128c3SMatthias Ringwald return 1; 9003deb3ec6SMatthias Ringwald 9013deb3ec6SMatthias Ringwald case P_W2_SEND_SERVICE_WITH_UUID_QUERY: 902*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_SERVICE_WITH_UUID_RESULT; 903*5cf1669fSMatthias Ringwald send_gatt_services_by_uuid_request(gatt_client); 904544128c3SMatthias Ringwald return 1; 9053deb3ec6SMatthias Ringwald 9063deb3ec6SMatthias Ringwald case P_W2_SEND_ALL_CHARACTERISTICS_OF_SERVICE_QUERY: 907*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_ALL_CHARACTERISTICS_OF_SERVICE_QUERY_RESULT; 908*5cf1669fSMatthias Ringwald send_gatt_characteristic_request(gatt_client); 909544128c3SMatthias Ringwald return 1; 9103deb3ec6SMatthias Ringwald 9113deb3ec6SMatthias Ringwald case P_W2_SEND_CHARACTERISTIC_WITH_UUID_QUERY: 912*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_CHARACTERISTIC_WITH_UUID_QUERY_RESULT; 913*5cf1669fSMatthias Ringwald send_gatt_characteristic_request(gatt_client); 914544128c3SMatthias Ringwald return 1; 9153deb3ec6SMatthias Ringwald 9163deb3ec6SMatthias Ringwald case P_W2_SEND_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY: 917*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_CHARACTERISTIC_WITH_UUID_QUERY_RESULT; 918*5cf1669fSMatthias Ringwald send_gatt_characteristic_descriptor_request(gatt_client); 919544128c3SMatthias Ringwald return 1; 9203deb3ec6SMatthias Ringwald 9213deb3ec6SMatthias Ringwald case P_W2_SEND_INCLUDED_SERVICE_QUERY: 922*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_INCLUDED_SERVICE_QUERY_RESULT; 923*5cf1669fSMatthias Ringwald send_gatt_included_service_request(gatt_client); 924544128c3SMatthias Ringwald return 1; 9253deb3ec6SMatthias Ringwald 9263deb3ec6SMatthias Ringwald case P_W2_SEND_INCLUDED_SERVICE_WITH_UUID_QUERY: 927*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_INCLUDED_SERVICE_UUID_WITH_QUERY_RESULT; 928*5cf1669fSMatthias Ringwald send_gatt_included_service_uuid_request(gatt_client); 929544128c3SMatthias Ringwald return 1; 9303deb3ec6SMatthias Ringwald 9313deb3ec6SMatthias Ringwald case P_W2_SEND_READ_CHARACTERISTIC_VALUE_QUERY: 932*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_READ_CHARACTERISTIC_VALUE_RESULT; 933*5cf1669fSMatthias Ringwald send_gatt_read_characteristic_value_request(gatt_client); 934544128c3SMatthias Ringwald return 1; 9353deb3ec6SMatthias Ringwald 9363deb3ec6SMatthias Ringwald case P_W2_SEND_READ_BLOB_QUERY: 937*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_READ_BLOB_RESULT; 938*5cf1669fSMatthias Ringwald send_gatt_read_blob_request(gatt_client); 939544128c3SMatthias Ringwald return 1; 9403deb3ec6SMatthias Ringwald 9413deb3ec6SMatthias Ringwald case P_W2_SEND_READ_BY_TYPE_REQUEST: 942*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_READ_BY_TYPE_RESPONSE; 943*5cf1669fSMatthias Ringwald send_gatt_read_by_type_request(gatt_client); 944544128c3SMatthias Ringwald return 1; 9453deb3ec6SMatthias Ringwald 9463deb3ec6SMatthias Ringwald case P_W2_SEND_READ_MULTIPLE_REQUEST: 947*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_READ_MULTIPLE_RESPONSE; 948*5cf1669fSMatthias Ringwald send_gatt_read_multiple_request(gatt_client); 949544128c3SMatthias Ringwald return 1; 9503deb3ec6SMatthias Ringwald 9513deb3ec6SMatthias Ringwald case P_W2_SEND_WRITE_CHARACTERISTIC_VALUE: 952*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_WRITE_CHARACTERISTIC_VALUE_RESULT; 953*5cf1669fSMatthias Ringwald send_gatt_write_attribute_value_request(gatt_client); 954544128c3SMatthias Ringwald return 1; 9553deb3ec6SMatthias Ringwald 9563deb3ec6SMatthias Ringwald case P_W2_PREPARE_WRITE: 957*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_PREPARE_WRITE_RESULT; 958*5cf1669fSMatthias Ringwald send_gatt_prepare_write_request(gatt_client); 959544128c3SMatthias Ringwald return 1; 9603deb3ec6SMatthias Ringwald 9613deb3ec6SMatthias Ringwald case P_W2_PREPARE_WRITE_SINGLE: 962*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_PREPARE_WRITE_SINGLE_RESULT; 963*5cf1669fSMatthias Ringwald send_gatt_prepare_write_request(gatt_client); 964544128c3SMatthias Ringwald return 1; 9653deb3ec6SMatthias Ringwald 9663deb3ec6SMatthias Ringwald case P_W2_PREPARE_RELIABLE_WRITE: 967*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_PREPARE_RELIABLE_WRITE_RESULT; 968*5cf1669fSMatthias Ringwald send_gatt_prepare_write_request(gatt_client); 969544128c3SMatthias Ringwald return 1; 9703deb3ec6SMatthias Ringwald 9713deb3ec6SMatthias Ringwald case P_W2_EXECUTE_PREPARED_WRITE: 972*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_EXECUTE_PREPARED_WRITE_RESULT; 973*5cf1669fSMatthias Ringwald send_gatt_execute_write_request(gatt_client); 974544128c3SMatthias Ringwald return 1; 9753deb3ec6SMatthias Ringwald 9763deb3ec6SMatthias Ringwald case P_W2_CANCEL_PREPARED_WRITE: 977*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_CANCEL_PREPARED_WRITE_RESULT; 978*5cf1669fSMatthias Ringwald send_gatt_cancel_prepared_write_request(gatt_client); 979544128c3SMatthias Ringwald return 1; 9803deb3ec6SMatthias Ringwald 9813deb3ec6SMatthias Ringwald case P_W2_CANCEL_PREPARED_WRITE_DATA_MISMATCH: 982*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_CANCEL_PREPARED_WRITE_DATA_MISMATCH_RESULT; 983*5cf1669fSMatthias Ringwald send_gatt_cancel_prepared_write_request(gatt_client); 984544128c3SMatthias Ringwald return 1; 9853deb3ec6SMatthias Ringwald 986abdc9fb5SMatthias Ringwald #ifdef ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY 987abdc9fb5SMatthias Ringwald case P_W2_SEND_FIND_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY: 988abdc9fb5SMatthias Ringwald // use Find Information 989*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_FIND_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY_RESULT; 990*5cf1669fSMatthias Ringwald send_gatt_characteristic_descriptor_request(gatt_client); 991abdc9fb5SMatthias Ringwald #else 9923deb3ec6SMatthias Ringwald case P_W2_SEND_READ_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY: 993abdc9fb5SMatthias Ringwald // Use Read By Type 994*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_READ_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY_RESULT; 995*5cf1669fSMatthias Ringwald send_gatt_read_client_characteristic_configuration_request(gatt_client); 996abdc9fb5SMatthias Ringwald #endif 997544128c3SMatthias Ringwald return 1; 9983deb3ec6SMatthias Ringwald 9993deb3ec6SMatthias Ringwald case P_W2_SEND_READ_CHARACTERISTIC_DESCRIPTOR_QUERY: 1000*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_READ_CHARACTERISTIC_DESCRIPTOR_RESULT; 1001*5cf1669fSMatthias Ringwald send_gatt_read_characteristic_descriptor_request(gatt_client); 1002544128c3SMatthias Ringwald return 1; 10033deb3ec6SMatthias Ringwald 10043deb3ec6SMatthias Ringwald case P_W2_SEND_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_QUERY: 1005*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_RESULT; 1006*5cf1669fSMatthias Ringwald send_gatt_read_blob_request(gatt_client); 1007544128c3SMatthias Ringwald return 1; 10083deb3ec6SMatthias Ringwald 10093deb3ec6SMatthias Ringwald case P_W2_SEND_WRITE_CHARACTERISTIC_DESCRIPTOR: 1010*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT; 1011*5cf1669fSMatthias Ringwald send_gatt_write_attribute_value_request(gatt_client); 1012544128c3SMatthias Ringwald return 1; 10133deb3ec6SMatthias Ringwald 10143deb3ec6SMatthias Ringwald case P_W2_WRITE_CLIENT_CHARACTERISTIC_CONFIGURATION: 1015*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_CLIENT_CHARACTERISTIC_CONFIGURATION_RESULT; 1016*5cf1669fSMatthias Ringwald send_gatt_write_client_characteristic_configuration_request(gatt_client); 1017544128c3SMatthias Ringwald return 1; 10183deb3ec6SMatthias Ringwald 10193deb3ec6SMatthias Ringwald case P_W2_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR: 1020*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT; 1021*5cf1669fSMatthias Ringwald send_gatt_prepare_write_request(gatt_client); 1022544128c3SMatthias Ringwald return 1; 10233deb3ec6SMatthias Ringwald 10243deb3ec6SMatthias Ringwald case P_W2_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR: 1025*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT; 1026*5cf1669fSMatthias Ringwald send_gatt_execute_write_request(gatt_client); 1027544128c3SMatthias Ringwald return 1; 10283deb3ec6SMatthias Ringwald 10297a766ebfSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 1030793cf6ceSMatthias Ringwald case P_W4_IDENTITY_RESOLVING: 1031*5cf1669fSMatthias Ringwald log_info("P_W4_IDENTITY_RESOLVING - state %x", sm_identity_resolving_state(gatt_client->con_handle)); 1032*5cf1669fSMatthias Ringwald switch (sm_identity_resolving_state(gatt_client->con_handle)){ 1033793cf6ceSMatthias Ringwald case IRK_LOOKUP_SUCCEEDED: 1034*5cf1669fSMatthias Ringwald gatt_client->le_device_index = sm_le_device_index(gatt_client->con_handle); 1035*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_CMAC_READY; 1036793cf6ceSMatthias Ringwald break; 1037793cf6ceSMatthias Ringwald case IRK_LOOKUP_FAILED: 1038*5cf1669fSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 1039*5cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_BONDING_INFORMATION_MISSING); 1040793cf6ceSMatthias Ringwald return 0; 1041793cf6ceSMatthias Ringwald default: 1042793cf6ceSMatthias Ringwald return 0; 1043793cf6ceSMatthias Ringwald } 1044793cf6ceSMatthias Ringwald 1045793cf6ceSMatthias Ringwald /* Fall through */ 1046793cf6ceSMatthias Ringwald 10473deb3ec6SMatthias Ringwald case P_W4_CMAC_READY: 10483deb3ec6SMatthias Ringwald if (sm_cmac_ready()){ 10493deb3ec6SMatthias Ringwald sm_key_t csrk; 1050*5cf1669fSMatthias Ringwald le_device_db_local_csrk_get(gatt_client->le_device_index, csrk); 1051*5cf1669fSMatthias Ringwald uint32_t sign_counter = le_device_db_local_counter_get(gatt_client->le_device_index); 1052*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_CMAC_RESULT; 1053*5cf1669fSMatthias 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); 10543deb3ec6SMatthias Ringwald } 1055544128c3SMatthias Ringwald return 0; 10563deb3ec6SMatthias Ringwald 10573deb3ec6SMatthias Ringwald case P_W2_SEND_SIGNED_WRITE: { 1058*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_SEND_SINGED_WRITE_DONE; 10593deb3ec6SMatthias Ringwald // bump local signing counter 1060*5cf1669fSMatthias Ringwald uint32_t sign_counter = le_device_db_local_counter_get(gatt_client->le_device_index); 1061*5cf1669fSMatthias Ringwald le_device_db_local_counter_set(gatt_client->le_device_index, sign_counter + 1); 106264b12680SMatthias Ringwald // send signed write command 1063*5cf1669fSMatthias Ringwald send_gatt_signed_write_request(gatt_client, sign_counter); 10643deb3ec6SMatthias Ringwald // finally, notifiy client that write is complete 1065*5cf1669fSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 1066*5cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_SUCCESS); 1067544128c3SMatthias Ringwald return 1; 10683deb3ec6SMatthias Ringwald } 10697a766ebfSMatthias Ringwald #endif 10703deb3ec6SMatthias Ringwald default: 10713deb3ec6SMatthias Ringwald break; 10723deb3ec6SMatthias Ringwald } 107347181045SMatthias Ringwald 107447181045SMatthias Ringwald // requested can send snow? 1075*5cf1669fSMatthias Ringwald if (gatt_client->write_without_response_callback){ 1076*5cf1669fSMatthias Ringwald btstack_packet_handler_t packet_handler = gatt_client->write_without_response_callback; 1077*5cf1669fSMatthias Ringwald gatt_client->write_without_response_callback = NULL; 107847181045SMatthias Ringwald uint8_t event[4]; 107947181045SMatthias Ringwald event[0] = GATT_EVENT_CAN_WRITE_WITHOUT_RESPONSE; 10804ea43905SMatthias Ringwald event[1] = sizeof(event) - 2u; 1081*5cf1669fSMatthias Ringwald little_endian_store_16(event, 2, gatt_client->con_handle); 1082*5cf1669fSMatthias Ringwald packet_handler(HCI_EVENT_PACKET, gatt_client->con_handle, event, sizeof(event)); 108347181045SMatthias Ringwald return 1; // to trigger requeueing (even if higher layer didn't sent) 108447181045SMatthias Ringwald } 108547181045SMatthias Ringwald 1086544128c3SMatthias Ringwald return 0; 10873deb3ec6SMatthias Ringwald } 10883deb3ec6SMatthias Ringwald 1089544128c3SMatthias Ringwald static void gatt_client_run(void){ 1090544128c3SMatthias Ringwald btstack_linked_item_t *it; 1091a0da043fSMatthias Ringwald for (it = (btstack_linked_item_t *) gatt_client_connections; it != NULL; it = it->next){ 1092*5cf1669fSMatthias Ringwald gatt_client_t * gatt_client = (gatt_client_t *) it; 1093*5cf1669fSMatthias Ringwald if (!att_dispatch_client_can_send_now(gatt_client->con_handle)) { 1094*5cf1669fSMatthias Ringwald att_dispatch_client_request_can_send_now_event(gatt_client->con_handle); 1095544128c3SMatthias Ringwald return; 1096544128c3SMatthias Ringwald } 1097*5cf1669fSMatthias Ringwald int packet_sent = gatt_client_run_for_gatt_client(gatt_client); 1098544128c3SMatthias Ringwald if (packet_sent){ 109945f2a740SMatthias Ringwald // request new permission 1100*5cf1669fSMatthias Ringwald att_dispatch_client_request_can_send_now_event(gatt_client->con_handle); 110145f2a740SMatthias Ringwald // requeue client for fairness and exit 110245f2a740SMatthias Ringwald // note: iterator has become invalid 1103*5cf1669fSMatthias Ringwald btstack_linked_list_remove(&gatt_client_connections, (btstack_linked_item_t *) gatt_client); 1104*5cf1669fSMatthias Ringwald btstack_linked_list_add_tail(&gatt_client_connections, (btstack_linked_item_t *) gatt_client); 1105544128c3SMatthias Ringwald return; 1106544128c3SMatthias Ringwald } 1107544128c3SMatthias Ringwald } 11083deb3ec6SMatthias Ringwald } 11093deb3ec6SMatthias Ringwald 1110*5cf1669fSMatthias Ringwald static void gatt_client_report_error_if_pending(gatt_client_t *gatt_client, uint8_t att_error_code) { 1111*5cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 1) return; 1112*5cf1669fSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 1113*5cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, att_error_code); 11143deb3ec6SMatthias Ringwald } 11153deb3ec6SMatthias Ringwald 1116f4b33574SMatthias Ringwald static void gatt_client_event_packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size){ 11171ac26e06SMatthias Ringwald UNUSED(channel); // ok: handling own l2cap events 11181ac26e06SMatthias Ringwald UNUSED(size); // ok: there is no channel 11199ec2630cSMatthias Ringwald 1120361b1363SMatthias Ringwald if (packet_type != HCI_EVENT_PACKET) return; 1121361b1363SMatthias Ringwald 1122f4b33574SMatthias Ringwald hci_con_handle_t con_handle; 1123*5cf1669fSMatthias Ringwald gatt_client_t * gatt_client; 11240e2df43fSMatthias Ringwald switch (hci_event_packet_get_type(packet)) { 11253deb3ec6SMatthias Ringwald case HCI_EVENT_DISCONNECTION_COMPLETE: 11263deb3ec6SMatthias Ringwald log_info("GATT Client: HCI_EVENT_DISCONNECTION_COMPLETE"); 1127f4b33574SMatthias Ringwald con_handle = little_endian_read_16(packet,3); 1128*5cf1669fSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(con_handle); 1129*5cf1669fSMatthias Ringwald if (gatt_client == NULL) break; 11303deb3ec6SMatthias Ringwald 1131*5cf1669fSMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, ATT_ERROR_HCI_DISCONNECT_RECEIVED); 1132*5cf1669fSMatthias Ringwald gatt_client_timeout_stop(gatt_client); 1133*5cf1669fSMatthias Ringwald btstack_linked_list_remove(&gatt_client_connections, (btstack_linked_item_t *) gatt_client); 1134*5cf1669fSMatthias Ringwald btstack_memory_gatt_client_free(gatt_client); 11353deb3ec6SMatthias Ringwald break; 1136f4b33574SMatthias Ringwald 1137f4b33574SMatthias Ringwald #ifdef ENABLE_GATT_CLIENT_PAIRING 1138f4b33574SMatthias Ringwald // Pairing complete (with/without bonding=storing of pairing information) 1139f4b33574SMatthias Ringwald case SM_EVENT_PAIRING_COMPLETE: 1140f4b33574SMatthias Ringwald con_handle = sm_event_pairing_complete_get_handle(packet); 1141*5cf1669fSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(con_handle); 1142*5cf1669fSMatthias Ringwald if (gatt_client == NULL) break; 1143f4b33574SMatthias Ringwald 1144*5cf1669fSMatthias Ringwald if (gatt_client->wait_for_pairing_complete){ 1145*5cf1669fSMatthias Ringwald gatt_client->wait_for_pairing_complete = 0; 1146f4b33574SMatthias Ringwald if (sm_event_pairing_complete_get_status(packet)){ 1147*5cf1669fSMatthias Ringwald log_info("pairing failed, report previous error 0x%x", gatt_client->pending_error_code); 1148*5cf1669fSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 1149*5cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, gatt_client->pending_error_code); 1150f4b33574SMatthias Ringwald } else { 1151f4b33574SMatthias Ringwald log_info("pairing success, retry operation"); 11523deb3ec6SMatthias Ringwald } 1153f4b33574SMatthias Ringwald } 1154f4b33574SMatthias Ringwald break; 1155f4b33574SMatthias Ringwald #endif 1156793cf6ceSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 1157793cf6ceSMatthias Ringwald // Identity Resolving completed (no code, gatt_client_run will continue) 1158793cf6ceSMatthias Ringwald case SM_EVENT_IDENTITY_RESOLVING_SUCCEEDED: 1159793cf6ceSMatthias Ringwald case SM_EVENT_IDENTITY_RESOLVING_FAILED: 1160793cf6ceSMatthias Ringwald break; 1161793cf6ceSMatthias Ringwald #endif 1162f4b33574SMatthias Ringwald 11633deb3ec6SMatthias Ringwald default: 11643deb3ec6SMatthias Ringwald break; 11653deb3ec6SMatthias Ringwald } 11663deb3ec6SMatthias Ringwald 1167361b1363SMatthias Ringwald gatt_client_run(); 11683deb3ec6SMatthias Ringwald } 11693deb3ec6SMatthias Ringwald 11703deb3ec6SMatthias Ringwald static void gatt_client_att_packet_handler(uint8_t packet_type, uint16_t handle, uint8_t *packet, uint16_t size){ 1171*5cf1669fSMatthias Ringwald gatt_client_t * gatt_client; 11724ea43905SMatthias Ringwald if (size < 1u) return; 11730fbf59a1SMatthias Ringwald 11740fbf59a1SMatthias Ringwald if (packet_type == HCI_EVENT_PACKET) { 11750fbf59a1SMatthias Ringwald switch (packet[0]){ 11760fbf59a1SMatthias Ringwald case L2CAP_EVENT_CAN_SEND_NOW: 117751764b3bSMatthias Ringwald gatt_client_run(); 11780fbf59a1SMatthias Ringwald break; 11790fbf59a1SMatthias Ringwald // att_server has negotiated the mtu for this connection, cache if context exists 11800fbf59a1SMatthias Ringwald case ATT_EVENT_MTU_EXCHANGE_COMPLETE: 11814ea43905SMatthias Ringwald if (size < 6u) break; 1182*5cf1669fSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(handle); 1183*5cf1669fSMatthias Ringwald if (gatt_client == NULL) break; 1184*5cf1669fSMatthias Ringwald gatt_client->mtu = little_endian_read_16(packet, 4); 11850fbf59a1SMatthias Ringwald break; 11860fbf59a1SMatthias Ringwald default: 11870fbf59a1SMatthias Ringwald break; 11880fbf59a1SMatthias Ringwald } 11890fbf59a1SMatthias Ringwald return; 119051764b3bSMatthias Ringwald } 119151764b3bSMatthias Ringwald 11923deb3ec6SMatthias Ringwald if (packet_type != ATT_DATA_PACKET) return; 11933deb3ec6SMatthias Ringwald 11943deb3ec6SMatthias Ringwald // special cases: notifications don't need a context while indications motivate creating one 11953deb3ec6SMatthias Ringwald switch (packet[0]){ 11963deb3ec6SMatthias Ringwald case ATT_HANDLE_VALUE_NOTIFICATION: 11974ea43905SMatthias Ringwald if (size < 3u) return; 11984ea43905SMatthias Ringwald report_gatt_notification(handle, little_endian_read_16(packet,1u), &packet[3], size-3u); 11993deb3ec6SMatthias Ringwald return; 12003deb3ec6SMatthias Ringwald case ATT_HANDLE_VALUE_INDICATION: 1201*5cf1669fSMatthias Ringwald gatt_client = gatt_client_provide_context_for_handle(handle); 12023deb3ec6SMatthias Ringwald break; 12033deb3ec6SMatthias Ringwald default: 1204*5cf1669fSMatthias Ringwald gatt_client = gatt_client_get_context_for_handle(handle); 12053deb3ec6SMatthias Ringwald break; 12063deb3ec6SMatthias Ringwald } 12073deb3ec6SMatthias Ringwald 1208*5cf1669fSMatthias Ringwald if (gatt_client == NULL) return; 12093deb3ec6SMatthias Ringwald 12103deb3ec6SMatthias Ringwald switch (packet[0]){ 12113deb3ec6SMatthias Ringwald case ATT_EXCHANGE_MTU_RESPONSE: 12123deb3ec6SMatthias Ringwald { 12134ea43905SMatthias Ringwald if (size < 3u) break; 1214f8fbdce0SMatthias Ringwald uint16_t remote_rx_mtu = little_endian_read_16(packet, 1); 12153deb3ec6SMatthias Ringwald uint16_t local_rx_mtu = l2cap_max_le_mtu(); 1216*5cf1669fSMatthias Ringwald gatt_client->mtu = (remote_rx_mtu < local_rx_mtu) ? remote_rx_mtu : local_rx_mtu; 1217*5cf1669fSMatthias Ringwald gatt_client->mtu_state = MTU_EXCHANGED; 1218*5cf1669fSMatthias Ringwald emit_gatt_mtu_exchanged_result_event(gatt_client, gatt_client->mtu); 12193deb3ec6SMatthias Ringwald break; 12203deb3ec6SMatthias Ringwald } 12213deb3ec6SMatthias Ringwald case ATT_READ_BY_GROUP_TYPE_RESPONSE: 1222*5cf1669fSMatthias Ringwald switch(gatt_client->gatt_client_state){ 12233deb3ec6SMatthias Ringwald case P_W4_SERVICE_QUERY_RESULT: 1224*5cf1669fSMatthias Ringwald report_gatt_services(gatt_client, packet, size); 1225*5cf1669fSMatthias Ringwald trigger_next_service_query(gatt_client, get_last_result_handle_from_service_list(packet, size)); 12265611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 12273deb3ec6SMatthias Ringwald break; 12283deb3ec6SMatthias Ringwald default: 12293deb3ec6SMatthias Ringwald break; 12303deb3ec6SMatthias Ringwald } 12313deb3ec6SMatthias Ringwald break; 12323deb3ec6SMatthias Ringwald case ATT_HANDLE_VALUE_INDICATION: 12334ea43905SMatthias Ringwald if (size < 3u) break; 12344ea43905SMatthias Ringwald report_gatt_indication(handle, little_endian_read_16(packet,1u), &packet[3], size-3u); 1235*5cf1669fSMatthias Ringwald gatt_client->send_confirmation = 1; 12363deb3ec6SMatthias Ringwald break; 12373deb3ec6SMatthias Ringwald 12383deb3ec6SMatthias Ringwald case ATT_READ_BY_TYPE_RESPONSE: 1239*5cf1669fSMatthias Ringwald switch (gatt_client->gatt_client_state){ 12403deb3ec6SMatthias Ringwald case P_W4_ALL_CHARACTERISTICS_OF_SERVICE_QUERY_RESULT: 1241*5cf1669fSMatthias Ringwald report_gatt_characteristics(gatt_client, packet, size); 1242*5cf1669fSMatthias Ringwald trigger_next_characteristic_query(gatt_client, get_last_result_handle_from_characteristics_list(packet, size)); 12435611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done, or by ATT_ERROR 12443deb3ec6SMatthias Ringwald break; 12453deb3ec6SMatthias Ringwald case P_W4_CHARACTERISTIC_WITH_UUID_QUERY_RESULT: 1246*5cf1669fSMatthias Ringwald report_gatt_characteristics(gatt_client, packet, size); 1247*5cf1669fSMatthias Ringwald trigger_next_characteristic_query(gatt_client, get_last_result_handle_from_characteristics_list(packet, size)); 12485611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done, or by ATT_ERROR 12493deb3ec6SMatthias Ringwald break; 12503deb3ec6SMatthias Ringwald case P_W4_INCLUDED_SERVICE_QUERY_RESULT: 12513deb3ec6SMatthias Ringwald { 12524ea43905SMatthias Ringwald if (size < 2u) break; 12533deb3ec6SMatthias Ringwald uint16_t uuid16 = 0; 12543deb3ec6SMatthias Ringwald uint16_t pair_size = packet[1]; 12553deb3ec6SMatthias Ringwald 12564ea43905SMatthias Ringwald if (pair_size == 6u){ 12574ea43905SMatthias Ringwald if (size < 8u) break; 12583deb3ec6SMatthias Ringwald // UUIDs not available, query first included service 1259*5cf1669fSMatthias Ringwald gatt_client->start_group_handle = little_endian_read_16(packet, 2); // ready for next query 1260*5cf1669fSMatthias Ringwald gatt_client->query_start_handle = little_endian_read_16(packet, 4); 1261*5cf1669fSMatthias Ringwald gatt_client->query_end_handle = little_endian_read_16(packet, 6); 1262*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_INCLUDED_SERVICE_WITH_UUID_QUERY; 12633deb3ec6SMatthias Ringwald break; 12643deb3ec6SMatthias Ringwald } 12653deb3ec6SMatthias Ringwald 12664ea43905SMatthias Ringwald if (pair_size != 8u) break; 12679f698c82SMatthias Ringwald 12689f698c82SMatthias Ringwald // UUIDs included, report all of them 12693deb3ec6SMatthias Ringwald uint16_t offset; 12704ea43905SMatthias Ringwald for (offset = 2u; (offset + 8u) <= size; offset += pair_size){ 1271f8fbdce0SMatthias Ringwald uint16_t include_handle = little_endian_read_16(packet, offset); 1272*5cf1669fSMatthias Ringwald gatt_client->query_start_handle = little_endian_read_16(packet, offset + 2u); 1273*5cf1669fSMatthias Ringwald gatt_client->query_end_handle = little_endian_read_16(packet, offset + 4u); 12744ea43905SMatthias Ringwald uuid16 = little_endian_read_16(packet, offset+6u); 1275*5cf1669fSMatthias Ringwald report_gatt_included_service_uuid16(gatt_client, include_handle, uuid16); 12763deb3ec6SMatthias Ringwald } 12773deb3ec6SMatthias Ringwald 1278*5cf1669fSMatthias Ringwald trigger_next_included_service_query(gatt_client, get_last_result_handle_from_included_services_list(packet, size)); 12795611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 12803deb3ec6SMatthias Ringwald break; 12813deb3ec6SMatthias Ringwald } 1282abdc9fb5SMatthias Ringwald #ifndef ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY 12833deb3ec6SMatthias Ringwald case P_W4_READ_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY_RESULT: 1284*5cf1669fSMatthias Ringwald gatt_client->client_characteristic_configuration_handle = little_endian_read_16(packet, 2); 1285*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_WRITE_CLIENT_CHARACTERISTIC_CONFIGURATION; 12863deb3ec6SMatthias Ringwald break; 1287abdc9fb5SMatthias Ringwald #endif 12883deb3ec6SMatthias Ringwald case P_W4_READ_BY_TYPE_RESPONSE: { 12893deb3ec6SMatthias Ringwald uint16_t pair_size = packet[1]; 12903deb3ec6SMatthias Ringwald uint16_t offset; 12913deb3ec6SMatthias Ringwald uint16_t last_result_handle = 0; 12923deb3ec6SMatthias Ringwald for (offset = 2; offset < size ; offset += pair_size){ 1293f8fbdce0SMatthias Ringwald uint16_t value_handle = little_endian_read_16(packet, offset); 1294*5cf1669fSMatthias Ringwald report_gatt_characteristic_value(gatt_client, value_handle, &packet[offset + 2u], pair_size - 2u); 12953deb3ec6SMatthias Ringwald last_result_handle = value_handle; 12963deb3ec6SMatthias Ringwald } 1297*5cf1669fSMatthias Ringwald trigger_next_read_by_type_query(gatt_client, last_result_handle); 12983deb3ec6SMatthias Ringwald break; 12993deb3ec6SMatthias Ringwald } 13003deb3ec6SMatthias Ringwald default: 13013deb3ec6SMatthias Ringwald break; 13023deb3ec6SMatthias Ringwald } 13033deb3ec6SMatthias Ringwald break; 13043deb3ec6SMatthias Ringwald case ATT_READ_RESPONSE: 1305*5cf1669fSMatthias Ringwald switch (gatt_client->gatt_client_state){ 13063deb3ec6SMatthias Ringwald case P_W4_INCLUDED_SERVICE_UUID_WITH_QUERY_RESULT: { 13073deb3ec6SMatthias Ringwald uint8_t uuid128[16]; 13089c80e4ccSMatthias Ringwald reverse_128(&packet[1], uuid128); 1309*5cf1669fSMatthias Ringwald report_gatt_included_service_uuid128(gatt_client, gatt_client->start_group_handle, uuid128); 1310*5cf1669fSMatthias Ringwald trigger_next_included_service_query(gatt_client, gatt_client->start_group_handle); 13115611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 13123deb3ec6SMatthias Ringwald break; 13133deb3ec6SMatthias Ringwald } 13143deb3ec6SMatthias Ringwald case P_W4_READ_CHARACTERISTIC_VALUE_RESULT: 1315*5cf1669fSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 1316*5cf1669fSMatthias Ringwald report_gatt_characteristic_value(gatt_client, gatt_client->attribute_handle, &packet[1], size - 1u); 1317*5cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_SUCCESS); 13183deb3ec6SMatthias Ringwald break; 13193deb3ec6SMatthias Ringwald 13203deb3ec6SMatthias Ringwald case P_W4_READ_CHARACTERISTIC_DESCRIPTOR_RESULT:{ 1321*5cf1669fSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 1322*5cf1669fSMatthias Ringwald report_gatt_characteristic_descriptor(gatt_client, gatt_client->attribute_handle, &packet[1], size - 1u, 0u); 1323*5cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_SUCCESS); 13243deb3ec6SMatthias Ringwald break; 13253deb3ec6SMatthias Ringwald } 13263deb3ec6SMatthias Ringwald default: 13273deb3ec6SMatthias Ringwald break; 13283deb3ec6SMatthias Ringwald } 13293deb3ec6SMatthias Ringwald break; 13303deb3ec6SMatthias Ringwald 13313deb3ec6SMatthias Ringwald case ATT_FIND_BY_TYPE_VALUE_RESPONSE: 13323deb3ec6SMatthias Ringwald { 13333deb3ec6SMatthias Ringwald uint8_t pair_size = 4; 13343deb3ec6SMatthias Ringwald int i; 13353deb3ec6SMatthias Ringwald uint16_t start_group_handle; 13365611a760SMatthias Ringwald uint16_t end_group_handle= 0xffff; // asserts GATT_EVENT_QUERY_COMPLETE is emitted if no results 13374ea43905SMatthias Ringwald for (i = 1u; (i + pair_size) <= size; i += pair_size){ 1338f8fbdce0SMatthias Ringwald start_group_handle = little_endian_read_16(packet,i); 1339f8fbdce0SMatthias Ringwald end_group_handle = little_endian_read_16(packet,i+2); 1340*5cf1669fSMatthias Ringwald emit_gatt_service_query_result_event(gatt_client, start_group_handle, end_group_handle, gatt_client->uuid128); 13413deb3ec6SMatthias Ringwald } 1342*5cf1669fSMatthias Ringwald trigger_next_service_by_uuid_query(gatt_client, end_group_handle); 13435611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 13443deb3ec6SMatthias Ringwald break; 13453deb3ec6SMatthias Ringwald } 13463deb3ec6SMatthias Ringwald case ATT_FIND_INFORMATION_REPLY: 13473deb3ec6SMatthias Ringwald { 13484ea43905SMatthias Ringwald if (size < 2u) break; 1349a6121b51SMilanka Ringwald 13503deb3ec6SMatthias Ringwald uint8_t pair_size = 4; 13514ea43905SMatthias Ringwald if (packet[1u] == 2u){ 13523deb3ec6SMatthias Ringwald pair_size = 18; 13533deb3ec6SMatthias Ringwald } 1354a6121b51SMilanka Ringwald uint16_t offset = 2; 1355a6121b51SMilanka Ringwald 1356a6121b51SMilanka Ringwald if (size < (pair_size + offset)) break; 1357f8fbdce0SMatthias Ringwald uint16_t last_descriptor_handle = little_endian_read_16(packet, size - pair_size); 1358abdc9fb5SMatthias Ringwald 1359abdc9fb5SMatthias Ringwald #ifdef ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY 1360*5cf1669fSMatthias Ringwald log_info("ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY, state %x", gatt_client->gatt_client_state); 1361*5cf1669fSMatthias Ringwald if (gatt_client->gatt_client_state == P_W4_FIND_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY_RESULT){ 1362abdc9fb5SMatthias Ringwald // iterate over descriptors looking for CCC 1363abdc9fb5SMatthias Ringwald if (pair_size == 4){ 1364a6121b51SMilanka Ringwald while ((offset + 4) <= size){ 1365abdc9fb5SMatthias Ringwald uint16_t uuid16 = little_endian_read_16(packet, offset + 2); 1366abdc9fb5SMatthias Ringwald if (uuid16 == GATT_CLIENT_CHARACTERISTICS_CONFIGURATION){ 1367*5cf1669fSMatthias Ringwald gatt_client->client_characteristic_configuration_handle = little_endian_read_16(packet, offset); 1368*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_WRITE_CLIENT_CHARACTERISTIC_CONFIGURATION; 1369*5cf1669fSMatthias Ringwald log_info("CCC found %x", gatt_client->client_characteristic_configuration_handle); 1370abdc9fb5SMatthias Ringwald break; 1371abdc9fb5SMatthias Ringwald } 1372abdc9fb5SMatthias Ringwald offset += pair_size; 1373abdc9fb5SMatthias Ringwald } 1374abdc9fb5SMatthias Ringwald } 1375*5cf1669fSMatthias Ringwald if (is_query_done(gatt_client, last_descriptor_handle)){ 1376abdc9fb5SMatthias Ringwald 1377abdc9fb5SMatthias Ringwald } else { 1378abdc9fb5SMatthias Ringwald // next 1379*5cf1669fSMatthias Ringwald gatt_client->start_group_handle = last_descriptor_handle + 1; 1380*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_FIND_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY; 1381abdc9fb5SMatthias Ringwald } 1382abdc9fb5SMatthias Ringwald break; 1383abdc9fb5SMatthias Ringwald } 1384abdc9fb5SMatthias Ringwald #endif 1385*5cf1669fSMatthias Ringwald report_gatt_all_characteristic_descriptors(gatt_client, &packet[2], size - 2u, pair_size); 1386*5cf1669fSMatthias Ringwald trigger_next_characteristic_descriptor_query(gatt_client, last_descriptor_handle); 13875611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 13883deb3ec6SMatthias Ringwald break; 13893deb3ec6SMatthias Ringwald } 13903deb3ec6SMatthias Ringwald 13913deb3ec6SMatthias Ringwald case ATT_WRITE_RESPONSE: 1392*5cf1669fSMatthias Ringwald switch (gatt_client->gatt_client_state){ 13933deb3ec6SMatthias Ringwald case P_W4_WRITE_CHARACTERISTIC_VALUE_RESULT: 1394*5cf1669fSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 1395*5cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_SUCCESS); 13963deb3ec6SMatthias Ringwald break; 13973deb3ec6SMatthias Ringwald case P_W4_CLIENT_CHARACTERISTIC_CONFIGURATION_RESULT: 1398*5cf1669fSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 1399*5cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_SUCCESS); 14003deb3ec6SMatthias Ringwald break; 14013deb3ec6SMatthias Ringwald case P_W4_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT: 1402*5cf1669fSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 1403*5cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_SUCCESS); 14043deb3ec6SMatthias Ringwald break; 14053deb3ec6SMatthias Ringwald default: 14063deb3ec6SMatthias Ringwald break; 14073deb3ec6SMatthias Ringwald } 14083deb3ec6SMatthias Ringwald break; 14093deb3ec6SMatthias Ringwald 14103deb3ec6SMatthias Ringwald case ATT_READ_BLOB_RESPONSE:{ 14114ea43905SMatthias Ringwald uint16_t received_blob_length = size-1u; 1412*5cf1669fSMatthias Ringwald switch(gatt_client->gatt_client_state){ 14133deb3ec6SMatthias Ringwald case P_W4_READ_BLOB_RESULT: 1414*5cf1669fSMatthias Ringwald report_gatt_long_characteristic_value_blob(gatt_client, gatt_client->attribute_handle, &packet[1], received_blob_length, gatt_client->attribute_offset); 1415*5cf1669fSMatthias Ringwald trigger_next_blob_query(gatt_client, P_W2_SEND_READ_BLOB_QUERY, received_blob_length); 14165611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 14173deb3ec6SMatthias Ringwald break; 14183deb3ec6SMatthias Ringwald case P_W4_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_RESULT: 1419*5cf1669fSMatthias Ringwald report_gatt_long_characteristic_descriptor(gatt_client, gatt_client->attribute_handle, 14203deb3ec6SMatthias Ringwald &packet[1], received_blob_length, 1421*5cf1669fSMatthias Ringwald gatt_client->attribute_offset); 1422*5cf1669fSMatthias Ringwald trigger_next_blob_query(gatt_client, P_W2_SEND_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_QUERY, received_blob_length); 14235611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 14243deb3ec6SMatthias Ringwald break; 14253deb3ec6SMatthias Ringwald default: 14263deb3ec6SMatthias Ringwald break; 14273deb3ec6SMatthias Ringwald } 14283deb3ec6SMatthias Ringwald break; 14293deb3ec6SMatthias Ringwald } 14303deb3ec6SMatthias Ringwald case ATT_PREPARE_WRITE_RESPONSE: 1431*5cf1669fSMatthias Ringwald switch (gatt_client->gatt_client_state){ 14323deb3ec6SMatthias Ringwald case P_W4_PREPARE_WRITE_SINGLE_RESULT: 1433*5cf1669fSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 1434*5cf1669fSMatthias Ringwald if (is_value_valid(gatt_client, packet, size)){ 1435*5cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_SUCCESS); 14363deb3ec6SMatthias Ringwald } else { 1437*5cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_DATA_MISMATCH); 14383deb3ec6SMatthias Ringwald } 14393deb3ec6SMatthias Ringwald break; 14403deb3ec6SMatthias Ringwald 14413deb3ec6SMatthias Ringwald case P_W4_PREPARE_WRITE_RESULT:{ 1442*5cf1669fSMatthias Ringwald gatt_client->attribute_offset = little_endian_read_16(packet, 3); 1443*5cf1669fSMatthias Ringwald trigger_next_prepare_write_query(gatt_client, P_W2_PREPARE_WRITE, P_W2_EXECUTE_PREPARED_WRITE); 14445611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 14453deb3ec6SMatthias Ringwald break; 14463deb3ec6SMatthias Ringwald } 14473deb3ec6SMatthias Ringwald case P_W4_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT:{ 1448*5cf1669fSMatthias Ringwald gatt_client->attribute_offset = little_endian_read_16(packet, 3); 1449*5cf1669fSMatthias Ringwald trigger_next_prepare_write_query(gatt_client, P_W2_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR, P_W2_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR); 14505611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 14513deb3ec6SMatthias Ringwald break; 14523deb3ec6SMatthias Ringwald } 14533deb3ec6SMatthias Ringwald case P_W4_PREPARE_RELIABLE_WRITE_RESULT:{ 1454*5cf1669fSMatthias Ringwald if (is_value_valid(gatt_client, packet, size)){ 1455*5cf1669fSMatthias Ringwald gatt_client->attribute_offset = little_endian_read_16(packet, 3); 1456*5cf1669fSMatthias Ringwald trigger_next_prepare_write_query(gatt_client, P_W2_PREPARE_RELIABLE_WRITE, P_W2_EXECUTE_PREPARED_WRITE); 14575611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 14583deb3ec6SMatthias Ringwald break; 14593deb3ec6SMatthias Ringwald } 1460*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_CANCEL_PREPARED_WRITE_DATA_MISMATCH; 14613deb3ec6SMatthias Ringwald break; 14623deb3ec6SMatthias Ringwald } 14633deb3ec6SMatthias Ringwald default: 14643deb3ec6SMatthias Ringwald break; 14653deb3ec6SMatthias Ringwald } 14663deb3ec6SMatthias Ringwald break; 14673deb3ec6SMatthias Ringwald 14683deb3ec6SMatthias Ringwald case ATT_EXECUTE_WRITE_RESPONSE: 1469*5cf1669fSMatthias Ringwald switch (gatt_client->gatt_client_state){ 14703deb3ec6SMatthias Ringwald case P_W4_EXECUTE_PREPARED_WRITE_RESULT: 1471*5cf1669fSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 1472*5cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_SUCCESS); 14733deb3ec6SMatthias Ringwald break; 14743deb3ec6SMatthias Ringwald case P_W4_CANCEL_PREPARED_WRITE_RESULT: 1475*5cf1669fSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 1476*5cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_SUCCESS); 14773deb3ec6SMatthias Ringwald break; 14783deb3ec6SMatthias Ringwald case P_W4_CANCEL_PREPARED_WRITE_DATA_MISMATCH_RESULT: 1479*5cf1669fSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 1480*5cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_DATA_MISMATCH); 14813deb3ec6SMatthias Ringwald break; 14823deb3ec6SMatthias Ringwald case P_W4_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT: 1483*5cf1669fSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 1484*5cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_SUCCESS); 14853deb3ec6SMatthias Ringwald break; 14863deb3ec6SMatthias Ringwald default: 14873deb3ec6SMatthias Ringwald break; 14883deb3ec6SMatthias Ringwald 14893deb3ec6SMatthias Ringwald } 14903deb3ec6SMatthias Ringwald break; 14913deb3ec6SMatthias Ringwald 14923deb3ec6SMatthias Ringwald case ATT_READ_MULTIPLE_RESPONSE: 1493*5cf1669fSMatthias Ringwald switch(gatt_client->gatt_client_state){ 14943deb3ec6SMatthias Ringwald case P_W4_READ_MULTIPLE_RESPONSE: 1495*5cf1669fSMatthias Ringwald report_gatt_characteristic_value(gatt_client, 0u, &packet[1], size - 1u); 1496*5cf1669fSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 1497*5cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_SUCCESS); 14983deb3ec6SMatthias Ringwald break; 14993deb3ec6SMatthias Ringwald default: 15003deb3ec6SMatthias Ringwald break; 15013deb3ec6SMatthias Ringwald } 15023deb3ec6SMatthias Ringwald break; 15033deb3ec6SMatthias Ringwald 15043deb3ec6SMatthias Ringwald case ATT_ERROR_RESPONSE: 15054ea43905SMatthias Ringwald if (size < 5u) return; 15063deb3ec6SMatthias Ringwald switch (packet[4]){ 15073deb3ec6SMatthias Ringwald case ATT_ERROR_ATTRIBUTE_NOT_FOUND: { 1508*5cf1669fSMatthias Ringwald switch(gatt_client->gatt_client_state){ 15093deb3ec6SMatthias Ringwald case P_W4_SERVICE_QUERY_RESULT: 15103deb3ec6SMatthias Ringwald case P_W4_SERVICE_WITH_UUID_RESULT: 15113deb3ec6SMatthias Ringwald case P_W4_INCLUDED_SERVICE_QUERY_RESULT: 15123deb3ec6SMatthias Ringwald case P_W4_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY_RESULT: 1513*5cf1669fSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 1514*5cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_SUCCESS); 15153deb3ec6SMatthias Ringwald break; 15163deb3ec6SMatthias Ringwald case P_W4_ALL_CHARACTERISTICS_OF_SERVICE_QUERY_RESULT: 15173deb3ec6SMatthias Ringwald case P_W4_CHARACTERISTIC_WITH_UUID_QUERY_RESULT: 1518*5cf1669fSMatthias Ringwald characteristic_end_found(gatt_client, gatt_client->end_group_handle); 1519*5cf1669fSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 1520*5cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_SUCCESS); 15213deb3ec6SMatthias Ringwald break; 15223deb3ec6SMatthias Ringwald case P_W4_READ_BY_TYPE_RESPONSE: 1523*5cf1669fSMatthias Ringwald gatt_client_handle_transaction_complete(gatt_client); 1524*5cf1669fSMatthias Ringwald if (gatt_client->start_group_handle == gatt_client->query_start_handle){ 1525*5cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_ATTRIBUTE_NOT_FOUND); 15263deb3ec6SMatthias Ringwald } else { 1527*5cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_SUCCESS); 15283deb3ec6SMatthias Ringwald } 15293deb3ec6SMatthias Ringwald break; 15303deb3ec6SMatthias Ringwald default: 1531*5cf1669fSMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, packet[4]); 15323deb3ec6SMatthias Ringwald break; 15333deb3ec6SMatthias Ringwald } 15343deb3ec6SMatthias Ringwald break; 15353deb3ec6SMatthias Ringwald } 1536f4b33574SMatthias Ringwald 1537f4b33574SMatthias Ringwald #ifdef ENABLE_GATT_CLIENT_PAIRING 1538f4b33574SMatthias Ringwald 1539f4b33574SMatthias Ringwald case ATT_ERROR_INSUFFICIENT_AUTHENTICATION: 1540f4b33574SMatthias Ringwald case ATT_ERROR_INSUFFICIENT_ENCRYPTION_KEY_SIZE: 1541a0e0c2beSMatthias Ringwald case ATT_ERROR_INSUFFICIENT_ENCRYPTION: { 1542a0e0c2beSMatthias Ringwald 1543f4b33574SMatthias Ringwald // security too low 1544*5cf1669fSMatthias Ringwald if (gatt_client->security_counter > 0) { 1545*5cf1669fSMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, packet[4]); 1546f4b33574SMatthias Ringwald break; 1547f4b33574SMatthias Ringwald } 1548f4b33574SMatthias Ringwald // start security 1549*5cf1669fSMatthias Ringwald gatt_client->security_counter++; 1550f4b33574SMatthias Ringwald 1551f4b33574SMatthias Ringwald // setup action 1552f4b33574SMatthias Ringwald int retry = 1; 1553*5cf1669fSMatthias Ringwald switch (gatt_client->gatt_client_state){ 1554f4b33574SMatthias Ringwald case P_W4_READ_CHARACTERISTIC_VALUE_RESULT: 1555*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_CHARACTERISTIC_VALUE_QUERY ; 1556f4b33574SMatthias Ringwald break; 1557f4b33574SMatthias Ringwald case P_W4_READ_BLOB_RESULT: 1558*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_BLOB_QUERY; 1559f4b33574SMatthias Ringwald break; 1560f4b33574SMatthias Ringwald case P_W4_READ_BY_TYPE_RESPONSE: 1561*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_BY_TYPE_REQUEST; 1562f4b33574SMatthias Ringwald break; 1563f4b33574SMatthias Ringwald case P_W4_READ_MULTIPLE_RESPONSE: 1564*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_MULTIPLE_REQUEST; 1565f4b33574SMatthias Ringwald break; 1566f4b33574SMatthias Ringwald case P_W4_WRITE_CHARACTERISTIC_VALUE_RESULT: 1567*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_WRITE_CHARACTERISTIC_VALUE; 1568f4b33574SMatthias Ringwald break; 1569f4b33574SMatthias Ringwald case P_W4_PREPARE_WRITE_RESULT: 1570*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_PREPARE_WRITE; 1571f4b33574SMatthias Ringwald break; 1572f4b33574SMatthias Ringwald case P_W4_PREPARE_WRITE_SINGLE_RESULT: 1573*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_PREPARE_WRITE_SINGLE; 1574f4b33574SMatthias Ringwald break; 1575f4b33574SMatthias Ringwald case P_W4_PREPARE_RELIABLE_WRITE_RESULT: 1576*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_PREPARE_RELIABLE_WRITE; 1577f4b33574SMatthias Ringwald break; 1578f4b33574SMatthias Ringwald case P_W4_EXECUTE_PREPARED_WRITE_RESULT: 1579*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_EXECUTE_PREPARED_WRITE; 1580f4b33574SMatthias Ringwald break; 1581f4b33574SMatthias Ringwald case P_W4_CANCEL_PREPARED_WRITE_RESULT: 1582*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_CANCEL_PREPARED_WRITE; 1583f4b33574SMatthias Ringwald break; 1584f4b33574SMatthias Ringwald case P_W4_CANCEL_PREPARED_WRITE_DATA_MISMATCH_RESULT: 1585*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_CANCEL_PREPARED_WRITE_DATA_MISMATCH; 1586f4b33574SMatthias Ringwald break; 1587f4b33574SMatthias Ringwald case P_W4_READ_CHARACTERISTIC_DESCRIPTOR_RESULT: 1588*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_CHARACTERISTIC_DESCRIPTOR_QUERY; 1589f4b33574SMatthias Ringwald break; 1590f4b33574SMatthias Ringwald case P_W4_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_RESULT: 1591*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_QUERY; 1592f4b33574SMatthias Ringwald break; 1593f4b33574SMatthias Ringwald case P_W4_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT: 1594*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_WRITE_CHARACTERISTIC_DESCRIPTOR; 1595f4b33574SMatthias Ringwald break; 1596f4b33574SMatthias Ringwald case P_W4_CLIENT_CHARACTERISTIC_CONFIGURATION_RESULT: 1597*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_WRITE_CLIENT_CHARACTERISTIC_CONFIGURATION; 1598f4b33574SMatthias Ringwald break; 1599f4b33574SMatthias Ringwald case P_W4_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT: 1600*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR; 1601f4b33574SMatthias Ringwald break; 1602f4b33574SMatthias Ringwald case P_W4_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT: 1603*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR; 1604f4b33574SMatthias Ringwald break; 1605f4b33574SMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 1606f4b33574SMatthias Ringwald case P_W4_SEND_SINGED_WRITE_DONE: 1607*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_SIGNED_WRITE; 1608f4b33574SMatthias Ringwald break; 1609f4b33574SMatthias Ringwald #endif 1610f4b33574SMatthias Ringwald default: 1611*5cf1669fSMatthias Ringwald log_info("retry not supported for state %x", gatt_client->gatt_client_state); 1612f4b33574SMatthias Ringwald retry = 0; 1613f4b33574SMatthias Ringwald break; 1614f4b33574SMatthias Ringwald } 1615f4b33574SMatthias Ringwald 1616f4b33574SMatthias Ringwald if (!retry) { 1617*5cf1669fSMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, packet[4]); 1618f4b33574SMatthias Ringwald break; 1619f4b33574SMatthias Ringwald } 1620f4b33574SMatthias Ringwald 1621f4b33574SMatthias Ringwald log_info("security error, start pairing"); 1622f4b33574SMatthias Ringwald 1623f4b33574SMatthias Ringwald // requrest pairing 1624*5cf1669fSMatthias Ringwald gatt_client->wait_for_pairing_complete = 1; 1625*5cf1669fSMatthias Ringwald gatt_client->pending_error_code = packet[4]; 1626*5cf1669fSMatthias Ringwald sm_request_pairing(gatt_client->con_handle); 1627f4b33574SMatthias Ringwald break; 1628a0e0c2beSMatthias Ringwald } 1629f4b33574SMatthias Ringwald #endif 1630f4b33574SMatthias Ringwald 1631f4b33574SMatthias Ringwald // nothing we can do about that 1632f4b33574SMatthias Ringwald case ATT_ERROR_INSUFFICIENT_AUTHORIZATION: 16333deb3ec6SMatthias Ringwald default: 1634*5cf1669fSMatthias Ringwald gatt_client_report_error_if_pending(gatt_client, packet[4]); 16353deb3ec6SMatthias Ringwald break; 16363deb3ec6SMatthias Ringwald } 16373deb3ec6SMatthias Ringwald break; 16383deb3ec6SMatthias Ringwald 16393deb3ec6SMatthias Ringwald default: 16403deb3ec6SMatthias Ringwald log_info("ATT Handler, unhandled response type 0x%02x", packet[0]); 16413deb3ec6SMatthias Ringwald break; 16423deb3ec6SMatthias Ringwald } 16433deb3ec6SMatthias Ringwald gatt_client_run(); 16443deb3ec6SMatthias Ringwald } 16453deb3ec6SMatthias Ringwald 16467a766ebfSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 16473deb3ec6SMatthias Ringwald static void att_signed_write_handle_cmac_result(uint8_t hash[8]){ 1648665d90f2SMatthias Ringwald btstack_linked_list_iterator_t it; 1649665d90f2SMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client_connections); 1650665d90f2SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 1651*5cf1669fSMatthias Ringwald gatt_client_t * gatt_client = (gatt_client_t *) btstack_linked_list_iterator_next(&it); 1652*5cf1669fSMatthias Ringwald if (gatt_client->gatt_client_state == P_W4_CMAC_RESULT){ 16533deb3ec6SMatthias Ringwald // store result 1654*5cf1669fSMatthias Ringwald (void)memcpy(gatt_client->cmac, hash, 8); 1655*5cf1669fSMatthias Ringwald // reverse_64(hash, gatt_client->cmac); 1656*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_SIGNED_WRITE; 16573deb3ec6SMatthias Ringwald gatt_client_run(); 16583deb3ec6SMatthias Ringwald return; 16593deb3ec6SMatthias Ringwald } 16603deb3ec6SMatthias Ringwald } 16613deb3ec6SMatthias Ringwald } 16623deb3ec6SMatthias Ringwald 1663711e6c80SMatthias 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){ 1664*5cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle(con_handle); 1665*5cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 1666*5cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 16673deb3ec6SMatthias Ringwald 1668*5cf1669fSMatthias Ringwald gatt_client->callback = callback; 1669*5cf1669fSMatthias Ringwald gatt_client->attribute_handle = handle; 1670*5cf1669fSMatthias Ringwald gatt_client->attribute_length = message_len; 1671*5cf1669fSMatthias Ringwald gatt_client->attribute_value = message; 1672*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W4_IDENTITY_RESOLVING; 16733deb3ec6SMatthias Ringwald gatt_client_run(); 167425b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 16753deb3ec6SMatthias Ringwald } 16767a766ebfSMatthias Ringwald #endif 16773deb3ec6SMatthias Ringwald 1678711e6c80SMatthias Ringwald uint8_t gatt_client_discover_primary_services(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 1679*5cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 1680*5cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 1681*5cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 16823deb3ec6SMatthias Ringwald 1683*5cf1669fSMatthias Ringwald gatt_client->callback = callback; 1684*5cf1669fSMatthias Ringwald gatt_client->start_group_handle = 0x0001; 1685*5cf1669fSMatthias Ringwald gatt_client->end_group_handle = 0xffff; 1686*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_SERVICE_QUERY; 1687*5cf1669fSMatthias Ringwald gatt_client->uuid16 = 0; 16883deb3ec6SMatthias Ringwald gatt_client_run(); 168925b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 16903deb3ec6SMatthias Ringwald } 16913deb3ec6SMatthias Ringwald 16923deb3ec6SMatthias Ringwald 1693711e6c80SMatthias Ringwald uint8_t gatt_client_discover_primary_services_by_uuid16(btstack_packet_handler_t callback, hci_con_handle_t con_handle, uint16_t uuid16){ 1694*5cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 1695*5cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 1696*5cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 16973deb3ec6SMatthias Ringwald 1698*5cf1669fSMatthias Ringwald gatt_client->callback = callback; 1699*5cf1669fSMatthias Ringwald gatt_client->start_group_handle = 0x0001; 1700*5cf1669fSMatthias Ringwald gatt_client->end_group_handle = 0xffff; 1701*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_SERVICE_WITH_UUID_QUERY; 1702*5cf1669fSMatthias Ringwald gatt_client->uuid16 = uuid16; 1703*5cf1669fSMatthias Ringwald uuid_add_bluetooth_prefix((uint8_t*) &(gatt_client->uuid128), gatt_client->uuid16); 17043deb3ec6SMatthias Ringwald gatt_client_run(); 170525b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 17063deb3ec6SMatthias Ringwald } 17073deb3ec6SMatthias Ringwald 1708711e6c80SMatthias 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){ 1709*5cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 1710*5cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 1711*5cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 17123deb3ec6SMatthias Ringwald 1713*5cf1669fSMatthias Ringwald gatt_client->callback = callback; 1714*5cf1669fSMatthias Ringwald gatt_client->start_group_handle = 0x0001; 1715*5cf1669fSMatthias Ringwald gatt_client->end_group_handle = 0xffff; 1716*5cf1669fSMatthias Ringwald gatt_client->uuid16 = 0; 1717*5cf1669fSMatthias Ringwald (void)memcpy(gatt_client->uuid128, uuid128, 16); 1718*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_SERVICE_WITH_UUID_QUERY; 17193deb3ec6SMatthias Ringwald gatt_client_run(); 172025b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 17213deb3ec6SMatthias Ringwald } 17223deb3ec6SMatthias Ringwald 1723711e6c80SMatthias 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){ 1724*5cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 1725*5cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 1726*5cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 17273deb3ec6SMatthias Ringwald 1728*5cf1669fSMatthias Ringwald gatt_client->callback = callback; 1729*5cf1669fSMatthias Ringwald gatt_client->start_group_handle = service->start_group_handle; 1730*5cf1669fSMatthias Ringwald gatt_client->end_group_handle = service->end_group_handle; 1731*5cf1669fSMatthias Ringwald gatt_client->filter_with_uuid = 0; 1732*5cf1669fSMatthias Ringwald gatt_client->characteristic_start_handle = 0; 1733*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_ALL_CHARACTERISTICS_OF_SERVICE_QUERY; 17343deb3ec6SMatthias Ringwald gatt_client_run(); 173525b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 17363deb3ec6SMatthias Ringwald } 17373deb3ec6SMatthias Ringwald 1738711e6c80SMatthias 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){ 1739*5cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 1740*5cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 1741*5cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 1742*5cf1669fSMatthias Ringwald gatt_client->callback = callback; 1743*5cf1669fSMatthias Ringwald gatt_client->start_group_handle = service->start_group_handle; 1744*5cf1669fSMatthias Ringwald gatt_client->end_group_handle = service->end_group_handle; 1745*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_INCLUDED_SERVICE_QUERY; 17463deb3ec6SMatthias Ringwald 17473deb3ec6SMatthias Ringwald gatt_client_run(); 174825b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 17493deb3ec6SMatthias Ringwald } 17503deb3ec6SMatthias Ringwald 1751711e6c80SMatthias 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){ 1752*5cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 1753*5cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 1754*5cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 17553deb3ec6SMatthias Ringwald 1756*5cf1669fSMatthias Ringwald gatt_client->callback = callback; 1757*5cf1669fSMatthias Ringwald gatt_client->start_group_handle = start_handle; 1758*5cf1669fSMatthias Ringwald gatt_client->end_group_handle = end_handle; 1759*5cf1669fSMatthias Ringwald gatt_client->filter_with_uuid = 1; 1760*5cf1669fSMatthias Ringwald gatt_client->uuid16 = uuid16; 1761*5cf1669fSMatthias Ringwald uuid_add_bluetooth_prefix((uint8_t*) &(gatt_client->uuid128), uuid16); 1762*5cf1669fSMatthias Ringwald gatt_client->characteristic_start_handle = 0; 1763*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_CHARACTERISTIC_WITH_UUID_QUERY; 17643deb3ec6SMatthias Ringwald gatt_client_run(); 176525b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 17663deb3ec6SMatthias Ringwald } 17673deb3ec6SMatthias Ringwald 1768711e6c80SMatthias 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){ 1769*5cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 1770*5cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 1771*5cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 17723deb3ec6SMatthias Ringwald 1773*5cf1669fSMatthias Ringwald gatt_client->callback = callback; 1774*5cf1669fSMatthias Ringwald gatt_client->start_group_handle = start_handle; 1775*5cf1669fSMatthias Ringwald gatt_client->end_group_handle = end_handle; 1776*5cf1669fSMatthias Ringwald gatt_client->filter_with_uuid = 1; 1777*5cf1669fSMatthias Ringwald gatt_client->uuid16 = 0; 1778*5cf1669fSMatthias Ringwald (void)memcpy(gatt_client->uuid128, uuid128, 16); 1779*5cf1669fSMatthias Ringwald gatt_client->characteristic_start_handle = 0; 1780*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_CHARACTERISTIC_WITH_UUID_QUERY; 17813deb3ec6SMatthias Ringwald gatt_client_run(); 178225b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 17833deb3ec6SMatthias Ringwald } 17843deb3ec6SMatthias Ringwald 17853deb3ec6SMatthias Ringwald 1786d25c33e5SMatthias 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){ 17879c662c9bSMatthias Ringwald return gatt_client_discover_characteristics_for_handle_range_by_uuid16(callback, handle, service->start_group_handle, service->end_group_handle, uuid16); 17883deb3ec6SMatthias Ringwald } 17893deb3ec6SMatthias Ringwald 1790d25c33e5SMatthias 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){ 17919c662c9bSMatthias Ringwald return gatt_client_discover_characteristics_for_handle_range_by_uuid128(callback, handle, service->start_group_handle, service->end_group_handle, uuid128); 17923deb3ec6SMatthias Ringwald } 17933deb3ec6SMatthias Ringwald 1794711e6c80SMatthias Ringwald uint8_t gatt_client_discover_characteristic_descriptors(btstack_packet_handler_t callback, hci_con_handle_t con_handle, gatt_client_characteristic_t *characteristic){ 1795*5cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 1796*5cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 1797*5cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 17983deb3ec6SMatthias Ringwald 17993deb3ec6SMatthias Ringwald if (characteristic->value_handle == characteristic->end_handle){ 1800*5cf1669fSMatthias Ringwald emit_gatt_complete_event(gatt_client, ATT_ERROR_SUCCESS); 180125b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 18023deb3ec6SMatthias Ringwald } 1803*5cf1669fSMatthias Ringwald gatt_client->callback = callback; 1804*5cf1669fSMatthias Ringwald gatt_client->start_group_handle = characteristic->value_handle + 1u; 1805*5cf1669fSMatthias Ringwald gatt_client->end_group_handle = characteristic->end_handle; 1806*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY; 18073deb3ec6SMatthias Ringwald gatt_client_run(); 180825b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 18093deb3ec6SMatthias Ringwald } 18103deb3ec6SMatthias Ringwald 1811711e6c80SMatthias 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){ 1812*5cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 1813*5cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 1814*5cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 18153deb3ec6SMatthias Ringwald 1816*5cf1669fSMatthias Ringwald gatt_client->callback = callback; 1817*5cf1669fSMatthias Ringwald gatt_client->attribute_handle = value_handle; 1818*5cf1669fSMatthias Ringwald gatt_client->attribute_offset = 0; 1819*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_CHARACTERISTIC_VALUE_QUERY; 18203deb3ec6SMatthias Ringwald gatt_client_run(); 182125b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 18223deb3ec6SMatthias Ringwald } 18233deb3ec6SMatthias Ringwald 1824711e6c80SMatthias 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){ 1825*5cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 1826*5cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 1827*5cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 18283deb3ec6SMatthias Ringwald 1829*5cf1669fSMatthias Ringwald gatt_client->callback = callback; 1830*5cf1669fSMatthias Ringwald gatt_client->start_group_handle = start_handle; 1831*5cf1669fSMatthias Ringwald gatt_client->end_group_handle = end_handle; 1832*5cf1669fSMatthias Ringwald gatt_client->query_start_handle = start_handle; 1833*5cf1669fSMatthias Ringwald gatt_client->query_end_handle = end_handle; 1834*5cf1669fSMatthias Ringwald gatt_client->uuid16 = uuid16; 1835*5cf1669fSMatthias Ringwald uuid_add_bluetooth_prefix((uint8_t*) &(gatt_client->uuid128), uuid16); 1836*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_BY_TYPE_REQUEST; 18373deb3ec6SMatthias Ringwald gatt_client_run(); 183825b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 18393deb3ec6SMatthias Ringwald } 18403deb3ec6SMatthias Ringwald 1841711e6c80SMatthias 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){ 1842*5cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 1843*5cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 1844*5cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 18453deb3ec6SMatthias Ringwald 1846*5cf1669fSMatthias Ringwald gatt_client->callback = callback; 1847*5cf1669fSMatthias Ringwald gatt_client->start_group_handle = start_handle; 1848*5cf1669fSMatthias Ringwald gatt_client->end_group_handle = end_handle; 1849*5cf1669fSMatthias Ringwald gatt_client->query_start_handle = start_handle; 1850*5cf1669fSMatthias Ringwald gatt_client->query_end_handle = end_handle; 1851*5cf1669fSMatthias Ringwald gatt_client->uuid16 = 0; 1852*5cf1669fSMatthias Ringwald (void)memcpy(gatt_client->uuid128, uuid128, 16); 1853*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_BY_TYPE_REQUEST; 18543deb3ec6SMatthias Ringwald gatt_client_run(); 185525b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 18563deb3ec6SMatthias Ringwald } 18573deb3ec6SMatthias Ringwald 18583deb3ec6SMatthias Ringwald 1859d25c33e5SMatthias Ringwald uint8_t gatt_client_read_value_of_characteristic(btstack_packet_handler_t callback, uint16_t handle, gatt_client_characteristic_t *characteristic){ 18609c662c9bSMatthias Ringwald return gatt_client_read_value_of_characteristic_using_value_handle(callback, handle, characteristic->value_handle); 18613deb3ec6SMatthias Ringwald } 18623deb3ec6SMatthias Ringwald 1863711e6c80SMatthias 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){ 1864*5cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 1865*5cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 1866*5cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 18673deb3ec6SMatthias Ringwald 1868*5cf1669fSMatthias Ringwald gatt_client->callback = callback; 1869*5cf1669fSMatthias Ringwald gatt_client->attribute_handle = characteristic_value_handle; 1870*5cf1669fSMatthias Ringwald gatt_client->attribute_offset = offset; 1871*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_BLOB_QUERY; 18723deb3ec6SMatthias Ringwald gatt_client_run(); 187325b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 18743deb3ec6SMatthias Ringwald } 18753deb3ec6SMatthias Ringwald 1876711e6c80SMatthias 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){ 18779c662c9bSMatthias Ringwald return gatt_client_read_long_value_of_characteristic_using_value_handle_with_offset(callback, con_handle, characteristic_value_handle, 0); 18783deb3ec6SMatthias Ringwald } 18793deb3ec6SMatthias Ringwald 1880d25c33e5SMatthias Ringwald uint8_t gatt_client_read_long_value_of_characteristic(btstack_packet_handler_t callback, uint16_t handle, gatt_client_characteristic_t *characteristic){ 18819c662c9bSMatthias Ringwald return gatt_client_read_long_value_of_characteristic_using_value_handle(callback, handle, characteristic->value_handle); 18823deb3ec6SMatthias Ringwald } 18833deb3ec6SMatthias Ringwald 1884711e6c80SMatthias 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){ 1885*5cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 1886*5cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 1887*5cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 18883deb3ec6SMatthias Ringwald 1889*5cf1669fSMatthias Ringwald gatt_client->callback = callback; 1890*5cf1669fSMatthias Ringwald gatt_client->read_multiple_handle_count = num_value_handles; 1891*5cf1669fSMatthias Ringwald gatt_client->read_multiple_handles = value_handles; 1892*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_MULTIPLE_REQUEST; 18933deb3ec6SMatthias Ringwald gatt_client_run(); 189425b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 18953deb3ec6SMatthias Ringwald } 18963deb3ec6SMatthias Ringwald 1897de9f8e94SMatthias 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){ 1898*5cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle(con_handle); 1899*5cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 19003deb3ec6SMatthias Ringwald 1901*5cf1669fSMatthias Ringwald if (value_length > (gatt_client_mtu(gatt_client) - 3u)) return GATT_CLIENT_VALUE_TOO_LONG; 1902*5cf1669fSMatthias Ringwald if (!att_dispatch_client_can_send_now(gatt_client->con_handle)) return GATT_CLIENT_BUSY; 19033deb3ec6SMatthias Ringwald 1904*5cf1669fSMatthias Ringwald return att_write_request(ATT_WRITE_COMMAND, gatt_client->con_handle, value_handle, value_length, value); 19053deb3ec6SMatthias Ringwald } 19063deb3ec6SMatthias Ringwald 1907711e6c80SMatthias 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){ 1908*5cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 1909*5cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 1910*5cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 19113deb3ec6SMatthias Ringwald 1912*5cf1669fSMatthias Ringwald gatt_client->callback = callback; 1913*5cf1669fSMatthias Ringwald gatt_client->attribute_handle = value_handle; 1914*5cf1669fSMatthias Ringwald gatt_client->attribute_length = value_length; 1915*5cf1669fSMatthias Ringwald gatt_client->attribute_value = data; 1916*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_WRITE_CHARACTERISTIC_VALUE; 19173deb3ec6SMatthias Ringwald gatt_client_run(); 191825b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 19193deb3ec6SMatthias Ringwald } 19203deb3ec6SMatthias Ringwald 1921711e6c80SMatthias 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){ 1922*5cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 1923*5cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 1924*5cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 19253deb3ec6SMatthias Ringwald 1926*5cf1669fSMatthias Ringwald gatt_client->callback = callback; 1927*5cf1669fSMatthias Ringwald gatt_client->attribute_handle = value_handle; 1928*5cf1669fSMatthias Ringwald gatt_client->attribute_length = value_length; 1929*5cf1669fSMatthias Ringwald gatt_client->attribute_offset = offset; 1930*5cf1669fSMatthias Ringwald gatt_client->attribute_value = data; 1931*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_PREPARE_WRITE; 19323deb3ec6SMatthias Ringwald gatt_client_run(); 193325b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 19343deb3ec6SMatthias Ringwald } 19353deb3ec6SMatthias Ringwald 1936711e6c80SMatthias 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){ 19379c662c9bSMatthias Ringwald return gatt_client_write_long_value_of_characteristic_with_offset(callback, con_handle, value_handle, 0, value_length, value); 19383deb3ec6SMatthias Ringwald } 19393deb3ec6SMatthias Ringwald 1940711e6c80SMatthias 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){ 1941*5cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 1942*5cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 1943*5cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 19443deb3ec6SMatthias Ringwald 1945*5cf1669fSMatthias Ringwald gatt_client->callback = callback; 1946*5cf1669fSMatthias Ringwald gatt_client->attribute_handle = value_handle; 1947*5cf1669fSMatthias Ringwald gatt_client->attribute_length = value_length; 1948*5cf1669fSMatthias Ringwald gatt_client->attribute_offset = 0; 1949*5cf1669fSMatthias Ringwald gatt_client->attribute_value = value; 1950*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_PREPARE_RELIABLE_WRITE; 19513deb3ec6SMatthias Ringwald gatt_client_run(); 195225b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 19533deb3ec6SMatthias Ringwald } 19543deb3ec6SMatthias Ringwald 1955711e6c80SMatthias 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){ 1956*5cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 1957*5cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 1958*5cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 19593deb3ec6SMatthias Ringwald 19603deb3ec6SMatthias Ringwald if ( (configuration & GATT_CLIENT_CHARACTERISTICS_CONFIGURATION_NOTIFICATION) && 19614ea43905SMatthias Ringwald ((characteristic->properties & ATT_PROPERTY_NOTIFY) == 0u)) { 1962d8e8f12aSMatthias Ringwald log_info("gatt_client_write_client_characteristic_configuration: GATT_CLIENT_CHARACTERISTIC_NOTIFICATION_NOT_SUPPORTED"); 1963616edd56SMatthias Ringwald return GATT_CLIENT_CHARACTERISTIC_NOTIFICATION_NOT_SUPPORTED; 19643deb3ec6SMatthias Ringwald } else if ( (configuration & GATT_CLIENT_CHARACTERISTICS_CONFIGURATION_INDICATION) && 19654ea43905SMatthias Ringwald ((characteristic->properties & ATT_PROPERTY_INDICATE) == 0u)){ 1966d8e8f12aSMatthias Ringwald log_info("gatt_client_write_client_characteristic_configuration: GATT_CLIENT_CHARACTERISTIC_INDICATION_NOT_SUPPORTED"); 1967616edd56SMatthias Ringwald return GATT_CLIENT_CHARACTERISTIC_INDICATION_NOT_SUPPORTED; 19683deb3ec6SMatthias Ringwald } 19693deb3ec6SMatthias Ringwald 1970*5cf1669fSMatthias Ringwald gatt_client->callback = callback; 1971*5cf1669fSMatthias Ringwald gatt_client->start_group_handle = characteristic->value_handle; 1972*5cf1669fSMatthias Ringwald gatt_client->end_group_handle = characteristic->end_handle; 1973*5cf1669fSMatthias Ringwald little_endian_store_16(gatt_client->client_characteristic_configuration_value, 0, configuration); 19743deb3ec6SMatthias Ringwald 1975abdc9fb5SMatthias Ringwald #ifdef ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY 1976*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_FIND_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY; 1977abdc9fb5SMatthias Ringwald #else 1978*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY; 1979abdc9fb5SMatthias Ringwald #endif 19803deb3ec6SMatthias Ringwald gatt_client_run(); 19819cb80b17SMilanka Ringwald return ERROR_CODE_SUCCESS; 19823deb3ec6SMatthias Ringwald } 19833deb3ec6SMatthias Ringwald 1984711e6c80SMatthias 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){ 1985*5cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 1986*5cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 1987*5cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 19883deb3ec6SMatthias Ringwald 1989*5cf1669fSMatthias Ringwald gatt_client->callback = callback; 1990*5cf1669fSMatthias Ringwald gatt_client->attribute_handle = descriptor_handle; 19913deb3ec6SMatthias Ringwald 1992*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_CHARACTERISTIC_DESCRIPTOR_QUERY; 19933deb3ec6SMatthias Ringwald gatt_client_run(); 199425b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 19953deb3ec6SMatthias Ringwald } 19963deb3ec6SMatthias Ringwald 1997711e6c80SMatthias 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){ 19989c662c9bSMatthias Ringwald return gatt_client_read_characteristic_descriptor_using_descriptor_handle(callback, con_handle, descriptor->handle); 19993deb3ec6SMatthias Ringwald } 20003deb3ec6SMatthias Ringwald 2001711e6c80SMatthias 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){ 2002*5cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 2003*5cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 2004*5cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 20053deb3ec6SMatthias Ringwald 2006*5cf1669fSMatthias Ringwald gatt_client->callback = callback; 2007*5cf1669fSMatthias Ringwald gatt_client->attribute_handle = descriptor_handle; 2008*5cf1669fSMatthias Ringwald gatt_client->attribute_offset = offset; 2009*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_QUERY; 20103deb3ec6SMatthias Ringwald gatt_client_run(); 201125b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 20123deb3ec6SMatthias Ringwald } 20133deb3ec6SMatthias Ringwald 2014711e6c80SMatthias 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){ 20159c662c9bSMatthias Ringwald return gatt_client_read_long_characteristic_descriptor_using_descriptor_handle_with_offset(callback, con_handle, descriptor_handle, 0); 20163deb3ec6SMatthias Ringwald } 20173deb3ec6SMatthias Ringwald 2018711e6c80SMatthias 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){ 20199c662c9bSMatthias Ringwald return gatt_client_read_long_characteristic_descriptor_using_descriptor_handle(callback, con_handle, descriptor->handle); 20203deb3ec6SMatthias Ringwald } 20213deb3ec6SMatthias Ringwald 2022711e6c80SMatthias 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){ 2023*5cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 2024*5cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 2025*5cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 20263deb3ec6SMatthias Ringwald 2027*5cf1669fSMatthias Ringwald gatt_client->callback = callback; 2028*5cf1669fSMatthias Ringwald gatt_client->attribute_handle = descriptor_handle; 2029*5cf1669fSMatthias Ringwald gatt_client->attribute_length = length; 2030*5cf1669fSMatthias Ringwald gatt_client->attribute_offset = 0; 2031*5cf1669fSMatthias Ringwald gatt_client->attribute_value = data; 2032*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_SEND_WRITE_CHARACTERISTIC_DESCRIPTOR; 20333deb3ec6SMatthias Ringwald gatt_client_run(); 203425b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 20353deb3ec6SMatthias Ringwald } 20363deb3ec6SMatthias Ringwald 2037711e6c80SMatthias 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){ 20389c662c9bSMatthias Ringwald return gatt_client_write_characteristic_descriptor_using_descriptor_handle(callback, con_handle, descriptor->handle, length, value); 20393deb3ec6SMatthias Ringwald } 20403deb3ec6SMatthias Ringwald 2041711e6c80SMatthias 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){ 2042*5cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 2043*5cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 2044*5cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 20453deb3ec6SMatthias Ringwald 2046*5cf1669fSMatthias Ringwald gatt_client->callback = callback; 2047*5cf1669fSMatthias Ringwald gatt_client->attribute_handle = descriptor_handle; 2048*5cf1669fSMatthias Ringwald gatt_client->attribute_length = length; 2049*5cf1669fSMatthias Ringwald gatt_client->attribute_offset = offset; 2050*5cf1669fSMatthias Ringwald gatt_client->attribute_value = data; 2051*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR; 20523deb3ec6SMatthias Ringwald gatt_client_run(); 205325b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 20543deb3ec6SMatthias Ringwald } 20553deb3ec6SMatthias Ringwald 2056711e6c80SMatthias 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){ 20579c662c9bSMatthias Ringwald return gatt_client_write_long_characteristic_descriptor_using_descriptor_handle_with_offset(callback, con_handle, descriptor_handle, 0, length, data ); 20583deb3ec6SMatthias Ringwald } 20593deb3ec6SMatthias Ringwald 2060711e6c80SMatthias 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){ 20619c662c9bSMatthias Ringwald return gatt_client_write_long_characteristic_descriptor_using_descriptor_handle(callback, con_handle, descriptor->handle, length, value); 20623deb3ec6SMatthias Ringwald } 20633deb3ec6SMatthias Ringwald 20643deb3ec6SMatthias Ringwald /** 20653deb3ec6SMatthias Ringwald * @brief -> gatt complete event 20663deb3ec6SMatthias Ringwald */ 2067711e6c80SMatthias 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){ 2068*5cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 2069*5cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 2070*5cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 20713deb3ec6SMatthias Ringwald 2072*5cf1669fSMatthias Ringwald gatt_client->callback = callback; 2073*5cf1669fSMatthias Ringwald gatt_client->attribute_handle = attribute_handle; 2074*5cf1669fSMatthias Ringwald gatt_client->attribute_length = length; 2075*5cf1669fSMatthias Ringwald gatt_client->attribute_offset = offset; 2076*5cf1669fSMatthias Ringwald gatt_client->attribute_value = data; 2077*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_PREPARE_WRITE_SINGLE; 20783deb3ec6SMatthias Ringwald gatt_client_run(); 207925b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 20803deb3ec6SMatthias Ringwald } 20813deb3ec6SMatthias Ringwald 20823deb3ec6SMatthias Ringwald /** 20833deb3ec6SMatthias Ringwald * @brief -> gatt complete event 20843deb3ec6SMatthias Ringwald */ 2085711e6c80SMatthias Ringwald uint8_t gatt_client_execute_write(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 2086*5cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 20873deb3ec6SMatthias Ringwald 2088*5cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 2089*5cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 20903deb3ec6SMatthias Ringwald 2091*5cf1669fSMatthias Ringwald gatt_client->callback = callback; 2092*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_EXECUTE_PREPARED_WRITE; 20933deb3ec6SMatthias Ringwald gatt_client_run(); 209425b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 20953deb3ec6SMatthias Ringwald } 20963deb3ec6SMatthias Ringwald 20973deb3ec6SMatthias Ringwald /** 20983deb3ec6SMatthias Ringwald * @brief -> gatt complete event 20993deb3ec6SMatthias Ringwald */ 2100711e6c80SMatthias Ringwald uint8_t gatt_client_cancel_write(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 2101*5cf1669fSMatthias Ringwald gatt_client_t * gatt_client = gatt_client_provide_context_for_handle_and_start_timer(con_handle); 2102*5cf1669fSMatthias Ringwald if (gatt_client == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 2103*5cf1669fSMatthias Ringwald if (is_ready(gatt_client) == 0) return GATT_CLIENT_IN_WRONG_STATE; 21043deb3ec6SMatthias Ringwald 2105*5cf1669fSMatthias Ringwald gatt_client->callback = callback; 2106*5cf1669fSMatthias Ringwald gatt_client->gatt_client_state = P_W2_CANCEL_PREPARED_WRITE; 21073deb3ec6SMatthias Ringwald gatt_client_run(); 21087d2258b3SMilanka Ringwald return ERROR_CODE_SUCCESS; 21093deb3ec6SMatthias Ringwald } 21103deb3ec6SMatthias Ringwald 2111313e337bSMatthias Ringwald void gatt_client_deserialize_service(const uint8_t *packet, int offset, gatt_client_service_t *service){ 21126ba2ad22SMatthias Ringwald service->start_group_handle = little_endian_read_16(packet, offset); 21136ba2ad22SMatthias Ringwald service->end_group_handle = little_endian_read_16(packet, offset + 2); 21146ba2ad22SMatthias Ringwald reverse_128(&packet[offset + 4], service->uuid128); 21156ba2ad22SMatthias Ringwald if (uuid_has_bluetooth_prefix(service->uuid128)){ 21166ba2ad22SMatthias Ringwald service->uuid16 = big_endian_read_32(service->uuid128, 0); 2117c839c6f9SMatthias Ringwald } else { 2118c839c6f9SMatthias Ringwald service->uuid16 = 0; 21196ba2ad22SMatthias Ringwald } 21206ba2ad22SMatthias Ringwald } 21216ba2ad22SMatthias Ringwald 2122313e337bSMatthias Ringwald void gatt_client_deserialize_characteristic(const uint8_t * packet, int offset, gatt_client_characteristic_t * characteristic){ 21236ba2ad22SMatthias Ringwald characteristic->start_handle = little_endian_read_16(packet, offset); 21246ba2ad22SMatthias Ringwald characteristic->value_handle = little_endian_read_16(packet, offset + 2); 21256ba2ad22SMatthias Ringwald characteristic->end_handle = little_endian_read_16(packet, offset + 4); 21266ba2ad22SMatthias Ringwald characteristic->properties = little_endian_read_16(packet, offset + 6); 212786c38559SMatthias Ringwald reverse_128(&packet[offset+8], characteristic->uuid128); 21286ba2ad22SMatthias Ringwald if (uuid_has_bluetooth_prefix(characteristic->uuid128)){ 21296ba2ad22SMatthias Ringwald characteristic->uuid16 = big_endian_read_32(characteristic->uuid128, 0); 2130c839c6f9SMatthias Ringwald } else { 2131c839c6f9SMatthias Ringwald characteristic->uuid16 = 0; 21326ba2ad22SMatthias Ringwald } 21336ba2ad22SMatthias Ringwald } 21346ba2ad22SMatthias Ringwald 2135313e337bSMatthias Ringwald void gatt_client_deserialize_characteristic_descriptor(const uint8_t * packet, int offset, gatt_client_characteristic_descriptor_t * descriptor){ 21366ba2ad22SMatthias Ringwald descriptor->handle = little_endian_read_16(packet, offset); 21376ba2ad22SMatthias Ringwald reverse_128(&packet[offset+2], descriptor->uuid128); 2138b4895529SJakob Krantz if (uuid_has_bluetooth_prefix(descriptor->uuid128)){ 2139b4895529SJakob Krantz descriptor->uuid16 = big_endian_read_32(descriptor->uuid128, 0); 2140c839c6f9SMatthias Ringwald } else { 2141c839c6f9SMatthias Ringwald descriptor->uuid16 = 0; 2142b4895529SJakob Krantz } 21436ba2ad22SMatthias Ringwald } 21445cf6c434SJakob Krantz 21455cf6c434SJakob Krantz void gatt_client_send_mtu_negotiation(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 2146*5cf1669fSMatthias Ringwald gatt_client_t * context = gatt_client_provide_context_for_handle(con_handle); 21477d2258b3SMilanka Ringwald if (context == NULL) return; 21485cf6c434SJakob Krantz if (context->mtu_state == MTU_AUTO_EXCHANGE_DISABLED){ 21495cf6c434SJakob Krantz context->callback = callback; 21505cf6c434SJakob Krantz context->mtu_state = SEND_MTU_EXCHANGE; 21515cf6c434SJakob Krantz gatt_client_run(); 21525cf6c434SJakob Krantz } 21535cf6c434SJakob Krantz } 215447181045SMatthias Ringwald 215547181045SMatthias Ringwald uint8_t gatt_client_request_can_write_without_response_event(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 2156*5cf1669fSMatthias Ringwald gatt_client_t * context = gatt_client_provide_context_for_handle(con_handle); 21577d2258b3SMilanka Ringwald if (context == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 21587d2258b3SMilanka Ringwald if (context->write_without_response_callback != NULL) return GATT_CLIENT_IN_WRONG_STATE; 215947181045SMatthias Ringwald context->write_without_response_callback = callback; 216047181045SMatthias Ringwald att_dispatch_client_request_can_send_now_event(context->con_handle); 21617d2258b3SMilanka Ringwald return ERROR_CODE_SUCCESS; 216247181045SMatthias Ringwald } 2163a6121b51SMilanka Ringwald 2164a6121b51SMilanka Ringwald #ifdef FUZZING_BUILD_MODE_UNSAFE_FOR_PRODUCTION 2165a6121b51SMilanka Ringwald void gatt_client_att_packet_handler_fuzz(uint8_t packet_type, uint16_t handle, uint8_t *packet, uint16_t size){ 2166a6121b51SMilanka Ringwald gatt_client_att_packet_handler(packet_type, handle, packet, size); 2167a6121b51SMilanka Ringwald } 2168a6121b51SMilanka Ringwald #endif 2169