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); 757d2258b3SMilanka Ringwald static void gatt_client_report_error_if_pending(gatt_client_t *peripheral, uint8_t att_error_code); 767a766ebfSMatthias Ringwald 777a766ebfSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 783deb3ec6SMatthias Ringwald static void att_signed_write_handle_cmac_result(uint8_t hash[8]); 797a766ebfSMatthias Ringwald #endif 803deb3ec6SMatthias Ringwald 813deb3ec6SMatthias Ringwald static uint16_t peripheral_mtu(gatt_client_t *peripheral){ 823deb3ec6SMatthias Ringwald if (peripheral->mtu > l2cap_max_le_mtu()){ 833deb3ec6SMatthias Ringwald log_error("Peripheral mtu is not initialized"); 843deb3ec6SMatthias Ringwald return l2cap_max_le_mtu(); 853deb3ec6SMatthias Ringwald } 863deb3ec6SMatthias Ringwald return peripheral->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)){ 111665d90f2SMatthias Ringwald gatt_client_t * peripheral = (gatt_client_t *) btstack_linked_list_iterator_next(&it); 1123deb3ec6SMatthias Ringwald if ( &peripheral->gc_timeout == ts) { 1133deb3ec6SMatthias Ringwald return peripheral; 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){ 1203deb3ec6SMatthias Ringwald gatt_client_t * peripheral = gatt_client_for_timer(timer); 1217d2258b3SMilanka Ringwald if (peripheral == NULL) return; 122fc64f94aSMatthias Ringwald log_info("GATT client timeout handle, handle 0x%02x", peripheral->con_handle); 1233deb3ec6SMatthias Ringwald gatt_client_report_error_if_pending(peripheral, ATT_ERROR_TIMEOUT); 1243deb3ec6SMatthias Ringwald } 1253deb3ec6SMatthias Ringwald 1263deb3ec6SMatthias Ringwald static void gatt_client_timeout_start(gatt_client_t * peripheral){ 127fc64f94aSMatthias Ringwald log_info("GATT client timeout start, handle 0x%02x", peripheral->con_handle); 128528a4a3bSMatthias Ringwald btstack_run_loop_remove_timer(&peripheral->gc_timeout); 129528a4a3bSMatthias Ringwald btstack_run_loop_set_timer_handler(&peripheral->gc_timeout, gatt_client_timeout_handler); 130528a4a3bSMatthias Ringwald btstack_run_loop_set_timer(&peripheral->gc_timeout, 30000); // 30 seconds sm timeout 131528a4a3bSMatthias Ringwald btstack_run_loop_add_timer(&peripheral->gc_timeout); 1323deb3ec6SMatthias Ringwald } 1333deb3ec6SMatthias Ringwald 1343deb3ec6SMatthias Ringwald static void gatt_client_timeout_stop(gatt_client_t * peripheral){ 135fc64f94aSMatthias Ringwald log_info("GATT client timeout stop, handle 0x%02x", peripheral->con_handle); 136528a4a3bSMatthias Ringwald btstack_run_loop_remove_timer(&peripheral->gc_timeout); 1373deb3ec6SMatthias Ringwald } 1383deb3ec6SMatthias Ringwald 1393deb3ec6SMatthias Ringwald static gatt_client_t * get_gatt_client_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){ 1423deb3ec6SMatthias Ringwald gatt_client_t * peripheral = (gatt_client_t *) it; 143fc64f94aSMatthias Ringwald if (peripheral->con_handle == handle){ 1443deb3ec6SMatthias Ringwald return peripheral; 1453deb3ec6SMatthias Ringwald } 1463deb3ec6SMatthias Ringwald } 1473deb3ec6SMatthias Ringwald return NULL; 1483deb3ec6SMatthias Ringwald } 1493deb3ec6SMatthias Ringwald 1503deb3ec6SMatthias Ringwald 1513deb3ec6SMatthias Ringwald // @returns context 1523deb3ec6SMatthias Ringwald // returns existing one, or tries to setup new one 153711e6c80SMatthias Ringwald static gatt_client_t * provide_context_for_conn_handle(hci_con_handle_t con_handle){ 1543deb3ec6SMatthias Ringwald gatt_client_t * context = get_gatt_client_context_for_handle(con_handle); 1553deb3ec6SMatthias Ringwald if (context) return context; 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 } 1623deb3ec6SMatthias Ringwald context = btstack_memory_gatt_client_get(); 1633deb3ec6SMatthias Ringwald if (!context) return NULL; 1643deb3ec6SMatthias Ringwald // init state 165fc64f94aSMatthias Ringwald context->con_handle = con_handle; 1663deb3ec6SMatthias Ringwald context->mtu = ATT_DEFAULT_MTU; 1675cf6c434SJakob Krantz if (mtu_exchange_enabled){ 1683deb3ec6SMatthias Ringwald context->mtu_state = SEND_MTU_EXCHANGE; 1695cf6c434SJakob Krantz } else { 1705cf6c434SJakob Krantz context->mtu_state = MTU_AUTO_EXCHANGE_DISABLED; 1715cf6c434SJakob Krantz } 1723deb3ec6SMatthias Ringwald context->gatt_client_state = P_READY; 173665d90f2SMatthias Ringwald btstack_linked_list_add(&gatt_client_connections, (btstack_linked_item_t*)context); 1743deb3ec6SMatthias Ringwald return context; 1753deb3ec6SMatthias Ringwald } 1763deb3ec6SMatthias Ringwald 177711e6c80SMatthias Ringwald static gatt_client_t * provide_context_for_conn_handle_and_start_timer(hci_con_handle_t con_handle){ 1783deb3ec6SMatthias Ringwald gatt_client_t * context = provide_context_for_conn_handle(con_handle); 1797d2258b3SMilanka Ringwald if (context == NULL) return NULL; 1803deb3ec6SMatthias Ringwald gatt_client_timeout_start(context); 1813deb3ec6SMatthias Ringwald return context; 1823deb3ec6SMatthias Ringwald } 1833deb3ec6SMatthias Ringwald 1843deb3ec6SMatthias Ringwald static int is_ready(gatt_client_t * context){ 1853deb3ec6SMatthias Ringwald return context->gatt_client_state == P_READY; 1863deb3ec6SMatthias Ringwald } 1873deb3ec6SMatthias Ringwald 188fc64f94aSMatthias Ringwald int gatt_client_is_ready(hci_con_handle_t con_handle){ 189fc64f94aSMatthias Ringwald gatt_client_t * context = provide_context_for_conn_handle(con_handle); 1907d2258b3SMilanka Ringwald if (context == NULL) return 0; 1913deb3ec6SMatthias Ringwald return is_ready(context); 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){ 199fc64f94aSMatthias Ringwald gatt_client_t * context = provide_context_for_conn_handle(con_handle); 2007d2258b3SMilanka Ringwald if (context == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 2017d2258b3SMilanka Ringwald 2020e588213SMatthias Ringwald if ((context->mtu_state == MTU_EXCHANGED) || (context->mtu_state == MTU_AUTO_EXCHANGE_DISABLED)){ 2033deb3ec6SMatthias Ringwald *mtu = context->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 21125b7c058SMilanka Ringwald static uint8_t att_confirmation(uint16_t peripheral_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 21625b7c058SMilanka Ringwald return l2cap_send_prepared_connectionless(peripheral_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL, 1); 2173deb3ec6SMatthias Ringwald } 2183deb3ec6SMatthias Ringwald 2193deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 22025b7c058SMilanka Ringwald static uint8_t att_find_information_request(uint16_t request_type, uint16_t peripheral_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 22725b7c058SMilanka Ringwald return l2cap_send_prepared_connectionless(peripheral_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL, 5); 2283deb3ec6SMatthias Ringwald } 2293deb3ec6SMatthias Ringwald 2303deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 23125b7c058SMilanka Ringwald static uint8_t att_find_by_type_value_request(uint16_t request_type, uint16_t attribute_group_type, uint16_t peripheral_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 24125b7c058SMilanka Ringwald return l2cap_send_prepared_connectionless(peripheral_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL, 7+value_size); 2423deb3ec6SMatthias Ringwald } 2433deb3ec6SMatthias Ringwald 2443deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 24525b7c058SMilanka Ringwald static uint8_t att_read_by_type_or_group_request_for_uuid16(uint16_t request_type, uint16_t uuid16, uint16_t peripheral_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 25325b7c058SMilanka Ringwald return l2cap_send_prepared_connectionless(peripheral_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL, 7); 2543deb3ec6SMatthias Ringwald } 2553deb3ec6SMatthias Ringwald 2563deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 25725b7c058SMilanka Ringwald static uint8_t att_read_by_type_or_group_request_for_uuid128(uint16_t request_type, uint8_t * uuid128, uint16_t peripheral_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 26525b7c058SMilanka Ringwald return l2cap_send_prepared_connectionless(peripheral_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL, 21); 2663deb3ec6SMatthias Ringwald } 2673deb3ec6SMatthias Ringwald 2683deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 26925b7c058SMilanka Ringwald static uint8_t att_read_request(uint16_t request_type, uint16_t peripheral_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 27525b7c058SMilanka Ringwald return l2cap_send_prepared_connectionless(peripheral_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL, 3); 2763deb3ec6SMatthias Ringwald } 2773deb3ec6SMatthias Ringwald 2783deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 27925b7c058SMilanka Ringwald static uint8_t att_read_blob_request(uint16_t request_type, uint16_t peripheral_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 28625b7c058SMilanka Ringwald return l2cap_send_prepared_connectionless(peripheral_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL, 5); 2873deb3ec6SMatthias Ringwald } 2883deb3ec6SMatthias Ringwald 28925b7c058SMilanka Ringwald static uint8_t att_read_multiple_request(uint16_t peripheral_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 30025b7c058SMilanka Ringwald return l2cap_send_prepared_connectionless(peripheral_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 30525b7c058SMilanka Ringwald static uint8_t att_signed_write_request(uint16_t request_type, uint16_t peripheral_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 31425b7c058SMilanka Ringwald return l2cap_send_prepared_connectionless(peripheral_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL, 3 + value_length + 12); 3153deb3ec6SMatthias Ringwald } 3167a766ebfSMatthias Ringwald #endif 3173deb3ec6SMatthias Ringwald 3183deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 31925b7c058SMilanka Ringwald static uint8_t att_write_request(uint16_t request_type, uint16_t peripheral_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 32625b7c058SMilanka Ringwald return l2cap_send_prepared_connectionless(peripheral_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL, 3 + value_length); 3273deb3ec6SMatthias Ringwald } 3283deb3ec6SMatthias Ringwald 3293deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 33025b7c058SMilanka Ringwald static uint8_t att_execute_write_request(uint16_t request_type, uint16_t peripheral_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 33625b7c058SMilanka Ringwald return l2cap_send_prepared_connectionless(peripheral_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL, 2); 3373deb3ec6SMatthias Ringwald } 3383deb3ec6SMatthias Ringwald 3393deb3ec6SMatthias Ringwald // precondition: can_send_packet_now == TRUE 34025b7c058SMilanka Ringwald static uint8_t att_prepare_write_request(uint16_t request_type, uint16_t peripheral_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 34825b7c058SMilanka Ringwald return l2cap_send_prepared_connectionless(peripheral_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL, 5+blob_length); 3493deb3ec6SMatthias Ringwald } 3503deb3ec6SMatthias Ringwald 35125b7c058SMilanka Ringwald static uint8_t att_exchange_mtu_request(uint16_t peripheral_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 35825b7c058SMilanka Ringwald return l2cap_send_prepared_connectionless(peripheral_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL, 3); 3593deb3ec6SMatthias Ringwald } 3603deb3ec6SMatthias Ringwald 3613deb3ec6SMatthias Ringwald static uint16_t write_blob_length(gatt_client_t * peripheral){ 3623deb3ec6SMatthias Ringwald uint16_t max_blob_length = peripheral_mtu(peripheral) - 5; 3633deb3ec6SMatthias Ringwald if (peripheral->attribute_offset >= peripheral->attribute_length) { 3643deb3ec6SMatthias Ringwald return 0; 3653deb3ec6SMatthias Ringwald } 3663deb3ec6SMatthias Ringwald uint16_t rest_length = peripheral->attribute_length - peripheral->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 3733deb3ec6SMatthias Ringwald static void send_gatt_services_request(gatt_client_t *peripheral){ 374fc64f94aSMatthias Ringwald att_read_by_type_or_group_request_for_uuid16(ATT_READ_BY_GROUP_TYPE_REQUEST, GATT_PRIMARY_SERVICE_UUID, peripheral->con_handle, peripheral->start_group_handle, peripheral->end_group_handle); 3753deb3ec6SMatthias Ringwald } 3763deb3ec6SMatthias Ringwald 3773deb3ec6SMatthias Ringwald static void send_gatt_by_uuid_request(gatt_client_t *peripheral, uint16_t attribute_group_type){ 3783deb3ec6SMatthias Ringwald if (peripheral->uuid16){ 3793deb3ec6SMatthias Ringwald uint8_t uuid16[2]; 380f8fbdce0SMatthias Ringwald little_endian_store_16(uuid16, 0, peripheral->uuid16); 381fc64f94aSMatthias Ringwald att_find_by_type_value_request(ATT_FIND_BY_TYPE_VALUE_REQUEST, attribute_group_type, peripheral->con_handle, peripheral->start_group_handle, peripheral->end_group_handle, uuid16, 2); 3823deb3ec6SMatthias Ringwald return; 3833deb3ec6SMatthias Ringwald } 3843deb3ec6SMatthias Ringwald uint8_t uuid128[16]; 3859c80e4ccSMatthias Ringwald reverse_128(peripheral->uuid128, uuid128); 386fc64f94aSMatthias Ringwald att_find_by_type_value_request(ATT_FIND_BY_TYPE_VALUE_REQUEST, attribute_group_type, peripheral->con_handle, peripheral->start_group_handle, peripheral->end_group_handle, uuid128, 16); 3873deb3ec6SMatthias Ringwald } 3883deb3ec6SMatthias Ringwald 3893deb3ec6SMatthias Ringwald static void send_gatt_services_by_uuid_request(gatt_client_t *peripheral){ 3903deb3ec6SMatthias Ringwald send_gatt_by_uuid_request(peripheral, GATT_PRIMARY_SERVICE_UUID); 3913deb3ec6SMatthias Ringwald } 3923deb3ec6SMatthias Ringwald 3933deb3ec6SMatthias Ringwald static void send_gatt_included_service_uuid_request(gatt_client_t *peripheral){ 394fc64f94aSMatthias Ringwald att_read_request(ATT_READ_REQUEST, peripheral->con_handle, peripheral->query_start_handle); 3953deb3ec6SMatthias Ringwald } 3963deb3ec6SMatthias Ringwald 3973deb3ec6SMatthias Ringwald static void send_gatt_included_service_request(gatt_client_t *peripheral){ 398fc64f94aSMatthias Ringwald att_read_by_type_or_group_request_for_uuid16(ATT_READ_BY_TYPE_REQUEST, GATT_INCLUDE_SERVICE_UUID, peripheral->con_handle, peripheral->start_group_handle, peripheral->end_group_handle); 3993deb3ec6SMatthias Ringwald } 4003deb3ec6SMatthias Ringwald 4013deb3ec6SMatthias Ringwald static void send_gatt_characteristic_request(gatt_client_t *peripheral){ 402fc64f94aSMatthias Ringwald att_read_by_type_or_group_request_for_uuid16(ATT_READ_BY_TYPE_REQUEST, GATT_CHARACTERISTICS_UUID, peripheral->con_handle, peripheral->start_group_handle, peripheral->end_group_handle); 4033deb3ec6SMatthias Ringwald } 4043deb3ec6SMatthias Ringwald 4053deb3ec6SMatthias Ringwald static void send_gatt_characteristic_descriptor_request(gatt_client_t *peripheral){ 406fc64f94aSMatthias Ringwald att_find_information_request(ATT_FIND_INFORMATION_REQUEST, peripheral->con_handle, peripheral->start_group_handle, peripheral->end_group_handle); 4073deb3ec6SMatthias Ringwald } 4083deb3ec6SMatthias Ringwald 4093deb3ec6SMatthias Ringwald static void send_gatt_read_characteristic_value_request(gatt_client_t *peripheral){ 410fc64f94aSMatthias Ringwald att_read_request(ATT_READ_REQUEST, peripheral->con_handle, peripheral->attribute_handle); 4113deb3ec6SMatthias Ringwald } 4123deb3ec6SMatthias Ringwald 4133deb3ec6SMatthias Ringwald static void send_gatt_read_by_type_request(gatt_client_t * peripheral){ 4143deb3ec6SMatthias Ringwald if (peripheral->uuid16){ 415fc64f94aSMatthias Ringwald att_read_by_type_or_group_request_for_uuid16(ATT_READ_BY_TYPE_REQUEST, peripheral->uuid16, peripheral->con_handle, peripheral->start_group_handle, peripheral->end_group_handle); 4163deb3ec6SMatthias Ringwald } else { 417fc64f94aSMatthias Ringwald att_read_by_type_or_group_request_for_uuid128(ATT_READ_BY_TYPE_REQUEST, peripheral->uuid128, peripheral->con_handle, peripheral->start_group_handle, peripheral->end_group_handle); 4183deb3ec6SMatthias Ringwald } 4193deb3ec6SMatthias Ringwald } 4203deb3ec6SMatthias Ringwald 4213deb3ec6SMatthias Ringwald static void send_gatt_read_blob_request(gatt_client_t *peripheral){ 422fc64f94aSMatthias Ringwald att_read_blob_request(ATT_READ_BLOB_REQUEST, peripheral->con_handle, peripheral->attribute_handle, peripheral->attribute_offset); 4233deb3ec6SMatthias Ringwald } 4243deb3ec6SMatthias Ringwald 4253deb3ec6SMatthias Ringwald static void send_gatt_read_multiple_request(gatt_client_t * peripheral){ 426fc64f94aSMatthias Ringwald att_read_multiple_request(peripheral->con_handle, peripheral->read_multiple_handle_count, peripheral->read_multiple_handles); 4273deb3ec6SMatthias Ringwald } 4283deb3ec6SMatthias Ringwald 4293deb3ec6SMatthias Ringwald static void send_gatt_write_attribute_value_request(gatt_client_t * peripheral){ 430fc64f94aSMatthias Ringwald att_write_request(ATT_WRITE_REQUEST, peripheral->con_handle, peripheral->attribute_handle, peripheral->attribute_length, peripheral->attribute_value); 4313deb3ec6SMatthias Ringwald } 4323deb3ec6SMatthias Ringwald 4333deb3ec6SMatthias Ringwald static void send_gatt_write_client_characteristic_configuration_request(gatt_client_t * peripheral){ 434fc64f94aSMatthias Ringwald att_write_request(ATT_WRITE_REQUEST, peripheral->con_handle, peripheral->client_characteristic_configuration_handle, 2, peripheral->client_characteristic_configuration_value); 4353deb3ec6SMatthias Ringwald } 4363deb3ec6SMatthias Ringwald 4373deb3ec6SMatthias Ringwald static void send_gatt_prepare_write_request(gatt_client_t * peripheral){ 438fc64f94aSMatthias Ringwald att_prepare_write_request(ATT_PREPARE_WRITE_REQUEST, peripheral->con_handle, peripheral->attribute_handle, peripheral->attribute_offset, write_blob_length(peripheral), peripheral->attribute_value); 4393deb3ec6SMatthias Ringwald } 4403deb3ec6SMatthias Ringwald 4413deb3ec6SMatthias Ringwald static void send_gatt_execute_write_request(gatt_client_t * peripheral){ 442fc64f94aSMatthias Ringwald att_execute_write_request(ATT_EXECUTE_WRITE_REQUEST, peripheral->con_handle, 1); 4433deb3ec6SMatthias Ringwald } 4443deb3ec6SMatthias Ringwald 4453deb3ec6SMatthias Ringwald static void send_gatt_cancel_prepared_write_request(gatt_client_t * peripheral){ 446fc64f94aSMatthias Ringwald att_execute_write_request(ATT_EXECUTE_WRITE_REQUEST, peripheral->con_handle, 0); 4473deb3ec6SMatthias Ringwald } 4483deb3ec6SMatthias Ringwald 449abdc9fb5SMatthias Ringwald #ifndef ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY 4503deb3ec6SMatthias Ringwald static void send_gatt_read_client_characteristic_configuration_request(gatt_client_t * peripheral){ 451fc64f94aSMatthias Ringwald att_read_by_type_or_group_request_for_uuid16(ATT_READ_BY_TYPE_REQUEST, GATT_CLIENT_CHARACTERISTICS_CONFIGURATION, peripheral->con_handle, peripheral->start_group_handle, peripheral->end_group_handle); 4523deb3ec6SMatthias Ringwald } 453abdc9fb5SMatthias Ringwald #endif 4543deb3ec6SMatthias Ringwald 4553deb3ec6SMatthias Ringwald static void send_gatt_read_characteristic_descriptor_request(gatt_client_t * peripheral){ 456fc64f94aSMatthias Ringwald att_read_request(ATT_READ_REQUEST, peripheral->con_handle, peripheral->attribute_handle); 4573deb3ec6SMatthias Ringwald } 4583deb3ec6SMatthias Ringwald 4597a766ebfSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 4603deb3ec6SMatthias Ringwald static void send_gatt_signed_write_request(gatt_client_t * peripheral, uint32_t sign_counter){ 461fc64f94aSMatthias Ringwald att_signed_write_request(ATT_SIGNED_WRITE_COMMAND, peripheral->con_handle, peripheral->attribute_handle, peripheral->attribute_length, peripheral->attribute_value, sign_counter, peripheral->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]; 467f8fbdce0SMatthias Ringwald return little_endian_read_16(packet, size - attr_length + 2); 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]; 472f8fbdce0SMatthias Ringwald return little_endian_read_16(packet, size - attr_length + 3); 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 4803deb3ec6SMatthias Ringwald static void gatt_client_handle_transaction_complete(gatt_client_t * peripheral){ 4813deb3ec6SMatthias Ringwald peripheral->gatt_client_state = P_READY; 4823deb3ec6SMatthias Ringwald gatt_client_timeout_stop(peripheral); 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; 494*b3f03c84SMatthias Ringwald if (characteristic == NULL){ 495*b3f03c84SMatthias Ringwald notification->attribute_handle = GATT_CLIENT_ANY_VALUE_HANDLE; 496*b3f03c84SMatthias Ringwald } else { 4979c662c9bSMatthias Ringwald notification->attribute_handle = characteristic->value_handle; 498*b3f03c84SMatthias 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); 511*b3f03c84SMatthias Ringwald if ((notification->con_handle != GATT_CLIENT_ANY_CONNECTION) && (notification->con_handle != con_handle)) continue; 512*b3f03c84SMatthias 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 5177d2258b3SMilanka Ringwald static void emit_gatt_complete_event(gatt_client_t * peripheral, 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; 522fc64f94aSMatthias Ringwald little_endian_store_16(packet, 2, peripheral->con_handle); 5237d2258b3SMilanka Ringwald packet[4] = att_status; 5249c662c9bSMatthias Ringwald emit_event_new(peripheral->callback, packet, sizeof(packet)); 5253deb3ec6SMatthias Ringwald } 5263deb3ec6SMatthias Ringwald 5273deb3ec6SMatthias Ringwald static void emit_gatt_service_query_result_event(gatt_client_t * peripheral, 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; 5313deb3ec6SMatthias Ringwald packet[1] = sizeof(packet) - 2; 532fc64f94aSMatthias Ringwald little_endian_store_16(packet, 2, peripheral->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]); 5379c662c9bSMatthias Ringwald emit_event_new(peripheral->callback, packet, sizeof(packet)); 5383deb3ec6SMatthias Ringwald } 5393deb3ec6SMatthias Ringwald 5403deb3ec6SMatthias Ringwald static void emit_gatt_included_service_query_result_event(gatt_client_t * peripheral, 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; 5443deb3ec6SMatthias Ringwald packet[1] = sizeof(packet) - 2; 545fc64f94aSMatthias Ringwald little_endian_store_16(packet, 2, peripheral->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]); 5529c662c9bSMatthias Ringwald emit_event_new(peripheral->callback, packet, sizeof(packet)); 5533deb3ec6SMatthias Ringwald } 5543deb3ec6SMatthias Ringwald 5553deb3ec6SMatthias Ringwald static void emit_gatt_characteristic_query_result_event(gatt_client_t * peripheral, 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; 5603deb3ec6SMatthias Ringwald packet[1] = sizeof(packet) - 2; 561fc64f94aSMatthias Ringwald little_endian_store_16(packet, 2, peripheral->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]); 5689c662c9bSMatthias Ringwald emit_event_new(peripheral->callback, packet, sizeof(packet)); 5693deb3ec6SMatthias Ringwald } 5703deb3ec6SMatthias Ringwald 5713deb3ec6SMatthias Ringwald static void emit_gatt_all_characteristic_descriptors_result_event( 5723deb3ec6SMatthias Ringwald gatt_client_t * peripheral, 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; 5763deb3ec6SMatthias Ringwald packet[1] = sizeof(packet) - 2; 577fc64f94aSMatthias Ringwald little_endian_store_16(packet, 2, peripheral->con_handle); 5783deb3ec6SMatthias Ringwald /// 579f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 4, descriptor_handle); 5809c80e4ccSMatthias Ringwald reverse_128(uuid128, &packet[6]); 5819c662c9bSMatthias Ringwald emit_event_new(peripheral->callback, packet, sizeof(packet)); 5823deb3ec6SMatthias Ringwald } 5833deb3ec6SMatthias Ringwald 5848f37572aSJakob Krantz static void emit_gatt_mtu_exchanged_result_event(gatt_client_t * peripheral, uint16_t new_mtu){ 5858f37572aSJakob Krantz // @format H2 5868f37572aSJakob Krantz uint8_t packet[6]; 5878f37572aSJakob Krantz packet[0] = GATT_EVENT_MTU; 5888f37572aSJakob Krantz packet[1] = sizeof(packet) - 2; 5898f37572aSJakob Krantz little_endian_store_16(packet, 2, peripheral->con_handle); 5908f37572aSJakob Krantz little_endian_store_16(packet, 4, new_mtu); 591b12646c5SJakob Krantz att_dispatch_client_mtu_exchanged(peripheral->con_handle, new_mtu); 5928f37572aSJakob Krantz emit_event_new(peripheral->callback, packet, sizeof(packet)); 5938f37572aSJakob Krantz } 5948f37572aSJakob Krantz /// 5953deb3ec6SMatthias Ringwald static void report_gatt_services(gatt_client_t * peripheral, uint8_t * packet, uint16_t size){ 5963deb3ec6SMatthias Ringwald uint8_t attr_length = packet[1]; 5973deb3ec6SMatthias Ringwald uint8_t uuid_length = attr_length - 4; 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 6063deb3ec6SMatthias Ringwald if (uuid_length == 2){ 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 } 6123deb3ec6SMatthias Ringwald emit_gatt_service_query_result_event(peripheral, start_group_handle, end_group_handle, uuid128); 6133deb3ec6SMatthias Ringwald } 614fc64f94aSMatthias Ringwald // log_info("report_gatt_services for %02X done", peripheral->con_handle); 6153deb3ec6SMatthias Ringwald } 6163deb3ec6SMatthias Ringwald 6173deb3ec6SMatthias Ringwald // helper 6183deb3ec6SMatthias Ringwald static void characteristic_start_found(gatt_client_t * peripheral, uint16_t start_handle, uint8_t properties, uint16_t value_handle, uint8_t * uuid, uint16_t uuid_length){ 6193deb3ec6SMatthias Ringwald uint8_t uuid128[16]; 6203deb3ec6SMatthias Ringwald uint16_t uuid16 = 0; 6213deb3ec6SMatthias Ringwald if (uuid_length == 2){ 622f8fbdce0SMatthias Ringwald uuid16 = little_endian_read_16(uuid, 0); 623e1a125dfSMatthias Ringwald uuid_add_bluetooth_prefix((uint8_t*) uuid128, uuid16); 6243deb3ec6SMatthias Ringwald } else { 6259c80e4ccSMatthias Ringwald reverse_128(uuid, uuid128); 6263deb3ec6SMatthias Ringwald } 6273deb3ec6SMatthias Ringwald 6285df9dc78SMatthias Ringwald if (peripheral->filter_with_uuid && (memcmp(peripheral->uuid128, uuid128, 16) != 0)) return; 6293deb3ec6SMatthias Ringwald 6303deb3ec6SMatthias Ringwald peripheral->characteristic_properties = properties; 6313deb3ec6SMatthias Ringwald peripheral->characteristic_start_handle = start_handle; 6323deb3ec6SMatthias Ringwald peripheral->attribute_handle = value_handle; 6333deb3ec6SMatthias Ringwald 6343deb3ec6SMatthias Ringwald if (peripheral->filter_with_uuid) return; 6353deb3ec6SMatthias Ringwald 6363deb3ec6SMatthias Ringwald peripheral->uuid16 = uuid16; 6376535961aSMatthias Ringwald (void)memcpy(peripheral->uuid128, uuid128, 16); 6383deb3ec6SMatthias Ringwald } 6393deb3ec6SMatthias Ringwald 6403deb3ec6SMatthias Ringwald static void characteristic_end_found(gatt_client_t * peripheral, uint16_t end_handle){ 6413deb3ec6SMatthias Ringwald // TODO: stop searching if filter and uuid found 6423deb3ec6SMatthias Ringwald 6433deb3ec6SMatthias Ringwald if (!peripheral->characteristic_start_handle) return; 6443deb3ec6SMatthias Ringwald 6453deb3ec6SMatthias Ringwald emit_gatt_characteristic_query_result_event(peripheral, peripheral->characteristic_start_handle, peripheral->attribute_handle, 6463deb3ec6SMatthias Ringwald end_handle, peripheral->characteristic_properties, peripheral->uuid128); 6473deb3ec6SMatthias Ringwald 6483deb3ec6SMatthias Ringwald peripheral->characteristic_start_handle = 0; 6493deb3ec6SMatthias Ringwald } 6503deb3ec6SMatthias Ringwald 6513deb3ec6SMatthias Ringwald static void report_gatt_characteristics(gatt_client_t * peripheral, uint8_t * packet, uint16_t size){ 6523deb3ec6SMatthias Ringwald uint8_t attr_length = packet[1]; 6533deb3ec6SMatthias Ringwald uint8_t uuid_length = attr_length - 5; 6543deb3ec6SMatthias Ringwald int i; 6553deb3ec6SMatthias Ringwald for (i = 2; i < size; i += attr_length){ 656f8fbdce0SMatthias Ringwald uint16_t start_handle = little_endian_read_16(packet, i); 6573deb3ec6SMatthias Ringwald uint8_t properties = packet[i+2]; 658f8fbdce0SMatthias Ringwald uint16_t value_handle = little_endian_read_16(packet, i+3); 6593deb3ec6SMatthias Ringwald characteristic_end_found(peripheral, start_handle-1); 6603deb3ec6SMatthias Ringwald characteristic_start_found(peripheral, start_handle, properties, value_handle, &packet[i+5], uuid_length); 6613deb3ec6SMatthias Ringwald } 6623deb3ec6SMatthias Ringwald } 6633deb3ec6SMatthias Ringwald 6643deb3ec6SMatthias Ringwald static void report_gatt_included_service_uuid16(gatt_client_t * peripheral, uint16_t include_handle, uint16_t uuid16){ 6653deb3ec6SMatthias Ringwald uint8_t normalized_uuid128[16]; 666e1a125dfSMatthias Ringwald uuid_add_bluetooth_prefix(normalized_uuid128, uuid16); 6673deb3ec6SMatthias Ringwald emit_gatt_included_service_query_result_event(peripheral, include_handle, peripheral->query_start_handle, 6683deb3ec6SMatthias Ringwald peripheral->query_end_handle, normalized_uuid128); 6693deb3ec6SMatthias Ringwald } 6703deb3ec6SMatthias Ringwald 6713deb3ec6SMatthias Ringwald static void report_gatt_included_service_uuid128(gatt_client_t * peripheral, uint16_t include_handle, uint8_t *uuid128){ 6723deb3ec6SMatthias Ringwald emit_gatt_included_service_query_result_event(peripheral, include_handle, peripheral->query_start_handle, 6733deb3ec6SMatthias Ringwald peripheral->query_end_handle, uuid128); 6743deb3ec6SMatthias Ringwald } 6753deb3ec6SMatthias Ringwald 6763deb3ec6SMatthias Ringwald // @returns packet pointer 6773deb3ec6SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite HCI + L2CAP packet headers 6783deb3ec6SMatthias Ringwald static const int characteristic_value_event_header_size = 8; 679711e6c80SMatthias 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){ 6803deb3ec6SMatthias Ringwald // before the value inside the ATT PDU 6813deb3ec6SMatthias Ringwald uint8_t * packet = value - characteristic_value_event_header_size; 6823deb3ec6SMatthias Ringwald packet[0] = type; 6833deb3ec6SMatthias Ringwald packet[1] = characteristic_value_event_header_size - 2 + length; 684f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 2, con_handle); 685f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 4, attribute_handle); 686f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 6, length); 6873deb3ec6SMatthias Ringwald return packet; 6883deb3ec6SMatthias Ringwald } 6893deb3ec6SMatthias Ringwald 6903deb3ec6SMatthias Ringwald // @returns packet pointer 6913deb3ec6SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite parts of the HCI/L2CAP/ATT packet (4/4/3) bytes 6923deb3ec6SMatthias Ringwald static const int long_characteristic_value_event_header_size = 10; 693711e6c80SMatthias 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){ 6943deb3ec6SMatthias Ringwald #if defined(HCI_INCOMING_PRE_BUFFER_SIZE) && (HCI_INCOMING_PRE_BUFFER_SIZE >= 10 - 8) // L2CAP Header (4) - ACL Header (4) 6953deb3ec6SMatthias Ringwald // before the value inside the ATT PDU 6963deb3ec6SMatthias Ringwald uint8_t * packet = value - long_characteristic_value_event_header_size; 6973deb3ec6SMatthias Ringwald packet[0] = type; 6983deb3ec6SMatthias Ringwald packet[1] = long_characteristic_value_event_header_size - 2 + length; 699f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 2, con_handle); 700f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 4, attribute_handle); 701f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 6, offset); 702f8fbdce0SMatthias Ringwald little_endian_store_16(packet, 8, length); 7033deb3ec6SMatthias Ringwald return packet; 7043deb3ec6SMatthias Ringwald #else 7053deb3ec6SMatthias Ringwald log_error("HCI_INCOMING_PRE_BUFFER_SIZE >= 2 required for long characteristic reads"); 7063deb3ec6SMatthias Ringwald return NULL; 7073deb3ec6SMatthias Ringwald #endif 7083deb3ec6SMatthias Ringwald } 7093deb3ec6SMatthias Ringwald 7103deb3ec6SMatthias Ringwald 7113deb3ec6SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite parts of the HCI/L2CAP/ATT packet (4/4/3) bytes 712711e6c80SMatthias Ringwald static void report_gatt_notification(hci_con_handle_t con_handle, uint16_t value_handle, uint8_t * value, int length){ 7135611a760SMatthias Ringwald uint8_t * packet = setup_characteristic_value_packet(GATT_EVENT_NOTIFICATION, con_handle, value_handle, value, length); 7149c662c9bSMatthias Ringwald emit_event_to_registered_listeners(con_handle, value_handle, packet, characteristic_value_event_header_size + length); 7153deb3ec6SMatthias Ringwald } 7163deb3ec6SMatthias Ringwald 7173deb3ec6SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite parts of the HCI/L2CAP/ATT packet (4/4/3) bytes 718711e6c80SMatthias Ringwald static void report_gatt_indication(hci_con_handle_t con_handle, uint16_t value_handle, uint8_t * value, int length){ 7195611a760SMatthias Ringwald uint8_t * packet = setup_characteristic_value_packet(GATT_EVENT_INDICATION, con_handle, value_handle, value, length); 7209c662c9bSMatthias Ringwald emit_event_to_registered_listeners(con_handle, value_handle, packet, characteristic_value_event_header_size + length); 7213deb3ec6SMatthias Ringwald } 7223deb3ec6SMatthias Ringwald 7233deb3ec6SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite parts of the HCI/L2CAP/ATT packet (4/4/3) bytes 7243deb3ec6SMatthias Ringwald static void report_gatt_characteristic_value(gatt_client_t * peripheral, uint16_t attribute_handle, uint8_t * value, uint16_t length){ 725fc64f94aSMatthias Ringwald uint8_t * packet = setup_characteristic_value_packet(GATT_EVENT_CHARACTERISTIC_VALUE_QUERY_RESULT, peripheral->con_handle, attribute_handle, value, length); 7269c662c9bSMatthias Ringwald emit_event_new(peripheral->callback, packet, characteristic_value_event_header_size + length); 7273deb3ec6SMatthias Ringwald } 7283deb3ec6SMatthias Ringwald 7293deb3ec6SMatthias Ringwald // @note assume that value is part of an l2cap buffer - overwrite parts of the HCI/L2CAP/ATT packet (4/4/3) bytes 7303deb3ec6SMatthias Ringwald static void report_gatt_long_characteristic_value_blob(gatt_client_t * peripheral, uint16_t attribute_handle, uint8_t * blob, uint16_t blob_length, int value_offset){ 731fc64f94aSMatthias Ringwald uint8_t * packet = setup_long_characteristic_value_packet(GATT_EVENT_LONG_CHARACTERISTIC_VALUE_QUERY_RESULT, peripheral->con_handle, attribute_handle, value_offset, blob, blob_length); 7323deb3ec6SMatthias Ringwald if (!packet) return; 7339c662c9bSMatthias Ringwald emit_event_new(peripheral->callback, packet, blob_length + long_characteristic_value_event_header_size); 7343deb3ec6SMatthias Ringwald } 7353deb3ec6SMatthias Ringwald 7363deb3ec6SMatthias Ringwald static void report_gatt_characteristic_descriptor(gatt_client_t * peripheral, uint16_t descriptor_handle, uint8_t *value, uint16_t value_length, uint16_t value_offset){ 7379ec2630cSMatthias Ringwald UNUSED(value_offset); 738fc64f94aSMatthias Ringwald uint8_t * packet = setup_characteristic_value_packet(GATT_EVENT_CHARACTERISTIC_DESCRIPTOR_QUERY_RESULT, peripheral->con_handle, descriptor_handle, value, value_length); 7399c662c9bSMatthias Ringwald emit_event_new(peripheral->callback, packet, value_length + 8); 7403deb3ec6SMatthias Ringwald } 7413deb3ec6SMatthias Ringwald 7423deb3ec6SMatthias Ringwald static void report_gatt_long_characteristic_descriptor(gatt_client_t * peripheral, uint16_t descriptor_handle, uint8_t *blob, uint16_t blob_length, uint16_t value_offset){ 743fc64f94aSMatthias Ringwald uint8_t * packet = setup_long_characteristic_value_packet(GATT_EVENT_LONG_CHARACTERISTIC_DESCRIPTOR_QUERY_RESULT, peripheral->con_handle, descriptor_handle, value_offset, blob, blob_length); 7443deb3ec6SMatthias Ringwald if (!packet) return; 7459c662c9bSMatthias Ringwald emit_event_new(peripheral->callback, packet, blob_length + long_characteristic_value_event_header_size); 7463deb3ec6SMatthias Ringwald } 7473deb3ec6SMatthias Ringwald 7483deb3ec6SMatthias Ringwald static void report_gatt_all_characteristic_descriptors(gatt_client_t * peripheral, uint8_t * packet, uint16_t size, uint16_t pair_size){ 7493deb3ec6SMatthias Ringwald int i; 7503deb3ec6SMatthias Ringwald for (i = 0; i<size; i+=pair_size){ 751f8fbdce0SMatthias Ringwald uint16_t descriptor_handle = little_endian_read_16(packet,i); 7523deb3ec6SMatthias Ringwald uint8_t uuid128[16]; 7533deb3ec6SMatthias Ringwald uint16_t uuid16 = 0; 7543deb3ec6SMatthias Ringwald if (pair_size == 4){ 755f8fbdce0SMatthias Ringwald uuid16 = little_endian_read_16(packet,i+2); 756e1a125dfSMatthias Ringwald uuid_add_bluetooth_prefix(uuid128, uuid16); 7573deb3ec6SMatthias Ringwald } else { 7589c80e4ccSMatthias Ringwald reverse_128(&packet[i+2], uuid128); 7593deb3ec6SMatthias Ringwald } 7603deb3ec6SMatthias Ringwald emit_gatt_all_characteristic_descriptors_result_event(peripheral, descriptor_handle, uuid128); 7613deb3ec6SMatthias Ringwald } 7623deb3ec6SMatthias Ringwald 7633deb3ec6SMatthias Ringwald } 7643deb3ec6SMatthias Ringwald 7653deb3ec6SMatthias Ringwald static int is_query_done(gatt_client_t * peripheral, uint16_t last_result_handle){ 7663deb3ec6SMatthias Ringwald return last_result_handle >= peripheral->end_group_handle; 7673deb3ec6SMatthias Ringwald } 7683deb3ec6SMatthias Ringwald 7693deb3ec6SMatthias Ringwald static void trigger_next_query(gatt_client_t * peripheral, uint16_t last_result_handle, gatt_client_state_t next_query_state){ 7703deb3ec6SMatthias Ringwald if (is_query_done(peripheral, last_result_handle)){ 7713deb3ec6SMatthias Ringwald gatt_client_handle_transaction_complete(peripheral); 7729cb80b17SMilanka Ringwald emit_gatt_complete_event(peripheral, ATT_ERROR_SUCCESS); 7733deb3ec6SMatthias Ringwald return; 7743deb3ec6SMatthias Ringwald } 7753deb3ec6SMatthias Ringwald // next 7763deb3ec6SMatthias Ringwald peripheral->start_group_handle = last_result_handle + 1; 7773deb3ec6SMatthias Ringwald peripheral->gatt_client_state = next_query_state; 7783deb3ec6SMatthias Ringwald } 7793deb3ec6SMatthias Ringwald 78000748105SMatthias Ringwald static void trigger_next_included_service_query(gatt_client_t * peripheral, uint16_t last_result_handle){ 7813deb3ec6SMatthias Ringwald trigger_next_query(peripheral, last_result_handle, P_W2_SEND_INCLUDED_SERVICE_QUERY); 7823deb3ec6SMatthias Ringwald } 7833deb3ec6SMatthias Ringwald 78400748105SMatthias Ringwald static void trigger_next_service_query(gatt_client_t * peripheral, uint16_t last_result_handle){ 7853deb3ec6SMatthias Ringwald trigger_next_query(peripheral, last_result_handle, P_W2_SEND_SERVICE_QUERY); 7863deb3ec6SMatthias Ringwald } 7873deb3ec6SMatthias Ringwald 78800748105SMatthias Ringwald static void trigger_next_service_by_uuid_query(gatt_client_t * peripheral, uint16_t last_result_handle){ 7893deb3ec6SMatthias Ringwald trigger_next_query(peripheral, last_result_handle, P_W2_SEND_SERVICE_WITH_UUID_QUERY); 7903deb3ec6SMatthias Ringwald } 7913deb3ec6SMatthias Ringwald 79200748105SMatthias Ringwald static void trigger_next_characteristic_query(gatt_client_t * peripheral, uint16_t last_result_handle){ 7933deb3ec6SMatthias Ringwald if (is_query_done(peripheral, last_result_handle)){ 7943deb3ec6SMatthias Ringwald // report last characteristic 7953deb3ec6SMatthias Ringwald characteristic_end_found(peripheral, peripheral->end_group_handle); 7963deb3ec6SMatthias Ringwald } 7973deb3ec6SMatthias Ringwald trigger_next_query(peripheral, last_result_handle, P_W2_SEND_ALL_CHARACTERISTICS_OF_SERVICE_QUERY); 7983deb3ec6SMatthias Ringwald } 7993deb3ec6SMatthias Ringwald 80000748105SMatthias Ringwald static void trigger_next_characteristic_descriptor_query(gatt_client_t * peripheral, uint16_t last_result_handle){ 8013deb3ec6SMatthias Ringwald trigger_next_query(peripheral, last_result_handle, P_W2_SEND_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY); 8023deb3ec6SMatthias Ringwald } 8033deb3ec6SMatthias Ringwald 80400748105SMatthias Ringwald static void trigger_next_read_by_type_query(gatt_client_t * peripheral, uint16_t last_result_handle){ 8053deb3ec6SMatthias Ringwald trigger_next_query(peripheral, last_result_handle, P_W2_SEND_READ_BY_TYPE_REQUEST); 8063deb3ec6SMatthias Ringwald } 8073deb3ec6SMatthias Ringwald 80800748105SMatthias Ringwald static void trigger_next_prepare_write_query(gatt_client_t * peripheral, gatt_client_state_t next_query_state, gatt_client_state_t done_state){ 8093deb3ec6SMatthias Ringwald peripheral->attribute_offset += write_blob_length(peripheral); 8103deb3ec6SMatthias Ringwald uint16_t next_blob_length = write_blob_length(peripheral); 8113deb3ec6SMatthias Ringwald 8123deb3ec6SMatthias Ringwald if (next_blob_length == 0){ 8133deb3ec6SMatthias Ringwald peripheral->gatt_client_state = done_state; 8143deb3ec6SMatthias Ringwald return; 8153deb3ec6SMatthias Ringwald } 8163deb3ec6SMatthias Ringwald peripheral->gatt_client_state = next_query_state; 8173deb3ec6SMatthias Ringwald } 8183deb3ec6SMatthias Ringwald 81900748105SMatthias Ringwald static void trigger_next_blob_query(gatt_client_t * peripheral, gatt_client_state_t next_query_state, uint16_t received_blob_length){ 8203deb3ec6SMatthias Ringwald 8213deb3ec6SMatthias Ringwald uint16_t max_blob_length = peripheral_mtu(peripheral) - 1; 8223deb3ec6SMatthias Ringwald if (received_blob_length < max_blob_length){ 8233deb3ec6SMatthias Ringwald gatt_client_handle_transaction_complete(peripheral); 8249cb80b17SMilanka Ringwald emit_gatt_complete_event(peripheral, ATT_ERROR_SUCCESS); 8253deb3ec6SMatthias Ringwald return; 8263deb3ec6SMatthias Ringwald } 8273deb3ec6SMatthias Ringwald 8283deb3ec6SMatthias Ringwald peripheral->attribute_offset += received_blob_length; 8293deb3ec6SMatthias Ringwald peripheral->gatt_client_state = next_query_state; 8303deb3ec6SMatthias Ringwald } 8313deb3ec6SMatthias Ringwald 8323deb3ec6SMatthias Ringwald 8333deb3ec6SMatthias Ringwald static int is_value_valid(gatt_client_t *peripheral, uint8_t *packet, uint16_t size){ 834f8fbdce0SMatthias Ringwald uint16_t attribute_handle = little_endian_read_16(packet, 1); 835f8fbdce0SMatthias Ringwald uint16_t value_offset = little_endian_read_16(packet, 3); 8363deb3ec6SMatthias Ringwald 8373deb3ec6SMatthias Ringwald if (peripheral->attribute_handle != attribute_handle) return 0; 8383deb3ec6SMatthias Ringwald if (peripheral->attribute_offset != value_offset) return 0; 8393deb3ec6SMatthias Ringwald return memcmp(&peripheral->attribute_value[peripheral->attribute_offset], &packet[5], size-5) == 0; 8403deb3ec6SMatthias Ringwald } 8413deb3ec6SMatthias Ringwald 842544128c3SMatthias Ringwald // returns 1 if packet was sent 843544128c3SMatthias Ringwald static int gatt_client_run_for_peripheral( gatt_client_t * peripheral){ 8443deb3ec6SMatthias Ringwald // log_info("- handle_peripheral_list, mtu state %u, client state %u", peripheral->mtu_state, peripheral->gatt_client_state); 8453deb3ec6SMatthias Ringwald 846d1e1a57fSMatthias Ringwald // wait until re-encryption as central is complete 847d1e1a57fSMatthias Ringwald if (gap_reconnect_security_setup_active(peripheral->con_handle)) return 0; 848d1e1a57fSMatthias Ringwald 849f4b33574SMatthias Ringwald #ifdef ENABLE_GATT_CLIENT_PAIRING 850f4b33574SMatthias Ringwald // wait until pairing complete 851f4b33574SMatthias Ringwald if (peripheral->wait_for_pairing_complete) return 0; 852f4b33574SMatthias Ringwald #endif 853f4b33574SMatthias Ringwald 8543deb3ec6SMatthias Ringwald switch (peripheral->mtu_state) { 855544128c3SMatthias Ringwald case SEND_MTU_EXCHANGE: 8563deb3ec6SMatthias Ringwald peripheral->mtu_state = SENT_MTU_EXCHANGE; 857fc64f94aSMatthias Ringwald att_exchange_mtu_request(peripheral->con_handle); 858544128c3SMatthias Ringwald return 1; 8593deb3ec6SMatthias Ringwald case SENT_MTU_EXCHANGE: 860544128c3SMatthias Ringwald return 0; 8613deb3ec6SMatthias Ringwald default: 8623deb3ec6SMatthias Ringwald break; 8633deb3ec6SMatthias Ringwald } 8643deb3ec6SMatthias Ringwald 8653deb3ec6SMatthias Ringwald if (peripheral->send_confirmation){ 8663deb3ec6SMatthias Ringwald peripheral->send_confirmation = 0; 867fc64f94aSMatthias Ringwald att_confirmation(peripheral->con_handle); 868544128c3SMatthias Ringwald return 1; 8693deb3ec6SMatthias Ringwald } 8703deb3ec6SMatthias Ringwald 8713deb3ec6SMatthias Ringwald // check MTU for writes 8723deb3ec6SMatthias Ringwald switch (peripheral->gatt_client_state){ 8733deb3ec6SMatthias Ringwald case P_W2_SEND_WRITE_CHARACTERISTIC_VALUE: 8743deb3ec6SMatthias Ringwald case P_W2_SEND_WRITE_CHARACTERISTIC_DESCRIPTOR: 875c1ab6cc1SMatthias Ringwald if (peripheral->attribute_length <= (peripheral_mtu(peripheral) - 3)) break; 8763deb3ec6SMatthias Ringwald log_error("gatt_client_run: value len %u > MTU %u - 3\n", peripheral->attribute_length, peripheral_mtu(peripheral)); 8773deb3ec6SMatthias Ringwald gatt_client_handle_transaction_complete(peripheral); 8783deb3ec6SMatthias Ringwald emit_gatt_complete_event(peripheral, ATT_ERROR_INVALID_ATTRIBUTE_VALUE_LENGTH); 879544128c3SMatthias Ringwald return 0; 8803deb3ec6SMatthias Ringwald default: 8813deb3ec6SMatthias Ringwald break; 8823deb3ec6SMatthias Ringwald } 8833deb3ec6SMatthias Ringwald 8843deb3ec6SMatthias Ringwald // log_info("gatt_client_state %u", peripheral->gatt_client_state); 8853deb3ec6SMatthias Ringwald switch (peripheral->gatt_client_state){ 8863deb3ec6SMatthias Ringwald case P_W2_SEND_SERVICE_QUERY: 8873deb3ec6SMatthias Ringwald peripheral->gatt_client_state = P_W4_SERVICE_QUERY_RESULT; 8883deb3ec6SMatthias Ringwald send_gatt_services_request(peripheral); 889544128c3SMatthias Ringwald return 1; 8903deb3ec6SMatthias Ringwald 8913deb3ec6SMatthias Ringwald case P_W2_SEND_SERVICE_WITH_UUID_QUERY: 8923deb3ec6SMatthias Ringwald peripheral->gatt_client_state = P_W4_SERVICE_WITH_UUID_RESULT; 8933deb3ec6SMatthias Ringwald send_gatt_services_by_uuid_request(peripheral); 894544128c3SMatthias Ringwald return 1; 8953deb3ec6SMatthias Ringwald 8963deb3ec6SMatthias Ringwald case P_W2_SEND_ALL_CHARACTERISTICS_OF_SERVICE_QUERY: 8973deb3ec6SMatthias Ringwald peripheral->gatt_client_state = P_W4_ALL_CHARACTERISTICS_OF_SERVICE_QUERY_RESULT; 8983deb3ec6SMatthias Ringwald send_gatt_characteristic_request(peripheral); 899544128c3SMatthias Ringwald return 1; 9003deb3ec6SMatthias Ringwald 9013deb3ec6SMatthias Ringwald case P_W2_SEND_CHARACTERISTIC_WITH_UUID_QUERY: 9023deb3ec6SMatthias Ringwald peripheral->gatt_client_state = P_W4_CHARACTERISTIC_WITH_UUID_QUERY_RESULT; 9033deb3ec6SMatthias Ringwald send_gatt_characteristic_request(peripheral); 904544128c3SMatthias Ringwald return 1; 9053deb3ec6SMatthias Ringwald 9063deb3ec6SMatthias Ringwald case P_W2_SEND_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY: 9073deb3ec6SMatthias Ringwald peripheral->gatt_client_state = P_W4_CHARACTERISTIC_WITH_UUID_QUERY_RESULT; 9083deb3ec6SMatthias Ringwald send_gatt_characteristic_descriptor_request(peripheral); 909544128c3SMatthias Ringwald return 1; 9103deb3ec6SMatthias Ringwald 9113deb3ec6SMatthias Ringwald case P_W2_SEND_INCLUDED_SERVICE_QUERY: 9123deb3ec6SMatthias Ringwald peripheral->gatt_client_state = P_W4_INCLUDED_SERVICE_QUERY_RESULT; 9133deb3ec6SMatthias Ringwald send_gatt_included_service_request(peripheral); 914544128c3SMatthias Ringwald return 1; 9153deb3ec6SMatthias Ringwald 9163deb3ec6SMatthias Ringwald case P_W2_SEND_INCLUDED_SERVICE_WITH_UUID_QUERY: 9173deb3ec6SMatthias Ringwald peripheral->gatt_client_state = P_W4_INCLUDED_SERVICE_UUID_WITH_QUERY_RESULT; 9183deb3ec6SMatthias Ringwald send_gatt_included_service_uuid_request(peripheral); 919544128c3SMatthias Ringwald return 1; 9203deb3ec6SMatthias Ringwald 9213deb3ec6SMatthias Ringwald case P_W2_SEND_READ_CHARACTERISTIC_VALUE_QUERY: 9223deb3ec6SMatthias Ringwald peripheral->gatt_client_state = P_W4_READ_CHARACTERISTIC_VALUE_RESULT; 9233deb3ec6SMatthias Ringwald send_gatt_read_characteristic_value_request(peripheral); 924544128c3SMatthias Ringwald return 1; 9253deb3ec6SMatthias Ringwald 9263deb3ec6SMatthias Ringwald case P_W2_SEND_READ_BLOB_QUERY: 9273deb3ec6SMatthias Ringwald peripheral->gatt_client_state = P_W4_READ_BLOB_RESULT; 9283deb3ec6SMatthias Ringwald send_gatt_read_blob_request(peripheral); 929544128c3SMatthias Ringwald return 1; 9303deb3ec6SMatthias Ringwald 9313deb3ec6SMatthias Ringwald case P_W2_SEND_READ_BY_TYPE_REQUEST: 9323deb3ec6SMatthias Ringwald peripheral->gatt_client_state = P_W4_READ_BY_TYPE_RESPONSE; 9333deb3ec6SMatthias Ringwald send_gatt_read_by_type_request(peripheral); 934544128c3SMatthias Ringwald return 1; 9353deb3ec6SMatthias Ringwald 9363deb3ec6SMatthias Ringwald case P_W2_SEND_READ_MULTIPLE_REQUEST: 9373deb3ec6SMatthias Ringwald peripheral->gatt_client_state = P_W4_READ_MULTIPLE_RESPONSE; 9383deb3ec6SMatthias Ringwald send_gatt_read_multiple_request(peripheral); 939544128c3SMatthias Ringwald return 1; 9403deb3ec6SMatthias Ringwald 9413deb3ec6SMatthias Ringwald case P_W2_SEND_WRITE_CHARACTERISTIC_VALUE: 9423deb3ec6SMatthias Ringwald peripheral->gatt_client_state = P_W4_WRITE_CHARACTERISTIC_VALUE_RESULT; 9433deb3ec6SMatthias Ringwald send_gatt_write_attribute_value_request(peripheral); 944544128c3SMatthias Ringwald return 1; 9453deb3ec6SMatthias Ringwald 9463deb3ec6SMatthias Ringwald case P_W2_PREPARE_WRITE: 9473deb3ec6SMatthias Ringwald peripheral->gatt_client_state = P_W4_PREPARE_WRITE_RESULT; 9483deb3ec6SMatthias Ringwald send_gatt_prepare_write_request(peripheral); 949544128c3SMatthias Ringwald return 1; 9503deb3ec6SMatthias Ringwald 9513deb3ec6SMatthias Ringwald case P_W2_PREPARE_WRITE_SINGLE: 9523deb3ec6SMatthias Ringwald peripheral->gatt_client_state = P_W4_PREPARE_WRITE_SINGLE_RESULT; 9533deb3ec6SMatthias Ringwald send_gatt_prepare_write_request(peripheral); 954544128c3SMatthias Ringwald return 1; 9553deb3ec6SMatthias Ringwald 9563deb3ec6SMatthias Ringwald case P_W2_PREPARE_RELIABLE_WRITE: 9573deb3ec6SMatthias Ringwald peripheral->gatt_client_state = P_W4_PREPARE_RELIABLE_WRITE_RESULT; 9583deb3ec6SMatthias Ringwald send_gatt_prepare_write_request(peripheral); 959544128c3SMatthias Ringwald return 1; 9603deb3ec6SMatthias Ringwald 9613deb3ec6SMatthias Ringwald case P_W2_EXECUTE_PREPARED_WRITE: 9623deb3ec6SMatthias Ringwald peripheral->gatt_client_state = P_W4_EXECUTE_PREPARED_WRITE_RESULT; 9633deb3ec6SMatthias Ringwald send_gatt_execute_write_request(peripheral); 964544128c3SMatthias Ringwald return 1; 9653deb3ec6SMatthias Ringwald 9663deb3ec6SMatthias Ringwald case P_W2_CANCEL_PREPARED_WRITE: 9673deb3ec6SMatthias Ringwald peripheral->gatt_client_state = P_W4_CANCEL_PREPARED_WRITE_RESULT; 9683deb3ec6SMatthias Ringwald send_gatt_cancel_prepared_write_request(peripheral); 969544128c3SMatthias Ringwald return 1; 9703deb3ec6SMatthias Ringwald 9713deb3ec6SMatthias Ringwald case P_W2_CANCEL_PREPARED_WRITE_DATA_MISMATCH: 9723deb3ec6SMatthias Ringwald peripheral->gatt_client_state = P_W4_CANCEL_PREPARED_WRITE_DATA_MISMATCH_RESULT; 9733deb3ec6SMatthias Ringwald send_gatt_cancel_prepared_write_request(peripheral); 974544128c3SMatthias Ringwald return 1; 9753deb3ec6SMatthias Ringwald 976abdc9fb5SMatthias Ringwald #ifdef ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY 977abdc9fb5SMatthias Ringwald case P_W2_SEND_FIND_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY: 978abdc9fb5SMatthias Ringwald // use Find Information 979abdc9fb5SMatthias Ringwald peripheral->gatt_client_state = P_W4_FIND_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY_RESULT; 980abdc9fb5SMatthias Ringwald send_gatt_characteristic_descriptor_request(peripheral); 981abdc9fb5SMatthias Ringwald #else 9823deb3ec6SMatthias Ringwald case P_W2_SEND_READ_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY: 983abdc9fb5SMatthias Ringwald // Use Read By Type 9843deb3ec6SMatthias Ringwald peripheral->gatt_client_state = P_W4_READ_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY_RESULT; 9853deb3ec6SMatthias Ringwald send_gatt_read_client_characteristic_configuration_request(peripheral); 986abdc9fb5SMatthias Ringwald #endif 987544128c3SMatthias Ringwald return 1; 9883deb3ec6SMatthias Ringwald 9893deb3ec6SMatthias Ringwald case P_W2_SEND_READ_CHARACTERISTIC_DESCRIPTOR_QUERY: 9903deb3ec6SMatthias Ringwald peripheral->gatt_client_state = P_W4_READ_CHARACTERISTIC_DESCRIPTOR_RESULT; 9913deb3ec6SMatthias Ringwald send_gatt_read_characteristic_descriptor_request(peripheral); 992544128c3SMatthias Ringwald return 1; 9933deb3ec6SMatthias Ringwald 9943deb3ec6SMatthias Ringwald case P_W2_SEND_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_QUERY: 9953deb3ec6SMatthias Ringwald peripheral->gatt_client_state = P_W4_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_RESULT; 9963deb3ec6SMatthias Ringwald send_gatt_read_blob_request(peripheral); 997544128c3SMatthias Ringwald return 1; 9983deb3ec6SMatthias Ringwald 9993deb3ec6SMatthias Ringwald case P_W2_SEND_WRITE_CHARACTERISTIC_DESCRIPTOR: 10003deb3ec6SMatthias Ringwald peripheral->gatt_client_state = P_W4_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT; 10013deb3ec6SMatthias Ringwald send_gatt_write_attribute_value_request(peripheral); 1002544128c3SMatthias Ringwald return 1; 10033deb3ec6SMatthias Ringwald 10043deb3ec6SMatthias Ringwald case P_W2_WRITE_CLIENT_CHARACTERISTIC_CONFIGURATION: 10053deb3ec6SMatthias Ringwald peripheral->gatt_client_state = P_W4_CLIENT_CHARACTERISTIC_CONFIGURATION_RESULT; 10063deb3ec6SMatthias Ringwald send_gatt_write_client_characteristic_configuration_request(peripheral); 1007544128c3SMatthias Ringwald return 1; 10083deb3ec6SMatthias Ringwald 10093deb3ec6SMatthias Ringwald case P_W2_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR: 10103deb3ec6SMatthias Ringwald peripheral->gatt_client_state = P_W4_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT; 10113deb3ec6SMatthias Ringwald send_gatt_prepare_write_request(peripheral); 1012544128c3SMatthias Ringwald return 1; 10133deb3ec6SMatthias Ringwald 10143deb3ec6SMatthias Ringwald case P_W2_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR: 10153deb3ec6SMatthias Ringwald peripheral->gatt_client_state = P_W4_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT; 10163deb3ec6SMatthias Ringwald send_gatt_execute_write_request(peripheral); 1017544128c3SMatthias Ringwald return 1; 10183deb3ec6SMatthias Ringwald 10197a766ebfSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 1020793cf6ceSMatthias Ringwald case P_W4_IDENTITY_RESOLVING: 1021793cf6ceSMatthias Ringwald log_info("P_W4_IDENTITY_RESOLVING - state %x", sm_identity_resolving_state(peripheral->con_handle)); 1022793cf6ceSMatthias Ringwald switch (sm_identity_resolving_state(peripheral->con_handle)){ 1023793cf6ceSMatthias Ringwald case IRK_LOOKUP_SUCCEEDED: 1024793cf6ceSMatthias Ringwald peripheral->le_device_index = sm_le_device_index(peripheral->con_handle); 1025793cf6ceSMatthias Ringwald peripheral->gatt_client_state = P_W4_CMAC_READY; 1026793cf6ceSMatthias Ringwald break; 1027793cf6ceSMatthias Ringwald case IRK_LOOKUP_FAILED: 1028793cf6ceSMatthias Ringwald gatt_client_handle_transaction_complete(peripheral); 1029793cf6ceSMatthias Ringwald emit_gatt_complete_event(peripheral, ATT_ERROR_BONDING_INFORMATION_MISSING); 1030793cf6ceSMatthias Ringwald return 0; 1031793cf6ceSMatthias Ringwald default: 1032793cf6ceSMatthias Ringwald return 0; 1033793cf6ceSMatthias Ringwald } 1034793cf6ceSMatthias Ringwald 1035793cf6ceSMatthias Ringwald /* Fall through */ 1036793cf6ceSMatthias Ringwald 10373deb3ec6SMatthias Ringwald case P_W4_CMAC_READY: 10383deb3ec6SMatthias Ringwald if (sm_cmac_ready()){ 10393deb3ec6SMatthias Ringwald sm_key_t csrk; 10403deb3ec6SMatthias Ringwald le_device_db_local_csrk_get(peripheral->le_device_index, csrk); 10413deb3ec6SMatthias Ringwald uint32_t sign_counter = le_device_db_local_counter_get(peripheral->le_device_index); 10423deb3ec6SMatthias Ringwald peripheral->gatt_client_state = P_W4_CMAC_RESULT; 10434dfd504aSMatthias Ringwald sm_cmac_signed_write_start(csrk, ATT_SIGNED_WRITE_COMMAND, peripheral->attribute_handle, peripheral->attribute_length, peripheral->attribute_value, sign_counter, att_signed_write_handle_cmac_result); 10443deb3ec6SMatthias Ringwald } 1045544128c3SMatthias Ringwald return 0; 10463deb3ec6SMatthias Ringwald 10473deb3ec6SMatthias Ringwald case P_W2_SEND_SIGNED_WRITE: { 10483deb3ec6SMatthias Ringwald peripheral->gatt_client_state = P_W4_SEND_SINGED_WRITE_DONE; 10493deb3ec6SMatthias Ringwald // bump local signing counter 10503deb3ec6SMatthias Ringwald uint32_t sign_counter = le_device_db_local_counter_get(peripheral->le_device_index); 10513deb3ec6SMatthias Ringwald le_device_db_local_counter_set(peripheral->le_device_index, sign_counter + 1); 105264b12680SMatthias Ringwald // send signed write command 10533deb3ec6SMatthias Ringwald send_gatt_signed_write_request(peripheral, sign_counter); 10543deb3ec6SMatthias Ringwald // finally, notifiy client that write is complete 10553deb3ec6SMatthias Ringwald gatt_client_handle_transaction_complete(peripheral); 10569cb80b17SMilanka Ringwald emit_gatt_complete_event(peripheral, ATT_ERROR_SUCCESS); 1057544128c3SMatthias Ringwald return 1; 10583deb3ec6SMatthias Ringwald } 10597a766ebfSMatthias Ringwald #endif 10603deb3ec6SMatthias Ringwald default: 10613deb3ec6SMatthias Ringwald break; 10623deb3ec6SMatthias Ringwald } 106347181045SMatthias Ringwald 106447181045SMatthias Ringwald // requested can send snow? 106547181045SMatthias Ringwald if (peripheral->write_without_response_callback){ 106647181045SMatthias Ringwald btstack_packet_handler_t packet_handler = peripheral->write_without_response_callback; 106747181045SMatthias Ringwald peripheral->write_without_response_callback = NULL; 106847181045SMatthias Ringwald uint8_t event[4]; 106947181045SMatthias Ringwald event[0] = GATT_EVENT_CAN_WRITE_WITHOUT_RESPONSE; 107047181045SMatthias Ringwald event[1] = sizeof(event) - 2; 107147181045SMatthias Ringwald little_endian_store_16(event, 2, peripheral->con_handle); 107247181045SMatthias Ringwald packet_handler(HCI_EVENT_PACKET, peripheral->con_handle, event, sizeof(event)); 107347181045SMatthias Ringwald return 1; // to trigger requeueing (even if higher layer didn't sent) 107447181045SMatthias Ringwald } 107547181045SMatthias Ringwald 1076544128c3SMatthias Ringwald return 0; 10773deb3ec6SMatthias Ringwald } 10783deb3ec6SMatthias Ringwald 1079544128c3SMatthias Ringwald static void gatt_client_run(void){ 1080544128c3SMatthias Ringwald btstack_linked_item_t *it; 1081a0da043fSMatthias Ringwald for (it = (btstack_linked_item_t *) gatt_client_connections; it != NULL; it = it->next){ 1082544128c3SMatthias Ringwald gatt_client_t * peripheral = (gatt_client_t *) it; 1083544128c3SMatthias Ringwald if (!att_dispatch_client_can_send_now(peripheral->con_handle)) { 1084544128c3SMatthias Ringwald att_dispatch_client_request_can_send_now_event(peripheral->con_handle); 1085544128c3SMatthias Ringwald return; 1086544128c3SMatthias Ringwald } 1087544128c3SMatthias Ringwald int packet_sent = gatt_client_run_for_peripheral(peripheral); 1088544128c3SMatthias Ringwald if (packet_sent){ 108945f2a740SMatthias Ringwald // request new permission 1090544128c3SMatthias Ringwald att_dispatch_client_request_can_send_now_event(peripheral->con_handle); 109145f2a740SMatthias Ringwald // requeue client for fairness and exit 109245f2a740SMatthias Ringwald // note: iterator has become invalid 109345f2a740SMatthias Ringwald btstack_linked_list_remove(&gatt_client_connections, (btstack_linked_item_t *) peripheral); 109445f2a740SMatthias Ringwald btstack_linked_list_add_tail(&gatt_client_connections, (btstack_linked_item_t *) peripheral); 1095544128c3SMatthias Ringwald return; 1096544128c3SMatthias Ringwald } 1097544128c3SMatthias Ringwald } 10983deb3ec6SMatthias Ringwald } 10993deb3ec6SMatthias Ringwald 11007d2258b3SMilanka Ringwald static void gatt_client_report_error_if_pending(gatt_client_t *peripheral, uint8_t att_error_code) { 11017d2258b3SMilanka Ringwald if (is_ready(peripheral) == 1) return; 11023deb3ec6SMatthias Ringwald gatt_client_handle_transaction_complete(peripheral); 11037d2258b3SMilanka Ringwald emit_gatt_complete_event(peripheral, att_error_code); 11043deb3ec6SMatthias Ringwald } 11053deb3ec6SMatthias Ringwald 1106f4b33574SMatthias Ringwald static void gatt_client_event_packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size){ 11071ac26e06SMatthias Ringwald UNUSED(channel); // ok: handling own l2cap events 11081ac26e06SMatthias Ringwald UNUSED(size); // ok: there is no channel 11099ec2630cSMatthias Ringwald 1110361b1363SMatthias Ringwald if (packet_type != HCI_EVENT_PACKET) return; 1111361b1363SMatthias Ringwald 1112f4b33574SMatthias Ringwald hci_con_handle_t con_handle; 1113f4b33574SMatthias Ringwald gatt_client_t * peripheral; 11140e2df43fSMatthias Ringwald switch (hci_event_packet_get_type(packet)) { 11153deb3ec6SMatthias Ringwald case HCI_EVENT_DISCONNECTION_COMPLETE: 11163deb3ec6SMatthias Ringwald log_info("GATT Client: HCI_EVENT_DISCONNECTION_COMPLETE"); 1117f4b33574SMatthias Ringwald con_handle = little_endian_read_16(packet,3); 1118f4b33574SMatthias Ringwald peripheral = get_gatt_client_context_for_handle(con_handle); 11197d2258b3SMilanka Ringwald if (peripheral == NULL) break; 11203deb3ec6SMatthias Ringwald 1121cce308d6SMatthias Ringwald gatt_client_report_error_if_pending(peripheral, ATT_ERROR_HCI_DISCONNECT_RECEIVED); 1122cce308d6SMatthias Ringwald gatt_client_timeout_stop(peripheral); 1123665d90f2SMatthias Ringwald btstack_linked_list_remove(&gatt_client_connections, (btstack_linked_item_t *) peripheral); 11243deb3ec6SMatthias Ringwald btstack_memory_gatt_client_free(peripheral); 11253deb3ec6SMatthias Ringwald break; 1126f4b33574SMatthias Ringwald 1127f4b33574SMatthias Ringwald #ifdef ENABLE_GATT_CLIENT_PAIRING 1128f4b33574SMatthias Ringwald // Pairing complete (with/without bonding=storing of pairing information) 1129f4b33574SMatthias Ringwald case SM_EVENT_PAIRING_COMPLETE: 1130f4b33574SMatthias Ringwald con_handle = sm_event_pairing_complete_get_handle(packet); 1131f4b33574SMatthias Ringwald peripheral = get_gatt_client_context_for_handle(con_handle); 11327d2258b3SMilanka Ringwald if (peripheral == NULL) break; 1133f4b33574SMatthias Ringwald 1134f4b33574SMatthias Ringwald if (peripheral->wait_for_pairing_complete){ 1135f4b33574SMatthias Ringwald peripheral->wait_for_pairing_complete = 0; 1136f4b33574SMatthias Ringwald if (sm_event_pairing_complete_get_status(packet)){ 1137f4b33574SMatthias Ringwald log_info("pairing failed, report previous error 0x%x", peripheral->pending_error_code); 1138f4b33574SMatthias Ringwald gatt_client_handle_transaction_complete(peripheral); 1139f4b33574SMatthias Ringwald emit_gatt_complete_event(peripheral, peripheral->pending_error_code); 1140f4b33574SMatthias Ringwald } else { 1141f4b33574SMatthias Ringwald log_info("pairing success, retry operation"); 11423deb3ec6SMatthias Ringwald } 1143f4b33574SMatthias Ringwald } 1144f4b33574SMatthias Ringwald break; 1145f4b33574SMatthias Ringwald #endif 1146793cf6ceSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 1147793cf6ceSMatthias Ringwald // Identity Resolving completed (no code, gatt_client_run will continue) 1148793cf6ceSMatthias Ringwald case SM_EVENT_IDENTITY_RESOLVING_SUCCEEDED: 1149793cf6ceSMatthias Ringwald case SM_EVENT_IDENTITY_RESOLVING_FAILED: 1150793cf6ceSMatthias Ringwald break; 1151793cf6ceSMatthias Ringwald #endif 1152f4b33574SMatthias Ringwald 11533deb3ec6SMatthias Ringwald default: 11543deb3ec6SMatthias Ringwald break; 11553deb3ec6SMatthias Ringwald } 11563deb3ec6SMatthias Ringwald 1157361b1363SMatthias Ringwald gatt_client_run(); 11583deb3ec6SMatthias Ringwald } 11593deb3ec6SMatthias Ringwald 11603deb3ec6SMatthias Ringwald static void gatt_client_att_packet_handler(uint8_t packet_type, uint16_t handle, uint8_t *packet, uint16_t size){ 11613deb3ec6SMatthias Ringwald 11620fbf59a1SMatthias Ringwald gatt_client_t * peripheral; 11630fbf59a1SMatthias Ringwald 11640fbf59a1SMatthias Ringwald if (packet_type == HCI_EVENT_PACKET) { 11650fbf59a1SMatthias Ringwald switch (packet[0]){ 11660fbf59a1SMatthias Ringwald case L2CAP_EVENT_CAN_SEND_NOW: 116751764b3bSMatthias Ringwald gatt_client_run(); 11680fbf59a1SMatthias Ringwald break; 11690fbf59a1SMatthias Ringwald // att_server has negotiated the mtu for this connection, cache if context exists 11700fbf59a1SMatthias Ringwald case ATT_EVENT_MTU_EXCHANGE_COMPLETE: 11710fbf59a1SMatthias Ringwald peripheral = get_gatt_client_context_for_handle(handle); 11727d2258b3SMilanka Ringwald if (peripheral == NULL) break; 11730fbf59a1SMatthias Ringwald peripheral->mtu = little_endian_read_16(packet, 4); 11740fbf59a1SMatthias Ringwald break; 11750fbf59a1SMatthias Ringwald default: 11760fbf59a1SMatthias Ringwald break; 11770fbf59a1SMatthias Ringwald } 11780fbf59a1SMatthias Ringwald return; 117951764b3bSMatthias Ringwald } 118051764b3bSMatthias Ringwald 11813deb3ec6SMatthias Ringwald if (packet_type != ATT_DATA_PACKET) return; 11823deb3ec6SMatthias Ringwald 11833deb3ec6SMatthias Ringwald // special cases: notifications don't need a context while indications motivate creating one 11843deb3ec6SMatthias Ringwald switch (packet[0]){ 11853deb3ec6SMatthias Ringwald case ATT_HANDLE_VALUE_NOTIFICATION: 1186f8fbdce0SMatthias Ringwald report_gatt_notification(handle, little_endian_read_16(packet,1), &packet[3], size-3); 11873deb3ec6SMatthias Ringwald return; 11883deb3ec6SMatthias Ringwald case ATT_HANDLE_VALUE_INDICATION: 11893deb3ec6SMatthias Ringwald peripheral = provide_context_for_conn_handle(handle); 11903deb3ec6SMatthias Ringwald break; 11913deb3ec6SMatthias Ringwald default: 11923deb3ec6SMatthias Ringwald peripheral = get_gatt_client_context_for_handle(handle); 11933deb3ec6SMatthias Ringwald break; 11943deb3ec6SMatthias Ringwald } 11953deb3ec6SMatthias Ringwald 11967d2258b3SMilanka Ringwald if (peripheral == NULL) return; 11973deb3ec6SMatthias Ringwald 11983deb3ec6SMatthias Ringwald switch (packet[0]){ 11993deb3ec6SMatthias Ringwald case ATT_EXCHANGE_MTU_RESPONSE: 12003deb3ec6SMatthias Ringwald { 1201f8fbdce0SMatthias Ringwald uint16_t remote_rx_mtu = little_endian_read_16(packet, 1); 12023deb3ec6SMatthias Ringwald uint16_t local_rx_mtu = l2cap_max_le_mtu(); 1203c1ab6cc1SMatthias Ringwald peripheral->mtu = (remote_rx_mtu < local_rx_mtu) ? remote_rx_mtu : local_rx_mtu; 12043deb3ec6SMatthias Ringwald peripheral->mtu_state = MTU_EXCHANGED; 12058f37572aSJakob Krantz emit_gatt_mtu_exchanged_result_event(peripheral, peripheral->mtu); 12063deb3ec6SMatthias Ringwald break; 12073deb3ec6SMatthias Ringwald } 12083deb3ec6SMatthias Ringwald case ATT_READ_BY_GROUP_TYPE_RESPONSE: 12093deb3ec6SMatthias Ringwald switch(peripheral->gatt_client_state){ 12103deb3ec6SMatthias Ringwald case P_W4_SERVICE_QUERY_RESULT: 12113deb3ec6SMatthias Ringwald report_gatt_services(peripheral, packet, size); 12123deb3ec6SMatthias Ringwald trigger_next_service_query(peripheral, get_last_result_handle_from_service_list(packet, size)); 12135611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 12143deb3ec6SMatthias Ringwald break; 12153deb3ec6SMatthias Ringwald default: 12163deb3ec6SMatthias Ringwald break; 12173deb3ec6SMatthias Ringwald } 12183deb3ec6SMatthias Ringwald break; 12193deb3ec6SMatthias Ringwald case ATT_HANDLE_VALUE_INDICATION: 1220f8fbdce0SMatthias Ringwald report_gatt_indication(handle, little_endian_read_16(packet,1), &packet[3], size-3); 12213deb3ec6SMatthias Ringwald peripheral->send_confirmation = 1; 12223deb3ec6SMatthias Ringwald break; 12233deb3ec6SMatthias Ringwald 12243deb3ec6SMatthias Ringwald case ATT_READ_BY_TYPE_RESPONSE: 12253deb3ec6SMatthias Ringwald switch (peripheral->gatt_client_state){ 12263deb3ec6SMatthias Ringwald case P_W4_ALL_CHARACTERISTICS_OF_SERVICE_QUERY_RESULT: 12273deb3ec6SMatthias Ringwald report_gatt_characteristics(peripheral, packet, size); 12283deb3ec6SMatthias Ringwald trigger_next_characteristic_query(peripheral, get_last_result_handle_from_characteristics_list(packet, size)); 12295611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done, or by ATT_ERROR 12303deb3ec6SMatthias Ringwald break; 12313deb3ec6SMatthias Ringwald case P_W4_CHARACTERISTIC_WITH_UUID_QUERY_RESULT: 12323deb3ec6SMatthias Ringwald report_gatt_characteristics(peripheral, packet, size); 12333deb3ec6SMatthias Ringwald trigger_next_characteristic_query(peripheral, get_last_result_handle_from_characteristics_list(packet, size)); 12345611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done, or by ATT_ERROR 12353deb3ec6SMatthias Ringwald break; 12363deb3ec6SMatthias Ringwald case P_W4_INCLUDED_SERVICE_QUERY_RESULT: 12373deb3ec6SMatthias Ringwald { 12383deb3ec6SMatthias Ringwald uint16_t uuid16 = 0; 12393deb3ec6SMatthias Ringwald uint16_t pair_size = packet[1]; 12403deb3ec6SMatthias Ringwald 12413deb3ec6SMatthias Ringwald if (pair_size < 7){ 12423deb3ec6SMatthias Ringwald // UUIDs not available, query first included service 1243f8fbdce0SMatthias Ringwald peripheral->start_group_handle = little_endian_read_16(packet, 2); // ready for next query 1244f8fbdce0SMatthias Ringwald peripheral->query_start_handle = little_endian_read_16(packet, 4); 1245f8fbdce0SMatthias Ringwald peripheral->query_end_handle = little_endian_read_16(packet,6); 12463deb3ec6SMatthias Ringwald peripheral->gatt_client_state = P_W2_SEND_INCLUDED_SERVICE_WITH_UUID_QUERY; 12473deb3ec6SMatthias Ringwald break; 12483deb3ec6SMatthias Ringwald } 12493deb3ec6SMatthias Ringwald 12503deb3ec6SMatthias Ringwald uint16_t offset; 12513deb3ec6SMatthias Ringwald for (offset = 2; offset < size; offset += pair_size){ 1252f8fbdce0SMatthias Ringwald uint16_t include_handle = little_endian_read_16(packet, offset); 1253f8fbdce0SMatthias Ringwald peripheral->query_start_handle = little_endian_read_16(packet,offset+2); 1254f8fbdce0SMatthias Ringwald peripheral->query_end_handle = little_endian_read_16(packet,offset+4); 1255f8fbdce0SMatthias Ringwald uuid16 = little_endian_read_16(packet, offset+6); 12563deb3ec6SMatthias Ringwald report_gatt_included_service_uuid16(peripheral, include_handle, uuid16); 12573deb3ec6SMatthias Ringwald } 12583deb3ec6SMatthias Ringwald 12593deb3ec6SMatthias Ringwald trigger_next_included_service_query(peripheral, get_last_result_handle_from_included_services_list(packet, size)); 12605611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 12613deb3ec6SMatthias Ringwald break; 12623deb3ec6SMatthias Ringwald } 1263abdc9fb5SMatthias Ringwald #ifndef ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY 12643deb3ec6SMatthias Ringwald case P_W4_READ_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY_RESULT: 1265f8fbdce0SMatthias Ringwald peripheral->client_characteristic_configuration_handle = little_endian_read_16(packet, 2); 12663deb3ec6SMatthias Ringwald peripheral->gatt_client_state = P_W2_WRITE_CLIENT_CHARACTERISTIC_CONFIGURATION; 12673deb3ec6SMatthias Ringwald break; 1268abdc9fb5SMatthias Ringwald #endif 12693deb3ec6SMatthias Ringwald case P_W4_READ_BY_TYPE_RESPONSE: { 12703deb3ec6SMatthias Ringwald uint16_t pair_size = packet[1]; 12713deb3ec6SMatthias Ringwald uint16_t offset; 12723deb3ec6SMatthias Ringwald uint16_t last_result_handle = 0; 12733deb3ec6SMatthias Ringwald for (offset = 2; offset < size ; offset += pair_size){ 1274f8fbdce0SMatthias Ringwald uint16_t value_handle = little_endian_read_16(packet, offset); 12753deb3ec6SMatthias Ringwald report_gatt_characteristic_value(peripheral, value_handle, &packet[offset+2], pair_size-2); 12763deb3ec6SMatthias Ringwald last_result_handle = value_handle; 12773deb3ec6SMatthias Ringwald } 12783deb3ec6SMatthias Ringwald trigger_next_read_by_type_query(peripheral, last_result_handle); 12793deb3ec6SMatthias Ringwald break; 12803deb3ec6SMatthias Ringwald } 12813deb3ec6SMatthias Ringwald default: 12823deb3ec6SMatthias Ringwald break; 12833deb3ec6SMatthias Ringwald } 12843deb3ec6SMatthias Ringwald break; 12853deb3ec6SMatthias Ringwald case ATT_READ_RESPONSE: 12863deb3ec6SMatthias Ringwald switch (peripheral->gatt_client_state){ 12873deb3ec6SMatthias Ringwald case P_W4_INCLUDED_SERVICE_UUID_WITH_QUERY_RESULT: { 12883deb3ec6SMatthias Ringwald uint8_t uuid128[16]; 12899c80e4ccSMatthias Ringwald reverse_128(&packet[1], uuid128); 12903deb3ec6SMatthias Ringwald report_gatt_included_service_uuid128(peripheral, peripheral->start_group_handle, uuid128); 12913deb3ec6SMatthias Ringwald trigger_next_included_service_query(peripheral, peripheral->start_group_handle); 12925611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 12933deb3ec6SMatthias Ringwald break; 12943deb3ec6SMatthias Ringwald } 12953deb3ec6SMatthias Ringwald case P_W4_READ_CHARACTERISTIC_VALUE_RESULT: 12963deb3ec6SMatthias Ringwald gatt_client_handle_transaction_complete(peripheral); 12973deb3ec6SMatthias Ringwald report_gatt_characteristic_value(peripheral, peripheral->attribute_handle, &packet[1], size-1); 12989cb80b17SMilanka Ringwald emit_gatt_complete_event(peripheral, ATT_ERROR_SUCCESS); 12993deb3ec6SMatthias Ringwald break; 13003deb3ec6SMatthias Ringwald 13013deb3ec6SMatthias Ringwald case P_W4_READ_CHARACTERISTIC_DESCRIPTOR_RESULT:{ 13023deb3ec6SMatthias Ringwald gatt_client_handle_transaction_complete(peripheral); 13033deb3ec6SMatthias Ringwald report_gatt_characteristic_descriptor(peripheral, peripheral->attribute_handle, &packet[1], size-1, 0); 13049cb80b17SMilanka Ringwald emit_gatt_complete_event(peripheral, ATT_ERROR_SUCCESS); 13053deb3ec6SMatthias Ringwald break; 13063deb3ec6SMatthias Ringwald } 13073deb3ec6SMatthias Ringwald default: 13083deb3ec6SMatthias Ringwald break; 13093deb3ec6SMatthias Ringwald } 13103deb3ec6SMatthias Ringwald break; 13113deb3ec6SMatthias Ringwald 13123deb3ec6SMatthias Ringwald case ATT_FIND_BY_TYPE_VALUE_RESPONSE: 13133deb3ec6SMatthias Ringwald { 13143deb3ec6SMatthias Ringwald uint8_t pair_size = 4; 13153deb3ec6SMatthias Ringwald int i; 13163deb3ec6SMatthias Ringwald uint16_t start_group_handle; 13175611a760SMatthias Ringwald uint16_t end_group_handle= 0xffff; // asserts GATT_EVENT_QUERY_COMPLETE is emitted if no results 13183deb3ec6SMatthias Ringwald for (i = 1; i<size; i+=pair_size){ 1319f8fbdce0SMatthias Ringwald start_group_handle = little_endian_read_16(packet,i); 1320f8fbdce0SMatthias Ringwald end_group_handle = little_endian_read_16(packet,i+2); 13213deb3ec6SMatthias Ringwald emit_gatt_service_query_result_event(peripheral, start_group_handle, end_group_handle, peripheral->uuid128); 13223deb3ec6SMatthias Ringwald } 13233deb3ec6SMatthias Ringwald trigger_next_service_by_uuid_query(peripheral, end_group_handle); 13245611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 13253deb3ec6SMatthias Ringwald break; 13263deb3ec6SMatthias Ringwald } 13273deb3ec6SMatthias Ringwald case ATT_FIND_INFORMATION_REPLY: 13283deb3ec6SMatthias Ringwald { 13293deb3ec6SMatthias Ringwald uint8_t pair_size = 4; 13303deb3ec6SMatthias Ringwald if (packet[1] == 2){ 13313deb3ec6SMatthias Ringwald pair_size = 18; 13323deb3ec6SMatthias Ringwald } 1333f8fbdce0SMatthias Ringwald uint16_t last_descriptor_handle = little_endian_read_16(packet, size - pair_size); 1334abdc9fb5SMatthias Ringwald 1335abdc9fb5SMatthias Ringwald #ifdef ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY 1336abdc9fb5SMatthias Ringwald log_info("ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY, state %x", peripheral->gatt_client_state); 1337abdc9fb5SMatthias Ringwald if (peripheral->gatt_client_state == P_W4_FIND_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY_RESULT){ 1338abdc9fb5SMatthias Ringwald // iterate over descriptors looking for CCC 1339abdc9fb5SMatthias Ringwald if (pair_size == 4){ 1340abdc9fb5SMatthias Ringwald int offset = 2; 1341abdc9fb5SMatthias Ringwald while (offset < size){ 1342abdc9fb5SMatthias Ringwald uint16_t uuid16 = little_endian_read_16(packet, offset + 2); 1343abdc9fb5SMatthias Ringwald if (uuid16 == GATT_CLIENT_CHARACTERISTICS_CONFIGURATION){ 1344abdc9fb5SMatthias Ringwald peripheral->client_characteristic_configuration_handle = little_endian_read_16(packet, offset); 1345abdc9fb5SMatthias Ringwald peripheral->gatt_client_state = P_W2_WRITE_CLIENT_CHARACTERISTIC_CONFIGURATION; 1346abdc9fb5SMatthias Ringwald log_info("CCC found %x", peripheral->client_characteristic_configuration_handle); 1347abdc9fb5SMatthias Ringwald break; 1348abdc9fb5SMatthias Ringwald } 1349abdc9fb5SMatthias Ringwald offset += pair_size; 1350abdc9fb5SMatthias Ringwald } 1351abdc9fb5SMatthias Ringwald } 1352abdc9fb5SMatthias Ringwald if (is_query_done(peripheral, last_descriptor_handle)){ 1353abdc9fb5SMatthias Ringwald 1354abdc9fb5SMatthias Ringwald } else { 1355abdc9fb5SMatthias Ringwald // next 1356abdc9fb5SMatthias Ringwald peripheral->start_group_handle = last_descriptor_handle + 1; 1357abdc9fb5SMatthias Ringwald peripheral->gatt_client_state = P_W2_SEND_FIND_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY; 1358abdc9fb5SMatthias Ringwald } 1359abdc9fb5SMatthias Ringwald break; 1360abdc9fb5SMatthias Ringwald } 1361abdc9fb5SMatthias Ringwald #endif 13623deb3ec6SMatthias Ringwald report_gatt_all_characteristic_descriptors(peripheral, &packet[2], size-2, pair_size); 13633deb3ec6SMatthias Ringwald trigger_next_characteristic_descriptor_query(peripheral, last_descriptor_handle); 13645611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 13653deb3ec6SMatthias Ringwald break; 13663deb3ec6SMatthias Ringwald } 13673deb3ec6SMatthias Ringwald 13683deb3ec6SMatthias Ringwald case ATT_WRITE_RESPONSE: 13693deb3ec6SMatthias Ringwald switch (peripheral->gatt_client_state){ 13703deb3ec6SMatthias Ringwald case P_W4_WRITE_CHARACTERISTIC_VALUE_RESULT: 13713deb3ec6SMatthias Ringwald gatt_client_handle_transaction_complete(peripheral); 13729cb80b17SMilanka Ringwald emit_gatt_complete_event(peripheral, ATT_ERROR_SUCCESS); 13733deb3ec6SMatthias Ringwald break; 13743deb3ec6SMatthias Ringwald case P_W4_CLIENT_CHARACTERISTIC_CONFIGURATION_RESULT: 13753deb3ec6SMatthias Ringwald gatt_client_handle_transaction_complete(peripheral); 13769cb80b17SMilanka Ringwald emit_gatt_complete_event(peripheral, ATT_ERROR_SUCCESS); 13773deb3ec6SMatthias Ringwald break; 13783deb3ec6SMatthias Ringwald case P_W4_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT: 13793deb3ec6SMatthias Ringwald gatt_client_handle_transaction_complete(peripheral); 13809cb80b17SMilanka Ringwald emit_gatt_complete_event(peripheral, ATT_ERROR_SUCCESS); 13813deb3ec6SMatthias Ringwald break; 13823deb3ec6SMatthias Ringwald default: 13833deb3ec6SMatthias Ringwald break; 13843deb3ec6SMatthias Ringwald } 13853deb3ec6SMatthias Ringwald break; 13863deb3ec6SMatthias Ringwald 13873deb3ec6SMatthias Ringwald case ATT_READ_BLOB_RESPONSE:{ 13883deb3ec6SMatthias Ringwald uint16_t received_blob_length = size-1; 13893deb3ec6SMatthias Ringwald switch(peripheral->gatt_client_state){ 13903deb3ec6SMatthias Ringwald case P_W4_READ_BLOB_RESULT: 13913deb3ec6SMatthias Ringwald report_gatt_long_characteristic_value_blob(peripheral, peripheral->attribute_handle, &packet[1], received_blob_length, peripheral->attribute_offset); 13923deb3ec6SMatthias Ringwald trigger_next_blob_query(peripheral, P_W2_SEND_READ_BLOB_QUERY, received_blob_length); 13935611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 13943deb3ec6SMatthias Ringwald break; 13953deb3ec6SMatthias Ringwald case P_W4_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_RESULT: 13963deb3ec6SMatthias Ringwald report_gatt_long_characteristic_descriptor(peripheral, peripheral->attribute_handle, 13973deb3ec6SMatthias Ringwald &packet[1], received_blob_length, 13983deb3ec6SMatthias Ringwald peripheral->attribute_offset); 13993deb3ec6SMatthias Ringwald trigger_next_blob_query(peripheral, P_W2_SEND_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_QUERY, received_blob_length); 14005611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 14013deb3ec6SMatthias Ringwald break; 14023deb3ec6SMatthias Ringwald default: 14033deb3ec6SMatthias Ringwald break; 14043deb3ec6SMatthias Ringwald } 14053deb3ec6SMatthias Ringwald break; 14063deb3ec6SMatthias Ringwald } 14073deb3ec6SMatthias Ringwald case ATT_PREPARE_WRITE_RESPONSE: 14083deb3ec6SMatthias Ringwald switch (peripheral->gatt_client_state){ 14093deb3ec6SMatthias Ringwald case P_W4_PREPARE_WRITE_SINGLE_RESULT: 14103deb3ec6SMatthias Ringwald gatt_client_handle_transaction_complete(peripheral); 14113deb3ec6SMatthias Ringwald if (is_value_valid(peripheral, packet, size)){ 14129cb80b17SMilanka Ringwald emit_gatt_complete_event(peripheral, ATT_ERROR_SUCCESS); 14133deb3ec6SMatthias Ringwald } else { 14143deb3ec6SMatthias Ringwald emit_gatt_complete_event(peripheral, ATT_ERROR_DATA_MISMATCH); 14153deb3ec6SMatthias Ringwald } 14163deb3ec6SMatthias Ringwald break; 14173deb3ec6SMatthias Ringwald 14183deb3ec6SMatthias Ringwald case P_W4_PREPARE_WRITE_RESULT:{ 1419f8fbdce0SMatthias Ringwald peripheral->attribute_offset = little_endian_read_16(packet, 3); 14203deb3ec6SMatthias Ringwald trigger_next_prepare_write_query(peripheral, P_W2_PREPARE_WRITE, P_W2_EXECUTE_PREPARED_WRITE); 14215611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 14223deb3ec6SMatthias Ringwald break; 14233deb3ec6SMatthias Ringwald } 14243deb3ec6SMatthias Ringwald case P_W4_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT:{ 1425f8fbdce0SMatthias Ringwald peripheral->attribute_offset = little_endian_read_16(packet, 3); 14263deb3ec6SMatthias Ringwald trigger_next_prepare_write_query(peripheral, P_W2_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR, P_W2_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR); 14275611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 14283deb3ec6SMatthias Ringwald break; 14293deb3ec6SMatthias Ringwald } 14303deb3ec6SMatthias Ringwald case P_W4_PREPARE_RELIABLE_WRITE_RESULT:{ 14313deb3ec6SMatthias Ringwald if (is_value_valid(peripheral, packet, size)){ 1432f8fbdce0SMatthias Ringwald peripheral->attribute_offset = little_endian_read_16(packet, 3); 14333deb3ec6SMatthias Ringwald trigger_next_prepare_write_query(peripheral, P_W2_PREPARE_RELIABLE_WRITE, P_W2_EXECUTE_PREPARED_WRITE); 14345611a760SMatthias Ringwald // GATT_EVENT_QUERY_COMPLETE is emitted by trigger_next_xxx when done 14353deb3ec6SMatthias Ringwald break; 14363deb3ec6SMatthias Ringwald } 14373deb3ec6SMatthias Ringwald peripheral->gatt_client_state = P_W2_CANCEL_PREPARED_WRITE_DATA_MISMATCH; 14383deb3ec6SMatthias Ringwald break; 14393deb3ec6SMatthias Ringwald } 14403deb3ec6SMatthias Ringwald default: 14413deb3ec6SMatthias Ringwald break; 14423deb3ec6SMatthias Ringwald } 14433deb3ec6SMatthias Ringwald break; 14443deb3ec6SMatthias Ringwald 14453deb3ec6SMatthias Ringwald case ATT_EXECUTE_WRITE_RESPONSE: 14463deb3ec6SMatthias Ringwald switch (peripheral->gatt_client_state){ 14473deb3ec6SMatthias Ringwald case P_W4_EXECUTE_PREPARED_WRITE_RESULT: 14483deb3ec6SMatthias Ringwald gatt_client_handle_transaction_complete(peripheral); 14499cb80b17SMilanka Ringwald emit_gatt_complete_event(peripheral, ATT_ERROR_SUCCESS); 14503deb3ec6SMatthias Ringwald break; 14513deb3ec6SMatthias Ringwald case P_W4_CANCEL_PREPARED_WRITE_RESULT: 14523deb3ec6SMatthias Ringwald gatt_client_handle_transaction_complete(peripheral); 14539cb80b17SMilanka Ringwald emit_gatt_complete_event(peripheral, ATT_ERROR_SUCCESS); 14543deb3ec6SMatthias Ringwald break; 14553deb3ec6SMatthias Ringwald case P_W4_CANCEL_PREPARED_WRITE_DATA_MISMATCH_RESULT: 14563deb3ec6SMatthias Ringwald gatt_client_handle_transaction_complete(peripheral); 14573deb3ec6SMatthias Ringwald emit_gatt_complete_event(peripheral, ATT_ERROR_DATA_MISMATCH); 14583deb3ec6SMatthias Ringwald break; 14593deb3ec6SMatthias Ringwald case P_W4_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT: 14603deb3ec6SMatthias Ringwald gatt_client_handle_transaction_complete(peripheral); 14619cb80b17SMilanka Ringwald emit_gatt_complete_event(peripheral, ATT_ERROR_SUCCESS); 14623deb3ec6SMatthias Ringwald break; 14633deb3ec6SMatthias Ringwald default: 14643deb3ec6SMatthias Ringwald break; 14653deb3ec6SMatthias Ringwald 14663deb3ec6SMatthias Ringwald } 14673deb3ec6SMatthias Ringwald break; 14683deb3ec6SMatthias Ringwald 14693deb3ec6SMatthias Ringwald case ATT_READ_MULTIPLE_RESPONSE: 14703deb3ec6SMatthias Ringwald switch(peripheral->gatt_client_state){ 14713deb3ec6SMatthias Ringwald case P_W4_READ_MULTIPLE_RESPONSE: 14723deb3ec6SMatthias Ringwald report_gatt_characteristic_value(peripheral, 0, &packet[1], size-1); 14733deb3ec6SMatthias Ringwald gatt_client_handle_transaction_complete(peripheral); 14749cb80b17SMilanka Ringwald emit_gatt_complete_event(peripheral, ATT_ERROR_SUCCESS); 14753deb3ec6SMatthias Ringwald break; 14763deb3ec6SMatthias Ringwald default: 14773deb3ec6SMatthias Ringwald break; 14783deb3ec6SMatthias Ringwald } 14793deb3ec6SMatthias Ringwald break; 14803deb3ec6SMatthias Ringwald 14813deb3ec6SMatthias Ringwald case ATT_ERROR_RESPONSE: 14823deb3ec6SMatthias Ringwald 14833deb3ec6SMatthias Ringwald switch (packet[4]){ 14843deb3ec6SMatthias Ringwald case ATT_ERROR_ATTRIBUTE_NOT_FOUND: { 14853deb3ec6SMatthias Ringwald switch(peripheral->gatt_client_state){ 14863deb3ec6SMatthias Ringwald case P_W4_SERVICE_QUERY_RESULT: 14873deb3ec6SMatthias Ringwald case P_W4_SERVICE_WITH_UUID_RESULT: 14883deb3ec6SMatthias Ringwald case P_W4_INCLUDED_SERVICE_QUERY_RESULT: 14893deb3ec6SMatthias Ringwald case P_W4_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY_RESULT: 14903deb3ec6SMatthias Ringwald gatt_client_handle_transaction_complete(peripheral); 14919cb80b17SMilanka Ringwald emit_gatt_complete_event(peripheral, ATT_ERROR_SUCCESS); 14923deb3ec6SMatthias Ringwald break; 14933deb3ec6SMatthias Ringwald case P_W4_ALL_CHARACTERISTICS_OF_SERVICE_QUERY_RESULT: 14943deb3ec6SMatthias Ringwald case P_W4_CHARACTERISTIC_WITH_UUID_QUERY_RESULT: 14953deb3ec6SMatthias Ringwald characteristic_end_found(peripheral, peripheral->end_group_handle); 14963deb3ec6SMatthias Ringwald gatt_client_handle_transaction_complete(peripheral); 14979cb80b17SMilanka Ringwald emit_gatt_complete_event(peripheral, ATT_ERROR_SUCCESS); 14983deb3ec6SMatthias Ringwald break; 14993deb3ec6SMatthias Ringwald case P_W4_READ_BY_TYPE_RESPONSE: 15003deb3ec6SMatthias Ringwald gatt_client_handle_transaction_complete(peripheral); 15013deb3ec6SMatthias Ringwald if (peripheral->start_group_handle == peripheral->query_start_handle){ 15023deb3ec6SMatthias Ringwald emit_gatt_complete_event(peripheral, ATT_ERROR_ATTRIBUTE_NOT_FOUND); 15033deb3ec6SMatthias Ringwald } else { 15049cb80b17SMilanka Ringwald emit_gatt_complete_event(peripheral, ATT_ERROR_SUCCESS); 15053deb3ec6SMatthias Ringwald } 15063deb3ec6SMatthias Ringwald break; 15073deb3ec6SMatthias Ringwald default: 15083deb3ec6SMatthias Ringwald gatt_client_report_error_if_pending(peripheral, packet[4]); 15093deb3ec6SMatthias Ringwald break; 15103deb3ec6SMatthias Ringwald } 15113deb3ec6SMatthias Ringwald break; 15123deb3ec6SMatthias Ringwald } 1513f4b33574SMatthias Ringwald 1514f4b33574SMatthias Ringwald #ifdef ENABLE_GATT_CLIENT_PAIRING 1515f4b33574SMatthias Ringwald 1516f4b33574SMatthias Ringwald case ATT_ERROR_INSUFFICIENT_AUTHENTICATION: 1517f4b33574SMatthias Ringwald case ATT_ERROR_INSUFFICIENT_ENCRYPTION_KEY_SIZE: 1518a0e0c2beSMatthias Ringwald case ATT_ERROR_INSUFFICIENT_ENCRYPTION: { 1519a0e0c2beSMatthias Ringwald 1520f4b33574SMatthias Ringwald // security too low 1521f4b33574SMatthias Ringwald if (peripheral->security_counter > 0) { 1522f4b33574SMatthias Ringwald gatt_client_report_error_if_pending(peripheral, packet[4]); 1523f4b33574SMatthias Ringwald break; 1524f4b33574SMatthias Ringwald } 1525f4b33574SMatthias Ringwald // start security 1526f4b33574SMatthias Ringwald peripheral->security_counter++; 1527f4b33574SMatthias Ringwald 1528f4b33574SMatthias Ringwald // setup action 1529f4b33574SMatthias Ringwald int retry = 1; 1530f4b33574SMatthias Ringwald switch (peripheral->gatt_client_state){ 1531f4b33574SMatthias Ringwald case P_W4_READ_CHARACTERISTIC_VALUE_RESULT: 1532f4b33574SMatthias Ringwald peripheral->gatt_client_state = P_W2_SEND_READ_CHARACTERISTIC_VALUE_QUERY ; 1533f4b33574SMatthias Ringwald break; 1534f4b33574SMatthias Ringwald case P_W4_READ_BLOB_RESULT: 1535f4b33574SMatthias Ringwald peripheral->gatt_client_state = P_W2_SEND_READ_BLOB_QUERY; 1536f4b33574SMatthias Ringwald break; 1537f4b33574SMatthias Ringwald case P_W4_READ_BY_TYPE_RESPONSE: 1538f4b33574SMatthias Ringwald peripheral->gatt_client_state = P_W2_SEND_READ_BY_TYPE_REQUEST; 1539f4b33574SMatthias Ringwald break; 1540f4b33574SMatthias Ringwald case P_W4_READ_MULTIPLE_RESPONSE: 1541f4b33574SMatthias Ringwald peripheral->gatt_client_state = P_W2_SEND_READ_MULTIPLE_REQUEST; 1542f4b33574SMatthias Ringwald break; 1543f4b33574SMatthias Ringwald case P_W4_WRITE_CHARACTERISTIC_VALUE_RESULT: 1544f4b33574SMatthias Ringwald peripheral->gatt_client_state = P_W2_SEND_WRITE_CHARACTERISTIC_VALUE; 1545f4b33574SMatthias Ringwald break; 1546f4b33574SMatthias Ringwald case P_W4_PREPARE_WRITE_RESULT: 1547f4b33574SMatthias Ringwald peripheral->gatt_client_state = P_W2_PREPARE_WRITE; 1548f4b33574SMatthias Ringwald break; 1549f4b33574SMatthias Ringwald case P_W4_PREPARE_WRITE_SINGLE_RESULT: 1550f4b33574SMatthias Ringwald peripheral->gatt_client_state = P_W2_PREPARE_WRITE_SINGLE; 1551f4b33574SMatthias Ringwald break; 1552f4b33574SMatthias Ringwald case P_W4_PREPARE_RELIABLE_WRITE_RESULT: 1553f4b33574SMatthias Ringwald peripheral->gatt_client_state = P_W2_PREPARE_RELIABLE_WRITE; 1554f4b33574SMatthias Ringwald break; 1555f4b33574SMatthias Ringwald case P_W4_EXECUTE_PREPARED_WRITE_RESULT: 1556f4b33574SMatthias Ringwald peripheral->gatt_client_state = P_W2_EXECUTE_PREPARED_WRITE; 1557f4b33574SMatthias Ringwald break; 1558f4b33574SMatthias Ringwald case P_W4_CANCEL_PREPARED_WRITE_RESULT: 1559f4b33574SMatthias Ringwald peripheral->gatt_client_state = P_W2_CANCEL_PREPARED_WRITE; 1560f4b33574SMatthias Ringwald break; 1561f4b33574SMatthias Ringwald case P_W4_CANCEL_PREPARED_WRITE_DATA_MISMATCH_RESULT: 1562f4b33574SMatthias Ringwald peripheral->gatt_client_state = P_W2_CANCEL_PREPARED_WRITE_DATA_MISMATCH; 1563f4b33574SMatthias Ringwald break; 1564f4b33574SMatthias Ringwald case P_W4_READ_CHARACTERISTIC_DESCRIPTOR_RESULT: 1565f4b33574SMatthias Ringwald peripheral->gatt_client_state = P_W2_SEND_READ_CHARACTERISTIC_DESCRIPTOR_QUERY; 1566f4b33574SMatthias Ringwald break; 1567f4b33574SMatthias Ringwald case P_W4_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_RESULT: 1568f4b33574SMatthias Ringwald peripheral->gatt_client_state = P_W2_SEND_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_QUERY; 1569f4b33574SMatthias Ringwald break; 1570f4b33574SMatthias Ringwald case P_W4_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT: 1571f4b33574SMatthias Ringwald peripheral->gatt_client_state = P_W2_SEND_WRITE_CHARACTERISTIC_DESCRIPTOR; 1572f4b33574SMatthias Ringwald break; 1573f4b33574SMatthias Ringwald case P_W4_CLIENT_CHARACTERISTIC_CONFIGURATION_RESULT: 1574f4b33574SMatthias Ringwald peripheral->gatt_client_state = P_W2_WRITE_CLIENT_CHARACTERISTIC_CONFIGURATION; 1575f4b33574SMatthias Ringwald break; 1576f4b33574SMatthias Ringwald case P_W4_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT: 1577f4b33574SMatthias Ringwald peripheral->gatt_client_state = P_W2_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR; 1578f4b33574SMatthias Ringwald break; 1579f4b33574SMatthias Ringwald case P_W4_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR_RESULT: 1580f4b33574SMatthias Ringwald peripheral->gatt_client_state = P_W2_EXECUTE_PREPARED_WRITE_CHARACTERISTIC_DESCRIPTOR; 1581f4b33574SMatthias Ringwald break; 1582f4b33574SMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 1583f4b33574SMatthias Ringwald case P_W4_SEND_SINGED_WRITE_DONE: 1584f4b33574SMatthias Ringwald peripheral->gatt_client_state = P_W2_SEND_SIGNED_WRITE; 1585f4b33574SMatthias Ringwald break; 1586f4b33574SMatthias Ringwald #endif 1587f4b33574SMatthias Ringwald default: 1588f4b33574SMatthias Ringwald log_info("retry not supported for state %x", peripheral->gatt_client_state); 1589f4b33574SMatthias Ringwald retry = 0; 1590f4b33574SMatthias Ringwald break; 1591f4b33574SMatthias Ringwald } 1592f4b33574SMatthias Ringwald 1593f4b33574SMatthias Ringwald if (!retry) { 1594f4b33574SMatthias Ringwald gatt_client_report_error_if_pending(peripheral, packet[4]); 1595f4b33574SMatthias Ringwald break; 1596f4b33574SMatthias Ringwald } 1597f4b33574SMatthias Ringwald 1598f4b33574SMatthias Ringwald log_info("security error, start pairing"); 1599f4b33574SMatthias Ringwald 1600f4b33574SMatthias Ringwald // requrest pairing 1601f4b33574SMatthias Ringwald peripheral->wait_for_pairing_complete = 1; 1602f4b33574SMatthias Ringwald peripheral->pending_error_code = packet[4]; 1603f4b33574SMatthias Ringwald sm_request_pairing(peripheral->con_handle); 1604f4b33574SMatthias Ringwald break; 1605a0e0c2beSMatthias Ringwald } 1606f4b33574SMatthias Ringwald #endif 1607f4b33574SMatthias Ringwald 1608f4b33574SMatthias Ringwald // nothing we can do about that 1609f4b33574SMatthias Ringwald case ATT_ERROR_INSUFFICIENT_AUTHORIZATION: 16103deb3ec6SMatthias Ringwald default: 16113deb3ec6SMatthias Ringwald gatt_client_report_error_if_pending(peripheral, packet[4]); 16123deb3ec6SMatthias Ringwald break; 16133deb3ec6SMatthias Ringwald } 16143deb3ec6SMatthias Ringwald break; 16153deb3ec6SMatthias Ringwald 16163deb3ec6SMatthias Ringwald default: 16173deb3ec6SMatthias Ringwald log_info("ATT Handler, unhandled response type 0x%02x", packet[0]); 16183deb3ec6SMatthias Ringwald break; 16193deb3ec6SMatthias Ringwald } 16203deb3ec6SMatthias Ringwald gatt_client_run(); 16213deb3ec6SMatthias Ringwald } 16223deb3ec6SMatthias Ringwald 16237a766ebfSMatthias Ringwald #ifdef ENABLE_LE_SIGNED_WRITE 16243deb3ec6SMatthias Ringwald static void att_signed_write_handle_cmac_result(uint8_t hash[8]){ 1625665d90f2SMatthias Ringwald btstack_linked_list_iterator_t it; 1626665d90f2SMatthias Ringwald btstack_linked_list_iterator_init(&it, &gatt_client_connections); 1627665d90f2SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 1628665d90f2SMatthias Ringwald gatt_client_t * peripheral = (gatt_client_t *) btstack_linked_list_iterator_next(&it); 16293deb3ec6SMatthias Ringwald if (peripheral->gatt_client_state == P_W4_CMAC_RESULT){ 16303deb3ec6SMatthias Ringwald // store result 16316535961aSMatthias Ringwald (void)memcpy(peripheral->cmac, hash, 8); 16329c80e4ccSMatthias Ringwald // reverse_64(hash, peripheral->cmac); 16333deb3ec6SMatthias Ringwald peripheral->gatt_client_state = P_W2_SEND_SIGNED_WRITE; 16343deb3ec6SMatthias Ringwald gatt_client_run(); 16353deb3ec6SMatthias Ringwald return; 16363deb3ec6SMatthias Ringwald } 16373deb3ec6SMatthias Ringwald } 16383deb3ec6SMatthias Ringwald } 16393deb3ec6SMatthias Ringwald 1640711e6c80SMatthias 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){ 16413deb3ec6SMatthias Ringwald gatt_client_t * peripheral = provide_context_for_conn_handle(con_handle); 16427d2258b3SMilanka Ringwald if (peripheral == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 16437d2258b3SMilanka Ringwald if (is_ready(peripheral) == 0) return GATT_CLIENT_IN_WRONG_STATE; 16443deb3ec6SMatthias Ringwald 16459c662c9bSMatthias Ringwald peripheral->callback = callback; 16463deb3ec6SMatthias Ringwald peripheral->attribute_handle = handle; 16473deb3ec6SMatthias Ringwald peripheral->attribute_length = message_len; 16483deb3ec6SMatthias Ringwald peripheral->attribute_value = message; 1649793cf6ceSMatthias Ringwald peripheral->gatt_client_state = P_W4_IDENTITY_RESOLVING; 16503deb3ec6SMatthias Ringwald gatt_client_run(); 165125b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 16523deb3ec6SMatthias Ringwald } 16537a766ebfSMatthias Ringwald #endif 16543deb3ec6SMatthias Ringwald 1655711e6c80SMatthias Ringwald uint8_t gatt_client_discover_primary_services(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 16563deb3ec6SMatthias Ringwald gatt_client_t * peripheral = provide_context_for_conn_handle_and_start_timer(con_handle); 16577d2258b3SMilanka Ringwald if (peripheral == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 16587d2258b3SMilanka Ringwald if (is_ready(peripheral) == 0) return GATT_CLIENT_IN_WRONG_STATE; 16593deb3ec6SMatthias Ringwald 16609c662c9bSMatthias Ringwald peripheral->callback = callback; 16613deb3ec6SMatthias Ringwald peripheral->start_group_handle = 0x0001; 16623deb3ec6SMatthias Ringwald peripheral->end_group_handle = 0xffff; 16633deb3ec6SMatthias Ringwald peripheral->gatt_client_state = P_W2_SEND_SERVICE_QUERY; 16643deb3ec6SMatthias Ringwald peripheral->uuid16 = 0; 16653deb3ec6SMatthias Ringwald gatt_client_run(); 166625b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 16673deb3ec6SMatthias Ringwald } 16683deb3ec6SMatthias Ringwald 16693deb3ec6SMatthias Ringwald 1670711e6c80SMatthias Ringwald uint8_t gatt_client_discover_primary_services_by_uuid16(btstack_packet_handler_t callback, hci_con_handle_t con_handle, uint16_t uuid16){ 16713deb3ec6SMatthias Ringwald gatt_client_t * peripheral = provide_context_for_conn_handle_and_start_timer(con_handle); 16727d2258b3SMilanka Ringwald if (peripheral == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 16737d2258b3SMilanka Ringwald if (is_ready(peripheral) == 0) return GATT_CLIENT_IN_WRONG_STATE; 16743deb3ec6SMatthias Ringwald 16759c662c9bSMatthias Ringwald peripheral->callback = callback; 16763deb3ec6SMatthias Ringwald peripheral->start_group_handle = 0x0001; 16773deb3ec6SMatthias Ringwald peripheral->end_group_handle = 0xffff; 16783deb3ec6SMatthias Ringwald peripheral->gatt_client_state = P_W2_SEND_SERVICE_WITH_UUID_QUERY; 16793deb3ec6SMatthias Ringwald peripheral->uuid16 = uuid16; 1680e1a125dfSMatthias Ringwald uuid_add_bluetooth_prefix((uint8_t*) &(peripheral->uuid128), peripheral->uuid16); 16813deb3ec6SMatthias Ringwald gatt_client_run(); 168225b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 16833deb3ec6SMatthias Ringwald } 16843deb3ec6SMatthias Ringwald 1685711e6c80SMatthias 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){ 16863deb3ec6SMatthias Ringwald gatt_client_t * peripheral = provide_context_for_conn_handle_and_start_timer(con_handle); 16877d2258b3SMilanka Ringwald if (peripheral == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 16887d2258b3SMilanka Ringwald if (is_ready(peripheral) == 0) return GATT_CLIENT_IN_WRONG_STATE; 16893deb3ec6SMatthias Ringwald 16909c662c9bSMatthias Ringwald peripheral->callback = callback; 16913deb3ec6SMatthias Ringwald peripheral->start_group_handle = 0x0001; 16923deb3ec6SMatthias Ringwald peripheral->end_group_handle = 0xffff; 16933deb3ec6SMatthias Ringwald peripheral->uuid16 = 0; 16946535961aSMatthias Ringwald (void)memcpy(peripheral->uuid128, uuid128, 16); 16953deb3ec6SMatthias Ringwald peripheral->gatt_client_state = P_W2_SEND_SERVICE_WITH_UUID_QUERY; 16963deb3ec6SMatthias Ringwald gatt_client_run(); 169725b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 16983deb3ec6SMatthias Ringwald } 16993deb3ec6SMatthias Ringwald 1700711e6c80SMatthias 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){ 17013deb3ec6SMatthias Ringwald gatt_client_t * peripheral = provide_context_for_conn_handle_and_start_timer(con_handle); 17027d2258b3SMilanka Ringwald if (peripheral == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 17037d2258b3SMilanka Ringwald if (is_ready(peripheral) == 0) return GATT_CLIENT_IN_WRONG_STATE; 17043deb3ec6SMatthias Ringwald 17059c662c9bSMatthias Ringwald peripheral->callback = callback; 17063deb3ec6SMatthias Ringwald peripheral->start_group_handle = service->start_group_handle; 17073deb3ec6SMatthias Ringwald peripheral->end_group_handle = service->end_group_handle; 17083deb3ec6SMatthias Ringwald peripheral->filter_with_uuid = 0; 17093deb3ec6SMatthias Ringwald peripheral->characteristic_start_handle = 0; 17103deb3ec6SMatthias Ringwald peripheral->gatt_client_state = P_W2_SEND_ALL_CHARACTERISTICS_OF_SERVICE_QUERY; 17113deb3ec6SMatthias Ringwald gatt_client_run(); 171225b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 17133deb3ec6SMatthias Ringwald } 17143deb3ec6SMatthias Ringwald 1715711e6c80SMatthias 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){ 17163deb3ec6SMatthias Ringwald gatt_client_t * peripheral = provide_context_for_conn_handle_and_start_timer(con_handle); 17177d2258b3SMilanka Ringwald if (peripheral == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 17187d2258b3SMilanka Ringwald if (is_ready(peripheral) == 0) return GATT_CLIENT_IN_WRONG_STATE; 17199c662c9bSMatthias Ringwald peripheral->callback = callback; 17203deb3ec6SMatthias Ringwald peripheral->start_group_handle = service->start_group_handle; 17213deb3ec6SMatthias Ringwald peripheral->end_group_handle = service->end_group_handle; 17223deb3ec6SMatthias Ringwald peripheral->gatt_client_state = P_W2_SEND_INCLUDED_SERVICE_QUERY; 17233deb3ec6SMatthias Ringwald 17243deb3ec6SMatthias Ringwald gatt_client_run(); 172525b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 17263deb3ec6SMatthias Ringwald } 17273deb3ec6SMatthias Ringwald 1728711e6c80SMatthias 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){ 17293deb3ec6SMatthias Ringwald gatt_client_t * peripheral = provide_context_for_conn_handle_and_start_timer(con_handle); 17307d2258b3SMilanka Ringwald if (peripheral == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 17317d2258b3SMilanka Ringwald if (is_ready(peripheral) == 0) return GATT_CLIENT_IN_WRONG_STATE; 17323deb3ec6SMatthias Ringwald 17339c662c9bSMatthias Ringwald peripheral->callback = callback; 17343deb3ec6SMatthias Ringwald peripheral->start_group_handle = start_handle; 17353deb3ec6SMatthias Ringwald peripheral->end_group_handle = end_handle; 17363deb3ec6SMatthias Ringwald peripheral->filter_with_uuid = 1; 17373deb3ec6SMatthias Ringwald peripheral->uuid16 = uuid16; 1738e1a125dfSMatthias Ringwald uuid_add_bluetooth_prefix((uint8_t*) &(peripheral->uuid128), uuid16); 17393deb3ec6SMatthias Ringwald peripheral->characteristic_start_handle = 0; 17403deb3ec6SMatthias Ringwald peripheral->gatt_client_state = P_W2_SEND_CHARACTERISTIC_WITH_UUID_QUERY; 17413deb3ec6SMatthias Ringwald gatt_client_run(); 174225b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 17433deb3ec6SMatthias Ringwald } 17443deb3ec6SMatthias Ringwald 1745711e6c80SMatthias 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){ 17463deb3ec6SMatthias Ringwald gatt_client_t * peripheral = provide_context_for_conn_handle_and_start_timer(con_handle); 17477d2258b3SMilanka Ringwald if (peripheral == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 17487d2258b3SMilanka Ringwald if (is_ready(peripheral) == 0) return GATT_CLIENT_IN_WRONG_STATE; 17493deb3ec6SMatthias Ringwald 17509c662c9bSMatthias Ringwald peripheral->callback = callback; 17513deb3ec6SMatthias Ringwald peripheral->start_group_handle = start_handle; 17523deb3ec6SMatthias Ringwald peripheral->end_group_handle = end_handle; 17533deb3ec6SMatthias Ringwald peripheral->filter_with_uuid = 1; 17543deb3ec6SMatthias Ringwald peripheral->uuid16 = 0; 17556535961aSMatthias Ringwald (void)memcpy(peripheral->uuid128, uuid128, 16); 17563deb3ec6SMatthias Ringwald peripheral->characteristic_start_handle = 0; 17573deb3ec6SMatthias Ringwald peripheral->gatt_client_state = P_W2_SEND_CHARACTERISTIC_WITH_UUID_QUERY; 17583deb3ec6SMatthias Ringwald gatt_client_run(); 175925b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 17603deb3ec6SMatthias Ringwald } 17613deb3ec6SMatthias Ringwald 17623deb3ec6SMatthias Ringwald 1763d25c33e5SMatthias 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){ 17649c662c9bSMatthias Ringwald return gatt_client_discover_characteristics_for_handle_range_by_uuid16(callback, handle, service->start_group_handle, service->end_group_handle, uuid16); 17653deb3ec6SMatthias Ringwald } 17663deb3ec6SMatthias Ringwald 1767d25c33e5SMatthias 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){ 17689c662c9bSMatthias Ringwald return gatt_client_discover_characteristics_for_handle_range_by_uuid128(callback, handle, service->start_group_handle, service->end_group_handle, uuid128); 17693deb3ec6SMatthias Ringwald } 17703deb3ec6SMatthias Ringwald 1771711e6c80SMatthias Ringwald uint8_t gatt_client_discover_characteristic_descriptors(btstack_packet_handler_t callback, hci_con_handle_t con_handle, gatt_client_characteristic_t *characteristic){ 17723deb3ec6SMatthias Ringwald gatt_client_t * peripheral = provide_context_for_conn_handle_and_start_timer(con_handle); 17737d2258b3SMilanka Ringwald if (peripheral == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 17747d2258b3SMilanka Ringwald if (is_ready(peripheral) == 0) return GATT_CLIENT_IN_WRONG_STATE; 17753deb3ec6SMatthias Ringwald 17763deb3ec6SMatthias Ringwald if (characteristic->value_handle == characteristic->end_handle){ 17779cb80b17SMilanka Ringwald emit_gatt_complete_event(peripheral, ATT_ERROR_SUCCESS); 177825b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 17793deb3ec6SMatthias Ringwald } 17809c662c9bSMatthias Ringwald peripheral->callback = callback; 17813deb3ec6SMatthias Ringwald peripheral->start_group_handle = characteristic->value_handle + 1; 17823deb3ec6SMatthias Ringwald peripheral->end_group_handle = characteristic->end_handle; 17833deb3ec6SMatthias Ringwald peripheral->gatt_client_state = P_W2_SEND_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY; 17843deb3ec6SMatthias Ringwald gatt_client_run(); 178525b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 17863deb3ec6SMatthias Ringwald } 17873deb3ec6SMatthias Ringwald 1788711e6c80SMatthias 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){ 17893deb3ec6SMatthias Ringwald gatt_client_t * peripheral = provide_context_for_conn_handle_and_start_timer(con_handle); 17907d2258b3SMilanka Ringwald if (peripheral == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 17917d2258b3SMilanka Ringwald if (is_ready(peripheral) == 0) return GATT_CLIENT_IN_WRONG_STATE; 17923deb3ec6SMatthias Ringwald 17939c662c9bSMatthias Ringwald peripheral->callback = callback; 17943deb3ec6SMatthias Ringwald peripheral->attribute_handle = value_handle; 17953deb3ec6SMatthias Ringwald peripheral->attribute_offset = 0; 17963deb3ec6SMatthias Ringwald peripheral->gatt_client_state = P_W2_SEND_READ_CHARACTERISTIC_VALUE_QUERY; 17973deb3ec6SMatthias Ringwald gatt_client_run(); 179825b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 17993deb3ec6SMatthias Ringwald } 18003deb3ec6SMatthias Ringwald 1801711e6c80SMatthias 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){ 18023deb3ec6SMatthias Ringwald gatt_client_t * peripheral = provide_context_for_conn_handle_and_start_timer(con_handle); 18037d2258b3SMilanka Ringwald if (peripheral == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 18047d2258b3SMilanka Ringwald if (is_ready(peripheral) == 0) return GATT_CLIENT_IN_WRONG_STATE; 18053deb3ec6SMatthias Ringwald 18069c662c9bSMatthias Ringwald peripheral->callback = callback; 18073deb3ec6SMatthias Ringwald peripheral->start_group_handle = start_handle; 18083deb3ec6SMatthias Ringwald peripheral->end_group_handle = end_handle; 18093deb3ec6SMatthias Ringwald peripheral->query_start_handle = start_handle; 18103deb3ec6SMatthias Ringwald peripheral->query_end_handle = end_handle; 18113deb3ec6SMatthias Ringwald peripheral->uuid16 = uuid16; 1812e1a125dfSMatthias Ringwald uuid_add_bluetooth_prefix((uint8_t*) &(peripheral->uuid128), uuid16); 18133deb3ec6SMatthias Ringwald peripheral->gatt_client_state = P_W2_SEND_READ_BY_TYPE_REQUEST; 18143deb3ec6SMatthias Ringwald gatt_client_run(); 181525b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 18163deb3ec6SMatthias Ringwald } 18173deb3ec6SMatthias Ringwald 1818711e6c80SMatthias 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){ 18193deb3ec6SMatthias Ringwald gatt_client_t * peripheral = provide_context_for_conn_handle_and_start_timer(con_handle); 18207d2258b3SMilanka Ringwald if (peripheral == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 18217d2258b3SMilanka Ringwald if (is_ready(peripheral) == 0) return GATT_CLIENT_IN_WRONG_STATE; 18223deb3ec6SMatthias Ringwald 18239c662c9bSMatthias Ringwald peripheral->callback = callback; 18243deb3ec6SMatthias Ringwald peripheral->start_group_handle = start_handle; 18253deb3ec6SMatthias Ringwald peripheral->end_group_handle = end_handle; 18263deb3ec6SMatthias Ringwald peripheral->query_start_handle = start_handle; 18273deb3ec6SMatthias Ringwald peripheral->query_end_handle = end_handle; 18283deb3ec6SMatthias Ringwald peripheral->uuid16 = 0; 18296535961aSMatthias Ringwald (void)memcpy(peripheral->uuid128, uuid128, 16); 18303deb3ec6SMatthias Ringwald peripheral->gatt_client_state = P_W2_SEND_READ_BY_TYPE_REQUEST; 18313deb3ec6SMatthias Ringwald gatt_client_run(); 183225b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 18333deb3ec6SMatthias Ringwald } 18343deb3ec6SMatthias Ringwald 18353deb3ec6SMatthias Ringwald 1836d25c33e5SMatthias Ringwald uint8_t gatt_client_read_value_of_characteristic(btstack_packet_handler_t callback, uint16_t handle, gatt_client_characteristic_t *characteristic){ 18379c662c9bSMatthias Ringwald return gatt_client_read_value_of_characteristic_using_value_handle(callback, handle, characteristic->value_handle); 18383deb3ec6SMatthias Ringwald } 18393deb3ec6SMatthias Ringwald 1840711e6c80SMatthias 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){ 18413deb3ec6SMatthias Ringwald gatt_client_t * peripheral = provide_context_for_conn_handle_and_start_timer(con_handle); 18427d2258b3SMilanka Ringwald if (peripheral == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 18437d2258b3SMilanka Ringwald if (is_ready(peripheral) == 0) return GATT_CLIENT_IN_WRONG_STATE; 18443deb3ec6SMatthias Ringwald 18459c662c9bSMatthias Ringwald peripheral->callback = callback; 18463deb3ec6SMatthias Ringwald peripheral->attribute_handle = characteristic_value_handle; 18473deb3ec6SMatthias Ringwald peripheral->attribute_offset = offset; 18483deb3ec6SMatthias Ringwald peripheral->gatt_client_state = P_W2_SEND_READ_BLOB_QUERY; 18493deb3ec6SMatthias Ringwald gatt_client_run(); 185025b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 18513deb3ec6SMatthias Ringwald } 18523deb3ec6SMatthias Ringwald 1853711e6c80SMatthias 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){ 18549c662c9bSMatthias Ringwald return gatt_client_read_long_value_of_characteristic_using_value_handle_with_offset(callback, con_handle, characteristic_value_handle, 0); 18553deb3ec6SMatthias Ringwald } 18563deb3ec6SMatthias Ringwald 1857d25c33e5SMatthias Ringwald uint8_t gatt_client_read_long_value_of_characteristic(btstack_packet_handler_t callback, uint16_t handle, gatt_client_characteristic_t *characteristic){ 18589c662c9bSMatthias Ringwald return gatt_client_read_long_value_of_characteristic_using_value_handle(callback, handle, characteristic->value_handle); 18593deb3ec6SMatthias Ringwald } 18603deb3ec6SMatthias Ringwald 1861711e6c80SMatthias 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){ 18623deb3ec6SMatthias Ringwald gatt_client_t * peripheral = provide_context_for_conn_handle_and_start_timer(con_handle); 18637d2258b3SMilanka Ringwald if (peripheral == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 18647d2258b3SMilanka Ringwald if (is_ready(peripheral) == 0) return GATT_CLIENT_IN_WRONG_STATE; 18653deb3ec6SMatthias Ringwald 18669c662c9bSMatthias Ringwald peripheral->callback = callback; 18673deb3ec6SMatthias Ringwald peripheral->read_multiple_handle_count = num_value_handles; 18683deb3ec6SMatthias Ringwald peripheral->read_multiple_handles = value_handles; 18693deb3ec6SMatthias Ringwald peripheral->gatt_client_state = P_W2_SEND_READ_MULTIPLE_REQUEST; 18703deb3ec6SMatthias Ringwald gatt_client_run(); 187125b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 18723deb3ec6SMatthias Ringwald } 18733deb3ec6SMatthias Ringwald 1874de9f8e94SMatthias 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){ 18753deb3ec6SMatthias Ringwald gatt_client_t * peripheral = provide_context_for_conn_handle(con_handle); 18767d2258b3SMilanka Ringwald if (peripheral == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 18773deb3ec6SMatthias Ringwald 1878a1df452eSMatthias Ringwald if (value_length > (peripheral_mtu(peripheral) - 3)) return GATT_CLIENT_VALUE_TOO_LONG; 187951764b3bSMatthias Ringwald if (!att_dispatch_client_can_send_now(peripheral->con_handle)) return GATT_CLIENT_BUSY; 18803deb3ec6SMatthias Ringwald 188125b7c058SMilanka Ringwald return att_write_request(ATT_WRITE_COMMAND, peripheral->con_handle, value_handle, value_length, value); 18823deb3ec6SMatthias Ringwald } 18833deb3ec6SMatthias Ringwald 1884711e6c80SMatthias 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){ 18853deb3ec6SMatthias Ringwald gatt_client_t * peripheral = provide_context_for_conn_handle_and_start_timer(con_handle); 18867d2258b3SMilanka Ringwald if (peripheral == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 18877d2258b3SMilanka Ringwald if (is_ready(peripheral) == 0) return GATT_CLIENT_IN_WRONG_STATE; 18883deb3ec6SMatthias Ringwald 18899c662c9bSMatthias Ringwald peripheral->callback = callback; 18903deb3ec6SMatthias Ringwald peripheral->attribute_handle = value_handle; 18913deb3ec6SMatthias Ringwald peripheral->attribute_length = value_length; 18923deb3ec6SMatthias Ringwald peripheral->attribute_value = data; 18933deb3ec6SMatthias Ringwald peripheral->gatt_client_state = P_W2_SEND_WRITE_CHARACTERISTIC_VALUE; 18943deb3ec6SMatthias Ringwald gatt_client_run(); 189525b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 18963deb3ec6SMatthias Ringwald } 18973deb3ec6SMatthias Ringwald 1898711e6c80SMatthias 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){ 18993deb3ec6SMatthias Ringwald gatt_client_t * peripheral = provide_context_for_conn_handle_and_start_timer(con_handle); 19007d2258b3SMilanka Ringwald if (peripheral == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 19017d2258b3SMilanka Ringwald if (is_ready(peripheral) == 0) return GATT_CLIENT_IN_WRONG_STATE; 19023deb3ec6SMatthias Ringwald 19039c662c9bSMatthias Ringwald peripheral->callback = callback; 19043deb3ec6SMatthias Ringwald peripheral->attribute_handle = value_handle; 19053deb3ec6SMatthias Ringwald peripheral->attribute_length = value_length; 19063deb3ec6SMatthias Ringwald peripheral->attribute_offset = offset; 19073deb3ec6SMatthias Ringwald peripheral->attribute_value = data; 19083deb3ec6SMatthias Ringwald peripheral->gatt_client_state = P_W2_PREPARE_WRITE; 19093deb3ec6SMatthias Ringwald gatt_client_run(); 191025b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 19113deb3ec6SMatthias Ringwald } 19123deb3ec6SMatthias Ringwald 1913711e6c80SMatthias 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){ 19149c662c9bSMatthias Ringwald return gatt_client_write_long_value_of_characteristic_with_offset(callback, con_handle, value_handle, 0, value_length, value); 19153deb3ec6SMatthias Ringwald } 19163deb3ec6SMatthias Ringwald 1917711e6c80SMatthias 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){ 19183deb3ec6SMatthias Ringwald gatt_client_t * peripheral = provide_context_for_conn_handle_and_start_timer(con_handle); 19197d2258b3SMilanka Ringwald if (peripheral == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 19207d2258b3SMilanka Ringwald if (is_ready(peripheral) == 0) return GATT_CLIENT_IN_WRONG_STATE; 19213deb3ec6SMatthias Ringwald 19229c662c9bSMatthias Ringwald peripheral->callback = callback; 19233deb3ec6SMatthias Ringwald peripheral->attribute_handle = value_handle; 19243deb3ec6SMatthias Ringwald peripheral->attribute_length = value_length; 19253deb3ec6SMatthias Ringwald peripheral->attribute_offset = 0; 19263deb3ec6SMatthias Ringwald peripheral->attribute_value = value; 19273deb3ec6SMatthias Ringwald peripheral->gatt_client_state = P_W2_PREPARE_RELIABLE_WRITE; 19283deb3ec6SMatthias Ringwald gatt_client_run(); 192925b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 19303deb3ec6SMatthias Ringwald } 19313deb3ec6SMatthias Ringwald 1932711e6c80SMatthias 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){ 19333deb3ec6SMatthias Ringwald gatt_client_t * peripheral = provide_context_for_conn_handle_and_start_timer(con_handle); 19347d2258b3SMilanka Ringwald if (peripheral == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 19357d2258b3SMilanka Ringwald if (is_ready(peripheral) == 0) return GATT_CLIENT_IN_WRONG_STATE; 19363deb3ec6SMatthias Ringwald 19373deb3ec6SMatthias Ringwald if ( (configuration & GATT_CLIENT_CHARACTERISTICS_CONFIGURATION_NOTIFICATION) && 1938a1df452eSMatthias Ringwald ((characteristic->properties & ATT_PROPERTY_NOTIFY) == 0)) { 1939d8e8f12aSMatthias Ringwald log_info("gatt_client_write_client_characteristic_configuration: GATT_CLIENT_CHARACTERISTIC_NOTIFICATION_NOT_SUPPORTED"); 1940616edd56SMatthias Ringwald return GATT_CLIENT_CHARACTERISTIC_NOTIFICATION_NOT_SUPPORTED; 19413deb3ec6SMatthias Ringwald } else if ( (configuration & GATT_CLIENT_CHARACTERISTICS_CONFIGURATION_INDICATION) && 1942a1df452eSMatthias Ringwald ((characteristic->properties & ATT_PROPERTY_INDICATE) == 0)){ 1943d8e8f12aSMatthias Ringwald log_info("gatt_client_write_client_characteristic_configuration: GATT_CLIENT_CHARACTERISTIC_INDICATION_NOT_SUPPORTED"); 1944616edd56SMatthias Ringwald return GATT_CLIENT_CHARACTERISTIC_INDICATION_NOT_SUPPORTED; 19453deb3ec6SMatthias Ringwald } 19463deb3ec6SMatthias Ringwald 19479c662c9bSMatthias Ringwald peripheral->callback = callback; 19483deb3ec6SMatthias Ringwald peripheral->start_group_handle = characteristic->value_handle; 19493deb3ec6SMatthias Ringwald peripheral->end_group_handle = characteristic->end_handle; 1950f8fbdce0SMatthias Ringwald little_endian_store_16(peripheral->client_characteristic_configuration_value, 0, configuration); 19513deb3ec6SMatthias Ringwald 1952abdc9fb5SMatthias Ringwald #ifdef ENABLE_GATT_FIND_INFORMATION_FOR_CCC_DISCOVERY 1953abdc9fb5SMatthias Ringwald peripheral->gatt_client_state = P_W2_SEND_FIND_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY; 1954abdc9fb5SMatthias Ringwald #else 19553deb3ec6SMatthias Ringwald peripheral->gatt_client_state = P_W2_SEND_READ_CLIENT_CHARACTERISTIC_CONFIGURATION_QUERY; 1956abdc9fb5SMatthias Ringwald #endif 19573deb3ec6SMatthias Ringwald gatt_client_run(); 19589cb80b17SMilanka Ringwald return ERROR_CODE_SUCCESS; 19593deb3ec6SMatthias Ringwald } 19603deb3ec6SMatthias Ringwald 1961711e6c80SMatthias 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){ 19623deb3ec6SMatthias Ringwald gatt_client_t * peripheral = provide_context_for_conn_handle_and_start_timer(con_handle); 19637d2258b3SMilanka Ringwald if (peripheral == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 19647d2258b3SMilanka Ringwald if (is_ready(peripheral) == 0) return GATT_CLIENT_IN_WRONG_STATE; 19653deb3ec6SMatthias Ringwald 19669c662c9bSMatthias Ringwald peripheral->callback = callback; 19673deb3ec6SMatthias Ringwald peripheral->attribute_handle = descriptor_handle; 19683deb3ec6SMatthias Ringwald 19693deb3ec6SMatthias Ringwald peripheral->gatt_client_state = P_W2_SEND_READ_CHARACTERISTIC_DESCRIPTOR_QUERY; 19703deb3ec6SMatthias Ringwald gatt_client_run(); 197125b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 19723deb3ec6SMatthias Ringwald } 19733deb3ec6SMatthias Ringwald 1974711e6c80SMatthias 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){ 19759c662c9bSMatthias Ringwald return gatt_client_read_characteristic_descriptor_using_descriptor_handle(callback, con_handle, descriptor->handle); 19763deb3ec6SMatthias Ringwald } 19773deb3ec6SMatthias Ringwald 1978711e6c80SMatthias 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){ 19793deb3ec6SMatthias Ringwald gatt_client_t * peripheral = provide_context_for_conn_handle_and_start_timer(con_handle); 19807d2258b3SMilanka Ringwald if (peripheral == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 19817d2258b3SMilanka Ringwald if (is_ready(peripheral) == 0) return GATT_CLIENT_IN_WRONG_STATE; 19823deb3ec6SMatthias Ringwald 19839c662c9bSMatthias Ringwald peripheral->callback = callback; 19843deb3ec6SMatthias Ringwald peripheral->attribute_handle = descriptor_handle; 19853deb3ec6SMatthias Ringwald peripheral->attribute_offset = offset; 19863deb3ec6SMatthias Ringwald peripheral->gatt_client_state = P_W2_SEND_READ_BLOB_CHARACTERISTIC_DESCRIPTOR_QUERY; 19873deb3ec6SMatthias Ringwald gatt_client_run(); 198825b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 19893deb3ec6SMatthias Ringwald } 19903deb3ec6SMatthias Ringwald 1991711e6c80SMatthias 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){ 19929c662c9bSMatthias Ringwald return gatt_client_read_long_characteristic_descriptor_using_descriptor_handle_with_offset(callback, con_handle, descriptor_handle, 0); 19933deb3ec6SMatthias Ringwald } 19943deb3ec6SMatthias Ringwald 1995711e6c80SMatthias 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){ 19969c662c9bSMatthias Ringwald return gatt_client_read_long_characteristic_descriptor_using_descriptor_handle(callback, con_handle, descriptor->handle); 19973deb3ec6SMatthias Ringwald } 19983deb3ec6SMatthias Ringwald 1999711e6c80SMatthias 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){ 20003deb3ec6SMatthias Ringwald gatt_client_t * peripheral = provide_context_for_conn_handle_and_start_timer(con_handle); 20017d2258b3SMilanka Ringwald if (peripheral == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 20027d2258b3SMilanka Ringwald if (is_ready(peripheral) == 0) return GATT_CLIENT_IN_WRONG_STATE; 20033deb3ec6SMatthias Ringwald 20049c662c9bSMatthias Ringwald peripheral->callback = callback; 20053deb3ec6SMatthias Ringwald peripheral->attribute_handle = descriptor_handle; 20063deb3ec6SMatthias Ringwald peripheral->attribute_length = length; 20073deb3ec6SMatthias Ringwald peripheral->attribute_offset = 0; 20083deb3ec6SMatthias Ringwald peripheral->attribute_value = data; 20093deb3ec6SMatthias Ringwald peripheral->gatt_client_state = P_W2_SEND_WRITE_CHARACTERISTIC_DESCRIPTOR; 20103deb3ec6SMatthias Ringwald gatt_client_run(); 201125b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 20123deb3ec6SMatthias Ringwald } 20133deb3ec6SMatthias Ringwald 2014711e6c80SMatthias 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){ 20159c662c9bSMatthias Ringwald return gatt_client_write_characteristic_descriptor_using_descriptor_handle(callback, con_handle, descriptor->handle, length, value); 20163deb3ec6SMatthias Ringwald } 20173deb3ec6SMatthias Ringwald 2018711e6c80SMatthias 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){ 20193deb3ec6SMatthias Ringwald gatt_client_t * peripheral = provide_context_for_conn_handle_and_start_timer(con_handle); 20207d2258b3SMilanka Ringwald if (peripheral == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 20217d2258b3SMilanka Ringwald if (is_ready(peripheral) == 0) return GATT_CLIENT_IN_WRONG_STATE; 20223deb3ec6SMatthias Ringwald 20239c662c9bSMatthias Ringwald peripheral->callback = callback; 20243deb3ec6SMatthias Ringwald peripheral->attribute_handle = descriptor_handle; 20253deb3ec6SMatthias Ringwald peripheral->attribute_length = length; 20263deb3ec6SMatthias Ringwald peripheral->attribute_offset = offset; 20273deb3ec6SMatthias Ringwald peripheral->attribute_value = data; 20283deb3ec6SMatthias Ringwald peripheral->gatt_client_state = P_W2_PREPARE_WRITE_CHARACTERISTIC_DESCRIPTOR; 20293deb3ec6SMatthias Ringwald gatt_client_run(); 203025b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 20313deb3ec6SMatthias Ringwald } 20323deb3ec6SMatthias Ringwald 2033711e6c80SMatthias 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){ 20349c662c9bSMatthias Ringwald return gatt_client_write_long_characteristic_descriptor_using_descriptor_handle_with_offset(callback, con_handle, descriptor_handle, 0, length, data ); 20353deb3ec6SMatthias Ringwald } 20363deb3ec6SMatthias Ringwald 2037711e6c80SMatthias 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){ 20389c662c9bSMatthias Ringwald return gatt_client_write_long_characteristic_descriptor_using_descriptor_handle(callback, con_handle, descriptor->handle, length, value); 20393deb3ec6SMatthias Ringwald } 20403deb3ec6SMatthias Ringwald 20413deb3ec6SMatthias Ringwald /** 20423deb3ec6SMatthias Ringwald * @brief -> gatt complete event 20433deb3ec6SMatthias Ringwald */ 2044711e6c80SMatthias 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){ 20453deb3ec6SMatthias Ringwald gatt_client_t * peripheral = provide_context_for_conn_handle_and_start_timer(con_handle); 20467d2258b3SMilanka Ringwald if (peripheral == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 20477d2258b3SMilanka Ringwald if (is_ready(peripheral) == 0) return GATT_CLIENT_IN_WRONG_STATE; 20483deb3ec6SMatthias Ringwald 20499c662c9bSMatthias Ringwald peripheral->callback = callback; 20503deb3ec6SMatthias Ringwald peripheral->attribute_handle = attribute_handle; 20513deb3ec6SMatthias Ringwald peripheral->attribute_length = length; 20523deb3ec6SMatthias Ringwald peripheral->attribute_offset = offset; 20533deb3ec6SMatthias Ringwald peripheral->attribute_value = data; 20543deb3ec6SMatthias Ringwald peripheral->gatt_client_state = P_W2_PREPARE_WRITE_SINGLE; 20553deb3ec6SMatthias Ringwald gatt_client_run(); 205625b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 20573deb3ec6SMatthias Ringwald } 20583deb3ec6SMatthias Ringwald 20593deb3ec6SMatthias Ringwald /** 20603deb3ec6SMatthias Ringwald * @brief -> gatt complete event 20613deb3ec6SMatthias Ringwald */ 2062711e6c80SMatthias Ringwald uint8_t gatt_client_execute_write(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 20633deb3ec6SMatthias Ringwald gatt_client_t * peripheral = provide_context_for_conn_handle_and_start_timer(con_handle); 20643deb3ec6SMatthias Ringwald 20657d2258b3SMilanka Ringwald if (peripheral == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 20667d2258b3SMilanka Ringwald if (is_ready(peripheral) == 0) return GATT_CLIENT_IN_WRONG_STATE; 20673deb3ec6SMatthias Ringwald 20689c662c9bSMatthias Ringwald peripheral->callback = callback; 20693deb3ec6SMatthias Ringwald peripheral->gatt_client_state = P_W2_EXECUTE_PREPARED_WRITE; 20703deb3ec6SMatthias Ringwald gatt_client_run(); 207125b7c058SMilanka Ringwald return ERROR_CODE_SUCCESS; 20723deb3ec6SMatthias Ringwald } 20733deb3ec6SMatthias Ringwald 20743deb3ec6SMatthias Ringwald /** 20753deb3ec6SMatthias Ringwald * @brief -> gatt complete event 20763deb3ec6SMatthias Ringwald */ 2077711e6c80SMatthias Ringwald uint8_t gatt_client_cancel_write(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 20783deb3ec6SMatthias Ringwald gatt_client_t * peripheral = provide_context_for_conn_handle_and_start_timer(con_handle); 20797d2258b3SMilanka Ringwald if (peripheral == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 20807d2258b3SMilanka Ringwald if (is_ready(peripheral) == 0) return GATT_CLIENT_IN_WRONG_STATE; 20813deb3ec6SMatthias Ringwald 20829c662c9bSMatthias Ringwald peripheral->callback = callback; 20833deb3ec6SMatthias Ringwald peripheral->gatt_client_state = P_W2_CANCEL_PREPARED_WRITE; 20843deb3ec6SMatthias Ringwald gatt_client_run(); 20857d2258b3SMilanka Ringwald return ERROR_CODE_SUCCESS; 20863deb3ec6SMatthias Ringwald } 20873deb3ec6SMatthias Ringwald 2088313e337bSMatthias Ringwald void gatt_client_deserialize_service(const uint8_t *packet, int offset, gatt_client_service_t *service){ 20896ba2ad22SMatthias Ringwald service->start_group_handle = little_endian_read_16(packet, offset); 20906ba2ad22SMatthias Ringwald service->end_group_handle = little_endian_read_16(packet, offset + 2); 20916ba2ad22SMatthias Ringwald reverse_128(&packet[offset + 4], service->uuid128); 20926ba2ad22SMatthias Ringwald if (uuid_has_bluetooth_prefix(service->uuid128)){ 20936ba2ad22SMatthias Ringwald service->uuid16 = big_endian_read_32(service->uuid128, 0); 2094c839c6f9SMatthias Ringwald } else { 2095c839c6f9SMatthias Ringwald service->uuid16 = 0; 20966ba2ad22SMatthias Ringwald } 20976ba2ad22SMatthias Ringwald } 20986ba2ad22SMatthias Ringwald 2099313e337bSMatthias Ringwald void gatt_client_deserialize_characteristic(const uint8_t * packet, int offset, gatt_client_characteristic_t * characteristic){ 21006ba2ad22SMatthias Ringwald characteristic->start_handle = little_endian_read_16(packet, offset); 21016ba2ad22SMatthias Ringwald characteristic->value_handle = little_endian_read_16(packet, offset + 2); 21026ba2ad22SMatthias Ringwald characteristic->end_handle = little_endian_read_16(packet, offset + 4); 21036ba2ad22SMatthias Ringwald characteristic->properties = little_endian_read_16(packet, offset + 6); 210486c38559SMatthias Ringwald reverse_128(&packet[offset+8], characteristic->uuid128); 21056ba2ad22SMatthias Ringwald if (uuid_has_bluetooth_prefix(characteristic->uuid128)){ 21066ba2ad22SMatthias Ringwald characteristic->uuid16 = big_endian_read_32(characteristic->uuid128, 0); 2107c839c6f9SMatthias Ringwald } else { 2108c839c6f9SMatthias Ringwald characteristic->uuid16 = 0; 21096ba2ad22SMatthias Ringwald } 21106ba2ad22SMatthias Ringwald } 21116ba2ad22SMatthias Ringwald 2112313e337bSMatthias Ringwald void gatt_client_deserialize_characteristic_descriptor(const uint8_t * packet, int offset, gatt_client_characteristic_descriptor_t * descriptor){ 21136ba2ad22SMatthias Ringwald descriptor->handle = little_endian_read_16(packet, offset); 21146ba2ad22SMatthias Ringwald reverse_128(&packet[offset+2], descriptor->uuid128); 2115b4895529SJakob Krantz if (uuid_has_bluetooth_prefix(descriptor->uuid128)){ 2116b4895529SJakob Krantz descriptor->uuid16 = big_endian_read_32(descriptor->uuid128, 0); 2117c839c6f9SMatthias Ringwald } else { 2118c839c6f9SMatthias Ringwald descriptor->uuid16 = 0; 2119b4895529SJakob Krantz } 21206ba2ad22SMatthias Ringwald } 21215cf6c434SJakob Krantz 21225cf6c434SJakob Krantz void gatt_client_send_mtu_negotiation(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 21235cf6c434SJakob Krantz gatt_client_t * context = provide_context_for_conn_handle(con_handle); 21247d2258b3SMilanka Ringwald if (context == NULL) return; 21255cf6c434SJakob Krantz if (context->mtu_state == MTU_AUTO_EXCHANGE_DISABLED){ 21265cf6c434SJakob Krantz context->callback = callback; 21275cf6c434SJakob Krantz context->mtu_state = SEND_MTU_EXCHANGE; 21285cf6c434SJakob Krantz gatt_client_run(); 21295cf6c434SJakob Krantz } 21305cf6c434SJakob Krantz } 213147181045SMatthias Ringwald 213247181045SMatthias Ringwald uint8_t gatt_client_request_can_write_without_response_event(btstack_packet_handler_t callback, hci_con_handle_t con_handle){ 213347181045SMatthias Ringwald gatt_client_t * context = provide_context_for_conn_handle(con_handle); 21347d2258b3SMilanka Ringwald if (context == NULL) return BTSTACK_MEMORY_ALLOC_FAILED; 21357d2258b3SMilanka Ringwald if (context->write_without_response_callback != NULL) return GATT_CLIENT_IN_WRONG_STATE; 213647181045SMatthias Ringwald context->write_without_response_callback = callback; 213747181045SMatthias Ringwald att_dispatch_client_request_can_send_now_event(context->con_handle); 21387d2258b3SMilanka Ringwald return ERROR_CODE_SUCCESS; 213947181045SMatthias Ringwald } 2140