11f504dbdSmatthias.ringwald /* 2a0c35809S[email protected] * Copyright (C) 2014 BlueKitchen GmbH 31713bceaSmatthias.ringwald * 41713bceaSmatthias.ringwald * Redistribution and use in source and binary forms, with or without 51713bceaSmatthias.ringwald * modification, are permitted provided that the following conditions 61713bceaSmatthias.ringwald * are met: 71713bceaSmatthias.ringwald * 81713bceaSmatthias.ringwald * 1. Redistributions of source code must retain the above copyright 91713bceaSmatthias.ringwald * notice, this list of conditions and the following disclaimer. 101713bceaSmatthias.ringwald * 2. Redistributions in binary form must reproduce the above copyright 111713bceaSmatthias.ringwald * notice, this list of conditions and the following disclaimer in the 121713bceaSmatthias.ringwald * documentation and/or other materials provided with the distribution. 131713bceaSmatthias.ringwald * 3. Neither the name of the copyright holders nor the names of 141713bceaSmatthias.ringwald * contributors may be used to endorse or promote products derived 151713bceaSmatthias.ringwald * from this software without specific prior written permission. 166b64433eSmatthias.ringwald * 4. Any redistribution, use, or modification is done solely for 176b64433eSmatthias.ringwald * personal benefit and not for any commercial purpose or for 186b64433eSmatthias.ringwald * monetary gain. 191713bceaSmatthias.ringwald * 20a0c35809S[email protected] * THIS SOFTWARE IS PROVIDED BY BLUEKITCHEN GMBH AND CONTRIBUTORS 211713bceaSmatthias.ringwald * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 221713bceaSmatthias.ringwald * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS 232fca4dadSMilanka Ringwald * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL BLUEKITCHEN 242fca4dadSMilanka Ringwald * GMBH OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, 251713bceaSmatthias.ringwald * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, 261713bceaSmatthias.ringwald * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS 271713bceaSmatthias.ringwald * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED 281713bceaSmatthias.ringwald * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, 291713bceaSmatthias.ringwald * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF 301713bceaSmatthias.ringwald * THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 311713bceaSmatthias.ringwald * SUCH DAMAGE. 321713bceaSmatthias.ringwald * 33a0c35809S[email protected] * Please inquire about commercial licensing options at 34a0c35809S[email protected] * [email protected] 356b64433eSmatthias.ringwald * 361713bceaSmatthias.ringwald */ 371713bceaSmatthias.ringwald 38e501bae0SMatthias Ringwald #define BTSTACK_FILE__ "hci.c" 39ab2c6ae4SMatthias Ringwald 401713bceaSmatthias.ringwald /* 411f504dbdSmatthias.ringwald * hci.c 421f504dbdSmatthias.ringwald * 431f504dbdSmatthias.ringwald * Created by Matthias Ringwald on 4/29/09. 441f504dbdSmatthias.ringwald * 451f504dbdSmatthias.ringwald */ 461f504dbdSmatthias.ringwald 477907f069SMatthias Ringwald #include "btstack_config.h" 4828171530Smatthias.ringwald 497f2435e6Smatthias.ringwald 5006b9e820SMatthias Ringwald #ifdef ENABLE_CLASSIC 51aec7654dSMatthias Ringwald #ifdef HAVE_EMBEDDED_TICK 528f2a52f4SMatthias Ringwald #include "btstack_run_loop_embedded.h" 53a484130cSMatthias Ringwald #endif 5406b9e820SMatthias Ringwald #endif 55a484130cSMatthias Ringwald 56a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE 57472a5742SMatthias Ringwald #include "gap.h" 5821debf25SMatthias Ringwald #include "ble/le_device_db.h" 5945c102fdSMatthias Ringwald #endif 6045c102fdSMatthias Ringwald 6193b8dc03Smatthias.ringwald #include <stdarg.h> 6293b8dc03Smatthias.ringwald #include <string.h> 635838a2edSMatthias Ringwald #include <inttypes.h> 647f2435e6Smatthias.ringwald 6516ece135SMatthias Ringwald #include "btstack_debug.h" 660e2df43fSMatthias Ringwald #include "btstack_event.h" 674a3574a1SMatthias Ringwald #include "btstack_linked_list.h" 684a3574a1SMatthias Ringwald #include "btstack_memory.h" 6961f37892SMatthias Ringwald #include "bluetooth_company_id.h" 701cfb383eSMatthias Ringwald #include "bluetooth_data_types.h" 714a3574a1SMatthias Ringwald #include "gap.h" 724a3574a1SMatthias Ringwald #include "hci.h" 734a3574a1SMatthias Ringwald #include "hci_cmd.h" 74d8905019Smatthias.ringwald #include "hci_dump.h" 751cfb383eSMatthias Ringwald #include "ad_parser.h" 7693b8dc03Smatthias.ringwald 778ad9cf99SMatthias Ringwald #ifdef ENABLE_CONTROLLER_DUMP_PACKETS 788ad9cf99SMatthias Ringwald #include <stdio.h> // sprintf 798ad9cf99SMatthias Ringwald #endif 808ad9cf99SMatthias Ringwald 812b838201SMatthias Ringwald #ifdef ENABLE_HCI_CONTROLLER_TO_HOST_FLOW_CONTROL 822b838201SMatthias Ringwald #ifndef HCI_HOST_ACL_PACKET_NUM 832b838201SMatthias Ringwald #error "ENABLE_HCI_CONTROLLER_TO_HOST_FLOW_CONTROL requires to define HCI_HOST_ACL_PACKET_NUM" 842b838201SMatthias Ringwald #endif 852b838201SMatthias Ringwald #ifndef HCI_HOST_ACL_PACKET_LEN 862b838201SMatthias Ringwald #error "ENABLE_HCI_CONTROLLER_TO_HOST_FLOW_CONTROL requires to define HCI_HOST_ACL_PACKET_LEN" 872b838201SMatthias Ringwald #endif 882b838201SMatthias Ringwald #ifndef HCI_HOST_SCO_PACKET_NUM 892b838201SMatthias Ringwald #error "ENABLE_HCI_CONTROLLER_TO_HOST_FLOW_CONTROL requires to define HCI_HOST_SCO_PACKET_NUM" 902b838201SMatthias Ringwald #endif 912b838201SMatthias Ringwald #ifndef HCI_HOST_SCO_PACKET_LEN 922b838201SMatthias Ringwald #error "ENABLE_HCI_CONTROLLER_TO_HOST_FLOW_CONTROL requires to define HCI_HOST_SCO_PACKET_LEN" 932b838201SMatthias Ringwald #endif 942b838201SMatthias Ringwald #endif 951b0e3922Smatthias.ringwald 96616cfd90SMatthias Ringwald #ifndef MAX_NR_CONTROLLER_ACL_BUFFERS 97616cfd90SMatthias Ringwald #define MAX_NR_CONTROLLER_ACL_BUFFERS 255 98616cfd90SMatthias Ringwald #endif 99616cfd90SMatthias Ringwald #ifndef MAX_NR_CONTROLLER_SCO_PACKETS 100616cfd90SMatthias Ringwald #define MAX_NR_CONTROLLER_SCO_PACKETS 255 101616cfd90SMatthias Ringwald #endif 102616cfd90SMatthias Ringwald 1036bcf18c2SMatthias Ringwald #ifndef HCI_ACL_CHUNK_SIZE_ALIGNMENT 1046bcf18c2SMatthias Ringwald #define HCI_ACL_CHUNK_SIZE_ALIGNMENT 1 1056bcf18c2SMatthias Ringwald #endif 1066bcf18c2SMatthias Ringwald 107aa81e641SMatthias Ringwald #if defined(ENABLE_SCO_OVER_HCI) && defined(ENABLE_SCO_OVER_PCM) 108aa81e641SMatthias Ringwald #error "SCO data can either be routed over HCI or over PCM, but not over both. Please only enable ENABLE_SCO_OVER_HCI or ENABLE_SCO_OVER_PCM." 109aa81e641SMatthias Ringwald #endif 110aa81e641SMatthias Ringwald 1111e20a53eSMatthias Ringwald #if defined(ENABLE_SCO_OVER_HCI) && defined(HAVE_SCO_TRANSPORT) 1121e20a53eSMatthias Ringwald #error "SCO data can either be routed over HCI or over PCM, but not over both. Please only enable ENABLE_SCO_OVER_HCI or HAVE_SCO_TRANSPORT." 1131e20a53eSMatthias Ringwald #endif 1141e20a53eSMatthias Ringwald 115169f8b28Smatthias.ringwald #define HCI_CONNECTION_TIMEOUT_MS 10000 11662473419SMatthias Ringwald 11762473419SMatthias Ringwald #ifndef HCI_RESET_RESEND_TIMEOUT_MS 118659d758cSMatthias Ringwald #define HCI_RESET_RESEND_TIMEOUT_MS 200 11962473419SMatthias Ringwald #endif 120ee091cf1Smatthias.ringwald 1211cfb383eSMatthias Ringwald // Names are arbitrarily shortened to 32 bytes if not requested otherwise 1221cfb383eSMatthias Ringwald #ifndef GAP_INQUIRY_MAX_NAME_LEN 1231cfb383eSMatthias Ringwald #define GAP_INQUIRY_MAX_NAME_LEN 32 1241cfb383eSMatthias Ringwald #endif 1251cfb383eSMatthias Ringwald 126f5875de5SMatthias Ringwald // GAP inquiry state: 0 = off, 0x01 - 0x30 = requested duration, 0xfe = active, 0xff = stop requested 127f5875de5SMatthias Ringwald #define GAP_INQUIRY_DURATION_MIN 0x01 128f5875de5SMatthias Ringwald #define GAP_INQUIRY_DURATION_MAX 0x30 12930199e24SMatthias Ringwald #define GAP_INQUIRY_MIN_PERIODIC_LEN_MIN 0x02 13030199e24SMatthias Ringwald #define GAP_INQUIRY_MAX_PERIODIC_LEN_MIN 0x03 131beb3c81dSMatthias Ringwald #define GAP_INQUIRY_STATE_IDLE 0x00 132beb3c81dSMatthias Ringwald #define GAP_INQUIRY_STATE_W4_ACTIVE 0x80 133beb3c81dSMatthias Ringwald #define GAP_INQUIRY_STATE_ACTIVE 0x81 134beb3c81dSMatthias Ringwald #define GAP_INQUIRY_STATE_W2_CANCEL 0x82 135beb3c81dSMatthias Ringwald #define GAP_INQUIRY_STATE_W4_CANCELLED 0x83 13630199e24SMatthias Ringwald #define GAP_INQUIRY_STATE_PERIODIC 0x84 13730199e24SMatthias Ringwald #define GAP_INQUIRY_STATE_W2_EXIT_PERIODIC 0x85 138f5875de5SMatthias Ringwald 139b7f1ee76SMatthias Ringwald // GAP Remote Name Request 140b7f1ee76SMatthias Ringwald #define GAP_REMOTE_NAME_STATE_IDLE 0 141b7f1ee76SMatthias Ringwald #define GAP_REMOTE_NAME_STATE_W2_SEND 1 142b7f1ee76SMatthias Ringwald #define GAP_REMOTE_NAME_STATE_W4_COMPLETE 2 143b7f1ee76SMatthias Ringwald 1440a51f88bSMatthias Ringwald // GAP Pairing 1450a51f88bSMatthias Ringwald #define GAP_PAIRING_STATE_IDLE 0 1460a51f88bSMatthias Ringwald #define GAP_PAIRING_STATE_SEND_PIN 1 1470a51f88bSMatthias Ringwald #define GAP_PAIRING_STATE_SEND_PIN_NEGATIVE 2 1480a51f88bSMatthias Ringwald #define GAP_PAIRING_STATE_SEND_PASSKEY 3 1490a51f88bSMatthias Ringwald #define GAP_PAIRING_STATE_SEND_PASSKEY_NEGATIVE 4 1500a51f88bSMatthias Ringwald #define GAP_PAIRING_STATE_SEND_CONFIRMATION 5 1510a51f88bSMatthias Ringwald #define GAP_PAIRING_STATE_SEND_CONFIRMATION_NEGATIVE 6 152cc15bb2cSMatthias Ringwald #define GAP_PAIRING_STATE_WAIT_FOR_COMMAND_COMPLETE 7 1530a51f88bSMatthias Ringwald 15425e46151SMatthias Ringwald // 1559ce37759SMatthias Ringwald // compact storage of relevant supported HCI Commands. 1569ce37759SMatthias Ringwald // X-Macro below provides enumeration and mapping table into the supported 15725e46151SMatthias Ringwald // commands bitmap (64 bytes) from HCI Read Local Supported Commands 15825e46151SMatthias Ringwald // 15925e46151SMatthias Ringwald 16025e46151SMatthias Ringwald // format: command name, byte offset, bit nr in 64-byte supported commands 1618c021356SMatthias Ringwald // currently stored in 32-bit variable 16225e46151SMatthias Ringwald #define SUPPORTED_HCI_COMMANDS \ 1639ce37759SMatthias Ringwald X( SUPPORTED_HCI_COMMAND_READ_REMOTE_EXTENDED_FEATURES , 2, 5) \ 16425e46151SMatthias Ringwald X( SUPPORTED_HCI_COMMAND_WRITE_SYNCHRONOUS_FLOW_CONTROL_ENABLE , 10, 4) \ 1659ce37759SMatthias Ringwald X( SUPPORTED_HCI_COMMAND_READ_BUFFER_SIZE , 14, 7) \ 16625e46151SMatthias Ringwald X( SUPPORTED_HCI_COMMAND_WRITE_DEFAULT_ERRONEOUS_DATA_REPORTING, 18, 3) \ 1679ce37759SMatthias Ringwald X( SUPPORTED_HCI_COMMAND_READ_ENCRYPTION_KEY_SIZE , 20, 4) \ 168ff7d1758SMatthias Ringwald X( SUPPORTED_HCI_COMMAND_SET_EVENT_MASK_PAGE_2 , 22, 2) \ 1699ce37759SMatthias Ringwald X( SUPPORTED_HCI_COMMAND_WRITE_LE_HOST_SUPPORTED , 24, 6) \ 1704639b1e4SMatthias Ringwald X( SUPPORTED_HCI_COMMAND_LE_READ_REMOTE_FEATURES , 27, 5) \ 1719ce37759SMatthias Ringwald X( SUPPORTED_HCI_COMMAND_REMOTE_OOB_EXTENDED_DATA_REQUEST_REPLY, 32, 1) \ 1729ce37759SMatthias Ringwald X( SUPPORTED_HCI_COMMAND_WRITE_SECURE_CONNECTIONS_HOST , 32, 3) \ 1739ce37759SMatthias Ringwald X( SUPPORTED_HCI_COMMAND_READ_LOCAL_OOB_EXTENDED_DATA_COMMAND , 32, 6) \ 17425e46151SMatthias Ringwald X( SUPPORTED_HCI_COMMAND_LE_WRITE_SUGGESTED_DEFAULT_DATA_LENGTH, 34, 0) \ 17525e46151SMatthias Ringwald X( SUPPORTED_HCI_COMMAND_LE_SET_ADDRESS_RESOLUTION_ENABLE , 35, 1) \ 176a391128dSMatthias Ringwald X( SUPPORTED_HCI_COMMAND_LE_READ_MAXIMUM_DATA_LENGTH , 35, 3) \ 1779ce37759SMatthias Ringwald X( SUPPORTED_HCI_COMMAND_LE_SET_DEFAULT_PHY , 35, 5) \ 17863671e69SMatthias Ringwald X( SUPPORTED_HCI_COMMAND_LE_SET_EXTENDED_ADVERTISING_ENABLE , 36, 6) \ 17979b7ea2dSMatthias Ringwald X( SUPPORTED_HCI_COMMAND_LE_READ_BUFFER_SIZE_V2 , 41, 5) \ 180a391128dSMatthias Ringwald X( SUPPORTED_HCI_COMMAND_SET_MIN_ENCRYPTION_KEY_SIZE , 45, 7) \ 18125e46151SMatthias Ringwald 18225e46151SMatthias Ringwald // enumerate supported commands 18325e46151SMatthias Ringwald #define X(name, offset, bit) name, 18425e46151SMatthias Ringwald enum { 18525e46151SMatthias Ringwald SUPPORTED_HCI_COMMANDS 18625e46151SMatthias Ringwald SUPPORTED_HCI_COMMANDS_COUNT 18725e46151SMatthias Ringwald }; 18825e46151SMatthias Ringwald #undef X 18925e46151SMatthias Ringwald 190b83d5eabSMatthias Ringwald // prototypes 19135454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 192758b46ceSmatthias.ringwald static void hci_update_scan_enable(void); 19371fd255dSMatthias Ringwald static void hci_emit_scan_mode_changed(uint8_t discoverable, uint8_t connectable); 19435454696SMatthias Ringwald static int hci_local_ssp_activated(void); 19520dcdd22SMatthias Ringwald static bool hci_remote_ssp_supported(hci_con_handle_t con_handle); 19667aae551SMatthias Ringwald static bool hci_ssp_supported(hci_connection_t * connection); 19735454696SMatthias Ringwald static void hci_notify_if_sco_can_send_now(void); 19835454696SMatthias Ringwald static void hci_emit_connection_complete(bd_addr_t address, hci_con_handle_t con_handle, uint8_t status); 199a00031e2S[email protected] static gap_security_level_t gap_security_level_for_connection(hci_connection_t * connection); 20035454696SMatthias Ringwald static void hci_emit_security_level(hci_con_handle_t con_handle, gap_security_level_t level); 201ec820d77SMatthias Ringwald static void hci_connection_timeout_handler(btstack_timer_source_t *timer); 20296a45072S[email protected] static void hci_connection_timestamp(hci_connection_t *connection); 20352db98b2SMatthias Ringwald static void hci_emit_l2cap_check_timeout(hci_connection_t *conn); 2049784dac1SMatthias Ringwald static void gap_inquiry_explode(uint8_t *packet, uint16_t size); 20552db98b2SMatthias Ringwald #endif 2061cfb383eSMatthias Ringwald 2077586ee35S[email protected] static int hci_power_control_on(void); 2087586ee35S[email protected] static void hci_power_control_off(void); 2096da48142SSean Wilson static void hci_state_reset(void); 210685ec254SMatthias Ringwald static void hci_halting_timeout_handler(btstack_timer_source_t * ds); 211fd43c0e0SMatthias Ringwald static void hci_emit_transport_packet_sent(void); 212fc64f94aSMatthias Ringwald static void hci_emit_disconnection_complete(hci_con_handle_t con_handle, uint8_t reason); 213b83d5eabSMatthias Ringwald static void hci_emit_nr_connections_changed(void); 214b83d5eabSMatthias Ringwald static void hci_emit_hci_open_failed(void); 215b83d5eabSMatthias Ringwald static void hci_emit_dedicated_bonding_result(bd_addr_t address, uint8_t status); 216b83d5eabSMatthias Ringwald static void hci_emit_event(uint8_t * event, uint16_t size, int dump); 217b83d5eabSMatthias Ringwald static void hci_emit_acl_packet(uint8_t * packet, uint16_t size); 21895d71764SMatthias Ringwald static void hci_run(void); 219617c03d6SMatthias Ringwald static bool hci_is_le_connection(hci_connection_t * connection); 220ed208344SMatthias Ringwald static uint8_t hci_send_prepared_cmd_packet(void); 2216a5ffed8SMatthias Ringwald 2226a5ffed8SMatthias Ringwald #ifdef ENABLE_CLASSIC 223f234b250SMatthias Ringwald static int hci_have_usb_transport(void); 224dbe0d85cSMatthias Ringwald static void hci_trigger_remote_features_for_connection(hci_connection_t * connection); 2256a5ffed8SMatthias Ringwald #endif 2265d509858SMatthias Ringwald 227a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE 228137a570aSMatthias Ringwald static bool hci_run_general_gap_le(void); 229137a570aSMatthias Ringwald static void gap_privacy_clients_handle_ready(void); 230137a570aSMatthias Ringwald static void gap_privacy_clients_notify(bd_addr_t new_random_address); 231e8c8828eSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 23239677e66SMatthias Ringwald // called from test/ble_client/advertising_data_parser.c 233384b59deSMatthias Ringwald void le_handle_advertisement_report(uint8_t *packet, uint16_t size); 234667ba9d1SMatthias Ringwald static uint8_t hci_whitelist_remove(bd_addr_type_t address_type, const bd_addr_t address); 235ca0d6e5aSMatthias Ringwald static hci_connection_t * gap_get_outgoing_le_connection(void); 236c42da3bcSMatthias Ringwald static void hci_le_scan_stop(void); 2375d509858SMatthias Ringwald #endif 23825df6c61SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 239ee54aff5SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 24025df6c61SMatthias Ringwald static le_advertising_set_t * hci_advertising_set_for_handle(uint8_t advertising_handle); 241033393eeSBob Abeles static uint8_t hci_le_extended_advertising_operation_for_chunk(uint16_t pos, uint16_t len); 242033393eeSBob Abeles static void le_handle_extended_advertisement_report(uint8_t *packet, uint16_t size); 243ee54aff5SMatthias Ringwald #endif /* ENABLE_LE_EXTENDED_ADVERTISING */ 244ee54aff5SMatthias Ringwald #endif /* ENABLE_LE_PERIPHERAL */ 2454ae8623eSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS 246969d876aSMatthias Ringwald static hci_iso_stream_t * hci_iso_stream_create(hci_iso_type_t iso_type, hci_iso_stream_state_t state, uint8_t group_id, uint8_t stream_id); 2474ae8623eSMatthias Ringwald static void hci_iso_stream_finalize(hci_iso_stream_t * iso_stream); 248778463d0SMatthias Ringwald static void hci_iso_stream_finalize_by_type_and_group_id(hci_iso_type_t iso_type, uint8_t group_id); 24915a15be3SMatthias Ringwald static hci_iso_stream_t * hci_iso_stream_for_con_handle(hci_con_handle_t con_handle); 25015a15be3SMatthias Ringwald static void hci_iso_stream_requested_finalize(uint8_t big_handle); 25115a15be3SMatthias Ringwald static void hci_iso_stream_requested_confirm(uint8_t big_handle); 252750818acSMatthias Ringwald static void hci_iso_packet_handler(hci_iso_stream_t *iso_stream, uint8_t *packet, uint16_t size); 2537aa35f6aSMatthias Ringwald static le_audio_big_t * hci_big_for_handle(uint8_t big_handle); 254d3a89d91SMatthias Ringwald static le_audio_cig_t * hci_cig_for_id(uint8_t cig_id); 2555ade6657SMatthias Ringwald static void hci_iso_notify_can_send_now(void); 2567aa35f6aSMatthias Ringwald static void hci_emit_big_created(const le_audio_big_t * big, uint8_t status); 2577aa35f6aSMatthias Ringwald static void hci_emit_big_terminated(const le_audio_big_t * big); 2582a6c0f82SMatthias Ringwald static void hci_emit_big_sync_created(const le_audio_big_sync_t * big_sync, uint8_t status); 259d04a9afcSMatthias Ringwald static void hci_emit_big_sync_stopped(uint8_t big_handle); 260d3a89d91SMatthias Ringwald static void hci_emit_cig_created(const le_audio_cig_t * cig, uint8_t status); 26114045fdbSMatthias Ringwald static void hci_cis_handle_created(hci_iso_stream_t * iso_stream, uint8_t status); 2622a6c0f82SMatthias Ringwald static le_audio_big_sync_t * hci_big_sync_for_handle(uint8_t big_handle); 2634ae8623eSMatthias Ringwald #endif /* ENABLE_LE_ISOCHRONOUS_STREAMS */ 264ee54aff5SMatthias Ringwald #endif /* ENABLE_BLE */ 265758b46ceSmatthias.ringwald 26606b35ec0Smatthias.ringwald // the STACK is here 2673a9fb326S[email protected] #ifndef HAVE_MALLOC 2683a9fb326S[email protected] static hci_stack_t hci_stack_static; 2693a9fb326S[email protected] #endif 2703a9fb326S[email protected] static hci_stack_t * hci_stack = NULL; 27116833f0aSmatthias.ringwald 2721c9e5e9dSMatthias Ringwald #ifdef ENABLE_CLASSIC 27363168530SMatthias Ringwald // default name 27463168530SMatthias Ringwald static const char * default_classic_name = "BTstack 00:00:00:00:00:00"; 27563168530SMatthias Ringwald 27666fb9560S[email protected] // test helper 27766fb9560S[email protected] static uint8_t disable_l2cap_timeouts = 0; 2781c9e5e9dSMatthias Ringwald #endif 27966fb9560S[email protected] 280aee5d5c1SMatthias Ringwald // reset connection state on create and on reconnect 281aee5d5c1SMatthias Ringwald // don't overwrite addr, con handle, role 282aee5d5c1SMatthias Ringwald static void hci_connection_init(hci_connection_t * conn){ 2838daf94bcSMatthias Ringwald conn->authentication_flags = AUTH_FLAG_NONE; 28496a45072S[email protected] conn->bonding_flags = 0; 28596a45072S[email protected] conn->requested_security_level = LEVEL_0; 2868ce18681SMatthias Ringwald conn->link_key_type = INVALID_LINK_KEY; 28752db98b2SMatthias Ringwald #ifdef ENABLE_CLASSIC 28888a03c8dSMatthias Ringwald conn->request_role = HCI_ROLE_INVALID; 289140c0557SMatthias Ringwald conn->sniff_subrating_max_latency = 0xffff; 290965a4ccfSMatthias Ringwald conn->qos_service_type = HCI_SERVICE_TYPE_INVALID; 29191a977e8SMatthias Ringwald btstack_run_loop_set_timer_handler(&conn->timeout, hci_connection_timeout_handler); 29291a977e8SMatthias Ringwald btstack_run_loop_set_timer_context(&conn->timeout, conn); 29396a45072S[email protected] hci_connection_timestamp(conn); 29452db98b2SMatthias Ringwald #endif 29596a45072S[email protected] conn->acl_recombination_length = 0; 29696a45072S[email protected] conn->acl_recombination_pos = 0; 297ce41473eSMatthias Ringwald conn->num_packets_sent = 0; 298760b20efSMatthias Ringwald 299da886c03S[email protected] conn->le_con_parameter_update_state = CON_PARAMETER_UPDATE_NONE; 300b90f6e0aSMatthias Ringwald #ifdef ENABLE_BLE 301b90f6e0aSMatthias Ringwald conn->le_phy_update_all_phys = 0xff; 302b90f6e0aSMatthias Ringwald #endif 3030f3b27c5SMatthias Ringwald #ifdef ENABLE_LE_LIMIT_ACL_FRAGMENT_BY_MAX_OCTETS 3040f3b27c5SMatthias Ringwald conn->le_max_tx_octets = 27; 3050f3b27c5SMatthias Ringwald #endif 306cb439cf1SMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB 307cb439cf1SMatthias Ringwald conn->classic_oob_c_192 = NULL; 308cb439cf1SMatthias Ringwald conn->classic_oob_r_192 = NULL; 309cb439cf1SMatthias Ringwald conn->classic_oob_c_256 = NULL; 310cb439cf1SMatthias Ringwald conn->classic_oob_r_256 = NULL; 311cb439cf1SMatthias Ringwald #endif 3124dcab8b6SMatthias Ringwald #ifdef ENABLE_LE_PERIODIC_ADVERTISING 3134dcab8b6SMatthias Ringwald conn->le_past_sync_handle = HCI_CON_HANDLE_INVALID; 3144dcab8b6SMatthias Ringwald conn->le_past_advertising_handle = 0xff; 3154dcab8b6SMatthias Ringwald #endif 316aee5d5c1SMatthias Ringwald } 317aee5d5c1SMatthias Ringwald 318aee5d5c1SMatthias Ringwald /** 319aee5d5c1SMatthias Ringwald * create connection for given address 320aee5d5c1SMatthias Ringwald * 321aee5d5c1SMatthias Ringwald * @return connection OR NULL, if no memory left 322aee5d5c1SMatthias Ringwald */ 32388f925b1SMatthias Ringwald static hci_connection_t * 32488f925b1SMatthias Ringwald create_connection_for_bd_addr_and_type(const bd_addr_t addr, bd_addr_type_t addr_type, hci_role_t role) { 325aee5d5c1SMatthias Ringwald log_info("create_connection_for_addr %s, type %x", bd_addr_to_str(addr), addr_type); 326aee5d5c1SMatthias Ringwald 327aee5d5c1SMatthias Ringwald hci_connection_t * conn = btstack_memory_hci_connection_get(); 328aee5d5c1SMatthias Ringwald if (!conn) return NULL; 329aee5d5c1SMatthias Ringwald hci_connection_init(conn); 330aee5d5c1SMatthias Ringwald 331aee5d5c1SMatthias Ringwald bd_addr_copy(conn->address, addr); 332aee5d5c1SMatthias Ringwald conn->address_type = addr_type; 333aee5d5c1SMatthias Ringwald conn->con_handle = HCI_CON_HANDLE_INVALID; 33488f925b1SMatthias Ringwald conn->role = role; 335665d90f2SMatthias Ringwald btstack_linked_list_add(&hci_stack->connections, (btstack_linked_item_t *) conn); 336aee5d5c1SMatthias Ringwald 33796a45072S[email protected] return conn; 33896a45072S[email protected] } 33966fb9560S[email protected] 340da886c03S[email protected] 341da886c03S[email protected] /** 342da886c03S[email protected] * get le connection parameter range 343da886c03S[email protected] * 344da886c03S[email protected] * @return le connection parameter range struct 345da886c03S[email protected] */ 3464ced4e8cSMatthias Ringwald void gap_get_connection_parameter_range(le_connection_parameter_range_t * range){ 3474ced4e8cSMatthias Ringwald *range = hci_stack->le_connection_parameter_range; 348da886c03S[email protected] } 349da886c03S[email protected] 350da886c03S[email protected] /** 351da886c03S[email protected] * set le connection parameter range 352da886c03S[email protected] * 353da886c03S[email protected] */ 354da886c03S[email protected] 3554ced4e8cSMatthias Ringwald void gap_set_connection_parameter_range(le_connection_parameter_range_t *range){ 3564ced4e8cSMatthias Ringwald hci_stack->le_connection_parameter_range = *range; 357da886c03S[email protected] } 358da886c03S[email protected] 359da886c03S[email protected] /** 36073cd8a2aSMatthias Ringwald * @brief Test if connection parameters are inside in existing rage 36173cd8a2aSMatthias Ringwald * @param conn_interval_min (unit: 1.25ms) 36273cd8a2aSMatthias Ringwald * @param conn_interval_max (unit: 1.25ms) 36373cd8a2aSMatthias Ringwald * @param conn_latency 36473cd8a2aSMatthias Ringwald * @param supervision_timeout (unit: 10ms) 3656b65794dSMilanka Ringwald * @return 1 if included 36673cd8a2aSMatthias Ringwald */ 36773cd8a2aSMatthias Ringwald int gap_connection_parameter_range_included(le_connection_parameter_range_t * existing_range, uint16_t le_conn_interval_min, uint16_t le_conn_interval_max, uint16_t le_conn_latency, uint16_t le_supervision_timeout){ 36873cd8a2aSMatthias Ringwald if (le_conn_interval_min < existing_range->le_conn_interval_min) return 0; 36973cd8a2aSMatthias Ringwald if (le_conn_interval_max > existing_range->le_conn_interval_max) return 0; 37073cd8a2aSMatthias Ringwald 37173cd8a2aSMatthias Ringwald if (le_conn_latency < existing_range->le_conn_latency_min) return 0; 37273cd8a2aSMatthias Ringwald if (le_conn_latency > existing_range->le_conn_latency_max) return 0; 37373cd8a2aSMatthias Ringwald 37473cd8a2aSMatthias Ringwald if (le_supervision_timeout < existing_range->le_supervision_timeout_min) return 0; 37573cd8a2aSMatthias Ringwald if (le_supervision_timeout > existing_range->le_supervision_timeout_max) return 0; 37673cd8a2aSMatthias Ringwald 37773cd8a2aSMatthias Ringwald return 1; 37873cd8a2aSMatthias Ringwald } 37973cd8a2aSMatthias Ringwald 38073cd8a2aSMatthias Ringwald /** 3812b6ab3e6SMatthias Ringwald * @brief Set max number of connections in LE Peripheral role (if Bluetooth Controller supports it) 3822b6ab3e6SMatthias Ringwald * @note: default: 1 3832b6ab3e6SMatthias Ringwald * @param max_peripheral_connections 3842b6ab3e6SMatthias Ringwald */ 385d4e4907bSMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 3862b6ab3e6SMatthias Ringwald void gap_set_max_number_peripheral_connections(int max_peripheral_connections){ 3872b6ab3e6SMatthias Ringwald hci_stack->le_max_number_peripheral_connections = max_peripheral_connections; 3882b6ab3e6SMatthias Ringwald } 389d4e4907bSMatthias Ringwald #endif 3902b6ab3e6SMatthias Ringwald 3912b6ab3e6SMatthias Ringwald /** 392da886c03S[email protected] * get hci connections iterator 393da886c03S[email protected] * 394da886c03S[email protected] * @return hci connections iterator 395da886c03S[email protected] */ 396da886c03S[email protected] 397665d90f2SMatthias Ringwald void hci_connections_get_iterator(btstack_linked_list_iterator_t *it){ 398665d90f2SMatthias Ringwald btstack_linked_list_iterator_init(it, &hci_stack->connections); 399da886c03S[email protected] } 400da886c03S[email protected] 40197addcc5Smatthias.ringwald /** 402ee091cf1Smatthias.ringwald * get connection for a given handle 403ee091cf1Smatthias.ringwald * 404ee091cf1Smatthias.ringwald * @return connection OR NULL, if not found 405ee091cf1Smatthias.ringwald */ 4065061f3afS[email protected] hci_connection_t * hci_connection_for_handle(hci_con_handle_t con_handle){ 407665d90f2SMatthias Ringwald btstack_linked_list_iterator_t it; 408665d90f2SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->connections); 409665d90f2SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 410665d90f2SMatthias Ringwald hci_connection_t * item = (hci_connection_t *) btstack_linked_list_iterator_next(&it); 4113ac2fe56S[email protected] if ( item->con_handle == con_handle ) { 412da886c03S[email protected] return item; 413ee091cf1Smatthias.ringwald } 414ee091cf1Smatthias.ringwald } 415ee091cf1Smatthias.ringwald return NULL; 416ee091cf1Smatthias.ringwald } 417ee091cf1Smatthias.ringwald 41896a45072S[email protected] /** 41996a45072S[email protected] * get connection for given address 42096a45072S[email protected] * 42196a45072S[email protected] * @return connection OR NULL, if not found 42296a45072S[email protected] */ 423667ba9d1SMatthias Ringwald hci_connection_t * hci_connection_for_bd_addr_and_type(const bd_addr_t addr, bd_addr_type_t addr_type){ 424665d90f2SMatthias Ringwald btstack_linked_list_iterator_t it; 425665d90f2SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->connections); 426665d90f2SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 427665d90f2SMatthias Ringwald hci_connection_t * connection = (hci_connection_t *) btstack_linked_list_iterator_next(&it); 42896a45072S[email protected] if (connection->address_type != addr_type) continue; 42996a45072S[email protected] if (memcmp(addr, connection->address, 6) != 0) continue; 43062bda3fbS[email protected] return connection; 43162bda3fbS[email protected] } 43262bda3fbS[email protected] return NULL; 43362bda3fbS[email protected] } 43462bda3fbS[email protected] 435d5f71a7eSMatthias Ringwald #ifdef ENABLE_CLASSIC 436d5f71a7eSMatthias Ringwald 4373e5e0926SMatthias Ringwald inline static void connectionClearAuthenticationFlags(hci_connection_t * conn, hci_authentication_flags_t flags){ 4383e5e0926SMatthias Ringwald conn->authentication_flags = (hci_authentication_flags_t)(conn->authentication_flags & ~flags); 4393e5e0926SMatthias Ringwald } 44052db98b2SMatthias Ringwald 441228e430cSMatthias Ringwald inline static void connectionSetAuthenticationFlags(hci_connection_t * conn, hci_authentication_flags_t flags){ 442228e430cSMatthias Ringwald conn->authentication_flags = (hci_authentication_flags_t)(conn->authentication_flags | flags); 443228e430cSMatthias Ringwald } 444228e430cSMatthias Ringwald 445ee752bb8SMatthias Ringwald #ifdef ENABLE_SCO_OVER_HCI 446ee752bb8SMatthias Ringwald static int hci_number_sco_connections(void){ 447ee752bb8SMatthias Ringwald int connections = 0; 448ee752bb8SMatthias Ringwald btstack_linked_list_iterator_t it; 449ee752bb8SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->connections); 450ee752bb8SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 451ee752bb8SMatthias Ringwald hci_connection_t * connection = (hci_connection_t *) btstack_linked_list_iterator_next(&it); 452ee752bb8SMatthias Ringwald if (connection->address_type != BD_ADDR_TYPE_SCO) continue; 453ee752bb8SMatthias Ringwald connections++; 454ee752bb8SMatthias Ringwald } 455ee752bb8SMatthias Ringwald return connections; 456ee752bb8SMatthias Ringwald } 457ee752bb8SMatthias Ringwald #endif 458ee752bb8SMatthias Ringwald 459ec820d77SMatthias Ringwald static void hci_connection_timeout_handler(btstack_timer_source_t *timer){ 46091a977e8SMatthias Ringwald hci_connection_t * connection = (hci_connection_t *) btstack_run_loop_get_timer_context(timer); 461aec7654dSMatthias Ringwald #ifdef HAVE_EMBEDDED_TICK 462528a4a3bSMatthias Ringwald if (btstack_run_loop_embedded_get_ticks() > connection->timestamp + btstack_run_loop_embedded_ticks_for_ms(HCI_CONNECTION_TIMEOUT_MS)){ 463c785ef68Smatthias.ringwald // connections might be timed out 464c785ef68Smatthias.ringwald hci_emit_l2cap_check_timeout(connection); 465c785ef68Smatthias.ringwald } 466f316a845SMatthias Ringwald #else 467c1ab6cc1SMatthias Ringwald if (btstack_run_loop_get_time_ms() > (connection->timestamp + HCI_CONNECTION_TIMEOUT_MS)){ 4685f26aadcSMatthias Ringwald // connections might be timed out 4695f26aadcSMatthias Ringwald hci_emit_l2cap_check_timeout(connection); 4705f26aadcSMatthias Ringwald } 4715f26aadcSMatthias Ringwald #endif 472c785ef68Smatthias.ringwald } 473ee091cf1Smatthias.ringwald 474ee091cf1Smatthias.ringwald static void hci_connection_timestamp(hci_connection_t *connection){ 475aec7654dSMatthias Ringwald #ifdef HAVE_EMBEDDED_TICK 476528a4a3bSMatthias Ringwald connection->timestamp = btstack_run_loop_embedded_get_ticks(); 477f316a845SMatthias Ringwald #else 478528a4a3bSMatthias Ringwald connection->timestamp = btstack_run_loop_get_time_ms(); 4795f26aadcSMatthias Ringwald #endif 480ee091cf1Smatthias.ringwald } 481ee091cf1Smatthias.ringwald 48243bfb1bdSmatthias.ringwald /** 48380ca58a0Smatthias.ringwald * add authentication flags and reset timer 48496a45072S[email protected] * @note: assumes classic connection 4852e77e513S[email protected] * @note: bd_addr is passed in as litle endian uint8_t * as it is called from parsing packets 4867fde4af9Smatthias.ringwald */ 4877fde4af9Smatthias.ringwald static void hci_add_connection_flags_for_flipped_bd_addr(uint8_t *bd_addr, hci_authentication_flags_t flags){ 4887fde4af9Smatthias.ringwald bd_addr_t addr; 489724d70a2SMatthias Ringwald reverse_bd_addr(bd_addr, addr); 490f16129ceSMatthias Ringwald hci_connection_t * conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL); 4917fde4af9Smatthias.ringwald if (conn) { 49228ca2b46S[email protected] connectionSetAuthenticationFlags(conn, flags); 49380ca58a0Smatthias.ringwald hci_connection_timestamp(conn); 4947fde4af9Smatthias.ringwald } 4957fde4af9Smatthias.ringwald } 4967fde4af9Smatthias.ringwald 4971714cbbdSMatthias Ringwald static bool hci_pairing_active(hci_connection_t * hci_connection){ 4988daf94bcSMatthias Ringwald return (hci_connection->authentication_flags & AUTH_FLAG_PAIRING_ACTIVE_MASK) != 0; 4991714cbbdSMatthias Ringwald } 5001714cbbdSMatthias Ringwald 5011714cbbdSMatthias Ringwald static void hci_pairing_started(hci_connection_t * hci_connection, bool ssp){ 5021714cbbdSMatthias Ringwald if (hci_pairing_active(hci_connection)) return; 5031714cbbdSMatthias Ringwald if (ssp){ 5048daf94bcSMatthias Ringwald hci_connection->authentication_flags |= AUTH_FLAG_SSP_PAIRING_ACTIVE; 5051714cbbdSMatthias Ringwald } else { 5068daf94bcSMatthias Ringwald hci_connection->authentication_flags |= AUTH_FLAG_LEGACY_PAIRING_ACTIVE; 5071714cbbdSMatthias Ringwald } 5081714cbbdSMatthias Ringwald // if we are initiator, we have sent an HCI Authenticate Request 5091714cbbdSMatthias Ringwald bool initiator = (hci_connection->bonding_flags & BONDING_SENT_AUTHENTICATE_REQUEST) != 0; 5101714cbbdSMatthias Ringwald 5115a561920SMatthias Ringwald // if we are responder, use minimal service security level as required level 5125a561920SMatthias Ringwald if (!initiator){ 513acadfdd0SMatthias Ringwald hci_connection->requested_security_level = (gap_security_level_t) btstack_max((uint32_t) hci_connection->requested_security_level, (uint32_t) hci_stack->gap_minimal_service_security_level); 5145a561920SMatthias Ringwald } 5155a561920SMatthias Ringwald 5165a561920SMatthias Ringwald log_info("pairing started, ssp %u, initiator %u, requested level %u", (int) ssp, (int) initiator, hci_connection->requested_security_level); 51777208d90SMatthias Ringwald 51877208d90SMatthias Ringwald uint8_t event[12]; 51977208d90SMatthias Ringwald event[0] = GAP_EVENT_PAIRING_STARTED; 52077208d90SMatthias Ringwald event[1] = 10; 521bfaf6993SMatthias Ringwald little_endian_store_16(event, 2, (uint16_t) hci_connection->con_handle); 5224159a80bSMatthias Ringwald reverse_bd_addr(hci_connection->address, &event[4]); 52377208d90SMatthias Ringwald event[10] = (uint8_t) ssp; 52477208d90SMatthias Ringwald event[11] = (uint8_t) initiator; 52577208d90SMatthias Ringwald hci_emit_event(event, sizeof(event), 1); 5261714cbbdSMatthias Ringwald } 5271714cbbdSMatthias Ringwald 5281714cbbdSMatthias Ringwald static void hci_pairing_complete(hci_connection_t * hci_connection, uint8_t status){ 5293c439ac4SMatthias Ringwald hci_connection->requested_security_level = LEVEL_0; 5301714cbbdSMatthias Ringwald if (!hci_pairing_active(hci_connection)) return; 5318daf94bcSMatthias Ringwald hci_connection->authentication_flags &= ~AUTH_FLAG_PAIRING_ACTIVE_MASK; 5321e7371deSMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB 533cb439cf1SMatthias Ringwald hci_connection->classic_oob_c_192 = NULL; 534cb439cf1SMatthias Ringwald hci_connection->classic_oob_r_192 = NULL; 535cb439cf1SMatthias Ringwald hci_connection->classic_oob_c_256 = NULL; 536cb439cf1SMatthias Ringwald hci_connection->classic_oob_r_256 = NULL; 5371e7371deSMatthias Ringwald #endif 5381714cbbdSMatthias Ringwald log_info("pairing complete, status %02x", status); 53977208d90SMatthias Ringwald 5403176c896SMatthias Ringwald uint8_t event[11]; 54177208d90SMatthias Ringwald event[0] = GAP_EVENT_PAIRING_COMPLETE; 54277208d90SMatthias Ringwald event[1] = 9; 543bfaf6993SMatthias Ringwald little_endian_store_16(event, 2, (uint16_t) hci_connection->con_handle); 5444159a80bSMatthias Ringwald reverse_bd_addr(hci_connection->address, &event[4]); 54577208d90SMatthias Ringwald event[10] = status; 54677208d90SMatthias Ringwald hci_emit_event(event, sizeof(event), 1); 5475999ee11SMatthias Ringwald 5485999ee11SMatthias Ringwald // emit dedicated bonding done on failure, otherwise verify that connection can be encrypted 5495999ee11SMatthias Ringwald if ((status != ERROR_CODE_SUCCESS) && ((hci_connection->bonding_flags & BONDING_DEDICATED) != 0)){ 5505999ee11SMatthias Ringwald hci_connection->bonding_flags &= ~BONDING_DEDICATED; 5515999ee11SMatthias Ringwald hci_connection->bonding_flags |= BONDING_DISCONNECT_DEDICATED_DONE; 5525999ee11SMatthias Ringwald hci_connection->bonding_status = status; 5535999ee11SMatthias Ringwald } 5541714cbbdSMatthias Ringwald } 5551714cbbdSMatthias Ringwald 55620dcdd22SMatthias Ringwald bool hci_authentication_active_for_handle(hci_con_handle_t handle){ 5575061f3afS[email protected] hci_connection_t * conn = hci_connection_for_handle(handle); 55820dcdd22SMatthias Ringwald if (!conn) return false; 55920dcdd22SMatthias Ringwald return hci_pairing_active(conn); 56080ca58a0Smatthias.ringwald } 56180ca58a0Smatthias.ringwald 56215a95bd5SMatthias Ringwald void gap_drop_link_key_for_bd_addr(bd_addr_t addr){ 56355597469SMatthias Ringwald if (!hci_stack->link_key_db) return; 5642bacf595SMatthias Ringwald log_info("gap_drop_link_key_for_bd_addr: %s", bd_addr_to_str(addr)); 565a98592bcSMatthias Ringwald hci_stack->link_key_db->delete_link_key(addr); 566c12e46e7Smatthias.ringwald } 56755597469SMatthias Ringwald 56855597469SMatthias Ringwald void gap_store_link_key_for_bd_addr(bd_addr_t addr, link_key_t link_key, link_key_type_t type){ 56955597469SMatthias Ringwald if (!hci_stack->link_key_db) return; 5702bacf595SMatthias Ringwald log_info("gap_store_link_key_for_bd_addr: %s, type %u", bd_addr_to_str(addr), type); 57155597469SMatthias Ringwald hci_stack->link_key_db->put_link_key(addr, link_key, type); 572c12e46e7Smatthias.ringwald } 5731b6fb31bSMatthias Ringwald 574e8ad470fSMatthias Ringwald bool gap_get_link_key_for_bd_addr(bd_addr_t addr, link_key_t link_key, link_key_type_t * type){ 575e8ad470fSMatthias Ringwald if (!hci_stack->link_key_db) return false; 57676b0318eSMatthias Ringwald int result = hci_stack->link_key_db->get_link_key(addr, link_key, type) != 0; 57776b0318eSMatthias Ringwald log_info("link key for %s available %u, type %u", bd_addr_to_str(addr), result, (int) *type); 57876b0318eSMatthias Ringwald return result; 579e8ad470fSMatthias Ringwald } 580e8ad470fSMatthias Ringwald 581ceecb9d9SMatthias Ringwald void gap_delete_all_link_keys(void){ 582ceecb9d9SMatthias Ringwald bd_addr_t addr; 583ceecb9d9SMatthias Ringwald link_key_t link_key; 584ceecb9d9SMatthias Ringwald link_key_type_t type; 585ceecb9d9SMatthias Ringwald btstack_link_key_iterator_t it; 586ceecb9d9SMatthias Ringwald int ok = gap_link_key_iterator_init(&it); 587ceecb9d9SMatthias Ringwald if (!ok) { 588ceecb9d9SMatthias Ringwald log_error("could not initialize iterator"); 589ceecb9d9SMatthias Ringwald return; 590ceecb9d9SMatthias Ringwald } 591ceecb9d9SMatthias Ringwald while (gap_link_key_iterator_get_next(&it, addr, link_key, &type)){ 592ceecb9d9SMatthias Ringwald gap_drop_link_key_for_bd_addr(addr); 593ceecb9d9SMatthias Ringwald } 594ceecb9d9SMatthias Ringwald gap_link_key_iterator_done(&it); 595ceecb9d9SMatthias Ringwald } 596ceecb9d9SMatthias Ringwald 5971b6fb31bSMatthias Ringwald int gap_link_key_iterator_init(btstack_link_key_iterator_t * it){ 5981b6fb31bSMatthias Ringwald if (!hci_stack->link_key_db) return 0; 5991b6fb31bSMatthias Ringwald if (!hci_stack->link_key_db->iterator_init) return 0; 6001b6fb31bSMatthias Ringwald return hci_stack->link_key_db->iterator_init(it); 6011b6fb31bSMatthias Ringwald } 6021b6fb31bSMatthias Ringwald int gap_link_key_iterator_get_next(btstack_link_key_iterator_t * it, bd_addr_t bd_addr, link_key_t link_key, link_key_type_t * type){ 6031b6fb31bSMatthias Ringwald if (!hci_stack->link_key_db) return 0; 6041b6fb31bSMatthias Ringwald return hci_stack->link_key_db->iterator_get_next(it, bd_addr, link_key, type); 6051b6fb31bSMatthias Ringwald } 6061b6fb31bSMatthias Ringwald void gap_link_key_iterator_done(btstack_link_key_iterator_t * it){ 6071b6fb31bSMatthias Ringwald if (!hci_stack->link_key_db) return; 6081b6fb31bSMatthias Ringwald hci_stack->link_key_db->iterator_done(it); 6091b6fb31bSMatthias Ringwald } 61035454696SMatthias Ringwald #endif 611c12e46e7Smatthias.ringwald 6128e97a820SMatthias Ringwald bool hci_is_le_connection_type(bd_addr_type_t address_type){ 613eb8076ddSMatthias Ringwald switch (address_type){ 614ce41473eSMatthias Ringwald case BD_ADDR_TYPE_LE_PUBLIC: 615ce41473eSMatthias Ringwald case BD_ADDR_TYPE_LE_RANDOM: 6163739bc96SMatthias Ringwald case BD_ADDR_TYPE_LE_PUBLIC_IDENTITY: 6173739bc96SMatthias Ringwald case BD_ADDR_TYPE_LE_RANDOM_IDENTITY: 618eb8076ddSMatthias Ringwald return true; 619ce41473eSMatthias Ringwald default: 620eb8076ddSMatthias Ringwald return false; 621ce41473eSMatthias Ringwald } 6220bf6344aS[email protected] } 6230bf6344aS[email protected] 6240890cf2bSMatthias Ringwald bool hci_is_le_identity_address_type(bd_addr_type_t address_type){ 6250890cf2bSMatthias Ringwald switch (address_type){ 6260890cf2bSMatthias Ringwald case BD_ADDR_TYPE_LE_PUBLIC_IDENTITY: 6270890cf2bSMatthias Ringwald case BD_ADDR_TYPE_LE_RANDOM_IDENTITY: 6280890cf2bSMatthias Ringwald return true; 6290890cf2bSMatthias Ringwald default: 6300890cf2bSMatthias Ringwald return false; 6310890cf2bSMatthias Ringwald } 6320890cf2bSMatthias Ringwald } 6330890cf2bSMatthias Ringwald 634617c03d6SMatthias Ringwald static bool hci_is_le_connection(hci_connection_t * connection){ 635eb8076ddSMatthias Ringwald return hci_is_le_connection_type(connection->address_type); 636eb8076ddSMatthias Ringwald } 637eb8076ddSMatthias Ringwald 6387fde4af9Smatthias.ringwald /** 63943bfb1bdSmatthias.ringwald * count connections 64043bfb1bdSmatthias.ringwald */ 64140d1c7a4Smatthias.ringwald static int nr_hci_connections(void){ 64256c253c9Smatthias.ringwald int count = 0; 643665d90f2SMatthias Ringwald btstack_linked_item_t *it; 644a0da043fSMatthias Ringwald for (it = (btstack_linked_item_t *) hci_stack->connections; it != NULL ; it = it->next){ 64515a27967SMatthias Ringwald count++; 64615a27967SMatthias Ringwald } 64743bfb1bdSmatthias.ringwald return count; 64843bfb1bdSmatthias.ringwald } 649c8e4258aSmatthias.ringwald 6508f733c6fSMatthias Ringwald uint16_t hci_number_free_acl_slots_for_connection_type(bd_addr_type_t address_type){ 651ee303eddS[email protected] 652f04a0c31SMatthias Ringwald unsigned int num_packets_sent_classic = 0; 653f04a0c31SMatthias Ringwald unsigned int num_packets_sent_le = 0; 654ee303eddS[email protected] 655665d90f2SMatthias Ringwald btstack_linked_item_t *it; 656a0da043fSMatthias Ringwald for (it = (btstack_linked_item_t *) hci_stack->connections; it != NULL; it = it->next){ 657998906cdSmatthias.ringwald hci_connection_t * connection = (hci_connection_t *) it; 658ce41473eSMatthias Ringwald if (hci_is_le_connection(connection)){ 659ce41473eSMatthias Ringwald num_packets_sent_le += connection->num_packets_sent; 660ce41473eSMatthias Ringwald } 661f16129ceSMatthias Ringwald if (connection->address_type == BD_ADDR_TYPE_ACL){ 662ce41473eSMatthias Ringwald num_packets_sent_classic += connection->num_packets_sent; 663ee303eddS[email protected] } 664ee303eddS[email protected] } 665d999b54eSMatthias Ringwald log_debug("ACL classic buffers: %u used of %u", num_packets_sent_classic, hci_stack->acl_packets_total_num); 666ee303eddS[email protected] int free_slots_classic = hci_stack->acl_packets_total_num - num_packets_sent_classic; 667ee303eddS[email protected] int free_slots_le = 0; 668ee303eddS[email protected] 669ee303eddS[email protected] if (free_slots_classic < 0){ 6709da54300S[email protected] log_error("hci_number_free_acl_slots: outgoing classic packets (%u) > total classic packets (%u)", num_packets_sent_classic, hci_stack->acl_packets_total_num); 671998906cdSmatthias.ringwald return 0; 672998906cdSmatthias.ringwald } 673ee303eddS[email protected] 674ee303eddS[email protected] if (hci_stack->le_acl_packets_total_num){ 675ee303eddS[email protected] // if we have LE slots, they are used 676ee303eddS[email protected] free_slots_le = hci_stack->le_acl_packets_total_num - num_packets_sent_le; 677ee303eddS[email protected] if (free_slots_le < 0){ 6789da54300S[email protected] log_error("hci_number_free_acl_slots: outgoing le packets (%u) > total le packets (%u)", num_packets_sent_le, hci_stack->le_acl_packets_total_num); 679ee303eddS[email protected] return 0; 680998906cdSmatthias.ringwald } 681ee303eddS[email protected] } else { 682ee303eddS[email protected] // otherwise, classic slots are used for LE, too 683ee303eddS[email protected] free_slots_classic -= num_packets_sent_le; 684ee303eddS[email protected] if (free_slots_classic < 0){ 6859da54300S[email protected] log_error("hci_number_free_acl_slots: outgoing classic + le packets (%u + %u) > total packets (%u)", num_packets_sent_classic, num_packets_sent_le, hci_stack->acl_packets_total_num); 686ee303eddS[email protected] return 0; 687ee303eddS[email protected] } 688ee303eddS[email protected] } 689ee303eddS[email protected] 690ee303eddS[email protected] switch (address_type){ 691ee303eddS[email protected] case BD_ADDR_TYPE_UNKNOWN: 6922125de09SMatthias Ringwald log_error("hci_number_free_acl_slots: unknown address type"); 693ee303eddS[email protected] return 0; 694ee303eddS[email protected] 695f16129ceSMatthias Ringwald case BD_ADDR_TYPE_ACL: 6968f733c6fSMatthias Ringwald return (uint16_t) free_slots_classic; 697ee303eddS[email protected] 698ee303eddS[email protected] default: 6998f733c6fSMatthias Ringwald if (hci_stack->le_acl_packets_total_num > 0){ 7008f733c6fSMatthias Ringwald return (uint16_t) free_slots_le; 701ee303eddS[email protected] } 7028f733c6fSMatthias Ringwald return (uint16_t) free_slots_classic; 703cb00d3aaS[email protected] } 704998906cdSmatthias.ringwald } 705998906cdSmatthias.ringwald 7062125de09SMatthias Ringwald int hci_number_free_acl_slots_for_handle(hci_con_handle_t con_handle){ 7072125de09SMatthias Ringwald // get connection type 7082125de09SMatthias Ringwald hci_connection_t * connection = hci_connection_for_handle(con_handle); 7092125de09SMatthias Ringwald if (!connection){ 7102125de09SMatthias Ringwald log_error("hci_number_free_acl_slots: handle 0x%04x not in connection list", con_handle); 7112125de09SMatthias Ringwald return 0; 7122125de09SMatthias Ringwald } 7132125de09SMatthias Ringwald return hci_number_free_acl_slots_for_connection_type(connection->address_type); 7142125de09SMatthias Ringwald } 7152125de09SMatthias Ringwald 71635454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 717701e3307SMatthias Ringwald static int hci_number_free_sco_slots(void){ 718f04a0c31SMatthias Ringwald unsigned int num_sco_packets_sent = 0; 719665d90f2SMatthias Ringwald btstack_linked_item_t *it; 720760b20efSMatthias Ringwald if (hci_stack->synchronous_flow_control_enabled){ 721760b20efSMatthias Ringwald // explicit flow control 722665d90f2SMatthias Ringwald for (it = (btstack_linked_item_t *) hci_stack->connections; it ; it = it->next){ 723e35edcc1S[email protected] hci_connection_t * connection = (hci_connection_t *) it; 724ce41473eSMatthias Ringwald if (connection->address_type != BD_ADDR_TYPE_SCO) continue; 725ce41473eSMatthias Ringwald num_sco_packets_sent += connection->num_packets_sent; 726e35edcc1S[email protected] } 727e35edcc1S[email protected] if (num_sco_packets_sent > hci_stack->sco_packets_total_num){ 728701e3307SMatthias Ringwald log_info("hci_number_free_sco_slots:packets (%u) > total packets (%u)", num_sco_packets_sent, hci_stack->sco_packets_total_num); 72944d0e3d5S[email protected] return 0; 73044d0e3d5S[email protected] } 731e35edcc1S[email protected] return hci_stack->sco_packets_total_num - num_sco_packets_sent; 73249205f5dSMatthias Ringwald } else { 733fa7f2dfdSMatthias Ringwald // implicit flow control 7346f28d2eeSMatthias Ringwald int num_ready = 0; 7356f28d2eeSMatthias Ringwald for (it = (btstack_linked_item_t *) hci_stack->connections; it ; it = it->next){ 7366f28d2eeSMatthias Ringwald hci_connection_t * connection = (hci_connection_t *) it; 7376f28d2eeSMatthias Ringwald if (connection->address_type != BD_ADDR_TYPE_SCO) continue; 7386f28d2eeSMatthias Ringwald if (connection->sco_tx_ready == 0) continue; 7396f28d2eeSMatthias Ringwald num_ready++; 74049205f5dSMatthias Ringwald } 7416f28d2eeSMatthias Ringwald return num_ready; 7426f28d2eeSMatthias Ringwald } 743e35edcc1S[email protected] } 74435454696SMatthias Ringwald #endif 74544d0e3d5S[email protected] 7462b838201SMatthias Ringwald // only used to send HCI Host Number Completed Packets 7472b838201SMatthias Ringwald static int hci_can_send_comand_packet_transport(void){ 748ac928cc2S[email protected] if (hci_stack->hci_packet_buffer_reserved) return 0; 749ac928cc2S[email protected] 750ac928cc2S[email protected] // check for async hci transport implementations 751ac928cc2S[email protected] if (hci_stack->hci_transport->can_send_packet_now){ 752ac928cc2S[email protected] if (!hci_stack->hci_transport->can_send_packet_now(HCI_COMMAND_DATA_PACKET)){ 753ac928cc2S[email protected] return 0; 754ac928cc2S[email protected] } 755ac928cc2S[email protected] } 7562b838201SMatthias Ringwald return 1; 7572b838201SMatthias Ringwald } 758ac928cc2S[email protected] 7592b838201SMatthias Ringwald // new functions replacing hci_can_send_packet_now[_using_packet_buffer] 7601972f31fSMatthias Ringwald bool hci_can_send_command_packet_now(void){ 7611972f31fSMatthias Ringwald if (hci_can_send_comand_packet_transport() == 0) return false; 7624ea43905SMatthias Ringwald return hci_stack->num_cmd_packets > 0u; 763ac928cc2S[email protected] } 764ac928cc2S[email protected] 7659d04d3a7SMatthias Ringwald static int hci_transport_can_send_prepared_packet_now(uint8_t packet_type){ 766ac928cc2S[email protected] // check for async hci transport implementations 7671972f31fSMatthias Ringwald if (!hci_stack->hci_transport->can_send_packet_now) return true; 7689d04d3a7SMatthias Ringwald return hci_stack->hci_transport->can_send_packet_now(packet_type); 769ac928cc2S[email protected] } 7709d04d3a7SMatthias Ringwald 7711972f31fSMatthias Ringwald static bool hci_can_send_prepared_acl_packet_for_address_type(bd_addr_type_t address_type){ 7721972f31fSMatthias Ringwald if (!hci_transport_can_send_prepared_packet_now(HCI_ACL_DATA_PACKET)) return false; 7739d04d3a7SMatthias Ringwald return hci_number_free_acl_slots_for_connection_type(address_type) > 0; 774ac928cc2S[email protected] } 7759d04d3a7SMatthias Ringwald 7761972f31fSMatthias Ringwald bool hci_can_send_acl_le_packet_now(void){ 7771972f31fSMatthias Ringwald if (hci_stack->hci_packet_buffer_reserved) return false; 7789d04d3a7SMatthias Ringwald return hci_can_send_prepared_acl_packet_for_address_type(BD_ADDR_TYPE_LE_PUBLIC); 7799d04d3a7SMatthias Ringwald } 7809d04d3a7SMatthias Ringwald 7811972f31fSMatthias Ringwald bool hci_can_send_prepared_acl_packet_now(hci_con_handle_t con_handle) { 7821972f31fSMatthias Ringwald if (!hci_transport_can_send_prepared_packet_now(HCI_ACL_DATA_PACKET)) return false; 783e79abdd6S[email protected] return hci_number_free_acl_slots_for_handle(con_handle) > 0; 784ac928cc2S[email protected] } 785ac928cc2S[email protected] 7861972f31fSMatthias Ringwald bool hci_can_send_acl_packet_now(hci_con_handle_t con_handle){ 7871972f31fSMatthias Ringwald if (hci_stack->hci_packet_buffer_reserved) return false; 788ac928cc2S[email protected] return hci_can_send_prepared_acl_packet_now(con_handle); 7896b4af23dS[email protected] } 7906b4af23dS[email protected] 79135454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 7921972f31fSMatthias Ringwald bool hci_can_send_acl_classic_packet_now(void){ 7931972f31fSMatthias Ringwald if (hci_stack->hci_packet_buffer_reserved) return false; 794f16129ceSMatthias Ringwald return hci_can_send_prepared_acl_packet_for_address_type(BD_ADDR_TYPE_ACL); 79535454696SMatthias Ringwald } 79635454696SMatthias Ringwald 7971972f31fSMatthias Ringwald bool hci_can_send_prepared_sco_packet_now(void){ 7981972f31fSMatthias Ringwald if (!hci_transport_can_send_prepared_packet_now(HCI_SCO_DATA_PACKET)) return false; 799f234b250SMatthias Ringwald if (hci_have_usb_transport()){ 800f234b250SMatthias Ringwald return hci_stack->sco_can_send_now; 801f234b250SMatthias Ringwald } else { 802701e3307SMatthias Ringwald return hci_number_free_sco_slots() > 0; 80344d0e3d5S[email protected] } 804f234b250SMatthias Ringwald } 80544d0e3d5S[email protected] 8061972f31fSMatthias Ringwald bool hci_can_send_sco_packet_now(void){ 8071972f31fSMatthias Ringwald if (hci_stack->hci_packet_buffer_reserved) return false; 808701e3307SMatthias Ringwald return hci_can_send_prepared_sco_packet_now(); 80944d0e3d5S[email protected] } 81044d0e3d5S[email protected] 811d057580eSMatthias Ringwald void hci_request_sco_can_send_now_event(void){ 812d057580eSMatthias Ringwald hci_stack->sco_waiting_for_can_send_now = 1; 813d057580eSMatthias Ringwald hci_notify_if_sco_can_send_now(); 814d057580eSMatthias Ringwald } 81535454696SMatthias Ringwald #endif 816d057580eSMatthias Ringwald 81795d71764SMatthias Ringwald // used for internal checks in l2cap.c 81802c7fc01SMatthias Ringwald bool hci_is_packet_buffer_reserved(void){ 819c8b9416aS[email protected] return hci_stack->hci_packet_buffer_reserved; 820c8b9416aS[email protected] } 821c8b9416aS[email protected] 8228f4649e3SMatthias Ringwald void hci_reserve_packet_buffer(void){ 8235d350981SMatthias Ringwald btstack_assert(hci_stack->hci_packet_buffer_reserved == false); 82402c7fc01SMatthias Ringwald hci_stack->hci_packet_buffer_reserved = true; 8256b4af23dS[email protected] } 8266b4af23dS[email protected] 82768a0fcf7S[email protected] void hci_release_packet_buffer(void){ 8285d350981SMatthias Ringwald btstack_assert(hci_stack->hci_packet_buffer_reserved); 82902c7fc01SMatthias Ringwald hci_stack->hci_packet_buffer_reserved = false; 8305daaa52eSMatthias Ringwald hci_emit_transport_packet_sent(); 83168a0fcf7S[email protected] } 83268a0fcf7S[email protected] 8336b4af23dS[email protected] // assumption: synchronous implementations don't provide can_send_packet_now as they don't keep the buffer after the call 8347f02f414SMatthias Ringwald static int hci_transport_synchronous(void){ 8356b4af23dS[email protected] return hci_stack->hci_transport->can_send_packet_now == NULL; 8366b4af23dS[email protected] } 8376b4af23dS[email protected] 8388ad9cf99SMatthias Ringwald // used for debugging 8398ad9cf99SMatthias Ringwald #ifdef ENABLE_CONTROLLER_DUMP_PACKETS 8408ad9cf99SMatthias Ringwald static void hci_controller_dump_packets(void){ 8418ad9cf99SMatthias Ringwald // format: "{handle:04x}:{count:02d} " 8428ad9cf99SMatthias Ringwald char summaries[3][7 * 8 + 1]; 8438ad9cf99SMatthias Ringwald uint16_t totals[3]; 8448ad9cf99SMatthias Ringwald uint8_t index; 8458ad9cf99SMatthias Ringwald for (index = 0 ; index < 3 ; index++){ 8468ad9cf99SMatthias Ringwald summaries[index][0] = 0; 8478ad9cf99SMatthias Ringwald totals[index] = 0; 8488ad9cf99SMatthias Ringwald } 8498ad9cf99SMatthias Ringwald btstack_linked_item_t *it; 8508ad9cf99SMatthias Ringwald for (it = (btstack_linked_item_t *) hci_stack->connections; it != NULL; it = it->next){ 8518ad9cf99SMatthias Ringwald hci_connection_t * connection = (hci_connection_t *) it; 8528ad9cf99SMatthias Ringwald switch (connection->address_type){ 8538ad9cf99SMatthias Ringwald case BD_ADDR_TYPE_ACL: 8548ad9cf99SMatthias Ringwald index = 0; 8558ad9cf99SMatthias Ringwald break; 8568ad9cf99SMatthias Ringwald case BD_ADDR_TYPE_SCO: 8578ad9cf99SMatthias Ringwald index = 2; 8588ad9cf99SMatthias Ringwald break; 8598ad9cf99SMatthias Ringwald default: 8608ad9cf99SMatthias Ringwald index = 1; 861ce7ca7c8SMatthias Ringwald break; 8628ad9cf99SMatthias Ringwald } 8638ad9cf99SMatthias Ringwald totals[index] += connection->num_packets_sent; 8648ad9cf99SMatthias Ringwald char item_text[10]; 8658ad9cf99SMatthias Ringwald sprintf(item_text, "%04x:%02d ", connection->con_handle,connection->num_packets_sent); 8668ad9cf99SMatthias Ringwald btstack_strcat(summaries[index], sizeof(summaries[0]), item_text); 8678ad9cf99SMatthias Ringwald } 8688ad9cf99SMatthias Ringwald for (index = 0 ; index < 3 ; index++){ 8698ad9cf99SMatthias Ringwald if (summaries[index][0] == 0){ 8708ad9cf99SMatthias Ringwald summaries[index][0] = '-'; 8718ad9cf99SMatthias Ringwald summaries[index][1] = 0; 8728ad9cf99SMatthias Ringwald } 8738ad9cf99SMatthias Ringwald } 8748ad9cf99SMatthias Ringwald log_info("Controller ACL BR/EDR: %s total %u / LE: %s total %u / SCO: %s total %u", summaries[0], totals[0], summaries[1], totals[1], summaries[2], totals[2]); 8758ad9cf99SMatthias Ringwald } 8768ad9cf99SMatthias Ringwald #endif 8778ad9cf99SMatthias Ringwald 8783e2050f7SMatthias Ringwald static uint8_t hci_send_acl_packet_fragments(hci_connection_t *connection){ 879452cf3bbS[email protected] 880452cf3bbS[email protected] // log_info("hci_send_acl_packet_fragments %u/%u (con 0x%04x)", hci_stack->acl_fragmentation_pos, hci_stack->acl_fragmentation_total_size, connection->con_handle); 881452cf3bbS[email protected] 882452cf3bbS[email protected] // max ACL data packet length depends on connection type (LE vs. Classic) and available buffers 883452cf3bbS[email protected] uint16_t max_acl_data_packet_length = hci_stack->acl_data_packet_length; 8844ea43905SMatthias Ringwald if (hci_is_le_connection(connection) && (hci_stack->le_data_packets_length > 0u)){ 885452cf3bbS[email protected] max_acl_data_packet_length = hci_stack->le_data_packets_length; 886452cf3bbS[email protected] } 887452cf3bbS[email protected] 8880f3b27c5SMatthias Ringwald #ifdef ENABLE_LE_LIMIT_ACL_FRAGMENT_BY_MAX_OCTETS 889fcf88f47SMatthias Ringwald if (hci_is_le_connection(connection) && (connection->le_max_tx_octets < max_acl_data_packet_length)){ 8900f3b27c5SMatthias Ringwald max_acl_data_packet_length = connection->le_max_tx_octets; 8910f3b27c5SMatthias Ringwald } 8920f3b27c5SMatthias Ringwald #endif 893452cf3bbS[email protected] 894d999b54eSMatthias Ringwald log_debug("hci_send_acl_packet_fragments entered"); 895d999b54eSMatthias Ringwald 8963e2050f7SMatthias Ringwald uint8_t status = ERROR_CODE_SUCCESS; 897452cf3bbS[email protected] // multiple packets could be send on a synchronous HCI transport 898ff3cc4a5SMatthias Ringwald while (true){ 899452cf3bbS[email protected] 900d999b54eSMatthias Ringwald log_debug("hci_send_acl_packet_fragments loop entered"); 901d999b54eSMatthias Ringwald 902452cf3bbS[email protected] // get current data 9034ea43905SMatthias Ringwald const uint16_t acl_header_pos = hci_stack->acl_fragmentation_pos - 4u; 904452cf3bbS[email protected] int current_acl_data_packet_length = hci_stack->acl_fragmentation_total_size - hci_stack->acl_fragmentation_pos; 9051979f09cSMatthias Ringwald bool more_fragments = false; 906452cf3bbS[email protected] 907452cf3bbS[email protected] // if ACL packet is larger than Bluetooth packet buffer, only send max_acl_data_packet_length 908452cf3bbS[email protected] if (current_acl_data_packet_length > max_acl_data_packet_length){ 9091979f09cSMatthias Ringwald more_fragments = true; 9106bcf18c2SMatthias Ringwald current_acl_data_packet_length = max_acl_data_packet_length & (~(HCI_ACL_CHUNK_SIZE_ALIGNMENT-1)); 911452cf3bbS[email protected] } 912452cf3bbS[email protected] 913452cf3bbS[email protected] // copy handle_and_flags if not first fragment and update packet boundary flags to be 01 (continuing fragmnent) 9144ea43905SMatthias Ringwald if (acl_header_pos > 0u){ 915f8fbdce0SMatthias Ringwald uint16_t handle_and_flags = little_endian_read_16(hci_stack->hci_packet_buffer, 0); 9164ea43905SMatthias Ringwald handle_and_flags = (handle_and_flags & 0xcfffu) | (1u << 12u); 917f8fbdce0SMatthias Ringwald little_endian_store_16(hci_stack->hci_packet_buffer, acl_header_pos, handle_and_flags); 918452cf3bbS[email protected] } 919452cf3bbS[email protected] 920452cf3bbS[email protected] // update header len 9214ea43905SMatthias Ringwald little_endian_store_16(hci_stack->hci_packet_buffer, acl_header_pos + 2u, current_acl_data_packet_length); 922452cf3bbS[email protected] 923452cf3bbS[email protected] // count packet 924ce41473eSMatthias Ringwald connection->num_packets_sent++; 9251979f09cSMatthias Ringwald log_debug("hci_send_acl_packet_fragments loop before send (more fragments %d)", (int) more_fragments); 926d999b54eSMatthias Ringwald 927d999b54eSMatthias Ringwald // update state for next fragment (if any) as "transport done" might be sent during send_packet already 928d999b54eSMatthias Ringwald if (more_fragments){ 929d999b54eSMatthias Ringwald // update start of next fragment to send 930d999b54eSMatthias Ringwald hci_stack->acl_fragmentation_pos += current_acl_data_packet_length; 931d999b54eSMatthias Ringwald } else { 932d999b54eSMatthias Ringwald // done 933d999b54eSMatthias Ringwald hci_stack->acl_fragmentation_pos = 0; 934d999b54eSMatthias Ringwald hci_stack->acl_fragmentation_total_size = 0; 935d999b54eSMatthias Ringwald } 936452cf3bbS[email protected] 937452cf3bbS[email protected] // send packet 938452cf3bbS[email protected] uint8_t * packet = &hci_stack->hci_packet_buffer[acl_header_pos]; 939452cf3bbS[email protected] const int size = current_acl_data_packet_length + 4; 9405bb5bc3eS[email protected] hci_dump_packet(HCI_ACL_DATA_PACKET, 0, packet, size); 94181d2bdb2SMatthias Ringwald hci_stack->acl_fragmentation_tx_active = 1; 9423e2050f7SMatthias Ringwald int err = hci_stack->hci_transport->send_packet(HCI_ACL_DATA_PACKET, packet, size); 9433e2050f7SMatthias Ringwald if (err != 0){ 9443e2050f7SMatthias Ringwald // no error from HCI Transport expected 9453e2050f7SMatthias Ringwald status = ERROR_CODE_HARDWARE_FAILURE; 946a84946b2SMatthias Ringwald break; 9473e2050f7SMatthias Ringwald } 948452cf3bbS[email protected] 9498ad9cf99SMatthias Ringwald #ifdef ENABLE_CONTROLLER_DUMP_PACKETS 9508ad9cf99SMatthias Ringwald hci_controller_dump_packets(); 9518ad9cf99SMatthias Ringwald #endif 9528ad9cf99SMatthias Ringwald 9531979f09cSMatthias Ringwald log_debug("hci_send_acl_packet_fragments loop after send (more fragments %d)", (int) more_fragments); 954d999b54eSMatthias Ringwald 955452cf3bbS[email protected] // done yet? 956452cf3bbS[email protected] if (!more_fragments) break; 957452cf3bbS[email protected] 958452cf3bbS[email protected] // can send more? 9593e2050f7SMatthias Ringwald if (!hci_can_send_prepared_acl_packet_now(connection->con_handle)) return status; 960452cf3bbS[email protected] } 961452cf3bbS[email protected] 962d999b54eSMatthias Ringwald log_debug("hci_send_acl_packet_fragments loop over"); 963452cf3bbS[email protected] 964d051460cS[email protected] // release buffer now for synchronous transport 965203bace6S[email protected] if (hci_transport_synchronous()){ 96681d2bdb2SMatthias Ringwald hci_stack->acl_fragmentation_tx_active = 0; 967452cf3bbS[email protected] hci_release_packet_buffer(); 968452cf3bbS[email protected] } 969452cf3bbS[email protected] 9703e2050f7SMatthias Ringwald return status; 971452cf3bbS[email protected] } 972452cf3bbS[email protected] 973826f7347S[email protected] // pre: caller has reserved the packet buffer 9743e2050f7SMatthias Ringwald uint8_t hci_send_acl_packet_buffer(int size){ 9753e2050f7SMatthias Ringwald btstack_assert(hci_stack->hci_packet_buffer_reserved); 976826f7347S[email protected] 977d713a683S[email protected] uint8_t * packet = hci_stack->hci_packet_buffer; 978d713a683S[email protected] hci_con_handle_t con_handle = READ_ACL_CONNECTION_HANDLE(packet); 979d713a683S[email protected] 9805061f3afS[email protected] hci_connection_t *connection = hci_connection_for_handle( con_handle); 98197b61c7bS[email protected] if (!connection) { 9825fa0b7cfS[email protected] log_error("hci_send_acl_packet_buffer called but no connection for handle 0x%04x", con_handle); 98397b61c7bS[email protected] hci_release_packet_buffer(); 9843e2050f7SMatthias Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 98597b61c7bS[email protected] } 98652db98b2SMatthias Ringwald 98779a2851bSMilanka Ringwald // check for free places on Bluetooth module 98879a2851bSMilanka Ringwald if (!hci_can_send_prepared_acl_packet_now(con_handle)) { 98979a2851bSMilanka Ringwald log_error("hci_send_acl_packet_buffer called but no free ACL buffers on controller"); 99079a2851bSMilanka Ringwald hci_release_packet_buffer(); 99179a2851bSMilanka Ringwald return BTSTACK_ACL_BUFFERS_FULL; 99279a2851bSMilanka Ringwald } 99379a2851bSMilanka Ringwald 99452db98b2SMatthias Ringwald #ifdef ENABLE_CLASSIC 99556cf178bSmatthias.ringwald hci_connection_timestamp(connection); 99652db98b2SMatthias Ringwald #endif 99756cf178bSmatthias.ringwald 998452cf3bbS[email protected] // hci_dump_packet( HCI_ACL_DATA_PACKET, 0, packet, size); 9997856c818Smatthias.ringwald 1000452cf3bbS[email protected] // setup data 1001452cf3bbS[email protected] hci_stack->acl_fragmentation_total_size = size; 1002452cf3bbS[email protected] hci_stack->acl_fragmentation_pos = 4; // start of L2CAP packet 10036218e6f1Smatthias.ringwald 1004452cf3bbS[email protected] return hci_send_acl_packet_fragments(connection); 1005ee091cf1Smatthias.ringwald } 1006ee091cf1Smatthias.ringwald 100735454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 100844d0e3d5S[email protected] // pre: caller has reserved the packet buffer 10093e2050f7SMatthias Ringwald uint8_t hci_send_sco_packet_buffer(int size){ 10103e2050f7SMatthias Ringwald btstack_assert(hci_stack->hci_packet_buffer_reserved); 101144d0e3d5S[email protected] 101244d0e3d5S[email protected] uint8_t * packet = hci_stack->hci_packet_buffer; 10134b3e1e19SMatthias Ringwald 10144b3e1e19SMatthias Ringwald // skip checks in loopback mode 10154b3e1e19SMatthias Ringwald if (!hci_stack->loopback_mode){ 101644d0e3d5S[email protected] hci_con_handle_t con_handle = READ_ACL_CONNECTION_HANDLE(packet); // same for ACL and SCO 101744d0e3d5S[email protected] 101844d0e3d5S[email protected] // check for free places on Bluetooth module 1019701e3307SMatthias Ringwald if (!hci_can_send_prepared_sco_packet_now()) { 1020cbf638a9SMatthias Ringwald log_error("hci_send_sco_packet_buffer called but no free SCO buffers on controller"); 102144d0e3d5S[email protected] hci_release_packet_buffer(); 102244d0e3d5S[email protected] return BTSTACK_ACL_BUFFERS_FULL; 102344d0e3d5S[email protected] } 102444d0e3d5S[email protected] 1025e35edcc1S[email protected] // track send packet in connection struct 1026e35edcc1S[email protected] hci_connection_t *connection = hci_connection_for_handle( con_handle); 1027e35edcc1S[email protected] if (!connection) { 1028e35edcc1S[email protected] log_error("hci_send_sco_packet_buffer called but no connection for handle 0x%04x", con_handle); 1029e35edcc1S[email protected] hci_release_packet_buffer(); 10303e2050f7SMatthias Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 1031e35edcc1S[email protected] } 1032f234b250SMatthias Ringwald 1033f234b250SMatthias Ringwald if (hci_have_usb_transport()){ 1034f234b250SMatthias Ringwald // token used 10351972f31fSMatthias Ringwald hci_stack->sco_can_send_now = false; 1036f234b250SMatthias Ringwald } else { 1037760b20efSMatthias Ringwald if (hci_stack->synchronous_flow_control_enabled){ 1038ce41473eSMatthias Ringwald connection->num_packets_sent++; 10396f28d2eeSMatthias Ringwald } else { 1040e4157653SMatthias Ringwald connection->sco_tx_ready--; 1041760b20efSMatthias Ringwald } 10424b3e1e19SMatthias Ringwald } 1043f234b250SMatthias Ringwald } 104444d0e3d5S[email protected] 104544d0e3d5S[email protected] hci_dump_packet( HCI_SCO_DATA_PACKET, 0, packet, size); 1046543e835cSMatthias Ringwald 104743149fc9SMatthias Ringwald #ifdef HAVE_SCO_TRANSPORT 104843149fc9SMatthias Ringwald hci_stack->sco_transport->send_packet(packet, size); 104943149fc9SMatthias Ringwald hci_release_packet_buffer(); 105043149fc9SMatthias Ringwald hci_emit_transport_packet_sent(); 105143149fc9SMatthias Ringwald 105243149fc9SMatthias Ringwald return 0; 105343149fc9SMatthias Ringwald #else 105443149fc9SMatthias Ringwald int err = hci_stack->hci_transport->send_packet(HCI_SCO_DATA_PACKET, packet, size); 1055a84946b2SMatthias Ringwald uint8_t status; 1056a84946b2SMatthias Ringwald if (err == 0){ 1057a84946b2SMatthias Ringwald status = ERROR_CODE_SUCCESS; 1058a84946b2SMatthias Ringwald } else { 1059a84946b2SMatthias Ringwald status = ERROR_CODE_HARDWARE_FAILURE; 1060a84946b2SMatthias Ringwald } 1061a84946b2SMatthias Ringwald if ((status != ERROR_CODE_SUCCESS) || hci_transport_synchronous()){ 1062543e835cSMatthias Ringwald hci_release_packet_buffer(); 1063543e835cSMatthias Ringwald } 1064a84946b2SMatthias Ringwald return status; 106543149fc9SMatthias Ringwald #endif 106644d0e3d5S[email protected] } 106735454696SMatthias Ringwald #endif 106844d0e3d5S[email protected] 10690a8cccd5SMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS 107068ab6207SMatthias Ringwald static uint8_t hci_send_iso_packet_fragments(void){ 107168ab6207SMatthias Ringwald 107268ab6207SMatthias Ringwald uint16_t max_iso_data_packet_length = hci_stack->le_iso_packets_length; 107368ab6207SMatthias Ringwald uint8_t status = ERROR_CODE_SUCCESS; 107468ab6207SMatthias Ringwald // multiple packets could be send on a synchronous HCI transport 107568ab6207SMatthias Ringwald while (true){ 107668ab6207SMatthias Ringwald 107768ab6207SMatthias Ringwald // get current data 107868ab6207SMatthias Ringwald const uint16_t iso_header_pos = hci_stack->iso_fragmentation_pos - 4u; 107968ab6207SMatthias Ringwald int current_iso_data_packet_length = hci_stack->iso_fragmentation_total_size - hci_stack->iso_fragmentation_pos; 108068ab6207SMatthias Ringwald bool more_fragments = false; 108168ab6207SMatthias Ringwald 108268ab6207SMatthias Ringwald // if ISO packet is larger than Bluetooth packet buffer, only send max_acl_data_packet_length 108368ab6207SMatthias Ringwald if (current_iso_data_packet_length > max_iso_data_packet_length){ 108468ab6207SMatthias Ringwald more_fragments = true; 108568ab6207SMatthias Ringwald current_iso_data_packet_length = max_iso_data_packet_length; 108668ab6207SMatthias Ringwald } 108768ab6207SMatthias Ringwald 108868ab6207SMatthias Ringwald // copy handle_and_flags if not first fragment and update packet boundary flags to be 01 (continuing fragmnent) 108968ab6207SMatthias Ringwald uint16_t handle_and_flags = little_endian_read_16(hci_stack->hci_packet_buffer, 0); 109068ab6207SMatthias Ringwald uint8_t pb_flags; 109168ab6207SMatthias Ringwald if (iso_header_pos == 0u){ 109268ab6207SMatthias Ringwald // first fragment, keep TS field 109368ab6207SMatthias Ringwald pb_flags = more_fragments ? 0x00 : 0x02; 109468ab6207SMatthias Ringwald handle_and_flags = (handle_and_flags & 0x4fffu) | (pb_flags << 12u); 109568ab6207SMatthias Ringwald } else { 109668ab6207SMatthias Ringwald // later fragment, drop TS field 109768ab6207SMatthias Ringwald pb_flags = more_fragments ? 0x01 : 0x03; 109868ab6207SMatthias Ringwald handle_and_flags = (handle_and_flags & 0x0fffu) | (pb_flags << 12u); 109968ab6207SMatthias Ringwald } 110068ab6207SMatthias Ringwald little_endian_store_16(hci_stack->hci_packet_buffer, iso_header_pos, handle_and_flags); 110168ab6207SMatthias Ringwald 110268ab6207SMatthias Ringwald // update header len 110368ab6207SMatthias Ringwald little_endian_store_16(hci_stack->hci_packet_buffer, iso_header_pos + 2u, current_iso_data_packet_length); 110468ab6207SMatthias Ringwald 110568ab6207SMatthias Ringwald // update state for next fragment (if any) as "transport done" might be sent during send_packet already 110668ab6207SMatthias Ringwald if (more_fragments){ 110768ab6207SMatthias Ringwald // update start of next fragment to send 110868ab6207SMatthias Ringwald hci_stack->iso_fragmentation_pos += current_iso_data_packet_length; 110968ab6207SMatthias Ringwald } else { 111068ab6207SMatthias Ringwald // done 111168ab6207SMatthias Ringwald hci_stack->iso_fragmentation_pos = 0; 111268ab6207SMatthias Ringwald hci_stack->iso_fragmentation_total_size = 0; 111368ab6207SMatthias Ringwald } 111468ab6207SMatthias Ringwald 111568ab6207SMatthias Ringwald // send packet 111668ab6207SMatthias Ringwald uint8_t * packet = &hci_stack->hci_packet_buffer[iso_header_pos]; 111768ab6207SMatthias Ringwald const int size = current_iso_data_packet_length + 4; 111868ab6207SMatthias Ringwald hci_dump_packet(HCI_ISO_DATA_PACKET, 0, packet, size); 111968ab6207SMatthias Ringwald hci_stack->iso_fragmentation_tx_active = true; 112068ab6207SMatthias Ringwald int err = hci_stack->hci_transport->send_packet(HCI_ISO_DATA_PACKET, packet, size); 112168ab6207SMatthias Ringwald if (err != 0){ 112268ab6207SMatthias Ringwald // no error from HCI Transport expected 112368ab6207SMatthias Ringwald status = ERROR_CODE_HARDWARE_FAILURE; 112468ab6207SMatthias Ringwald } 112568ab6207SMatthias Ringwald 112668ab6207SMatthias Ringwald // done yet? 112768ab6207SMatthias Ringwald if (!more_fragments) break; 112868ab6207SMatthias Ringwald 112968ab6207SMatthias Ringwald // can send more? 113068ab6207SMatthias Ringwald if (!hci_transport_can_send_prepared_packet_now(HCI_ISO_DATA_PACKET)) return false; 113168ab6207SMatthias Ringwald } 113268ab6207SMatthias Ringwald 113368ab6207SMatthias Ringwald // release buffer now for synchronous transport 113468ab6207SMatthias Ringwald if (hci_transport_synchronous()){ 113568ab6207SMatthias Ringwald hci_stack->iso_fragmentation_tx_active = false; 113668ab6207SMatthias Ringwald hci_release_packet_buffer(); 113768ab6207SMatthias Ringwald hci_emit_transport_packet_sent(); 113868ab6207SMatthias Ringwald } 113968ab6207SMatthias Ringwald 114068ab6207SMatthias Ringwald return status; 114168ab6207SMatthias Ringwald } 114268ab6207SMatthias Ringwald 1143ace08712SMatthias Ringwald uint8_t hci_send_iso_packet_buffer(uint16_t size){ 1144ace08712SMatthias Ringwald btstack_assert(hci_stack->hci_packet_buffer_reserved); 1145ace08712SMatthias Ringwald 1146e5413aa0SMatthias Ringwald hci_con_handle_t con_handle = (hci_con_handle_t) little_endian_read_16(hci_stack->hci_packet_buffer, 0) & 0xfff; 1147e5413aa0SMatthias Ringwald hci_iso_stream_t * iso_stream = hci_iso_stream_for_con_handle(con_handle); 1148e5413aa0SMatthias Ringwald if (iso_stream == NULL){ 1149977f918dSMatthias Ringwald hci_release_packet_buffer(); 1150977f918dSMatthias Ringwald hci_iso_notify_can_send_now(); 1151e5413aa0SMatthias Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 1152e5413aa0SMatthias Ringwald } 1153e5413aa0SMatthias Ringwald 1154e5413aa0SMatthias Ringwald // TODO: check for space on controller 1155e5413aa0SMatthias Ringwald 1156977f918dSMatthias Ringwald // skip iso packets if needed 1157977f918dSMatthias Ringwald if (iso_stream->num_packets_to_skip > 0){ 1158977f918dSMatthias Ringwald iso_stream->num_packets_to_skip--; 1159977f918dSMatthias Ringwald // pretend it was processed and trigger next one 1160977f918dSMatthias Ringwald hci_release_packet_buffer(); 1161977f918dSMatthias Ringwald hci_iso_notify_can_send_now(); 1162977f918dSMatthias Ringwald return ERROR_CODE_SUCCESS; 1163977f918dSMatthias Ringwald } 1164977f918dSMatthias Ringwald 1165e5413aa0SMatthias Ringwald // track outgoing packet sent 1166e5413aa0SMatthias Ringwald log_info("Outgoing ISO packet for con handle 0x%04x", con_handle); 1167e5413aa0SMatthias Ringwald iso_stream->num_packets_sent++; 1168e5413aa0SMatthias Ringwald 116968ab6207SMatthias Ringwald // setup data 117068ab6207SMatthias Ringwald hci_stack->iso_fragmentation_total_size = size; 117168ab6207SMatthias Ringwald hci_stack->iso_fragmentation_pos = 4; // start of L2CAP packet 117268ab6207SMatthias Ringwald 117368ab6207SMatthias Ringwald return hci_send_iso_packet_fragments(); 1174ace08712SMatthias Ringwald } 1175ace08712SMatthias Ringwald #endif 1176ace08712SMatthias Ringwald 1177c3b46f5aSMatthias Ringwald static void acl_handler(uint8_t *packet, uint16_t size){ 1178e76a89eeS[email protected] 11797856c818Smatthias.ringwald // get info 11807856c818Smatthias.ringwald hci_con_handle_t con_handle = READ_ACL_CONNECTION_HANDLE(packet); 11815061f3afS[email protected] hci_connection_t *conn = hci_connection_for_handle(con_handle); 11827856c818Smatthias.ringwald uint8_t acl_flags = READ_ACL_FLAGS(packet); 11837856c818Smatthias.ringwald uint16_t acl_length = READ_ACL_LENGTH(packet); 11847856c818Smatthias.ringwald 11857856c818Smatthias.ringwald // ignore non-registered handle 11867856c818Smatthias.ringwald if (!conn){ 1187c3b46f5aSMatthias Ringwald log_error("acl_handler called with non-registered handle %u!" , con_handle); 11887856c818Smatthias.ringwald return; 11897856c818Smatthias.ringwald } 11907856c818Smatthias.ringwald 1191e76a89eeS[email protected] // assert packet is complete 11924ea43905SMatthias Ringwald if ((acl_length + 4u) != size){ 1193c3b46f5aSMatthias Ringwald log_error("acl_handler called with ACL packet of wrong size %d, expected %u => dropping packet", size, acl_length + 4); 1194e76a89eeS[email protected] return; 1195e76a89eeS[email protected] } 1196e76a89eeS[email protected] 119752db98b2SMatthias Ringwald #ifdef ENABLE_CLASSIC 11987856c818Smatthias.ringwald // update idle timestamp 11997856c818Smatthias.ringwald hci_connection_timestamp(conn); 120052db98b2SMatthias Ringwald #endif 12017856c818Smatthias.ringwald 12022b838201SMatthias Ringwald #ifdef ENABLE_HCI_CONTROLLER_TO_HOST_FLOW_CONTROL 12032b838201SMatthias Ringwald hci_stack->host_completed_packets = 1; 12042b838201SMatthias Ringwald conn->num_packets_completed++; 12052b838201SMatthias Ringwald #endif 12062b838201SMatthias Ringwald 12077856c818Smatthias.ringwald // handle different packet types 12084ea43905SMatthias Ringwald switch (acl_flags & 0x03u) { 12097856c818Smatthias.ringwald 12107856c818Smatthias.ringwald case 0x01: // continuation fragment 12117856c818Smatthias.ringwald 12120ca847afS[email protected] // sanity checks 12134ea43905SMatthias Ringwald if (conn->acl_recombination_pos == 0u) { 12149da54300S[email protected] log_error( "ACL Cont Fragment but no first fragment for handle 0x%02x", con_handle); 12157856c818Smatthias.ringwald return; 12167856c818Smatthias.ringwald } 12174ea43905SMatthias Ringwald if ((conn->acl_recombination_pos + acl_length) > (4u + HCI_ACL_BUFFER_SIZE)){ 12180ca847afS[email protected] log_error( "ACL Cont Fragment to large: combined packet %u > buffer size %u for handle 0x%02x", 12190ca847afS[email protected] conn->acl_recombination_pos + acl_length, 4 + HCI_ACL_BUFFER_SIZE, con_handle); 12200ca847afS[email protected] conn->acl_recombination_pos = 0; 12210ca847afS[email protected] return; 12220ca847afS[email protected] } 12237856c818Smatthias.ringwald 12247856c818Smatthias.ringwald // append fragment payload (header already stored) 12256535961aSMatthias Ringwald (void)memcpy(&conn->acl_recombination_buffer[HCI_INCOMING_PRE_BUFFER_SIZE + conn->acl_recombination_pos], 12266535961aSMatthias Ringwald &packet[4], acl_length); 12277856c818Smatthias.ringwald conn->acl_recombination_pos += acl_length; 12287856c818Smatthias.ringwald 12297856c818Smatthias.ringwald // forward complete L2CAP packet if complete. 12304ea43905SMatthias Ringwald if (conn->acl_recombination_pos >= (conn->acl_recombination_length + 4u + 4u)){ // pos already incl. ACL header 1231d6b06661SMatthias Ringwald hci_emit_acl_packet(&conn->acl_recombination_buffer[HCI_INCOMING_PRE_BUFFER_SIZE], conn->acl_recombination_pos); 12327856c818Smatthias.ringwald // reset recombination buffer 12337856c818Smatthias.ringwald conn->acl_recombination_length = 0; 12347856c818Smatthias.ringwald conn->acl_recombination_pos = 0; 12357856c818Smatthias.ringwald } 12367856c818Smatthias.ringwald break; 12377856c818Smatthias.ringwald 12387856c818Smatthias.ringwald case 0x02: { // first fragment 12397856c818Smatthias.ringwald 124023a77e1aS[email protected] // sanity check 124123a77e1aS[email protected] if (conn->acl_recombination_pos) { 124260737d2bSMatthias Ringwald // we just received the first fragment, but still have data. Only warn if the packet wasn't a flushable packet 124360737d2bSMatthias Ringwald if ((conn->acl_recombination_buffer[HCI_INCOMING_PRE_BUFFER_SIZE+1] >> 4) != 0x02){ 124460737d2bSMatthias Ringwald log_error( "ACL First Fragment but %u bytes in buffer for handle 0x%02x, dropping stale fragments", conn->acl_recombination_pos, con_handle); 124560737d2bSMatthias Ringwald } 124623a77e1aS[email protected] conn->acl_recombination_pos = 0; 124723a77e1aS[email protected] } 124823a77e1aS[email protected] 12497856c818Smatthias.ringwald // peek into L2CAP packet! 12507856c818Smatthias.ringwald uint16_t l2cap_length = READ_L2CAP_LENGTH( packet ); 12517856c818Smatthias.ringwald 12527856c818Smatthias.ringwald // compare fragment size to L2CAP packet size 12534ea43905SMatthias Ringwald if (acl_length >= (l2cap_length + 4u)){ 12547856c818Smatthias.ringwald // forward fragment as L2CAP packet 12554ea43905SMatthias Ringwald hci_emit_acl_packet(packet, acl_length + 4u); 12567856c818Smatthias.ringwald } else { 12570ca847afS[email protected] 12580ca847afS[email protected] if (acl_length > HCI_ACL_BUFFER_SIZE){ 12590ca847afS[email protected] log_error( "ACL First Fragment to large: fragment %u > buffer size %u for handle 0x%02x", 12600ca847afS[email protected] 4 + acl_length, 4 + HCI_ACL_BUFFER_SIZE, con_handle); 12610ca847afS[email protected] return; 12620ca847afS[email protected] } 12630ca847afS[email protected] 12647856c818Smatthias.ringwald // store first fragment and tweak acl length for complete package 12656535961aSMatthias Ringwald (void)memcpy(&conn->acl_recombination_buffer[HCI_INCOMING_PRE_BUFFER_SIZE], 12664ea43905SMatthias Ringwald packet, acl_length + 4u); 12674ea43905SMatthias Ringwald conn->acl_recombination_pos = acl_length + 4u; 12687856c818Smatthias.ringwald conn->acl_recombination_length = l2cap_length; 12694ea43905SMatthias Ringwald little_endian_store_16(conn->acl_recombination_buffer, HCI_INCOMING_PRE_BUFFER_SIZE + 2u, l2cap_length +4u); 12707856c818Smatthias.ringwald } 12717856c818Smatthias.ringwald break; 12727856c818Smatthias.ringwald 12737856c818Smatthias.ringwald } 12747856c818Smatthias.ringwald default: 1275c3b46f5aSMatthias Ringwald log_error( "acl_handler called with invalid packet boundary flags %u", acl_flags & 0x03); 12767856c818Smatthias.ringwald return; 12777856c818Smatthias.ringwald } 127894ab26f8Smatthias.ringwald 127994ab26f8Smatthias.ringwald // execute main loop 128094ab26f8Smatthias.ringwald hci_run(); 128116833f0aSmatthias.ringwald } 128222909952Smatthias.ringwald 12831ab2dc58SMatthias Ringwald static void hci_connection_stop_timer(hci_connection_t * conn){ 12841ab2dc58SMatthias Ringwald btstack_run_loop_remove_timer(&conn->timeout); 12851ab2dc58SMatthias Ringwald #ifdef ENABLE_CLASSIC 12861ab2dc58SMatthias Ringwald btstack_run_loop_remove_timer(&conn->timeout_sco); 12871ab2dc58SMatthias Ringwald #endif 12881ab2dc58SMatthias Ringwald } 12891ab2dc58SMatthias Ringwald 129067a3e8ecSmatthias.ringwald static void hci_shutdown_connection(hci_connection_t *conn){ 12919da54300S[email protected] log_info("Connection closed: handle 0x%x, %s", conn->con_handle, bd_addr_to_str(conn->address)); 12923c4d4b90Smatthias.ringwald 1293b3264428SMatthias Ringwald #ifdef ENABLE_CLASSIC 1294cb70c5abSMatthias Ringwald #if defined(ENABLE_SCO_OVER_HCI) || defined(HAVE_SCO_TRANSPORT) 1295cb70c5abSMatthias Ringwald bd_addr_type_t addr_type = conn->address_type; 1296cb70c5abSMatthias Ringwald #endif 1297cb70c5abSMatthias Ringwald #ifdef HAVE_SCO_TRANSPORT 1298cb70c5abSMatthias Ringwald hci_con_handle_t con_handle = conn->con_handle; 1299ee752bb8SMatthias Ringwald #endif 1300b3264428SMatthias Ringwald #endif 1301ee752bb8SMatthias Ringwald 13021ab2dc58SMatthias Ringwald hci_connection_stop_timer(conn); 1303c785ef68Smatthias.ringwald 1304665d90f2SMatthias Ringwald btstack_linked_list_remove(&hci_stack->connections, (btstack_linked_item_t *) conn); 1305a3b02b71Smatthias.ringwald btstack_memory_hci_connection_free( conn ); 13063c4d4b90Smatthias.ringwald 13073c4d4b90Smatthias.ringwald // now it's gone 1308c7e0c5f6Smatthias.ringwald hci_emit_nr_connections_changed(); 1309ee752bb8SMatthias Ringwald 1310b3264428SMatthias Ringwald #ifdef ENABLE_CLASSIC 1311034e9b53SMatthias Ringwald #ifdef ENABLE_SCO_OVER_HCI 1312ee752bb8SMatthias Ringwald // update SCO 1313cb70c5abSMatthias Ringwald if ((addr_type == BD_ADDR_TYPE_SCO) && (hci_stack->hci_transport != NULL) && (hci_stack->hci_transport->set_sco_config != NULL)){ 1314ee752bb8SMatthias Ringwald hci_stack->hci_transport->set_sco_config(hci_stack->sco_voice_setting_active, hci_number_sco_connections()); 1315ee752bb8SMatthias Ringwald } 1316034e9b53SMatthias Ringwald #endif 1317cb70c5abSMatthias Ringwald #ifdef HAVE_SCO_TRANSPORT 1318cb70c5abSMatthias Ringwald if ((addr_type == BD_ADDR_TYPE_SCO) && (hci_stack->sco_transport != NULL)){ 1319cb70c5abSMatthias Ringwald hci_stack->sco_transport->close(con_handle); 1320cb70c5abSMatthias Ringwald } 1321cb70c5abSMatthias Ringwald #endif 1322b3264428SMatthias Ringwald #endif 1323c7e0c5f6Smatthias.ringwald } 1324c7e0c5f6Smatthias.ringwald 132535454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 132635454696SMatthias Ringwald 132729e39de4SMatthias Ringwald static const uint16_t hci_acl_packet_type_sizes[] = { 13288f8108aaSmatthias.ringwald 0, HCI_ACL_2DH1_SIZE, HCI_ACL_3DH1_SIZE, HCI_ACL_DM1_SIZE, 13298f8108aaSmatthias.ringwald HCI_ACL_DH1_SIZE, 0, 0, 0, 13308f8108aaSmatthias.ringwald HCI_ACL_2DH3_SIZE, HCI_ACL_3DH3_SIZE, HCI_ACL_DM3_SIZE, HCI_ACL_DH3_SIZE, 13318f8108aaSmatthias.ringwald HCI_ACL_2DH5_SIZE, HCI_ACL_3DH5_SIZE, HCI_ACL_DM5_SIZE, HCI_ACL_DH5_SIZE 13328f8108aaSmatthias.ringwald }; 133329e39de4SMatthias Ringwald static const uint8_t hci_acl_packet_type_feature_requirement_bit[] = { 133465389bfcS[email protected] 0, // 3 slot packets 133565389bfcS[email protected] 1, // 5 slot packets 133665389bfcS[email protected] 25, // EDR 2 mpbs 133765389bfcS[email protected] 26, // EDR 3 mbps 133865389bfcS[email protected] 39, // 3 slot EDR packts 133965389bfcS[email protected] 40, // 5 slot EDR packet 134065389bfcS[email protected] }; 134129e39de4SMatthias Ringwald static const uint16_t hci_acl_packet_type_feature_packet_mask[] = { 134265389bfcS[email protected] 0x0f00, // 3 slot packets 134365389bfcS[email protected] 0xf000, // 5 slot packets 134465389bfcS[email protected] 0x1102, // EDR 2 mpbs 134565389bfcS[email protected] 0x2204, // EDR 3 mbps 134665389bfcS[email protected] 0x0300, // 3 slot EDR packts 134765389bfcS[email protected] 0x3000, // 5 slot EDR packet 134865389bfcS[email protected] }; 13498f8108aaSmatthias.ringwald 135065389bfcS[email protected] static uint16_t hci_acl_packet_types_for_buffer_size_and_local_features(uint16_t buffer_size, uint8_t * local_supported_features){ 135165389bfcS[email protected] // enable packet types based on size 13528f8108aaSmatthias.ringwald uint16_t packet_types = 0; 1353f16a69bbS[email protected] unsigned int i; 13548f8108aaSmatthias.ringwald for (i=0;i<16;i++){ 135529e39de4SMatthias Ringwald if (hci_acl_packet_type_sizes[i] == 0) continue; 135629e39de4SMatthias Ringwald if (hci_acl_packet_type_sizes[i] <= buffer_size){ 13578f8108aaSmatthias.ringwald packet_types |= 1 << i; 13588f8108aaSmatthias.ringwald } 13598f8108aaSmatthias.ringwald } 136065389bfcS[email protected] // disable packet types due to missing local supported features 136129e39de4SMatthias Ringwald for (i=0;i<sizeof(hci_acl_packet_type_feature_requirement_bit); i++){ 136229e39de4SMatthias Ringwald unsigned int bit_idx = hci_acl_packet_type_feature_requirement_bit[i]; 136365389bfcS[email protected] int feature_set = (local_supported_features[bit_idx >> 3] & (1<<(bit_idx & 7))) != 0; 136465389bfcS[email protected] if (feature_set) continue; 136529e39de4SMatthias Ringwald log_info("Features bit %02u is not set, removing packet types 0x%04x", bit_idx, hci_acl_packet_type_feature_packet_mask[i]); 136629e39de4SMatthias Ringwald packet_types &= ~hci_acl_packet_type_feature_packet_mask[i]; 136765389bfcS[email protected] } 13688f8108aaSmatthias.ringwald return packet_types; 13698f8108aaSmatthias.ringwald } 13708f8108aaSmatthias.ringwald 13718f8108aaSmatthias.ringwald uint16_t hci_usable_acl_packet_types(void){ 1372028ead5eSMatthias Ringwald uint16_t active_packet_types = (hci_stack->usable_packet_types_acl & hci_stack->enabled_packet_types_acl); 137329e39de4SMatthias Ringwald // flip bits for "may not be used" 1374028ead5eSMatthias Ringwald return active_packet_types ^ 0x3306; 1375028ead5eSMatthias Ringwald } 1376028ead5eSMatthias Ringwald 1377028ead5eSMatthias Ringwald void hci_enable_acl_packet_types(uint16_t packet_types){ 1378028ead5eSMatthias Ringwald hci_stack->enabled_packet_types_acl = packet_types; 13798f8108aaSmatthias.ringwald } 138029e39de4SMatthias Ringwald 1381c92ca2c8SMatthias Ringwald static const struct { 1382c92ca2c8SMatthias Ringwald uint8_t feature_index; 1383c92ca2c8SMatthias Ringwald uint16_t feature_packet_mask; 1384c92ca2c8SMatthias Ringwald } hci_sco_packet_type_feature_requirements[] = { 1385c92ca2c8SMatthias Ringwald { 12, SCO_PACKET_TYPES_HV2 }, // HV2 packets 1386c92ca2c8SMatthias Ringwald { 13, SCO_PACKET_TYPES_HV3 }, // HV3 packets 1387c92ca2c8SMatthias Ringwald { 31, SCO_PACKET_TYPES_ESCO }, // eSCO links (EV3 packets) 1388c92ca2c8SMatthias Ringwald { 32, SCO_PACKET_TYPES_EV4 }, // EV4 packets 1389c92ca2c8SMatthias Ringwald { 45, SCO_PACKET_TYPES_2EV3 | SCO_PACKET_TYPES_2EV5 }, // EDR eSCO 2 Mb/s 1390c92ca2c8SMatthias Ringwald { 46, SCO_PACKET_TYPES_3EV3 | SCO_PACKET_TYPES_3EV5 }, // EDR eSCO 3 Mb/s 13916afff830SMatthias Ringwald { 47, SCO_PACKET_TYPES_2EV5 | SCO_PACKET_TYPES_3EV5 }, // 3-slot EDR eSCO packets, 2-EV3/3-EV3 use single slot 1392c92ca2c8SMatthias Ringwald }; 1393c92ca2c8SMatthias Ringwald 1394d7891039SMatthias Ringwald // map packet types to payload length, prefer eSCO over SCO and large over small packets 1395d7891039SMatthias Ringwald static const struct { 1396d7891039SMatthias Ringwald uint16_t type; 1397d7891039SMatthias Ringwald uint16_t payload_length; 1398d7891039SMatthias Ringwald } hci_sco_packet_type_to_payload_length[] = { 1399d7891039SMatthias Ringwald {SCO_PACKET_TYPES_3EV5, HCI_SCO_3EV5_SIZE}, // 540 1400d7891039SMatthias Ringwald {SCO_PACKET_TYPES_2EV5, HCI_SCO_2EV5_SIZE}, // 360 1401d7891039SMatthias Ringwald {SCO_PACKET_TYPES_EV5, HCI_SCO_EV5_SIZE}, // 180 1402d7891039SMatthias Ringwald {SCO_PACKET_TYPES_EV4, HCI_SCO_EV4_SIZE}, // 120 1403d7891039SMatthias Ringwald {SCO_PACKET_TYPES_3EV3, HCI_SCO_3EV3_SIZE}, // 90 1404d7891039SMatthias Ringwald {SCO_PACKET_TYPES_2EV3, HCI_SCO_2EV3_SIZE}, // 60 1405d7891039SMatthias Ringwald {SCO_PACKET_TYPES_EV3, HCI_SCO_EV3_SIZE}, // 30 1406d7891039SMatthias Ringwald {SCO_PACKET_TYPES_HV3, HCI_SCO_HV3_SIZE}, // 30 1407d7891039SMatthias Ringwald {SCO_PACKET_TYPES_HV2, HCI_SCO_HV2_SIZE}, // 20 1408d7891039SMatthias Ringwald {SCO_PACKET_TYPES_HV1, HCI_SCO_HV1_SIZE} // 10 1409d7891039SMatthias Ringwald }; 1410d7891039SMatthias Ringwald 1411c92ca2c8SMatthias Ringwald static uint16_t hci_sco_packet_types_for_features(const uint8_t * local_supported_features){ 1412c92ca2c8SMatthias Ringwald uint16_t packet_types = SCO_PACKET_TYPES_ALL; 1413c92ca2c8SMatthias Ringwald unsigned int i; 1414c92ca2c8SMatthias Ringwald // disable packet types due to missing local supported features 1415c92ca2c8SMatthias Ringwald for (i=0;i<(sizeof(hci_sco_packet_type_feature_requirements)/sizeof(hci_sco_packet_type_feature_requirements[0])); i++){ 1416c92ca2c8SMatthias Ringwald unsigned int bit_idx = hci_sco_packet_type_feature_requirements[i].feature_index; 1417c92ca2c8SMatthias Ringwald bool feature_set = (local_supported_features[bit_idx >> 3] & (1<<(bit_idx & 7))) != 0; 1418c92ca2c8SMatthias Ringwald if (feature_set) continue; 1419c92ca2c8SMatthias Ringwald log_info("Features bit %02u is not set, removing packet types 0x%04x", bit_idx, hci_sco_packet_type_feature_requirements[i].feature_packet_mask); 1420c92ca2c8SMatthias Ringwald packet_types &= ~hci_sco_packet_type_feature_requirements[i].feature_packet_mask; 1421c92ca2c8SMatthias Ringwald } 1422c92ca2c8SMatthias Ringwald return packet_types; 1423c92ca2c8SMatthias Ringwald } 1424c92ca2c8SMatthias Ringwald 1425c92ca2c8SMatthias Ringwald uint16_t hci_usable_sco_packet_types(void){ 1426c92ca2c8SMatthias Ringwald return hci_stack->usable_packet_types_sco; 1427c92ca2c8SMatthias Ringwald } 1428c92ca2c8SMatthias Ringwald 1429d7891039SMatthias Ringwald static uint16_t hci_sco_payload_length_for_packet_types(uint16_t packet_types){ 1430d7891039SMatthias Ringwald uint8_t i; 1431d7891039SMatthias Ringwald for (i=0;i<sizeof(hci_sco_packet_type_to_payload_length)/sizeof(hci_sco_packet_type_to_payload_length[0]);i++){ 1432d7891039SMatthias Ringwald if ((hci_sco_packet_type_to_payload_length[i].type & packet_types) != 0){ 1433d7891039SMatthias Ringwald return hci_sco_packet_type_to_payload_length[i].payload_length; 1434d7891039SMatthias Ringwald } 1435d7891039SMatthias Ringwald } 1436d7891039SMatthias Ringwald return 0; 1437d7891039SMatthias Ringwald } 1438d7891039SMatthias Ringwald 143935454696SMatthias Ringwald #endif 14408f8108aaSmatthias.ringwald 1441facf93fdS[email protected] uint8_t* hci_get_outgoing_packet_buffer(void){ 14427dc17943Smatthias.ringwald // hci packet buffer is >= acl data packet length 14433a9fb326S[email protected] return hci_stack->hci_packet_buffer; 14447dc17943Smatthias.ringwald } 14457dc17943Smatthias.ringwald 1446f5d8d141S[email protected] uint16_t hci_max_acl_data_packet_length(void){ 14473a9fb326S[email protected] return hci_stack->acl_data_packet_length; 14487dc17943Smatthias.ringwald } 14497dc17943Smatthias.ringwald 145006b9e820SMatthias Ringwald #ifdef ENABLE_CLASSIC 145120dcdd22SMatthias Ringwald bool hci_extended_sco_link_supported(void){ 14523e68d23dSMatthias Ringwald // No. 31, byte 3, bit 7 14533e68d23dSMatthias Ringwald return (hci_stack->local_supported_features[3] & (1 << 7)) != 0; 14543e68d23dSMatthias Ringwald } 145506b9e820SMatthias Ringwald #endif 14563e68d23dSMatthias Ringwald 145720dcdd22SMatthias Ringwald bool hci_non_flushable_packet_boundary_flag_supported(void){ 14586ac9a97eS[email protected] // No. 54, byte 6, bit 6 14594ea43905SMatthias Ringwald return (hci_stack->local_supported_features[6u] & (1u << 6u)) != 0u; 14606ac9a97eS[email protected] } 14616ac9a97eS[email protected] 14629885fb2dSMatthias Ringwald #ifdef ENABLE_CLASSIC 146357514786SMatthias Ringwald static bool gap_ssp_supported(void){ 14646ac9a97eS[email protected] // No. 51, byte 6, bit 3 14654ea43905SMatthias Ringwald return (hci_stack->local_supported_features[6u] & (1u << 3u)) != 0u; 1466f5d8d141S[email protected] } 14679885fb2dSMatthias Ringwald #endif 1468f5d8d141S[email protected] 1469ad58a385SMatthias Ringwald bool hci_classic_supported(void){ 147035454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 14716ac9a97eS[email protected] // No. 37, byte 4, bit 5, = No BR/EDR Support 14723a9fb326S[email protected] return (hci_stack->local_supported_features[4] & (1 << 5)) == 0; 147335454696SMatthias Ringwald #else 147457514786SMatthias Ringwald return false; 147535454696SMatthias Ringwald #endif 1476f5d8d141S[email protected] } 1477f5d8d141S[email protected] 1478ad58a385SMatthias Ringwald bool hci_le_supported(void){ 1479a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE 14806ac9a97eS[email protected] // No. 37, byte 4, bit 6 = LE Supported (Controller) 14814ea43905SMatthias Ringwald return (hci_stack->local_supported_features[4u] & (1u << 6u)) != 0u; 1482f5d8d141S[email protected] #else 148357514786SMatthias Ringwald return false; 1484f5d8d141S[email protected] #endif 1485f5d8d141S[email protected] } 1486f5d8d141S[email protected] 14871ffa425cSMatthias Ringwald static bool hci_command_supported(uint8_t command_index){ 14881ffa425cSMatthias Ringwald return (hci_stack->local_supported_commands & (1LU << command_index)) != 0; 14891ffa425cSMatthias Ringwald } 14901ffa425cSMatthias Ringwald 1491b95a5a35SMatthias Ringwald #ifdef ENABLE_BLE 1492b95a5a35SMatthias Ringwald 149363671e69SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 149422f987e4SMatthias Ringwald bool hci_le_extended_advertising_supported(void){ 149563671e69SMatthias Ringwald return hci_command_supported(SUPPORTED_HCI_COMMAND_LE_SET_EXTENDED_ADVERTISING_ENABLE); 149663671e69SMatthias Ringwald } 149763671e69SMatthias Ringwald #endif 149863671e69SMatthias Ringwald 1499f5873674SMatthias Ringwald static void hci_get_own_address_for_addr_type(uint8_t own_addr_type, bd_addr_t own_addr){ 15006bcfa632SMatthias Ringwald if (own_addr_type == BD_ADDR_TYPE_LE_PUBLIC){ 15016bcfa632SMatthias Ringwald (void)memcpy(own_addr, hci_stack->local_bd_addr, 6); 150269a97523S[email protected] } else { 15036bcfa632SMatthias Ringwald (void)memcpy(own_addr, hci_stack->le_random_address, 6); 150469a97523S[email protected] } 150569a97523S[email protected] } 150669a97523S[email protected] 15076bcfa632SMatthias Ringwald void gap_le_get_own_address(uint8_t * addr_type, bd_addr_t addr){ 15086bcfa632SMatthias Ringwald *addr_type = hci_stack->le_own_addr_type; 15096bcfa632SMatthias Ringwald hci_get_own_address_for_addr_type(hci_stack->le_own_addr_type, addr); 15106bcfa632SMatthias Ringwald } 15116bcfa632SMatthias Ringwald 15126bcfa632SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 15136bcfa632SMatthias Ringwald void gap_le_get_own_advertisements_address(uint8_t * addr_type, bd_addr_t addr){ 15146bcfa632SMatthias Ringwald *addr_type = hci_stack->le_advertisements_own_addr_type; 15156bcfa632SMatthias Ringwald hci_get_own_address_for_addr_type(hci_stack->le_advertisements_own_addr_type, addr); 15166bcfa632SMatthias Ringwald }; 1517efc77985SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 1518efc77985SMatthias Ringwald void gap_le_get_own_advertising_set_address(uint8_t * addr_type, bd_addr_t addr, uint8_t advertising_handle){ 1519efc77985SMatthias Ringwald if (advertising_handle == 0){ 1520efc77985SMatthias Ringwald gap_le_get_own_advertisements_address(addr_type, addr); 1521efc77985SMatthias Ringwald } else { 1522efc77985SMatthias Ringwald le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(advertising_handle); 1523efc77985SMatthias Ringwald if (advertising_set != NULL){ 1524efc77985SMatthias Ringwald switch (advertising_set->extended_params.own_address_type){ 1525efc77985SMatthias Ringwald case BD_ADDR_TYPE_LE_PUBLIC: 1526efc77985SMatthias Ringwald *addr_type = BD_ADDR_TYPE_LE_PUBLIC; 1527efc77985SMatthias Ringwald memcpy(addr, hci_stack->local_bd_addr, 6); 1528efc77985SMatthias Ringwald break; 1529efc77985SMatthias Ringwald case BD_ADDR_TYPE_LE_RANDOM: 1530efc77985SMatthias Ringwald *addr_type = BD_ADDR_TYPE_LE_RANDOM; 1531efc77985SMatthias Ringwald memcpy(addr, advertising_set->random_address, 6); 1532efc77985SMatthias Ringwald break; 1533efc77985SMatthias Ringwald case BD_ADDR_TYPE_LE_PUBLIC_IDENTITY: 1534efc77985SMatthias Ringwald case BD_ADDR_TYPE_LE_RANDOM_IDENTITY: 1535efc77985SMatthias Ringwald // do nothing as random address was already set from enhanced connection complete 1536efc77985SMatthias Ringwald break; 1537efc77985SMatthias Ringwald default: 1538efc77985SMatthias Ringwald break; 1539efc77985SMatthias Ringwald } 1540efc77985SMatthias Ringwald } 1541efc77985SMatthias Ringwald } 1542efc77985SMatthias Ringwald }; 1543efc77985SMatthias Ringwald #endif 15446bcfa632SMatthias Ringwald #endif 15456bcfa632SMatthias Ringwald 1546e8c8828eSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 15476bcfa632SMatthias Ringwald 15486bcfa632SMatthias Ringwald /** 15496bcfa632SMatthias Ringwald * @brief Get own addr type and address used for LE connections (Central) 15506bcfa632SMatthias Ringwald */ 15516bcfa632SMatthias Ringwald void gap_le_get_own_connection_address(uint8_t * addr_type, bd_addr_t addr){ 15526bcfa632SMatthias Ringwald *addr_type = hci_stack->le_connection_own_addr_type; 15536bcfa632SMatthias Ringwald hci_get_own_address_for_addr_type(hci_stack->le_connection_own_addr_type, addr); 15546bcfa632SMatthias Ringwald } 15556bcfa632SMatthias Ringwald 1556384b59deSMatthias Ringwald void le_handle_advertisement_report(uint8_t *packet, uint16_t size){ 15579ec2630cSMatthias Ringwald 1558a0698cb4SMatthias Ringwald uint16_t offset = 3; 1559a0698cb4SMatthias Ringwald uint8_t num_reports = packet[offset]; 1560d1dc057bS[email protected] offset += 1; 1561d1dc057bS[email protected] 1562a0698cb4SMatthias Ringwald uint16_t i; 156303fbe9c6S[email protected] uint8_t event[12 + LE_ADVERTISING_DATA_SIZE]; // use upper bound to avoid var size automatic var 1564a1df452eSMatthias Ringwald for (i=0; (i<num_reports) && (offset < size);i++){ 156533e6948bSMatthias Ringwald // sanity checks on data_length: 156633e6948bSMatthias Ringwald uint8_t data_length = packet[offset + 8]; 156733e6948bSMatthias Ringwald if (data_length > LE_ADVERTISING_DATA_SIZE) return; 15684ea43905SMatthias Ringwald if ((offset + 9u + data_length + 1u) > size) return; 156933e6948bSMatthias Ringwald // setup event 15704ea43905SMatthias Ringwald uint8_t event_size = 10u + data_length; 1571a0698cb4SMatthias Ringwald uint16_t pos = 0; 1572045013feSMatthias Ringwald event[pos++] = GAP_EVENT_ADVERTISING_REPORT; 157357c9da5bS[email protected] event[pos++] = event_size; 15746535961aSMatthias Ringwald (void)memcpy(&event[pos], &packet[offset], 1 + 1 + 6); // event type + address type + address 1575d1dc057bS[email protected] offset += 8; 1576d1dc057bS[email protected] pos += 8; 1577d1dc057bS[email protected] event[pos++] = packet[offset + 1 + data_length]; // rssi 157833e6948bSMatthias Ringwald event[pos++] = data_length; 157933e6948bSMatthias Ringwald offset++; 15806535961aSMatthias Ringwald (void)memcpy(&event[pos], &packet[offset], data_length); 158157c9da5bS[email protected] pos += data_length; 15824ea43905SMatthias Ringwald offset += data_length + 1u; // rssi 1583d6b06661SMatthias Ringwald hci_emit_event(event, pos, 1); 158457c9da5bS[email protected] } 158557c9da5bS[email protected] } 1586a0698cb4SMatthias Ringwald 1587a0698cb4SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 1588033393eeSBob Abeles static void le_handle_extended_advertisement_report(uint8_t *packet, uint16_t size) { 1589a0698cb4SMatthias Ringwald uint16_t offset = 3; 1590a0698cb4SMatthias Ringwald uint8_t num_reports = packet[offset++]; 1591c95a0fc7SMatthias Ringwald uint8_t event[2 + 255]; // use upper bound to avoid var size automatic var 1592a0698cb4SMatthias Ringwald uint8_t i; 1593a0698cb4SMatthias Ringwald for (i=0; (i<num_reports) && (offset < size);i++){ 1594a0698cb4SMatthias Ringwald // sanity checks on data_length: 1595a0698cb4SMatthias Ringwald uint16_t data_length = packet[offset + 23]; 159643ce0351SMatthias Ringwald if (data_length > LE_EXTENDED_ADVERTISING_DATA_SIZE) return; 1597a0698cb4SMatthias Ringwald if ((offset + 24u + data_length) > size) return; 1598a0698cb4SMatthias Ringwald uint16_t event_type = little_endian_read_16(packet, offset); 1599a0698cb4SMatthias Ringwald offset += 2; 1600a0698cb4SMatthias Ringwald if ((event_type & 0x10) != 0) { 1601a0698cb4SMatthias Ringwald // setup legacy event 1602a0698cb4SMatthias Ringwald uint8_t legacy_event_type; 1603a0698cb4SMatthias Ringwald switch (event_type){ 1604a0698cb4SMatthias Ringwald case 0b0010011: 1605a0698cb4SMatthias Ringwald // ADV_IND 1606a0698cb4SMatthias Ringwald legacy_event_type = 0; 1607a0698cb4SMatthias Ringwald break; 1608a0698cb4SMatthias Ringwald case 0b0010101: 1609a0698cb4SMatthias Ringwald // ADV_DIRECT_IND 1610a0698cb4SMatthias Ringwald legacy_event_type = 1; 1611a0698cb4SMatthias Ringwald break; 1612a0698cb4SMatthias Ringwald case 0b0010010: 1613a0698cb4SMatthias Ringwald // ADV_SCAN_IND 1614a0698cb4SMatthias Ringwald legacy_event_type = 2; 1615a0698cb4SMatthias Ringwald break; 1616a0698cb4SMatthias Ringwald case 0b0010000: 1617a0698cb4SMatthias Ringwald // ADV_NONCONN_IND 1618a0698cb4SMatthias Ringwald legacy_event_type = 3; 1619a0698cb4SMatthias Ringwald break; 1620a0698cb4SMatthias Ringwald case 0b0011011: 1621a0698cb4SMatthias Ringwald case 0b0011010: 1622a0698cb4SMatthias Ringwald // SCAN_RSP 1623a0698cb4SMatthias Ringwald legacy_event_type = 4; 1624a0698cb4SMatthias Ringwald break; 1625a0698cb4SMatthias Ringwald default: 1626a0698cb4SMatthias Ringwald legacy_event_type = 0; 1627a0698cb4SMatthias Ringwald break; 1628a0698cb4SMatthias Ringwald } 1629a0698cb4SMatthias Ringwald uint16_t pos = 0; 1630a0698cb4SMatthias Ringwald event[pos++] = GAP_EVENT_ADVERTISING_REPORT; 1631a0698cb4SMatthias Ringwald event[pos++] = 10u + data_length; 1632a0698cb4SMatthias Ringwald event[pos++] = legacy_event_type; 1633a0698cb4SMatthias Ringwald // copy address type + address 1634a0698cb4SMatthias Ringwald (void) memcpy(&event[pos], &packet[offset], 1 + 6); 1635a0698cb4SMatthias Ringwald offset += 7; 1636a0698cb4SMatthias Ringwald pos += 7; 1637a0698cb4SMatthias Ringwald // skip primary_phy, secondary_phy, advertising_sid, tx_power 1638a0698cb4SMatthias Ringwald offset += 4; 1639a0698cb4SMatthias Ringwald // copy rssi 1640a0698cb4SMatthias Ringwald event[pos++] = packet[offset++]; 1641a0698cb4SMatthias Ringwald // skip periodic advertising interval and direct address 1642a0698cb4SMatthias Ringwald offset += 9; 1643a0698cb4SMatthias Ringwald // copy data len + data; 1644a0698cb4SMatthias Ringwald (void) memcpy(&event[pos], &packet[offset], 1 + data_length); 1645a0698cb4SMatthias Ringwald pos += 1 +data_length; 1646a0698cb4SMatthias Ringwald offset += 1+ data_length; 1647a0698cb4SMatthias Ringwald hci_emit_event(event, pos, 1); 1648a0698cb4SMatthias Ringwald } else { 1649c95a0fc7SMatthias Ringwald event[0] = GAP_EVENT_EXTENDED_ADVERTISING_REPORT; 1650c95a0fc7SMatthias Ringwald uint8_t report_len = 24 + data_length; 1651c95a0fc7SMatthias Ringwald event[1] = report_len; 16520f7610adSMatthias Ringwald little_endian_store_16(event, 2, event_type); 16530f7610adSMatthias Ringwald memcpy(&event[4], &packet[offset], report_len); 1654c95a0fc7SMatthias Ringwald offset += report_len; 1655c95a0fc7SMatthias Ringwald hci_emit_event(event, 2 + report_len, 1); 1656a0698cb4SMatthias Ringwald } 1657a0698cb4SMatthias Ringwald } 1658a0698cb4SMatthias Ringwald } 1659a0698cb4SMatthias Ringwald #endif 1660a0698cb4SMatthias Ringwald 1661b2f949feS[email protected] #endif 1662e8c8828eSMatthias Ringwald #endif 166357c9da5bS[email protected] 16642b6ab3e6SMatthias Ringwald #ifdef ENABLE_BLE 16652b6ab3e6SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 1666bbc366e6SMatthias Ringwald static void hci_update_advertisements_enabled_for_current_roles(void){ 1667a408e724SMatthias Ringwald if ((hci_stack->le_advertisements_state & LE_ADVERTISEMENT_STATE_ENABLED) != 0){ 16682b6ab3e6SMatthias Ringwald // get number of active le slave connections 16692b6ab3e6SMatthias Ringwald int num_slave_connections = 0; 16702b6ab3e6SMatthias Ringwald btstack_linked_list_iterator_t it; 16712b6ab3e6SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->connections); 16722b6ab3e6SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 16732b6ab3e6SMatthias Ringwald hci_connection_t * con = (hci_connection_t*) btstack_linked_list_iterator_next(&it); 16742b6ab3e6SMatthias Ringwald log_info("state %u, role %u, le_con %u", con->state, con->role, hci_is_le_connection(con)); 16752b6ab3e6SMatthias Ringwald if (con->state != OPEN) continue; 16762b6ab3e6SMatthias Ringwald if (con->role != HCI_ROLE_SLAVE) continue; 16772b6ab3e6SMatthias Ringwald if (!hci_is_le_connection(con)) continue; 16782b6ab3e6SMatthias Ringwald num_slave_connections++; 16792b6ab3e6SMatthias Ringwald } 16802b6ab3e6SMatthias Ringwald log_info("Num LE Peripheral roles: %u of %u", num_slave_connections, hci_stack->le_max_number_peripheral_connections); 1681bbc366e6SMatthias Ringwald hci_stack->le_advertisements_enabled_for_current_roles = num_slave_connections < hci_stack->le_max_number_peripheral_connections; 1682bbc366e6SMatthias Ringwald } else { 1683bbc366e6SMatthias Ringwald hci_stack->le_advertisements_enabled_for_current_roles = false; 16842b6ab3e6SMatthias Ringwald } 16852b6ab3e6SMatthias Ringwald } 16862b6ab3e6SMatthias Ringwald #endif 16872b6ab3e6SMatthias Ringwald #endif 16882b6ab3e6SMatthias Ringwald 168959d59ecfSMatthias Ringwald #ifdef ENABLE_CLASSIC 169059d59ecfSMatthias Ringwald static void gap_run_set_local_name(void){ 169159d59ecfSMatthias Ringwald hci_reserve_packet_buffer(); 169259d59ecfSMatthias Ringwald uint8_t * packet = hci_stack->hci_packet_buffer; 169359d59ecfSMatthias Ringwald // construct HCI Command and send 169459d59ecfSMatthias Ringwald uint16_t opcode = hci_write_local_name.opcode; 169559d59ecfSMatthias Ringwald packet[0] = opcode & 0xff; 169659d59ecfSMatthias Ringwald packet[1] = opcode >> 8; 169759d59ecfSMatthias Ringwald packet[2] = DEVICE_NAME_LEN; 169859d59ecfSMatthias Ringwald memset(&packet[3], 0, DEVICE_NAME_LEN); 169959d59ecfSMatthias Ringwald uint16_t name_len = (uint16_t) strlen(hci_stack->local_name); 170059d59ecfSMatthias Ringwald uint16_t bytes_to_copy = btstack_min(name_len, DEVICE_NAME_LEN); 170159d59ecfSMatthias Ringwald // if shorter than DEVICE_NAME_LEN, it's implicitly NULL-terminated by memset call 170259d59ecfSMatthias Ringwald (void)memcpy(&packet[3], hci_stack->local_name, bytes_to_copy); 170359d59ecfSMatthias Ringwald // expand '00:00:00:00:00:00' in name with bd_addr 170459d59ecfSMatthias Ringwald btstack_replace_bd_addr_placeholder(&packet[3], bytes_to_copy, hci_stack->local_bd_addr); 1705ca6804fdSMatthias Ringwald hci_send_prepared_cmd_packet(); 170659d59ecfSMatthias Ringwald } 170759d59ecfSMatthias Ringwald 170859d59ecfSMatthias Ringwald static void gap_run_set_eir_data(void){ 170959d59ecfSMatthias Ringwald hci_reserve_packet_buffer(); 171059d59ecfSMatthias Ringwald uint8_t * packet = hci_stack->hci_packet_buffer; 171159d59ecfSMatthias Ringwald // construct HCI Command in-place and send 171259d59ecfSMatthias Ringwald uint16_t opcode = hci_write_extended_inquiry_response.opcode; 171359d59ecfSMatthias Ringwald uint16_t offset = 0; 171459d59ecfSMatthias Ringwald packet[offset++] = opcode & 0xff; 171559d59ecfSMatthias Ringwald packet[offset++] = opcode >> 8; 171659d59ecfSMatthias Ringwald packet[offset++] = 1 + EXTENDED_INQUIRY_RESPONSE_DATA_LEN; 171759d59ecfSMatthias Ringwald packet[offset++] = 0; // FEC not required 171859d59ecfSMatthias Ringwald memset(&packet[offset], 0, EXTENDED_INQUIRY_RESPONSE_DATA_LEN); 171959d59ecfSMatthias Ringwald if (hci_stack->eir_data){ 172059d59ecfSMatthias Ringwald // copy items and expand '00:00:00:00:00:00' in name with bd_addr 172159d59ecfSMatthias Ringwald ad_context_t context; 172259d59ecfSMatthias Ringwald for (ad_iterator_init(&context, EXTENDED_INQUIRY_RESPONSE_DATA_LEN, hci_stack->eir_data) ; ad_iterator_has_more(&context) ; ad_iterator_next(&context)) { 172359d59ecfSMatthias Ringwald uint8_t data_type = ad_iterator_get_data_type(&context); 172459d59ecfSMatthias Ringwald uint8_t size = ad_iterator_get_data_len(&context); 172559d59ecfSMatthias Ringwald const uint8_t *data = ad_iterator_get_data(&context); 172659d59ecfSMatthias Ringwald // copy item 172759d59ecfSMatthias Ringwald packet[offset++] = size + 1; 172859d59ecfSMatthias Ringwald packet[offset++] = data_type; 172959d59ecfSMatthias Ringwald memcpy(&packet[offset], data, size); 173059d59ecfSMatthias Ringwald // update name item 173159d59ecfSMatthias Ringwald if ((data_type == BLUETOOTH_DATA_TYPE_SHORTENED_LOCAL_NAME) || (data_type == BLUETOOTH_DATA_TYPE_COMPLETE_LOCAL_NAME)){ 173259d59ecfSMatthias Ringwald btstack_replace_bd_addr_placeholder(&packet[offset], size, hci_stack->local_bd_addr); 173359d59ecfSMatthias Ringwald } 173459d59ecfSMatthias Ringwald offset += size; 173559d59ecfSMatthias Ringwald } 173659d59ecfSMatthias Ringwald } else { 173759d59ecfSMatthias Ringwald uint16_t name_len = (uint16_t) strlen(hci_stack->local_name); 173859d59ecfSMatthias Ringwald uint16_t bytes_to_copy = btstack_min(name_len, EXTENDED_INQUIRY_RESPONSE_DATA_LEN - 2); 173959d59ecfSMatthias Ringwald packet[offset++] = bytes_to_copy + 1; 174059d59ecfSMatthias Ringwald packet[offset++] = BLUETOOTH_DATA_TYPE_COMPLETE_LOCAL_NAME; 174159d59ecfSMatthias Ringwald (void)memcpy(&packet[6], hci_stack->local_name, bytes_to_copy); 174259d59ecfSMatthias Ringwald // expand '00:00:00:00:00:00' in name with bd_addr 174359d59ecfSMatthias Ringwald btstack_replace_bd_addr_placeholder(&packet[offset], bytes_to_copy, hci_stack->local_bd_addr); 174459d59ecfSMatthias Ringwald } 1745ca6804fdSMatthias Ringwald hci_send_prepared_cmd_packet(); 174659d59ecfSMatthias Ringwald } 1747ab4831a3SMatthias Ringwald 1748ab4831a3SMatthias Ringwald static void hci_run_gap_tasks_classic(void){ 1749baa4881eSMatthias Ringwald if ((hci_stack->gap_tasks_classic & GAP_TASK_SET_CLASS_OF_DEVICE) != 0) { 1750baa4881eSMatthias Ringwald hci_stack->gap_tasks_classic &= ~GAP_TASK_SET_CLASS_OF_DEVICE; 1751ab4831a3SMatthias Ringwald hci_send_cmd(&hci_write_class_of_device, hci_stack->class_of_device); 1752ab4831a3SMatthias Ringwald return; 1753ab4831a3SMatthias Ringwald } 1754baa4881eSMatthias Ringwald if ((hci_stack->gap_tasks_classic & GAP_TASK_SET_LOCAL_NAME) != 0) { 1755baa4881eSMatthias Ringwald hci_stack->gap_tasks_classic &= ~GAP_TASK_SET_LOCAL_NAME; 1756ab4831a3SMatthias Ringwald gap_run_set_local_name(); 1757ab4831a3SMatthias Ringwald return; 1758ab4831a3SMatthias Ringwald } 1759baa4881eSMatthias Ringwald if ((hci_stack->gap_tasks_classic & GAP_TASK_SET_EIR_DATA) != 0) { 1760baa4881eSMatthias Ringwald hci_stack->gap_tasks_classic &= ~GAP_TASK_SET_EIR_DATA; 1761ab4831a3SMatthias Ringwald gap_run_set_eir_data(); 1762ab4831a3SMatthias Ringwald return; 1763ab4831a3SMatthias Ringwald } 1764baa4881eSMatthias Ringwald if ((hci_stack->gap_tasks_classic & GAP_TASK_SET_DEFAULT_LINK_POLICY) != 0) { 1765baa4881eSMatthias Ringwald hci_stack->gap_tasks_classic &= ~GAP_TASK_SET_DEFAULT_LINK_POLICY; 1766ab4831a3SMatthias Ringwald hci_send_cmd(&hci_write_default_link_policy_setting, hci_stack->default_link_policy_settings); 1767ab4831a3SMatthias Ringwald return; 1768ab4831a3SMatthias Ringwald } 1769ab4831a3SMatthias Ringwald // write page scan activity 1770baa4881eSMatthias Ringwald if ((hci_stack->gap_tasks_classic & GAP_TASK_WRITE_PAGE_SCAN_ACTIVITY) != 0) { 1771baa4881eSMatthias Ringwald hci_stack->gap_tasks_classic &= ~GAP_TASK_WRITE_PAGE_SCAN_ACTIVITY; 1772ab4831a3SMatthias Ringwald hci_send_cmd(&hci_write_page_scan_activity, hci_stack->new_page_scan_interval, hci_stack->new_page_scan_window); 1773ab4831a3SMatthias Ringwald return; 1774ab4831a3SMatthias Ringwald } 1775ab4831a3SMatthias Ringwald // write page scan type 1776baa4881eSMatthias Ringwald if ((hci_stack->gap_tasks_classic & GAP_TASK_WRITE_PAGE_SCAN_TYPE) != 0) { 1777baa4881eSMatthias Ringwald hci_stack->gap_tasks_classic &= ~GAP_TASK_WRITE_PAGE_SCAN_TYPE; 1778ab4831a3SMatthias Ringwald hci_send_cmd(&hci_write_page_scan_type, hci_stack->new_page_scan_type); 1779ab4831a3SMatthias Ringwald return; 1780ab4831a3SMatthias Ringwald } 178132a12730SMatthias Ringwald // write page timeout 1782baa4881eSMatthias Ringwald if ((hci_stack->gap_tasks_classic & GAP_TASK_WRITE_PAGE_TIMEOUT) != 0) { 1783baa4881eSMatthias Ringwald hci_stack->gap_tasks_classic &= ~GAP_TASK_WRITE_PAGE_TIMEOUT; 178432a12730SMatthias Ringwald hci_send_cmd(&hci_write_page_timeout, hci_stack->page_timeout); 178532a12730SMatthias Ringwald return; 178632a12730SMatthias Ringwald } 1787ab4831a3SMatthias Ringwald // send scan enable 1788baa4881eSMatthias Ringwald if ((hci_stack->gap_tasks_classic & GAP_TASK_WRITE_SCAN_ENABLE) != 0) { 1789baa4881eSMatthias Ringwald hci_stack->gap_tasks_classic &= ~GAP_TASK_WRITE_SCAN_ENABLE; 1790ab4831a3SMatthias Ringwald hci_send_cmd(&hci_write_scan_enable, hci_stack->new_scan_enable_value); 1791ab4831a3SMatthias Ringwald return; 1792ab4831a3SMatthias Ringwald } 1793c0c8a829SMatthias Ringwald // send write scan activity 1794baa4881eSMatthias Ringwald if ((hci_stack->gap_tasks_classic & GAP_TASK_WRITE_INQUIRY_SCAN_ACTIVITY) != 0) { 1795baa4881eSMatthias Ringwald hci_stack->gap_tasks_classic &= ~GAP_TASK_WRITE_INQUIRY_SCAN_ACTIVITY; 1796c0c8a829SMatthias Ringwald hci_send_cmd(&hci_write_inquiry_scan_activity, hci_stack->inquiry_scan_interval, hci_stack->inquiry_scan_window); 1797c0c8a829SMatthias Ringwald return; 1798c0c8a829SMatthias Ringwald } 1799f50ed5acSAndrey Fominykh // send write inquiry transmit power level 1800f50ed5acSAndrey Fominykh if ((hci_stack->gap_tasks_classic & GAP_TASK_WRITE_INQUIRY_TX_POWER_LEVEL) != 0) { 1801f50ed5acSAndrey Fominykh hci_stack->gap_tasks_classic &= ~GAP_TASK_WRITE_INQUIRY_TX_POWER_LEVEL; 1802f50ed5acSAndrey Fominykh hci_send_cmd(&hci_write_inquiry_transmit_power_level, hci_stack->inquiry_tx_power_level); 1803f50ed5acSAndrey Fominykh return; 1804f50ed5acSAndrey Fominykh } 1805ab4831a3SMatthias Ringwald } 180659d59ecfSMatthias Ringwald #endif 180759d59ecfSMatthias Ringwald 18086fad2c37SMatthias Ringwald #ifndef HAVE_HOST_CONTROLLER_API 180906b9e820SMatthias Ringwald 181096b53536SMatthias Ringwald static uint32_t hci_transport_uart_get_main_baud_rate(void){ 181196b53536SMatthias Ringwald if (!hci_stack->config) return 0; 18129796ebeaSMatthias Ringwald uint32_t baud_rate = ((hci_transport_config_uart_t *)hci_stack->config)->baudrate_main; 181396b53536SMatthias Ringwald // Limit baud rate for Broadcom chipsets to 3 mbps 1814a1df452eSMatthias Ringwald if ((hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_BROADCOM_CORPORATION) && (baud_rate > 3000000)){ 181596b53536SMatthias Ringwald baud_rate = 3000000; 181696b53536SMatthias Ringwald } 181796b53536SMatthias Ringwald return baud_rate; 181896b53536SMatthias Ringwald } 181996b53536SMatthias Ringwald 1820ec820d77SMatthias Ringwald static void hci_initialization_timeout_handler(btstack_timer_source_t * ds){ 18219ec2630cSMatthias Ringwald UNUSED(ds); 18229ec2630cSMatthias Ringwald 18230305bdeaSMatthias Ringwald switch (hci_stack->substate){ 18240305bdeaSMatthias Ringwald case HCI_INIT_W4_SEND_RESET: 18257b0d7667SMatthias Ringwald log_info("Resend HCI Reset"); 18260305bdeaSMatthias Ringwald hci_stack->substate = HCI_INIT_SEND_RESET; 18277b0d7667SMatthias Ringwald hci_stack->num_cmd_packets = 1; 18280305bdeaSMatthias Ringwald hci_run(); 18290305bdeaSMatthias Ringwald break; 18309f007422SMatthias Ringwald case HCI_INIT_W4_CUSTOM_INIT_CSR_WARM_BOOT_LINK_RESET: 18319f007422SMatthias Ringwald log_info("Resend HCI Reset - CSR Warm Boot with Link Reset"); 18329f007422SMatthias Ringwald if (hci_stack->hci_transport->reset_link){ 18339f007422SMatthias Ringwald hci_stack->hci_transport->reset_link(); 18349f007422SMatthias Ringwald } 1835cf373d3aSMatthias Ringwald 1836cf373d3aSMatthias Ringwald /* fall through */ 1837cf373d3aSMatthias Ringwald 1838e47e68c7SMatthias Ringwald case HCI_INIT_W4_CUSTOM_INIT_CSR_WARM_BOOT: 1839e47e68c7SMatthias Ringwald log_info("Resend HCI Reset - CSR Warm Boot"); 1840e47e68c7SMatthias Ringwald hci_stack->substate = HCI_INIT_SEND_RESET_CSR_WARM_BOOT; 1841e47e68c7SMatthias Ringwald hci_stack->num_cmd_packets = 1; 1842e47e68c7SMatthias Ringwald hci_run(); 1843688c2635SMatthias Ringwald break; 18447224be7eSMatthias Ringwald case HCI_INIT_W4_SEND_BAUD_CHANGE: 18457224be7eSMatthias Ringwald if (hci_stack->hci_transport->set_baudrate){ 184696b53536SMatthias Ringwald uint32_t baud_rate = hci_transport_uart_get_main_baud_rate(); 1847cd724cb7SMatthias Ringwald log_info("Local baud rate change to %" PRIu32 "(timeout handler)", baud_rate); 18487dd9d0ecSMatthias Ringwald hci_stack->hci_transport->set_baudrate(baud_rate); 18497224be7eSMatthias Ringwald } 1850834bce8cSMatthias Ringwald // For CSR, HCI Reset is sent on new baud rate. Don't forget to reset link for H5/BCSP 185161f37892SMatthias Ringwald if (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_CAMBRIDGE_SILICON_RADIO){ 1852834bce8cSMatthias Ringwald if (hci_stack->hci_transport->reset_link){ 1853834bce8cSMatthias Ringwald log_info("Link Reset"); 1854834bce8cSMatthias Ringwald hci_stack->hci_transport->reset_link(); 1855834bce8cSMatthias Ringwald } 1856772a36d3SMatthias Ringwald hci_stack->substate = HCI_INIT_SEND_RESET_CSR_WARM_BOOT; 1857772a36d3SMatthias Ringwald hci_run(); 1858772a36d3SMatthias Ringwald } 18594696bddbSMatthias Ringwald break; 1860559961d0SMatthias Ringwald case HCI_INIT_W4_CUSTOM_INIT_BCM_DELAY: 1861559961d0SMatthias Ringwald // otherwise continue 1862559961d0SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_READ_LOCAL_SUPPORTED_COMMANDS; 1863559961d0SMatthias Ringwald hci_send_cmd(&hci_read_local_supported_commands); 1864559961d0SMatthias Ringwald break; 18650305bdeaSMatthias Ringwald default: 18660305bdeaSMatthias Ringwald break; 18670305bdeaSMatthias Ringwald } 18680305bdeaSMatthias Ringwald } 186906b9e820SMatthias Ringwald #endif 18700305bdeaSMatthias Ringwald 187171de195eSMatthias Ringwald static void hci_initializing_next_state(void){ 187274b323a9SMatthias Ringwald hci_stack->substate = (hci_substate_t )( ((int) hci_stack->substate) + 1); 187374b323a9SMatthias Ringwald } 187474b323a9SMatthias Ringwald 1875f795c86eSMatthias Ringwald static void hci_init_done(void){ 1876f795c86eSMatthias Ringwald // done. tell the app 1877f795c86eSMatthias Ringwald log_info("hci_init_done -> HCI_STATE_WORKING"); 1878f795c86eSMatthias Ringwald hci_stack->state = HCI_STATE_WORKING; 1879f795c86eSMatthias Ringwald hci_emit_state(); 1880f795c86eSMatthias Ringwald } 1881f795c86eSMatthias Ringwald 188274b323a9SMatthias Ringwald // assumption: hci_can_send_command_packet_now() == true 188371de195eSMatthias Ringwald static void hci_initializing_run(void){ 1884148ca237SMatthias Ringwald log_debug("hci_initializing_run: substate %u, can send %u", hci_stack->substate, hci_can_send_command_packet_now()); 1885f4c579d4SMatthias Ringwald 18860d37aff3SMatthias Ringwald if (!hci_can_send_command_packet_now()) return; 18870d37aff3SMatthias Ringwald 1888f4c579d4SMatthias Ringwald #ifndef HAVE_HOST_CONTROLLER_API 1889f9fd20c2SMatthias Ringwald bool need_baud_change = hci_stack->config 1890f4c579d4SMatthias Ringwald && hci_stack->chipset 1891f4c579d4SMatthias Ringwald && hci_stack->chipset->set_baudrate_command 1892f4c579d4SMatthias Ringwald && hci_stack->hci_transport->set_baudrate 1893f4c579d4SMatthias Ringwald && ((hci_transport_config_uart_t *)hci_stack->config)->baudrate_main; 1894f4c579d4SMatthias Ringwald #endif 1895f4c579d4SMatthias Ringwald 189674b323a9SMatthias Ringwald switch (hci_stack->substate){ 189774b323a9SMatthias Ringwald case HCI_INIT_SEND_RESET: 189874b323a9SMatthias Ringwald hci_state_reset(); 1899a0cf2f3fSMatthias Ringwald 19006fad2c37SMatthias Ringwald #ifndef HAVE_HOST_CONTROLLER_API 19010305bdeaSMatthias Ringwald // prepare reset if command complete not received in 100ms 1902659d758cSMatthias Ringwald btstack_run_loop_set_timer(&hci_stack->timeout, HCI_RESET_RESEND_TIMEOUT_MS); 1903528a4a3bSMatthias Ringwald btstack_run_loop_set_timer_handler(&hci_stack->timeout, hci_initialization_timeout_handler); 1904528a4a3bSMatthias Ringwald btstack_run_loop_add_timer(&hci_stack->timeout); 1905a0cf2f3fSMatthias Ringwald #endif 19060305bdeaSMatthias Ringwald // send command 190774b323a9SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_SEND_RESET; 19080305bdeaSMatthias Ringwald hci_send_cmd(&hci_reset); 190974b323a9SMatthias Ringwald break; 191076fcb19bSMatthias Ringwald case HCI_INIT_SEND_READ_LOCAL_VERSION_INFORMATION: 191176fcb19bSMatthias Ringwald hci_send_cmd(&hci_read_local_version_information); 191276fcb19bSMatthias Ringwald hci_stack->substate = HCI_INIT_W4_SEND_READ_LOCAL_VERSION_INFORMATION; 191376fcb19bSMatthias Ringwald break; 1914e28e41c0SMatthias Ringwald 1915e28e41c0SMatthias Ringwald #ifndef HAVE_HOST_CONTROLLER_API 1916e47e68c7SMatthias Ringwald case HCI_INIT_SEND_RESET_CSR_WARM_BOOT: 1917e47e68c7SMatthias Ringwald hci_state_reset(); 1918e47e68c7SMatthias Ringwald // prepare reset if command complete not received in 100ms 1919659d758cSMatthias Ringwald btstack_run_loop_set_timer(&hci_stack->timeout, HCI_RESET_RESEND_TIMEOUT_MS); 1920528a4a3bSMatthias Ringwald btstack_run_loop_set_timer_handler(&hci_stack->timeout, hci_initialization_timeout_handler); 1921528a4a3bSMatthias Ringwald btstack_run_loop_add_timer(&hci_stack->timeout); 1922e47e68c7SMatthias Ringwald // send command 1923e47e68c7SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_CUSTOM_INIT_CSR_WARM_BOOT; 1924e47e68c7SMatthias Ringwald hci_send_cmd(&hci_reset); 1925e47e68c7SMatthias Ringwald break; 19268d29070eSMatthias Ringwald case HCI_INIT_SEND_RESET_ST_WARM_BOOT: 19278d29070eSMatthias Ringwald hci_state_reset(); 19288d29070eSMatthias Ringwald hci_stack->substate = HCI_INIT_W4_SEND_RESET_ST_WARM_BOOT; 19298d29070eSMatthias Ringwald hci_send_cmd(&hci_reset); 19308d29070eSMatthias Ringwald break; 1931f4c579d4SMatthias Ringwald case HCI_INIT_SEND_BAUD_CHANGE_BCM: { 1932a784d71bSMatthias Ringwald hci_reserve_packet_buffer(); 1933f4c579d4SMatthias Ringwald uint32_t baud_rate = hci_transport_uart_get_main_baud_rate(); 1934f4c579d4SMatthias Ringwald hci_stack->chipset->set_baudrate_command(baud_rate, hci_stack->hci_packet_buffer); 1935f4c579d4SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_SEND_BAUD_CHANGE_BCM; 1936ca6804fdSMatthias Ringwald hci_send_prepared_cmd_packet(); 1937f4c579d4SMatthias Ringwald break; 1938f4c579d4SMatthias Ringwald } 1939c97af506SMatthias Ringwald case HCI_INIT_SET_BD_ADDR: 1940a784d71bSMatthias Ringwald hci_reserve_packet_buffer(); 1941c97af506SMatthias Ringwald log_info("Set Public BD ADDR to %s", bd_addr_to_str(hci_stack->custom_bd_addr)); 1942c97af506SMatthias Ringwald hci_stack->chipset->set_bd_addr_command(hci_stack->custom_bd_addr, hci_stack->hci_packet_buffer); 1943c97af506SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_SET_BD_ADDR; 1944ca6804fdSMatthias Ringwald hci_send_prepared_cmd_packet(); 1945c97af506SMatthias Ringwald break; 19468250c242SMatthias Ringwald case HCI_INIT_SEND_READ_LOCAL_NAME: 19478250c242SMatthias Ringwald #ifdef ENABLE_CLASSIC 19488250c242SMatthias Ringwald hci_send_cmd(&hci_read_local_name); 19498250c242SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_SEND_READ_LOCAL_NAME; 19508250c242SMatthias Ringwald break; 19518250c242SMatthias Ringwald #endif 19528250c242SMatthias Ringwald /* fall through */ 19538250c242SMatthias Ringwald 1954f4c579d4SMatthias Ringwald case HCI_INIT_SEND_BAUD_CHANGE: 1955f4c579d4SMatthias Ringwald if (need_baud_change) { 1956a784d71bSMatthias Ringwald hci_reserve_packet_buffer(); 195796b53536SMatthias Ringwald uint32_t baud_rate = hci_transport_uart_get_main_baud_rate(); 19583fb36a29SMatthias Ringwald hci_stack->chipset->set_baudrate_command(baud_rate, hci_stack->hci_packet_buffer); 195974b323a9SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_SEND_BAUD_CHANGE; 1960ca6804fdSMatthias Ringwald hci_send_prepared_cmd_packet(); 19614696bddbSMatthias Ringwald // STLC25000D: baudrate change happens within 0.5 s after command was send, 19624696bddbSMatthias Ringwald // use timer to update baud rate after 100 ms (knowing exactly, when command was sent is non-trivial) 196361f37892SMatthias Ringwald if (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_ST_MICROELECTRONICS){ 1964659d758cSMatthias Ringwald btstack_run_loop_set_timer(&hci_stack->timeout, HCI_RESET_RESEND_TIMEOUT_MS); 1965528a4a3bSMatthias Ringwald btstack_run_loop_add_timer(&hci_stack->timeout); 19664696bddbSMatthias Ringwald } 196774b323a9SMatthias Ringwald break; 1968fab26ab3SMatthias Ringwald } 19696fe16221SMatthias Ringwald hci_stack->substate = HCI_INIT_CUSTOM_INIT; 1970f4c579d4SMatthias Ringwald 1971f4c579d4SMatthias Ringwald /* fall through */ 1972f4c579d4SMatthias Ringwald 197374b323a9SMatthias Ringwald case HCI_INIT_CUSTOM_INIT: 19746fe16221SMatthias Ringwald case HCI_INIT_CUSTOM_PRE_INIT: 197574b323a9SMatthias Ringwald // Custom initialization 19763fb36a29SMatthias Ringwald if (hci_stack->chipset && hci_stack->chipset->next_command){ 1977ee418d0fSMatthias Ringwald hci_reserve_packet_buffer(); 1978ae334e9eSMatthias Ringwald hci_stack->chipset_result = (*hci_stack->chipset->next_command)(hci_stack->hci_packet_buffer); 19791979f09cSMatthias Ringwald bool send_cmd = false; 1980ae334e9eSMatthias Ringwald switch (hci_stack->chipset_result){ 1981f41911edSMatthias Ringwald case BTSTACK_CHIPSET_VALID_COMMAND: 19821979f09cSMatthias Ringwald send_cmd = true; 19836fe16221SMatthias Ringwald switch (hci_stack->substate){ 19846fe16221SMatthias Ringwald case HCI_INIT_CUSTOM_INIT: 1985e47e68c7SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_CUSTOM_INIT; 1986e47e68c7SMatthias Ringwald break; 19876fe16221SMatthias Ringwald case HCI_INIT_CUSTOM_PRE_INIT: 19886fe16221SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_CUSTOM_PRE_INIT; 19896fe16221SMatthias Ringwald break; 19906fe16221SMatthias Ringwald default: 19916fe16221SMatthias Ringwald btstack_assert(false); 19926fe16221SMatthias Ringwald break; 19936fe16221SMatthias Ringwald } 19946fe16221SMatthias Ringwald break; 1995f41911edSMatthias Ringwald case BTSTACK_CHIPSET_WARMSTART_REQUIRED: 19961979f09cSMatthias Ringwald send_cmd = true; 1997f41911edSMatthias Ringwald // CSR Warm Boot: Wait a bit, then send HCI Reset until HCI Command Complete 1998e47e68c7SMatthias Ringwald log_info("CSR Warm Boot"); 1999659d758cSMatthias Ringwald btstack_run_loop_set_timer(&hci_stack->timeout, HCI_RESET_RESEND_TIMEOUT_MS); 2000528a4a3bSMatthias Ringwald btstack_run_loop_set_timer_handler(&hci_stack->timeout, hci_initialization_timeout_handler); 2001528a4a3bSMatthias Ringwald btstack_run_loop_add_timer(&hci_stack->timeout); 2002a1df452eSMatthias Ringwald if ((hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_CAMBRIDGE_SILICON_RADIO) 2003772a36d3SMatthias Ringwald && hci_stack->config 20043fb36a29SMatthias Ringwald && hci_stack->chipset 20053fb36a29SMatthias Ringwald // && hci_stack->chipset->set_baudrate_command -- there's no such command 2006772a36d3SMatthias Ringwald && hci_stack->hci_transport->set_baudrate 20072caefae9SMatthias Ringwald && hci_transport_uart_get_main_baud_rate()){ 2008772a36d3SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_SEND_BAUD_CHANGE; 2009772a36d3SMatthias Ringwald } else { 20109f007422SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_CUSTOM_INIT_CSR_WARM_BOOT_LINK_RESET; 2011772a36d3SMatthias Ringwald } 2012e47e68c7SMatthias Ringwald break; 2013f41911edSMatthias Ringwald default: 2014f41911edSMatthias Ringwald break; 2015e47e68c7SMatthias Ringwald } 2016ee720f3aSMatthias Ringwald 2017ee720f3aSMatthias Ringwald if (send_cmd){ 2018ca6804fdSMatthias Ringwald hci_send_prepared_cmd_packet(); 201974b323a9SMatthias Ringwald break; 2020ee418d0fSMatthias Ringwald } else { 2021ee418d0fSMatthias Ringwald hci_release_packet_buffer(); 202274b323a9SMatthias Ringwald } 2023148ca237SMatthias Ringwald log_info("Init script done"); 202492a0d36dSMatthias Ringwald 20256fe16221SMatthias Ringwald // Custom Pre-Init complete, start regular init with HCI Reset 20266fe16221SMatthias Ringwald if (hci_stack->substate == HCI_INIT_CUSTOM_PRE_INIT){ 20276fe16221SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_SEND_RESET; 20286fe16221SMatthias Ringwald hci_send_cmd(&hci_reset); 20296fe16221SMatthias Ringwald break; 20306fe16221SMatthias Ringwald } 20316fe16221SMatthias Ringwald 2032559961d0SMatthias Ringwald // Init script download on Broadcom chipsets causes: 2033ae334e9eSMatthias Ringwald if ( (hci_stack->chipset_result != BTSTACK_CHIPSET_NO_INIT_SCRIPT) && 2034a1df452eSMatthias Ringwald ( (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_BROADCOM_CORPORATION) 2035a1df452eSMatthias Ringwald || (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_EM_MICROELECTRONIC_MARIN_SA)) ){ 2036e021ff1eSMatthias Ringwald 2037559961d0SMatthias Ringwald // - baud rate to reset, restore UART baud rate if needed 203892a0d36dSMatthias Ringwald if (need_baud_change) { 20399796ebeaSMatthias Ringwald uint32_t baud_rate = ((hci_transport_config_uart_t *)hci_stack->config)->baudrate_init; 2040cd724cb7SMatthias Ringwald log_info("Local baud rate change to %" PRIu32 " after init script (bcm)", baud_rate); 204192a0d36dSMatthias Ringwald hci_stack->hci_transport->set_baudrate(baud_rate); 204292a0d36dSMatthias Ringwald } 2043559961d0SMatthias Ringwald 2044f19b3c9eSMatthias Ringwald uint16_t bcm_delay_ms = 300; 2045f19b3c9eSMatthias Ringwald // - UART may or may not be disabled during update and Controller RTS may or may not be high during this time 2046f19b3c9eSMatthias Ringwald // -> Work around: wait here. 2047f19b3c9eSMatthias Ringwald log_info("BCM delay (%u ms) after init script", bcm_delay_ms); 2048559961d0SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_CUSTOM_INIT_BCM_DELAY; 2049f19b3c9eSMatthias Ringwald btstack_run_loop_set_timer(&hci_stack->timeout, bcm_delay_ms); 2050559961d0SMatthias Ringwald btstack_run_loop_set_timer_handler(&hci_stack->timeout, hci_initialization_timeout_handler); 2051559961d0SMatthias Ringwald btstack_run_loop_add_timer(&hci_stack->timeout); 2052559961d0SMatthias Ringwald break; 205392a0d36dSMatthias Ringwald } 205474b323a9SMatthias Ringwald } 205506b9e820SMatthias Ringwald #endif 2056521bd5ffSMatthias Ringwald /* fall through */ 205706b9e820SMatthias Ringwald 205806b9e820SMatthias Ringwald case HCI_INIT_READ_LOCAL_SUPPORTED_COMMANDS: 205906b9e820SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_READ_LOCAL_SUPPORTED_COMMANDS; 206006b9e820SMatthias Ringwald hci_send_cmd(&hci_read_local_supported_commands); 206106b9e820SMatthias Ringwald break; 206253860077SMatthias Ringwald case HCI_INIT_READ_BD_ADDR: 206353860077SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_READ_BD_ADDR; 206453860077SMatthias Ringwald hci_send_cmd(&hci_read_bd_addr); 206553860077SMatthias Ringwald break; 206674b323a9SMatthias Ringwald case HCI_INIT_READ_BUFFER_SIZE: 20675ffe9d0bSMatthias Ringwald // only read buffer size if supported 20681ffa425cSMatthias Ringwald if (hci_command_supported(SUPPORTED_HCI_COMMAND_READ_BUFFER_SIZE)){ 206974b323a9SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_READ_BUFFER_SIZE; 20700305bdeaSMatthias Ringwald hci_send_cmd(&hci_read_buffer_size); 207174b323a9SMatthias Ringwald break; 20725ffe9d0bSMatthias Ringwald } 2073521bd5ffSMatthias Ringwald 20745ffe9d0bSMatthias Ringwald /* fall through */ 20755ffe9d0bSMatthias Ringwald 207653860077SMatthias Ringwald case HCI_INIT_READ_LOCAL_SUPPORTED_FEATURES: 207753860077SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_READ_LOCAL_SUPPORTED_FEATURES; 20780305bdeaSMatthias Ringwald hci_send_cmd(&hci_read_local_supported_features); 207974b323a9SMatthias Ringwald break; 20802b838201SMatthias Ringwald 20812b838201SMatthias Ringwald #ifdef ENABLE_HCI_CONTROLLER_TO_HOST_FLOW_CONTROL 20822b838201SMatthias Ringwald case HCI_INIT_SET_CONTROLLER_TO_HOST_FLOW_CONTROL: 20832b838201SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_SET_CONTROLLER_TO_HOST_FLOW_CONTROL; 20842b838201SMatthias Ringwald hci_send_cmd(&hci_set_controller_to_host_flow_control, 3); // ACL + SCO Flow Control 20852b838201SMatthias Ringwald break; 20862b838201SMatthias Ringwald case HCI_INIT_HOST_BUFFER_SIZE: 20872b838201SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_HOST_BUFFER_SIZE; 20882b838201SMatthias Ringwald hci_send_cmd(&hci_host_buffer_size, HCI_HOST_ACL_PACKET_LEN, HCI_HOST_SCO_PACKET_LEN, 20892b838201SMatthias Ringwald HCI_HOST_ACL_PACKET_NUM, HCI_HOST_SCO_PACKET_NUM); 20902b838201SMatthias Ringwald break; 20912b838201SMatthias Ringwald #endif 20922b838201SMatthias Ringwald 209374b323a9SMatthias Ringwald case HCI_INIT_SET_EVENT_MASK: 20940305bdeaSMatthias Ringwald hci_stack->substate = HCI_INIT_W4_SET_EVENT_MASK; 209574b323a9SMatthias Ringwald if (hci_le_supported()){ 20965ce1359eSMatthias Ringwald hci_send_cmd(&hci_set_event_mask,0xFFFFFFFFU, 0x3FFFFFFFU); 209774b323a9SMatthias Ringwald } else { 209874b323a9SMatthias Ringwald // Kensington Bluetooth 2.1 USB Dongle (CSR Chipset) returns an error for 0xffff... 20995ce1359eSMatthias Ringwald hci_send_cmd(&hci_set_event_mask,0xFFFFFFFFU, 0x1FFFFFFFU); 210074b323a9SMatthias Ringwald } 210174b323a9SMatthias Ringwald break; 21022b838201SMatthias Ringwald 2103ff7d1758SMatthias Ringwald case HCI_INIT_SET_EVENT_MASK_2: 21048254e329SMatthias Ringwald // On Bluettooth PTS dongle (BL 654) with PacketCraft HCI Firmware (LMP subversion) 0x5244, 21058254e329SMatthias Ringwald // setting Event Mask 2 causes Controller to drop Encryption Change events. 21068254e329SMatthias Ringwald if (hci_command_supported(SUPPORTED_HCI_COMMAND_SET_EVENT_MASK_PAGE_2) 21078254e329SMatthias Ringwald && (hci_stack->manufacturer != BLUETOOTH_COMPANY_ID_PACKETCRAFT_INC)){ 2108ff7d1758SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_SET_EVENT_MASK_2; 2109ff7d1758SMatthias Ringwald // Encryption Change Event v2 - bit 25 2110ff7d1758SMatthias Ringwald hci_send_cmd(&hci_set_event_mask_2,0x02000000U, 0x0); 2111ff7d1758SMatthias Ringwald break; 2112ff7d1758SMatthias Ringwald } 2113ff7d1758SMatthias Ringwald 211435454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 2115ff7d1758SMatthias Ringwald /* fall through */ 2116ff7d1758SMatthias Ringwald 211774b323a9SMatthias Ringwald case HCI_INIT_WRITE_SIMPLE_PAIRING_MODE: 2118f795c86eSMatthias Ringwald if (hci_classic_supported() && gap_ssp_supported()){ 211974b323a9SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_WRITE_SIMPLE_PAIRING_MODE; 21200305bdeaSMatthias Ringwald hci_send_cmd(&hci_write_simple_pairing_mode, hci_stack->ssp_enable); 212174b323a9SMatthias Ringwald break; 2122e7c662faSMatthias Ringwald } 2123521bd5ffSMatthias Ringwald 2124e7c662faSMatthias Ringwald /* fall through */ 2125e7c662faSMatthias Ringwald 2126f6858d14SMatthias Ringwald case HCI_INIT_WRITE_INQUIRY_MODE: 2127f795c86eSMatthias Ringwald if (hci_classic_supported()){ 2128f6858d14SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_WRITE_INQUIRY_MODE; 21298a114470SMatthias Ringwald hci_send_cmd(&hci_write_inquiry_mode, (int) hci_stack->inquiry_mode); 2130f6858d14SMatthias Ringwald break; 2131f795c86eSMatthias Ringwald } 2132521bd5ffSMatthias Ringwald 2133f795c86eSMatthias Ringwald /* fall through */ 2134f795c86eSMatthias Ringwald 21355d23aae8SMatthias Ringwald case HCI_INIT_WRITE_SECURE_CONNECTIONS_HOST_ENABLE: 2136f3052906SMatthias Ringwald // skip write secure connections host support if not supported or disabled 21371ffa425cSMatthias Ringwald if (hci_classic_supported() && hci_stack->secure_connections_enable 21381ffa425cSMatthias Ringwald && hci_command_supported(SUPPORTED_HCI_COMMAND_WRITE_SECURE_CONNECTIONS_HOST)) { 2139c214d65bSMatthias Ringwald hci_stack->secure_connections_active = true; 21405d23aae8SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_WRITE_SECURE_CONNECTIONS_HOST_ENABLE; 21411ffa425cSMatthias Ringwald hci_send_cmd(&hci_write_secure_connections_host_support, 1); 21425d23aae8SMatthias Ringwald break; 2143f3052906SMatthias Ringwald } 2144521bd5ffSMatthias Ringwald 2145a391128dSMatthias Ringwald /* fall through */ 2146a391128dSMatthias Ringwald 2147a391128dSMatthias Ringwald case HCI_INIT_SET_MIN_ENCRYPTION_KEY_SIZE: 2148a391128dSMatthias Ringwald // skip set min encryption key size 2149a391128dSMatthias Ringwald if (hci_classic_supported() && hci_command_supported(SUPPORTED_HCI_COMMAND_SET_MIN_ENCRYPTION_KEY_SIZE)) { 2150a391128dSMatthias Ringwald hci_stack->substate = HCI_INIT_W4_SET_MIN_ENCRYPTION_KEY_SIZE; 2151a391128dSMatthias Ringwald hci_send_cmd(&hci_set_min_encryption_key_size, hci_stack->gap_required_encyrption_key_size); 2152a391128dSMatthias Ringwald break; 2153a391128dSMatthias Ringwald } 2154a391128dSMatthias Ringwald 2155e4c6114dSMatthias Ringwald #ifdef ENABLE_SCO_OVER_HCI 2156521bd5ffSMatthias Ringwald /* fall through */ 2157521bd5ffSMatthias Ringwald 2158483c5078SMatthias Ringwald // only sent if ENABLE_SCO_OVER_HCI is defined 2159729ed62eSMatthias Ringwald case HCI_INIT_WRITE_SYNCHRONOUS_FLOW_CONTROL_ENABLE: 2160e4c6114dSMatthias Ringwald // skip write synchronous flow control if not supported 21611ffa425cSMatthias Ringwald if (hci_classic_supported() 21621ffa425cSMatthias Ringwald && hci_command_supported(SUPPORTED_HCI_COMMAND_WRITE_SYNCHRONOUS_FLOW_CONTROL_ENABLE)) { 2163729ed62eSMatthias Ringwald hci_stack->substate = HCI_INIT_W4_WRITE_SYNCHRONOUS_FLOW_CONTROL_ENABLE; 2164729ed62eSMatthias Ringwald hci_send_cmd(&hci_write_synchronous_flow_control_enable, 1); // SCO tracking enabled 2165729ed62eSMatthias Ringwald break; 2166f795c86eSMatthias Ringwald } 2167f795c86eSMatthias Ringwald /* fall through */ 2168f795c86eSMatthias Ringwald 2169483c5078SMatthias Ringwald case HCI_INIT_WRITE_DEFAULT_ERRONEOUS_DATA_REPORTING: 2170e4c6114dSMatthias Ringwald // skip write default erroneous data reporting if not supported 21711ffa425cSMatthias Ringwald if (hci_classic_supported() 21721ffa425cSMatthias Ringwald && hci_command_supported(SUPPORTED_HCI_COMMAND_WRITE_DEFAULT_ERRONEOUS_DATA_REPORTING)) { 2173483c5078SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_WRITE_DEFAULT_ERRONEOUS_DATA_REPORTING; 2174483c5078SMatthias Ringwald hci_send_cmd(&hci_write_default_erroneous_data_reporting, 1); 2175483c5078SMatthias Ringwald break; 2176f795c86eSMatthias Ringwald } 2177e4c6114dSMatthias Ringwald #endif 2178f795c86eSMatthias Ringwald 2179f795c86eSMatthias Ringwald #if defined(ENABLE_SCO_OVER_HCI) || defined(ENABLE_SCO_OVER_PCM) 2180521bd5ffSMatthias Ringwald /* fall through */ 2181521bd5ffSMatthias Ringwald 21828051253fSMatthias Ringwald // only sent if manufacturer is Broadcom and ENABLE_SCO_OVER_HCI or ENABLE_SCO_OVER_PCM is defined 2183a42798c3SMatthias Ringwald case HCI_INIT_BCM_WRITE_SCO_PCM_INT: 2184e4c6114dSMatthias Ringwald if (hci_classic_supported() && (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_BROADCOM_CORPORATION)){ 2185a42798c3SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_BCM_WRITE_SCO_PCM_INT; 21868051253fSMatthias Ringwald #ifdef ENABLE_SCO_OVER_HCI 2187a42798c3SMatthias Ringwald log_info("BCM: Route SCO data via HCI transport"); 2188a42798c3SMatthias Ringwald hci_send_cmd(&hci_bcm_write_sco_pcm_int, 1, 0, 0, 0, 0); 21898051253fSMatthias Ringwald #endif 21908051253fSMatthias Ringwald #ifdef ENABLE_SCO_OVER_PCM 21918051253fSMatthias Ringwald log_info("BCM: Route SCO data via PCM interface"); 21921d2bbd54SMatthias Ringwald #ifdef ENABLE_BCM_PCM_WBS 2193f795c86eSMatthias Ringwald // 512 kHz bit clock for 2 channels x 16 bit x 16 kHz 21941d2bbd54SMatthias Ringwald hci_send_cmd(&hci_bcm_write_sco_pcm_int, 0, 2, 0, 1, 1); 21951d2bbd54SMatthias Ringwald #else 21961d2bbd54SMatthias Ringwald // 256 kHz bit clock for 2 channels x 16 bit x 8 kHz 21971d2bbd54SMatthias Ringwald hci_send_cmd(&hci_bcm_write_sco_pcm_int, 0, 1, 0, 1, 1); 21981d2bbd54SMatthias Ringwald #endif 21998051253fSMatthias Ringwald #endif 2200a42798c3SMatthias Ringwald break; 2201f795c86eSMatthias Ringwald } 2202f795c86eSMatthias Ringwald #endif 2203f795c86eSMatthias Ringwald 22044e821764SMatthias Ringwald #ifdef ENABLE_SCO_OVER_PCM 2205521bd5ffSMatthias Ringwald /* fall through */ 2206521bd5ffSMatthias Ringwald 22074e821764SMatthias Ringwald case HCI_INIT_BCM_WRITE_I2SPCM_INTERFACE_PARAM: 2208e4c6114dSMatthias Ringwald if (hci_classic_supported() && (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_BROADCOM_CORPORATION)){ 22094e821764SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_BCM_WRITE_I2SPCM_INTERFACE_PARAM; 22104e821764SMatthias Ringwald log_info("BCM: Config PCM interface for I2S"); 22111d2bbd54SMatthias Ringwald #ifdef ENABLE_BCM_PCM_WBS 22121d2bbd54SMatthias Ringwald // 512 kHz bit clock for 2 channels x 16 bit x 8 kHz 22131d2bbd54SMatthias Ringwald hci_send_cmd(&hci_bcm_write_i2spcm_interface_param, 1, 1, 0, 2); 22141d2bbd54SMatthias Ringwald #else 22151d2bbd54SMatthias Ringwald // 256 kHz bit clock for 2 channels x 16 bit x 8 kHz 22161d2bbd54SMatthias Ringwald hci_send_cmd(&hci_bcm_write_i2spcm_interface_param, 1, 1, 0, 1); 22171d2bbd54SMatthias Ringwald #endif 22184e821764SMatthias Ringwald break; 2219f795c86eSMatthias Ringwald } 22201be678e9SMatthias Ringwald case HCI_INIT_BCM_WRITE_PCM_DATA_FORMAT_PARAM: 22211be678e9SMatthias Ringwald if (hci_classic_supported() && (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_BROADCOM_CORPORATION)){ 22221be678e9SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_BCM_WRITE_PCM_DATA_FORMAT_PARAM; 22231be678e9SMatthias Ringwald log_info("BCM: Config PCM Data format"); 22241be678e9SMatthias Ringwald // msb first, fill bits 0, left justified 22251be678e9SMatthias Ringwald hci_send_cmd(&hci_bcm_write_pcm_data_format_param, 0, 0, 3, 3, 0); 22261be678e9SMatthias Ringwald break; 22271be678e9SMatthias Ringwald } 2228dd1f98b4SMatthias Ringwald #ifdef HAVE_BCM_PCM2 2229dd1f98b4SMatthias Ringwald case HCI_INIT_BCM_PCM2_SETUP: 2230dd1f98b4SMatthias Ringwald if (hci_classic_supported() && (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_BROADCOM_CORPORATION)) { 2231dd1f98b4SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_BCM_PCM2_SETUP; 2232dd1f98b4SMatthias Ringwald uint8_t op_mode = 0; // Op_Mode = 0 = PCM, 1 = I2S 2233dd1f98b4SMatthias Ringwald uint32_t pcm_clock_freq; 2234dd1f98b4SMatthias Ringwald uint8_t ch_0_period; 2235dd1f98b4SMatthias Ringwald #ifdef ENABLE_BCM_PCM_WBS 2236dd1f98b4SMatthias Ringwald // 512 kHz, resample 8 kHz to 16 khz 2237dd1f98b4SMatthias Ringwald pcm_clock_freq = 512000; 2238dd1f98b4SMatthias Ringwald ch_0_period = 1; 2239dd1f98b4SMatthias Ringwald #else 2240dd1f98b4SMatthias Ringwald // 256 khz, 8 khz output 2241dd1f98b4SMatthias Ringwald pcm_clock_freq = 256000; 2242dd1f98b4SMatthias Ringwald ch_0_period = 0; 224335454696SMatthias Ringwald #endif 2244dd1f98b4SMatthias Ringwald log_info("BCM: Config PCM2 - op mode %u, pcm clock %" PRIu32 ", ch0_period %u", op_mode, pcm_clock_freq, ch_0_period); 2245dd1f98b4SMatthias Ringwald hci_send_cmd(&hci_bcm_pcm2_setup, 2246dd1f98b4SMatthias Ringwald 0x00, // Action = Write 2247dd1f98b4SMatthias Ringwald 0x00, // Test_Options = None 2248dd1f98b4SMatthias Ringwald op_mode, // Op_Mode 2249dd1f98b4SMatthias Ringwald 0x1D, // Sync_and_Clock_Options Sync = Signal | Sync Output Enable | Generate PCM_CLK | Tristate When Idle 2250dd1f98b4SMatthias Ringwald pcm_clock_freq, // PCM_Clock_Freq 2251dd1f98b4SMatthias Ringwald 0x01, // Sync_Signal_Width 2252dd1f98b4SMatthias Ringwald 0x0F, // Slot_Width 2253dd1f98b4SMatthias Ringwald 0x01, // NumberOfSlots 2254dd1f98b4SMatthias Ringwald 0x00, // Bank_0_Fill_Mode = 0s 2255dd1f98b4SMatthias Ringwald 0x00, // Bank_0_Number_of_Fill_Bits 2256dd1f98b4SMatthias Ringwald 0x00, // Bank_0_Programmable_Fill_Data 2257dd1f98b4SMatthias Ringwald 0x00, // Bank_1_Fill_Mode = 0s 2258dd1f98b4SMatthias Ringwald 0x00, // Bank_1_Number_of_Fill_Bits 2259dd1f98b4SMatthias Ringwald 0x00, // Bank_1_Programmable_Fill_Data 2260dd1f98b4SMatthias Ringwald 0x00, // Data_Justify_And_Bit_Order_Options = Left Justify 2261dd1f98b4SMatthias Ringwald 0x00, // Ch_0_Slot_Number 2262dd1f98b4SMatthias Ringwald 0x01, // Ch_1_Slot_Number 2263dd1f98b4SMatthias Ringwald 0x02, // Ch_2_Slot_Number 2264dd1f98b4SMatthias Ringwald 0x03, // Ch_3_Slot_Number 2265dd1f98b4SMatthias Ringwald 0x04, // Ch_4_Slot_Number 2266dd1f98b4SMatthias Ringwald ch_0_period, // Ch_0_Period 2267dd1f98b4SMatthias Ringwald 0x00, // Ch_1_Period 2268dd1f98b4SMatthias Ringwald 0x00 // Ch_2_Period 2269dd1f98b4SMatthias Ringwald ); 2270dd1f98b4SMatthias Ringwald break; 2271dd1f98b4SMatthias Ringwald } 22724e821764SMatthias Ringwald #endif 2273dd1f98b4SMatthias Ringwald #endif /* ENABLE_SCO_OVER_PCM */ 2274dd1f98b4SMatthias Ringwald #endif /* ENABLE_CLASSIC */ 22754e821764SMatthias Ringwald 2276a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE 2277521bd5ffSMatthias Ringwald /* fall through */ 2278521bd5ffSMatthias Ringwald 227974b323a9SMatthias Ringwald // LE INIT 228074b323a9SMatthias Ringwald case HCI_INIT_LE_READ_BUFFER_SIZE: 2281f795c86eSMatthias Ringwald if (hci_le_supported()){ 228274b323a9SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_LE_READ_BUFFER_SIZE; 228379b7ea2dSMatthias Ringwald if (hci_command_supported(SUPPORTED_HCI_COMMAND_LE_READ_BUFFER_SIZE_V2)){ 228479b7ea2dSMatthias Ringwald hci_send_cmd(&hci_le_read_buffer_size_v2); 228579b7ea2dSMatthias Ringwald } else { 22860305bdeaSMatthias Ringwald hci_send_cmd(&hci_le_read_buffer_size); 228779b7ea2dSMatthias Ringwald } 228874b323a9SMatthias Ringwald break; 2289f795c86eSMatthias Ringwald } 2290521bd5ffSMatthias Ringwald 2291f795c86eSMatthias Ringwald /* fall through */ 2292f795c86eSMatthias Ringwald 2293699a5fcaSMatthias Ringwald case HCI_INIT_WRITE_LE_HOST_SUPPORTED: 2294699a5fcaSMatthias Ringwald // skip write le host if not supported (e.g. on LE only EM9301) 22951ffa425cSMatthias Ringwald if (hci_le_supported() 22961ffa425cSMatthias Ringwald && hci_command_supported(SUPPORTED_HCI_COMMAND_WRITE_LE_HOST_SUPPORTED)) { 2297699a5fcaSMatthias Ringwald // LE Supported Host = 1, Simultaneous Host = 0 2298699a5fcaSMatthias Ringwald hci_stack->substate = HCI_INIT_W4_WRITE_LE_HOST_SUPPORTED; 2299699a5fcaSMatthias Ringwald hci_send_cmd(&hci_write_le_host_supported, 1, 0); 2300daabb8b8SMatthias Ringwald break; 2301f795c86eSMatthias Ringwald } 2302521bd5ffSMatthias Ringwald 2303f795c86eSMatthias Ringwald /* fall through */ 2304f795c86eSMatthias Ringwald 2305699a5fcaSMatthias Ringwald case HCI_INIT_LE_SET_EVENT_MASK: 2306f795c86eSMatthias Ringwald if (hci_le_supported()){ 2307699a5fcaSMatthias Ringwald hci_stack->substate = HCI_INIT_W4_LE_SET_EVENT_MASK; 23085d6688b0SMatthias Ringwald #ifdef ENABLE_LE_ENHANCED_CONNECTION_COMPLETE_EVENT 2309920a6ac5SMatthias Ringwald hci_send_cmd(&hci_le_set_event_mask, 0xffffffff, 0x0107); // all events from core v5.3 23105d6688b0SMatthias Ringwald #else 2311920a6ac5SMatthias Ringwald hci_send_cmd(&hci_le_set_event_mask, 0xfffffdff, 0x0007); // all events from core v5.3 without LE Enhanced Connection Complete 23125d6688b0SMatthias Ringwald #endif 231374b323a9SMatthias Ringwald break; 2314f795c86eSMatthias Ringwald } 2315b435e062SMatthias Ringwald #endif 2316b435e062SMatthias Ringwald 2317b435e062SMatthias Ringwald #ifdef ENABLE_LE_DATA_LENGTH_EXTENSION 2318521bd5ffSMatthias Ringwald /* fall through */ 2319521bd5ffSMatthias Ringwald 2320dcd678baSMatthias Ringwald case HCI_INIT_LE_READ_MAX_DATA_LENGTH: 23211ffa425cSMatthias Ringwald if (hci_le_supported() 23221ffa425cSMatthias Ringwald && hci_command_supported(SUPPORTED_HCI_COMMAND_LE_READ_MAXIMUM_DATA_LENGTH)) { 2323dcd678baSMatthias Ringwald hci_stack->substate = HCI_INIT_W4_LE_READ_MAX_DATA_LENGTH; 2324dcd678baSMatthias Ringwald hci_send_cmd(&hci_le_read_maximum_data_length); 2325dcd678baSMatthias Ringwald break; 2326f795c86eSMatthias Ringwald } 2327521bd5ffSMatthias Ringwald 2328f795c86eSMatthias Ringwald /* fall through */ 2329f795c86eSMatthias Ringwald 2330dcd678baSMatthias Ringwald case HCI_INIT_LE_WRITE_SUGGESTED_DATA_LENGTH: 23311ffa425cSMatthias Ringwald if (hci_le_supported() 23321ffa425cSMatthias Ringwald && hci_command_supported(SUPPORTED_HCI_COMMAND_LE_WRITE_SUGGESTED_DEFAULT_DATA_LENGTH)) { 2333dcd678baSMatthias Ringwald hci_stack->substate = HCI_INIT_W4_LE_WRITE_SUGGESTED_DATA_LENGTH; 2334b435e062SMatthias Ringwald hci_send_cmd(&hci_le_write_suggested_default_data_length, hci_stack->le_supported_max_tx_octets, hci_stack->le_supported_max_tx_time); 2335dcd678baSMatthias Ringwald break; 2336f795c86eSMatthias Ringwald } 2337b435e062SMatthias Ringwald #endif 2338b435e062SMatthias Ringwald 2339b95a5a35SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 2340521bd5ffSMatthias Ringwald /* fall through */ 2341521bd5ffSMatthias Ringwald 23423b6d4121SMatthias Ringwald case HCI_INIT_READ_WHITE_LIST_SIZE: 2343f795c86eSMatthias Ringwald if (hci_le_supported()){ 23443b6d4121SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_READ_WHITE_LIST_SIZE; 23453b6d4121SMatthias Ringwald hci_send_cmd(&hci_le_read_white_list_size); 23463b6d4121SMatthias Ringwald break; 2347f795c86eSMatthias Ringwald } 2348521bd5ffSMatthias Ringwald 234974b323a9SMatthias Ringwald #endif 23504f982f31SMatthias Ringwald 23513a74541eSMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 23523a74541eSMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 23533a74541eSMatthias Ringwald /* fall through */ 23543a74541eSMatthias Ringwald 23553a74541eSMatthias Ringwald case HCI_INIT_LE_READ_MAX_ADV_DATA_LEN: 235622f987e4SMatthias Ringwald if (hci_le_extended_advertising_supported()){ 23573a74541eSMatthias Ringwald hci_stack->substate = HCI_INIT_W4_LE_READ_MAX_ADV_DATA_LEN; 23583a74541eSMatthias Ringwald hci_send_cmd(&hci_le_read_maximum_advertising_data_length); 23593a74541eSMatthias Ringwald break; 23603a74541eSMatthias Ringwald } 23613a74541eSMatthias Ringwald #endif 23623a74541eSMatthias Ringwald #endif 2363521bd5ffSMatthias Ringwald /* fall through */ 2364521bd5ffSMatthias Ringwald 2365c63ee49aSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS 2366c63ee49aSMatthias Ringwald case HCI_INIT_LE_SET_HOST_FEATURE_CONNECTED_ISO_STREAMS: 2367c63ee49aSMatthias Ringwald if (hci_le_supported()) { 2368c63ee49aSMatthias Ringwald hci_stack->substate = HCI_INIT_W4_LE_SET_HOST_FEATURE_CONNECTED_ISO_STREAMS; 2369c63ee49aSMatthias Ringwald hci_send_cmd(&hci_le_set_host_feature, 32, 1); 2370c63ee49aSMatthias Ringwald break; 2371c63ee49aSMatthias Ringwald } 2372c63ee49aSMatthias Ringwald #endif 2373c63ee49aSMatthias Ringwald 2374c63ee49aSMatthias Ringwald /* fall through */ 2375c63ee49aSMatthias Ringwald 2376f795c86eSMatthias Ringwald case HCI_INIT_DONE: 23774f982f31SMatthias Ringwald hci_stack->substate = HCI_INIT_DONE; 237873799937SMatthias Ringwald // main init sequence complete 23794f982f31SMatthias Ringwald #ifdef ENABLE_CLASSIC 238073799937SMatthias Ringwald // check if initial Classic GAP Tasks are completed 2381baa4881eSMatthias Ringwald if (hci_classic_supported() && (hci_stack->gap_tasks_classic != 0)) { 23824f982f31SMatthias Ringwald hci_run_gap_tasks_classic(); 23834f982f31SMatthias Ringwald break; 23844f982f31SMatthias Ringwald } 23854f982f31SMatthias Ringwald #endif 238673799937SMatthias Ringwald #ifdef ENABLE_BLE 238773799937SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 238873799937SMatthias Ringwald // check if initial LE GAP Tasks are completed 238973799937SMatthias Ringwald if (hci_le_supported() && hci_stack->le_scanning_param_update) { 239073799937SMatthias Ringwald hci_run_general_gap_le(); 239173799937SMatthias Ringwald break; 239273799937SMatthias Ringwald } 239373799937SMatthias Ringwald #endif 239473799937SMatthias Ringwald #endif 2395f795c86eSMatthias Ringwald hci_init_done(); 2396f795c86eSMatthias Ringwald break; 2397f795c86eSMatthias Ringwald 239874b323a9SMatthias Ringwald default: 239974b323a9SMatthias Ringwald return; 240074b323a9SMatthias Ringwald } 240155975f88SMatthias Ringwald } 240255975f88SMatthias Ringwald 240307fd2f31SMatthias Ringwald static bool hci_initializing_event_handler_command_completed(const uint8_t * packet){ 240407fd2f31SMatthias Ringwald bool command_completed = false; 24050e2df43fSMatthias Ringwald if (hci_event_packet_get_type(packet) == HCI_EVENT_COMMAND_COMPLETE){ 2406f8fbdce0SMatthias Ringwald uint16_t opcode = little_endian_read_16(packet,3); 24076155b3d3S[email protected] if (opcode == hci_stack->last_cmd_opcode){ 240807fd2f31SMatthias Ringwald command_completed = true; 2409148ca237SMatthias Ringwald log_debug("Command complete for expected opcode %04x at substate %u", opcode, hci_stack->substate); 24106155b3d3S[email protected] } else { 2411d58dd308SMatthias Ringwald log_info("Command complete for different opcode %04x, expected %04x, at substate %u", opcode, hci_stack->last_cmd_opcode, hci_stack->substate); 24126155b3d3S[email protected] } 24136155b3d3S[email protected] } 24140f97eae7SMatthias Ringwald 24150e2df43fSMatthias Ringwald if (hci_event_packet_get_type(packet) == HCI_EVENT_COMMAND_STATUS){ 24166155b3d3S[email protected] uint8_t status = packet[2]; 2417f8fbdce0SMatthias Ringwald uint16_t opcode = little_endian_read_16(packet,4); 24186155b3d3S[email protected] if (opcode == hci_stack->last_cmd_opcode){ 24196155b3d3S[email protected] if (status){ 242007fd2f31SMatthias Ringwald command_completed = true; 2421148ca237SMatthias Ringwald log_debug("Command status error 0x%02x for expected opcode %04x at substate %u", status, opcode, hci_stack->substate); 24226155b3d3S[email protected] } else { 24236155b3d3S[email protected] log_info("Command status OK for expected opcode %04x, waiting for command complete", opcode); 24246155b3d3S[email protected] } 24256155b3d3S[email protected] } else { 2426148ca237SMatthias Ringwald log_debug("Command status for opcode %04x, expected %04x", opcode, hci_stack->last_cmd_opcode); 24276155b3d3S[email protected] } 24286155b3d3S[email protected] } 24296fad2c37SMatthias Ringwald #ifndef HAVE_HOST_CONTROLLER_API 2430e47e68c7SMatthias Ringwald // Vendor == CSR 24310e588213SMatthias Ringwald if ((hci_stack->substate == HCI_INIT_W4_CUSTOM_INIT) && (hci_event_packet_get_type(packet) == HCI_EVENT_VENDOR_SPECIFIC)){ 2432e47e68c7SMatthias Ringwald // TODO: track actual command 243307fd2f31SMatthias Ringwald command_completed = true; 2434e47e68c7SMatthias Ringwald } 2435a2481739S[email protected] 24364e9daa6fSMatthias Ringwald // Vendor == Toshiba 24370e588213SMatthias Ringwald if ((hci_stack->substate == HCI_INIT_W4_SEND_BAUD_CHANGE) && (hci_event_packet_get_type(packet) == HCI_EVENT_VENDOR_SPECIFIC)){ 24384e9daa6fSMatthias Ringwald // TODO: track actual command 243907fd2f31SMatthias Ringwald command_completed = true; 2440004902f1SMatthias Ringwald // Fix: no HCI Command Complete received, so num_cmd_packets not reset 2441004902f1SMatthias Ringwald hci_stack->num_cmd_packets = 1; 24424e9daa6fSMatthias Ringwald } 244307fd2f31SMatthias Ringwald #endif 244407fd2f31SMatthias Ringwald 244507fd2f31SMatthias Ringwald return command_completed; 244607fd2f31SMatthias Ringwald } 244707fd2f31SMatthias Ringwald 244807fd2f31SMatthias Ringwald static void hci_initializing_event_handler(const uint8_t * packet, uint16_t size){ 244907fd2f31SMatthias Ringwald 245007fd2f31SMatthias Ringwald UNUSED(size); // ok: less than 6 bytes are read from our buffer 245107fd2f31SMatthias Ringwald 245207fd2f31SMatthias Ringwald bool command_completed = hci_initializing_event_handler_command_completed(packet); 245307fd2f31SMatthias Ringwald 24546fad2c37SMatthias Ringwald #ifndef HAVE_HOST_CONTROLLER_API 24554e9daa6fSMatthias Ringwald 24560f97eae7SMatthias Ringwald // Late response (> 100 ms) for HCI Reset e.g. on Toshiba TC35661: 24570f97eae7SMatthias Ringwald // Command complete for HCI Reset arrives after we've resent the HCI Reset command 24580f97eae7SMatthias Ringwald // 24590f97eae7SMatthias Ringwald // HCI Reset 24600f97eae7SMatthias Ringwald // Timeout 100 ms 24610f97eae7SMatthias Ringwald // HCI Reset 24620f97eae7SMatthias Ringwald // Command Complete Reset 24630f97eae7SMatthias Ringwald // HCI Read Local Version Information 24640f97eae7SMatthias Ringwald // Command Complete Reset - but we expected Command Complete Read Local Version Information 24650f97eae7SMatthias Ringwald // hang... 24660f97eae7SMatthias Ringwald // 24670f97eae7SMatthias Ringwald // Fix: Command Complete for HCI Reset in HCI_INIT_W4_SEND_READ_LOCAL_VERSION_INFORMATION trigger resend 24680f97eae7SMatthias Ringwald if (!command_completed 2469a1df452eSMatthias Ringwald && (hci_event_packet_get_type(packet) == HCI_EVENT_COMMAND_COMPLETE) 24700e588213SMatthias Ringwald && (hci_stack->substate == HCI_INIT_W4_SEND_READ_LOCAL_VERSION_INFORMATION)){ 24710f97eae7SMatthias Ringwald 2472f8fbdce0SMatthias Ringwald uint16_t opcode = little_endian_read_16(packet,3); 24730f97eae7SMatthias Ringwald if (opcode == hci_reset.opcode){ 24740f97eae7SMatthias Ringwald hci_stack->substate = HCI_INIT_SEND_READ_LOCAL_VERSION_INFORMATION; 24750f97eae7SMatthias Ringwald return; 24760f97eae7SMatthias Ringwald } 24770f97eae7SMatthias Ringwald } 24780f97eae7SMatthias Ringwald 24799f007422SMatthias Ringwald // CSR & H5 24809f007422SMatthias Ringwald // Fix: Command Complete for HCI Reset in HCI_INIT_W4_SEND_READ_LOCAL_VERSION_INFORMATION trigger resend 24819f007422SMatthias Ringwald if (!command_completed 2482a1df452eSMatthias Ringwald && (hci_event_packet_get_type(packet) == HCI_EVENT_COMMAND_COMPLETE) 24830e588213SMatthias Ringwald && (hci_stack->substate == HCI_INIT_W4_READ_LOCAL_SUPPORTED_COMMANDS)){ 24849f007422SMatthias Ringwald 24859f007422SMatthias Ringwald uint16_t opcode = little_endian_read_16(packet,3); 24869f007422SMatthias Ringwald if (opcode == hci_reset.opcode){ 24879f007422SMatthias Ringwald hci_stack->substate = HCI_INIT_READ_LOCAL_SUPPORTED_COMMANDS; 24889f007422SMatthias Ringwald return; 24899f007422SMatthias Ringwald } 24909f007422SMatthias Ringwald } 24919f007422SMatthias Ringwald 24929f007422SMatthias Ringwald // on CSR with BCSP/H5, the reset resend timeout leads to substate == HCI_INIT_SEND_RESET or HCI_INIT_SEND_RESET_CSR_WARM_BOOT 24939f007422SMatthias Ringwald // fix: Correct substate and behave as command below 24949f007422SMatthias Ringwald if (command_completed){ 24959f007422SMatthias Ringwald switch (hci_stack->substate){ 24969f007422SMatthias Ringwald case HCI_INIT_SEND_RESET: 24979f007422SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_SEND_RESET; 24989f007422SMatthias Ringwald break; 24999f007422SMatthias Ringwald case HCI_INIT_SEND_RESET_CSR_WARM_BOOT: 25009f007422SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_CUSTOM_INIT_CSR_WARM_BOOT; 25019f007422SMatthias Ringwald break; 25029f007422SMatthias Ringwald default: 25039f007422SMatthias Ringwald break; 25049f007422SMatthias Ringwald } 25059f007422SMatthias Ringwald } 25060f97eae7SMatthias Ringwald 250706b9e820SMatthias Ringwald #endif 25080f97eae7SMatthias Ringwald 2509a2481739S[email protected] if (!command_completed) return; 2510a2481739S[email protected] 251107fd2f31SMatthias Ringwald bool need_baud_change = false; 251207fd2f31SMatthias Ringwald bool need_addr_change = false; 251306b9e820SMatthias Ringwald 25146fad2c37SMatthias Ringwald #ifndef HAVE_HOST_CONTROLLER_API 251506b9e820SMatthias Ringwald need_baud_change = hci_stack->config 25163fb36a29SMatthias Ringwald && hci_stack->chipset 25173fb36a29SMatthias Ringwald && hci_stack->chipset->set_baudrate_command 2518db8bc6ffSMatthias Ringwald && hci_stack->hci_transport->set_baudrate 25199796ebeaSMatthias Ringwald && ((hci_transport_config_uart_t *)hci_stack->config)->baudrate_main; 2520db8bc6ffSMatthias Ringwald 252106b9e820SMatthias Ringwald need_addr_change = hci_stack->custom_bd_addr_set 25223fb36a29SMatthias Ringwald && hci_stack->chipset 25233fb36a29SMatthias Ringwald && hci_stack->chipset->set_bd_addr_command; 252406b9e820SMatthias Ringwald #endif 2525a80162e9SMatthias Ringwald 25265c363727SMatthias Ringwald switch(hci_stack->substate){ 252706b9e820SMatthias Ringwald 25286fad2c37SMatthias Ringwald #ifndef HAVE_HOST_CONTROLLER_API 25299f007422SMatthias Ringwald case HCI_INIT_SEND_RESET: 2530d58dd308SMatthias Ringwald // on CSR with BCSP/H5, resend triggers resend of HCI Reset and leads to substate == HCI_INIT_SEND_RESET 25319f007422SMatthias Ringwald // fix: just correct substate and behave as command below 2532f4c579d4SMatthias Ringwald 2533f4c579d4SMatthias Ringwald /* fall through */ 2534f4c579d4SMatthias Ringwald #endif 2535f4c579d4SMatthias Ringwald 253674b323a9SMatthias Ringwald case HCI_INIT_W4_SEND_RESET: 2537528a4a3bSMatthias Ringwald btstack_run_loop_remove_timer(&hci_stack->timeout); 2538f4c579d4SMatthias Ringwald hci_stack->substate = HCI_INIT_SEND_READ_LOCAL_VERSION_INFORMATION; 25392f48d920SMatthias Ringwald return; 2540f4c579d4SMatthias Ringwald 2541f4c579d4SMatthias Ringwald #ifndef HAVE_HOST_CONTROLLER_API 2542a80162e9SMatthias Ringwald case HCI_INIT_W4_SEND_BAUD_CHANGE: 25434696bddbSMatthias Ringwald // for STLC2500D, baud rate change already happened. 2544fab26ab3SMatthias Ringwald // for others, baud rate gets changed now 254561f37892SMatthias Ringwald if ((hci_stack->manufacturer != BLUETOOTH_COMPANY_ID_ST_MICROELECTRONICS) && need_baud_change){ 254696b53536SMatthias Ringwald uint32_t baud_rate = hci_transport_uart_get_main_baud_rate(); 2547cd724cb7SMatthias Ringwald log_info("Local baud rate change to %" PRIu32 "(w4_send_baud_change)", baud_rate); 2548fab26ab3SMatthias Ringwald hci_stack->hci_transport->set_baudrate(baud_rate); 25494696bddbSMatthias Ringwald } 255074b323a9SMatthias Ringwald hci_stack->substate = HCI_INIT_CUSTOM_INIT; 255174b323a9SMatthias Ringwald return; 2552a80162e9SMatthias Ringwald case HCI_INIT_W4_CUSTOM_INIT_CSR_WARM_BOOT: 2553528a4a3bSMatthias Ringwald btstack_run_loop_remove_timer(&hci_stack->timeout); 2554a80162e9SMatthias Ringwald hci_stack->substate = HCI_INIT_CUSTOM_INIT; 2555a80162e9SMatthias Ringwald return; 255674b323a9SMatthias Ringwald case HCI_INIT_W4_CUSTOM_INIT: 255774b323a9SMatthias Ringwald // repeat custom init 255874b323a9SMatthias Ringwald hci_stack->substate = HCI_INIT_CUSTOM_INIT; 255974b323a9SMatthias Ringwald return; 25606fe16221SMatthias Ringwald case HCI_INIT_W4_CUSTOM_PRE_INIT: 25616fe16221SMatthias Ringwald // repeat custom init 25626fe16221SMatthias Ringwald hci_stack->substate = HCI_INIT_CUSTOM_PRE_INIT; 25636fe16221SMatthias Ringwald return; 256406b9e820SMatthias Ringwald #endif 256506b9e820SMatthias Ringwald 2566a828a756SMatthias Ringwald case HCI_INIT_W4_READ_LOCAL_SUPPORTED_COMMANDS: 25670e588213SMatthias Ringwald if (need_baud_change && (hci_stack->chipset_result != BTSTACK_CHIPSET_NO_INIT_SCRIPT) && 2568efd3b327SMatthias Ringwald ((hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_BROADCOM_CORPORATION) || 2569efd3b327SMatthias Ringwald (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_EM_MICROELECTRONIC_MARIN_SA))) { 2570eb3a5314SMatthias Ringwald hci_stack->substate = HCI_INIT_SEND_BAUD_CHANGE_BCM; 2571eb3a5314SMatthias Ringwald return; 2572eb3a5314SMatthias Ringwald } 257353860077SMatthias Ringwald if (need_addr_change){ 257453860077SMatthias Ringwald hci_stack->substate = HCI_INIT_SET_BD_ADDR; 257553860077SMatthias Ringwald return; 257653860077SMatthias Ringwald } 257753860077SMatthias Ringwald hci_stack->substate = HCI_INIT_READ_BD_ADDR; 257853860077SMatthias Ringwald return; 25796fad2c37SMatthias Ringwald #ifndef HAVE_HOST_CONTROLLER_API 25807224be7eSMatthias Ringwald case HCI_INIT_W4_SEND_BAUD_CHANGE_BCM: 25817224be7eSMatthias Ringwald if (need_baud_change){ 258296b53536SMatthias Ringwald uint32_t baud_rate = hci_transport_uart_get_main_baud_rate(); 2583cd724cb7SMatthias Ringwald log_info("Local baud rate change to %" PRIu32 "(w4_send_baud_change_bcm))", baud_rate); 2584fab26ab3SMatthias Ringwald hci_stack->hci_transport->set_baudrate(baud_rate); 25857224be7eSMatthias Ringwald } 2586eb3a5314SMatthias Ringwald if (need_addr_change){ 2587eb3a5314SMatthias Ringwald hci_stack->substate = HCI_INIT_SET_BD_ADDR; 2588eb3a5314SMatthias Ringwald return; 2589eb3a5314SMatthias Ringwald } 2590eb3a5314SMatthias Ringwald hci_stack->substate = HCI_INIT_READ_BD_ADDR; 2591eb3a5314SMatthias Ringwald return; 259253860077SMatthias Ringwald case HCI_INIT_W4_SET_BD_ADDR: 25936ca9a99aSMatthias Ringwald // for STLC2500D + ATWILC3000, bd addr change only gets active after sending reset command 25946ca9a99aSMatthias Ringwald if ((hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_ST_MICROELECTRONICS) 25956ca9a99aSMatthias Ringwald || (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_ATMEL_CORPORATION)){ 259653860077SMatthias Ringwald hci_stack->substate = HCI_INIT_SEND_RESET_ST_WARM_BOOT; 259753860077SMatthias Ringwald return; 259853860077SMatthias Ringwald } 259953860077SMatthias Ringwald // skipping st warm boot 260053860077SMatthias Ringwald hci_stack->substate = HCI_INIT_READ_BD_ADDR; 260153860077SMatthias Ringwald return; 260253860077SMatthias Ringwald case HCI_INIT_W4_SEND_RESET_ST_WARM_BOOT: 260353860077SMatthias Ringwald hci_stack->substate = HCI_INIT_READ_BD_ADDR; 260453860077SMatthias Ringwald return; 260506b9e820SMatthias Ringwald #endif 2606e7c662faSMatthias Ringwald 2607f795c86eSMatthias Ringwald case HCI_INIT_DONE: 2608eb8d95caSMatthias Ringwald // set state if we came here by fall through 2609eb8d95caSMatthias Ringwald hci_stack->substate = HCI_INIT_DONE; 2610f795c86eSMatthias Ringwald return; 2611a650ba4dSMatthias Ringwald 26126155b3d3S[email protected] default: 261374b323a9SMatthias Ringwald break; 26146155b3d3S[email protected] } 261555975f88SMatthias Ringwald hci_initializing_next_state(); 26166155b3d3S[email protected] } 26176155b3d3S[email protected] 26180bbba85bSMatthias Ringwald static void hci_handle_connection_failed(hci_connection_t * conn, uint8_t status){ 26193bb5ff27SMatthias Ringwald // CC2564C might emit Connection Complete for rejected incoming SCO connection 26201a4fdac4SMatthias Ringwald // To prevent accidentally free'ing the HCI connection for the ACL connection, 26211a4fdac4SMatthias Ringwald // check if we have been aware of the HCI connection 26221f34df2cSMatthias Ringwald switch (conn->state){ 26231a4fdac4SMatthias Ringwald case SENT_CREATE_CONNECTION: 26241f34df2cSMatthias Ringwald case RECEIVED_CONNECTION_REQUEST: 26259071873aSMatthias Ringwald case ACCEPTED_CONNECTION_REQUEST: 26261f34df2cSMatthias Ringwald break; 26271f34df2cSMatthias Ringwald default: 26281f34df2cSMatthias Ringwald return; 26291f34df2cSMatthias Ringwald } 26303bb5ff27SMatthias Ringwald 2631229331c6SMatthias Ringwald log_info("Outgoing connection to %s failed", bd_addr_to_str(conn->address)); 26320bbba85bSMatthias Ringwald bd_addr_t bd_address; 26336535961aSMatthias Ringwald (void)memcpy(&bd_address, conn->address, 6); 26340bbba85bSMatthias Ringwald 26356bc9fa5eSMatthias Ringwald #ifdef ENABLE_CLASSIC 26366bc9fa5eSMatthias Ringwald // cache needed data 26376bc9fa5eSMatthias Ringwald int notify_dedicated_bonding_failed = conn->bonding_flags & BONDING_DEDICATED; 26386bc9fa5eSMatthias Ringwald #endif 26396bc9fa5eSMatthias Ringwald 26400bbba85bSMatthias Ringwald // connection failed, remove entry 26410bbba85bSMatthias Ringwald btstack_linked_list_remove(&hci_stack->connections, (btstack_linked_item_t *) conn); 26420bbba85bSMatthias Ringwald btstack_memory_hci_connection_free( conn ); 26430bbba85bSMatthias Ringwald 26446bc9fa5eSMatthias Ringwald #ifdef ENABLE_CLASSIC 26450bbba85bSMatthias Ringwald // notify client if dedicated bonding 26460bbba85bSMatthias Ringwald if (notify_dedicated_bonding_failed){ 26470bbba85bSMatthias Ringwald log_info("hci notify_dedicated_bonding_failed"); 26480bbba85bSMatthias Ringwald hci_emit_dedicated_bonding_result(bd_address, status); 26490bbba85bSMatthias Ringwald } 26500bbba85bSMatthias Ringwald 26510bbba85bSMatthias Ringwald // if authentication error, also delete link key 26520bbba85bSMatthias Ringwald if (status == ERROR_CODE_AUTHENTICATION_FAILURE) { 26530bbba85bSMatthias Ringwald gap_drop_link_key_for_bd_addr(bd_address); 26540bbba85bSMatthias Ringwald } 26551c79b5e3SMatthias Ringwald #else 26561c79b5e3SMatthias Ringwald UNUSED(status); 26576bc9fa5eSMatthias Ringwald #endif 26580bbba85bSMatthias Ringwald } 26590bbba85bSMatthias Ringwald 2660be500194SMatthias Ringwald #ifdef ENABLE_CLASSIC 26612f5c44baSMatthias Ringwald static void hci_handle_remote_features_page_0(hci_connection_t * conn, const uint8_t * features){ 26622f5c44baSMatthias Ringwald // SSP Controller 26632f5c44baSMatthias Ringwald if (features[6] & (1 << 3)){ 26642f5c44baSMatthias Ringwald conn->bonding_flags |= BONDING_REMOTE_SUPPORTS_SSP_CONTROLLER; 26652f5c44baSMatthias Ringwald } 26662f5c44baSMatthias Ringwald // eSCO 26672f5c44baSMatthias Ringwald if (features[3] & (1<<7)){ 26682f5c44baSMatthias Ringwald conn->remote_supported_features[0] |= 1; 26692f5c44baSMatthias Ringwald } 26702f5c44baSMatthias Ringwald // Extended features 26712f5c44baSMatthias Ringwald if (features[7] & (1<<7)){ 26722f5c44baSMatthias Ringwald conn->remote_supported_features[0] |= 2; 26732f5c44baSMatthias Ringwald } 26740b78a447SMatthias Ringwald // SCO packet types 26750b78a447SMatthias Ringwald conn->remote_supported_sco_packets = hci_sco_packet_types_for_features(features); 26762f5c44baSMatthias Ringwald } 26772f5c44baSMatthias Ringwald 26782f5c44baSMatthias Ringwald static void hci_handle_remote_features_page_1(hci_connection_t * conn, const uint8_t * features){ 26792f5c44baSMatthias Ringwald // SSP Host 26802f5c44baSMatthias Ringwald if (features[0] & (1 << 0)){ 26812f5c44baSMatthias Ringwald conn->bonding_flags |= BONDING_REMOTE_SUPPORTS_SSP_HOST; 26822f5c44baSMatthias Ringwald } 268350c51a77SMatthias Ringwald // SC Host 268450c51a77SMatthias Ringwald if (features[0] & (1 << 3)){ 268550c51a77SMatthias Ringwald conn->bonding_flags |= BONDING_REMOTE_SUPPORTS_SC_HOST; 268650c51a77SMatthias Ringwald } 268750c51a77SMatthias Ringwald } 268850c51a77SMatthias Ringwald 268950c51a77SMatthias Ringwald static void hci_handle_remote_features_page_2(hci_connection_t * conn, const uint8_t * features){ 269050c51a77SMatthias Ringwald // SC Controller 269150c51a77SMatthias Ringwald if (features[1] & (1 << 0)){ 269250c51a77SMatthias Ringwald conn->bonding_flags |= BONDING_REMOTE_SUPPORTS_SC_CONTROLLER; 269350c51a77SMatthias Ringwald } 26942f5c44baSMatthias Ringwald } 26952f5c44baSMatthias Ringwald 2696de0df013SMatthias Ringwald static void hci_handle_remote_features_received(hci_connection_t * conn){ 2697461a2bc4SMatthias Ringwald conn->bonding_flags &= ~BONDING_REMOTE_FEATURES_QUERY_ACTIVE; 2698de0df013SMatthias Ringwald conn->bonding_flags |= BONDING_RECEIVED_REMOTE_FEATURES; 2699cb7b3e6fSMatthias Ringwald log_info("Remote features %02x, bonding flags %" PRIx32, conn->remote_supported_features[0], conn->bonding_flags); 2700de0df013SMatthias Ringwald if (conn->bonding_flags & BONDING_DEDICATED){ 2701de0df013SMatthias Ringwald conn->bonding_flags |= BONDING_SEND_AUTHENTICATE_REQUEST; 2702de0df013SMatthias Ringwald } 2703de0df013SMatthias Ringwald } 2704128825c3SMatthias Ringwald static bool hci_remote_sc_enabled(hci_connection_t * connection){ 2705128825c3SMatthias Ringwald const uint16_t sc_enabled_mask = BONDING_REMOTE_SUPPORTS_SC_HOST | BONDING_REMOTE_SUPPORTS_SC_CONTROLLER; 2706128825c3SMatthias Ringwald return (connection->bonding_flags & sc_enabled_mask) == sc_enabled_mask; 2707128825c3SMatthias Ringwald } 2708128825c3SMatthias Ringwald 2709be500194SMatthias Ringwald #endif 2710de0df013SMatthias Ringwald 271167c6c9dcSMatthias Ringwald static void handle_event_for_current_stack_state(const uint8_t * packet, uint16_t size) { 271267c6c9dcSMatthias Ringwald // handle BT initialization 271367c6c9dcSMatthias Ringwald if (hci_stack->state == HCI_STATE_INITIALIZING) { 271467c6c9dcSMatthias Ringwald hci_initializing_event_handler(packet, size); 271567c6c9dcSMatthias Ringwald } 271667c6c9dcSMatthias Ringwald 271767c6c9dcSMatthias Ringwald // help with BT sleep 271867c6c9dcSMatthias Ringwald if ((hci_stack->state == HCI_STATE_FALLING_ASLEEP) 271967c6c9dcSMatthias Ringwald && (hci_stack->substate == HCI_FALLING_ASLEEP_W4_WRITE_SCAN_ENABLE) 272072a2585aSMatthias Ringwald && (hci_event_packet_get_type(packet) == HCI_EVENT_COMMAND_COMPLETE) 272172a2585aSMatthias Ringwald && (hci_event_command_complete_get_command_opcode(packet) == HCI_OPCODE_HCI_WRITE_SCAN_ENABLE)){ 272267c6c9dcSMatthias Ringwald hci_initializing_next_state(); 272367c6c9dcSMatthias Ringwald } 272467c6c9dcSMatthias Ringwald } 272567c6c9dcSMatthias Ringwald 27269866fdc7SMatthias Ringwald #ifdef ENABLE_CLASSIC 27274aa2f135SMatthias Ringwald static void hci_handle_mutual_authentication_completed(hci_connection_t * conn){ 27284aa2f135SMatthias Ringwald // bonding complete if connection is authenticated (either initiated or BR/EDR SC) 27294aa2f135SMatthias Ringwald conn->requested_security_level = LEVEL_0; 27304aa2f135SMatthias Ringwald gap_security_level_t security_level = gap_security_level_for_connection(conn); 27314aa2f135SMatthias Ringwald hci_emit_security_level(conn->con_handle, security_level); 27324aa2f135SMatthias Ringwald 273367718330SMatthias Ringwald // dedicated bonding 2734de9f0299SMatthias Ringwald if ((conn->bonding_flags & BONDING_DEDICATED) != 0){ 2735de9f0299SMatthias Ringwald conn->bonding_flags &= ~BONDING_DEDICATED; 2736de9f0299SMatthias Ringwald conn->bonding_status = security_level == 0 ? ERROR_CODE_INSUFFICIENT_SECURITY : ERROR_CODE_SUCCESS; 2737db3c1f89SMatthias Ringwald #ifdef ENABLE_EXPLICIT_DEDICATED_BONDING_DISCONNECT 2738db3c1f89SMatthias Ringwald // emit dedicated bonding complete, don't disconnect 2739db3c1f89SMatthias Ringwald hci_emit_dedicated_bonding_result(conn->address, conn->bonding_status); 2740db3c1f89SMatthias Ringwald #else 2741db3c1f89SMatthias Ringwald // request disconnect, event is emitted after disconnect 2742db3c1f89SMatthias Ringwald conn->bonding_flags |= BONDING_DISCONNECT_DEDICATED_DONE; 2743db3c1f89SMatthias Ringwald #endif 2744de9f0299SMatthias Ringwald } 274567718330SMatthias Ringwald } 2746abdad579SMatthias Ringwald 274767718330SMatthias Ringwald static void hci_handle_read_encryption_key_size_complete(hci_connection_t * conn, uint8_t encryption_key_size) { 274867718330SMatthias Ringwald conn->authentication_flags |= AUTH_FLAG_CONNECTION_ENCRYPTED; 274967718330SMatthias Ringwald conn->encryption_key_size = encryption_key_size; 275067718330SMatthias Ringwald 275167718330SMatthias Ringwald // mutual authentication complete if authenticated and we have retrieved the encryption key size 27528daf94bcSMatthias Ringwald if ((conn->authentication_flags & AUTH_FLAG_CONNECTION_AUTHENTICATED) != 0) { 27534aa2f135SMatthias Ringwald hci_handle_mutual_authentication_completed(conn); 27544cd03f8aSMatthias Ringwald } else { 27554cd03f8aSMatthias Ringwald // otherwise trigger remote feature request and send authentication request 2756dbe0d85cSMatthias Ringwald hci_trigger_remote_features_for_connection(conn); 27574cd03f8aSMatthias Ringwald if ((conn->bonding_flags & BONDING_SENT_AUTHENTICATE_REQUEST) == 0) { 2758abdad579SMatthias Ringwald conn->bonding_flags |= BONDING_SEND_AUTHENTICATE_REQUEST; 27599866fdc7SMatthias Ringwald } 27604cd03f8aSMatthias Ringwald } 27614cd03f8aSMatthias Ringwald } 27629866fdc7SMatthias Ringwald #endif 27639866fdc7SMatthias Ringwald 27643b631737SMatthias Ringwald static void hci_store_local_supported_commands(const uint8_t * packet){ 276525e46151SMatthias Ringwald // create mapping table 276625e46151SMatthias Ringwald #define X(name, offset, bit) { offset, bit }, 276725e46151SMatthias Ringwald static struct { 276825e46151SMatthias Ringwald uint8_t byte_offset; 276925e46151SMatthias Ringwald uint8_t bit_position; 277025e46151SMatthias Ringwald } supported_hci_commands_map [] = { 277125e46151SMatthias Ringwald SUPPORTED_HCI_COMMANDS 277225e46151SMatthias Ringwald }; 277325e46151SMatthias Ringwald #undef X 277425e46151SMatthias Ringwald 277525e46151SMatthias Ringwald // create names for debug purposes 277625e46151SMatthias Ringwald #ifdef ENABLE_LOG_DEBUG 277725e46151SMatthias Ringwald #define X(name, offset, bit) #name, 277825e46151SMatthias Ringwald static const char * command_names[] = { 277925e46151SMatthias Ringwald SUPPORTED_HCI_COMMANDS 278025e46151SMatthias Ringwald }; 278125e46151SMatthias Ringwald #undef X 278225e46151SMatthias Ringwald #endif 278325e46151SMatthias Ringwald 27841ffa425cSMatthias Ringwald hci_stack->local_supported_commands = 0; 278525e46151SMatthias Ringwald const uint8_t * commands_map = &packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1]; 278625e46151SMatthias Ringwald uint16_t i; 278725e46151SMatthias Ringwald for (i = 0 ; i < SUPPORTED_HCI_COMMANDS_COUNT ; i++){ 278825e46151SMatthias Ringwald if ((commands_map[supported_hci_commands_map[i].byte_offset] & (1 << supported_hci_commands_map[i].bit_position)) != 0){ 278925e46151SMatthias Ringwald #ifdef ENABLE_LOG_DEBUG 279025e46151SMatthias Ringwald log_info("Command %s (%u) supported %u/%u", command_names[i], i, supported_hci_commands_map[i].byte_offset, supported_hci_commands_map[i].bit_position); 279125e46151SMatthias Ringwald #else 27921ffa425cSMatthias Ringwald log_info("Command 0x%02x supported %u/%u", i, supported_hci_commands_map[i].byte_offset, supported_hci_commands_map[i].bit_position); 279325e46151SMatthias Ringwald #endif 27941ffa425cSMatthias Ringwald hci_stack->local_supported_commands |= (1LU << i); 279525e46151SMatthias Ringwald } 279625e46151SMatthias Ringwald } 2797cb7b3e6fSMatthias Ringwald log_info("Local supported commands summary %08" PRIx32, hci_stack->local_supported_commands); 27983b631737SMatthias Ringwald } 27993b631737SMatthias Ringwald 28004f781026SMatthias Ringwald static void handle_command_complete_event(uint8_t * packet, uint16_t size){ 2801b08371a9SMilanka Ringwald UNUSED(size); 2802e76a89eeS[email protected] 28034781fa78SDirk Helbig uint8_t status = 0; 28044781fa78SDirk Helbig if( size > OFFSET_OF_DATA_IN_COMMAND_COMPLETE ) { 28054781fa78SDirk Helbig status = hci_event_command_complete_get_return_parameters(packet)[0]; 28064781fa78SDirk Helbig } 28079cbd2215SMatthias Ringwald uint16_t manufacturer; 28089cbd2215SMatthias Ringwald #ifdef ENABLE_CLASSIC 28091f7b95a1Smatthias.ringwald hci_connection_t * conn; 2810c7a108afSMatthias Ringwald #endif 2811c7a108afSMatthias Ringwald #if defined(ENABLE_CLASSIC) || (defined(ENABLE_BLE) && defined(ENABLE_LE_ISOCHRONOUS_STREAMS)) 28124781fa78SDirk Helbig hci_con_handle_t handle; 28139cbd2215SMatthias Ringwald #endif 2814d3a89d91SMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS 2815d3a89d91SMatthias Ringwald le_audio_cig_t * cig; 2816d3a89d91SMatthias Ringwald #endif 281791036612SMatthias Ringwald #if defined(ENABLE_BLE) && defined(ENABLE_HCI_COMMAND_STATUS_DISCARDED_FOR_FAILED_CONNECTIONS_WORKAROUND) 2818f48a5586SMatthias Ringwald hci_stack->hci_command_con_handle = HCI_CON_HANDLE_INVALID; 2819f48a5586SMatthias Ringwald #endif 2820d3a89d91SMatthias Ringwald 28216bef4003SMatthias Ringwald // get num cmd packets - limit to 1 to reduce complexity 28226bef4003SMatthias Ringwald hci_stack->num_cmd_packets = packet[2] ? 1 : 0; 28237ec5eeaaSmatthias.ringwald 2824645b7c25SMatthias Ringwald uint16_t opcode = hci_event_command_complete_get_command_opcode(packet); 2825645b7c25SMatthias Ringwald switch (opcode){ 2826645b7c25SMatthias Ringwald case HCI_OPCODE_HCI_READ_LOCAL_NAME: 28274781fa78SDirk Helbig if (status) break; 28289e263bd7SMatthias Ringwald // terminate, name 248 chars 28299e263bd7SMatthias Ringwald packet[6+248] = 0; 28309e263bd7SMatthias Ringwald log_info("local name: %s", &packet[6]); 2831645b7c25SMatthias Ringwald break; 2832645b7c25SMatthias Ringwald case HCI_OPCODE_HCI_READ_BUFFER_SIZE: 28331d279b20Smatthias.ringwald // "The HC_ACL_Data_Packet_Length return parameter will be used to determine the size of the L2CAP segments contained in ACL Data Packets" 2834c3b46f5aSMatthias Ringwald if (hci_stack->state == HCI_STATE_INITIALIZING) { 2835429122ccSMatthias Ringwald uint16_t acl_len = little_endian_read_16(packet, 6); 2836429122ccSMatthias Ringwald uint16_t sco_len = packet[8]; 2837429122ccSMatthias Ringwald 2838429122ccSMatthias Ringwald // determine usable ACL/SCO payload size 2839429122ccSMatthias Ringwald hci_stack->acl_data_packet_length = btstack_min(acl_len, HCI_ACL_PAYLOAD_SIZE); 2840429122ccSMatthias Ringwald hci_stack->sco_data_packet_length = btstack_min(sco_len, HCI_ACL_PAYLOAD_SIZE); 2841429122ccSMatthias Ringwald 2842616cfd90SMatthias Ringwald hci_stack->acl_packets_total_num = (uint8_t) btstack_min(little_endian_read_16(packet, 9), MAX_NR_CONTROLLER_ACL_BUFFERS); 2843616cfd90SMatthias Ringwald hci_stack->sco_packets_total_num = (uint8_t) btstack_min(little_endian_read_16(packet, 11), MAX_NR_CONTROLLER_SCO_PACKETS); 2844a8b12447S[email protected] 2845429122ccSMatthias Ringwald log_info("hci_read_buffer_size: ACL size module %u -> used %u, count %u / SCO size %u, count %u", 2846429122ccSMatthias Ringwald acl_len, hci_stack->acl_data_packet_length, hci_stack->acl_packets_total_num, 28471a06f663S[email protected] hci_stack->sco_data_packet_length, hci_stack->sco_packets_total_num); 2848c3b46f5aSMatthias Ringwald } 2849645b7c25SMatthias Ringwald break; 2850645b7c25SMatthias Ringwald case HCI_OPCODE_HCI_READ_RSSI: 28514781fa78SDirk Helbig if (status == ERROR_CODE_SUCCESS){ 2852891b9fc2SMatthias Ringwald uint8_t event[5]; 2853891b9fc2SMatthias Ringwald event[0] = GAP_EVENT_RSSI_MEASUREMENT; 2854891b9fc2SMatthias Ringwald event[1] = 3; 28556535961aSMatthias Ringwald (void)memcpy(&event[2], &packet[6], 3); 2856891b9fc2SMatthias Ringwald hci_emit_event(event, sizeof(event), 1); 2857891b9fc2SMatthias Ringwald } 2858645b7c25SMatthias Ringwald break; 2859a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE 286079b7ea2dSMatthias Ringwald case HCI_OPCODE_HCI_LE_READ_BUFFER_SIZE_V2: 286179b7ea2dSMatthias Ringwald hci_stack->le_iso_packets_length = little_endian_read_16(packet, 9); 286279b7ea2dSMatthias Ringwald hci_stack->le_iso_packets_total_num = packet[11]; 286379b7ea2dSMatthias Ringwald log_info("hci_le_read_buffer_size_v2: iso size %u, iso count %u", 286479b7ea2dSMatthias Ringwald hci_stack->le_iso_packets_length, hci_stack->le_iso_packets_total_num); 286579b7ea2dSMatthias Ringwald 286679b7ea2dSMatthias Ringwald /* fall through */ 286779b7ea2dSMatthias Ringwald 2868645b7c25SMatthias Ringwald case HCI_OPCODE_HCI_LE_READ_BUFFER_SIZE: 2869f8fbdce0SMatthias Ringwald hci_stack->le_data_packets_length = little_endian_read_16(packet, 6); 2870ee303eddS[email protected] hci_stack->le_acl_packets_total_num = packet[8]; 28716c26b087S[email protected] // determine usable ACL payload size 28726c26b087S[email protected] if (HCI_ACL_PAYLOAD_SIZE < hci_stack->le_data_packets_length){ 28736c26b087S[email protected] hci_stack->le_data_packets_length = HCI_ACL_PAYLOAD_SIZE; 28746c26b087S[email protected] } 287579b7ea2dSMatthias Ringwald log_info("hci_le_read_buffer_size: acl size %u, acl count %u", hci_stack->le_data_packets_length, hci_stack->le_acl_packets_total_num); 2876645b7c25SMatthias Ringwald break; 2877b435e062SMatthias Ringwald #endif 2878b435e062SMatthias Ringwald #ifdef ENABLE_LE_DATA_LENGTH_EXTENSION 2879645b7c25SMatthias Ringwald case HCI_OPCODE_HCI_LE_READ_MAXIMUM_DATA_LENGTH: 2880dcd678baSMatthias Ringwald hci_stack->le_supported_max_tx_octets = little_endian_read_16(packet, 6); 2881dcd678baSMatthias Ringwald hci_stack->le_supported_max_tx_time = little_endian_read_16(packet, 8); 2882dcd678baSMatthias Ringwald log_info("hci_le_read_maximum_data_length: tx octets %u, tx time %u us", hci_stack->le_supported_max_tx_octets, hci_stack->le_supported_max_tx_time); 2883645b7c25SMatthias Ringwald break; 2884b435e062SMatthias Ringwald #endif 2885d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 2886645b7c25SMatthias Ringwald case HCI_OPCODE_HCI_LE_READ_WHITE_LIST_SIZE: 2887e691bb38SMatthias Ringwald hci_stack->le_whitelist_capacity = packet[6]; 288815d0a15bSMatthias Ringwald log_info("hci_le_read_white_list_size: size %u", hci_stack->le_whitelist_capacity); 2889645b7c25SMatthias Ringwald break; 289065a46ef3S[email protected] #endif 28913a74541eSMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 28923a74541eSMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 28933a74541eSMatthias Ringwald case HCI_OPCODE_HCI_LE_READ_MAXIMUM_ADVERTISING_DATA_LENGTH: 28943a74541eSMatthias Ringwald hci_stack->le_maximum_advertising_data_length = little_endian_read_16(packet, 6); 28953a74541eSMatthias Ringwald break; 289625df6c61SMatthias Ringwald case HCI_OPCODE_HCI_LE_SET_EXTENDED_ADVERTISING_PARAMETERS: 289725df6c61SMatthias Ringwald if (hci_stack->le_advertising_set_in_current_command != 0) { 289825df6c61SMatthias Ringwald le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(hci_stack->le_advertising_set_in_current_command); 289925df6c61SMatthias Ringwald hci_stack->le_advertising_set_in_current_command = 0; 290025df6c61SMatthias Ringwald if (advertising_set == NULL) break; 290125df6c61SMatthias Ringwald uint8_t adv_status = packet[6]; 290225df6c61SMatthias Ringwald uint8_t tx_power = packet[7]; 290325df6c61SMatthias Ringwald uint8_t event[] = { HCI_EVENT_META_GAP, 4, GAP_SUBEVENT_ADVERTISING_SET_INSTALLED, hci_stack->le_advertising_set_in_current_command, adv_status, tx_power }; 290425df6c61SMatthias Ringwald if (adv_status == 0){ 290525df6c61SMatthias Ringwald advertising_set->state |= LE_ADVERTISEMENT_STATE_PARAMS_SET; 290625df6c61SMatthias Ringwald } 290725df6c61SMatthias Ringwald hci_emit_event(event, sizeof(event), 1); 290825df6c61SMatthias Ringwald } 290925df6c61SMatthias Ringwald break; 291025df6c61SMatthias Ringwald case HCI_OPCODE_HCI_LE_REMOVE_ADVERTISING_SET: 291125df6c61SMatthias Ringwald if (hci_stack->le_advertising_set_in_current_command != 0) { 291225df6c61SMatthias Ringwald le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(hci_stack->le_advertising_set_in_current_command); 291325df6c61SMatthias Ringwald hci_stack->le_advertising_set_in_current_command = 0; 291425df6c61SMatthias Ringwald if (advertising_set == NULL) break; 29154781fa78SDirk Helbig uint8_t event[] = { HCI_EVENT_META_GAP, 3, GAP_SUBEVENT_ADVERTISING_SET_REMOVED, hci_stack->le_advertising_set_in_current_command, status }; 29164781fa78SDirk Helbig if (status == 0){ 291725df6c61SMatthias Ringwald btstack_linked_list_remove(&hci_stack->le_advertising_sets, (btstack_linked_item_t *) advertising_set); 291825df6c61SMatthias Ringwald } 291925df6c61SMatthias Ringwald hci_emit_event(event, sizeof(event), 1); 292025df6c61SMatthias Ringwald } 292125df6c61SMatthias Ringwald break; 29223a74541eSMatthias Ringwald #endif 29233a74541eSMatthias Ringwald #endif 2924645b7c25SMatthias Ringwald case HCI_OPCODE_HCI_READ_BD_ADDR: 2925645b7c25SMatthias Ringwald reverse_bd_addr(&packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE + 1], hci_stack->local_bd_addr); 29264781fa78SDirk Helbig log_info("Local Address, Status: 0x%02x: Addr: %s", status, bd_addr_to_str(hci_stack->local_bd_addr)); 292733373e40SMatthias Ringwald #ifdef ENABLE_CLASSIC 29281624665aSMatthias Ringwald if (hci_stack->link_key_db){ 29291624665aSMatthias Ringwald hci_stack->link_key_db->set_local_bd_addr(hci_stack->local_bd_addr); 29301624665aSMatthias Ringwald } 293133373e40SMatthias Ringwald #endif 2932645b7c25SMatthias Ringwald break; 293335454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 2934645b7c25SMatthias Ringwald case HCI_OPCODE_HCI_WRITE_SCAN_ENABLE: 293571fd255dSMatthias Ringwald hci_emit_scan_mode_changed(hci_stack->discoverable, hci_stack->connectable); 2936645b7c25SMatthias Ringwald break; 29373d1f2d24SMatthias Ringwald case HCI_OPCODE_HCI_PERIODIC_INQUIRY_MODE: 29383d1f2d24SMatthias Ringwald if (status == ERROR_CODE_SUCCESS) { 29393d1f2d24SMatthias Ringwald hci_stack->inquiry_state = GAP_INQUIRY_STATE_PERIODIC; 29403d1f2d24SMatthias Ringwald } else { 29413d1f2d24SMatthias Ringwald hci_stack->inquiry_state = GAP_INQUIRY_STATE_IDLE; 29423d1f2d24SMatthias Ringwald } 29433d1f2d24SMatthias Ringwald break; 2944645b7c25SMatthias Ringwald case HCI_OPCODE_HCI_INQUIRY_CANCEL: 294530199e24SMatthias Ringwald case HCI_OPCODE_HCI_EXIT_PERIODIC_INQUIRY_MODE: 2946f5875de5SMatthias Ringwald if (hci_stack->inquiry_state == GAP_INQUIRY_STATE_W4_CANCELLED){ 2947f5875de5SMatthias Ringwald hci_stack->inquiry_state = GAP_INQUIRY_STATE_IDLE; 2948f5875de5SMatthias Ringwald uint8_t event[] = { GAP_EVENT_INQUIRY_COMPLETE, 1, 0}; 2949f5875de5SMatthias Ringwald hci_emit_event(event, sizeof(event), 1); 2950f5875de5SMatthias Ringwald } 2951645b7c25SMatthias Ringwald break; 295235454696SMatthias Ringwald #endif 2953645b7c25SMatthias Ringwald case HCI_OPCODE_HCI_READ_LOCAL_SUPPORTED_FEATURES: 29544f781026SMatthias Ringwald (void)memcpy(hci_stack->local_supported_features, &packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE + 1], 8); 295565389bfcS[email protected] 295635454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 2957a5a23fc2S[email protected] // determine usable ACL packet types based on host buffer size and supported features 295829e39de4SMatthias Ringwald hci_stack->usable_packet_types_acl = hci_acl_packet_types_for_buffer_size_and_local_features(HCI_ACL_PAYLOAD_SIZE, &hci_stack->local_supported_features[0]); 2959c92ca2c8SMatthias Ringwald log_info("ACL Packet types %04x", hci_stack->usable_packet_types_acl); 2960c92ca2c8SMatthias Ringwald // determine usable SCO packet types based on supported features 2961c92ca2c8SMatthias Ringwald hci_stack->usable_packet_types_sco = hci_sco_packet_types_for_features( 2962c92ca2c8SMatthias Ringwald &hci_stack->local_supported_features[0]); 2963c92ca2c8SMatthias Ringwald log_info("SCO Packet types %04x - eSCO %u", hci_stack->usable_packet_types_sco, hci_extended_sco_link_supported()); 296435454696SMatthias Ringwald #endif 2965f5d8d141S[email protected] // Classic/LE 2966f5d8d141S[email protected] log_info("BR/EDR support %u, LE support %u", hci_classic_supported(), hci_le_supported()); 2967645b7c25SMatthias Ringwald break; 2968645b7c25SMatthias Ringwald case HCI_OPCODE_HCI_READ_LOCAL_VERSION_INFORMATION: 2969645b7c25SMatthias Ringwald manufacturer = little_endian_read_16(packet, 10); 2970547a29a6SMatthias Ringwald // map Cypress & Infineon to Broadcom 2971547a29a6SMatthias Ringwald switch (manufacturer){ 2972547a29a6SMatthias Ringwald case BLUETOOTH_COMPANY_ID_CYPRESS_SEMICONDUCTOR: 2973547a29a6SMatthias Ringwald case BLUETOOTH_COMPANY_ID_INFINEON_TECHNOLOGIES_AG: 2974547a29a6SMatthias Ringwald log_info("Treat Cypress/Infineon as Broadcom"); 2975c21d89f3SMatthias Ringwald manufacturer = BLUETOOTH_COMPANY_ID_BROADCOM_CORPORATION; 2976c21d89f3SMatthias Ringwald little_endian_store_16(packet, 10, manufacturer); 2977547a29a6SMatthias Ringwald break; 2978547a29a6SMatthias Ringwald default: 2979547a29a6SMatthias Ringwald break; 2980c21d89f3SMatthias Ringwald } 2981c21d89f3SMatthias Ringwald hci_stack->manufacturer = manufacturer; 29824696bddbSMatthias Ringwald log_info("Manufacturer: 0x%04x", hci_stack->manufacturer); 2983645b7c25SMatthias Ringwald break; 2984645b7c25SMatthias Ringwald case HCI_OPCODE_HCI_READ_LOCAL_SUPPORTED_COMMANDS: 29853b631737SMatthias Ringwald hci_store_local_supported_commands(packet); 2986645b7c25SMatthias Ringwald break; 2987e8c8828eSMatthias Ringwald #ifdef ENABLE_CLASSIC 2988645b7c25SMatthias Ringwald case HCI_OPCODE_HCI_WRITE_SYNCHRONOUS_FLOW_CONTROL_ENABLE: 29894781fa78SDirk Helbig if (status) return; 29905b9b590fSMatthias Ringwald hci_stack->synchronous_flow_control_enabled = 1; 2991645b7c25SMatthias Ringwald break; 2992645b7c25SMatthias Ringwald case HCI_OPCODE_HCI_READ_ENCRYPTION_KEY_SIZE: 2993573897a0SMatthias Ringwald handle = little_endian_read_16(packet, OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1); 2994573897a0SMatthias Ringwald conn = hci_connection_for_handle(handle); 2995c3b46f5aSMatthias Ringwald if (conn != NULL) { 29969866fdc7SMatthias Ringwald uint8_t key_size = 0; 2997573897a0SMatthias Ringwald if (status == 0){ 29989866fdc7SMatthias Ringwald key_size = packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+3]; 29994a659b0eSMatthias Ringwald log_info("Handle %04x key Size: %u", handle, key_size); 3000170fafaeSMatthias Ringwald } else { 3001e9f98c4aSMatthias Ringwald key_size = 1; 30029866fdc7SMatthias Ringwald log_info("Read Encryption Key Size failed 0x%02x-> assuming insecure connection with key size of 1", status); 3003573897a0SMatthias Ringwald } 30049866fdc7SMatthias Ringwald hci_handle_read_encryption_key_size_complete(conn, key_size); 3005c3b46f5aSMatthias Ringwald } 3006645b7c25SMatthias Ringwald break; 3007cc15bb2cSMatthias Ringwald // assert pairing complete event is emitted. 3008cc15bb2cSMatthias Ringwald // note: for SSP, Simple Pairing Complete Event is sufficient, but we want to be more robust 3009cc15bb2cSMatthias Ringwald case HCI_OPCODE_HCI_PIN_CODE_REQUEST_NEGATIVE_REPLY: 3010cc15bb2cSMatthias Ringwald case HCI_OPCODE_HCI_USER_PASSKEY_REQUEST_NEGATIVE_REPLY: 3011cc15bb2cSMatthias Ringwald case HCI_OPCODE_HCI_USER_CONFIRMATION_REQUEST_NEGATIVE_REPLY: 30128cc1507eSMatthias Ringwald hci_stack->gap_pairing_state = GAP_PAIRING_STATE_IDLE; 3013cc15bb2cSMatthias Ringwald // lookup connection by gap pairing addr 3014cc15bb2cSMatthias Ringwald conn = hci_connection_for_bd_addr_and_type(hci_stack->gap_pairing_addr, BD_ADDR_TYPE_ACL); 3015cc15bb2cSMatthias Ringwald if (conn == NULL) break; 3016cc15bb2cSMatthias Ringwald hci_pairing_complete(conn, ERROR_CODE_AUTHENTICATION_FAILURE); 3017cc15bb2cSMatthias Ringwald break; 3018cc15bb2cSMatthias Ringwald 301975a8e4faSMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB 302075a8e4faSMatthias Ringwald case HCI_OPCODE_HCI_READ_LOCAL_OOB_DATA: 302175a8e4faSMatthias Ringwald case HCI_OPCODE_HCI_READ_LOCAL_EXTENDED_OOB_DATA:{ 302275a8e4faSMatthias Ringwald uint8_t event[67]; 302375a8e4faSMatthias Ringwald event[0] = GAP_EVENT_LOCAL_OOB_DATA; 302475a8e4faSMatthias Ringwald event[1] = 65; 302575a8e4faSMatthias Ringwald (void)memset(&event[2], 0, 65); 30264781fa78SDirk Helbig if (status == ERROR_CODE_SUCCESS){ 302775a8e4faSMatthias Ringwald (void)memcpy(&event[3], &packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1], 32); 302875a8e4faSMatthias Ringwald if (opcode == HCI_OPCODE_HCI_READ_LOCAL_EXTENDED_OOB_DATA){ 302975a8e4faSMatthias Ringwald event[2] = 3; 303075a8e4faSMatthias Ringwald (void)memcpy(&event[35], &packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+33], 32); 303175a8e4faSMatthias Ringwald } else { 303275a8e4faSMatthias Ringwald event[2] = 1; 303375a8e4faSMatthias Ringwald } 303475a8e4faSMatthias Ringwald } 303575a8e4faSMatthias Ringwald hci_emit_event(event, sizeof(event), 0); 303675a8e4faSMatthias Ringwald break; 303775a8e4faSMatthias Ringwald } 30381ae74bf3SMatthias Ringwald 30391ae74bf3SMatthias Ringwald // note: only needed if user does not provide OOB data 30401ae74bf3SMatthias Ringwald case HCI_OPCODE_HCI_REMOTE_OOB_DATA_REQUEST_NEGATIVE_REPLY: 30411ae74bf3SMatthias Ringwald conn = hci_connection_for_handle(hci_stack->classic_oob_con_handle); 30421ae74bf3SMatthias Ringwald hci_stack->classic_oob_con_handle = HCI_CON_HANDLE_INVALID; 30431ae74bf3SMatthias Ringwald if (conn == NULL) break; 30441ae74bf3SMatthias Ringwald hci_pairing_complete(conn, ERROR_CODE_AUTHENTICATION_FAILURE); 30451ae74bf3SMatthias Ringwald break; 3046e8c8828eSMatthias Ringwald #endif 304775a8e4faSMatthias Ringwald #endif 30484ae8623eSMatthias Ringwald #ifdef ENABLE_BLE 30494ae8623eSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS 3050d3a89d91SMatthias Ringwald case HCI_OPCODE_HCI_LE_SET_CIG_PARAMETERS: 3051d3a89d91SMatthias Ringwald // lookup CIG 3052d3a89d91SMatthias Ringwald cig = hci_cig_for_id(hci_stack->iso_active_operation_group_id); 3053d3a89d91SMatthias Ringwald if (cig != NULL){ 3054d3a89d91SMatthias Ringwald uint8_t i = 0; 3055d3a89d91SMatthias Ringwald if (status == ERROR_CODE_SUCCESS){ 3056d3a89d91SMatthias Ringwald // assign CIS handles to pre-allocated CIS 3057d3a89d91SMatthias Ringwald btstack_linked_list_iterator_t it; 3058d3a89d91SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->iso_streams); 3059d3a89d91SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it) && (i < cig->num_cis)) { 3060d3a89d91SMatthias Ringwald hci_iso_stream_t *iso_stream = (hci_iso_stream_t *) btstack_linked_list_iterator_next(&it); 3061d3a89d91SMatthias Ringwald if ((iso_stream->group_id == hci_stack->iso_active_operation_group_id) && 3062d3a89d91SMatthias Ringwald (iso_stream->iso_type == HCI_ISO_TYPE_CIS)){ 3063d3a89d91SMatthias Ringwald hci_con_handle_t cis_handle = little_endian_read_16(packet, OFFSET_OF_DATA_IN_COMMAND_COMPLETE+3+(2*i)); 3064969d876aSMatthias Ringwald iso_stream->cis_handle = cis_handle; 3065d3a89d91SMatthias Ringwald cig->cis_con_handles[i] = cis_handle; 3066d3a89d91SMatthias Ringwald i++; 3067d3a89d91SMatthias Ringwald } 3068d3a89d91SMatthias Ringwald } 3069444e371eSMatthias Ringwald cig->state = LE_AUDIO_CIG_STATE_W4_CIS_REQUEST; 3070d3a89d91SMatthias Ringwald hci_emit_cig_created(cig, status); 3071d3a89d91SMatthias Ringwald } else { 3072d3a89d91SMatthias Ringwald hci_emit_cig_created(cig, status); 3073d3a89d91SMatthias Ringwald btstack_linked_list_remove(&hci_stack->le_audio_cigs, (btstack_linked_item_t *) cig); 3074d3a89d91SMatthias Ringwald } 3075d3a89d91SMatthias Ringwald } 307626b93350SMatthias Ringwald hci_stack->iso_active_operation_type = HCI_ISO_TYPE_INVALID; 3077d3a89d91SMatthias Ringwald break; 30784ae8623eSMatthias Ringwald case HCI_OPCODE_HCI_LE_CREATE_CIS: 30794ae8623eSMatthias Ringwald if (status != ERROR_CODE_SUCCESS){ 3080d75a6bbfSMatthias Ringwald hci_iso_stream_requested_finalize(HCI_ISO_GROUP_ID_INVALID); 30814ae8623eSMatthias Ringwald } 30824ae8623eSMatthias Ringwald break; 308342529435SMatthias Ringwald case HCI_OPCODE_HCI_LE_ACCEPT_CIS_REQUEST: 308442529435SMatthias Ringwald if (status != ERROR_CODE_SUCCESS){ 3085d75a6bbfSMatthias Ringwald hci_iso_stream_requested_finalize(HCI_ISO_GROUP_ID_INVALID); 308642529435SMatthias Ringwald } 308742529435SMatthias Ringwald break; 30887aa35f6aSMatthias Ringwald case HCI_OPCODE_HCI_LE_SETUP_ISO_DATA_PATH: { 30897aa35f6aSMatthias Ringwald // lookup BIG by state 30907aa35f6aSMatthias Ringwald btstack_linked_list_iterator_t it; 30917aa35f6aSMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->le_audio_bigs); 30927aa35f6aSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)) { 30937aa35f6aSMatthias Ringwald le_audio_big_t *big = (le_audio_big_t *) btstack_linked_list_iterator_next(&it); 30947aa35f6aSMatthias Ringwald if (big->state == LE_AUDIO_BIG_STATE_W4_SETUP_ISO_PATH){ 30957aa35f6aSMatthias Ringwald if (status == ERROR_CODE_SUCCESS){ 30967aa35f6aSMatthias Ringwald big->state_vars.next_bis++; 30977aa35f6aSMatthias Ringwald if (big->state_vars.next_bis == big->num_bis){ 30987aa35f6aSMatthias Ringwald big->state = LE_AUDIO_BIG_STATE_ACTIVE; 30997aa35f6aSMatthias Ringwald hci_emit_big_created(big, ERROR_CODE_SUCCESS); 31007aa35f6aSMatthias Ringwald } else { 31017aa35f6aSMatthias Ringwald big->state = LE_AUDIO_BIG_STATE_SETUP_ISO_PATH; 31027aa35f6aSMatthias Ringwald } 31037aa35f6aSMatthias Ringwald } else { 31047aa35f6aSMatthias Ringwald big->state = LE_AUDIO_BIG_STATE_SETUP_ISO_PATHS_FAILED; 31057aa35f6aSMatthias Ringwald big->state_vars.status = status; 31062a6c0f82SMatthias Ringwald } 31072a6c0f82SMatthias Ringwald return; 31082a6c0f82SMatthias Ringwald } 31092a6c0f82SMatthias Ringwald } 31102a6c0f82SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->le_audio_big_syncs); 31112a6c0f82SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)) { 31122a6c0f82SMatthias Ringwald le_audio_big_sync_t *big_sync = (le_audio_big_sync_t *) btstack_linked_list_iterator_next(&it); 31132a6c0f82SMatthias Ringwald if (big_sync->state == LE_AUDIO_BIG_STATE_W4_SETUP_ISO_PATH){ 31142a6c0f82SMatthias Ringwald if (status == ERROR_CODE_SUCCESS){ 31152a6c0f82SMatthias Ringwald big_sync->state_vars.next_bis++; 31162a6c0f82SMatthias Ringwald if (big_sync->state_vars.next_bis == big_sync->num_bis){ 31172a6c0f82SMatthias Ringwald big_sync->state = LE_AUDIO_BIG_STATE_ACTIVE; 31182a6c0f82SMatthias Ringwald hci_emit_big_sync_created(big_sync, ERROR_CODE_SUCCESS); 31192a6c0f82SMatthias Ringwald } else { 31202a6c0f82SMatthias Ringwald big_sync->state = LE_AUDIO_BIG_STATE_SETUP_ISO_PATH; 31212a6c0f82SMatthias Ringwald } 31222a6c0f82SMatthias Ringwald } else { 31232a6c0f82SMatthias Ringwald big_sync->state = LE_AUDIO_BIG_STATE_SETUP_ISO_PATHS_FAILED; 31242a6c0f82SMatthias Ringwald big_sync->state_vars.status = status; 31252a6c0f82SMatthias Ringwald } 31262a6c0f82SMatthias Ringwald return; 31272a6c0f82SMatthias Ringwald } 31282a6c0f82SMatthias Ringwald } 3129f9306a1aSMatthias Ringwald // Lookup CIS via active group operation 3130f9306a1aSMatthias Ringwald if (hci_stack->iso_active_operation_type == HCI_ISO_TYPE_CIS){ 313126b93350SMatthias Ringwald if (hci_stack->iso_active_operation_group_id == HCI_ISO_GROUP_ID_SINGLE_CIS){ 313226b93350SMatthias Ringwald hci_stack->iso_active_operation_type = HCI_ISO_TYPE_INVALID; 313326b93350SMatthias Ringwald 313426b93350SMatthias Ringwald // lookup CIS by state 313526b93350SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->iso_streams); 313626b93350SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 313726b93350SMatthias Ringwald hci_iso_stream_t * iso_stream = (hci_iso_stream_t *) btstack_linked_list_iterator_next(&it); 3138969d876aSMatthias Ringwald handle = iso_stream->cis_handle; 3139532211feSMatthias Ringwald bool emit_cis_created = false; 314026b93350SMatthias Ringwald switch (iso_stream->state){ 314126b93350SMatthias Ringwald case HCI_ISO_STREAM_STATE_W4_ISO_SETUP_INPUT: 314226b93350SMatthias Ringwald if (status != ERROR_CODE_SUCCESS){ 3143532211feSMatthias Ringwald emit_cis_created = true; 314426b93350SMatthias Ringwald break; 314526b93350SMatthias Ringwald } 314626b93350SMatthias Ringwald if (iso_stream->max_sdu_c_to_p > 0){ 31471418332dSMatthias Ringwald iso_stream->state = HCI_ISO_STREAM_STATE_W2_SETUP_ISO_OUTPUT; 314826b93350SMatthias Ringwald } else { 3149532211feSMatthias Ringwald emit_cis_created = true; 315026b93350SMatthias Ringwald } 315126b93350SMatthias Ringwald break; 315226b93350SMatthias Ringwald case HCI_ISO_STREAM_STATE_W4_ISO_SETUP_OUTPUT: 3153532211feSMatthias Ringwald emit_cis_created = true; 315426b93350SMatthias Ringwald break; 315526b93350SMatthias Ringwald default: 315626b93350SMatthias Ringwald break; 315726b93350SMatthias Ringwald } 3158532211feSMatthias Ringwald if (emit_cis_created){ 315914045fdbSMatthias Ringwald hci_cis_handle_created(iso_stream, status); 3160532211feSMatthias Ringwald } 316126b93350SMatthias Ringwald } 316226b93350SMatthias Ringwald } else { 3163f9306a1aSMatthias Ringwald cig = hci_cig_for_id(hci_stack->iso_active_operation_group_id); 3164532211feSMatthias Ringwald hci_stack->iso_active_operation_type = HCI_ISO_TYPE_INVALID; 3165f9306a1aSMatthias Ringwald if (cig != NULL) { 3166f9306a1aSMatthias Ringwald // emit cis created if all ISO Paths have been created 3167f9306a1aSMatthias Ringwald // assume we are central 3168f9306a1aSMatthias Ringwald uint8_t cis_index = cig->state_vars.next_cis >> 1; 3169f9306a1aSMatthias Ringwald uint8_t cis_direction = cig->state_vars.next_cis & 1; 3170f9306a1aSMatthias Ringwald bool outgoing_needed = cig->params->cis_params[cis_index].max_sdu_p_to_c > 0; 3171f9306a1aSMatthias Ringwald // if outgoing has been setup, or incoming was setup but outgoing not required 3172f9306a1aSMatthias Ringwald if ((cis_direction == 1) || (outgoing_needed == false)){ 3173532211feSMatthias Ringwald // lookup iso stream by cig/cis 3174b5ecaedbSMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->iso_streams); 3175532211feSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)) { 3176532211feSMatthias Ringwald hci_iso_stream_t *iso_stream = (hci_iso_stream_t *) btstack_linked_list_iterator_next(&it); 3177532211feSMatthias Ringwald if ((iso_stream->group_id == cig->cig_id) && (iso_stream->stream_id == cis_index)){ 317814045fdbSMatthias Ringwald hci_cis_handle_created(iso_stream, status); 3179532211feSMatthias Ringwald } 3180532211feSMatthias Ringwald } 3181f9306a1aSMatthias Ringwald } 3182f9306a1aSMatthias Ringwald // next state 3183f9306a1aSMatthias Ringwald cig->state_vars.next_cis++; 3184f9306a1aSMatthias Ringwald cig->state = LE_AUDIO_CIG_STATE_SETUP_ISO_PATH; 3185f9306a1aSMatthias Ringwald } 3186f9306a1aSMatthias Ringwald } 318726b93350SMatthias Ringwald } 31882a6c0f82SMatthias Ringwald break; 31892a6c0f82SMatthias Ringwald } 31902a6c0f82SMatthias Ringwald case HCI_OPCODE_HCI_LE_BIG_TERMINATE_SYNC: { 31912a6c0f82SMatthias Ringwald // lookup BIG by state 31922a6c0f82SMatthias Ringwald btstack_linked_list_iterator_t it; 31932a6c0f82SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->le_audio_big_syncs); 31942a6c0f82SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)) { 31952a6c0f82SMatthias Ringwald le_audio_big_sync_t *big_sync = (le_audio_big_sync_t *) btstack_linked_list_iterator_next(&it); 3196d04a9afcSMatthias Ringwald uint8_t big_handle = big_sync->big_handle; 31972a6c0f82SMatthias Ringwald switch (big_sync->state){ 31982a6c0f82SMatthias Ringwald case LE_AUDIO_BIG_STATE_W4_TERMINATED_AFTER_SETUP_FAILED: 3199d04a9afcSMatthias Ringwald btstack_linked_list_iterator_remove(&it); 32002a6c0f82SMatthias Ringwald hci_emit_big_sync_created(big_sync, big_sync->state_vars.status); 3201d04a9afcSMatthias Ringwald return; 32022a6c0f82SMatthias Ringwald default: 3203d04a9afcSMatthias Ringwald btstack_linked_list_iterator_remove(&it); 3204d04a9afcSMatthias Ringwald hci_emit_big_sync_stopped(big_handle); 32057aa35f6aSMatthias Ringwald return; 32067aa35f6aSMatthias Ringwald } 32077aa35f6aSMatthias Ringwald } 32087aa35f6aSMatthias Ringwald break; 32097aa35f6aSMatthias Ringwald } 32104ae8623eSMatthias Ringwald #endif 32114ae8623eSMatthias Ringwald #endif 32126f35bb46SMatthias Ringwald default: 32136f35bb46SMatthias Ringwald break; 32144f781026SMatthias Ringwald } 3215645b7c25SMatthias Ringwald } 32164f781026SMatthias Ringwald 3217afbf1cd7SMatthias Ringwald static void handle_command_status_event(uint8_t * packet, uint16_t size) { 3218afbf1cd7SMatthias Ringwald UNUSED(size); 3219afbf1cd7SMatthias Ringwald 3220afbf1cd7SMatthias Ringwald // get num cmd packets - limit to 1 to reduce complexity 3221afbf1cd7SMatthias Ringwald hci_stack->num_cmd_packets = packet[3] ? 1 : 0; 3222afbf1cd7SMatthias Ringwald 3223c70df5f8SMatthias Ringwald // get opcode and command status 3224c70df5f8SMatthias Ringwald uint16_t opcode = hci_event_command_status_get_command_opcode(packet); 3225c70df5f8SMatthias Ringwald 3226c70df5f8SMatthias Ringwald #if defined(ENABLE_CLASSIC) || defined(ENABLE_LE_CENTRAL) || defined(ENABLE_LE_ISOCHRONOUS_STREAMS) 3227c70df5f8SMatthias Ringwald uint8_t status = hci_event_command_status_get_status(packet); 3228c70df5f8SMatthias Ringwald #endif 3229c70df5f8SMatthias Ringwald 3230c70df5f8SMatthias Ringwald #if defined(ENABLE_CLASSIC) || defined(ENABLE_LE_CENTRAL) 3231c70df5f8SMatthias Ringwald bd_addr_type_t addr_type; 323273bccf35Slouislee91 bd_addr_t addr; 3233c70df5f8SMatthias Ringwald #endif 3234c70df5f8SMatthias Ringwald 323591036612SMatthias Ringwald #if defined(ENABLE_BLE) && defined (ENABLE_HCI_COMMAND_STATUS_DISCARDED_FOR_FAILED_CONNECTIONS_WORKAROUND) 3236f48a5586SMatthias Ringwald hci_stack->hci_command_con_handle = HCI_CON_HANDLE_INVALID; 3237f48a5586SMatthias Ringwald #endif 3238f48a5586SMatthias Ringwald 3239c70df5f8SMatthias Ringwald switch (opcode){ 3240afbf1cd7SMatthias Ringwald #ifdef ENABLE_CLASSIC 3241c70df5f8SMatthias Ringwald case HCI_OPCODE_HCI_CREATE_CONNECTION: 32429071873aSMatthias Ringwald case HCI_OPCODE_HCI_SETUP_SYNCHRONOUS_CONNECTION: 3243c70df5f8SMatthias Ringwald case HCI_OPCODE_HCI_ACCEPT_SYNCHRONOUS_CONNECTION: 3244afbf1cd7SMatthias Ringwald #endif 3245afbf1cd7SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 3246c70df5f8SMatthias Ringwald case HCI_OPCODE_HCI_LE_CREATE_CONNECTION: 3247afbf1cd7SMatthias Ringwald #endif 3248c70df5f8SMatthias Ringwald #if defined(ENABLE_CLASSIC) || defined(ENABLE_LE_CENTRAL) 3249afbf1cd7SMatthias Ringwald addr_type = hci_stack->outgoing_addr_type; 325073bccf35Slouislee91 memcpy(addr, hci_stack->outgoing_addr, 6); 3251afbf1cd7SMatthias Ringwald 3252afbf1cd7SMatthias Ringwald // reset outgoing address info 3253afbf1cd7SMatthias Ringwald memset(hci_stack->outgoing_addr, 0, 6); 3254afbf1cd7SMatthias Ringwald hci_stack->outgoing_addr_type = BD_ADDR_TYPE_UNKNOWN; 3255afbf1cd7SMatthias Ringwald 3256afbf1cd7SMatthias Ringwald // on error 3257afbf1cd7SMatthias Ringwald if (status != ERROR_CODE_SUCCESS){ 3258afbf1cd7SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 3259afbf1cd7SMatthias Ringwald if (hci_is_le_connection_type(addr_type)){ 3260afbf1cd7SMatthias Ringwald hci_stack->le_connecting_state = LE_CONNECTING_IDLE; 3261afbf1cd7SMatthias Ringwald hci_stack->le_connecting_request = LE_CONNECTING_IDLE; 3262afbf1cd7SMatthias Ringwald } 3263afbf1cd7SMatthias Ringwald #endif 3264afbf1cd7SMatthias Ringwald // error => outgoing connection failed 326573bccf35Slouislee91 hci_connection_t * conn = hci_connection_for_bd_addr_and_type(addr, addr_type); 3266afbf1cd7SMatthias Ringwald if (conn != NULL){ 3267afbf1cd7SMatthias Ringwald hci_handle_connection_failed(conn, status); 3268afbf1cd7SMatthias Ringwald } 3269afbf1cd7SMatthias Ringwald } 3270c70df5f8SMatthias Ringwald break; 3271c70df5f8SMatthias Ringwald #endif 3272afbf1cd7SMatthias Ringwald #ifdef ENABLE_CLASSIC 3273c70df5f8SMatthias Ringwald case HCI_OPCODE_HCI_INQUIRY: 3274afbf1cd7SMatthias Ringwald if (status == ERROR_CODE_SUCCESS) { 3275afbf1cd7SMatthias Ringwald hci_stack->inquiry_state = GAP_INQUIRY_STATE_ACTIVE; 3276afbf1cd7SMatthias Ringwald } else { 3277afbf1cd7SMatthias Ringwald hci_stack->inquiry_state = GAP_INQUIRY_STATE_IDLE; 3278afbf1cd7SMatthias Ringwald } 3279c70df5f8SMatthias Ringwald break; 3280c70df5f8SMatthias Ringwald #endif 3281afbf1cd7SMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS 3282c70df5f8SMatthias Ringwald case HCI_OPCODE_HCI_LE_CREATE_CIS: 3283c70df5f8SMatthias Ringwald case HCI_OPCODE_HCI_LE_ACCEPT_CIS_REQUEST: 3284afbf1cd7SMatthias Ringwald if (status == ERROR_CODE_SUCCESS){ 3285d75a6bbfSMatthias Ringwald hci_iso_stream_requested_confirm(HCI_ISO_GROUP_ID_INVALID); 3286afbf1cd7SMatthias Ringwald } else { 3287d75a6bbfSMatthias Ringwald hci_iso_stream_requested_finalize(HCI_ISO_GROUP_ID_INVALID); 3288afbf1cd7SMatthias Ringwald } 3289c70df5f8SMatthias Ringwald break; 3290afbf1cd7SMatthias Ringwald #endif /* ENABLE_LE_ISOCHRONOUS_STREAMS */ 3291c70df5f8SMatthias Ringwald default: 3292c70df5f8SMatthias Ringwald break; 3293c70df5f8SMatthias Ringwald } 3294afbf1cd7SMatthias Ringwald } 3295afbf1cd7SMatthias Ringwald 32960ce3f217SMatthias Ringwald #ifdef ENABLE_BLE 3297e4def797SMatthias Ringwald static void hci_create_gap_connection_complete_event(const uint8_t * hci_event, uint8_t * gap_event) { 3298e4def797SMatthias Ringwald gap_event[0] = HCI_EVENT_META_GAP; 3299e4def797SMatthias Ringwald gap_event[1] = 36 - 2; 3300e4def797SMatthias Ringwald gap_event[2] = GAP_SUBEVENT_LE_CONNECTION_COMPLETE; 3301bede2a55SMatthias Ringwald switch (hci_event_le_meta_get_subevent_code(hci_event)){ 3302a9212437SMatthias Ringwald case HCI_SUBEVENT_LE_CONNECTION_COMPLETE: 3303e4def797SMatthias Ringwald memcpy(&gap_event[3], &hci_event[3], 11); 3304e4def797SMatthias Ringwald memset(&gap_event[14], 0, 12); 3305e4def797SMatthias Ringwald memcpy(&gap_event[26], &hci_event[14], 7); 3306e4def797SMatthias Ringwald memset(&gap_event[33], 0xff, 3); 3307a9212437SMatthias Ringwald break; 3308a9212437SMatthias Ringwald case HCI_SUBEVENT_LE_ENHANCED_CONNECTION_COMPLETE_V1: 3309e4def797SMatthias Ringwald memcpy(&gap_event[3], &hci_event[3], 30); 3310e4def797SMatthias Ringwald memset(&gap_event[33], 0xff, 3); 3311a9212437SMatthias Ringwald break; 3312a9212437SMatthias Ringwald case HCI_SUBEVENT_LE_ENHANCED_CONNECTION_COMPLETE_V2: 3313e4def797SMatthias Ringwald memcpy(&gap_event[3], &hci_event[3], 33); 3314a9212437SMatthias Ringwald break; 3315a9212437SMatthias Ringwald default: 3316a9212437SMatthias Ringwald btstack_unreachable(); 3317a9212437SMatthias Ringwald break; 3318a9212437SMatthias Ringwald } 3319a9212437SMatthias Ringwald } 3320a9212437SMatthias Ringwald 3321688bcdb4SMatthias Ringwald static void hci_handle_le_connection_complete_event(const uint8_t * hci_event){ 33220ce3f217SMatthias Ringwald bd_addr_t addr; 33230ce3f217SMatthias Ringwald bd_addr_type_t addr_type; 33240ce3f217SMatthias Ringwald hci_connection_t * conn; 33250ce3f217SMatthias Ringwald 332698e0165dSMatthias Ringwald // create GAP_SUBEVENT_LE_CONNECTION_COMPLETE 3327a9212437SMatthias Ringwald uint8_t gap_event[36]; 3328a9212437SMatthias Ringwald hci_create_gap_connection_complete_event(hci_event, gap_event); 332960fb273dSMatthias Ringwald 333098e0165dSMatthias Ringwald // read fields 3331a9212437SMatthias Ringwald uint8_t status = gap_subevent_le_connection_complete_get_status(gap_event); 3332a9212437SMatthias Ringwald hci_role_t role = (hci_role_t) gap_subevent_le_connection_complete_get_role(gap_event); 3333a9212437SMatthias Ringwald uint16_t conn_interval = gap_subevent_le_connection_complete_get_conn_interval(gap_event); 333498e0165dSMatthias Ringwald 33350ce3f217SMatthias Ringwald // Connection management 3336a9212437SMatthias Ringwald gap_subevent_le_connection_complete_get_peer_address(gap_event, addr); 3337a9212437SMatthias Ringwald addr_type = (bd_addr_type_t) gap_subevent_le_connection_complete_get_peer_address_type(gap_event); 333860fb273dSMatthias Ringwald log_info("LE Connection_complete (status=%u) type %u, %s", status, addr_type, bd_addr_to_str(addr)); 33390ce3f217SMatthias Ringwald conn = hci_connection_for_bd_addr_and_type(addr, addr_type); 33400ce3f217SMatthias Ringwald 33410ce3f217SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 33420ce3f217SMatthias Ringwald // handle error: error is reported only to the initiator -> outgoing connection 334360fb273dSMatthias Ringwald if (status){ 33440ce3f217SMatthias Ringwald 33450ce3f217SMatthias Ringwald // handle cancelled outgoing connection 33460ce3f217SMatthias Ringwald // "If the cancellation was successful then, after the Command Complete event for the LE_Create_Connection_Cancel command, 33470ce3f217SMatthias Ringwald // either an LE Connection Complete or an LE Enhanced Connection Complete event shall be generated. 33480ce3f217SMatthias Ringwald // In either case, the event shall be sent with the error code Unknown Connection Identifier (0x02)." 334960fb273dSMatthias Ringwald if (status == ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER){ 33501f468175SMatthias Ringwald // reset state 33510ce3f217SMatthias Ringwald hci_stack->le_connecting_state = LE_CONNECTING_IDLE; 33520ce3f217SMatthias Ringwald // get outgoing connection conn struct for direct connect 33539fd274a1SMatthias Ringwald if (hci_stack->le_connecting_request == LE_CONNECTING_DIRECT){ 3354ca0d6e5aSMatthias Ringwald conn = gap_get_outgoing_le_connection(); 33559fd274a1SMatthias Ringwald conn->state = SEND_CREATE_CONNECTION; 33569fd274a1SMatthias Ringwald } 33570ce3f217SMatthias Ringwald } 33580ce3f217SMatthias Ringwald 3359c1281a25SMatthias Ringwald // free connection if cancelled by user (request == IDLE) 3360c1281a25SMatthias Ringwald if ((conn != NULL) && (hci_stack->le_connecting_request == LE_CONNECTING_IDLE)){ 33610ce3f217SMatthias Ringwald // remove entry 33620ce3f217SMatthias Ringwald btstack_linked_list_remove(&hci_stack->connections, (btstack_linked_item_t *) conn); 33630ce3f217SMatthias Ringwald btstack_memory_hci_connection_free( conn ); 33640ce3f217SMatthias Ringwald } 3365*4dbe0476SMatthias Ringwald 3366*4dbe0476SMatthias Ringwald // emit GAP_SUBEVENT_LE_CONNECTION_COMPLETE for error case 3367*4dbe0476SMatthias Ringwald hci_emit_event(gap_event, sizeof(gap_event), 1); 33680ce3f217SMatthias Ringwald return; 33690ce3f217SMatthias Ringwald } 33700ce3f217SMatthias Ringwald #endif 33710ce3f217SMatthias Ringwald 33720ce3f217SMatthias Ringwald // on success, both hosts receive connection complete event 337360fb273dSMatthias Ringwald if (role == HCI_ROLE_MASTER){ 33740ce3f217SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 33755bb205a5SMatthias Ringwald // if we're master, it was an outgoing connection 33760ce3f217SMatthias Ringwald // note: no hci_connection_t object exists yet for connect with whitelist 33775bb205a5SMatthias Ringwald 337858babb64SMatthias Ringwald // if a identity addresses was used without enhanced connection complete event, 337958babb64SMatthias Ringwald // the connection complete event contains the current random address of the peer device. 338058babb64SMatthias Ringwald // This random address is needed in the case of a re-pairing 338158babb64SMatthias Ringwald if (hci_event_le_meta_get_subevent_code(hci_event) == HCI_SUBEVENT_LE_CONNECTION_COMPLETE){ 33825bb205a5SMatthias Ringwald conn = gap_get_outgoing_le_connection(); 338358babb64SMatthias Ringwald // if outgoing connection object is available, check if identity address was used. 338458babb64SMatthias Ringwald // if yes, track resolved random address and provide rpa 33855bb205a5SMatthias Ringwald // note: we don't update hci le subevent connection complete 33865bb205a5SMatthias Ringwald if (conn != NULL){ 338758babb64SMatthias Ringwald if (hci_is_le_identity_address_type(conn->address_type)){ 338858babb64SMatthias Ringwald memcpy(&gap_event[20], &gap_event[8], 6); 33895bb205a5SMatthias Ringwald gap_event[7] = conn->address_type; 33905bb205a5SMatthias Ringwald reverse_bd_addr(conn->address, &gap_event[8]); 33915bb205a5SMatthias Ringwald } 339258babb64SMatthias Ringwald } 339358babb64SMatthias Ringwald } 33945bb205a5SMatthias Ringwald 33955bb205a5SMatthias Ringwald // we're done with it 33960ce3f217SMatthias Ringwald hci_stack->le_connecting_state = LE_CONNECTING_IDLE; 33970ce3f217SMatthias Ringwald hci_stack->le_connecting_request = LE_CONNECTING_IDLE; 33980ce3f217SMatthias Ringwald #endif 33990ce3f217SMatthias Ringwald } else { 34000ce3f217SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 34010ce3f217SMatthias Ringwald // if we're slave, it was an incoming connection, advertisements have stopped 3402935aa76eSMatthias Ringwald hci_stack->le_advertisements_state &= ~LE_ADVERTISEMENT_STATE_ACTIVE; 34030ce3f217SMatthias Ringwald #endif 34040ce3f217SMatthias Ringwald } 34050ce3f217SMatthias Ringwald 34060ce3f217SMatthias Ringwald // LE connections are auto-accepted, so just create a connection if there isn't one already 34070ce3f217SMatthias Ringwald if (!conn){ 340888f925b1SMatthias Ringwald conn = create_connection_for_bd_addr_and_type(addr, addr_type, role); 34090ce3f217SMatthias Ringwald } 34100ce3f217SMatthias Ringwald 34110ce3f217SMatthias Ringwald // no memory, sorry. 34120ce3f217SMatthias Ringwald if (!conn){ 34130ce3f217SMatthias Ringwald return; 34140ce3f217SMatthias Ringwald } 34150ce3f217SMatthias Ringwald 34160ce3f217SMatthias Ringwald conn->state = OPEN; 3417a9212437SMatthias Ringwald conn->con_handle = gap_subevent_le_connection_complete_get_connection_handle(gap_event); 341860fb273dSMatthias Ringwald conn->le_connection_interval = conn_interval; 34190ce3f217SMatthias Ringwald 34204639b1e4SMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS 3421ac0f6b83SMatthias Ringwald // workaround: PAST doesn't work without LE Read Remote Features on PacketCraft Controller with LMP 568B 34224639b1e4SMatthias Ringwald if (hci_command_supported(SUPPORTED_HCI_COMMAND_LE_READ_REMOTE_FEATURES)){ 3423ac0f6b83SMatthias Ringwald conn->gap_connection_tasks = GAP_CONNECTION_TASK_LE_READ_REMOTE_FEATURES; 34244639b1e4SMatthias Ringwald } 34254639b1e4SMatthias Ringwald #endif 3426ac0f6b83SMatthias Ringwald 34270ce3f217SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 342860fb273dSMatthias Ringwald if (role == HCI_ROLE_SLAVE){ 34290ce3f217SMatthias Ringwald hci_update_advertisements_enabled_for_current_roles(); 34300ce3f217SMatthias Ringwald } 34310ce3f217SMatthias Ringwald #endif 34320ce3f217SMatthias Ringwald 3433dde9ff1eSMatthias Ringwald // init unenhanced att bearer mtu 3434dde9ff1eSMatthias Ringwald conn->att_connection.mtu = ATT_DEFAULT_MTU; 3435dde9ff1eSMatthias Ringwald conn->att_connection.mtu_exchanged = false; 3436dde9ff1eSMatthias Ringwald 34370ce3f217SMatthias Ringwald // TODO: store - role, peer address type, conn_interval, conn_latency, supervision timeout, master clock 34380ce3f217SMatthias Ringwald 34390ce3f217SMatthias Ringwald // restart timer 34400ce3f217SMatthias Ringwald // btstack_run_loop_set_timer(&conn->timeout, HCI_CONNECTION_TIMEOUT_MS); 34410ce3f217SMatthias Ringwald // btstack_run_loop_add_timer(&conn->timeout); 34420ce3f217SMatthias Ringwald 34430ce3f217SMatthias Ringwald log_info("New connection: handle %u, %s", conn->con_handle, bd_addr_to_str(conn->address)); 34440ce3f217SMatthias Ringwald 344598e0165dSMatthias Ringwald // emit GAP_SUBEVENT_LE_CONNECTION_COMPLETE 3446a9212437SMatthias Ringwald hci_emit_event(gap_event, sizeof(gap_event), 1); 344798e0165dSMatthias Ringwald 344898e0165dSMatthias Ringwald // emit BTSTACK_EVENT_NR_CONNECTIONS_CHANGED; 34490ce3f217SMatthias Ringwald hci_emit_nr_connections_changed(); 34500ce3f217SMatthias Ringwald } 34510ce3f217SMatthias Ringwald #endif 34520ce3f217SMatthias Ringwald 345317c6fe5cSMatthias Ringwald #ifdef ENABLE_CLASSIC 345417c6fe5cSMatthias Ringwald static bool hci_ssp_security_level_possible_for_io_cap(gap_security_level_t level, uint8_t io_cap_local, uint8_t io_cap_remote){ 345517c6fe5cSMatthias Ringwald if (io_cap_local == SSP_IO_CAPABILITY_UNKNOWN) return false; 345617c6fe5cSMatthias Ringwald // LEVEL_4 is tested by l2cap 34579a8f78c1SMatthias Ringwald // LEVEL 3 requires MITM protection -> check io capabilities if Authenticated is possible 34589a8f78c1SMatthias Ringwald // @see: Core Spec v5.3, Vol 3, Part C, Table 5.7 345917c6fe5cSMatthias Ringwald if (level >= LEVEL_3){ 34609a8f78c1SMatthias Ringwald // MITM not possible without keyboard or display 346117c6fe5cSMatthias Ringwald if (io_cap_remote >= SSP_IO_CAPABILITY_NO_INPUT_NO_OUTPUT) return false; 346217c6fe5cSMatthias Ringwald if (io_cap_local >= SSP_IO_CAPABILITY_NO_INPUT_NO_OUTPUT) return false; 34639a8f78c1SMatthias Ringwald 34649a8f78c1SMatthias Ringwald // MITM possible if one side has keyboard and the other has keyboard or display 34659a8f78c1SMatthias Ringwald if (io_cap_remote == SSP_IO_CAPABILITY_KEYBOARD_ONLY) return true; 34669a8f78c1SMatthias Ringwald if (io_cap_local == SSP_IO_CAPABILITY_KEYBOARD_ONLY) return true; 34679a8f78c1SMatthias Ringwald 34689a8f78c1SMatthias Ringwald // MITM not possible if one side has only display and other side has no keyboard 34699a8f78c1SMatthias Ringwald if (io_cap_remote == SSP_IO_CAPABILITY_DISPLAY_ONLY) return false; 34709a8f78c1SMatthias Ringwald if (io_cap_local == SSP_IO_CAPABILITY_DISPLAY_ONLY) return false; 347117c6fe5cSMatthias Ringwald } 347217c6fe5cSMatthias Ringwald // LEVEL 2 requires SSP, which is a given 347317c6fe5cSMatthias Ringwald return true; 347417c6fe5cSMatthias Ringwald } 34753817f9dfSMatthias Ringwald 3476b3c4163bSMatthias Ringwald static void hci_ssp_assess_security_on_io_cap_request(hci_connection_t * conn){ 34772dd8985bSMatthias Ringwald // get requested security level 34782dd8985bSMatthias Ringwald gap_security_level_t requested_security_level = conn->requested_security_level; 34792dd8985bSMatthias Ringwald if (hci_stack->gap_secure_connections_only_mode){ 34802dd8985bSMatthias Ringwald requested_security_level = LEVEL_4; 34812dd8985bSMatthias Ringwald } 34822dd8985bSMatthias Ringwald 3483b3c4163bSMatthias Ringwald // assess security: LEVEL 4 requires SC 34842dd8985bSMatthias Ringwald // skip this preliminary test if remote features are not available yet to work around potential issue in ESP32 controller 34852dd8985bSMatthias Ringwald if ((requested_security_level == LEVEL_4) && 34862dd8985bSMatthias Ringwald ((conn->bonding_flags & BONDING_RECEIVED_REMOTE_FEATURES) != 0) && 34872dd8985bSMatthias Ringwald !hci_remote_sc_enabled(conn)){ 3488b3c4163bSMatthias Ringwald log_info("Level 4 required, but SC not supported -> abort"); 3489b3c4163bSMatthias Ringwald hci_pairing_complete(conn, ERROR_CODE_INSUFFICIENT_SECURITY); 3490b3c4163bSMatthias Ringwald connectionSetAuthenticationFlags(conn, AUTH_FLAG_SEND_IO_CAPABILITIES_NEGATIVE_REPLY); 3491b3c4163bSMatthias Ringwald return; 3492b3c4163bSMatthias Ringwald } 3493b3c4163bSMatthias Ringwald 3494c2414c00SMatthias Ringwald // assess bonding requirements: abort if remote in dedicated bonding mode but we are non-bonding 3495c2414c00SMatthias Ringwald // - GAP/MOD/NBON/BV-02-C 3496c2414c00SMatthias Ringwald // - GAP/DM/NBON/BV-01-C 3497c2414c00SMatthias Ringwald if (conn->authentication_flags & AUTH_FLAG_RECV_IO_CAPABILITIES_RESPONSE){ 3498c2414c00SMatthias Ringwald switch (conn->io_cap_response_auth_req){ 3499c2414c00SMatthias Ringwald case SSP_IO_AUTHREQ_MITM_PROTECTION_NOT_REQUIRED_DEDICATED_BONDING: 3500c2414c00SMatthias Ringwald case SSP_IO_AUTHREQ_MITM_PROTECTION_REQUIRED_DEDICATED_BONDING: 3501c2414c00SMatthias Ringwald if (hci_stack->bondable == false){ 3502c2414c00SMatthias Ringwald log_info("Dedicated vs. non-bondable -> abort"); 3503c2414c00SMatthias Ringwald hci_pairing_complete(conn, ERROR_CODE_INSUFFICIENT_SECURITY); 3504c2414c00SMatthias Ringwald connectionSetAuthenticationFlags(conn, AUTH_FLAG_SEND_IO_CAPABILITIES_NEGATIVE_REPLY); 3505c2414c00SMatthias Ringwald return; 3506c2414c00SMatthias Ringwald } 3507c2414c00SMatthias Ringwald default: 3508c2414c00SMatthias Ringwald break; 3509c2414c00SMatthias Ringwald } 3510c2414c00SMatthias Ringwald } 3511c2414c00SMatthias Ringwald 3512b3c4163bSMatthias Ringwald // assess security based on io capabilities 3513b3c4163bSMatthias Ringwald if (conn->authentication_flags & AUTH_FLAG_RECV_IO_CAPABILITIES_RESPONSE){ 3514b3c4163bSMatthias Ringwald // responder: fully validate io caps of both sides as well as OOB data 3515b3c4163bSMatthias Ringwald bool security_possible = false; 3516b3c4163bSMatthias Ringwald security_possible = hci_ssp_security_level_possible_for_io_cap(requested_security_level, hci_stack->ssp_io_capability, conn->io_cap_response_io); 3517b3c4163bSMatthias Ringwald 3518b3c4163bSMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB 3519b3c4163bSMatthias Ringwald // We assume that both Controller can reach LEVEL 4, if one side has received P-192 and the other has received P-256, 3520b3c4163bSMatthias Ringwald // so we merge the OOB data availability 3521b3c4163bSMatthias Ringwald uint8_t have_oob_data = conn->io_cap_response_oob_data; 3522b3c4163bSMatthias Ringwald if (conn->classic_oob_c_192 != NULL){ 3523b3c4163bSMatthias Ringwald have_oob_data |= 1; 3524b3c4163bSMatthias Ringwald } 3525b3c4163bSMatthias Ringwald if (conn->classic_oob_c_256 != NULL){ 3526b3c4163bSMatthias Ringwald have_oob_data |= 2; 3527b3c4163bSMatthias Ringwald } 3528b3c4163bSMatthias Ringwald // for up to Level 3, either P-192 as well as P-256 will do 3529b3c4163bSMatthias Ringwald // if we don't support SC, then a) conn->classic_oob_c_256 will be NULL and b) remote should not report P-256 available 3530b3c4163bSMatthias Ringwald // if remote does not SC, we should not receive P-256 data either 3531b3c4163bSMatthias Ringwald if ((requested_security_level <= LEVEL_3) && (have_oob_data != 0)){ 3532b3c4163bSMatthias Ringwald security_possible = true; 3533b3c4163bSMatthias Ringwald } 3534b3c4163bSMatthias Ringwald // for Level 4, P-256 is needed 3535b3c4163bSMatthias Ringwald if ((requested_security_level == LEVEL_4 && ((have_oob_data & 2) != 0))){ 3536b3c4163bSMatthias Ringwald security_possible = true; 3537b3c4163bSMatthias Ringwald } 3538b3c4163bSMatthias Ringwald #endif 3539b3c4163bSMatthias Ringwald 3540b3c4163bSMatthias Ringwald if (security_possible == false){ 35412dd8985bSMatthias Ringwald log_info("IOCap/OOB insufficient for level %u -> abort", requested_security_level); 3542b3c4163bSMatthias Ringwald hci_pairing_complete(conn, ERROR_CODE_INSUFFICIENT_SECURITY); 3543b3c4163bSMatthias Ringwald connectionSetAuthenticationFlags(conn, AUTH_FLAG_SEND_IO_CAPABILITIES_NEGATIVE_REPLY); 3544b3c4163bSMatthias Ringwald return; 3545b3c4163bSMatthias Ringwald } 3546b3c4163bSMatthias Ringwald } else { 3547b3c4163bSMatthias Ringwald // initiator: remote io cap not yet, only check if we have ability for MITM protection if requested and OOB is not supported 35481fe968f5SMatthias Ringwald #ifndef ENABLE_CLASSIC_PAIRING_OOB 35491fe968f5SMatthias Ringwald #ifndef ENABLE_EXPLICIT_IO_CAPABILITIES_REPLY 3550b3c4163bSMatthias Ringwald if ((conn->requested_security_level >= LEVEL_3) && (hci_stack->ssp_io_capability >= SSP_IO_CAPABILITY_NO_INPUT_NO_OUTPUT)){ 3551b3c4163bSMatthias Ringwald log_info("Level 3+ required, but no input/output -> abort"); 3552b3c4163bSMatthias Ringwald hci_pairing_complete(conn, ERROR_CODE_INSUFFICIENT_SECURITY); 3553b3c4163bSMatthias Ringwald connectionSetAuthenticationFlags(conn, AUTH_FLAG_SEND_IO_CAPABILITIES_NEGATIVE_REPLY); 3554b3c4163bSMatthias Ringwald return; 3555b3c4163bSMatthias Ringwald } 3556b3c4163bSMatthias Ringwald #endif 35571fe968f5SMatthias Ringwald #endif 3558b3c4163bSMatthias Ringwald } 3559b3c4163bSMatthias Ringwald 3560b3c4163bSMatthias Ringwald #ifndef ENABLE_EXPLICIT_IO_CAPABILITIES_REPLY 3561b3c4163bSMatthias Ringwald if (hci_stack->ssp_io_capability != SSP_IO_CAPABILITY_UNKNOWN){ 3562b3c4163bSMatthias Ringwald connectionSetAuthenticationFlags(conn, AUTH_FLAG_SEND_IO_CAPABILITIES_REPLY); 3563b3c4163bSMatthias Ringwald } else { 3564b3c4163bSMatthias Ringwald connectionSetAuthenticationFlags(conn, AUTH_FLAG_SEND_IO_CAPABILITIES_NEGATIVE_REPLY); 3565b3c4163bSMatthias Ringwald } 3566b3c4163bSMatthias Ringwald #endif 3567b3c4163bSMatthias Ringwald } 3568b3c4163bSMatthias Ringwald 356917c6fe5cSMatthias Ringwald #endif 357017c6fe5cSMatthias Ringwald 3571c3b46f5aSMatthias Ringwald static void event_handler(uint8_t *packet, uint16_t size){ 35724f781026SMatthias Ringwald 35734f781026SMatthias Ringwald uint16_t event_length = packet[1]; 35744f781026SMatthias Ringwald 35754f781026SMatthias Ringwald // assert packet is complete 35764ea43905SMatthias Ringwald if (size != (event_length + 2u)){ 35774f781026SMatthias Ringwald log_error("event_handler called with packet of wrong size %d, expected %u => dropping packet", size, event_length + 2); 35784f781026SMatthias Ringwald return; 35794f781026SMatthias Ringwald } 35804f781026SMatthias Ringwald 35814f781026SMatthias Ringwald hci_con_handle_t handle; 35824f781026SMatthias Ringwald hci_connection_t * conn; 35834f781026SMatthias Ringwald int i; 35844f781026SMatthias Ringwald 35854f781026SMatthias Ringwald #ifdef ENABLE_CLASSIC 35865e91d96cSMatthias Ringwald hci_link_type_t link_type; 358748f33f37SMatthias Ringwald bd_addr_t addr; 3588cef94710SMatthias Ringwald bd_addr_type_t addr_type; 35894f781026SMatthias Ringwald #endif 35904ae8623eSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS 35914ae8623eSMatthias Ringwald hci_iso_stream_t * iso_stream; 35927aa35f6aSMatthias Ringwald le_audio_big_t * big; 35932a6c0f82SMatthias Ringwald le_audio_big_sync_t * big_sync; 35944ae8623eSMatthias Ringwald #endif 359589254d99SMatthias Ringwald #if defined(ENABLE_LE_ISOCHRONOUS_STREAMS) || defined(ENABLE_LE_EXTENDED_ADVERTISING) 359689254d99SMatthias Ringwald btstack_linked_list_iterator_t it; 359789254d99SMatthias Ringwald #endif 359889254d99SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 359989254d99SMatthias Ringwald uint8_t advertising_handle; 360089254d99SMatthias Ringwald #endif 36014f781026SMatthias Ringwald 36024f781026SMatthias Ringwald // log_info("HCI:EVENT:%02x", hci_event_packet_get_type(packet)); 36034f781026SMatthias Ringwald 36044f781026SMatthias Ringwald switch (hci_event_packet_get_type(packet)) { 36054f781026SMatthias Ringwald 36064f781026SMatthias Ringwald case HCI_EVENT_COMMAND_COMPLETE: 36074f781026SMatthias Ringwald handle_command_complete_event(packet, size); 360856cf178bSmatthias.ringwald break; 360956cf178bSmatthias.ringwald 36107ec5eeaaSmatthias.ringwald case HCI_EVENT_COMMAND_STATUS: 3611afbf1cd7SMatthias Ringwald handle_command_status_event(packet, size); 36127ec5eeaaSmatthias.ringwald break; 36137ec5eeaaSmatthias.ringwald 36142e440c8aS[email protected] case HCI_EVENT_NUMBER_OF_COMPLETED_PACKETS:{ 36159784dac1SMatthias Ringwald if (size < 3) return; 36169784dac1SMatthias Ringwald uint16_t num_handles = packet[2]; 36174ea43905SMatthias Ringwald if (size != (3u + num_handles * 4u)) return; 3618d9a1d8edSMatthias Ringwald #ifdef ENABLE_CLASSIC 3619d9a1d8edSMatthias Ringwald bool notify_sco = false; 3620d9a1d8edSMatthias Ringwald #endif 3621d9a1d8edSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS 3622d9a1d8edSMatthias Ringwald bool notify_iso = false; 3623d9a1d8edSMatthias Ringwald #endif 36249784dac1SMatthias Ringwald uint16_t offset = 3; 36259784dac1SMatthias Ringwald for (i=0; i<num_handles;i++){ 36264ea43905SMatthias Ringwald handle = little_endian_read_16(packet, offset) & 0x0fffu; 36274ea43905SMatthias Ringwald offset += 2u; 3628f8fbdce0SMatthias Ringwald uint16_t num_packets = little_endian_read_16(packet, offset); 36294ea43905SMatthias Ringwald offset += 2u; 36302e440c8aS[email protected] 36315061f3afS[email protected] conn = hci_connection_for_handle(handle); 3632e5413aa0SMatthias Ringwald if (conn != NULL) { 363323bed257S[email protected] 3634ce41473eSMatthias Ringwald if (conn->num_packets_sent >= num_packets) { 3635ce41473eSMatthias Ringwald conn->num_packets_sent -= num_packets; 3636e35edcc1S[email protected] } else { 3637ce41473eSMatthias Ringwald log_error("hci_number_completed_packets, more packet slots freed then sent."); 3638ce41473eSMatthias Ringwald conn->num_packets_sent = 0; 3639e35edcc1S[email protected] } 3640ce41473eSMatthias Ringwald // log_info("hci_number_completed_packet %u processed for handle %u, outstanding %u", num_packets, handle, conn->num_packets_sent); 3641d9a1d8edSMatthias Ringwald #ifdef ENABLE_CLASSIC 3642d9a1d8edSMatthias Ringwald if (conn->address_type == BD_ADDR_TYPE_SCO){ 3643d9a1d8edSMatthias Ringwald notify_sco = true; 3644d9a1d8edSMatthias Ringwald } 3645d9a1d8edSMatthias Ringwald #endif 3646e5413aa0SMatthias Ringwald } 3647e5413aa0SMatthias Ringwald 36488ad9cf99SMatthias Ringwald #ifdef ENABLE_CONTROLLER_DUMP_PACKETS 36498ad9cf99SMatthias Ringwald hci_controller_dump_packets(); 36508ad9cf99SMatthias Ringwald #endif 36518ad9cf99SMatthias Ringwald 3652e5413aa0SMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS 3653e5413aa0SMatthias Ringwald if (conn == NULL){ 3654e5413aa0SMatthias Ringwald hci_iso_stream_t * iso_stream = hci_iso_stream_for_con_handle(handle); 3655e5413aa0SMatthias Ringwald if (iso_stream != NULL){ 3656e5413aa0SMatthias Ringwald if (iso_stream->num_packets_sent >= num_packets) { 3657e5413aa0SMatthias Ringwald iso_stream->num_packets_sent -= num_packets; 3658e5413aa0SMatthias Ringwald } else { 3659e5413aa0SMatthias Ringwald log_error("hci_number_completed_packets, more packet slots freed then sent."); 3660e5413aa0SMatthias Ringwald iso_stream->num_packets_sent = 0; 3661e5413aa0SMatthias Ringwald } 36628d72db10SMatthias Ringwald if (iso_stream->iso_type == HCI_ISO_TYPE_BIS){ 36638d72db10SMatthias Ringwald le_audio_big_t * big = hci_big_for_handle(iso_stream->group_id); 3664fe977b37SMatthias Ringwald if (big != NULL){ 3665fe977b37SMatthias Ringwald big->num_completed_timestamp_current_valid = true; 3666fe977b37SMatthias Ringwald big->num_completed_timestamp_current_ms = btstack_run_loop_get_time_ms(); 3667fe977b37SMatthias Ringwald } 3668fe977b37SMatthias Ringwald } 3669e5413aa0SMatthias Ringwald log_info("hci_number_completed_packet %u processed for handle %u, outstanding %u", 3670e5413aa0SMatthias Ringwald num_packets, handle, iso_stream->num_packets_sent); 3671d9a1d8edSMatthias Ringwald notify_iso = true; 3672e5413aa0SMatthias Ringwald } 3673d9a1d8edSMatthias Ringwald } 3674d9a1d8edSMatthias Ringwald #endif 3675d9a1d8edSMatthias Ringwald } 3676d9a1d8edSMatthias Ringwald 3677d9a1d8edSMatthias Ringwald #ifdef ENABLE_CLASSIC 3678d9a1d8edSMatthias Ringwald if (notify_sco){ 3679d9a1d8edSMatthias Ringwald hci_notify_if_sco_can_send_now(); 3680d9a1d8edSMatthias Ringwald } 3681d9a1d8edSMatthias Ringwald #endif 3682d9a1d8edSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS 3683d9a1d8edSMatthias Ringwald if (notify_iso){ 36845ade6657SMatthias Ringwald hci_iso_notify_can_send_now(); 3685e5413aa0SMatthias Ringwald } 3686e5413aa0SMatthias Ringwald #endif 36876772a24cSmatthias.ringwald break; 36882e440c8aS[email protected] } 368935454696SMatthias Ringwald 369035454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 36919afaa4d4SMatthias Ringwald case HCI_EVENT_FLUSH_OCCURRED: 36929afaa4d4SMatthias Ringwald // flush occurs only if automatic flush has been enabled by gap_enable_link_watchdog() 36939afaa4d4SMatthias Ringwald handle = hci_event_flush_occurred_get_handle(packet); 36949afaa4d4SMatthias Ringwald conn = hci_connection_for_handle(handle); 36959afaa4d4SMatthias Ringwald if (conn) { 36969afaa4d4SMatthias Ringwald log_info("Flush occurred, disconnect 0x%04x", handle); 36979afaa4d4SMatthias Ringwald conn->state = SEND_DISCONNECT; 36989afaa4d4SMatthias Ringwald } 36999afaa4d4SMatthias Ringwald break; 37009afaa4d4SMatthias Ringwald 3701f5875de5SMatthias Ringwald case HCI_EVENT_INQUIRY_COMPLETE: 3702f5875de5SMatthias Ringwald if (hci_stack->inquiry_state == GAP_INQUIRY_STATE_ACTIVE){ 3703f5875de5SMatthias Ringwald hci_stack->inquiry_state = GAP_INQUIRY_STATE_IDLE; 3704f5875de5SMatthias Ringwald uint8_t event[] = { GAP_EVENT_INQUIRY_COMPLETE, 1, 0}; 3705f5875de5SMatthias Ringwald hci_emit_event(event, sizeof(event), 1); 3706f5875de5SMatthias Ringwald } 3707f5875de5SMatthias Ringwald break; 3708b7f1ee76SMatthias Ringwald case HCI_EVENT_REMOTE_NAME_REQUEST_COMPLETE: 3709b7f1ee76SMatthias Ringwald if (hci_stack->remote_name_state == GAP_REMOTE_NAME_STATE_W4_COMPLETE){ 3710b7f1ee76SMatthias Ringwald hci_stack->remote_name_state = GAP_REMOTE_NAME_STATE_IDLE; 3711b7f1ee76SMatthias Ringwald } 3712b7f1ee76SMatthias Ringwald break; 37131f7b95a1Smatthias.ringwald case HCI_EVENT_CONNECTION_REQUEST: 3714724d70a2SMatthias Ringwald reverse_bd_addr(&packet[2], addr); 37155e91d96cSMatthias Ringwald link_type = (hci_link_type_t) packet[11]; 371672cf8859SMatthias Ringwald 371772cf8859SMatthias Ringwald // CVE-2020-26555: reject incoming connection from device with same BD ADDR 371872cf8859SMatthias Ringwald if (memcmp(hci_stack->local_bd_addr, addr, 6) == 0){ 371972cf8859SMatthias Ringwald hci_stack->decline_reason = ERROR_CODE_CONNECTION_REJECTED_DUE_TO_UNACCEPTABLE_BD_ADDR; 372072cf8859SMatthias Ringwald bd_addr_copy(hci_stack->decline_addr, addr); 372172cf8859SMatthias Ringwald break; 372272cf8859SMatthias Ringwald } 372372cf8859SMatthias Ringwald 372407e010b6SMilanka Ringwald if (hci_stack->gap_classic_accept_callback != NULL){ 37255e91d96cSMatthias Ringwald if ((*hci_stack->gap_classic_accept_callback)(addr, link_type) == 0){ 3726d152b6c6SMatthias Ringwald hci_stack->decline_reason = ERROR_CODE_CONNECTION_REJECTED_DUE_TO_SECURITY_REASONS; 372707e010b6SMilanka Ringwald bd_addr_copy(hci_stack->decline_addr, addr); 372807e010b6SMilanka Ringwald break; 372907e010b6SMilanka Ringwald } 373007e010b6SMilanka Ringwald } 373107e010b6SMilanka Ringwald 373237eaa4cfSmatthias.ringwald // TODO: eval COD 8-10 37335e91d96cSMatthias Ringwald log_info("Connection_incoming: %s, type %u", bd_addr_to_str(addr), (unsigned int) link_type); 37345e91d96cSMatthias Ringwald addr_type = (link_type == HCI_LINK_TYPE_ACL) ? BD_ADDR_TYPE_ACL : BD_ADDR_TYPE_SCO; 37352e77e513S[email protected] conn = hci_connection_for_bd_addr_and_type(addr, addr_type); 37361f7b95a1Smatthias.ringwald if (!conn) { 373788f925b1SMatthias Ringwald conn = create_connection_for_bd_addr_and_type(addr, addr_type, HCI_ROLE_SLAVE); 37381f7b95a1Smatthias.ringwald } 3739ce4c8fabSmatthias.ringwald if (!conn) { 3740ce4c8fabSmatthias.ringwald // CONNECTION REJECTED DUE TO LIMITED RESOURCES (0X0D) 37414536712cSMilanka Ringwald hci_stack->decline_reason = ERROR_CODE_CONNECTION_REJECTED_DUE_TO_LIMITED_RESOURCES; 3742058e3d6bSMatthias Ringwald bd_addr_copy(hci_stack->decline_addr, addr); 3743f23819bcSMatthias Ringwald hci_run(); 3744f23819bcSMatthias Ringwald // avoid event to higher layer 3745f23819bcSMatthias Ringwald return; 3746ce4c8fabSmatthias.ringwald } 374732ab9390Smatthias.ringwald conn->state = RECEIVED_CONNECTION_REQUEST; 3748f3a16b9aSMatthias Ringwald // store info about eSCO 37495e91d96cSMatthias Ringwald if (link_type == HCI_LINK_TYPE_ESCO){ 375076ccfb2aSMatthias Ringwald conn->remote_supported_features[0] |= 1; 3751f3a16b9aSMatthias Ringwald } 3752d7891039SMatthias Ringwald // propagate remote supported sco packet packets from existing ACL to new SCO connection 3753d7891039SMatthias Ringwald if (addr_type == BD_ADDR_TYPE_SCO){ 3754182d886dSMatthias Ringwald const hci_connection_t * acl_conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL); 3755182d886dSMatthias Ringwald // ACL exists unless fuzzing 3756182d886dSMatthias Ringwald if (acl_conn != NULL) { 3757d7891039SMatthias Ringwald conn->remote_supported_sco_packets = acl_conn->remote_supported_sco_packets; 3758d7891039SMatthias Ringwald } 3759182d886dSMatthias Ringwald } 376032ab9390Smatthias.ringwald hci_run(); 37611f7b95a1Smatthias.ringwald break; 37621f7b95a1Smatthias.ringwald 37636772a24cSmatthias.ringwald case HCI_EVENT_CONNECTION_COMPLETE: 3764fe1ed1b8Smatthias.ringwald // Connection management 3765724d70a2SMatthias Ringwald reverse_bd_addr(&packet[5], addr); 37669da54300S[email protected] log_info("Connection_complete (status=%u) %s", packet[2], bd_addr_to_str(addr)); 3767f16129ceSMatthias Ringwald addr_type = BD_ADDR_TYPE_ACL; 37682e77e513S[email protected] conn = hci_connection_for_bd_addr_and_type(addr, addr_type); 3769fe1ed1b8Smatthias.ringwald if (conn) { 3770893b4ccdSMatthias Ringwald switch (conn->state){ 3771893b4ccdSMatthias Ringwald // expected states 3772893b4ccdSMatthias Ringwald case ACCEPTED_CONNECTION_REQUEST: 3773893b4ccdSMatthias Ringwald case SENT_CREATE_CONNECTION: 3774893b4ccdSMatthias Ringwald break; 3775893b4ccdSMatthias Ringwald // unexpected state -> ignore 3776893b4ccdSMatthias Ringwald default: 3777893b4ccdSMatthias Ringwald // don't forward event to app 3778893b4ccdSMatthias Ringwald return; 3779893b4ccdSMatthias Ringwald } 3780b448a0e7Smatthias.ringwald if (!packet[2]){ 3781c8e4258aSmatthias.ringwald conn->state = OPEN; 3782f8fbdce0SMatthias Ringwald conn->con_handle = little_endian_read_16(packet, 3); 37836909f064SMatthias Ringwald 378422df2fe2SMatthias Ringwald // trigger write supervision timeout if we're master 3785d821984bSMatthias Ringwald if ((hci_stack->link_supervision_timeout != HCI_LINK_SUPERVISION_TIMEOUT_DEFAULT) && (conn->role == HCI_ROLE_MASTER)){ 378622df2fe2SMatthias Ringwald conn->gap_connection_tasks |= GAP_CONNECTION_TASK_WRITE_SUPERVISION_TIMEOUT; 37876909f064SMatthias Ringwald } 37886909f064SMatthias Ringwald 378922df2fe2SMatthias Ringwald // trigger write automatic flush timeout 37909afaa4d4SMatthias Ringwald if (hci_stack->automatic_flush_timeout != 0){ 37919afaa4d4SMatthias Ringwald conn->gap_connection_tasks |= GAP_CONNECTION_TASK_WRITE_AUTOMATIC_FLUSH_TIMEOUT; 37929afaa4d4SMatthias Ringwald } 37939afaa4d4SMatthias Ringwald 3794c785ef68Smatthias.ringwald // restart timer 3795528a4a3bSMatthias Ringwald btstack_run_loop_set_timer(&conn->timeout, HCI_CONNECTION_TIMEOUT_MS); 3796528a4a3bSMatthias Ringwald btstack_run_loop_add_timer(&conn->timeout); 3797c785ef68Smatthias.ringwald 379818c4a0a3SMatthias Ringwald // trigger remote features for dedicated bonding 379918c4a0a3SMatthias Ringwald if ((conn->bonding_flags & BONDING_DEDICATED) != 0){ 380018c4a0a3SMatthias Ringwald hci_trigger_remote_features_for_connection(conn); 380118c4a0a3SMatthias Ringwald } 380218c4a0a3SMatthias Ringwald 38039da54300S[email protected] log_info("New connection: handle %u, %s", conn->con_handle, bd_addr_to_str(conn->address)); 380443bfb1bdSmatthias.ringwald 380543bfb1bdSmatthias.ringwald hci_emit_nr_connections_changed(); 3806b448a0e7Smatthias.ringwald } else { 38070bbba85bSMatthias Ringwald // connection failed 38080bbba85bSMatthias Ringwald hci_handle_connection_failed(conn, packet[2]); 3809fe1ed1b8Smatthias.ringwald } 3810fe1ed1b8Smatthias.ringwald } 38116772a24cSmatthias.ringwald break; 3812fe1ed1b8Smatthias.ringwald 381344d0e3d5S[email protected] case HCI_EVENT_SYNCHRONOUS_CONNECTION_COMPLETE: 3814724d70a2SMatthias Ringwald reverse_bd_addr(&packet[5], addr); 38151f34df2cSMatthias Ringwald conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_SCO); 38161f34df2cSMatthias Ringwald log_info("Synchronous Connection Complete for %p (status=%u) %s", conn, packet[2], bd_addr_to_str(addr)); 3817182d886dSMatthias Ringwald 3818182d886dSMatthias Ringwald // SCO exists unless fuzzer 3819182d886dSMatthias Ringwald if (conn == NULL) break; 38209071873aSMatthias Ringwald 38219071873aSMatthias Ringwald if (packet[2] != ERROR_CODE_SUCCESS){ 38229071873aSMatthias Ringwald // connection failed, remove entry 38231f34df2cSMatthias Ringwald hci_handle_connection_failed(conn, packet[2]); 382444d0e3d5S[email protected] break; 382544d0e3d5S[email protected] } 38269071873aSMatthias Ringwald 38271a06f663S[email protected] conn->state = OPEN; 3828f8fbdce0SMatthias Ringwald conn->con_handle = little_endian_read_16(packet, 3); 3829ee752bb8SMatthias Ringwald 3830d7891039SMatthias Ringwald // update sco payload length for eSCO connections 3831d7891039SMatthias Ringwald if (hci_event_synchronous_connection_complete_get_tx_packet_length(packet) > 0){ 3832d7891039SMatthias Ringwald conn->sco_payload_length = hci_event_synchronous_connection_complete_get_tx_packet_length(packet); 3833d7891039SMatthias Ringwald log_info("eSCO Complete, set payload len %u", conn->sco_payload_length); 3834d7891039SMatthias Ringwald } 3835d7891039SMatthias Ringwald 3836ee752bb8SMatthias Ringwald #ifdef ENABLE_SCO_OVER_HCI 3837ee752bb8SMatthias Ringwald // update SCO 3838ee752bb8SMatthias Ringwald if (conn->address_type == BD_ADDR_TYPE_SCO && hci_stack->hci_transport && hci_stack->hci_transport->set_sco_config){ 3839ee752bb8SMatthias Ringwald hci_stack->hci_transport->set_sco_config(hci_stack->sco_voice_setting_active, hci_number_sco_connections()); 3840ee752bb8SMatthias Ringwald } 3841f234b250SMatthias Ringwald // trigger can send now 3842f234b250SMatthias Ringwald if (hci_have_usb_transport()){ 38431972f31fSMatthias Ringwald hci_stack->sco_can_send_now = true; 3844f234b250SMatthias Ringwald } 3845fa7f2dfdSMatthias Ringwald 3846fa7f2dfdSMatthias Ringwald // setup implict sco flow control 3847fa7f2dfdSMatthias Ringwald conn->sco_tx_ready = 0; 3848fa7f2dfdSMatthias Ringwald conn->sco_tx_active = 0; 3849fa7f2dfdSMatthias Ringwald conn->sco_established_ms = btstack_run_loop_get_time_ms(); 3850fa7f2dfdSMatthias Ringwald 3851ee752bb8SMatthias Ringwald #endif 3852cb70c5abSMatthias Ringwald #ifdef HAVE_SCO_TRANSPORT 3853cb70c5abSMatthias Ringwald // configure sco transport 3854cb70c5abSMatthias Ringwald if (hci_stack->sco_transport != NULL){ 3855cb70c5abSMatthias Ringwald sco_format_t sco_format = ((hci_stack->sco_voice_setting_active & 0x03) == 0x03) ? SCO_FORMAT_8_BIT : SCO_FORMAT_16_BIT; 3856cb70c5abSMatthias Ringwald hci_stack->sco_transport->open(conn->con_handle, sco_format); 3857cb70c5abSMatthias Ringwald } 3858cb70c5abSMatthias Ringwald #endif 385944d0e3d5S[email protected] break; 386044d0e3d5S[email protected] 3861afd4e962S[email protected] case HCI_EVENT_READ_REMOTE_SUPPORTED_FEATURES_COMPLETE: 3862f8fbdce0SMatthias Ringwald handle = little_endian_read_16(packet, 3); 3863afd4e962S[email protected] conn = hci_connection_for_handle(handle); 3864afd4e962S[email protected] if (!conn) break; 3865afd4e962S[email protected] if (!packet[2]){ 38662f5c44baSMatthias Ringwald const uint8_t * features = &packet[5]; 38672f5c44baSMatthias Ringwald hci_handle_remote_features_page_0(conn, features); 38682f5c44baSMatthias Ringwald 38695ccef624SMatthias Ringwald // read extended features if possible 38701ffa425cSMatthias Ringwald if (hci_command_supported(SUPPORTED_HCI_COMMAND_READ_REMOTE_EXTENDED_FEATURES) 38711ffa425cSMatthias Ringwald && ((conn->remote_supported_features[0] & 2) != 0)) { 38725ccef624SMatthias Ringwald conn->bonding_flags |= BONDING_REQUEST_REMOTE_FEATURES_PAGE_1; 38735ccef624SMatthias Ringwald break; 38745ccef624SMatthias Ringwald } 38755ccef624SMatthias Ringwald } 38765ccef624SMatthias Ringwald hci_handle_remote_features_received(conn); 38775ccef624SMatthias Ringwald break; 38785ccef624SMatthias Ringwald 38795ccef624SMatthias Ringwald case HCI_EVENT_READ_REMOTE_EXTENDED_FEATURES_COMPLETE: 38805ccef624SMatthias Ringwald handle = little_endian_read_16(packet, 3); 38815ccef624SMatthias Ringwald conn = hci_connection_for_handle(handle); 38825ccef624SMatthias Ringwald if (!conn) break; 38835ccef624SMatthias Ringwald // status = ok, page = 1 388450c51a77SMatthias Ringwald if (!packet[2]) { 388550c51a77SMatthias Ringwald uint8_t page_number = packet[5]; 388650c51a77SMatthias Ringwald uint8_t maximum_page_number = packet[6]; 38875ccef624SMatthias Ringwald const uint8_t * features = &packet[7]; 388850c51a77SMatthias Ringwald bool done = false; 388950c51a77SMatthias Ringwald switch (page_number){ 389050c51a77SMatthias Ringwald case 1: 38912f5c44baSMatthias Ringwald hci_handle_remote_features_page_1(conn, features); 389250c51a77SMatthias Ringwald if (maximum_page_number >= 2){ 389350c51a77SMatthias Ringwald // get Secure Connections (Controller) from Page 2 if available 389450c51a77SMatthias Ringwald conn->bonding_flags |= BONDING_REQUEST_REMOTE_FEATURES_PAGE_2; 389550c51a77SMatthias Ringwald } else { 389650c51a77SMatthias Ringwald // otherwise, assume SC (Controller) == SC (Host) 389750c51a77SMatthias Ringwald if ((conn->bonding_flags & BONDING_REMOTE_SUPPORTS_SC_HOST) != 0){ 389850c51a77SMatthias Ringwald conn->bonding_flags |= BONDING_REMOTE_SUPPORTS_SC_CONTROLLER; 389950c51a77SMatthias Ringwald } 390050c51a77SMatthias Ringwald done = true; 390150c51a77SMatthias Ringwald } 390250c51a77SMatthias Ringwald break; 390350c51a77SMatthias Ringwald case 2: 390450c51a77SMatthias Ringwald hci_handle_remote_features_page_2(conn, features); 390550c51a77SMatthias Ringwald done = true; 390650c51a77SMatthias Ringwald break; 390750c51a77SMatthias Ringwald default: 390850c51a77SMatthias Ringwald break; 390950c51a77SMatthias Ringwald } 391050c51a77SMatthias Ringwald if (!done) break; 3911afd4e962S[email protected] } 3912de0df013SMatthias Ringwald hci_handle_remote_features_received(conn); 3913afd4e962S[email protected] break; 3914afd4e962S[email protected] 39157fde4af9Smatthias.ringwald case HCI_EVENT_LINK_KEY_REQUEST: 3916308eeaffSMatthias Ringwald #ifndef ENABLE_EXPLICIT_LINK_KEY_REPLY 391763c0b2fdSMatthias Ringwald hci_event_link_key_request_get_bd_addr(packet, addr); 391863c0b2fdSMatthias Ringwald conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL); 391963c0b2fdSMatthias Ringwald if (!conn) break; 392063c0b2fdSMatthias Ringwald 392163c0b2fdSMatthias Ringwald // lookup link key in db if not cached 392263c0b2fdSMatthias Ringwald if ((conn->link_key_type == INVALID_LINK_KEY) && (hci_stack->link_key_db != NULL)){ 392363c0b2fdSMatthias Ringwald hci_stack->link_key_db->get_link_key(conn->address, conn->link_key, &conn->link_key_type); 392463c0b2fdSMatthias Ringwald } 392563c0b2fdSMatthias Ringwald 392663c0b2fdSMatthias Ringwald // response sent by hci_run() 392763c0b2fdSMatthias Ringwald conn->authentication_flags |= AUTH_FLAG_HANDLE_LINK_KEY_REQUEST; 392863c0b2fdSMatthias Ringwald #endif 3929608f51bbSMatthias Ringwald break; 39307fde4af9Smatthias.ringwald 39319ab95c90S[email protected] case HCI_EVENT_LINK_KEY_NOTIFICATION: { 39321714cbbdSMatthias Ringwald hci_event_link_key_request_get_bd_addr(packet, addr); 3933f16129ceSMatthias Ringwald conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL); 39349ab95c90S[email protected] if (!conn) break; 39351714cbbdSMatthias Ringwald 39361714cbbdSMatthias Ringwald hci_pairing_complete(conn, ERROR_CODE_SUCCESS); 39371714cbbdSMatthias Ringwald 39383817f9dfSMatthias Ringwald // CVE-2020-26555: ignore NULL link key 39393817f9dfSMatthias Ringwald // default link_key_type = INVALID_LINK_KEY asserts that NULL key won't be used for encryption 39403817f9dfSMatthias Ringwald if (btstack_is_null(&packet[8], 16)) break; 39413817f9dfSMatthias Ringwald 39427bdc6798S[email protected] link_key_type_t link_key_type = (link_key_type_t)packet[24]; 39439ab95c90S[email protected] // Change Connection Encryption keeps link key type 39449ab95c90S[email protected] if (link_key_type != CHANGED_COMBINATION_KEY){ 39459ab95c90S[email protected] conn->link_key_type = link_key_type; 39469ab95c90S[email protected] } 39473817f9dfSMatthias Ringwald 3948e9f98c4aSMatthias Ringwald // cache link key. link keys stored in little-endian format for legacy reasons 3949e9f98c4aSMatthias Ringwald memcpy(&conn->link_key, &packet[8], 16); 3950e9f98c4aSMatthias Ringwald 3951bec5f683SMatthias Ringwald // only store link key: 3952bec5f683SMatthias Ringwald // - if bondable enabled 3953bec5f683SMatthias Ringwald if (hci_stack->bondable == false) break; 39546edaed7fSMatthias Ringwald // - if security level sufficient 39556edaed7fSMatthias Ringwald if (gap_security_level_for_link_key_type(link_key_type) < conn->requested_security_level) break; 395655597469SMatthias Ringwald gap_store_link_key_for_bd_addr(addr, &packet[8], conn->link_key_type); 39577fde4af9Smatthias.ringwald break; 39589ab95c90S[email protected] } 39597fde4af9Smatthias.ringwald 39607fde4af9Smatthias.ringwald case HCI_EVENT_PIN_CODE_REQUEST: 39611714cbbdSMatthias Ringwald hci_event_pin_code_request_get_bd_addr(packet, addr); 39621714cbbdSMatthias Ringwald conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL); 39631714cbbdSMatthias Ringwald if (!conn) break; 39641714cbbdSMatthias Ringwald 39651714cbbdSMatthias Ringwald hci_pairing_started(conn, false); 3966a800d95eSMatthias Ringwald // abort pairing if: non-bondable mode (pin code request is not forwarded to app) 39673a9fb326S[email protected] if (!hci_stack->bondable ){ 39688daf94bcSMatthias Ringwald conn->authentication_flags |= AUTH_FLAG_DENY_PIN_CODE_REQUEST; 39691714cbbdSMatthias Ringwald hci_pairing_complete(conn, ERROR_CODE_PAIRING_NOT_ALLOWED); 3970f8fb5f6eS[email protected] hci_run(); 3971f8fb5f6eS[email protected] return; 39724c57c146S[email protected] } 3973a800d95eSMatthias Ringwald // abort pairing if: LEVEL_4 required (pin code request is not forwarded to app) 3974a800d95eSMatthias Ringwald if ((hci_stack->gap_secure_connections_only_mode) || (conn->requested_security_level == LEVEL_4)){ 3975a800d95eSMatthias Ringwald log_info("Level 4 required, but SC not supported -> abort"); 397650dcc63cSMatthias Ringwald conn->authentication_flags |= AUTH_FLAG_DENY_PIN_CODE_REQUEST; 397750dcc63cSMatthias Ringwald hci_pairing_complete(conn, ERROR_CODE_INSUFFICIENT_SECURITY); 397850dcc63cSMatthias Ringwald hci_run(); 397950dcc63cSMatthias Ringwald return; 398050dcc63cSMatthias Ringwald } 39817fde4af9Smatthias.ringwald break; 39827fde4af9Smatthias.ringwald 398350d7398cSMatthias Ringwald case HCI_EVENT_IO_CAPABILITY_RESPONSE: 398450d7398cSMatthias Ringwald hci_event_io_capability_response_get_bd_addr(packet, addr); 398550d7398cSMatthias Ringwald conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL); 398650d7398cSMatthias Ringwald if (!conn) break; 39871714cbbdSMatthias Ringwald 39888daf94bcSMatthias Ringwald hci_add_connection_flags_for_flipped_bd_addr(&packet[2], AUTH_FLAG_RECV_IO_CAPABILITIES_RESPONSE); 39891714cbbdSMatthias Ringwald hci_pairing_started(conn, true); 399050d7398cSMatthias Ringwald conn->io_cap_response_auth_req = hci_event_io_capability_response_get_authentication_requirements(packet); 3991e276e383SMatthias Ringwald conn->io_cap_response_io = hci_event_io_capability_response_get_io_capability(packet); 3992d22b82d6SMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB 3993d22b82d6SMatthias Ringwald conn->io_cap_response_oob_data = hci_event_io_capability_response_get_oob_data_present(packet); 3994d22b82d6SMatthias Ringwald #endif 399550d7398cSMatthias Ringwald break; 399650d7398cSMatthias Ringwald 39971d6b20aeS[email protected] case HCI_EVENT_IO_CAPABILITY_REQUEST: 39981714cbbdSMatthias Ringwald hci_event_io_capability_response_get_bd_addr(packet, addr); 39991714cbbdSMatthias Ringwald conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL); 40001714cbbdSMatthias Ringwald if (!conn) break; 40011714cbbdSMatthias Ringwald 4002c950c316SMatthias Ringwald hci_add_connection_flags_for_flipped_bd_addr(&packet[2], AUTH_FLAG_RECV_IO_CAPABILITIES_REQUEST); 40039671e615SMatthias Ringwald hci_connection_timestamp(conn); 40041714cbbdSMatthias Ringwald hci_pairing_started(conn, true); 4005dbe1a790S[email protected] break; 4006dbe1a790S[email protected] 40071849becdSMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB 40081849becdSMatthias Ringwald case HCI_EVENT_REMOTE_OOB_DATA_REQUEST: 40097ca4a7edSMatthias Ringwald hci_event_remote_oob_data_request_get_bd_addr(packet, addr); 40107ca4a7edSMatthias Ringwald conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL); 40117ca4a7edSMatthias Ringwald if (!conn) break; 40127ca4a7edSMatthias Ringwald 40137ca4a7edSMatthias Ringwald hci_connection_timestamp(conn); 40147ca4a7edSMatthias Ringwald 40157ca4a7edSMatthias Ringwald hci_pairing_started(conn, true); 40167ca4a7edSMatthias Ringwald 40177ca4a7edSMatthias Ringwald connectionSetAuthenticationFlags(conn, AUTH_FLAG_SEND_REMOTE_OOB_DATA_REPLY); 40181849becdSMatthias Ringwald break; 40191849becdSMatthias Ringwald #endif 40201849becdSMatthias Ringwald 4021dbe1a790S[email protected] case HCI_EVENT_USER_CONFIRMATION_REQUEST: 402217c6fe5cSMatthias Ringwald hci_event_user_confirmation_request_get_bd_addr(packet, addr); 4023367aedc0SMatthias Ringwald conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL); 4024367aedc0SMatthias Ringwald if (!conn) break; 4025367aedc0SMatthias Ringwald if (hci_ssp_security_level_possible_for_io_cap(conn->requested_security_level, hci_stack->ssp_io_capability, conn->io_cap_response_io)) { 4026367aedc0SMatthias Ringwald if (hci_stack->ssp_auto_accept){ 40278daf94bcSMatthias Ringwald hci_add_connection_flags_for_flipped_bd_addr(&packet[2], AUTH_FLAG_SEND_USER_CONFIRM_REPLY); 4028367aedc0SMatthias Ringwald }; 4029367aedc0SMatthias Ringwald } else { 4030367aedc0SMatthias Ringwald hci_pairing_complete(conn, ERROR_CODE_INSUFFICIENT_SECURITY); 4031367aedc0SMatthias Ringwald hci_add_connection_flags_for_flipped_bd_addr(&packet[2], AUTH_FLAG_SEND_USER_CONFIRM_NEGATIVE_REPLY); 4032367aedc0SMatthias Ringwald // don't forward event to app 4033367aedc0SMatthias Ringwald hci_run(); 4034367aedc0SMatthias Ringwald return; 4035367aedc0SMatthias Ringwald } 4036dbe1a790S[email protected] break; 4037dbe1a790S[email protected] 4038dbe1a790S[email protected] case HCI_EVENT_USER_PASSKEY_REQUEST: 4039367aedc0SMatthias Ringwald // Pairing using Passkey results in MITM protection. If Level 4 is required, support for SC is validated on IO Cap Request 4040367aedc0SMatthias Ringwald if (hci_stack->ssp_auto_accept){ 40418daf94bcSMatthias Ringwald hci_add_connection_flags_for_flipped_bd_addr(&packet[2], AUTH_FLAG_SEND_USER_PASSKEY_REPLY); 4042367aedc0SMatthias Ringwald }; 40431d6b20aeS[email protected] break; 40441849becdSMatthias Ringwald 40453dce6128SMatthias Ringwald case HCI_EVENT_MODE_CHANGE: 40463dce6128SMatthias Ringwald handle = hci_event_mode_change_get_handle(packet); 40473dce6128SMatthias Ringwald conn = hci_connection_for_handle(handle); 40483dce6128SMatthias Ringwald if (!conn) break; 40493dce6128SMatthias Ringwald conn->connection_mode = hci_event_mode_change_get_mode(packet); 40503dce6128SMatthias Ringwald log_info("HCI_EVENT_MODE_CHANGE, handle 0x%04x, mode %u", handle, conn->connection_mode); 40513dce6128SMatthias Ringwald break; 405235454696SMatthias Ringwald #endif 40531d6b20aeS[email protected] 4054f0944df2S[email protected] case HCI_EVENT_ENCRYPTION_CHANGE: 4055a355334eSMatthias Ringwald case HCI_EVENT_ENCRYPTION_CHANGE_V2: 4056254b78eeSMatthias Ringwald handle = hci_event_encryption_change_get_connection_handle(packet); 4057f0944df2S[email protected] conn = hci_connection_for_handle(handle); 4058f0944df2S[email protected] if (!conn) break; 4059db3c1f89SMatthias Ringwald if (hci_event_encryption_change_get_status(packet) == ERROR_CODE_SUCCESS) { 4060254b78eeSMatthias Ringwald uint8_t encryption_enabled = hci_event_encryption_change_get_encryption_enabled(packet); 4061254b78eeSMatthias Ringwald if (encryption_enabled){ 4062573897a0SMatthias Ringwald if (hci_is_le_connection(conn)){ 4063573897a0SMatthias Ringwald // For LE, we accept connection as encrypted 40648daf94bcSMatthias Ringwald conn->authentication_flags |= AUTH_FLAG_CONNECTION_ENCRYPTED; 4065573897a0SMatthias Ringwald } 4066573897a0SMatthias Ringwald #ifdef ENABLE_CLASSIC 4067573897a0SMatthias Ringwald else { 4068fcaf38b9SMatthias Ringwald 4069254b78eeSMatthias Ringwald // Detect Secure Connection -> Legacy Connection Downgrade Attack (BIAS) 407036c3546bSMatthias Ringwald bool sc_used_during_pairing = gap_secure_connection_for_link_key_type(conn->link_key_type); 4071254b78eeSMatthias Ringwald bool connected_uses_aes_ccm = encryption_enabled == 2; 4072edc1ac20SMatthias Ringwald if (hci_stack->secure_connections_active && sc_used_during_pairing && !connected_uses_aes_ccm){ 4073813a09c6SMatthias Ringwald #ifdef ENABLE_TESTING_SUPPORT 4074813a09c6SMatthias Ringwald // The following tests require to reject L2CAP connection as SC has been disabled on the remote 4075813a09c6SMatthias Ringwald // - GAP/SEC/SEM/BI-31-C 4076813a09c6SMatthias Ringwald // - GAP/SEC/SEM/BI-32-C 4077813a09c6SMatthias Ringwald // - GAP/SEC/SEM/BI-33-C 4078813a09c6SMatthias Ringwald 4079813a09c6SMatthias Ringwald // Our release code (aggressively) disconnects the HCI connection, without a chance to respond to PTS 4080813a09c6SMatthias Ringwald // To pass the tests, we only downgrade the link key type instead of the more secure disconnect 408129d4766dSMatthias Ringwald link_key_type_t new_link_key_type = UNAUTHENTICATED_COMBINATION_KEY_GENERATED_FROM_P192; 408229d4766dSMatthias Ringwald if (conn->link_key_type == AUTHENTICATED_COMBINATION_KEY_GENERATED_FROM_P256){ 4083813a09c6SMatthias Ringwald new_link_key_type = AUTHENTICATED_COMBINATION_KEY_GENERATED_FROM_P192; 4084813a09c6SMatthias Ringwald } 4085813a09c6SMatthias Ringwald log_info("SC during pairing, but only E0 now -> downgrade link key type from %u to %u", 4086813a09c6SMatthias Ringwald conn->link_key_type, new_link_key_type); 4087813a09c6SMatthias Ringwald conn->link_key_type = new_link_key_type; 4088813a09c6SMatthias Ringwald #else 4089254b78eeSMatthias Ringwald log_info("SC during pairing, but only E0 now -> abort"); 40909ece71c2SMatthias Ringwald conn->bonding_flags |= BONDING_DISCONNECT_SECURITY_BLOCK; 4091254b78eeSMatthias Ringwald break; 4092813a09c6SMatthias Ringwald #endif 4093254b78eeSMatthias Ringwald } 4094254b78eeSMatthias Ringwald 409562daa441SMatthias Ringwald #ifdef ENABLE_MUTUAL_AUTHENTICATION_FOR_LEGACY_SECURE_CONNECTIONS 4096aa2fe986SMatthias Ringwald // if AES-CCM is used, authentication used SC -> authentication was mutual and we can skip explicit authentication 4097aa2fe986SMatthias Ringwald if (connected_uses_aes_ccm){ 4098aa2fe986SMatthias Ringwald conn->authentication_flags |= AUTH_FLAG_CONNECTION_AUTHENTICATED; 4099aa2fe986SMatthias Ringwald } 410062daa441SMatthias Ringwald #else 410162daa441SMatthias Ringwald // We consider even Legacy Secure Connections as authenticated as BTstack mandates encryption 410262daa441SMatthias Ringwald // with encryption key size > hci_stack->gap_required_encyrption_key_size 410362daa441SMatthias Ringwald // for all operations that require any security. See BIAS attacks. 4104aa2fe986SMatthias Ringwald conn->authentication_flags |= AUTH_FLAG_CONNECTION_AUTHENTICATED; 4105aa2fe986SMatthias Ringwald #endif 4106a355334eSMatthias Ringwald // validate encryption key size 4107a355334eSMatthias Ringwald if (hci_event_packet_get_type(packet) == HCI_EVENT_ENCRYPTION_CHANGE_V2) { 4108a355334eSMatthias Ringwald uint8_t encryption_key_size = hci_event_encryption_change_v2_get_encryption_key_size(packet); 4109a355334eSMatthias Ringwald // already got encryption key size 4110a355334eSMatthias Ringwald hci_handle_read_encryption_key_size_complete(conn, encryption_key_size); 4111a355334eSMatthias Ringwald } else { 41121ffa425cSMatthias Ringwald if (hci_command_supported(SUPPORTED_HCI_COMMAND_READ_ENCRYPTION_KEY_SIZE)) { 41136e058d3fSMatthias Ringwald // For Classic, we need to validate encryption key size first, if possible (== supported by Controller) 4114573897a0SMatthias Ringwald conn->bonding_flags |= BONDING_SEND_READ_ENCRYPTION_KEY_SIZE; 41156e058d3fSMatthias Ringwald } else { 41166e058d3fSMatthias Ringwald // if not, pretend everything is perfect 41179866fdc7SMatthias Ringwald hci_handle_read_encryption_key_size_complete(conn, 16); 41186e058d3fSMatthias Ringwald } 4119573897a0SMatthias Ringwald } 4120a355334eSMatthias Ringwald } 4121573897a0SMatthias Ringwald #endif 4122f0944df2S[email protected] } else { 41238daf94bcSMatthias Ringwald conn->authentication_flags &= ~AUTH_FLAG_CONNECTION_ENCRYPTED; 4124f0944df2S[email protected] } 41255999ee11SMatthias Ringwald } else { 41268eae094cSMatthias Ringwald #ifdef ENABLE_CLASSIC 41278eae094cSMatthias Ringwald if (!hci_is_le_connection(conn)){ 41285999ee11SMatthias Ringwald uint8_t status = hci_event_encryption_change_get_status(packet); 41295999ee11SMatthias Ringwald if ((conn->bonding_flags & BONDING_DEDICATED) != 0){ 41305999ee11SMatthias Ringwald conn->bonding_flags &= ~BONDING_DEDICATED; 41315999ee11SMatthias Ringwald conn->bonding_flags |= BONDING_DISCONNECT_DEDICATED_DONE; 41325999ee11SMatthias Ringwald conn->bonding_status = status; 41335999ee11SMatthias Ringwald } 413427b992efSMatthias Ringwald // trigger security update -> level 0 413527b992efSMatthias Ringwald hci_handle_mutual_authentication_completed(conn); 4136ad83dc6aS[email protected] } 41378eae094cSMatthias Ringwald #endif 41388eae094cSMatthias Ringwald } 4139573897a0SMatthias Ringwald 4140f0944df2S[email protected] break; 4141f0944df2S[email protected] 414235454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 41431eb2563eS[email protected] case HCI_EVENT_AUTHENTICATION_COMPLETE_EVENT: 4144abdad579SMatthias Ringwald handle = hci_event_authentication_complete_get_connection_handle(packet); 41451eb2563eS[email protected] conn = hci_connection_for_handle(handle); 41461eb2563eS[email protected] if (!conn) break; 4147ad83dc6aS[email protected] 4148dbd5dcc3SMatthias Ringwald // clear authentication active flag 4149dbd5dcc3SMatthias Ringwald conn->bonding_flags &= ~BONDING_SENT_AUTHENTICATE_REQUEST; 41501714cbbdSMatthias Ringwald hci_pairing_complete(conn, hci_event_authentication_complete_get_status(packet)); 4151dbd5dcc3SMatthias Ringwald 4152abdad579SMatthias Ringwald // authenticated only if auth status == 0 4153abdad579SMatthias Ringwald if (hci_event_authentication_complete_get_status(packet) == 0){ 4154abdad579SMatthias Ringwald // authenticated 41558daf94bcSMatthias Ringwald conn->authentication_flags |= AUTH_FLAG_CONNECTION_AUTHENTICATED; 4156abdad579SMatthias Ringwald 4157131ef17aSMatthias Ringwald // If not already encrypted, start encryption 41588daf94bcSMatthias Ringwald if ((conn->authentication_flags & AUTH_FLAG_CONNECTION_ENCRYPTED) == 0){ 41591eb2563eS[email protected] conn->bonding_flags |= BONDING_SEND_ENCRYPTION_REQUEST; 4160ad83dc6aS[email protected] break; 4161ad83dc6aS[email protected] } 4162abdad579SMatthias Ringwald } 4163abdad579SMatthias Ringwald 41644aa2f135SMatthias Ringwald // emit updated security level (will be 0 if not authenticated) 41654aa2f135SMatthias Ringwald hci_handle_mutual_authentication_completed(conn); 41661eb2563eS[email protected] break; 41671714cbbdSMatthias Ringwald 41681714cbbdSMatthias Ringwald case HCI_EVENT_SIMPLE_PAIRING_COMPLETE: 41691714cbbdSMatthias Ringwald hci_event_simple_pairing_complete_get_bd_addr(packet, addr); 41701714cbbdSMatthias Ringwald conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL); 41711714cbbdSMatthias Ringwald if (!conn) break; 41721714cbbdSMatthias Ringwald 4173aa2fe986SMatthias Ringwald // treat successfully paired connection as authenticated 4174aa2fe986SMatthias Ringwald if (hci_event_simple_pairing_complete_get_status(packet) == ERROR_CODE_SUCCESS){ 4175f3aafff1SMatthias Ringwald conn->authentication_flags |= AUTH_FLAG_CONNECTION_AUTHENTICATED; 4176aa2fe986SMatthias Ringwald } 4177aa2fe986SMatthias Ringwald 41781714cbbdSMatthias Ringwald hci_pairing_complete(conn, hci_event_simple_pairing_complete_get_status(packet)); 41791714cbbdSMatthias Ringwald break; 418035454696SMatthias Ringwald #endif 418134d2123cS[email protected] 418286805605S[email protected] // HCI_EVENT_DISCONNECTION_COMPLETE 4183ccda6e14S[email protected] // has been split, to first notify stack before shutting connection down 4184ccda6e14S[email protected] // see end of function, too. 4185a4f30ec0S[email protected] case HCI_EVENT_DISCONNECTION_COMPLETE: 4186a4f30ec0S[email protected] if (packet[2]) break; // status != 0 4187f8fbdce0SMatthias Ringwald handle = little_endian_read_16(packet, 3); 418881d2bdb2SMatthias Ringwald // drop outgoing ACL fragments if it is for closed connection and release buffer if tx not active 41894ea43905SMatthias Ringwald if (hci_stack->acl_fragmentation_total_size > 0u) { 4190c6a37cfdSMatthias Ringwald if (handle == READ_ACL_CONNECTION_HANDLE(hci_stack->hci_packet_buffer)){ 41914ea43905SMatthias Ringwald int release_buffer = hci_stack->acl_fragmentation_tx_active == 0u; 419281d2bdb2SMatthias Ringwald log_info("drop fragmented ACL data for closed connection, release buffer %u", release_buffer); 4193c6a37cfdSMatthias Ringwald hci_stack->acl_fragmentation_total_size = 0; 4194c6a37cfdSMatthias Ringwald hci_stack->acl_fragmentation_pos = 0; 419581d2bdb2SMatthias Ringwald if (release_buffer){ 419681d2bdb2SMatthias Ringwald hci_release_packet_buffer(); 419781d2bdb2SMatthias Ringwald } 4198c6a37cfdSMatthias Ringwald } 4199c6a37cfdSMatthias Ringwald } 420035454696SMatthias Ringwald 42014ae8623eSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS 4202098c2716SMatthias Ringwald // drop outgoing ISO fragments if it is for closed connection and release buffer if tx not active 4203098c2716SMatthias Ringwald if (hci_stack->iso_fragmentation_total_size > 0u) { 4204098c2716SMatthias Ringwald if (handle == READ_ISO_CONNECTION_HANDLE(hci_stack->hci_packet_buffer)){ 4205098c2716SMatthias Ringwald int release_buffer = hci_stack->iso_fragmentation_tx_active == 0u; 4206098c2716SMatthias Ringwald log_info("drop fragmented ISO data for closed connection, release buffer %u", release_buffer); 4207098c2716SMatthias Ringwald hci_stack->iso_fragmentation_total_size = 0; 4208098c2716SMatthias Ringwald hci_stack->iso_fragmentation_pos = 0; 4209098c2716SMatthias Ringwald if (release_buffer){ 4210098c2716SMatthias Ringwald hci_release_packet_buffer(); 4211098c2716SMatthias Ringwald } 4212098c2716SMatthias Ringwald } 4213098c2716SMatthias Ringwald } 4214098c2716SMatthias Ringwald 42156fd1d2c8SMatthias Ringwald // finalize iso stream for CIS handle 421615a15be3SMatthias Ringwald iso_stream = hci_iso_stream_for_con_handle(handle); 42174ae8623eSMatthias Ringwald if (iso_stream != NULL){ 42184ae8623eSMatthias Ringwald hci_iso_stream_finalize(iso_stream); 42194ae8623eSMatthias Ringwald break; 42204ae8623eSMatthias Ringwald } 42216fd1d2c8SMatthias Ringwald 42226fd1d2c8SMatthias Ringwald // finalize iso stream(s) for ACL handle 42236fd1d2c8SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->iso_streams); 42246fd1d2c8SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 42256fd1d2c8SMatthias Ringwald hci_iso_stream_t * iso_stream = (hci_iso_stream_t *) btstack_linked_list_iterator_next(&it); 42266fd1d2c8SMatthias Ringwald if (iso_stream->acl_handle == handle ) { 42276fd1d2c8SMatthias Ringwald hci_iso_stream_finalize(iso_stream); 42286fd1d2c8SMatthias Ringwald } 42296fd1d2c8SMatthias Ringwald } 42304ae8623eSMatthias Ringwald #endif 42314ae8623eSMatthias Ringwald 423291036612SMatthias Ringwald #if defined(ENABLE_BLE) && defined (ENABLE_HCI_COMMAND_STATUS_DISCARDED_FOR_FAILED_CONNECTIONS_WORKAROUND) 4233f48a5586SMatthias Ringwald if ((handle != HCI_CON_HANDLE_INVALID) && (handle == hci_stack->hci_command_con_handle)){ 4234f48a5586SMatthias Ringwald // we did not receive a HCI Command Complete or HCI Command Status event for the disconnected connection 4235f48a5586SMatthias Ringwald // if needed, we could also track the hci command opcode and simulate a hci command complete with status 4236f48a5586SMatthias Ringwald // but the connection has failed anyway, so for now, we only set the num hci commands back to 1 423705acf48bSMatthias Ringwald log_info("Disconnect for conn handle 0x%04x in pending HCI command, assume command failed", handle); 423805acf48bSMatthias Ringwald hci_stack->hci_command_con_handle = HCI_CON_HANDLE_INVALID; 4239f48a5586SMatthias Ringwald hci_stack->num_cmd_packets = 1; 4240f48a5586SMatthias Ringwald } 4241f48a5586SMatthias Ringwald #endif 4242f48a5586SMatthias Ringwald 4243c6a37cfdSMatthias Ringwald conn = hci_connection_for_handle(handle); 4244c6a37cfdSMatthias Ringwald if (!conn) break; 42451714cbbdSMatthias Ringwald #ifdef ENABLE_CLASSIC 42461714cbbdSMatthias Ringwald // pairing failed if it was ongoing 42471714cbbdSMatthias Ringwald hci_pairing_complete(conn, ERROR_CODE_REMOTE_USER_TERMINATED_CONNECTION); 42481714cbbdSMatthias Ringwald #endif 4249046ec007SMatthias Ringwald 4250046ec007SMatthias Ringwald // emit dedicatd bonding event 4251046ec007SMatthias Ringwald if (conn->bonding_flags & BONDING_EMIT_COMPLETE_ON_DISCONNECT){ 4252046ec007SMatthias Ringwald hci_emit_dedicated_bonding_result(conn->address, conn->bonding_status); 4253046ec007SMatthias Ringwald } 4254046ec007SMatthias Ringwald 4255459d27b9SMatthias Ringwald // mark connection for shutdown, stop timers, reset state 4256459d27b9SMatthias Ringwald conn->state = RECEIVED_DISCONNECTION_COMPLETE; 4257459d27b9SMatthias Ringwald hci_connection_stop_timer(conn); 4258459d27b9SMatthias Ringwald hci_connection_init(conn); 4259459d27b9SMatthias Ringwald 426035454696SMatthias Ringwald #ifdef ENABLE_BLE 4261d70217a2SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 4262046ec007SMatthias Ringwald // re-enable advertisements for le connections if active 42632b6ab3e6SMatthias Ringwald if (hci_is_le_connection(conn)){ 4264bbc366e6SMatthias Ringwald hci_update_advertisements_enabled_for_current_roles(); 42659a2e4658SMatthias Ringwald } 426635454696SMatthias Ringwald #endif 4267d70217a2SMatthias Ringwald #endif 4268ccda6e14S[email protected] break; 42696772a24cSmatthias.ringwald 4270c68bdf90Smatthias.ringwald case HCI_EVENT_HARDWARE_ERROR: 4271313e5f9cSMatthias Ringwald log_error("Hardware Error: 0x%02x", packet[2]); 4272d23838ecSMatthias Ringwald if (hci_stack->hardware_error_callback){ 4273c2e1fa60SMatthias Ringwald (*hci_stack->hardware_error_callback)(packet[2]); 42747586ee35S[email protected] } else { 42757586ee35S[email protected] // if no special requests, just reboot stack 42767586ee35S[email protected] hci_power_control_off(); 42777586ee35S[email protected] hci_power_control_on(); 4278c68bdf90Smatthias.ringwald } 4279c68bdf90Smatthias.ringwald break; 4280c68bdf90Smatthias.ringwald 42810e6f3837SMatthias Ringwald #ifdef ENABLE_CLASSIC 42825cf766e8SMatthias Ringwald case HCI_EVENT_ROLE_CHANGE: 42835cf766e8SMatthias Ringwald if (packet[2]) break; // status != 0 4284c4c88f1bSJakob Krantz reverse_bd_addr(&packet[3], addr); 4285f16129ceSMatthias Ringwald addr_type = BD_ADDR_TYPE_ACL; 4286c4c88f1bSJakob Krantz conn = hci_connection_for_bd_addr_and_type(addr, addr_type); 4287c4c88f1bSJakob Krantz if (!conn) break; 428888f925b1SMatthias Ringwald conn->role = (hci_role_t) packet[9]; 42895cf766e8SMatthias Ringwald break; 42900e6f3837SMatthias Ringwald #endif 42915cf766e8SMatthias Ringwald 429263fa3374SMatthias Ringwald case HCI_EVENT_TRANSPORT_PACKET_SENT: 4293098c2716SMatthias Ringwald // release packet buffer only for asynchronous transport and if there are not further fragments 42944fa24b5fS[email protected] if (hci_transport_synchronous()) { 429563fa3374SMatthias Ringwald log_error("Synchronous HCI Transport shouldn't send HCI_EVENT_TRANSPORT_PACKET_SENT"); 42964fa24b5fS[email protected] return; // instead of break: to avoid re-entering hci_run() 42974fa24b5fS[email protected] } 429881d2bdb2SMatthias Ringwald hci_stack->acl_fragmentation_tx_active = 0; 4299098c2716SMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS 4300098c2716SMatthias Ringwald hci_stack->iso_fragmentation_tx_active = 0; 4301098c2716SMatthias Ringwald if (hci_stack->iso_fragmentation_total_size) break; 4302098c2716SMatthias Ringwald #endif 4303d051460cS[email protected] if (hci_stack->acl_fragmentation_total_size) break; 43045daaa52eSMatthias Ringwald 43055daaa52eSMatthias Ringwald // release packet buffer without HCI_EVENT_TRANSPORT_PACKET_SENT (as it will be later) 43065daaa52eSMatthias Ringwald btstack_assert(hci_stack->hci_packet_buffer_reserved); 43075daaa52eSMatthias Ringwald hci_stack->hci_packet_buffer_reserved = false; 4308701e3307SMatthias Ringwald 43095ade6657SMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS 43105ade6657SMatthias Ringwald hci_iso_notify_can_send_now(); 43115ade6657SMatthias Ringwald #endif 431263fa3374SMatthias Ringwald // L2CAP receives this event via the hci_emit_event below 431363fa3374SMatthias Ringwald 431435454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 431563fa3374SMatthias Ringwald // For SCO, we do the can_send_now_check here 4316701e3307SMatthias Ringwald hci_notify_if_sco_can_send_now(); 431735454696SMatthias Ringwald #endif 43186b4af23dS[email protected] break; 43196b4af23dS[email protected] 432035454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 432163fa3374SMatthias Ringwald case HCI_EVENT_SCO_CAN_SEND_NOW: 432263fa3374SMatthias Ringwald // For SCO, we do the can_send_now_check here 43231972f31fSMatthias Ringwald hci_stack->sco_can_send_now = true; 432463fa3374SMatthias Ringwald hci_notify_if_sco_can_send_now(); 432563fa3374SMatthias Ringwald return; 43261cfb383eSMatthias Ringwald 43271cfb383eSMatthias Ringwald // explode inquriy results for easier consumption 43281cfb383eSMatthias Ringwald case HCI_EVENT_INQUIRY_RESULT: 43291cfb383eSMatthias Ringwald case HCI_EVENT_INQUIRY_RESULT_WITH_RSSI: 43301cfb383eSMatthias Ringwald case HCI_EVENT_EXTENDED_INQUIRY_RESPONSE: 43319784dac1SMatthias Ringwald gap_inquiry_explode(packet, size); 43321cfb383eSMatthias Ringwald break; 433335454696SMatthias Ringwald #endif 433463fa3374SMatthias Ringwald 4335a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE 43365909f7f2Smatthias.ringwald case HCI_EVENT_LE_META: 43375909f7f2Smatthias.ringwald switch (packet[2]){ 4338d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 433957c9da5bS[email protected] case HCI_SUBEVENT_LE_ADVERTISING_REPORT: 43406fab74dbSMatthias Ringwald if (!hci_stack->le_scanning_enabled) break; 434157c9da5bS[email protected] le_handle_advertisement_report(packet, size); 43427bdc6798S[email protected] break; 4343a0698cb4SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 4344a0698cb4SMatthias Ringwald case HCI_SUBEVENT_LE_EXTENDED_ADVERTISING_REPORT: 4345a0698cb4SMatthias Ringwald if (!hci_stack->le_scanning_enabled) break; 4346a0698cb4SMatthias Ringwald le_handle_extended_advertisement_report(packet, size); 4347a0698cb4SMatthias Ringwald break; 4348ce56b945SMatthias Ringwald case HCI_SUBEVENT_LE_PERIODIC_ADVERTISING_SYNC_ESTABLISHMENT: 4349ce56b945SMatthias Ringwald hci_stack->le_periodic_sync_request = LE_CONNECTING_IDLE; 4350ce56b945SMatthias Ringwald hci_stack->le_periodic_sync_state = LE_CONNECTING_IDLE; 4351ce56b945SMatthias Ringwald break; 435289254d99SMatthias Ringwald case HCI_SUBEVENT_LE_ADVERTISING_SET_TERMINATED: 435389254d99SMatthias Ringwald advertising_handle = hci_subevent_le_advertising_set_terminated_get_advertising_handle(packet); 435489254d99SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->le_advertising_sets); 435589254d99SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)) { 435689254d99SMatthias Ringwald le_advertising_set_t *advertising_set = (le_advertising_set_t *) btstack_linked_list_iterator_next(&it); 435789254d99SMatthias Ringwald if (advertising_set->advertising_handle == advertising_handle){ 435889254d99SMatthias Ringwald advertising_set->state &= ~(LE_ADVERTISEMENT_STATE_ACTIVE | LE_ADVERTISEMENT_STATE_ENABLED); 435989254d99SMatthias Ringwald } 436089254d99SMatthias Ringwald } 436189254d99SMatthias Ringwald break; 4362a0698cb4SMatthias Ringwald #endif 4363d70217a2SMatthias Ringwald #endif 43645909f7f2Smatthias.ringwald case HCI_SUBEVENT_LE_CONNECTION_COMPLETE: 436560fb273dSMatthias Ringwald case HCI_SUBEVENT_LE_ENHANCED_CONNECTION_COMPLETE_V1: 436660fb273dSMatthias Ringwald case HCI_SUBEVENT_LE_ENHANCED_CONNECTION_COMPLETE_V2: 4367688bcdb4SMatthias Ringwald hci_handle_le_connection_complete_event(packet); 43685909f7f2Smatthias.ringwald break; 43695909f7f2Smatthias.ringwald 4370f8fbdce0SMatthias Ringwald // log_info("LE buffer size: %u, count %u", little_endian_read_16(packet,6), packet[8]); 4371c9db5c21SMilanka Ringwald case HCI_SUBEVENT_LE_CONNECTION_UPDATE_COMPLETE: 4372c9db5c21SMilanka Ringwald handle = hci_subevent_le_connection_update_complete_get_connection_handle(packet); 4373c9db5c21SMilanka Ringwald conn = hci_connection_for_handle(handle); 4374c9db5c21SMilanka Ringwald if (!conn) break; 4375c9db5c21SMilanka Ringwald conn->le_connection_interval = hci_subevent_le_connection_update_complete_get_conn_interval(packet); 4376c9db5c21SMilanka Ringwald break; 437765a46ef3S[email protected] 437873cd8a2aSMatthias Ringwald case HCI_SUBEVENT_LE_REMOTE_CONNECTION_PARAMETER_REQUEST: 437973cd8a2aSMatthias Ringwald // connection 438073cd8a2aSMatthias Ringwald handle = hci_subevent_le_remote_connection_parameter_request_get_connection_handle(packet); 438173cd8a2aSMatthias Ringwald conn = hci_connection_for_handle(handle); 438273cd8a2aSMatthias Ringwald if (conn) { 438373cd8a2aSMatthias Ringwald // read arguments 438473cd8a2aSMatthias Ringwald uint16_t le_conn_interval_min = hci_subevent_le_remote_connection_parameter_request_get_interval_min(packet); 438573cd8a2aSMatthias Ringwald uint16_t le_conn_interval_max = hci_subevent_le_remote_connection_parameter_request_get_interval_max(packet); 438673cd8a2aSMatthias Ringwald uint16_t le_conn_latency = hci_subevent_le_remote_connection_parameter_request_get_latency(packet); 438773cd8a2aSMatthias Ringwald uint16_t le_supervision_timeout = hci_subevent_le_remote_connection_parameter_request_get_timeout(packet); 438873cd8a2aSMatthias Ringwald 438973cd8a2aSMatthias Ringwald // validate against current connection parameter range 439073cd8a2aSMatthias Ringwald le_connection_parameter_range_t existing_range; 439173cd8a2aSMatthias Ringwald gap_get_connection_parameter_range(&existing_range); 439273cd8a2aSMatthias Ringwald int update_parameter = gap_connection_parameter_range_included(&existing_range, le_conn_interval_min, le_conn_interval_max, le_conn_latency, le_supervision_timeout); 439373cd8a2aSMatthias Ringwald if (update_parameter){ 439473cd8a2aSMatthias Ringwald conn->le_con_parameter_update_state = CON_PARAMETER_UPDATE_REPLY; 439573cd8a2aSMatthias Ringwald conn->le_conn_interval_min = le_conn_interval_min; 439673cd8a2aSMatthias Ringwald conn->le_conn_interval_max = le_conn_interval_max; 439773cd8a2aSMatthias Ringwald conn->le_conn_latency = le_conn_latency; 439873cd8a2aSMatthias Ringwald conn->le_supervision_timeout = le_supervision_timeout; 439973cd8a2aSMatthias Ringwald } else { 4400c3898ca4SMatthias Ringwald conn->le_con_parameter_update_state = CON_PARAMETER_UPDATE_NEGATIVE_REPLY; 440173cd8a2aSMatthias Ringwald } 440273cd8a2aSMatthias Ringwald } 440373cd8a2aSMatthias Ringwald break; 44040f3b27c5SMatthias Ringwald #ifdef ENABLE_LE_LIMIT_ACL_FRAGMENT_BY_MAX_OCTETS 44050f3b27c5SMatthias Ringwald case HCI_SUBEVENT_LE_DATA_LENGTH_CHANGE: 44060f3b27c5SMatthias Ringwald handle = hci_subevent_le_data_length_change_get_connection_handle(packet); 44070f3b27c5SMatthias Ringwald conn = hci_connection_for_handle(handle); 44080f3b27c5SMatthias Ringwald if (conn) { 44090f3b27c5SMatthias Ringwald conn->le_max_tx_octets = hci_subevent_le_data_length_change_get_max_tx_octets(packet); 44100f3b27c5SMatthias Ringwald } 44110f3b27c5SMatthias Ringwald break; 44120f3b27c5SMatthias Ringwald #endif 44134ae8623eSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS 44146fd1d2c8SMatthias Ringwald case HCI_SUBEVENT_LE_CIS_REQUEST: 44156fd1d2c8SMatthias Ringwald // incoming CIS request, allocate iso stream object and cache metadata 44166fd1d2c8SMatthias Ringwald iso_stream = hci_iso_stream_create(HCI_ISO_TYPE_CIS, HCI_ISO_STREAM_W4_USER, 44176fd1d2c8SMatthias Ringwald hci_subevent_le_cis_request_get_cig_id(packet), 44186fd1d2c8SMatthias Ringwald hci_subevent_le_cis_request_get_cis_id(packet)); 44196fd1d2c8SMatthias Ringwald // if there's no memory, gap_cis_accept/gap_cis_reject will fail 44206fd1d2c8SMatthias Ringwald if (iso_stream != NULL){ 44216fd1d2c8SMatthias Ringwald iso_stream->cis_handle = hci_subevent_le_cis_request_get_cis_connection_handle(packet); 44226fd1d2c8SMatthias Ringwald iso_stream->acl_handle = hci_subevent_le_cis_request_get_acl_connection_handle(packet); 44236fd1d2c8SMatthias Ringwald } 44246fd1d2c8SMatthias Ringwald break; 44254ae8623eSMatthias Ringwald case HCI_SUBEVENT_LE_CIS_ESTABLISHED: 44268e58e4f7SMatthias Ringwald if (hci_stack->iso_active_operation_type == HCI_ISO_TYPE_CIS){ 44274ae8623eSMatthias Ringwald handle = hci_subevent_le_cis_established_get_connection_handle(packet); 44284ae8623eSMatthias Ringwald uint8_t status = hci_subevent_le_cis_established_get_status(packet); 44298e58e4f7SMatthias Ringwald iso_stream = hci_iso_stream_for_con_handle(handle); 44308e58e4f7SMatthias Ringwald btstack_assert(iso_stream != NULL); 44317dd97f73SMatthias Ringwald // track connection info 44327dd97f73SMatthias Ringwald iso_stream->number_of_subevents = hci_subevent_le_cis_established_get_nse(packet); 44337dd97f73SMatthias Ringwald iso_stream->burst_number_c_to_p = hci_subevent_le_cis_established_get_bn_c_to_p(packet); 44347dd97f73SMatthias Ringwald iso_stream->burst_number_p_to_c = hci_subevent_le_cis_established_get_bn_p_to_c(packet); 44357dd97f73SMatthias Ringwald iso_stream->flush_timeout_c_to_p = hci_subevent_le_cis_established_get_ft_c_to_p(packet); 44367dd97f73SMatthias Ringwald iso_stream->flush_timeout_p_to_c = hci_subevent_le_cis_established_get_ft_p_to_c(packet); 443726b93350SMatthias Ringwald iso_stream->max_sdu_c_to_p = hci_subevent_le_cis_established_get_max_pdu_c_to_p(packet); 443826b93350SMatthias Ringwald iso_stream->max_sdu_p_to_c = hci_subevent_le_cis_established_get_max_pdu_p_to_c(packet); 44397dd97f73SMatthias Ringwald iso_stream->iso_interval_1250us = hci_subevent_le_cis_established_get_iso_interval(packet); 444026b93350SMatthias Ringwald if (hci_stack->iso_active_operation_group_id == HCI_ISO_GROUP_ID_SINGLE_CIS){ 444126b93350SMatthias Ringwald // CIS Accept by Peripheral 444226b93350SMatthias Ringwald if (status == ERROR_CODE_SUCCESS){ 444326b93350SMatthias Ringwald if (iso_stream->max_sdu_p_to_c > 0){ 444426b93350SMatthias Ringwald // we're peripheral and we will send data 444526b93350SMatthias Ringwald iso_stream->state = HCI_ISO_STREAM_STATE_W2_SETUP_ISO_INPUT; 444626b93350SMatthias Ringwald } else { 444726b93350SMatthias Ringwald // we're peripheral and we will only receive data 444826b93350SMatthias Ringwald iso_stream->state = HCI_ISO_STREAM_STATE_W2_SETUP_ISO_OUTPUT; 444926b93350SMatthias Ringwald } 445026b93350SMatthias Ringwald } else { 445114045fdbSMatthias Ringwald hci_cis_handle_created(iso_stream, status); 445226b93350SMatthias Ringwald } 445326b93350SMatthias Ringwald hci_stack->iso_active_operation_type = HCI_ISO_TYPE_INVALID; 445426b93350SMatthias Ringwald } else { 445526b93350SMatthias Ringwald // CIG Setup by Central 445626b93350SMatthias Ringwald le_audio_cig_t * cig = hci_cig_for_id(hci_stack->iso_active_operation_group_id); 445726b93350SMatthias Ringwald btstack_assert(cig != NULL); 445826b93350SMatthias Ringwald // update iso stream state 44594ae8623eSMatthias Ringwald if (status == ERROR_CODE_SUCCESS){ 44604ae8623eSMatthias Ringwald iso_stream->state = HCI_ISO_STREAM_STATE_ESTABLISHED; 44614ae8623eSMatthias Ringwald } else { 44628e58e4f7SMatthias Ringwald iso_stream->state = HCI_ISO_STREAM_STATE_IDLE; 44634ae8623eSMatthias Ringwald } 44648e58e4f7SMatthias Ringwald // update cig state 4465f06bb90fSMatthias Ringwald uint8_t i; 4466f06bb90fSMatthias Ringwald for (i=0;i<cig->num_cis;i++){ 4467f06bb90fSMatthias Ringwald if (cig->cis_con_handles[i] == handle){ 44683abcd16cSMatthias Ringwald cig->cis_setup_active[i] = false; 4469f9306a1aSMatthias Ringwald if (status == ERROR_CODE_SUCCESS){ 4470f9306a1aSMatthias Ringwald cig->cis_established[i] = true; 4471f9306a1aSMatthias Ringwald } else { 447214045fdbSMatthias Ringwald hci_cis_handle_created(iso_stream, status); 4473f06bb90fSMatthias Ringwald } 4474f06bb90fSMatthias Ringwald } 4475f06bb90fSMatthias Ringwald } 44768e58e4f7SMatthias Ringwald 44778e58e4f7SMatthias Ringwald // trigger iso path setup if complete 44780f0ba168SMatthias Ringwald bool cis_setup_active = false; 4479f9306a1aSMatthias Ringwald for (i=0;i<cig->num_cis;i++){ 44800f0ba168SMatthias Ringwald cis_setup_active |= cig->cis_setup_active[i]; 4481f9306a1aSMatthias Ringwald } 44820f0ba168SMatthias Ringwald if (cis_setup_active == false){ 4483f9306a1aSMatthias Ringwald cig->state_vars.next_cis = 0; 4484f9306a1aSMatthias Ringwald cig->state = LE_AUDIO_CIG_STATE_SETUP_ISO_PATH; 448526b93350SMatthias Ringwald hci_stack->iso_active_operation_type = HCI_ISO_TYPE_INVALID; 448626b93350SMatthias Ringwald } 4487f06bb90fSMatthias Ringwald } 44884ae8623eSMatthias Ringwald } 44897aa35f6aSMatthias Ringwald break; 44907aa35f6aSMatthias Ringwald case HCI_SUBEVENT_LE_CREATE_BIG_COMPLETE: 449126b93350SMatthias Ringwald hci_stack->iso_active_operation_type = HCI_ISO_TYPE_INVALID; 44927aa35f6aSMatthias Ringwald big = hci_big_for_handle(packet[4]); 44937aa35f6aSMatthias Ringwald if (big != NULL){ 44947aa35f6aSMatthias Ringwald uint8_t status = packet[3]; 44957aa35f6aSMatthias Ringwald if (status == ERROR_CODE_SUCCESS){ 44967aa35f6aSMatthias Ringwald // store bis_con_handles and trigger iso path setup 44975fd415a6SMatthias Ringwald uint8_t num_bis = btstack_min(big->num_bis, packet[20]); 44987aa35f6aSMatthias Ringwald uint8_t i; 44997aa35f6aSMatthias Ringwald for (i=0;i<num_bis;i++){ 4500fb16346aSMatthias Ringwald hci_con_handle_t bis_handle = (hci_con_handle_t) little_endian_read_16(packet, 21 + (2 * i)); 4501fb16346aSMatthias Ringwald big->bis_con_handles[i] = bis_handle; 4502fb16346aSMatthias Ringwald // assign bis handle 4503fb16346aSMatthias Ringwald btstack_linked_list_iterator_t it; 4504fb16346aSMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->iso_streams); 4505fb16346aSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 4506fb16346aSMatthias Ringwald hci_iso_stream_t * iso_stream = (hci_iso_stream_t *) btstack_linked_list_iterator_next(&it); 4507fb16346aSMatthias Ringwald if ((iso_stream->state == HCI_ISO_STREAM_STATE_REQUESTED ) && 45088d72db10SMatthias Ringwald (iso_stream->group_id == big->big_handle)){ 4509969d876aSMatthias Ringwald iso_stream->cis_handle = bis_handle; 4510fb16346aSMatthias Ringwald iso_stream->state = HCI_ISO_STREAM_STATE_ESTABLISHED; 4511cd1139aaSMatthias Ringwald break; 4512fb16346aSMatthias Ringwald } 4513fb16346aSMatthias Ringwald } 45147aa35f6aSMatthias Ringwald } 45152a6c0f82SMatthias Ringwald if (big->state == LE_AUDIO_BIG_STATE_W4_ESTABLISHED) { 45167aa35f6aSMatthias Ringwald big->state = LE_AUDIO_BIG_STATE_SETUP_ISO_PATH; 45177aa35f6aSMatthias Ringwald big->state_vars.next_bis = 0; 45182a6c0f82SMatthias Ringwald } 45197aa35f6aSMatthias Ringwald } else { 45202a6c0f82SMatthias Ringwald // create BIG failed or has been stopped by us 4521778463d0SMatthias Ringwald hci_iso_stream_finalize_by_type_and_group_id(HCI_ISO_TYPE_BIS, big->big_handle); 45227aa35f6aSMatthias Ringwald btstack_linked_list_remove(&hci_stack->le_audio_bigs, (btstack_linked_item_t *) big); 45232a6c0f82SMatthias Ringwald if (big->state == LE_AUDIO_BIG_STATE_W4_ESTABLISHED){ 45247aa35f6aSMatthias Ringwald hci_emit_big_created(big, status); 45252a6c0f82SMatthias Ringwald } else { 45262a6c0f82SMatthias Ringwald hci_emit_big_terminated(big); 45272a6c0f82SMatthias Ringwald } 45287aa35f6aSMatthias Ringwald } 45297aa35f6aSMatthias Ringwald } 45307aa35f6aSMatthias Ringwald break; 45317aa35f6aSMatthias Ringwald case HCI_SUBEVENT_LE_TERMINATE_BIG_COMPLETE: 4532c45ca112SMatthias Ringwald hci_stack->iso_active_operation_type = HCI_ISO_TYPE_INVALID; 45337aa35f6aSMatthias Ringwald big = hci_big_for_handle(hci_subevent_le_terminate_big_complete_get_big_handle(packet)); 45347aa35f6aSMatthias Ringwald if (big != NULL){ 4535fb16346aSMatthias Ringwald // finalize associated ISO streams 4536fb16346aSMatthias Ringwald btstack_linked_list_iterator_t it; 4537fb16346aSMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->iso_streams); 4538fb16346aSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 4539fb16346aSMatthias Ringwald hci_iso_stream_t * iso_stream = (hci_iso_stream_t *) btstack_linked_list_iterator_next(&it); 45408d72db10SMatthias Ringwald if (iso_stream->group_id == big->big_handle){ 4541969d876aSMatthias Ringwald log_info("BIG Terminated, big_handle 0x%02x, con handle 0x%04x", iso_stream->group_id, iso_stream->cis_handle); 4542fb16346aSMatthias Ringwald btstack_linked_list_iterator_remove(&it); 4543fb16346aSMatthias Ringwald btstack_memory_hci_iso_stream_free(iso_stream); 4544fb16346aSMatthias Ringwald } 4545fb16346aSMatthias Ringwald } 45467aa35f6aSMatthias Ringwald btstack_linked_list_remove(&hci_stack->le_audio_bigs, (btstack_linked_item_t *) big); 45477aa35f6aSMatthias Ringwald switch (big->state){ 45487aa35f6aSMatthias Ringwald case LE_AUDIO_BIG_STATE_W4_TERMINATED_AFTER_SETUP_FAILED: 45497aa35f6aSMatthias Ringwald hci_emit_big_created(big, big->state_vars.status); 45507aa35f6aSMatthias Ringwald break; 45517aa35f6aSMatthias Ringwald default: 45527aa35f6aSMatthias Ringwald hci_emit_big_terminated(big); 45537aa35f6aSMatthias Ringwald break; 45547aa35f6aSMatthias Ringwald } 45557aa35f6aSMatthias Ringwald } 45567aa35f6aSMatthias Ringwald break; 45572a6c0f82SMatthias Ringwald case HCI_SUBEVENT_LE_BIG_SYNC_ESTABLISHED: 4558c45ca112SMatthias Ringwald hci_stack->iso_active_operation_type = HCI_ISO_TYPE_INVALID; 45592a6c0f82SMatthias Ringwald big_sync = hci_big_sync_for_handle(packet[4]); 45602a6c0f82SMatthias Ringwald if (big_sync != NULL){ 45612a6c0f82SMatthias Ringwald uint8_t status = packet[3]; 45628282d308SMatthias Ringwald uint8_t big_handle = packet[4]; 45632a6c0f82SMatthias Ringwald if (status == ERROR_CODE_SUCCESS){ 45642a6c0f82SMatthias Ringwald // store bis_con_handles and trigger iso path setup 45655fd415a6SMatthias Ringwald uint8_t num_bis = btstack_min(big_sync->num_bis, packet[16]); 45668282d308SMatthias Ringwald uint8_t i; 45672a6c0f82SMatthias Ringwald for (i=0;i<num_bis;i++){ 456802e19895SMatthias Ringwald hci_con_handle_t bis_handle = little_endian_read_16(packet, 17 + (2 * i)); 456902e19895SMatthias Ringwald big_sync->bis_con_handles[i] = bis_handle; 457002e19895SMatthias Ringwald // setup iso_stream_t 457102e19895SMatthias Ringwald btstack_linked_list_iterator_t it; 457202e19895SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->iso_streams); 457302e19895SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 457402e19895SMatthias Ringwald hci_iso_stream_t * iso_stream = (hci_iso_stream_t *) btstack_linked_list_iterator_next(&it); 457502e19895SMatthias Ringwald if ((iso_stream->state == HCI_ISO_STREAM_STATE_REQUESTED ) && 457602e19895SMatthias Ringwald (iso_stream->group_id == big_sync->big_handle)){ 457702e19895SMatthias Ringwald iso_stream->cis_handle = bis_handle; 457802e19895SMatthias Ringwald iso_stream->state = HCI_ISO_STREAM_STATE_ESTABLISHED; 457902e19895SMatthias Ringwald break; 458002e19895SMatthias Ringwald } 458102e19895SMatthias Ringwald } 45822a6c0f82SMatthias Ringwald } 45832a6c0f82SMatthias Ringwald if (big_sync->state == LE_AUDIO_BIG_STATE_W4_ESTABLISHED) { 45842a6c0f82SMatthias Ringwald // trigger iso path setup 45852a6c0f82SMatthias Ringwald big_sync->state = LE_AUDIO_BIG_STATE_SETUP_ISO_PATH; 45862a6c0f82SMatthias Ringwald big_sync->state_vars.next_bis = 0; 45872a6c0f82SMatthias Ringwald } 45882a6c0f82SMatthias Ringwald } else { 45892a6c0f82SMatthias Ringwald // create BIG Sync failed or has been stopped by us 45902a6c0f82SMatthias Ringwald btstack_linked_list_remove(&hci_stack->le_audio_big_syncs, (btstack_linked_item_t *) big_sync); 45912a6c0f82SMatthias Ringwald if (big_sync->state == LE_AUDIO_BIG_STATE_W4_ESTABLISHED) { 45922a6c0f82SMatthias Ringwald hci_emit_big_sync_created(big_sync, status); 45932a6c0f82SMatthias Ringwald } else { 4594d04a9afcSMatthias Ringwald hci_emit_big_sync_stopped(big_handle); 45952a6c0f82SMatthias Ringwald } 45962a6c0f82SMatthias Ringwald } 45972a6c0f82SMatthias Ringwald } 45982a6c0f82SMatthias Ringwald break; 45992a6c0f82SMatthias Ringwald case HCI_SUBEVENT_LE_BIG_SYNC_LOST: 4600c45ca112SMatthias Ringwald hci_stack->iso_active_operation_type = HCI_ISO_TYPE_INVALID; 46012a6c0f82SMatthias Ringwald big_sync = hci_big_sync_for_handle(packet[4]); 46022a6c0f82SMatthias Ringwald if (big_sync != NULL){ 4603d04a9afcSMatthias Ringwald uint8_t big_handle = packet[4]; 46042a6c0f82SMatthias Ringwald btstack_linked_list_remove(&hci_stack->le_audio_big_syncs, (btstack_linked_item_t *) big_sync); 4605d04a9afcSMatthias Ringwald hci_emit_big_sync_stopped(big_handle); 46062a6c0f82SMatthias Ringwald } 46072a6c0f82SMatthias Ringwald break; 46084ae8623eSMatthias Ringwald #endif 46095909f7f2Smatthias.ringwald default: 46105909f7f2Smatthias.ringwald break; 46115909f7f2Smatthias.ringwald } 46125909f7f2Smatthias.ringwald break; 46135909f7f2Smatthias.ringwald #endif 46140b36101dSMatthias Ringwald case HCI_EVENT_VENDOR_SPECIFIC: 46150b36101dSMatthias Ringwald // Vendor specific commands often create vendor specific event instead of num completed packets 46160b36101dSMatthias Ringwald // To avoid getting stuck as num_cmds_packets is zero, reset it to 1 for controllers with this behaviour 46170b36101dSMatthias Ringwald switch (hci_stack->manufacturer){ 46180b36101dSMatthias Ringwald case BLUETOOTH_COMPANY_ID_CAMBRIDGE_SILICON_RADIO: 46190b36101dSMatthias Ringwald hci_stack->num_cmd_packets = 1; 46200b36101dSMatthias Ringwald break; 46210b36101dSMatthias Ringwald default: 46220b36101dSMatthias Ringwald break; 46230b36101dSMatthias Ringwald } 46240b36101dSMatthias Ringwald break; 46256772a24cSmatthias.ringwald default: 46266772a24cSmatthias.ringwald break; 4627fe1ed1b8Smatthias.ringwald } 4628fe1ed1b8Smatthias.ringwald 462967c6c9dcSMatthias Ringwald handle_event_for_current_stack_state(packet, size); 463089db417bSmatthias.ringwald 463186805605S[email protected] // notify upper stack 4632d6b06661SMatthias Ringwald hci_emit_event(packet, size, 0); // don't dump, already happened in packet handler 463394ab26f8Smatthias.ringwald 463486805605S[email protected] // moved here to give upper stack a chance to close down everything with hci_connection_t intact 4635797b2a3fSMatthias Ringwald if ((hci_event_packet_get_type(packet) == HCI_EVENT_DISCONNECTION_COMPLETE) && (packet[2] == 0)){ 4636f8fbdce0SMatthias Ringwald handle = little_endian_read_16(packet, 3); 463705ae8de3SMatthias Ringwald hci_connection_t * aConn = hci_connection_for_handle(handle); 4638046ec007SMatthias Ringwald // discard connection if app did not trigger a reconnect in the event handler 4639797b2a3fSMatthias Ringwald if (aConn && aConn->state == RECEIVED_DISCONNECTION_COMPLETE){ 464005ae8de3SMatthias Ringwald hci_shutdown_connection(aConn); 4641b0136355SMatthias Ringwald } 46428ad9cf99SMatthias Ringwald #ifdef ENABLE_CONTROLLER_DUMP_PACKETS 46438ad9cf99SMatthias Ringwald hci_controller_dump_packets(); 46448ad9cf99SMatthias Ringwald #endif 464586805605S[email protected] } 464686805605S[email protected] 464794ab26f8Smatthias.ringwald // execute main loop 464894ab26f8Smatthias.ringwald hci_run(); 464916833f0aSmatthias.ringwald } 465016833f0aSmatthias.ringwald 465135454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 46526f28d2eeSMatthias Ringwald 4653c91d150bS[email protected] static void sco_handler(uint8_t * packet, uint16_t size){ 46540b3f95dfSMatthias Ringwald // lookup connection struct 46552b838201SMatthias Ringwald hci_con_handle_t con_handle = READ_SCO_CONNECTION_HANDLE(packet); 46562b838201SMatthias Ringwald hci_connection_t * conn = hci_connection_for_handle(con_handle); 46570b3f95dfSMatthias Ringwald if (!conn) return; 46580b3f95dfSMatthias Ringwald 46596be3cf7fSMatthias Ringwald #ifdef ENABLE_SCO_OVER_HCI 4660760b20efSMatthias Ringwald // CSR 8811 prefixes 60 byte SCO packet in transparent mode with 20 zero bytes -> skip first 20 payload bytes 4661760b20efSMatthias Ringwald if (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_CAMBRIDGE_SILICON_RADIO){ 4662a1df452eSMatthias Ringwald if ((size == 83) && ((hci_stack->sco_voice_setting_active & 0x03) == 0x03)){ 4663760b20efSMatthias Ringwald packet[2] = 0x3c; 4664760b20efSMatthias Ringwald memmove(&packet[3], &packet[23], 63); 4665760b20efSMatthias Ringwald size = 63; 46660b3f95dfSMatthias Ringwald } 46670b3f95dfSMatthias Ringwald } 4668760b20efSMatthias Ringwald 4669f234b250SMatthias Ringwald if (hci_have_usb_transport()){ 4670f234b250SMatthias Ringwald // Nothing to do 4671f234b250SMatthias Ringwald } else { 467249205f5dSMatthias Ringwald // log_debug("sco flow %u, handle 0x%04x, packets sent %u, bytes send %u", hci_stack->synchronous_flow_control_enabled, (int) con_handle, conn->num_packets_sent, conn->num_sco_bytes_sent); 4673760b20efSMatthias Ringwald if (hci_stack->synchronous_flow_control_enabled == 0){ 4674fa7f2dfdSMatthias Ringwald // ignore received SCO packets for the first 10 ms, then allow for max two HCI_SCO_2EV3_SIZE packets 4675b1202089SMatthias Ringwald uint8_t max_sco_packets = (uint8_t) btstack_min(2 * HCI_SCO_2EV3_SIZE / conn->sco_payload_length, hci_stack->sco_packets_total_num); 4676fa7f2dfdSMatthias Ringwald if (conn->sco_tx_active == 0){ 4677fa7f2dfdSMatthias Ringwald if (btstack_time_delta(btstack_run_loop_get_time_ms(), conn->sco_established_ms) > 10){ 4678fa7f2dfdSMatthias Ringwald conn->sco_tx_active = 1; 4679fa7f2dfdSMatthias Ringwald conn->sco_tx_ready = max_sco_packets; 4680fa7f2dfdSMatthias Ringwald log_info("Start SCO sending, %u packets", conn->sco_tx_ready); 4681fa7f2dfdSMatthias Ringwald hci_notify_if_sco_can_send_now(); 468259c33575SMatthias Ringwald } 468359c33575SMatthias Ringwald } else { 4684fa7f2dfdSMatthias Ringwald if (conn->sco_tx_ready < max_sco_packets){ 4685fa7f2dfdSMatthias Ringwald conn->sco_tx_ready++; 468659c33575SMatthias Ringwald } 4687fa7f2dfdSMatthias Ringwald hci_notify_if_sco_can_send_now(); 46886f28d2eeSMatthias Ringwald } 4689760b20efSMatthias Ringwald } 4690f234b250SMatthias Ringwald } 46916be3cf7fSMatthias Ringwald #endif 46926be3cf7fSMatthias Ringwald 46930b3f95dfSMatthias Ringwald // deliver to app 46940b3f95dfSMatthias Ringwald if (hci_stack->sco_packet_handler) { 46950b3f95dfSMatthias Ringwald hci_stack->sco_packet_handler(HCI_SCO_DATA_PACKET, 0, packet, size); 46960b3f95dfSMatthias Ringwald } 46970b3f95dfSMatthias Ringwald 4698ed325439SMatthias Ringwald #ifdef HAVE_SCO_TRANSPORT 4699ed325439SMatthias Ringwald // We can send one packet for each received packet 4700ed325439SMatthias Ringwald conn->sco_tx_ready++; 4701ed325439SMatthias Ringwald hci_notify_if_sco_can_send_now(); 4702ed325439SMatthias Ringwald #endif 4703ed325439SMatthias Ringwald 47040b3f95dfSMatthias Ringwald #ifdef ENABLE_HCI_CONTROLLER_TO_HOST_FLOW_CONTROL 47052b838201SMatthias Ringwald conn->num_packets_completed++; 47062b838201SMatthias Ringwald hci_stack->host_completed_packets = 1; 47072b838201SMatthias Ringwald hci_run(); 47082b838201SMatthias Ringwald #endif 4709c91d150bS[email protected] } 471035454696SMatthias Ringwald #endif 4711c91d150bS[email protected] 47120a57e69fSmatthias.ringwald static void packet_handler(uint8_t packet_type, uint8_t *packet, uint16_t size){ 47134248f37eSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS 47144248f37eSMatthias Ringwald // propagate ISO packets received as ACL 4715062276f9SMatthias Ringwald hci_iso_stream_t * iso_stream = NULL; 47164248f37eSMatthias Ringwald if ((packet_type == HCI_ACL_DATA_PACKET) && (size >= HCI_ACL_HEADER_SIZE)){ 47174248f37eSMatthias Ringwald hci_con_handle_t con_handle = READ_ACL_CONNECTION_HANDLE(packet); 47184248f37eSMatthias Ringwald iso_stream = hci_iso_stream_for_con_handle(con_handle); 47194248f37eSMatthias Ringwald if (iso_stream != NULL){ 47204248f37eSMatthias Ringwald packet_type = HCI_ISO_DATA_PACKET; 47214248f37eSMatthias Ringwald } 47224248f37eSMatthias Ringwald } 47234248f37eSMatthias Ringwald #endif 47244248f37eSMatthias Ringwald 47255bb5bc3eS[email protected] hci_dump_packet(packet_type, 1, packet, size); 472610e830c9Smatthias.ringwald switch (packet_type) { 472710e830c9Smatthias.ringwald case HCI_EVENT_PACKET: 472810e830c9Smatthias.ringwald event_handler(packet, size); 472910e830c9Smatthias.ringwald break; 473010e830c9Smatthias.ringwald case HCI_ACL_DATA_PACKET: 473110e830c9Smatthias.ringwald acl_handler(packet, size); 473210e830c9Smatthias.ringwald break; 473335454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 4734c91d150bS[email protected] case HCI_SCO_DATA_PACKET: 4735c91d150bS[email protected] sco_handler(packet, size); 4736202c8a4cSMatthias Ringwald break; 473735454696SMatthias Ringwald #endif 47380a8cccd5SMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS 47395027c498SMatthias Ringwald case HCI_ISO_DATA_PACKET: 4740750818acSMatthias Ringwald if ((iso_stream == NULL) && (size >= HCI_ISO_HEADER_SIZE)){ 4741750818acSMatthias Ringwald hci_con_handle_t con_handle = READ_ISO_CONNECTION_HANDLE(packet); 4742750818acSMatthias Ringwald iso_stream = hci_iso_stream_for_con_handle(con_handle); 4743750818acSMatthias Ringwald } 4744750818acSMatthias Ringwald hci_iso_packet_handler(iso_stream, packet, size); 47455027c498SMatthias Ringwald break; 47465027c498SMatthias Ringwald #endif 474710e830c9Smatthias.ringwald default: 474810e830c9Smatthias.ringwald break; 474910e830c9Smatthias.ringwald } 475010e830c9Smatthias.ringwald } 475110e830c9Smatthias.ringwald 4752d6b06661SMatthias Ringwald /** 4753d6b06661SMatthias Ringwald * @brief Add event packet handler. 4754d6b06661SMatthias Ringwald */ 4755d6b06661SMatthias Ringwald void hci_add_event_handler(btstack_packet_callback_registration_t * callback_handler){ 4756d6b06661SMatthias Ringwald btstack_linked_list_add_tail(&hci_stack->event_handlers, (btstack_linked_item_t*) callback_handler); 4757d6b06661SMatthias Ringwald } 4758d6b06661SMatthias Ringwald 475967f708e0SMatthias Ringwald /** 476067f708e0SMatthias Ringwald * @brief Remove event packet handler. 476167f708e0SMatthias Ringwald */ 476267f708e0SMatthias Ringwald void hci_remove_event_handler(btstack_packet_callback_registration_t * callback_handler){ 476367f708e0SMatthias Ringwald btstack_linked_list_remove(&hci_stack->event_handlers, (btstack_linked_item_t*) callback_handler); 476467f708e0SMatthias Ringwald } 4765d6b06661SMatthias Ringwald 4766fcadd0caSmatthias.ringwald /** Register HCI packet handlers */ 47673d50b4baSMatthias Ringwald void hci_register_acl_packet_handler(btstack_packet_handler_t handler){ 4768fb37a842SMatthias Ringwald hci_stack->acl_packet_handler = handler; 476916833f0aSmatthias.ringwald } 477016833f0aSmatthias.ringwald 477135454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 47728abbe8b5SMatthias Ringwald /** 47738abbe8b5SMatthias Ringwald * @brief Registers a packet handler for SCO data. Used for HSP and HFP profiles. 47748abbe8b5SMatthias Ringwald */ 47753d50b4baSMatthias Ringwald void hci_register_sco_packet_handler(btstack_packet_handler_t handler){ 47768abbe8b5SMatthias Ringwald hci_stack->sco_packet_handler = handler; 47778abbe8b5SMatthias Ringwald } 477835454696SMatthias Ringwald #endif 47798abbe8b5SMatthias Ringwald 47800a8cccd5SMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS 47815027c498SMatthias Ringwald void hci_register_iso_packet_handler(btstack_packet_handler_t handler){ 47825027c498SMatthias Ringwald hci_stack->iso_packet_handler = handler; 47835027c498SMatthias Ringwald } 47845027c498SMatthias Ringwald #endif 47855027c498SMatthias Ringwald 478671de195eSMatthias Ringwald static void hci_state_reset(void){ 4787595bdbfbS[email protected] // no connections yet 4788595bdbfbS[email protected] hci_stack->connections = NULL; 478974308b23Smatthias.ringwald 479074308b23Smatthias.ringwald // keep discoverable/connectable as this has been requested by the client(s) 479174308b23Smatthias.ringwald // hci_stack->discoverable = 0; 479274308b23Smatthias.ringwald // hci_stack->connectable = 0; 479374308b23Smatthias.ringwald // hci_stack->bondable = 1; 4794b95a5a35SMatthias Ringwald // hci_stack->own_addr_type = 0; 4795595bdbfbS[email protected] 479644935e40S[email protected] // buffer is free 479702c7fc01SMatthias Ringwald hci_stack->hci_packet_buffer_reserved = false; 479844935e40S[email protected] 4799595bdbfbS[email protected] // no pending cmds 4800595bdbfbS[email protected] hci_stack->decline_reason = 0; 4801595bdbfbS[email protected] 4802c214d65bSMatthias Ringwald hci_stack->secure_connections_active = false; 4803c214d65bSMatthias Ringwald 4804bea424a5SMatthias Ringwald #ifdef ENABLE_CLASSIC 4805496bb884SMatthias Ringwald hci_stack->inquiry_lap = GAP_IAC_GENERAL_INQUIRY; 480632a12730SMatthias Ringwald 4807baa4881eSMatthias Ringwald hci_stack->gap_tasks_classic = 480859d59ecfSMatthias Ringwald GAP_TASK_SET_DEFAULT_LINK_POLICY | 480959d59ecfSMatthias Ringwald GAP_TASK_SET_CLASS_OF_DEVICE | 481059d59ecfSMatthias Ringwald GAP_TASK_SET_LOCAL_NAME | 4811bc2dcc03SMatthias Ringwald GAP_TASK_SET_EIR_DATA | 481232a12730SMatthias Ringwald GAP_TASK_WRITE_SCAN_ENABLE | 481332a12730SMatthias Ringwald GAP_TASK_WRITE_PAGE_TIMEOUT; 4814bea424a5SMatthias Ringwald #endif 4815bea424a5SMatthias Ringwald 4816cf01e888SMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB 48178d5f0979SMatthias Ringwald hci_stack->classic_read_local_oob_data = false; 48181ae74bf3SMatthias Ringwald hci_stack->classic_oob_con_handle = HCI_CON_HANDLE_INVALID; 4819cf01e888SMatthias Ringwald #endif 4820cf01e888SMatthias Ringwald 4821595bdbfbS[email protected] // LE 4822b95a5a35SMatthias Ringwald #ifdef ENABLE_BLE 4823b95a5a35SMatthias Ringwald memset(hci_stack->le_random_address, 0, 6); 4824b95a5a35SMatthias Ringwald hci_stack->le_random_address_set = 0; 4825d70217a2SMatthias Ringwald #endif 4826d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 4827a61834b6SMatthias Ringwald hci_stack->le_scanning_active = false; 482873799937SMatthias Ringwald hci_stack->le_scanning_param_update = true; 4829b04dfa37SMatthias Ringwald hci_stack->le_connecting_state = LE_CONNECTING_IDLE; 4830d5b1a89eSMatthias Ringwald hci_stack->le_connecting_request = LE_CONNECTING_IDLE; 4831e83201bcSMatthias Ringwald hci_stack->le_whitelist_capacity = 0; 48324bafedd5SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 48334bafedd5SMatthias Ringwald hci_stack->le_periodic_terminate_sync_handle = HCI_CON_HANDLE_INVALID; 48344bafedd5SMatthias Ringwald #endif 4835d70217a2SMatthias Ringwald #endif 4836a61834b6SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 4837935aa76eSMatthias Ringwald hci_stack->le_advertisements_state &= ~LE_ADVERTISEMENT_STATE_ACTIVE; 48386bf435a6SMatthias Ringwald if ((hci_stack->le_advertisements_state & LE_ADVERTISEMENT_STATE_PARAMS_SET) != 0){ 4839a61834b6SMatthias Ringwald hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_SET_PARAMS; 4840a61834b6SMatthias Ringwald } 4841a61834b6SMatthias Ringwald if (hci_stack->le_advertisements_data != NULL){ 4842a61834b6SMatthias Ringwald hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_SET_ADV_DATA; 4843a61834b6SMatthias Ringwald } 4844a61834b6SMatthias Ringwald #endif 4845d320e123SMatthias Ringwald #ifdef ENABLE_LE_PRIVACY_ADDRESS_RESOLUTION 4846d320e123SMatthias Ringwald hci_stack->le_resolving_list_state = LE_RESOLVING_LIST_SEND_ENABLE_ADDRESS_RESOLUTION; 4847d320e123SMatthias Ringwald #endif 484840f86dfdSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS 484926b93350SMatthias Ringwald hci_stack->iso_active_operation_type = HCI_ISO_TYPE_INVALID; 4850d75a6bbfSMatthias Ringwald hci_stack->iso_active_operation_group_id = HCI_ISO_GROUP_ID_INVALID; 485140f86dfdSMatthias Ringwald #endif 485291036612SMatthias Ringwald #ifdef ENABLE_HCI_COMMAND_STATUS_DISCARDED_FOR_FAILED_CONNECTIONS_WORKAROUND 4853f48a5586SMatthias Ringwald hci_stack->hci_command_con_handle = HCI_CON_HANDLE_INVALID; 4854f48a5586SMatthias Ringwald #endif 4855595bdbfbS[email protected] } 4856595bdbfbS[email protected] 485735454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 48582d5e09d6SMatthias Ringwald /** 48592d5e09d6SMatthias Ringwald * @brief Configure Bluetooth hardware control. Has to be called before power on. 48602d5e09d6SMatthias Ringwald */ 48612d5e09d6SMatthias Ringwald void hci_set_link_key_db(btstack_link_key_db_t const * link_key_db){ 48622d5e09d6SMatthias Ringwald // store and open remote device db 48632d5e09d6SMatthias Ringwald hci_stack->link_key_db = link_key_db; 48642d5e09d6SMatthias Ringwald if (hci_stack->link_key_db) { 48652d5e09d6SMatthias Ringwald hci_stack->link_key_db->open(); 48662d5e09d6SMatthias Ringwald } 48672d5e09d6SMatthias Ringwald } 486835454696SMatthias Ringwald #endif 48692d5e09d6SMatthias Ringwald 48702d5e09d6SMatthias Ringwald void hci_init(const hci_transport_t *transport, const void *config){ 4871475c8125Smatthias.ringwald 48723a9fb326S[email protected] #ifdef HAVE_MALLOC 48733a9fb326S[email protected] if (!hci_stack) { 48743a9fb326S[email protected] hci_stack = (hci_stack_t*) malloc(sizeof(hci_stack_t)); 48753a9fb326S[email protected] } 4876b1202089SMatthias Ringwald btstack_assert(hci_stack != NULL); 48773a9fb326S[email protected] #else 48783a9fb326S[email protected] hci_stack = &hci_stack_static; 48793a9fb326S[email protected] #endif 488066fb9560S[email protected] memset(hci_stack, 0, sizeof(hci_stack_t)); 48813a9fb326S[email protected] 4882475c8125Smatthias.ringwald // reference to use transport layer implementation 48833a9fb326S[email protected] hci_stack->hci_transport = transport; 4884475c8125Smatthias.ringwald 488511e23e5fSmatthias.ringwald // reference to used config 48863a9fb326S[email protected] hci_stack->config = config; 488711e23e5fSmatthias.ringwald 488826a9b6daSMatthias Ringwald // setup pointer for outgoing packet buffer 488926a9b6daSMatthias Ringwald hci_stack->hci_packet_buffer = &hci_stack->hci_packet_buffer_data[HCI_OUTGOING_PRE_BUFFER_SIZE]; 489026a9b6daSMatthias Ringwald 48918fcba05dSmatthias.ringwald // max acl payload size defined in config.h 48923a9fb326S[email protected] hci_stack->acl_data_packet_length = HCI_ACL_PAYLOAD_SIZE; 48938fcba05dSmatthias.ringwald 489416833f0aSmatthias.ringwald // register packet handlers with transport 489510e830c9Smatthias.ringwald transport->register_packet_handler(&packet_handler); 4896f5454fc6Smatthias.ringwald 48973a9fb326S[email protected] hci_stack->state = HCI_STATE_OFF; 4898e2386ba1S[email protected] 4899e2386ba1S[email protected] // class of device 49003a9fb326S[email protected] hci_stack->class_of_device = 0x007a020c; // Smartphone 4901a45d6b9fS[email protected] 4902f20168b8Smatthias.ringwald // bondable by default 4903f20168b8Smatthias.ringwald hci_stack->bondable = 1; 4904f20168b8Smatthias.ringwald 4905e9f343c8SMatthias Ringwald #ifdef ENABLE_CLASSIC 490663168530SMatthias Ringwald // classic name 490763168530SMatthias Ringwald hci_stack->local_name = default_classic_name; 4908c4c88f1bSJakob Krantz 4909c4c88f1bSJakob Krantz // Master slave policy 4910c4c88f1bSJakob Krantz hci_stack->master_slave_policy = 1; 4911170fafaeSMatthias Ringwald 4912b4eb4420SMatthias Ringwald // Allow Role Switch 4913b4eb4420SMatthias Ringwald hci_stack->allow_role_switch = 1; 4914b4eb4420SMatthias Ringwald 491578315a58SMatthias Ringwald // Default / minimum security level = 2 491678315a58SMatthias Ringwald hci_stack->gap_security_level = LEVEL_2; 491778315a58SMatthias Ringwald 49185dbec6b3SMatthias Ringwald // Default Security Mode 4 49195dbec6b3SMatthias Ringwald hci_stack->gap_security_mode = GAP_SECURITY_MODE_4; 49205dbec6b3SMatthias Ringwald 4921cd345294SMatthias Ringwald // Errata-11838 mandates 7 bytes for GAP Security Level 1-3 4922cd345294SMatthias Ringwald hci_stack->gap_required_encyrption_key_size = 7; 4923d821984bSMatthias Ringwald 4924d821984bSMatthias Ringwald // Link Supervision Timeout 4925d821984bSMatthias Ringwald hci_stack->link_supervision_timeout = HCI_LINK_SUPERVISION_TIMEOUT_DEFAULT; 4926d821984bSMatthias Ringwald 4927c874aa46SMatthias Ringwald // Page Timeout 4928c874aa46SMatthias Ringwald hci_stack->page_timeout = 0x6000; // ca. 15 sec 4929c874aa46SMatthias Ringwald 4930028ead5eSMatthias Ringwald // All ACL packet types are enabledh 4931028ead5eSMatthias Ringwald hci_stack->enabled_packet_types_acl = ACL_PACKET_TYPES_ALL; 4932e9f343c8SMatthias Ringwald #endif 493363168530SMatthias Ringwald 493463048403S[email protected] // Secure Simple Pairing default: enable, no I/O capabilities, general bonding, mitm not required, auto accept 49353a9fb326S[email protected] hci_stack->ssp_enable = 1; 49363a9fb326S[email protected] hci_stack->ssp_io_capability = SSP_IO_CAPABILITY_NO_INPUT_NO_OUTPUT; 49373a9fb326S[email protected] hci_stack->ssp_authentication_requirement = SSP_IO_AUTHREQ_MITM_PROTECTION_NOT_REQUIRED_GENERAL_BONDING; 49383a9fb326S[email protected] hci_stack->ssp_auto_accept = 1; 493969a97523S[email protected] 49405d23aae8SMatthias Ringwald // Secure Connections: enable (requires support from Controller) 49415d23aae8SMatthias Ringwald hci_stack->secure_connections_enable = true; 49425d23aae8SMatthias Ringwald 4943fac2e2feSMatthias Ringwald // voice setting - signed 16 bit pcm data with CVSD over the air 4944fac2e2feSMatthias Ringwald hci_stack->sco_voice_setting = 0x60; 4945d950d659SMatthias Ringwald 49460c2c5f79SMatthias Ringwald #ifdef ENABLE_BLE 4947cbe54ab2SJakob Krantz hci_stack->le_connection_scan_interval = 0x0060; // 60 ms 4948cbe54ab2SJakob Krantz hci_stack->le_connection_scan_window = 0x0030; // 30 ms 4949831711daSMatthias Ringwald hci_stack->le_connection_interval_min = 0x0008; // 10 ms 4950831711daSMatthias Ringwald hci_stack->le_connection_interval_max = 0x0018; // 30 ms 4951831711daSMatthias Ringwald hci_stack->le_connection_latency = 4; // 4 4952831711daSMatthias Ringwald hci_stack->le_supervision_timeout = 0x0048; // 720 ms 495324d14ae3SMatthias Ringwald hci_stack->le_minimum_ce_length = 0; // 0 ms 495424d14ae3SMatthias Ringwald hci_stack->le_maximum_ce_length = 0; // 0 ms 49550c2c5f79SMatthias Ringwald #endif 49560c2c5f79SMatthias Ringwald 49570c2c5f79SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 49587eb5b27eSMatthias Ringwald hci_stack->le_connection_phys = 0x01; // LE 1M PHY 49597261e5d8SMatthias Ringwald 49607261e5d8SMatthias Ringwald // default LE Scanning 49617eb5b27eSMatthias Ringwald hci_stack->le_scan_type = 0x01; // active 49628b69e4c7SMatthias Ringwald hci_stack->le_scan_interval = 0x1e0; // 300 ms 49638b69e4c7SMatthias Ringwald hci_stack->le_scan_window = 0x30; // 30 ms 49647eb5b27eSMatthias Ringwald hci_stack->le_scan_phys = 0x01; // LE 1M PHY 4965831711daSMatthias Ringwald #endif 4966831711daSMatthias Ringwald 49672b6ab3e6SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 49682b6ab3e6SMatthias Ringwald hci_stack->le_max_number_peripheral_connections = 1; // only single connection as peripheral 4969ee605458SMatthias Ringwald 4970ee605458SMatthias Ringwald // default advertising parameters from Core v5.4 -- needed to use random address without prior adv setup 4971ee605458SMatthias Ringwald hci_stack->le_advertisements_interval_min = 0x0800; 4972ee605458SMatthias Ringwald hci_stack->le_advertisements_interval_max = 0x0800; 4973ee605458SMatthias Ringwald hci_stack->le_advertisements_type = 0; 4974ee605458SMatthias Ringwald hci_stack->le_own_addr_type = BD_ADDR_TYPE_LE_PUBLIC; 4975ee605458SMatthias Ringwald hci_stack->le_advertisements_direct_address_type = BD_ADDR_TYPE_LE_PUBLIC; 4976ee605458SMatthias Ringwald hci_stack->le_advertisements_channel_map = 0x07; 4977ee605458SMatthias Ringwald hci_stack->le_advertisements_filter_policy = 0; 49782b6ab3e6SMatthias Ringwald #endif 49792b6ab3e6SMatthias Ringwald 4980831711daSMatthias Ringwald // connection parameter range used to answer connection parameter update requests in l2cap 4981831711daSMatthias Ringwald hci_stack->le_connection_parameter_range.le_conn_interval_min = 6; 4982831711daSMatthias Ringwald hci_stack->le_connection_parameter_range.le_conn_interval_max = 3200; 4983831711daSMatthias Ringwald hci_stack->le_connection_parameter_range.le_conn_latency_min = 0; 4984831711daSMatthias Ringwald hci_stack->le_connection_parameter_range.le_conn_latency_max = 500; 4985831711daSMatthias Ringwald hci_stack->le_connection_parameter_range.le_supervision_timeout_min = 10; 4986831711daSMatthias Ringwald hci_stack->le_connection_parameter_range.le_supervision_timeout_max = 3200; 4987831711daSMatthias Ringwald 498801d4f05fSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS 498901d4f05fSMatthias Ringwald hci_stack->iso_packets_to_queue = 1; 499001d4f05fSMatthias Ringwald #endif 499101d4f05fSMatthias Ringwald 4992c3d19a30SMatthias Ringwald #ifdef ENABLE_LE_PRIVACY_ADDRESS_RESOLUTION 4993c3d19a30SMatthias Ringwald hci_stack->le_privacy_mode = LE_PRIVACY_MODE_DEVICE; 4994c3d19a30SMatthias Ringwald #endif 4995c3d19a30SMatthias Ringwald 4996595bdbfbS[email protected] hci_state_reset(); 4997475c8125Smatthias.ringwald } 4998475c8125Smatthias.ringwald 49994688f216SMatthias Ringwald void hci_deinit(void){ 5000b02cfc15SMatthias Ringwald btstack_run_loop_remove_timer(&hci_stack->timeout); 50014688f216SMatthias Ringwald #ifdef HAVE_MALLOC 50024688f216SMatthias Ringwald if (hci_stack) { 50034688f216SMatthias Ringwald free(hci_stack); 50044688f216SMatthias Ringwald } 50054688f216SMatthias Ringwald #endif 50064688f216SMatthias Ringwald hci_stack = NULL; 5007b5bbcbf4SMatthias Ringwald 5008b5bbcbf4SMatthias Ringwald #ifdef ENABLE_CLASSIC 50094688f216SMatthias Ringwald disable_l2cap_timeouts = 0; 5010b5bbcbf4SMatthias Ringwald #endif 50114688f216SMatthias Ringwald } 50124688f216SMatthias Ringwald 50133fb36a29SMatthias Ringwald /** 50143fb36a29SMatthias Ringwald * @brief Configure Bluetooth chipset driver. Has to be called before power on, or right after receiving the local version information 50153fb36a29SMatthias Ringwald */ 50163fb36a29SMatthias Ringwald void hci_set_chipset(const btstack_chipset_t *chipset_driver){ 50173fb36a29SMatthias Ringwald hci_stack->chipset = chipset_driver; 50183fb36a29SMatthias Ringwald 50193fb36a29SMatthias Ringwald // reset chipset driver - init is also called on power_up 50203fb36a29SMatthias Ringwald if (hci_stack->chipset && hci_stack->chipset->init){ 50213fb36a29SMatthias Ringwald hci_stack->chipset->init(hci_stack->config); 50223fb36a29SMatthias Ringwald } 50233fb36a29SMatthias Ringwald } 50243fb36a29SMatthias Ringwald 50256fe16221SMatthias Ringwald void hci_enable_custom_pre_init(void){ 50266fe16221SMatthias Ringwald hci_stack->chipset_pre_init = true; 50276fe16221SMatthias Ringwald } 50286fe16221SMatthias Ringwald 5029fb55bd0aSMatthias Ringwald /** 5030d0b87befSMatthias Ringwald * @brief Configure Bluetooth hardware control. Has to be called after hci_init() but before power on. 5031fb55bd0aSMatthias Ringwald */ 5032fb55bd0aSMatthias Ringwald void hci_set_control(const btstack_control_t *hardware_control){ 5033fb55bd0aSMatthias Ringwald // references to used control implementation 5034fb55bd0aSMatthias Ringwald hci_stack->control = hardware_control; 5035d0b87befSMatthias Ringwald // init with transport config 5036d0b87befSMatthias Ringwald hardware_control->init(hci_stack->config); 5037fb55bd0aSMatthias Ringwald } 5038fb55bd0aSMatthias Ringwald 50391f9eb2ccSMatthias Ringwald static void hci_discard_connections(void){ 5040346f8c2cSMatthias Ringwald btstack_linked_list_iterator_t it; 5041346f8c2cSMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->connections); 5042346f8c2cSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 50431f9eb2ccSMatthias Ringwald // cancel all l2cap connections by emitting dicsconnection complete before shutdown (free) connection 5044346f8c2cSMatthias Ringwald hci_connection_t * connection = (hci_connection_t*) btstack_linked_list_iterator_next(&it); 50451f9eb2ccSMatthias Ringwald hci_emit_disconnection_complete(connection->con_handle, 0x16); // terminated by local host 50461f9eb2ccSMatthias Ringwald hci_shutdown_connection(connection); 50471f9eb2ccSMatthias Ringwald } 5048346f8c2cSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS 5049346f8c2cSMatthias Ringwald while (hci_stack->iso_streams != NULL){ 5050346f8c2cSMatthias Ringwald hci_iso_stream_finalize((hci_iso_stream_t *) hci_stack->iso_streams); 5051346f8c2cSMatthias Ringwald } 5052346f8c2cSMatthias Ringwald #endif 50531f9eb2ccSMatthias Ringwald } 50541f9eb2ccSMatthias Ringwald 505571de195eSMatthias Ringwald void hci_close(void){ 5056e6d6524dSMatthias Ringwald 5057e6d6524dSMatthias Ringwald #ifdef ENABLE_CLASSIC 5058404843c1Smatthias.ringwald // close remote device db 5059a98592bcSMatthias Ringwald if (hci_stack->link_key_db) { 5060a98592bcSMatthias Ringwald hci_stack->link_key_db->close(); 5061404843c1Smatthias.ringwald } 5062e6d6524dSMatthias Ringwald #endif 50637224be7eSMatthias Ringwald 50641f9eb2ccSMatthias Ringwald hci_discard_connections(); 50657224be7eSMatthias Ringwald 5066f5454fc6Smatthias.ringwald hci_power_control(HCI_POWER_OFF); 50673a9fb326S[email protected] 50683a9fb326S[email protected] #ifdef HAVE_MALLOC 50693a9fb326S[email protected] free(hci_stack); 50703a9fb326S[email protected] #endif 50713a9fb326S[email protected] hci_stack = NULL; 5072404843c1Smatthias.ringwald } 5073404843c1Smatthias.ringwald 5074cb70c5abSMatthias Ringwald #ifdef HAVE_SCO_TRANSPORT 5075cb70c5abSMatthias Ringwald void hci_set_sco_transport(const btstack_sco_transport_t *sco_transport){ 5076cb70c5abSMatthias Ringwald hci_stack->sco_transport = sco_transport; 5077cb70c5abSMatthias Ringwald sco_transport->register_packet_handler(&packet_handler); 5078cb70c5abSMatthias Ringwald } 5079cb70c5abSMatthias Ringwald #endif 5080cb70c5abSMatthias Ringwald 508135454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 5082170fafaeSMatthias Ringwald void gap_set_required_encryption_key_size(uint8_t encryption_key_size){ 5083170fafaeSMatthias Ringwald // validate ranage and set 5084170fafaeSMatthias Ringwald if (encryption_key_size < 7) return; 5085170fafaeSMatthias Ringwald if (encryption_key_size > 16) return; 5086170fafaeSMatthias Ringwald hci_stack->gap_required_encyrption_key_size = encryption_key_size; 5087170fafaeSMatthias Ringwald } 508878315a58SMatthias Ringwald 5089137715ebSMatthias Ringwald uint8_t gap_set_security_mode(gap_security_mode_t security_mode){ 5090137715ebSMatthias Ringwald if ((security_mode == GAP_SECURITY_MODE_4) || (security_mode == GAP_SECURITY_MODE_2)){ 50915dbec6b3SMatthias Ringwald hci_stack->gap_security_mode = security_mode; 5092137715ebSMatthias Ringwald return ERROR_CODE_SUCCESS; 5093137715ebSMatthias Ringwald } else { 5094137715ebSMatthias Ringwald return ERROR_CODE_UNSUPPORTED_FEATURE_OR_PARAMETER_VALUE; 5095137715ebSMatthias Ringwald } 50965dbec6b3SMatthias Ringwald } 50975dbec6b3SMatthias Ringwald 50985dbec6b3SMatthias Ringwald gap_security_mode_t gap_get_security_mode(void){ 50995dbec6b3SMatthias Ringwald return hci_stack->gap_security_mode; 51005dbec6b3SMatthias Ringwald } 51015dbec6b3SMatthias Ringwald 510278315a58SMatthias Ringwald void gap_set_security_level(gap_security_level_t security_level){ 510378315a58SMatthias Ringwald hci_stack->gap_security_level = security_level; 510478315a58SMatthias Ringwald } 510578315a58SMatthias Ringwald 510678315a58SMatthias Ringwald gap_security_level_t gap_get_security_level(void){ 5107d7387af3SMatthias Ringwald if (hci_stack->gap_secure_connections_only_mode){ 5108d7387af3SMatthias Ringwald return LEVEL_4; 5109d7387af3SMatthias Ringwald } 511078315a58SMatthias Ringwald return hci_stack->gap_security_level; 511178315a58SMatthias Ringwald } 511230cdf3c6SMatthias Ringwald 51138ad4dfffSMatthias Ringwald void gap_set_minimal_service_security_level(gap_security_level_t security_level){ 51148ad4dfffSMatthias Ringwald hci_stack->gap_minimal_service_security_level = security_level; 51158ad4dfffSMatthias Ringwald } 51168ad4dfffSMatthias Ringwald 511730cdf3c6SMatthias Ringwald void gap_set_secure_connections_only_mode(bool enable){ 511830cdf3c6SMatthias Ringwald hci_stack->gap_secure_connections_only_mode = enable; 511930cdf3c6SMatthias Ringwald } 512030cdf3c6SMatthias Ringwald 512130cdf3c6SMatthias Ringwald bool gap_get_secure_connections_only_mode(void){ 512230cdf3c6SMatthias Ringwald return hci_stack->gap_secure_connections_only_mode; 512330cdf3c6SMatthias Ringwald } 5124170fafaeSMatthias Ringwald #endif 5125170fafaeSMatthias Ringwald 5126170fafaeSMatthias Ringwald #ifdef ENABLE_CLASSIC 512760b9e82fSMatthias Ringwald void gap_set_class_of_device(uint32_t class_of_device){ 51289e61646fS[email protected] hci_stack->class_of_device = class_of_device; 5129baa4881eSMatthias Ringwald hci_stack->gap_tasks_classic |= GAP_TASK_SET_CLASS_OF_DEVICE; 513059d59ecfSMatthias Ringwald hci_run(); 51319e61646fS[email protected] } 513276f27cffSMatthias Ringwald 5133c33e56d3SMatthias Ringwald void gap_set_default_link_policy_settings(uint16_t default_link_policy_settings){ 5134c33e56d3SMatthias Ringwald hci_stack->default_link_policy_settings = default_link_policy_settings; 5135baa4881eSMatthias Ringwald hci_stack->gap_tasks_classic |= GAP_TASK_SET_DEFAULT_LINK_POLICY; 513659d59ecfSMatthias Ringwald hci_run(); 5137c33e56d3SMatthias Ringwald } 5138c33e56d3SMatthias Ringwald 5139b4eb4420SMatthias Ringwald void gap_set_allow_role_switch(bool allow_role_switch){ 5140b4eb4420SMatthias Ringwald hci_stack->allow_role_switch = allow_role_switch ? 1 : 0; 5141b4eb4420SMatthias Ringwald } 5142b4eb4420SMatthias Ringwald 5143b4eb4420SMatthias Ringwald uint8_t hci_get_allow_role_switch(void){ 5144b4eb4420SMatthias Ringwald return hci_stack->allow_role_switch; 5145b4eb4420SMatthias Ringwald } 5146b4eb4420SMatthias Ringwald 51470c3eb48dSMatthias Ringwald void gap_set_link_supervision_timeout(uint16_t link_supervision_timeout){ 51480c3eb48dSMatthias Ringwald hci_stack->link_supervision_timeout = link_supervision_timeout; 51490c3eb48dSMatthias Ringwald } 51500c3eb48dSMatthias Ringwald 51519afaa4d4SMatthias Ringwald void gap_enable_link_watchdog(uint16_t timeout_ms){ 51529afaa4d4SMatthias Ringwald hci_stack->automatic_flush_timeout = btstack_min(timeout_ms, 1280) * 8 / 5; // divide by 0.625 51539afaa4d4SMatthias Ringwald } 51549afaa4d4SMatthias Ringwald 51559afaa4d4SMatthias Ringwald uint16_t hci_automatic_flush_timeout(void){ 51569afaa4d4SMatthias Ringwald return hci_stack->automatic_flush_timeout; 51579afaa4d4SMatthias Ringwald } 51589afaa4d4SMatthias Ringwald 515976f27cffSMatthias Ringwald void hci_disable_l2cap_timeout_check(void){ 516076f27cffSMatthias Ringwald disable_l2cap_timeouts = 1; 516176f27cffSMatthias Ringwald } 516235454696SMatthias Ringwald #endif 51639e61646fS[email protected] 51646fad2c37SMatthias Ringwald #ifndef HAVE_HOST_CONTROLLER_API 5165f456b2d0S[email protected] // Set Public BD ADDR - passed on to Bluetooth chipset if supported in bt_control_h 5166f456b2d0S[email protected] void hci_set_bd_addr(bd_addr_t addr){ 51676535961aSMatthias Ringwald (void)memcpy(hci_stack->custom_bd_addr, addr, 6); 5168f456b2d0S[email protected] hci_stack->custom_bd_addr_set = 1; 5169f456b2d0S[email protected] } 517076f27cffSMatthias Ringwald #endif 5171f456b2d0S[email protected] 51728d213e1aSmatthias.ringwald // State-Module-Driver overview 51738d213e1aSmatthias.ringwald // state module low-level 51748d213e1aSmatthias.ringwald // HCI_STATE_OFF off close 51758d213e1aSmatthias.ringwald // HCI_STATE_INITIALIZING, on open 51768d213e1aSmatthias.ringwald // HCI_STATE_WORKING, on open 51778d213e1aSmatthias.ringwald // HCI_STATE_HALTING, on open 5178d661ed19Smatthias.ringwald // HCI_STATE_SLEEPING, off/sleep close 5179d661ed19Smatthias.ringwald // HCI_STATE_FALLING_ASLEEP on open 5180c7e0c5f6Smatthias.ringwald 518140d1c7a4Smatthias.ringwald static int hci_power_control_on(void){ 51827301ad89Smatthias.ringwald 5183038bc64cSmatthias.ringwald // power on 5184f9a30166Smatthias.ringwald int err = 0; 51853a9fb326S[email protected] if (hci_stack->control && hci_stack->control->on){ 5186d0b87befSMatthias Ringwald err = (*hci_stack->control->on)(); 5187f9a30166Smatthias.ringwald } 5188038bc64cSmatthias.ringwald if (err){ 51899da54300S[email protected] log_error( "POWER_ON failed"); 5190038bc64cSmatthias.ringwald hci_emit_hci_open_failed(); 5191038bc64cSmatthias.ringwald return err; 5192038bc64cSmatthias.ringwald } 5193038bc64cSmatthias.ringwald 519424b3c629SMatthias Ringwald // int chipset driver 51953fb36a29SMatthias Ringwald if (hci_stack->chipset && hci_stack->chipset->init){ 51963fb36a29SMatthias Ringwald hci_stack->chipset->init(hci_stack->config); 51973fb36a29SMatthias Ringwald } 51983fb36a29SMatthias Ringwald 519924b3c629SMatthias Ringwald // init transport 520024b3c629SMatthias Ringwald if (hci_stack->hci_transport->init){ 520124b3c629SMatthias Ringwald hci_stack->hci_transport->init(hci_stack->config); 520224b3c629SMatthias Ringwald } 520324b3c629SMatthias Ringwald 520424b3c629SMatthias Ringwald // open transport 520524b3c629SMatthias Ringwald err = hci_stack->hci_transport->open(); 5206038bc64cSmatthias.ringwald if (err){ 52079da54300S[email protected] log_error( "HCI_INIT failed, turning Bluetooth off again"); 52083a9fb326S[email protected] if (hci_stack->control && hci_stack->control->off){ 5209d0b87befSMatthias Ringwald (*hci_stack->control->off)(); 5210f9a30166Smatthias.ringwald } 5211038bc64cSmatthias.ringwald hci_emit_hci_open_failed(); 5212038bc64cSmatthias.ringwald return err; 5213038bc64cSmatthias.ringwald } 52148d213e1aSmatthias.ringwald return 0; 52158d213e1aSmatthias.ringwald } 5216038bc64cSmatthias.ringwald 521740d1c7a4Smatthias.ringwald static void hci_power_control_off(void){ 52188d213e1aSmatthias.ringwald 52199da54300S[email protected] log_info("hci_power_control_off"); 52209418f9c9Smatthias.ringwald 52218d213e1aSmatthias.ringwald // close low-level device 522224b3c629SMatthias Ringwald hci_stack->hci_transport->close(); 52238d213e1aSmatthias.ringwald 52249da54300S[email protected] log_info("hci_power_control_off - hci_transport closed"); 52259418f9c9Smatthias.ringwald 52268d213e1aSmatthias.ringwald // power off 52273a9fb326S[email protected] if (hci_stack->control && hci_stack->control->off){ 5228d0b87befSMatthias Ringwald (*hci_stack->control->off)(); 52298d213e1aSmatthias.ringwald } 52309418f9c9Smatthias.ringwald 52319da54300S[email protected] log_info("hci_power_control_off - control closed"); 52329418f9c9Smatthias.ringwald 52333a9fb326S[email protected] hci_stack->state = HCI_STATE_OFF; 523472ea5239Smatthias.ringwald } 523572ea5239Smatthias.ringwald 523640d1c7a4Smatthias.ringwald static void hci_power_control_sleep(void){ 523772ea5239Smatthias.ringwald 52389da54300S[email protected] log_info("hci_power_control_sleep"); 52393144bce4Smatthias.ringwald 5240b429b9b7Smatthias.ringwald #if 0 5241b429b9b7Smatthias.ringwald // don't close serial port during sleep 5242b429b9b7Smatthias.ringwald 524372ea5239Smatthias.ringwald // close low-level device 52443a9fb326S[email protected] hci_stack->hci_transport->close(hci_stack->config); 5245b429b9b7Smatthias.ringwald #endif 524672ea5239Smatthias.ringwald 524772ea5239Smatthias.ringwald // sleep mode 52483a9fb326S[email protected] if (hci_stack->control && hci_stack->control->sleep){ 5249d0b87befSMatthias Ringwald (*hci_stack->control->sleep)(); 525072ea5239Smatthias.ringwald } 5251b429b9b7Smatthias.ringwald 52523a9fb326S[email protected] hci_stack->state = HCI_STATE_SLEEPING; 52538d213e1aSmatthias.ringwald } 52548d213e1aSmatthias.ringwald 525540d1c7a4Smatthias.ringwald static int hci_power_control_wake(void){ 5256b429b9b7Smatthias.ringwald 52579da54300S[email protected] log_info("hci_power_control_wake"); 5258b429b9b7Smatthias.ringwald 5259b429b9b7Smatthias.ringwald // wake on 52603a9fb326S[email protected] if (hci_stack->control && hci_stack->control->wake){ 5261d0b87befSMatthias Ringwald (*hci_stack->control->wake)(); 5262b429b9b7Smatthias.ringwald } 5263b429b9b7Smatthias.ringwald 5264b429b9b7Smatthias.ringwald #if 0 5265b429b9b7Smatthias.ringwald // open low-level device 52663a9fb326S[email protected] int err = hci_stack->hci_transport->open(hci_stack->config); 5267b429b9b7Smatthias.ringwald if (err){ 52689da54300S[email protected] log_error( "HCI_INIT failed, turning Bluetooth off again"); 52693a9fb326S[email protected] if (hci_stack->control && hci_stack->control->off){ 5270d0b87befSMatthias Ringwald (*hci_stack->control->off)(); 5271b429b9b7Smatthias.ringwald } 5272b429b9b7Smatthias.ringwald hci_emit_hci_open_failed(); 5273b429b9b7Smatthias.ringwald return err; 5274b429b9b7Smatthias.ringwald } 5275b429b9b7Smatthias.ringwald #endif 5276b429b9b7Smatthias.ringwald 5277b429b9b7Smatthias.ringwald return 0; 5278b429b9b7Smatthias.ringwald } 5279b429b9b7Smatthias.ringwald 52800c88d5efSMatthias Ringwald static void hci_power_enter_initializing_state(void){ 528144935e40S[email protected] // set up state machine 528244935e40S[email protected] hci_stack->num_cmd_packets = 1; // assume that one cmd can be sent 528302c7fc01SMatthias Ringwald hci_stack->hci_packet_buffer_reserved = false; 528444935e40S[email protected] hci_stack->state = HCI_STATE_INITIALIZING; 52856fe16221SMatthias Ringwald 52860535e08cSMatthias Ringwald #ifndef HAVE_HOST_CONTROLLER_API 52876fe16221SMatthias Ringwald if (hci_stack->chipset_pre_init) { 52886fe16221SMatthias Ringwald hci_stack->substate = HCI_INIT_CUSTOM_PRE_INIT; 52890535e08cSMatthias Ringwald } else 52900535e08cSMatthias Ringwald #endif 52910535e08cSMatthias Ringwald { 52925c363727SMatthias Ringwald hci_stack->substate = HCI_INIT_SEND_RESET; 529344935e40S[email protected] } 52946fe16221SMatthias Ringwald } 5295b429b9b7Smatthias.ringwald 52960c88d5efSMatthias Ringwald static void hci_power_enter_halting_state(void){ 52970c88d5efSMatthias Ringwald #ifdef ENABLE_BLE 52981e907691SMatthias Ringwald // drop entries scheduled for removal, mark others for re-adding 52991e907691SMatthias Ringwald btstack_linked_list_iterator_t it; 53001e907691SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->le_whitelist); 53011e907691SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 53021e907691SMatthias Ringwald whitelist_entry_t * entry = (whitelist_entry_t*) btstack_linked_list_iterator_next(&it); 53031e907691SMatthias Ringwald if ((entry->state & (LE_WHITELIST_REMOVE_FROM_CONTROLLER | LE_WHITELIST_ADD_TO_CONTROLLER)) == LE_WHITELIST_REMOVE_FROM_CONTROLLER){ 53041e907691SMatthias Ringwald btstack_linked_list_iterator_remove(&it); 53051e907691SMatthias Ringwald btstack_memory_whitelist_entry_free(entry); 53061e907691SMatthias Ringwald } else { 53071e907691SMatthias Ringwald entry->state = LE_WHITELIST_ADD_TO_CONTROLLER; 53081e907691SMatthias Ringwald } 53091e907691SMatthias Ringwald } 5310a2c9d908SMatthias Ringwald #ifdef ENABLE_LE_PERIODIC_ADVERTISING 5311e8d160b3SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->le_periodic_advertiser_list); 5312e8d160b3SMatthias Ringwald const uint8_t mask = LE_PERIODIC_ADVERTISER_LIST_ENTRY_REMOVE_FROM_CONTROLLER | LE_PERIODIC_ADVERTISER_LIST_ENTRY_REMOVE_FROM_CONTROLLER; 5313e8d160b3SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 5314e8d160b3SMatthias Ringwald periodic_advertiser_list_entry_t * entry = (periodic_advertiser_list_entry_t*) btstack_linked_list_iterator_next(&it); 5315e8d160b3SMatthias Ringwald if ((entry->state & mask) == LE_PERIODIC_ADVERTISER_LIST_ENTRY_REMOVE_FROM_CONTROLLER) { 5316e8d160b3SMatthias Ringwald btstack_linked_list_iterator_remove(&it); 5317e8d160b3SMatthias Ringwald btstack_memory_periodic_advertiser_list_entry_free(entry); 5318e8d160b3SMatthias Ringwald } else { 5319e8d160b3SMatthias Ringwald entry->state |= LE_PERIODIC_ADVERTISER_LIST_ENTRY_ADD_TO_CONTROLLER; 5320e8d160b3SMatthias Ringwald continue; 5321e8d160b3SMatthias Ringwald } 5322e8d160b3SMatthias Ringwald } 5323a2c9d908SMatthias Ringwald #endif 53240c88d5efSMatthias Ringwald #endif 5325184dbe2fSMatthias Ringwald // see hci_run 5326184dbe2fSMatthias Ringwald hci_stack->state = HCI_STATE_HALTING; 53270c88d5efSMatthias Ringwald hci_stack->substate = HCI_HALTING_CLASSIC_STOP; 5328184dbe2fSMatthias Ringwald // setup watchdog timer for disconnect - only triggers if Controller does not respond anymore 5329184dbe2fSMatthias Ringwald btstack_run_loop_set_timer(&hci_stack->timeout, 1000); 5330184dbe2fSMatthias Ringwald btstack_run_loop_set_timer_handler(&hci_stack->timeout, hci_halting_timeout_handler); 5331184dbe2fSMatthias Ringwald btstack_run_loop_add_timer(&hci_stack->timeout); 5332184dbe2fSMatthias Ringwald } 5333184dbe2fSMatthias Ringwald 533442bd3d77SMatthias Ringwald // returns error 533542bd3d77SMatthias Ringwald static int hci_power_control_state_off(HCI_POWER_MODE power_mode){ 533642bd3d77SMatthias Ringwald int err; 53378d213e1aSmatthias.ringwald switch (power_mode){ 53388d213e1aSmatthias.ringwald case HCI_POWER_ON: 53398d213e1aSmatthias.ringwald err = hci_power_control_on(); 534042bd3d77SMatthias Ringwald if (err != 0) { 5341f04a0c31SMatthias Ringwald log_error("hci_power_control_on() error %d", err); 534297b61c7bS[email protected] return err; 534397b61c7bS[email protected] } 53440c88d5efSMatthias Ringwald hci_power_enter_initializing_state(); 53458d213e1aSmatthias.ringwald break; 53468d213e1aSmatthias.ringwald case HCI_POWER_OFF: 53478d213e1aSmatthias.ringwald // do nothing 53488d213e1aSmatthias.ringwald break; 53498d213e1aSmatthias.ringwald case HCI_POWER_SLEEP: 5350b546ac54Smatthias.ringwald // do nothing (with SLEEP == OFF) 53518d213e1aSmatthias.ringwald break; 53527bbeb3adSMilanka Ringwald default: 53537bbeb3adSMilanka Ringwald btstack_assert(false); 53547bbeb3adSMilanka Ringwald break; 53558d213e1aSmatthias.ringwald } 535642bd3d77SMatthias Ringwald return ERROR_CODE_SUCCESS; 535742bd3d77SMatthias Ringwald } 53587301ad89Smatthias.ringwald 535942bd3d77SMatthias Ringwald static int hci_power_control_state_initializing(HCI_POWER_MODE power_mode){ 53608d213e1aSmatthias.ringwald switch (power_mode){ 53618d213e1aSmatthias.ringwald case HCI_POWER_ON: 53628d213e1aSmatthias.ringwald // do nothing 53638d213e1aSmatthias.ringwald break; 53648d213e1aSmatthias.ringwald case HCI_POWER_OFF: 53658d213e1aSmatthias.ringwald // no connections yet, just turn it off 53668d213e1aSmatthias.ringwald hci_power_control_off(); 53678d213e1aSmatthias.ringwald break; 53688d213e1aSmatthias.ringwald case HCI_POWER_SLEEP: 5369b546ac54Smatthias.ringwald // no connections yet, just turn it off 537072ea5239Smatthias.ringwald hci_power_control_sleep(); 53718d213e1aSmatthias.ringwald break; 53727bbeb3adSMilanka Ringwald default: 53737bbeb3adSMilanka Ringwald btstack_assert(false); 53747bbeb3adSMilanka Ringwald break; 53758d213e1aSmatthias.ringwald } 537642bd3d77SMatthias Ringwald return ERROR_CODE_SUCCESS; 537742bd3d77SMatthias Ringwald } 53787301ad89Smatthias.ringwald 537942bd3d77SMatthias Ringwald static int hci_power_control_state_working(HCI_POWER_MODE power_mode) { 53808d213e1aSmatthias.ringwald switch (power_mode){ 53818d213e1aSmatthias.ringwald case HCI_POWER_ON: 53828d213e1aSmatthias.ringwald // do nothing 53838d213e1aSmatthias.ringwald break; 53848d213e1aSmatthias.ringwald case HCI_POWER_OFF: 53850c88d5efSMatthias Ringwald hci_power_enter_halting_state(); 53868d213e1aSmatthias.ringwald break; 53878d213e1aSmatthias.ringwald case HCI_POWER_SLEEP: 5388b546ac54Smatthias.ringwald // see hci_run 53893a9fb326S[email protected] hci_stack->state = HCI_STATE_FALLING_ASLEEP; 539074b323a9SMatthias Ringwald hci_stack->substate = HCI_FALLING_ASLEEP_DISCONNECT; 53918d213e1aSmatthias.ringwald break; 53927bbeb3adSMilanka Ringwald default: 53937bbeb3adSMilanka Ringwald btstack_assert(false); 53947bbeb3adSMilanka Ringwald break; 53958d213e1aSmatthias.ringwald } 539642bd3d77SMatthias Ringwald return ERROR_CODE_SUCCESS; 539742bd3d77SMatthias Ringwald } 53987301ad89Smatthias.ringwald 539942bd3d77SMatthias Ringwald static int hci_power_control_state_halting(HCI_POWER_MODE power_mode) { 54008d213e1aSmatthias.ringwald switch (power_mode){ 54018d213e1aSmatthias.ringwald case HCI_POWER_ON: 54020c88d5efSMatthias Ringwald hci_power_enter_initializing_state(); 54038d213e1aSmatthias.ringwald break; 54048d213e1aSmatthias.ringwald case HCI_POWER_OFF: 54058d213e1aSmatthias.ringwald // do nothing 54068d213e1aSmatthias.ringwald break; 54078d213e1aSmatthias.ringwald case HCI_POWER_SLEEP: 5408b546ac54Smatthias.ringwald // see hci_run 54093a9fb326S[email protected] hci_stack->state = HCI_STATE_FALLING_ASLEEP; 541074b323a9SMatthias Ringwald hci_stack->substate = HCI_FALLING_ASLEEP_DISCONNECT; 54118d213e1aSmatthias.ringwald break; 54127bbeb3adSMilanka Ringwald default: 54137bbeb3adSMilanka Ringwald btstack_assert(false); 54147bbeb3adSMilanka Ringwald break; 54158d213e1aSmatthias.ringwald } 541600278272SMatthias Ringwald return ERROR_CODE_SUCCESS; 541742bd3d77SMatthias Ringwald } 54188d213e1aSmatthias.ringwald 541942bd3d77SMatthias Ringwald static int hci_power_control_state_falling_asleep(HCI_POWER_MODE power_mode) { 54208d213e1aSmatthias.ringwald switch (power_mode){ 54218d213e1aSmatthias.ringwald case HCI_POWER_ON: 54220c88d5efSMatthias Ringwald hci_power_enter_initializing_state(); 54238d213e1aSmatthias.ringwald break; 54248d213e1aSmatthias.ringwald case HCI_POWER_OFF: 54250c88d5efSMatthias Ringwald hci_power_enter_halting_state(); 54268d213e1aSmatthias.ringwald break; 54278d213e1aSmatthias.ringwald case HCI_POWER_SLEEP: 5428b546ac54Smatthias.ringwald // do nothing 54298d213e1aSmatthias.ringwald break; 54307bbeb3adSMilanka Ringwald default: 54317bbeb3adSMilanka Ringwald btstack_assert(false); 54327bbeb3adSMilanka Ringwald break; 54338d213e1aSmatthias.ringwald } 543442bd3d77SMatthias Ringwald return ERROR_CODE_SUCCESS; 543542bd3d77SMatthias Ringwald } 54368d213e1aSmatthias.ringwald 543742bd3d77SMatthias Ringwald static int hci_power_control_state_sleeping(HCI_POWER_MODE power_mode) { 543842bd3d77SMatthias Ringwald int err; 54398d213e1aSmatthias.ringwald switch (power_mode){ 54408d213e1aSmatthias.ringwald case HCI_POWER_ON: 54413144bce4Smatthias.ringwald err = hci_power_control_wake(); 54423144bce4Smatthias.ringwald if (err) return err; 54430c88d5efSMatthias Ringwald hci_power_enter_initializing_state(); 54448d213e1aSmatthias.ringwald break; 54458d213e1aSmatthias.ringwald case HCI_POWER_OFF: 54460c88d5efSMatthias Ringwald hci_power_enter_halting_state(); 54478d213e1aSmatthias.ringwald break; 54488d213e1aSmatthias.ringwald case HCI_POWER_SLEEP: 5449b546ac54Smatthias.ringwald // do nothing 54508d213e1aSmatthias.ringwald break; 54517bbeb3adSMilanka Ringwald default: 54527bbeb3adSMilanka Ringwald btstack_assert(false); 54537bbeb3adSMilanka Ringwald break; 54548d213e1aSmatthias.ringwald } 545542bd3d77SMatthias Ringwald return ERROR_CODE_SUCCESS; 545642bd3d77SMatthias Ringwald } 54577bbeb3adSMilanka Ringwald 545842bd3d77SMatthias Ringwald int hci_power_control(HCI_POWER_MODE power_mode){ 545942bd3d77SMatthias Ringwald log_info("hci_power_control: %d, current mode %u", power_mode, hci_stack->state); 5460bef627f1SMatthias Ringwald btstack_run_loop_remove_timer(&hci_stack->timeout); 546124f87726SMatthias Ringwald int err = 0; 546242bd3d77SMatthias Ringwald switch (hci_stack->state){ 546342bd3d77SMatthias Ringwald case HCI_STATE_OFF: 546442bd3d77SMatthias Ringwald err = hci_power_control_state_off(power_mode); 546542bd3d77SMatthias Ringwald break; 546642bd3d77SMatthias Ringwald case HCI_STATE_INITIALIZING: 546742bd3d77SMatthias Ringwald err = hci_power_control_state_initializing(power_mode); 546842bd3d77SMatthias Ringwald break; 546942bd3d77SMatthias Ringwald case HCI_STATE_WORKING: 547042bd3d77SMatthias Ringwald err = hci_power_control_state_working(power_mode); 547142bd3d77SMatthias Ringwald break; 547242bd3d77SMatthias Ringwald case HCI_STATE_HALTING: 547342bd3d77SMatthias Ringwald err = hci_power_control_state_halting(power_mode); 547442bd3d77SMatthias Ringwald break; 547542bd3d77SMatthias Ringwald case HCI_STATE_FALLING_ASLEEP: 547642bd3d77SMatthias Ringwald err = hci_power_control_state_falling_asleep(power_mode); 547742bd3d77SMatthias Ringwald break; 547842bd3d77SMatthias Ringwald case HCI_STATE_SLEEPING: 547942bd3d77SMatthias Ringwald err = hci_power_control_state_sleeping(power_mode); 548042bd3d77SMatthias Ringwald break; 54817bbeb3adSMilanka Ringwald default: 54827bbeb3adSMilanka Ringwald btstack_assert(false); 54837bbeb3adSMilanka Ringwald break; 548411e23e5fSmatthias.ringwald } 548524f87726SMatthias Ringwald if (err != 0){ 548642bd3d77SMatthias Ringwald return err; 548742bd3d77SMatthias Ringwald } 548868d92d03Smatthias.ringwald 5489038bc64cSmatthias.ringwald // create internal event 5490ee8bf225Smatthias.ringwald hci_emit_state(); 5491ee8bf225Smatthias.ringwald 549268d92d03Smatthias.ringwald // trigger next/first action 549368d92d03Smatthias.ringwald hci_run(); 549468d92d03Smatthias.ringwald 5495475c8125Smatthias.ringwald return 0; 5496475c8125Smatthias.ringwald } 5497475c8125Smatthias.ringwald 549835454696SMatthias Ringwald 5499091e35e3SMatthias Ringwald static void hci_halting_run(void) { 5500091e35e3SMatthias Ringwald 5501091e35e3SMatthias Ringwald log_info("HCI_STATE_HALTING, substate %x\n", hci_stack->substate); 5502091e35e3SMatthias Ringwald 5503091e35e3SMatthias Ringwald hci_connection_t *connection; 5504d5f71a7eSMatthias Ringwald #ifdef ENABLE_BLE 5505d5f71a7eSMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 5506911801caSMatthias Ringwald bool stop_advertismenets; 5507d5f71a7eSMatthias Ringwald #endif 5508d5f71a7eSMatthias Ringwald #endif 5509091e35e3SMatthias Ringwald 5510091e35e3SMatthias Ringwald switch (hci_stack->substate) { 55110c88d5efSMatthias Ringwald case HCI_HALTING_CLASSIC_STOP: 55120c88d5efSMatthias Ringwald #ifdef ENABLE_CLASSIC 5513911801caSMatthias Ringwald if (!hci_can_send_command_packet_now()) return; 5514911801caSMatthias Ringwald 55150c88d5efSMatthias Ringwald if (hci_stack->connectable || hci_stack->discoverable){ 55160c88d5efSMatthias Ringwald hci_stack->substate = HCI_HALTING_LE_ADV_STOP; 55170c88d5efSMatthias Ringwald hci_send_cmd(&hci_write_scan_enable, 0); 55180c88d5efSMatthias Ringwald return; 55190c88d5efSMatthias Ringwald } 55200c88d5efSMatthias Ringwald #endif 55210c88d5efSMatthias Ringwald /* fall through */ 55220c88d5efSMatthias Ringwald 55230c88d5efSMatthias Ringwald case HCI_HALTING_LE_ADV_STOP: 55240c88d5efSMatthias Ringwald hci_stack->substate = HCI_HALTING_LE_ADV_STOP; 55250c88d5efSMatthias Ringwald 55260c88d5efSMatthias Ringwald #ifdef ENABLE_BLE 55270c88d5efSMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 5528911801caSMatthias Ringwald if (!hci_can_send_command_packet_now()) return; 5529911801caSMatthias Ringwald 5530911801caSMatthias Ringwald stop_advertismenets = (hci_stack->le_advertisements_state & LE_ADVERTISEMENT_STATE_ACTIVE) != 0; 5531911801caSMatthias Ringwald 5532911801caSMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 553322f987e4SMatthias Ringwald if (hci_le_extended_advertising_supported()){ 5534c814a904SMatthias Ringwald #ifdef ENABLE_LE_PERIODIC_ADVERTISING 5535911801caSMatthias Ringwald btstack_linked_list_iterator_t it; 5536911801caSMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->le_advertising_sets); 5537911801caSMatthias Ringwald // stop all periodic advertisements and check if an extended set is active 5538911801caSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 5539911801caSMatthias Ringwald le_advertising_set_t * advertising_set = (le_advertising_set_t*) btstack_linked_list_iterator_next(&it); 5540911801caSMatthias Ringwald if ((advertising_set->state & LE_ADVERTISEMENT_STATE_PERIODIC_ACTIVE) != 0) { 5541911801caSMatthias Ringwald advertising_set->state &= ~LE_ADVERTISEMENT_STATE_PERIODIC_ACTIVE; 5542911801caSMatthias Ringwald hci_send_cmd(&hci_le_set_periodic_advertising_enable, 0, advertising_set->advertising_handle); 55430c88d5efSMatthias Ringwald return; 55440c88d5efSMatthias Ringwald } 5545911801caSMatthias Ringwald if ((advertising_set->state & LE_ADVERTISEMENT_STATE_ACTIVE) != 0) { 5546911801caSMatthias Ringwald stop_advertismenets = true; 5547911801caSMatthias Ringwald advertising_set->state &= ~LE_ADVERTISEMENT_STATE_ACTIVE; 5548911801caSMatthias Ringwald } 5549911801caSMatthias Ringwald } 5550c814a904SMatthias Ringwald #endif /* ENABLE_LE_PERIODIC_ADVERTISING */ 5551911801caSMatthias Ringwald if (stop_advertismenets){ 5552911801caSMatthias Ringwald hci_stack->le_advertisements_state &= ~LE_ADVERTISEMENT_STATE_ACTIVE; 5553911801caSMatthias Ringwald hci_send_cmd(&hci_le_set_extended_advertising_enable, 0, 0, NULL, NULL, NULL); 5554911801caSMatthias Ringwald return; 5555911801caSMatthias Ringwald } 5556d935373dSMatthias Ringwald } else 5557a2c9d908SMatthias Ringwald #else /* ENABLE_LE_PERIPHERAL */ 5558911801caSMatthias Ringwald { 5559911801caSMatthias Ringwald if (stop_advertismenets) { 5560911801caSMatthias Ringwald hci_stack->le_advertisements_state &= ~LE_ADVERTISEMENT_STATE_ACTIVE; 5561911801caSMatthias Ringwald hci_send_cmd(&hci_le_set_advertise_enable, 0); 5562911801caSMatthias Ringwald return; 5563911801caSMatthias Ringwald } 5564911801caSMatthias Ringwald } 5565911801caSMatthias Ringwald #endif /* ENABLE_LE_EXTENDED_ADVERTISING*/ 5566911801caSMatthias Ringwald #endif /* ENABLE_LE_PERIPHERAL */ 5567911801caSMatthias Ringwald #endif /* ENABLE_BLE */ 5568911801caSMatthias Ringwald 55690c88d5efSMatthias Ringwald /* fall through */ 55700c88d5efSMatthias Ringwald 55710c88d5efSMatthias Ringwald case HCI_HALTING_LE_SCAN_STOP: 55720c88d5efSMatthias Ringwald hci_stack->substate = HCI_HALTING_LE_SCAN_STOP; 5573911801caSMatthias Ringwald if (!hci_can_send_command_packet_now()) return; 5574091e35e3SMatthias Ringwald 5575091e35e3SMatthias Ringwald #ifdef ENABLE_BLE 5576091e35e3SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 55770c88d5efSMatthias Ringwald if (hci_stack->le_scanning_active){ 5578c42da3bcSMatthias Ringwald hci_le_scan_stop(); 55790c88d5efSMatthias Ringwald hci_stack->substate = HCI_HALTING_DISCONNECT_ALL; 55800c88d5efSMatthias Ringwald return; 55810c88d5efSMatthias Ringwald } 5582091e35e3SMatthias Ringwald #endif 5583091e35e3SMatthias Ringwald #endif 55840c88d5efSMatthias Ringwald 55850c88d5efSMatthias Ringwald /* fall through */ 55860c88d5efSMatthias Ringwald 55870c88d5efSMatthias Ringwald case HCI_HALTING_DISCONNECT_ALL: 55880c88d5efSMatthias Ringwald hci_stack->substate = HCI_HALTING_DISCONNECT_ALL; 5589911801caSMatthias Ringwald if (!hci_can_send_command_packet_now()) return; 55900c88d5efSMatthias Ringwald 5591091e35e3SMatthias Ringwald // close all open connections 5592091e35e3SMatthias Ringwald connection = (hci_connection_t *) hci_stack->connections; 5593091e35e3SMatthias Ringwald if (connection) { 5594091e35e3SMatthias Ringwald hci_con_handle_t con_handle = (uint16_t) connection->con_handle; 5595091e35e3SMatthias Ringwald 559603270f05SMatthias Ringwald log_info("HCI_STATE_HALTING, connection %p, handle %u, state %u", connection, con_handle, connection->state); 5597091e35e3SMatthias Ringwald 559803270f05SMatthias Ringwald // check state 559903270f05SMatthias Ringwald switch(connection->state) { 560003270f05SMatthias Ringwald case SENT_DISCONNECT: 560103270f05SMatthias Ringwald case RECEIVED_DISCONNECTION_COMPLETE: 560203270f05SMatthias Ringwald // wait until connection is gone 560303270f05SMatthias Ringwald return; 560403270f05SMatthias Ringwald default: 560503270f05SMatthias Ringwald break; 560603270f05SMatthias Ringwald } 5607091e35e3SMatthias Ringwald 5608091e35e3SMatthias Ringwald // finally, send the disconnect command 560903270f05SMatthias Ringwald connection->state = SENT_DISCONNECT; 5610091e35e3SMatthias Ringwald hci_send_cmd(&hci_disconnect, con_handle, ERROR_CODE_REMOTE_USER_TERMINATED_CONNECTION); 5611091e35e3SMatthias Ringwald return; 5612091e35e3SMatthias Ringwald } 5613091e35e3SMatthias Ringwald 5614346f8c2cSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS 5615346f8c2cSMatthias Ringwald // stop BIGs and BIG Syncs 5616346f8c2cSMatthias Ringwald if (hci_stack->le_audio_bigs != NULL){ 5617346f8c2cSMatthias Ringwald le_audio_big_t * big = (le_audio_big_t*) hci_stack->le_audio_bigs; 5618346f8c2cSMatthias Ringwald if (big->state == LE_AUDIO_BIG_STATE_W4_TERMINATED) return; 5619346f8c2cSMatthias Ringwald big->state = LE_AUDIO_BIG_STATE_W4_TERMINATED; 5620346f8c2cSMatthias Ringwald hci_send_cmd(&hci_le_terminate_big, big->big_handle); 5621346f8c2cSMatthias Ringwald return; 5622346f8c2cSMatthias Ringwald } 5623346f8c2cSMatthias Ringwald if (hci_stack->le_audio_big_syncs != NULL){ 5624346f8c2cSMatthias Ringwald le_audio_big_sync_t * big_sync = (le_audio_big_sync_t*) hci_stack->le_audio_big_syncs; 5625346f8c2cSMatthias Ringwald if (big_sync->state == LE_AUDIO_BIG_STATE_W4_TERMINATED) return; 5626346f8c2cSMatthias Ringwald big_sync->state = LE_AUDIO_BIG_STATE_W4_TERMINATED; 5627346f8c2cSMatthias Ringwald hci_send_cmd(&hci_le_big_terminate_sync, big_sync->big_handle); 5628346f8c2cSMatthias Ringwald return; 5629346f8c2cSMatthias Ringwald } 5630346f8c2cSMatthias Ringwald #endif 5631346f8c2cSMatthias Ringwald 5632091e35e3SMatthias Ringwald btstack_run_loop_remove_timer(&hci_stack->timeout); 5633091e35e3SMatthias Ringwald 5634091e35e3SMatthias Ringwald // no connections left, wait a bit to assert that btstack_cyrpto isn't waiting for an HCI event 5635091e35e3SMatthias Ringwald log_info("HCI_STATE_HALTING: wait 50 ms"); 56360c88d5efSMatthias Ringwald hci_stack->substate = HCI_HALTING_W4_CLOSE_TIMER; 5637091e35e3SMatthias Ringwald btstack_run_loop_set_timer(&hci_stack->timeout, 50); 5638091e35e3SMatthias Ringwald btstack_run_loop_set_timer_handler(&hci_stack->timeout, hci_halting_timeout_handler); 5639091e35e3SMatthias Ringwald btstack_run_loop_add_timer(&hci_stack->timeout); 5640091e35e3SMatthias Ringwald break; 5641091e35e3SMatthias Ringwald 5642b188b5fcSMatthias Ringwald case HCI_HALTING_W4_CLOSE_TIMER: 5643b188b5fcSMatthias Ringwald // keep waiting 5644b188b5fcSMatthias Ringwald break; 5645b188b5fcSMatthias Ringwald 5646091e35e3SMatthias Ringwald case HCI_HALTING_CLOSE: 5647091e35e3SMatthias Ringwald // close left over connections (that had not been properly closed before) 5648b188b5fcSMatthias Ringwald hci_stack->substate = HCI_HALTING_CLOSE_DISCARDING_CONNECTIONS; 5649091e35e3SMatthias Ringwald hci_discard_connections(); 5650091e35e3SMatthias Ringwald 5651091e35e3SMatthias Ringwald log_info("HCI_STATE_HALTING, calling off"); 5652091e35e3SMatthias Ringwald 5653091e35e3SMatthias Ringwald // switch mode 5654091e35e3SMatthias Ringwald hci_power_control_off(); 5655091e35e3SMatthias Ringwald 5656091e35e3SMatthias Ringwald log_info("HCI_STATE_HALTING, emitting state"); 5657091e35e3SMatthias Ringwald hci_emit_state(); 5658091e35e3SMatthias Ringwald log_info("HCI_STATE_HALTING, done"); 5659091e35e3SMatthias Ringwald break; 5660091e35e3SMatthias Ringwald 5661091e35e3SMatthias Ringwald default: 5662091e35e3SMatthias Ringwald break; 5663091e35e3SMatthias Ringwald } 5664091e35e3SMatthias Ringwald }; 5665091e35e3SMatthias Ringwald 5666091e35e3SMatthias Ringwald static void hci_falling_asleep_run(void){ 5667091e35e3SMatthias Ringwald hci_connection_t * connection; 5668091e35e3SMatthias Ringwald switch(hci_stack->substate) { 5669091e35e3SMatthias Ringwald case HCI_FALLING_ASLEEP_DISCONNECT: 5670091e35e3SMatthias Ringwald log_info("HCI_STATE_FALLING_ASLEEP"); 5671091e35e3SMatthias Ringwald // close all open connections 5672091e35e3SMatthias Ringwald connection = (hci_connection_t *) hci_stack->connections; 5673091e35e3SMatthias Ringwald if (connection){ 5674091e35e3SMatthias Ringwald 5675091e35e3SMatthias Ringwald // send disconnect 5676091e35e3SMatthias Ringwald if (!hci_can_send_command_packet_now()) return; 5677091e35e3SMatthias Ringwald 5678091e35e3SMatthias Ringwald log_info("HCI_STATE_FALLING_ASLEEP, connection %p, handle %u", connection, (uint16_t)connection->con_handle); 5679091e35e3SMatthias Ringwald hci_send_cmd(&hci_disconnect, connection->con_handle, ERROR_CODE_REMOTE_USER_TERMINATED_CONNECTION); 5680091e35e3SMatthias Ringwald 5681091e35e3SMatthias Ringwald // send disconnected event right away - causes higher layer connections to get closed, too. 5682091e35e3SMatthias Ringwald hci_shutdown_connection(connection); 5683091e35e3SMatthias Ringwald return; 5684091e35e3SMatthias Ringwald } 5685091e35e3SMatthias Ringwald 5686091e35e3SMatthias Ringwald if (hci_classic_supported()){ 5687091e35e3SMatthias Ringwald // disable page and inquiry scan 5688091e35e3SMatthias Ringwald if (!hci_can_send_command_packet_now()) return; 5689091e35e3SMatthias Ringwald 5690091e35e3SMatthias Ringwald log_info("HCI_STATE_HALTING, disabling inq scans"); 5691091e35e3SMatthias Ringwald hci_send_cmd(&hci_write_scan_enable, hci_stack->connectable << 1); // drop inquiry scan but keep page scan 5692091e35e3SMatthias Ringwald 5693091e35e3SMatthias Ringwald // continue in next sub state 5694091e35e3SMatthias Ringwald hci_stack->substate = HCI_FALLING_ASLEEP_W4_WRITE_SCAN_ENABLE; 5695091e35e3SMatthias Ringwald break; 5696091e35e3SMatthias Ringwald } 5697091e35e3SMatthias Ringwald 5698091e35e3SMatthias Ringwald /* fall through */ 5699091e35e3SMatthias Ringwald 5700091e35e3SMatthias Ringwald case HCI_FALLING_ASLEEP_COMPLETE: 5701091e35e3SMatthias Ringwald log_info("HCI_STATE_HALTING, calling sleep"); 5702091e35e3SMatthias Ringwald // switch mode 5703091e35e3SMatthias Ringwald hci_power_control_sleep(); // changes hci_stack->state to SLEEP 5704091e35e3SMatthias Ringwald hci_emit_state(); 5705091e35e3SMatthias Ringwald break; 5706091e35e3SMatthias Ringwald 5707091e35e3SMatthias Ringwald default: 5708091e35e3SMatthias Ringwald break; 5709091e35e3SMatthias Ringwald } 5710091e35e3SMatthias Ringwald } 5711091e35e3SMatthias Ringwald 571235454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 571335454696SMatthias Ringwald 5714758b46ceSmatthias.ringwald static void hci_update_scan_enable(void){ 5715758b46ceSmatthias.ringwald // 2 = page scan, 1 = inq scan 5716a1df452eSMatthias Ringwald hci_stack->new_scan_enable_value = (hci_stack->connectable << 1) | hci_stack->discoverable; 5717baa4881eSMatthias Ringwald hci_stack->gap_tasks_classic |= GAP_TASK_WRITE_SCAN_ENABLE; 5718758b46ceSmatthias.ringwald hci_run(); 5719758b46ceSmatthias.ringwald } 5720758b46ceSmatthias.ringwald 572115a95bd5SMatthias Ringwald void gap_discoverable_control(uint8_t enable){ 5722381fbed8Smatthias.ringwald if (enable) enable = 1; // normalize argument 5723381fbed8Smatthias.ringwald 57243a9fb326S[email protected] if (hci_stack->discoverable == enable){ 572571fd255dSMatthias Ringwald hci_emit_scan_mode_changed(hci_stack->discoverable, hci_stack->connectable); 5726381fbed8Smatthias.ringwald return; 5727381fbed8Smatthias.ringwald } 5728381fbed8Smatthias.ringwald 57293a9fb326S[email protected] hci_stack->discoverable = enable; 5730758b46ceSmatthias.ringwald hci_update_scan_enable(); 5731758b46ceSmatthias.ringwald } 5732b031bebbSmatthias.ringwald 573315a95bd5SMatthias Ringwald void gap_connectable_control(uint8_t enable){ 5734758b46ceSmatthias.ringwald if (enable) enable = 1; // normalize argument 5735758b46ceSmatthias.ringwald 5736758b46ceSmatthias.ringwald // don't emit event 57373a9fb326S[email protected] if (hci_stack->connectable == enable) return; 5738758b46ceSmatthias.ringwald 57393a9fb326S[email protected] hci_stack->connectable = enable; 5740758b46ceSmatthias.ringwald hci_update_scan_enable(); 5741381fbed8Smatthias.ringwald } 574235454696SMatthias Ringwald #endif 5743381fbed8Smatthias.ringwald 574415a95bd5SMatthias Ringwald void gap_local_bd_addr(bd_addr_t address_buffer){ 57456535961aSMatthias Ringwald (void)memcpy(address_buffer, hci_stack->local_bd_addr, 6); 57465061f3afS[email protected] } 57475061f3afS[email protected] 57482b838201SMatthias Ringwald #ifdef ENABLE_HCI_CONTROLLER_TO_HOST_FLOW_CONTROL 57492b838201SMatthias Ringwald static void hci_host_num_completed_packets(void){ 57502b838201SMatthias Ringwald 57512b838201SMatthias Ringwald // create packet manually as arrays are not supported and num_commands should not get reduced 57522b838201SMatthias Ringwald hci_reserve_packet_buffer(); 57532b838201SMatthias Ringwald uint8_t * packet = hci_get_outgoing_packet_buffer(); 57542b838201SMatthias Ringwald 57552b838201SMatthias Ringwald uint16_t size = 0; 57562b838201SMatthias Ringwald uint16_t num_handles = 0; 57572b838201SMatthias Ringwald packet[size++] = 0x35; 57582b838201SMatthias Ringwald packet[size++] = 0x0c; 57592b838201SMatthias Ringwald size++; // skip param len 57602b838201SMatthias Ringwald size++; // skip num handles 57612b838201SMatthias Ringwald 57622b838201SMatthias Ringwald // add { handle, packets } entries 57632b838201SMatthias Ringwald btstack_linked_item_t * it; 57642b838201SMatthias Ringwald for (it = (btstack_linked_item_t *) hci_stack->connections; it ; it = it->next){ 57652b838201SMatthias Ringwald hci_connection_t * connection = (hci_connection_t *) it; 57662b838201SMatthias Ringwald if (connection->num_packets_completed){ 57672b838201SMatthias Ringwald little_endian_store_16(packet, size, connection->con_handle); 57682b838201SMatthias Ringwald size += 2; 57692b838201SMatthias Ringwald little_endian_store_16(packet, size, connection->num_packets_completed); 57702b838201SMatthias Ringwald size += 2; 57712b838201SMatthias Ringwald // 57722b838201SMatthias Ringwald num_handles++; 57732b838201SMatthias Ringwald connection->num_packets_completed = 0; 57742b838201SMatthias Ringwald } 57752b838201SMatthias Ringwald } 57762b838201SMatthias Ringwald 57772b838201SMatthias Ringwald packet[2] = size - 3; 57782b838201SMatthias Ringwald packet[3] = num_handles; 57792b838201SMatthias Ringwald 57802b838201SMatthias Ringwald hci_stack->host_completed_packets = 0; 57812b838201SMatthias Ringwald 57822b838201SMatthias Ringwald hci_dump_packet(HCI_COMMAND_DATA_PACKET, 0, packet, size); 57832b838201SMatthias Ringwald hci_stack->hci_transport->send_packet(HCI_COMMAND_DATA_PACKET, packet, size); 57842b838201SMatthias Ringwald 57852b838201SMatthias Ringwald // release packet buffer for synchronous transport implementations 57862b838201SMatthias Ringwald if (hci_transport_synchronous()){ 5787e2d22487SMatthias Ringwald hci_release_packet_buffer(); 5788068b8592SMatthias Ringwald hci_emit_transport_packet_sent(); 57892b838201SMatthias Ringwald } 57902b838201SMatthias Ringwald } 57912b838201SMatthias Ringwald #endif 57922b838201SMatthias Ringwald 579326fe9592SMatthias Ringwald static void hci_halting_timeout_handler(btstack_timer_source_t * ds){ 579426fe9592SMatthias Ringwald UNUSED(ds); 579526fe9592SMatthias Ringwald hci_stack->substate = HCI_HALTING_CLOSE; 5796f021201aSMatthias Ringwald hci_halting_run(); 579726fe9592SMatthias Ringwald } 579826fe9592SMatthias Ringwald 5799f30077b7SMatthias Ringwald static bool hci_run_acl_fragments(void){ 58004ea43905SMatthias Ringwald if (hci_stack->acl_fragmentation_total_size > 0u) { 5801b5d8b22bS[email protected] hci_con_handle_t con_handle = READ_ACL_CONNECTION_HANDLE(hci_stack->hci_packet_buffer); 5802b5d8b22bS[email protected] hci_connection_t *connection = hci_connection_for_handle(con_handle); 5803b5d8b22bS[email protected] if (connection) { 580428a0332dSMatthias Ringwald if (hci_can_send_prepared_acl_packet_now(con_handle)){ 5805b5d8b22bS[email protected] hci_send_acl_packet_fragments(connection); 5806f30077b7SMatthias Ringwald return true; 5807b5d8b22bS[email protected] } 580828a0332dSMatthias Ringwald } else { 5809b5d8b22bS[email protected] // connection gone -> discard further fragments 581028a0332dSMatthias Ringwald log_info("hci_run: fragmented ACL packet no connection -> discard fragment"); 5811b5d8b22bS[email protected] hci_stack->acl_fragmentation_total_size = 0; 5812b5d8b22bS[email protected] hci_stack->acl_fragmentation_pos = 0; 5813b5d8b22bS[email protected] } 5814b5d8b22bS[email protected] } 5815f30077b7SMatthias Ringwald return false; 58162b838201SMatthias Ringwald } 5817b031bebbSmatthias.ringwald 581868ab6207SMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS 581968ab6207SMatthias Ringwald static bool hci_run_iso_fragments(void){ 582068ab6207SMatthias Ringwald if (hci_stack->iso_fragmentation_total_size > 0u) { 582168ab6207SMatthias Ringwald // TODO: flow control 582268ab6207SMatthias Ringwald if (hci_transport_can_send_prepared_packet_now(HCI_ISO_DATA_PACKET)){ 582368ab6207SMatthias Ringwald hci_send_iso_packet_fragments(); 582468ab6207SMatthias Ringwald return true; 582568ab6207SMatthias Ringwald } 582668ab6207SMatthias Ringwald } 582768ab6207SMatthias Ringwald return false; 582868ab6207SMatthias Ringwald } 582968ab6207SMatthias Ringwald #endif 583068ab6207SMatthias Ringwald 583135454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 58326c0d5426SMatthias Ringwald 58336c0d5426SMatthias Ringwald #ifdef ENABLE_HCI_SERIALIZED_CONTROLLER_OPERATIONS 58346c0d5426SMatthias Ringwald static bool hci_classic_operation_active(void) { 58356c0d5426SMatthias Ringwald if (hci_stack->inquiry_state >= GAP_INQUIRY_STATE_W4_ACTIVE){ 58366c0d5426SMatthias Ringwald return true; 58376c0d5426SMatthias Ringwald } 58386c0d5426SMatthias Ringwald if (hci_stack->remote_name_state == GAP_REMOTE_NAME_STATE_W4_COMPLETE){ 58396c0d5426SMatthias Ringwald return true; 58406c0d5426SMatthias Ringwald } 58416c0d5426SMatthias Ringwald btstack_linked_item_t * it; 58426c0d5426SMatthias Ringwald for (it = (btstack_linked_item_t *) hci_stack->connections; it != NULL; it = it->next) { 58436c0d5426SMatthias Ringwald hci_connection_t *connection = (hci_connection_t *) it; 58446c0d5426SMatthias Ringwald switch (connection->state) { 58456c0d5426SMatthias Ringwald case SENT_CREATE_CONNECTION: 58466c0d5426SMatthias Ringwald case SENT_CANCEL_CONNECTION: 58476c0d5426SMatthias Ringwald case SENT_DISCONNECT: 58486c0d5426SMatthias Ringwald return true; 58496c0d5426SMatthias Ringwald default: 58506c0d5426SMatthias Ringwald break; 58516c0d5426SMatthias Ringwald } 58526c0d5426SMatthias Ringwald } 58536c0d5426SMatthias Ringwald return false; 58546c0d5426SMatthias Ringwald } 58556c0d5426SMatthias Ringwald #endif 58566c0d5426SMatthias Ringwald 5857f30077b7SMatthias Ringwald static bool hci_run_general_gap_classic(void){ 5858f30077b7SMatthias Ringwald 585959d59ecfSMatthias Ringwald // assert stack is working and classic is active 586059d59ecfSMatthias Ringwald if (hci_classic_supported() == false) return false; 586159d59ecfSMatthias Ringwald if (hci_stack->state != HCI_STATE_WORKING) return false; 586259d59ecfSMatthias Ringwald 5863b031bebbSmatthias.ringwald // decline incoming connections 58643a9fb326S[email protected] if (hci_stack->decline_reason){ 58653a9fb326S[email protected] uint8_t reason = hci_stack->decline_reason; 58663a9fb326S[email protected] hci_stack->decline_reason = 0; 58673a9fb326S[email protected] hci_send_cmd(&hci_reject_connection_request, hci_stack->decline_addr, reason); 5868f30077b7SMatthias Ringwald return true; 5869ce4c8fabSmatthias.ringwald } 587059d59ecfSMatthias Ringwald 5871baa4881eSMatthias Ringwald if (hci_stack->gap_tasks_classic != 0){ 5872ab4831a3SMatthias Ringwald hci_run_gap_tasks_classic(); 5873f30077b7SMatthias Ringwald return true; 5874b031bebbSmatthias.ringwald } 587527741fe7SMatthias Ringwald 5876f5875de5SMatthias Ringwald // start/stop inquiry 5877a1df452eSMatthias Ringwald if ((hci_stack->inquiry_state >= GAP_INQUIRY_DURATION_MIN) && (hci_stack->inquiry_state <= GAP_INQUIRY_DURATION_MAX)){ 58786c0d5426SMatthias Ringwald #ifdef ENABLE_HCI_SERIALIZED_CONTROLLER_OPERATIONS 58796c0d5426SMatthias Ringwald if (hci_classic_operation_active() == false) 58806c0d5426SMatthias Ringwald #endif 58816c0d5426SMatthias Ringwald { 5882f5875de5SMatthias Ringwald uint8_t duration = hci_stack->inquiry_state; 5883beb3c81dSMatthias Ringwald hci_stack->inquiry_state = GAP_INQUIRY_STATE_W4_ACTIVE; 588430199e24SMatthias Ringwald if (hci_stack->inquiry_max_period_length != 0){ 588530199e24SMatthias Ringwald hci_send_cmd(&hci_periodic_inquiry_mode, hci_stack->inquiry_max_period_length, hci_stack->inquiry_min_period_length, hci_stack->inquiry_lap, duration, 0); 588630199e24SMatthias Ringwald } else { 5887496bb884SMatthias Ringwald hci_send_cmd(&hci_inquiry, hci_stack->inquiry_lap, duration, 0); 588830199e24SMatthias Ringwald } 5889f30077b7SMatthias Ringwald return true; 5890f5875de5SMatthias Ringwald } 58916c0d5426SMatthias Ringwald } 5892f5875de5SMatthias Ringwald if (hci_stack->inquiry_state == GAP_INQUIRY_STATE_W2_CANCEL){ 5893f5875de5SMatthias Ringwald hci_stack->inquiry_state = GAP_INQUIRY_STATE_W4_CANCELLED; 5894f5875de5SMatthias Ringwald hci_send_cmd(&hci_inquiry_cancel); 5895f30077b7SMatthias Ringwald return true; 5896f5875de5SMatthias Ringwald } 589730199e24SMatthias Ringwald 589830199e24SMatthias Ringwald if (hci_stack->inquiry_state == GAP_INQUIRY_STATE_W2_EXIT_PERIODIC){ 5899bc06f564SMatthias Ringwald hci_stack->inquiry_state = GAP_INQUIRY_STATE_W4_CANCELLED; 590030199e24SMatthias Ringwald hci_send_cmd(&hci_exit_periodic_inquiry_mode); 590130199e24SMatthias Ringwald return true; 590230199e24SMatthias Ringwald } 590330199e24SMatthias Ringwald 5904b7f1ee76SMatthias Ringwald // remote name request 5905b7f1ee76SMatthias Ringwald if (hci_stack->remote_name_state == GAP_REMOTE_NAME_STATE_W2_SEND){ 59066c0d5426SMatthias Ringwald #ifdef ENABLE_HCI_SERIALIZED_CONTROLLER_OPERATIONS 59076c0d5426SMatthias Ringwald if (hci_classic_operation_active() == false) 59086c0d5426SMatthias Ringwald #endif 59096c0d5426SMatthias Ringwald { 5910b7f1ee76SMatthias Ringwald hci_stack->remote_name_state = GAP_REMOTE_NAME_STATE_W4_COMPLETE; 5911b7f1ee76SMatthias Ringwald hci_send_cmd(&hci_remote_name_request, hci_stack->remote_name_addr, 5912ee8a36c8SMatthias Ringwald hci_stack->remote_name_page_scan_repetition_mode, 0, hci_stack->remote_name_clock_offset); 5913f30077b7SMatthias Ringwald return true; 5914b7f1ee76SMatthias Ringwald } 59156c0d5426SMatthias Ringwald } 5916cf01e888SMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB 5917cf01e888SMatthias Ringwald // Local OOB data 591859d59ecfSMatthias Ringwald if (hci_stack->classic_read_local_oob_data){ 5919cf01e888SMatthias Ringwald hci_stack->classic_read_local_oob_data = false; 59201e83575aSMatthias Ringwald if (hci_command_supported(SUPPORTED_HCI_COMMAND_READ_LOCAL_OOB_EXTENDED_DATA_COMMAND)){ 5921cf01e888SMatthias Ringwald hci_send_cmd(&hci_read_local_extended_oob_data); 5922cf01e888SMatthias Ringwald } else { 5923cf01e888SMatthias Ringwald hci_send_cmd(&hci_read_local_oob_data); 5924cf01e888SMatthias Ringwald } 5925cf01e888SMatthias Ringwald } 5926cf01e888SMatthias Ringwald #endif 59270a51f88bSMatthias Ringwald // pairing 59280a51f88bSMatthias Ringwald if (hci_stack->gap_pairing_state != GAP_PAIRING_STATE_IDLE){ 59290a51f88bSMatthias Ringwald uint8_t state = hci_stack->gap_pairing_state; 5930c26f2c7bSMatthias Ringwald uint8_t pin_code[PIN_CODE_LEN]; 59310a51f88bSMatthias Ringwald switch (state){ 59320a51f88bSMatthias Ringwald case GAP_PAIRING_STATE_SEND_PIN: 5933cc15bb2cSMatthias Ringwald hci_stack->gap_pairing_state = GAP_PAIRING_STATE_IDLE; 59343f659ee4SMilanka Ringwald memset(pin_code, 0, 16); 59353f659ee4SMilanka Ringwald memcpy(pin_code, hci_stack->gap_pairing_input.gap_pairing_pin, hci_stack->gap_pairing_pin_len); 59363f659ee4SMilanka Ringwald hci_send_cmd(&hci_pin_code_request_reply, hci_stack->gap_pairing_addr, hci_stack->gap_pairing_pin_len, pin_code); 59370a51f88bSMatthias Ringwald break; 59380a51f88bSMatthias Ringwald case GAP_PAIRING_STATE_SEND_PIN_NEGATIVE: 5939cc15bb2cSMatthias Ringwald hci_stack->gap_pairing_state = GAP_PAIRING_STATE_WAIT_FOR_COMMAND_COMPLETE; 59400a51f88bSMatthias Ringwald hci_send_cmd(&hci_pin_code_request_negative_reply, hci_stack->gap_pairing_addr); 59410a51f88bSMatthias Ringwald break; 59420a51f88bSMatthias Ringwald case GAP_PAIRING_STATE_SEND_PASSKEY: 5943cc15bb2cSMatthias Ringwald hci_stack->gap_pairing_state = GAP_PAIRING_STATE_IDLE; 5944d504181aSMatthias Ringwald hci_send_cmd(&hci_user_passkey_request_reply, hci_stack->gap_pairing_addr, hci_stack->gap_pairing_input.gap_pairing_passkey); 59450a51f88bSMatthias Ringwald break; 59460a51f88bSMatthias Ringwald case GAP_PAIRING_STATE_SEND_PASSKEY_NEGATIVE: 5947cc15bb2cSMatthias Ringwald hci_stack->gap_pairing_state = GAP_PAIRING_STATE_WAIT_FOR_COMMAND_COMPLETE; 59480a51f88bSMatthias Ringwald hci_send_cmd(&hci_user_passkey_request_negative_reply, hci_stack->gap_pairing_addr); 59490a51f88bSMatthias Ringwald break; 59500a51f88bSMatthias Ringwald case GAP_PAIRING_STATE_SEND_CONFIRMATION: 5951cc15bb2cSMatthias Ringwald hci_stack->gap_pairing_state = GAP_PAIRING_STATE_IDLE; 59520a51f88bSMatthias Ringwald hci_send_cmd(&hci_user_confirmation_request_reply, hci_stack->gap_pairing_addr); 59530a51f88bSMatthias Ringwald break; 59540a51f88bSMatthias Ringwald case GAP_PAIRING_STATE_SEND_CONFIRMATION_NEGATIVE: 5955cc15bb2cSMatthias Ringwald hci_stack->gap_pairing_state = GAP_PAIRING_STATE_WAIT_FOR_COMMAND_COMPLETE; 59560a51f88bSMatthias Ringwald hci_send_cmd(&hci_user_confirmation_request_negative_reply, hci_stack->gap_pairing_addr); 59570a51f88bSMatthias Ringwald break; 59580a51f88bSMatthias Ringwald default: 59590a51f88bSMatthias Ringwald break; 59600a51f88bSMatthias Ringwald } 5961f30077b7SMatthias Ringwald return true; 5962f30077b7SMatthias Ringwald } 5963f30077b7SMatthias Ringwald return false; 59640a51f88bSMatthias Ringwald } 596535454696SMatthias Ringwald #endif 5966b031bebbSmatthias.ringwald 5967a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE 5968be7ef9d8SMatthias Ringwald 59697eb5b27eSMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 59707eb5b27eSMatthias Ringwald static uint8_t hci_le_num_phys(uint8_t phys){ 59717eb5b27eSMatthias Ringwald const uint8_t num_bits_set[] = { 0, 1, 1, 2, 1, 2, 2, 3 }; 59727eb5b27eSMatthias Ringwald btstack_assert(phys); 59737eb5b27eSMatthias Ringwald return num_bits_set[phys]; 59747eb5b27eSMatthias Ringwald } 59757eb5b27eSMatthias Ringwald #endif 59767eb5b27eSMatthias Ringwald 5977c42da3bcSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 5978c42da3bcSMatthias Ringwald static void hci_le_scan_stop(void){ 5979c42da3bcSMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 598022f987e4SMatthias Ringwald if (hci_le_extended_advertising_supported()) { 5981c42da3bcSMatthias Ringwald hci_send_cmd(&hci_le_set_extended_scan_enable, 0, 0, 0, 0); 5982c42da3bcSMatthias Ringwald } else 5983c42da3bcSMatthias Ringwald #endif 5984c42da3bcSMatthias Ringwald { 5985c42da3bcSMatthias Ringwald hci_send_cmd(&hci_le_set_scan_enable, 0, 0); 5986c42da3bcSMatthias Ringwald } 5987c42da3bcSMatthias Ringwald } 5988327f7f07SMatthias Ringwald 5989f346015eSMatthias Ringwald static void 5990f346015eSMatthias Ringwald hci_send_le_create_connection(uint8_t initiator_filter_policy, bd_addr_type_t address_type, uint8_t *address) { 5991327f7f07SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 599222f987e4SMatthias Ringwald if (hci_le_extended_advertising_supported()) { 59937eb5b27eSMatthias Ringwald // prepare arrays for all phys (LE Coded, LE 1M, LE 2M PHY) 59947eb5b27eSMatthias Ringwald uint16_t le_connection_scan_interval[3]; 59957eb5b27eSMatthias Ringwald uint16_t le_connection_scan_window[3]; 59967eb5b27eSMatthias Ringwald uint16_t le_connection_interval_min[3]; 59977eb5b27eSMatthias Ringwald uint16_t le_connection_interval_max[3]; 59987eb5b27eSMatthias Ringwald uint16_t le_connection_latency[3]; 59997eb5b27eSMatthias Ringwald uint16_t le_supervision_timeout[3]; 60007eb5b27eSMatthias Ringwald uint16_t le_minimum_ce_length[3]; 60017eb5b27eSMatthias Ringwald uint16_t le_maximum_ce_length[3]; 60027eb5b27eSMatthias Ringwald 60037eb5b27eSMatthias Ringwald uint8_t i; 60047eb5b27eSMatthias Ringwald uint8_t num_phys = hci_le_num_phys(hci_stack->le_connection_phys); 60057eb5b27eSMatthias Ringwald for (i=0;i<num_phys;i++){ 60067eb5b27eSMatthias Ringwald le_connection_scan_interval[i] = hci_stack->le_connection_scan_interval; 60077eb5b27eSMatthias Ringwald le_connection_scan_window[i] = hci_stack->le_connection_scan_window; 60087eb5b27eSMatthias Ringwald le_connection_interval_min[i] = hci_stack->le_connection_interval_min; 60097eb5b27eSMatthias Ringwald le_connection_interval_max[i] = hci_stack->le_connection_interval_max; 60107eb5b27eSMatthias Ringwald le_connection_latency[i] = hci_stack->le_connection_latency; 60117eb5b27eSMatthias Ringwald le_supervision_timeout[i] = hci_stack->le_supervision_timeout; 60127eb5b27eSMatthias Ringwald le_minimum_ce_length[i] = hci_stack->le_minimum_ce_length; 60137eb5b27eSMatthias Ringwald le_maximum_ce_length[i] = hci_stack->le_maximum_ce_length; 60147eb5b27eSMatthias Ringwald } 6015327f7f07SMatthias Ringwald hci_send_cmd(&hci_le_extended_create_connection, 6016f346015eSMatthias Ringwald initiator_filter_policy, 6017327f7f07SMatthias Ringwald hci_stack->le_connection_own_addr_type, // our addr type: 6018f346015eSMatthias Ringwald address_type, // peer address type 6019f346015eSMatthias Ringwald address, // peer bd addr 60207eb5b27eSMatthias Ringwald hci_stack->le_connection_phys, // initiating PHY 6021327f7f07SMatthias Ringwald le_connection_scan_interval, // conn scan interval 6022327f7f07SMatthias Ringwald le_connection_scan_window, // conn scan windows 6023327f7f07SMatthias Ringwald le_connection_interval_min, // conn interval min 6024327f7f07SMatthias Ringwald le_connection_interval_max, // conn interval max 6025327f7f07SMatthias Ringwald le_connection_latency, // conn latency 6026327f7f07SMatthias Ringwald le_supervision_timeout, // conn latency 6027327f7f07SMatthias Ringwald le_minimum_ce_length, // min ce length 6028327f7f07SMatthias Ringwald le_maximum_ce_length // max ce length 6029327f7f07SMatthias Ringwald ); 6030d935373dSMatthias Ringwald } else 6031327f7f07SMatthias Ringwald #endif 6032327f7f07SMatthias Ringwald { 6033327f7f07SMatthias Ringwald hci_send_cmd(&hci_le_create_connection, 6034327f7f07SMatthias Ringwald hci_stack->le_connection_scan_interval, // conn scan interval 6035327f7f07SMatthias Ringwald hci_stack->le_connection_scan_window, // conn scan windows 6036f346015eSMatthias Ringwald initiator_filter_policy, // don't use whitelist 6037f346015eSMatthias Ringwald address_type, // peer address type 6038f346015eSMatthias Ringwald address, // peer bd addr 6039327f7f07SMatthias Ringwald hci_stack->le_connection_own_addr_type, // our addr type: 6040327f7f07SMatthias Ringwald hci_stack->le_connection_interval_min, // conn interval min 6041327f7f07SMatthias Ringwald hci_stack->le_connection_interval_max, // conn interval max 6042327f7f07SMatthias Ringwald hci_stack->le_connection_latency, // conn latency 6043327f7f07SMatthias Ringwald hci_stack->le_supervision_timeout, // conn latency 6044327f7f07SMatthias Ringwald hci_stack->le_minimum_ce_length, // min ce length 6045327f7f07SMatthias Ringwald hci_stack->le_maximum_ce_length // max ce length 6046327f7f07SMatthias Ringwald ); 6047327f7f07SMatthias Ringwald } 6048327f7f07SMatthias Ringwald } 6049c42da3bcSMatthias Ringwald #endif 6050c42da3bcSMatthias Ringwald 6051be7ef9d8SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 6052be7ef9d8SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 6053033393eeSBob Abeles static uint8_t hci_le_extended_advertising_operation_for_chunk(uint16_t pos, uint16_t len){ 6054be7ef9d8SMatthias Ringwald uint8_t operation = 0; 6055be7ef9d8SMatthias Ringwald if (pos == 0){ 6056be7ef9d8SMatthias Ringwald // first fragment or complete data 6057be7ef9d8SMatthias Ringwald operation |= 1; 6058be7ef9d8SMatthias Ringwald } 6059be7ef9d8SMatthias Ringwald if (pos + LE_EXTENDED_ADVERTISING_MAX_CHUNK_LEN >= len){ 6060be7ef9d8SMatthias Ringwald // last fragment or complete data 6061be7ef9d8SMatthias Ringwald operation |= 2; 6062be7ef9d8SMatthias Ringwald } 6063be7ef9d8SMatthias Ringwald return operation; 6064be7ef9d8SMatthias Ringwald } 6065be7ef9d8SMatthias Ringwald #endif 6066be7ef9d8SMatthias Ringwald #endif 6067be7ef9d8SMatthias Ringwald 6068f30077b7SMatthias Ringwald static bool hci_run_general_gap_le(void){ 6069f30077b7SMatthias Ringwald 6070f40c73b4SMatthias Ringwald btstack_linked_list_iterator_t lit; 6071f40c73b4SMatthias Ringwald 60722052d96cSMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 60732052d96cSMatthias Ringwald if (hci_stack->le_resolvable_private_address_update_s > 0){ 60742052d96cSMatthias Ringwald uint16_t update_s = hci_stack->le_resolvable_private_address_update_s; 60752052d96cSMatthias Ringwald hci_stack->le_resolvable_private_address_update_s = 0; 60762052d96cSMatthias Ringwald hci_send_cmd(&hci_le_set_resolvable_private_address_timeout, update_s); 60772052d96cSMatthias Ringwald return true; 60782052d96cSMatthias Ringwald } 60792052d96cSMatthias Ringwald #endif 60802052d96cSMatthias Ringwald 6081a41310b7SMatthias Ringwald // Phase 1: collect what to stop 6082a41310b7SMatthias Ringwald 608349a6c69cSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 6084a41310b7SMatthias Ringwald bool scanning_stop = false; 6085a41310b7SMatthias Ringwald bool connecting_stop = false; 6086be7ef9d8SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 6087c814a904SMatthias Ringwald #ifdef ENABLE_LE_PERIODIC_ADVERTISING 60884bafedd5SMatthias Ringwald bool periodic_sync_stop = false; 60894bafedd5SMatthias Ringwald #endif 6090be7ef9d8SMatthias Ringwald #endif 6091c814a904SMatthias Ringwald #endif 6092be7ef9d8SMatthias Ringwald 609349a6c69cSMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 609449a6c69cSMatthias Ringwald bool advertising_stop = false; 609549a6c69cSMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 609649a6c69cSMatthias Ringwald le_advertising_set_t * advertising_stop_set = NULL; 609749a6c69cSMatthias Ringwald #ifdef ENABLE_LE_PERIODIC_ADVERTISING 609849a6c69cSMatthias Ringwald bool periodic_advertising_stop = false; 6099a41310b7SMatthias Ringwald #endif 610049a6c69cSMatthias Ringwald #endif 6101a41310b7SMatthias Ringwald #endif 6102a41310b7SMatthias Ringwald 61039136bde8SMatthias Ringwald // check if own address changes 61049ce6dfa1SMatthias Ringwald uint8_t address_change_mask = LE_ADVERTISEMENT_TASKS_SET_ADDRESS | LE_ADVERTISEMENT_TASKS_SET_ADDRESS_SET_0; 61059ce6dfa1SMatthias Ringwald bool random_address_change = (hci_stack->le_advertisements_todo & address_change_mask) != 0; 61069136bde8SMatthias Ringwald 610729c24bebSMatthias Ringwald // check if whitelist needs modification 610829c24bebSMatthias Ringwald bool whitelist_modification_pending = false; 610929c24bebSMatthias Ringwald btstack_linked_list_iterator_init(&lit, &hci_stack->le_whitelist); 611029c24bebSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&lit)){ 611129c24bebSMatthias Ringwald whitelist_entry_t * entry = (whitelist_entry_t*) btstack_linked_list_iterator_next(&lit); 611229c24bebSMatthias Ringwald if (entry->state & (LE_WHITELIST_REMOVE_FROM_CONTROLLER | LE_WHITELIST_ADD_TO_CONTROLLER)){ 611329c24bebSMatthias Ringwald whitelist_modification_pending = true; 611429c24bebSMatthias Ringwald break; 611529c24bebSMatthias Ringwald } 611629c24bebSMatthias Ringwald } 6117f40c73b4SMatthias Ringwald 611821debf25SMatthias Ringwald // check if resolving list needs modification 611921debf25SMatthias Ringwald bool resolving_list_modification_pending = false; 612021debf25SMatthias Ringwald #ifdef ENABLE_LE_PRIVACY_ADDRESS_RESOLUTION 61211ffa425cSMatthias Ringwald bool resolving_list_supported = hci_command_supported(SUPPORTED_HCI_COMMAND_LE_SET_ADDRESS_RESOLUTION_ENABLE); 6122ea151974SMatthias Ringwald if (resolving_list_supported && hci_stack->le_resolving_list_state != LE_RESOLVING_LIST_DONE){ 612321debf25SMatthias Ringwald resolving_list_modification_pending = true; 612421debf25SMatthias Ringwald } 612521debf25SMatthias Ringwald #endif 612629c24bebSMatthias Ringwald 6127f40c73b4SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 612849a6c69cSMatthias Ringwald 6129f40c73b4SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 613049a6c69cSMatthias Ringwald // check if periodic advertiser list needs modification 6131f40c73b4SMatthias Ringwald bool periodic_list_modification_pending = false; 6132f40c73b4SMatthias Ringwald btstack_linked_list_iterator_init(&lit, &hci_stack->le_periodic_advertiser_list); 6133f40c73b4SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&lit)){ 6134f40c73b4SMatthias Ringwald periodic_advertiser_list_entry_t * entry = (periodic_advertiser_list_entry_t*) btstack_linked_list_iterator_next(&lit); 6135f40c73b4SMatthias Ringwald if (entry->state & (LE_PERIODIC_ADVERTISER_LIST_ENTRY_ADD_TO_CONTROLLER | LE_PERIODIC_ADVERTISER_LIST_ENTRY_REMOVE_FROM_CONTROLLER)){ 6136f40c73b4SMatthias Ringwald periodic_list_modification_pending = true; 6137f40c73b4SMatthias Ringwald break; 6138f40c73b4SMatthias Ringwald } 6139f40c73b4SMatthias Ringwald } 6140f40c73b4SMatthias Ringwald #endif 6141f40c73b4SMatthias Ringwald 6142fde725feSMatthias Ringwald // scanning control 61433251a108SMatthias Ringwald if (hci_stack->le_scanning_active) { 614429c24bebSMatthias Ringwald // stop if: 614529c24bebSMatthias Ringwald // - parameter change required 614629c24bebSMatthias Ringwald // - it's disabled 614729c24bebSMatthias Ringwald // - whitelist change required but used for scanning 614821debf25SMatthias Ringwald // - resolving list modified 614951e51a58SMatthias Ringwald // - own address changes 615029c24bebSMatthias Ringwald bool scanning_uses_whitelist = (hci_stack->le_scan_filter_policy & 1) == 1; 615121debf25SMatthias Ringwald if ((hci_stack->le_scanning_param_update) || 615221debf25SMatthias Ringwald !hci_stack->le_scanning_enabled || 6153d54b2c94SMatthias Ringwald (scanning_uses_whitelist && whitelist_modification_pending) || 615451e51a58SMatthias Ringwald resolving_list_modification_pending || 615551e51a58SMatthias Ringwald random_address_change){ 615621debf25SMatthias Ringwald 61572d5c2a27SMatthias Ringwald scanning_stop = true; 6158fde725feSMatthias Ringwald } 6159fde725feSMatthias Ringwald } 6160fde725feSMatthias Ringwald 616129c24bebSMatthias Ringwald // connecting control 6162f496d06eSMatthias Ringwald bool connecting_with_whitelist; 6163f496d06eSMatthias Ringwald switch (hci_stack->le_connecting_state){ 6164f496d06eSMatthias Ringwald case LE_CONNECTING_DIRECT: 6165f496d06eSMatthias Ringwald case LE_CONNECTING_WHITELIST: 6166af64f147SMatthias Ringwald // stop connecting if: 6167af64f147SMatthias Ringwald // - connecting uses white and whitelist modification pending 6168af64f147SMatthias Ringwald // - if it got disabled 616921debf25SMatthias Ringwald // - resolving list modified 617051e51a58SMatthias Ringwald // - own address changes 6171f496d06eSMatthias Ringwald connecting_with_whitelist = hci_stack->le_connecting_state == LE_CONNECTING_WHITELIST; 6172f496d06eSMatthias Ringwald if ((connecting_with_whitelist && whitelist_modification_pending) || 617321debf25SMatthias Ringwald (hci_stack->le_connecting_request == LE_CONNECTING_IDLE) || 617451e51a58SMatthias Ringwald resolving_list_modification_pending || 617551e51a58SMatthias Ringwald random_address_change) { 617621debf25SMatthias Ringwald 617729c24bebSMatthias Ringwald connecting_stop = true; 617829c24bebSMatthias Ringwald } 6179f496d06eSMatthias Ringwald break; 6180f496d06eSMatthias Ringwald default: 6181f496d06eSMatthias Ringwald break; 618229c24bebSMatthias Ringwald } 618349a6c69cSMatthias Ringwald 61844bafedd5SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 618549a6c69cSMatthias Ringwald #ifdef ENABLE_LE_PERIODIC_ADVERTISING 61864bafedd5SMatthias Ringwald // periodic sync control 61874bafedd5SMatthias Ringwald bool sync_with_advertiser_list; 61884bafedd5SMatthias Ringwald switch(hci_stack->le_periodic_sync_state){ 61894bafedd5SMatthias Ringwald case LE_CONNECTING_DIRECT: 61904bafedd5SMatthias Ringwald case LE_CONNECTING_WHITELIST: 619149a6c69cSMatthias Ringwald // stop sync if: 61924bafedd5SMatthias Ringwald // - sync with advertiser list and advertiser list modification pending 619349a6c69cSMatthias Ringwald // - if it got disabled 61944bafedd5SMatthias Ringwald sync_with_advertiser_list = hci_stack->le_periodic_sync_state == LE_CONNECTING_WHITELIST; 61954bafedd5SMatthias Ringwald if ((sync_with_advertiser_list && periodic_list_modification_pending) || 61964bafedd5SMatthias Ringwald (hci_stack->le_periodic_sync_request == LE_CONNECTING_IDLE)){ 61974bafedd5SMatthias Ringwald periodic_sync_stop = true; 61984bafedd5SMatthias Ringwald } 61994bafedd5SMatthias Ringwald break; 62004bafedd5SMatthias Ringwald default: 62014bafedd5SMatthias Ringwald break; 62024bafedd5SMatthias Ringwald } 62034bafedd5SMatthias Ringwald #endif 6204d70217a2SMatthias Ringwald #endif 620529c24bebSMatthias Ringwald 620649a6c69cSMatthias Ringwald #endif /* ENABLE_LE_CENTRAL */ 620749a6c69cSMatthias Ringwald 6208d70217a2SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 620945c102fdSMatthias Ringwald // le advertisement control 6210935aa76eSMatthias Ringwald if ((hci_stack->le_advertisements_state & LE_ADVERTISEMENT_STATE_ACTIVE) != 0){ 621129c24bebSMatthias Ringwald // stop if: 621229c24bebSMatthias Ringwald // - parameter change required 62139136bde8SMatthias Ringwald // - random address used in advertising and changes 621429c24bebSMatthias Ringwald // - it's disabled 6215ba44ad41SMatthias Ringwald // - whitelist change required but used for advertisement filter policy 621621debf25SMatthias Ringwald // - resolving list modified 621751e51a58SMatthias Ringwald // - own address changes 6218a61834b6SMatthias Ringwald bool advertising_uses_whitelist = hci_stack->le_advertisements_filter_policy != 0; 62199136bde8SMatthias Ringwald bool advertising_uses_random_address = hci_stack->le_own_addr_type != BD_ADDR_TYPE_LE_PUBLIC; 62204e5d21eaSMatthias Ringwald bool advertising_change = (hci_stack->le_advertisements_todo & LE_ADVERTISEMENT_TASKS_SET_PARAMS) != 0; 6221a61834b6SMatthias Ringwald if (advertising_change || 62229136bde8SMatthias Ringwald (advertising_uses_random_address && random_address_change) || 6223a61834b6SMatthias Ringwald (hci_stack->le_advertisements_enabled_for_current_roles == 0) || 62249136bde8SMatthias Ringwald (advertising_uses_whitelist && whitelist_modification_pending) || 622551e51a58SMatthias Ringwald resolving_list_modification_pending || 622651e51a58SMatthias Ringwald random_address_change) { 622721debf25SMatthias Ringwald 6228fde725feSMatthias Ringwald advertising_stop = true; 6229fde725feSMatthias Ringwald } 6230fde725feSMatthias Ringwald } 6231be7ef9d8SMatthias Ringwald 6232be7ef9d8SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 623322f987e4SMatthias Ringwald if (hci_le_extended_advertising_supported() && (advertising_stop == false)){ 6234be7ef9d8SMatthias Ringwald btstack_linked_list_iterator_t it; 6235be7ef9d8SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->le_advertising_sets); 6236be7ef9d8SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 6237be7ef9d8SMatthias Ringwald le_advertising_set_t * advertising_set = (le_advertising_set_t*) btstack_linked_list_iterator_next(&it); 623853f240c0SMatthias Ringwald if ((advertising_set->state & LE_ADVERTISEMENT_STATE_ACTIVE) != 0) { 6239be7ef9d8SMatthias Ringwald // stop if: 6240be7ef9d8SMatthias Ringwald // - parameter change required 6241be7ef9d8SMatthias Ringwald // - random address used in connectable advertising and changes 6242be7ef9d8SMatthias Ringwald // - it's disabled 6243be7ef9d8SMatthias Ringwald // - whitelist change required but used for advertisement filter policy 6244be7ef9d8SMatthias Ringwald // - resolving list modified 6245be7ef9d8SMatthias Ringwald // - own address changes 6246be7ef9d8SMatthias Ringwald // - advertisement set will be removed 624757a04237SMatthias Ringwald bool advertising_uses_whitelist = advertising_set->extended_params.advertising_filter_policy != 0; 624857a04237SMatthias Ringwald bool advertising_connectable = (advertising_set->extended_params.advertising_event_properties & 1) != 0; 624953f240c0SMatthias Ringwald bool advertising_uses_random_address = 625053f240c0SMatthias Ringwald (advertising_set->extended_params.own_address_type != BD_ADDR_TYPE_LE_PUBLIC) && 625153f240c0SMatthias Ringwald advertising_connectable; 6252be7ef9d8SMatthias Ringwald bool advertising_parameter_change = (advertising_set->tasks & LE_ADVERTISEMENT_TASKS_SET_PARAMS) != 0; 6253be7ef9d8SMatthias Ringwald bool advertising_enabled = (advertising_set->state & LE_ADVERTISEMENT_STATE_ENABLED) != 0; 625453f240c0SMatthias Ringwald bool advertising_set_random_address_change = 625553f240c0SMatthias Ringwald (advertising_set->tasks & LE_ADVERTISEMENT_TASKS_SET_ADDRESS) != 0; 625653f240c0SMatthias Ringwald bool advertising_set_will_be_removed = 625753f240c0SMatthias Ringwald (advertising_set->state & LE_ADVERTISEMENT_TASKS_REMOVE_SET) != 0; 6258be7ef9d8SMatthias Ringwald if (advertising_parameter_change || 6259be7ef9d8SMatthias Ringwald (advertising_uses_random_address && advertising_set_random_address_change) || 6260be7ef9d8SMatthias Ringwald (advertising_enabled == false) || 6261be7ef9d8SMatthias Ringwald (advertising_uses_whitelist && whitelist_modification_pending) || 6262be7ef9d8SMatthias Ringwald resolving_list_modification_pending || 6263be7ef9d8SMatthias Ringwald advertising_set_will_be_removed) { 6264be7ef9d8SMatthias Ringwald 6265be7ef9d8SMatthias Ringwald advertising_stop = true; 6266be7ef9d8SMatthias Ringwald advertising_stop_set = advertising_set; 6267be7ef9d8SMatthias Ringwald break; 6268be7ef9d8SMatthias Ringwald } 6269be7ef9d8SMatthias Ringwald } 6270c814a904SMatthias Ringwald #ifdef ENABLE_LE_PERIODIC_ADVERTISING 627153f240c0SMatthias Ringwald if ((advertising_set->state & LE_ADVERTISEMENT_STATE_PERIODIC_ACTIVE) != 0) { 627253f240c0SMatthias Ringwald // stop if: 627353f240c0SMatthias Ringwald // - it's disabled 627453f240c0SMatthias Ringwald // - parameter change required 627553f240c0SMatthias Ringwald bool periodic_enabled = (advertising_set->state & LE_ADVERTISEMENT_STATE_PERIODIC_ENABLED) != 0; 627653f240c0SMatthias Ringwald bool periodic_parameter_change = (advertising_set->tasks & LE_ADVERTISEMENT_TASKS_SET_PERIODIC_PARAMS) != 0; 627753f240c0SMatthias Ringwald if ((periodic_enabled == false) || periodic_parameter_change){ 627849a6c69cSMatthias Ringwald periodic_advertising_stop = true; 627953f240c0SMatthias Ringwald advertising_stop_set = advertising_set; 628053f240c0SMatthias Ringwald } 628153f240c0SMatthias Ringwald } 628249a6c69cSMatthias Ringwald #endif /* ENABLE_LE_PERIODIC_ADVERTISING */ 628353f240c0SMatthias Ringwald } 6284be7ef9d8SMatthias Ringwald } 6285be7ef9d8SMatthias Ringwald #endif 6286be7ef9d8SMatthias Ringwald 6287a41310b7SMatthias Ringwald #endif 6288fde725feSMatthias Ringwald 6289a41310b7SMatthias Ringwald 6290a41310b7SMatthias Ringwald // Phase 2: stop everything that should be off during modifications 6291a41310b7SMatthias Ringwald 6292131d4778SMatthias Ringwald 6293131d4778SMatthias Ringwald // 2.1 Outgoing connection 6294131d4778SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 6295131d4778SMatthias Ringwald if (connecting_stop){ 6296131d4778SMatthias Ringwald hci_send_cmd(&hci_le_create_connection_cancel); 6297131d4778SMatthias Ringwald return true; 6298131d4778SMatthias Ringwald } 6299131d4778SMatthias Ringwald #endif 6300131d4778SMatthias Ringwald 6301131d4778SMatthias Ringwald // 2.2 Scanning 6302a41310b7SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 6303a41310b7SMatthias Ringwald if (scanning_stop){ 63045226d7f2SMatthias Ringwald hci_stack->le_scanning_active = false; 6305c42da3bcSMatthias Ringwald hci_le_scan_stop(); 6306a41310b7SMatthias Ringwald return true; 6307a41310b7SMatthias Ringwald } 6308a41310b7SMatthias Ringwald 6309131d4778SMatthias Ringwald // 2.3 Periodic Sync 63104bafedd5SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 631149a6c69cSMatthias Ringwald if (hci_stack->le_periodic_terminate_sync_handle != HCI_CON_HANDLE_INVALID){ 631249a6c69cSMatthias Ringwald uint16_t sync_handle = hci_stack->le_periodic_terminate_sync_handle; 631349a6c69cSMatthias Ringwald hci_stack->le_periodic_terminate_sync_handle = HCI_CON_HANDLE_INVALID; 631449a6c69cSMatthias Ringwald hci_send_cmd(&hci_le_periodic_advertising_terminate_sync, sync_handle); 631549a6c69cSMatthias Ringwald return true; 631649a6c69cSMatthias Ringwald } 631749a6c69cSMatthias Ringwald #ifdef ENABLE_LE_PERIODIC_ADVERTISING 63184bafedd5SMatthias Ringwald if (periodic_sync_stop){ 63194bafedd5SMatthias Ringwald hci_stack->le_periodic_sync_state = LE_CONNECTING_CANCEL; 63204bafedd5SMatthias Ringwald hci_send_cmd(&hci_le_periodic_advertising_create_sync_cancel); 63214bafedd5SMatthias Ringwald return true; 63224bafedd5SMatthias Ringwald } 632349a6c69cSMatthias Ringwald #endif /* ENABLE_LE_PERIODIC_ADVERTISING */ 6324a8016f96SMatthias Ringwald #endif /* ENABLE_LE_EXTENDED_ADVERTISING */ 6325a8016f96SMatthias Ringwald #endif /* ENABLE_LE_CENTRAL */ 6326a41310b7SMatthias Ringwald 6327131d4778SMatthias Ringwald // 2.4 Advertising: legacy, extended, periodic 6328a41310b7SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 6329fde725feSMatthias Ringwald if (advertising_stop){ 6330e464cd48SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 633122f987e4SMatthias Ringwald if (hci_le_extended_advertising_supported()) { 6332be7ef9d8SMatthias Ringwald uint8_t advertising_stop_handle; 6333be7ef9d8SMatthias Ringwald if (advertising_stop_set != NULL){ 6334be7ef9d8SMatthias Ringwald advertising_stop_handle = advertising_stop_set->advertising_handle; 6335be7ef9d8SMatthias Ringwald advertising_stop_set->state &= ~LE_ADVERTISEMENT_STATE_ACTIVE; 6336be7ef9d8SMatthias Ringwald } else { 6337be7ef9d8SMatthias Ringwald advertising_stop_handle = 0; 6338be7ef9d8SMatthias Ringwald hci_stack->le_advertisements_state &= ~LE_ADVERTISEMENT_STATE_ACTIVE; 6339be7ef9d8SMatthias Ringwald } 6340be7ef9d8SMatthias Ringwald const uint8_t advertising_handles[] = { advertising_stop_handle }; 6341e464cd48SMatthias Ringwald const uint16_t durations[] = { 0 }; 6342e464cd48SMatthias Ringwald const uint16_t max_events[] = { 0 }; 6343e464cd48SMatthias Ringwald hci_send_cmd(&hci_le_set_extended_advertising_enable, 0, 1, advertising_handles, durations, max_events); 6344e464cd48SMatthias Ringwald } else 6345e464cd48SMatthias Ringwald #endif 6346e464cd48SMatthias Ringwald { 6347be7ef9d8SMatthias Ringwald hci_stack->le_advertisements_state &= ~LE_ADVERTISEMENT_STATE_ACTIVE; 634845c102fdSMatthias Ringwald hci_send_cmd(&hci_le_set_advertise_enable, 0); 6349e464cd48SMatthias Ringwald } 6350f30077b7SMatthias Ringwald return true; 635145c102fdSMatthias Ringwald } 635253f240c0SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 6353c814a904SMatthias Ringwald #ifdef ENABLE_LE_PERIODIC_ADVERTISING 635449a6c69cSMatthias Ringwald if (periodic_advertising_stop){ 635553f240c0SMatthias Ringwald advertising_stop_set->state &= ~LE_ADVERTISEMENT_STATE_PERIODIC_ACTIVE; 635653f240c0SMatthias Ringwald hci_send_cmd(&hci_le_set_periodic_advertising_enable, 0, advertising_stop_set->advertising_handle); 635753f240c0SMatthias Ringwald return true; 635853f240c0SMatthias Ringwald } 6359c814a904SMatthias Ringwald #endif /* ENABLE_LE_PERIODIC_ADVERTISING */ 6360c814a904SMatthias Ringwald #endif /* ENABLE_LE_EXTENDED_ADVERTISING */ 6361a8016f96SMatthias Ringwald #endif /* ENABLE_LE_PERIPHERAL */ 6362fde725feSMatthias Ringwald 6363131d4778SMatthias Ringwald 6364a41310b7SMatthias Ringwald // Phase 3: modify 6365a41310b7SMatthias Ringwald 6366137a570aSMatthias Ringwald if (hci_stack->le_advertisements_todo & LE_ADVERTISEMENT_TASKS_PRIVACY_NOTIFY) { 6367137a570aSMatthias Ringwald hci_stack->le_advertisements_todo &= ~LE_ADVERTISEMENT_TASKS_PRIVACY_NOTIFY; 6368137a570aSMatthias Ringwald // GAP Privacy, notify clients upon upcoming random address change 6369137a570aSMatthias Ringwald hci_stack->le_advertisements_state |= LE_ADVERTISEMENT_STATE_PRIVACY_PENDING; 63701fa7a4bbSMatthias Ringwald // notify might cause hci_run to get executed, check if we still can send 6371137a570aSMatthias Ringwald gap_privacy_clients_notify(hci_stack->le_random_address); 63721fa7a4bbSMatthias Ringwald if (!hci_can_send_command_packet_now()) { 63731fa7a4bbSMatthias Ringwald return true; 63741fa7a4bbSMatthias Ringwald } 6375137a570aSMatthias Ringwald } 6376137a570aSMatthias Ringwald 6377137a570aSMatthias Ringwald // - wait until privacy update completed 6378137a570aSMatthias Ringwald if ((hci_stack->le_advertisements_state & LE_ADVERTISEMENT_STATE_PRIVACY_PENDING) != 0){ 6379137a570aSMatthias Ringwald return false; 6380137a570aSMatthias Ringwald } 6381137a570aSMatthias Ringwald 638264f9dabaSMatthias Ringwald if (hci_stack->le_advertisements_todo & LE_ADVERTISEMENT_TASKS_SET_ADDRESS){ 63839136bde8SMatthias Ringwald hci_stack->le_advertisements_todo &= ~LE_ADVERTISEMENT_TASKS_SET_ADDRESS; 63849136bde8SMatthias Ringwald hci_send_cmd(&hci_le_set_random_address, hci_stack->le_random_address); 6385ae35a99cSMatthias Ringwald #ifdef ENABLE_LE_SET_ADV_PARAMS_ON_RANDOM_ADDRESS_CHANGE 6386ae35a99cSMatthias Ringwald // workaround: on some Controllers, address in advertisements is updated only after next dv params set 6387ae35a99cSMatthias Ringwald hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_SET_PARAMS; 6388ae35a99cSMatthias Ringwald #endif 63899136bde8SMatthias Ringwald return true; 63909136bde8SMatthias Ringwald } 63919136bde8SMatthias Ringwald 6392a41310b7SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 6393a41310b7SMatthias Ringwald if (hci_stack->le_scanning_param_update){ 6394a41310b7SMatthias Ringwald hci_stack->le_scanning_param_update = false; 639563671e69SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 639622f987e4SMatthias Ringwald if (hci_le_extended_advertising_supported()){ 63977eb5b27eSMatthias Ringwald // prepare arrays for all phys (LE Coded and LE 1M PHY) 63987eb5b27eSMatthias Ringwald uint8_t scan_types[2]; 63997eb5b27eSMatthias Ringwald uint16_t scan_intervals[2]; 64007eb5b27eSMatthias Ringwald uint16_t scan_windows[2]; 64017eb5b27eSMatthias Ringwald 64027eb5b27eSMatthias Ringwald uint8_t i; 64037eb5b27eSMatthias Ringwald uint8_t num_phys = hci_le_num_phys(hci_stack->le_scan_phys); 64047eb5b27eSMatthias Ringwald for (i=0;i<num_phys;i++){ 64057eb5b27eSMatthias Ringwald scan_types[i] = hci_stack->le_scan_type; 64067eb5b27eSMatthias Ringwald scan_intervals[i] = hci_stack->le_scan_interval; 64077eb5b27eSMatthias Ringwald scan_windows[i] = hci_stack->le_scan_window; 64087eb5b27eSMatthias Ringwald } 640963671e69SMatthias Ringwald hci_send_cmd(&hci_le_set_extended_scan_parameters, hci_stack->le_own_addr_type, 64107eb5b27eSMatthias Ringwald hci_stack->le_scan_filter_policy, hci_stack->le_scan_phys, scan_types, scan_intervals, scan_windows); 641163671e69SMatthias Ringwald } else 641263671e69SMatthias Ringwald #endif 641363671e69SMatthias Ringwald { 6414a41310b7SMatthias Ringwald hci_send_cmd(&hci_le_set_scan_parameters, hci_stack->le_scan_type, hci_stack->le_scan_interval, hci_stack->le_scan_window, 6415a41310b7SMatthias Ringwald hci_stack->le_own_addr_type, hci_stack->le_scan_filter_policy); 641663671e69SMatthias Ringwald } 6417a41310b7SMatthias Ringwald return true; 6418a41310b7SMatthias Ringwald } 6419a41310b7SMatthias Ringwald #endif 6420a41310b7SMatthias Ringwald 6421a41310b7SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 642245c102fdSMatthias Ringwald if (hci_stack->le_advertisements_todo & LE_ADVERTISEMENT_TASKS_SET_PARAMS){ 642345c102fdSMatthias Ringwald hci_stack->le_advertisements_todo &= ~LE_ADVERTISEMENT_TASKS_SET_PARAMS; 64246bcfa632SMatthias Ringwald hci_stack->le_advertisements_own_addr_type = hci_stack->le_own_addr_type; 6425e464cd48SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 642622f987e4SMatthias Ringwald if (hci_le_extended_advertising_supported()){ 6427e464cd48SMatthias Ringwald // map advertisment type to advertising event properties 6428e464cd48SMatthias Ringwald uint16_t adv_event_properties = 0; 6429e464cd48SMatthias Ringwald const uint16_t mapping[] = { 0b00010011, 0b00010101, 0b00011101, 0b00010010, 0b00010000}; 6430e464cd48SMatthias Ringwald if (hci_stack->le_advertisements_type < (sizeof(mapping)/sizeof(uint16_t))){ 6431e464cd48SMatthias Ringwald adv_event_properties = mapping[hci_stack->le_advertisements_type]; 6432e464cd48SMatthias Ringwald } 6433174b4d21SMatthias Ringwald hci_stack->le_advertising_set_in_current_command = 0; 6434e464cd48SMatthias Ringwald hci_send_cmd(&hci_le_set_extended_advertising_parameters, 6435e464cd48SMatthias Ringwald 0, 6436e464cd48SMatthias Ringwald adv_event_properties, 6437e464cd48SMatthias Ringwald hci_stack->le_advertisements_interval_min, 6438e464cd48SMatthias Ringwald hci_stack->le_advertisements_interval_max, 6439e464cd48SMatthias Ringwald hci_stack->le_advertisements_channel_map, 6440e464cd48SMatthias Ringwald hci_stack->le_advertisements_own_addr_type, 6441e464cd48SMatthias Ringwald hci_stack->le_advertisements_direct_address_type, 6442e464cd48SMatthias Ringwald hci_stack->le_advertisements_direct_address, 6443e464cd48SMatthias Ringwald hci_stack->le_advertisements_filter_policy, 6444e464cd48SMatthias Ringwald 0x7f, // tx power: no preference 6445e464cd48SMatthias Ringwald 0x01, // primary adv phy: LE 1M 6446e464cd48SMatthias Ringwald 0, // secondary adv max skip 64475375ad13SMatthias Ringwald 0x01, // secondary adv phy 6448e464cd48SMatthias Ringwald 0, // adv sid 6449e464cd48SMatthias Ringwald 0 // scan request notification 6450e464cd48SMatthias Ringwald ); 6451d935373dSMatthias Ringwald } else 6452e464cd48SMatthias Ringwald #endif 6453e464cd48SMatthias Ringwald { 645445c102fdSMatthias Ringwald hci_send_cmd(&hci_le_set_advertising_parameters, 645545c102fdSMatthias Ringwald hci_stack->le_advertisements_interval_min, 645645c102fdSMatthias Ringwald hci_stack->le_advertisements_interval_max, 645745c102fdSMatthias Ringwald hci_stack->le_advertisements_type, 64586bcfa632SMatthias Ringwald hci_stack->le_advertisements_own_addr_type, 645945c102fdSMatthias Ringwald hci_stack->le_advertisements_direct_address_type, 646045c102fdSMatthias Ringwald hci_stack->le_advertisements_direct_address, 646145c102fdSMatthias Ringwald hci_stack->le_advertisements_channel_map, 646245c102fdSMatthias Ringwald hci_stack->le_advertisements_filter_policy); 6463e464cd48SMatthias Ringwald } 6464f30077b7SMatthias Ringwald return true; 646545c102fdSMatthias Ringwald } 6466be7ef9d8SMatthias Ringwald 64679ce6dfa1SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 64689ce6dfa1SMatthias Ringwald // assumption: only set if extended advertising is supported 64699ce6dfa1SMatthias Ringwald if ((hci_stack->le_advertisements_todo & LE_ADVERTISEMENT_TASKS_SET_ADDRESS_SET_0) != 0){ 64709ce6dfa1SMatthias Ringwald hci_stack->le_advertisements_todo &= ~LE_ADVERTISEMENT_TASKS_SET_ADDRESS_SET_0; 64719ce6dfa1SMatthias Ringwald hci_send_cmd(&hci_le_set_advertising_set_random_address, 0, hci_stack->le_random_address); 64729ce6dfa1SMatthias Ringwald return true; 64739ce6dfa1SMatthias Ringwald } 64749ce6dfa1SMatthias Ringwald #endif 64759ce6dfa1SMatthias Ringwald 6476501f56b3SMatthias Ringwald if (hci_stack->le_advertisements_todo & LE_ADVERTISEMENT_TASKS_SET_ADV_DATA){ 6477501f56b3SMatthias Ringwald hci_stack->le_advertisements_todo &= ~LE_ADVERTISEMENT_TASKS_SET_ADV_DATA; 64787a85e4f5SMatthias Ringwald uint8_t adv_data_clean[31]; 64797a85e4f5SMatthias Ringwald memset(adv_data_clean, 0, sizeof(adv_data_clean)); 64806535961aSMatthias Ringwald (void)memcpy(adv_data_clean, hci_stack->le_advertisements_data, 64816535961aSMatthias Ringwald hci_stack->le_advertisements_data_len); 64823c9da642SMatthias Ringwald btstack_replace_bd_addr_placeholder(adv_data_clean, hci_stack->le_advertisements_data_len, hci_stack->local_bd_addr); 6483e464cd48SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 648422f987e4SMatthias Ringwald if (hci_le_extended_advertising_supported()){ 6485174b4d21SMatthias Ringwald hci_stack->le_advertising_set_in_current_command = 0; 6486e464cd48SMatthias Ringwald hci_send_cmd(&hci_le_set_extended_advertising_data, 0, 0x03, 0x01, hci_stack->le_advertisements_data_len, adv_data_clean); 6487e464cd48SMatthias Ringwald } else 6488e464cd48SMatthias Ringwald #endif 6489e464cd48SMatthias Ringwald { 64907a85e4f5SMatthias Ringwald hci_send_cmd(&hci_le_set_advertising_data, hci_stack->le_advertisements_data_len, adv_data_clean); 6491e464cd48SMatthias Ringwald } 6492f30077b7SMatthias Ringwald return true; 649345c102fdSMatthias Ringwald } 6494be7ef9d8SMatthias Ringwald 6495501f56b3SMatthias Ringwald if (hci_stack->le_advertisements_todo & LE_ADVERTISEMENT_TASKS_SET_SCAN_DATA){ 6496501f56b3SMatthias Ringwald hci_stack->le_advertisements_todo &= ~LE_ADVERTISEMENT_TASKS_SET_SCAN_DATA; 6497f868b059SMatthias Ringwald uint8_t scan_data_clean[31]; 6498f868b059SMatthias Ringwald memset(scan_data_clean, 0, sizeof(scan_data_clean)); 64996535961aSMatthias Ringwald (void)memcpy(scan_data_clean, hci_stack->le_scan_response_data, 65006535961aSMatthias Ringwald hci_stack->le_scan_response_data_len); 65013c9da642SMatthias Ringwald btstack_replace_bd_addr_placeholder(scan_data_clean, hci_stack->le_scan_response_data_len, hci_stack->local_bd_addr); 6502e464cd48SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 650322f987e4SMatthias Ringwald if (hci_le_extended_advertising_supported()){ 6504174b4d21SMatthias Ringwald hci_stack->le_advertising_set_in_current_command = 0; 6505e464cd48SMatthias Ringwald hci_send_cmd(&hci_le_set_extended_scan_response_data, 0, 0x03, 0x01, hci_stack->le_scan_response_data_len, scan_data_clean); 6506e464cd48SMatthias Ringwald } else 6507e464cd48SMatthias Ringwald #endif 6508e464cd48SMatthias Ringwald { 6509214bfd60SMatthias Ringwald hci_send_cmd(&hci_le_set_scan_response_data, hci_stack->le_scan_response_data_len, scan_data_clean); 6510e464cd48SMatthias Ringwald } 6511f30077b7SMatthias Ringwald return true; 6512501f56b3SMatthias Ringwald } 6513be7ef9d8SMatthias Ringwald 6514be7ef9d8SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 651522f987e4SMatthias Ringwald if (hci_le_extended_advertising_supported()) { 6516be7ef9d8SMatthias Ringwald btstack_linked_list_iterator_t it; 6517be7ef9d8SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->le_advertising_sets); 6518be7ef9d8SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 6519be7ef9d8SMatthias Ringwald le_advertising_set_t * advertising_set = (le_advertising_set_t*) btstack_linked_list_iterator_next(&it); 6520be7ef9d8SMatthias Ringwald if ((advertising_set->tasks & LE_ADVERTISEMENT_TASKS_REMOVE_SET) != 0) { 6521be7ef9d8SMatthias Ringwald advertising_set->tasks &= ~LE_ADVERTISEMENT_TASKS_REMOVE_SET; 6522174b4d21SMatthias Ringwald hci_stack->le_advertising_set_in_current_command = advertising_set->advertising_handle; 6523be7ef9d8SMatthias Ringwald hci_send_cmd(&hci_le_remove_advertising_set, advertising_set->advertising_handle); 6524be7ef9d8SMatthias Ringwald return true; 6525be7ef9d8SMatthias Ringwald } 6526be7ef9d8SMatthias Ringwald if ((advertising_set->tasks & LE_ADVERTISEMENT_TASKS_SET_PARAMS) != 0){ 6527be7ef9d8SMatthias Ringwald advertising_set->tasks &= ~LE_ADVERTISEMENT_TASKS_SET_PARAMS; 6528174b4d21SMatthias Ringwald hci_stack->le_advertising_set_in_current_command = advertising_set->advertising_handle; 6529be7ef9d8SMatthias Ringwald hci_send_cmd(&hci_le_set_extended_advertising_parameters, 6530be7ef9d8SMatthias Ringwald advertising_set->advertising_handle, 653157a04237SMatthias Ringwald advertising_set->extended_params.advertising_event_properties, 653257a04237SMatthias Ringwald advertising_set->extended_params.primary_advertising_interval_min, 653357a04237SMatthias Ringwald advertising_set->extended_params.primary_advertising_interval_max, 653457a04237SMatthias Ringwald advertising_set->extended_params.primary_advertising_channel_map, 653557a04237SMatthias Ringwald advertising_set->extended_params.own_address_type, 653657a04237SMatthias Ringwald advertising_set->extended_params.peer_address_type, 653757a04237SMatthias Ringwald advertising_set->extended_params.peer_address, 653857a04237SMatthias Ringwald advertising_set->extended_params.advertising_filter_policy, 653957a04237SMatthias Ringwald advertising_set->extended_params.advertising_tx_power, 654057a04237SMatthias Ringwald advertising_set->extended_params.primary_advertising_phy, 654157a04237SMatthias Ringwald advertising_set->extended_params.secondary_advertising_max_skip, 654257a04237SMatthias Ringwald advertising_set->extended_params.secondary_advertising_phy, 654357a04237SMatthias Ringwald advertising_set->extended_params.advertising_sid, 654457a04237SMatthias Ringwald advertising_set->extended_params.scan_request_notification_enable 6545be7ef9d8SMatthias Ringwald ); 6546be7ef9d8SMatthias Ringwald return true; 6547be7ef9d8SMatthias Ringwald } 65480f54aa8dSMatthias Ringwald if ((advertising_set->tasks & LE_ADVERTISEMENT_TASKS_SET_ADDRESS) != 0){ 65490f54aa8dSMatthias Ringwald advertising_set->tasks &= ~LE_ADVERTISEMENT_TASKS_SET_ADDRESS; 65500f54aa8dSMatthias Ringwald hci_send_cmd(&hci_le_set_advertising_set_random_address, advertising_set->advertising_handle, advertising_set->random_address); 65510f54aa8dSMatthias Ringwald return true; 65520f54aa8dSMatthias Ringwald } 6553be7ef9d8SMatthias Ringwald if ((advertising_set->tasks & LE_ADVERTISEMENT_TASKS_SET_ADV_DATA) != 0) { 6554be7ef9d8SMatthias Ringwald uint16_t pos = advertising_set->adv_data_pos; 6555be7ef9d8SMatthias Ringwald uint8_t operation = hci_le_extended_advertising_operation_for_chunk(pos, advertising_set->adv_data_len); 6556be7ef9d8SMatthias Ringwald uint16_t data_to_upload = btstack_min(advertising_set->adv_data_len - pos, LE_EXTENDED_ADVERTISING_MAX_CHUNK_LEN); 6557be7ef9d8SMatthias Ringwald if ((operation & 0x02) != 0){ 6558be7ef9d8SMatthias Ringwald // last fragment or complete data 6559be7ef9d8SMatthias Ringwald operation |= 2; 6560be7ef9d8SMatthias Ringwald advertising_set->adv_data_pos = 0; 6561be7ef9d8SMatthias Ringwald advertising_set->tasks &= ~LE_ADVERTISEMENT_TASKS_SET_ADV_DATA; 6562be7ef9d8SMatthias Ringwald } else { 6563be7ef9d8SMatthias Ringwald advertising_set->adv_data_pos += data_to_upload; 6564be7ef9d8SMatthias Ringwald } 6565174b4d21SMatthias Ringwald hci_stack->le_advertising_set_in_current_command = advertising_set->advertising_handle; 65660cbe4690SMatthias Ringwald hci_send_cmd(&hci_le_set_extended_advertising_data, advertising_set->advertising_handle, operation, 0x01, data_to_upload, &advertising_set->adv_data[pos]); 6567be7ef9d8SMatthias Ringwald return true; 6568be7ef9d8SMatthias Ringwald } 6569be7ef9d8SMatthias Ringwald if ((advertising_set->tasks & LE_ADVERTISEMENT_TASKS_SET_SCAN_DATA) != 0) { 6570be7ef9d8SMatthias Ringwald uint16_t pos = advertising_set->scan_data_pos; 6571be7ef9d8SMatthias Ringwald uint8_t operation = hci_le_extended_advertising_operation_for_chunk(pos, advertising_set->scan_data_len); 6572be7ef9d8SMatthias Ringwald uint16_t data_to_upload = btstack_min(advertising_set->scan_data_len - pos, LE_EXTENDED_ADVERTISING_MAX_CHUNK_LEN); 6573be7ef9d8SMatthias Ringwald if ((operation & 0x02) != 0){ 6574be7ef9d8SMatthias Ringwald advertising_set->scan_data_pos = 0; 6575be7ef9d8SMatthias Ringwald advertising_set->tasks &= ~LE_ADVERTISEMENT_TASKS_SET_SCAN_DATA; 6576be7ef9d8SMatthias Ringwald } else { 6577be7ef9d8SMatthias Ringwald advertising_set->scan_data_pos += data_to_upload; 6578be7ef9d8SMatthias Ringwald } 6579174b4d21SMatthias Ringwald hci_stack->le_advertising_set_in_current_command = advertising_set->advertising_handle; 65808ef6d15fSMatthias Ringwald hci_send_cmd(&hci_le_set_extended_scan_response_data, advertising_set->advertising_handle, operation, 0x01, data_to_upload, &advertising_set->scan_data[pos]); 6581be7ef9d8SMatthias Ringwald return true; 6582be7ef9d8SMatthias Ringwald } 6583c814a904SMatthias Ringwald #ifdef ENABLE_LE_PERIODIC_ADVERTISING 658453f240c0SMatthias Ringwald if ((advertising_set->tasks & LE_ADVERTISEMENT_TASKS_SET_PERIODIC_PARAMS) != 0){ 658553f240c0SMatthias Ringwald advertising_set->tasks &= ~LE_ADVERTISEMENT_TASKS_SET_PERIODIC_PARAMS; 658653f240c0SMatthias Ringwald hci_stack->le_advertising_set_in_current_command = advertising_set->advertising_handle; 658753f240c0SMatthias Ringwald hci_send_cmd(&hci_le_set_periodic_advertising_parameters, 658853f240c0SMatthias Ringwald advertising_set->advertising_handle, 658953f240c0SMatthias Ringwald advertising_set->periodic_params.periodic_advertising_interval_min, 659053f240c0SMatthias Ringwald advertising_set->periodic_params.periodic_advertising_interval_max, 659153f240c0SMatthias Ringwald advertising_set->periodic_params.periodic_advertising_properties); 659253f240c0SMatthias Ringwald return true; 659353f240c0SMatthias Ringwald } 659453f240c0SMatthias Ringwald if ((advertising_set->tasks & LE_ADVERTISEMENT_TASKS_SET_PERIODIC_DATA) != 0) { 65950cbe4690SMatthias Ringwald uint16_t pos = advertising_set->periodic_data_pos; 659653f240c0SMatthias Ringwald uint8_t operation = hci_le_extended_advertising_operation_for_chunk(pos, advertising_set->periodic_data_len); 659753f240c0SMatthias Ringwald uint16_t data_to_upload = btstack_min(advertising_set->periodic_data_len - pos, LE_EXTENDED_ADVERTISING_MAX_CHUNK_LEN); 659853f240c0SMatthias Ringwald if ((operation & 0x02) != 0){ 659953f240c0SMatthias Ringwald // last fragment or complete data 660053f240c0SMatthias Ringwald operation |= 2; 66010cbe4690SMatthias Ringwald advertising_set->periodic_data_pos = 0; 660253f240c0SMatthias Ringwald advertising_set->tasks &= ~LE_ADVERTISEMENT_TASKS_SET_PERIODIC_DATA; 660353f240c0SMatthias Ringwald } else { 66040cbe4690SMatthias Ringwald advertising_set->periodic_data_pos += data_to_upload; 660553f240c0SMatthias Ringwald } 660653f240c0SMatthias Ringwald hci_stack->le_advertising_set_in_current_command = advertising_set->advertising_handle; 66070cbe4690SMatthias Ringwald hci_send_cmd(&hci_le_set_periodic_advertising_data, advertising_set->advertising_handle, operation, data_to_upload, &advertising_set->periodic_data[pos]); 660853f240c0SMatthias Ringwald return true; 660953f240c0SMatthias Ringwald } 6610c814a904SMatthias Ringwald #endif /* ENABLE_LE_PERIODIC_ADVERTISING */ 6611be7ef9d8SMatthias Ringwald } 6612be7ef9d8SMatthias Ringwald } 6613be7ef9d8SMatthias Ringwald #endif 6614be7ef9d8SMatthias Ringwald 6615d70217a2SMatthias Ringwald #endif 66169956955bSMatthias Ringwald 6617057ab60cSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 6618a41310b7SMatthias Ringwald // if connect with whitelist was active and is not cancelled yet, wait until next time 6619a41310b7SMatthias Ringwald if (hci_stack->le_connecting_state == LE_CONNECTING_CANCEL) return false; 66204bafedd5SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 66214bafedd5SMatthias Ringwald // if periodic sync with advertiser list was active and is not cancelled yet, wait until next time 66224bafedd5SMatthias Ringwald if (hci_stack->le_periodic_sync_state == LE_CONNECTING_CANCEL) return false; 66234bafedd5SMatthias Ringwald #endif 6624057ab60cSMatthias Ringwald #endif 6625057ab60cSMatthias Ringwald 6626a41310b7SMatthias Ringwald // LE Whitelist Management 6627a41310b7SMatthias Ringwald if (whitelist_modification_pending){ 66289956955bSMatthias Ringwald // add/remove entries 6629665d90f2SMatthias Ringwald btstack_linked_list_iterator_init(&lit, &hci_stack->le_whitelist); 6630665d90f2SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&lit)){ 6631665d90f2SMatthias Ringwald whitelist_entry_t * entry = (whitelist_entry_t*) btstack_linked_list_iterator_next(&lit); 6632453459ddSMatthias Ringwald if (entry->state & LE_WHITELIST_REMOVE_FROM_CONTROLLER){ 6633453459ddSMatthias Ringwald entry->state &= ~LE_WHITELIST_REMOVE_FROM_CONTROLLER; 6634334e35acSMatthias Ringwald entry->state &= ~LE_WHITELIST_ON_CONTROLLER; 6635334e35acSMatthias Ringwald bd_addr_type_t address_type = entry->address_type; 6636334e35acSMatthias Ringwald bd_addr_t address; 6637334e35acSMatthias Ringwald memcpy(address, entry->address, 6); 6638334e35acSMatthias Ringwald if ((entry->state & LE_WHITELIST_ADD_TO_CONTROLLER) == 0){ 6639334e35acSMatthias Ringwald // remove from whitelist if not scheduled for re-addition 6640334e35acSMatthias Ringwald btstack_linked_list_remove(&hci_stack->le_whitelist, (btstack_linked_item_t *) entry); 6641334e35acSMatthias Ringwald btstack_memory_whitelist_entry_free(entry); 6642334e35acSMatthias Ringwald } 6643334e35acSMatthias Ringwald hci_send_cmd(&hci_le_remove_device_from_white_list, address_type, address); 6644453459ddSMatthias Ringwald return true; 6645453459ddSMatthias Ringwald } 66469956955bSMatthias Ringwald if (entry->state & LE_WHITELIST_ADD_TO_CONTROLLER){ 6647453459ddSMatthias Ringwald entry->state &= ~LE_WHITELIST_ADD_TO_CONTROLLER; 6648453459ddSMatthias Ringwald entry->state |= LE_WHITELIST_ON_CONTROLLER; 66499956955bSMatthias Ringwald hci_send_cmd(&hci_le_add_device_to_white_list, entry->address_type, entry->address); 6650f30077b7SMatthias Ringwald return true; 66519956955bSMatthias Ringwald } 66529956955bSMatthias Ringwald } 665391915b0bSMatthias Ringwald } 66549956955bSMatthias Ringwald 665521debf25SMatthias Ringwald #ifdef ENABLE_LE_PRIVACY_ADDRESS_RESOLUTION 665621debf25SMatthias Ringwald // LE Resolving List Management 66572fbf0ed0SMatthias Ringwald if (resolving_list_modification_pending) { 665821debf25SMatthias Ringwald uint16_t i; 66598dc1b1d0SMatthias Ringwald uint8_t null_16[16]; 66608dc1b1d0SMatthias Ringwald uint8_t local_irk_flipped[16]; 66618dc1b1d0SMatthias Ringwald const uint8_t *local_irk; 666221debf25SMatthias Ringwald switch (hci_stack->le_resolving_list_state) { 666321debf25SMatthias Ringwald case LE_RESOLVING_LIST_SEND_ENABLE_ADDRESS_RESOLUTION: 666421debf25SMatthias Ringwald hci_stack->le_resolving_list_state = LE_RESOLVING_LIST_READ_SIZE; 666521debf25SMatthias Ringwald hci_send_cmd(&hci_le_set_address_resolution_enabled, 1); 666621debf25SMatthias Ringwald return true; 666721debf25SMatthias Ringwald case LE_RESOLVING_LIST_READ_SIZE: 666821debf25SMatthias Ringwald hci_stack->le_resolving_list_state = LE_RESOLVING_LIST_SEND_CLEAR; 666921debf25SMatthias Ringwald hci_send_cmd(&hci_le_read_resolving_list_size); 667021debf25SMatthias Ringwald return true; 667121debf25SMatthias Ringwald case LE_RESOLVING_LIST_SEND_CLEAR: 66728dc1b1d0SMatthias Ringwald hci_stack->le_resolving_list_state = LE_RESOLVING_LIST_SET_IRK; 6673ea151974SMatthias Ringwald (void) memset(hci_stack->le_resolving_list_add_entries, 0xff, 6674ea151974SMatthias Ringwald sizeof(hci_stack->le_resolving_list_add_entries)); 6675e8ca66c6SMatthias Ringwald (void) memset(hci_stack->le_resolving_list_set_privacy_mode, 0xff, 6676e8ca66c6SMatthias Ringwald sizeof(hci_stack->le_resolving_list_set_privacy_mode)); 6677ea151974SMatthias Ringwald (void) memset(hci_stack->le_resolving_list_remove_entries, 0, 6678ea151974SMatthias Ringwald sizeof(hci_stack->le_resolving_list_remove_entries)); 667921debf25SMatthias Ringwald hci_send_cmd(&hci_le_clear_resolving_list); 668021debf25SMatthias Ringwald return true; 66818dc1b1d0SMatthias Ringwald case LE_RESOLVING_LIST_SET_IRK: 66828dc1b1d0SMatthias Ringwald // set IRK used by RPA for undirected advertising 66838dc1b1d0SMatthias Ringwald hci_stack->le_resolving_list_state = LE_RESOLVING_LIST_UPDATES_ENTRIES; 66848dc1b1d0SMatthias Ringwald local_irk = gap_get_persistent_irk(); 66858dc1b1d0SMatthias Ringwald reverse_128(local_irk, local_irk_flipped); 66868dc1b1d0SMatthias Ringwald memset(null_16, 0, sizeof(null_16)); 66878dc1b1d0SMatthias Ringwald hci_send_cmd(&hci_le_add_device_to_resolving_list, BD_ADDR_TYPE_LE_PUBLIC, null_16, 66888dc1b1d0SMatthias Ringwald null_16, local_irk_flipped); 66898dc1b1d0SMatthias Ringwald return true; 66905f3ccd83SMatthias Ringwald case LE_RESOLVING_LIST_UPDATES_ENTRIES: 66915f3ccd83SMatthias Ringwald // first remove old entries 669202b02cffSMatthias Ringwald for (i = 0; i < MAX_NUM_RESOLVING_LIST_ENTRIES && i < le_device_db_max_count(); i++) { 669302b02cffSMatthias Ringwald uint8_t offset = i >> 3; 669402b02cffSMatthias Ringwald uint8_t mask = 1 << (i & 7); 669502b02cffSMatthias Ringwald if ((hci_stack->le_resolving_list_remove_entries[offset] & mask) == 0) continue; 669602b02cffSMatthias Ringwald hci_stack->le_resolving_list_remove_entries[offset] &= ~mask; 669702b02cffSMatthias Ringwald bd_addr_t peer_identity_addreses; 669802b02cffSMatthias Ringwald int peer_identity_addr_type = (int) BD_ADDR_TYPE_UNKNOWN; 669902b02cffSMatthias Ringwald sm_key_t peer_irk; 670002b02cffSMatthias Ringwald le_device_db_info(i, &peer_identity_addr_type, peer_identity_addreses, peer_irk); 670102b02cffSMatthias Ringwald if (peer_identity_addr_type == BD_ADDR_TYPE_UNKNOWN) continue; 6702f5228c62SMatthias Ringwald 6703f5228c62SMatthias Ringwald #ifdef ENABLE_LE_WHITELIST_TOUCH_AFTER_RESOLVING_LIST_UPDATE 6704f5228c62SMatthias Ringwald // trigger whitelist entry 'update' (work around for controller bug) 6705f5228c62SMatthias Ringwald btstack_linked_list_iterator_init(&lit, &hci_stack->le_whitelist); 6706f5228c62SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&lit)) { 6707f5228c62SMatthias Ringwald whitelist_entry_t *entry = (whitelist_entry_t *) btstack_linked_list_iterator_next(&lit); 6708f5228c62SMatthias Ringwald if (entry->address_type != peer_identity_addr_type) continue; 6709f5228c62SMatthias Ringwald if (memcmp(entry->address, peer_identity_addreses, 6) != 0) continue; 6710f5228c62SMatthias Ringwald log_info("trigger whitelist update %s", bd_addr_to_str(peer_identity_addreses)); 6711f5228c62SMatthias Ringwald entry->state |= LE_WHITELIST_REMOVE_FROM_CONTROLLER | LE_WHITELIST_ADD_TO_CONTROLLER; 6712f5228c62SMatthias Ringwald } 6713f5228c62SMatthias Ringwald #endif 6714f5228c62SMatthias Ringwald 6715ea151974SMatthias Ringwald hci_send_cmd(&hci_le_remove_device_from_resolving_list, peer_identity_addr_type, 6716ea151974SMatthias Ringwald peer_identity_addreses); 671702b02cffSMatthias Ringwald return true; 671802b02cffSMatthias Ringwald } 671902b02cffSMatthias Ringwald 67205f3ccd83SMatthias Ringwald // then add new entries 672121debf25SMatthias Ringwald for (i = 0; i < MAX_NUM_RESOLVING_LIST_ENTRIES && i < le_device_db_max_count(); i++) { 672221debf25SMatthias Ringwald uint8_t offset = i >> 3; 672321debf25SMatthias Ringwald uint8_t mask = 1 << (i & 7); 672402b02cffSMatthias Ringwald if ((hci_stack->le_resolving_list_add_entries[offset] & mask) == 0) continue; 672502b02cffSMatthias Ringwald hci_stack->le_resolving_list_add_entries[offset] &= ~mask; 672621debf25SMatthias Ringwald bd_addr_t peer_identity_addreses; 672721debf25SMatthias Ringwald int peer_identity_addr_type = (int) BD_ADDR_TYPE_UNKNOWN; 672821debf25SMatthias Ringwald sm_key_t peer_irk; 672921debf25SMatthias Ringwald le_device_db_info(i, &peer_identity_addr_type, peer_identity_addreses, peer_irk); 673021debf25SMatthias Ringwald if (peer_identity_addr_type == BD_ADDR_TYPE_UNKNOWN) continue; 6731e938c062SMatthias Ringwald if (btstack_is_null(peer_irk, 16)) continue; 67322b6efc4dSMatthias Ringwald local_irk = gap_get_persistent_irk(); 673321debf25SMatthias Ringwald // command uses format specifier 'P' that stores 16-byte value without flip 673421debf25SMatthias Ringwald uint8_t peer_irk_flipped[16]; 673521debf25SMatthias Ringwald reverse_128(local_irk, local_irk_flipped); 673621debf25SMatthias Ringwald reverse_128(peer_irk, peer_irk_flipped); 6737ea151974SMatthias Ringwald hci_send_cmd(&hci_le_add_device_to_resolving_list, peer_identity_addr_type, peer_identity_addreses, 6738ea151974SMatthias Ringwald peer_irk_flipped, local_irk_flipped); 673921debf25SMatthias Ringwald return true; 674021debf25SMatthias Ringwald } 6741e8ca66c6SMatthias Ringwald 6742e8ca66c6SMatthias Ringwald // finally, set privacy mode 6743e8ca66c6SMatthias Ringwald for (i = 0; i < MAX_NUM_RESOLVING_LIST_ENTRIES && i < le_device_db_max_count(); i++) { 6744e8ca66c6SMatthias Ringwald uint8_t offset = i >> 3; 6745e8ca66c6SMatthias Ringwald uint8_t mask = 1 << (i & 7); 6746e8ca66c6SMatthias Ringwald if ((hci_stack->le_resolving_list_set_privacy_mode[offset] & mask) == 0) continue; 6747e8ca66c6SMatthias Ringwald hci_stack->le_resolving_list_set_privacy_mode[offset] &= ~mask; 6748e8ca66c6SMatthias Ringwald if (hci_stack->le_privacy_mode == LE_PRIVACY_MODE_NETWORK) { 6749e8ca66c6SMatthias Ringwald // Network Privacy Mode is default 6750e8ca66c6SMatthias Ringwald continue; 6751e8ca66c6SMatthias Ringwald } 6752e8ca66c6SMatthias Ringwald bd_addr_t peer_identity_address; 6753e8ca66c6SMatthias Ringwald int peer_identity_addr_type = (int) BD_ADDR_TYPE_UNKNOWN; 6754e8ca66c6SMatthias Ringwald sm_key_t peer_irk; 6755e8ca66c6SMatthias Ringwald le_device_db_info(i, &peer_identity_addr_type, peer_identity_address, peer_irk); 6756e8ca66c6SMatthias Ringwald if (peer_identity_addr_type == BD_ADDR_TYPE_UNKNOWN) continue; 6757e8ca66c6SMatthias Ringwald if (btstack_is_null(peer_irk, 16)) continue; 6758e8ca66c6SMatthias Ringwald // command uses format specifier 'P' that stores 16-byte value without flip 6759e8ca66c6SMatthias Ringwald uint8_t peer_irk_flipped[16]; 6760e8ca66c6SMatthias Ringwald reverse_128(peer_irk, peer_irk_flipped); 6761e8ca66c6SMatthias Ringwald hci_send_cmd(&hci_le_set_privacy_mode, peer_identity_addr_type, peer_identity_address, hci_stack->le_privacy_mode); 6762e8ca66c6SMatthias Ringwald return true; 6763e8ca66c6SMatthias Ringwald } 676421debf25SMatthias Ringwald break; 676502b02cffSMatthias Ringwald 676621debf25SMatthias Ringwald default: 676721debf25SMatthias Ringwald break; 676821debf25SMatthias Ringwald } 676921debf25SMatthias Ringwald hci_stack->le_resolving_list_state = LE_RESOLVING_LIST_DONE; 67702fbf0ed0SMatthias Ringwald } 677121debf25SMatthias Ringwald #endif 6772a41310b7SMatthias Ringwald 6773f40c73b4SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 6774f40c73b4SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 6775f40c73b4SMatthias Ringwald // LE Whitelist Management 6776f40c73b4SMatthias Ringwald if (periodic_list_modification_pending){ 6777f40c73b4SMatthias Ringwald // add/remove entries 6778f40c73b4SMatthias Ringwald btstack_linked_list_iterator_init(&lit, &hci_stack->le_periodic_advertiser_list); 6779f40c73b4SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&lit)){ 6780f40c73b4SMatthias Ringwald periodic_advertiser_list_entry_t * entry = (periodic_advertiser_list_entry_t*) btstack_linked_list_iterator_next(&lit); 6781f40c73b4SMatthias Ringwald if (entry->state & LE_PERIODIC_ADVERTISER_LIST_ENTRY_REMOVE_FROM_CONTROLLER){ 6782f40c73b4SMatthias Ringwald entry->state &= ~LE_PERIODIC_ADVERTISER_LIST_ENTRY_REMOVE_FROM_CONTROLLER; 6783d946a741SMatthias Ringwald hci_send_cmd(&hci_le_remove_device_from_periodic_advertiser_list, entry->address_type, entry->address, entry->sid); 6784f40c73b4SMatthias Ringwald return true; 6785f40c73b4SMatthias Ringwald } 6786f40c73b4SMatthias Ringwald if (entry->state & LE_PERIODIC_ADVERTISER_LIST_ENTRY_ADD_TO_CONTROLLER){ 6787f40c73b4SMatthias Ringwald entry->state &= ~LE_PERIODIC_ADVERTISER_LIST_ENTRY_ADD_TO_CONTROLLER; 6788f40c73b4SMatthias Ringwald entry->state |= LE_PERIODIC_ADVERTISER_LIST_ENTRY_ON_CONTROLLER; 67899e88556bSMatthias Ringwald hci_send_cmd(&hci_le_add_device_to_periodic_advertiser_list, entry->address_type, entry->address, entry->sid); 6790f40c73b4SMatthias Ringwald return true; 6791f40c73b4SMatthias Ringwald } 6792f40c73b4SMatthias Ringwald if ((entry->state & LE_PERIODIC_ADVERTISER_LIST_ENTRY_ON_CONTROLLER) == 0){ 6793f40c73b4SMatthias Ringwald btstack_linked_list_remove(&hci_stack->le_periodic_advertiser_list, (btstack_linked_item_t *) entry); 6794f40c73b4SMatthias Ringwald btstack_memory_periodic_advertiser_list_entry_free(entry); 6795f40c73b4SMatthias Ringwald } 6796f40c73b4SMatthias Ringwald } 6797f40c73b4SMatthias Ringwald } 6798f40c73b4SMatthias Ringwald #endif 6799f40c73b4SMatthias Ringwald #endif 6800f40c73b4SMatthias Ringwald 680198aa715fSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 680298aa715fSMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 680398aa715fSMatthias Ringwald #ifdef ENABLE_LE_PERIODIC_ADVERTISING 680498aa715fSMatthias Ringwald if (hci_stack->le_past_set_default_params){ 680598aa715fSMatthias Ringwald hci_stack->le_past_set_default_params = false; 680698aa715fSMatthias Ringwald hci_send_cmd(&hci_le_set_default_periodic_advertising_sync_transfer_parameters, 680798aa715fSMatthias Ringwald hci_stack->le_past_mode, 680898aa715fSMatthias Ringwald hci_stack->le_past_skip, 680998aa715fSMatthias Ringwald hci_stack->le_past_sync_timeout, 681098aa715fSMatthias Ringwald hci_stack->le_past_cte_type); 681198aa715fSMatthias Ringwald return true; 681298aa715fSMatthias Ringwald } 681398aa715fSMatthias Ringwald #endif 681498aa715fSMatthias Ringwald #endif 681598aa715fSMatthias Ringwald #endif 681698aa715fSMatthias Ringwald 681773799937SMatthias Ringwald // post-pone all actions until stack is fully working 681873799937SMatthias Ringwald if (hci_stack->state != HCI_STATE_WORKING) return false; 681973799937SMatthias Ringwald 682073799937SMatthias Ringwald // advertisements, active scanning, and creating connections requires random address to be set if using private address 682173799937SMatthias Ringwald if ( (hci_stack->le_own_addr_type != BD_ADDR_TYPE_LE_PUBLIC) && (hci_stack->le_random_address_set == 0u) ) return false; 682273799937SMatthias Ringwald 6823a41310b7SMatthias Ringwald // Phase 4: restore state 682429c24bebSMatthias Ringwald 682529c24bebSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 6826af64f147SMatthias Ringwald // re-start scanning 682729c24bebSMatthias Ringwald if ((hci_stack->le_scanning_enabled && !hci_stack->le_scanning_active)){ 682829c24bebSMatthias Ringwald hci_stack->le_scanning_active = true; 682963671e69SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 683022f987e4SMatthias Ringwald if (hci_le_extended_advertising_supported()){ 68314856283bSMatthias Ringwald hci_send_cmd(&hci_le_set_extended_scan_enable, 1, hci_stack->le_scan_filter_duplicates, 0, 0); 683263671e69SMatthias Ringwald } else 683363671e69SMatthias Ringwald #endif 683463671e69SMatthias Ringwald { 68354856283bSMatthias Ringwald hci_send_cmd(&hci_le_set_scan_enable, 1, hci_stack->le_scan_filter_duplicates); 683663671e69SMatthias Ringwald } 683729c24bebSMatthias Ringwald return true; 683829c24bebSMatthias Ringwald } 683929c24bebSMatthias Ringwald #endif 684029c24bebSMatthias Ringwald 684113eb2a2eSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 6842af64f147SMatthias Ringwald // re-start connecting 6843af64f147SMatthias Ringwald if ( (hci_stack->le_connecting_state == LE_CONNECTING_IDLE) && (hci_stack->le_connecting_request == LE_CONNECTING_WHITELIST)){ 68449956955bSMatthias Ringwald bd_addr_t null_addr; 68459956955bSMatthias Ringwald memset(null_addr, 0, 6); 68466bcfa632SMatthias Ringwald hci_stack->le_connection_own_addr_type = hci_stack->le_own_addr_type; 68476bcfa632SMatthias Ringwald hci_get_own_address_for_addr_type(hci_stack->le_connection_own_addr_type, hci_stack->le_connection_own_address); 68486f34e9d6SMatthias Ringwald hci_send_le_create_connection(1, 0, null_addr); 6849f30077b7SMatthias Ringwald return true; 68509956955bSMatthias Ringwald } 68514bafedd5SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 68524bafedd5SMatthias Ringwald if (hci_stack->le_periodic_sync_state == LE_CONNECTING_IDLE){ 68534bafedd5SMatthias Ringwald switch(hci_stack->le_periodic_sync_request){ 68544bafedd5SMatthias Ringwald case LE_CONNECTING_DIRECT: 68554bafedd5SMatthias Ringwald case LE_CONNECTING_WHITELIST: 68564bafedd5SMatthias Ringwald hci_stack->le_periodic_sync_state = ((hci_stack->le_periodic_sync_options & 1) != 0) ? LE_CONNECTING_WHITELIST : LE_CONNECTING_DIRECT; 68574bafedd5SMatthias Ringwald hci_send_cmd(&hci_le_periodic_advertising_create_sync, 68584bafedd5SMatthias Ringwald hci_stack->le_periodic_sync_options, 68594bafedd5SMatthias Ringwald hci_stack->le_periodic_sync_advertising_sid, 68604bafedd5SMatthias Ringwald hci_stack->le_periodic_sync_advertiser_address_type, 68614bafedd5SMatthias Ringwald hci_stack->le_periodic_sync_advertiser_address, 68624bafedd5SMatthias Ringwald hci_stack->le_periodic_sync_skip, 68634bafedd5SMatthias Ringwald hci_stack->le_periodic_sync_timeout, 68644bafedd5SMatthias Ringwald hci_stack->le_periodic_sync_cte_type); 68654bafedd5SMatthias Ringwald return true; 68664bafedd5SMatthias Ringwald default: 68674bafedd5SMatthias Ringwald break; 68684bafedd5SMatthias Ringwald } 68694bafedd5SMatthias Ringwald } 68704bafedd5SMatthias Ringwald #endif 6871d70217a2SMatthias Ringwald #endif 6872a41310b7SMatthias Ringwald 6873a41310b7SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 6874a41310b7SMatthias Ringwald // re-start advertising 6875935aa76eSMatthias Ringwald if (hci_stack->le_advertisements_enabled_for_current_roles && ((hci_stack->le_advertisements_state & LE_ADVERTISEMENT_STATE_ACTIVE) == 0)){ 6876a41310b7SMatthias Ringwald // check if advertisements should be enabled given 6877935aa76eSMatthias Ringwald hci_stack->le_advertisements_state |= LE_ADVERTISEMENT_STATE_ACTIVE; 6878b892db1cSMatthias Ringwald hci_get_own_address_for_addr_type(hci_stack->le_advertisements_own_addr_type, hci_stack->le_advertisements_own_address); 6879e464cd48SMatthias Ringwald 6880e464cd48SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 688122f987e4SMatthias Ringwald if (hci_le_extended_advertising_supported()){ 6882e464cd48SMatthias Ringwald const uint8_t advertising_handles[] = { 0 }; 6883e464cd48SMatthias Ringwald const uint16_t durations[] = { 0 }; 6884e464cd48SMatthias Ringwald const uint16_t max_events[] = { 0 }; 6885e464cd48SMatthias Ringwald hci_send_cmd(&hci_le_set_extended_advertising_enable, 1, 1, advertising_handles, durations, max_events); 6886e464cd48SMatthias Ringwald } else 6887e464cd48SMatthias Ringwald #endif 6888e464cd48SMatthias Ringwald { 6889a41310b7SMatthias Ringwald hci_send_cmd(&hci_le_set_advertise_enable, 1); 6890e464cd48SMatthias Ringwald } 6891a41310b7SMatthias Ringwald return true; 6892a41310b7SMatthias Ringwald } 6893be7ef9d8SMatthias Ringwald 6894be7ef9d8SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 689522f987e4SMatthias Ringwald if (hci_le_extended_advertising_supported()) { 6896be7ef9d8SMatthias Ringwald btstack_linked_list_iterator_t it; 6897be7ef9d8SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->le_advertising_sets); 6898be7ef9d8SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)) { 6899be7ef9d8SMatthias Ringwald le_advertising_set_t *advertising_set = (le_advertising_set_t *) btstack_linked_list_iterator_next(&it); 6900be7ef9d8SMatthias Ringwald if (((advertising_set->state & LE_ADVERTISEMENT_STATE_ENABLED) != 0) && ((advertising_set->state & LE_ADVERTISEMENT_STATE_ACTIVE) == 0)){ 69018caa405cSMatthias Ringwald advertising_set->state |= LE_ADVERTISEMENT_STATE_ACTIVE; 6902be7ef9d8SMatthias Ringwald const uint8_t advertising_handles[] = { advertising_set->advertising_handle }; 6903be7ef9d8SMatthias Ringwald const uint16_t durations[] = { advertising_set->enable_timeout }; 6904be7ef9d8SMatthias Ringwald const uint16_t max_events[] = { advertising_set->enable_max_scan_events }; 6905be7ef9d8SMatthias Ringwald hci_send_cmd(&hci_le_set_extended_advertising_enable, 1, 1, advertising_handles, durations, max_events); 6906be7ef9d8SMatthias Ringwald return true; 6907be7ef9d8SMatthias Ringwald } 6908c814a904SMatthias Ringwald #ifdef ENABLE_LE_PERIODIC_ADVERTISING 690953f240c0SMatthias Ringwald if (((advertising_set->state & LE_ADVERTISEMENT_STATE_PERIODIC_ENABLED) != 0) && ((advertising_set->state & LE_ADVERTISEMENT_STATE_PERIODIC_ACTIVE) == 0)){ 691053f240c0SMatthias Ringwald advertising_set->state |= LE_ADVERTISEMENT_STATE_PERIODIC_ACTIVE; 691153f240c0SMatthias Ringwald uint8_t enable = 1; 691253f240c0SMatthias Ringwald if (advertising_set->periodic_include_adi){ 691353f240c0SMatthias Ringwald enable |= 2; 691453f240c0SMatthias Ringwald } 691553f240c0SMatthias Ringwald hci_send_cmd(&hci_le_set_periodic_advertising_enable, enable, advertising_set->advertising_handle); 691653f240c0SMatthias Ringwald return true; 691753f240c0SMatthias Ringwald } 6918c814a904SMatthias Ringwald #endif /* ENABLE_LE_PERIODIC_ADVERTISING */ 6919be7ef9d8SMatthias Ringwald } 6920be7ef9d8SMatthias Ringwald } 6921be7ef9d8SMatthias Ringwald #endif 6922a41310b7SMatthias Ringwald #endif 6923a41310b7SMatthias Ringwald 6924f30077b7SMatthias Ringwald return false; 69257bdc6798S[email protected] } 69267aa35f6aSMatthias Ringwald 69277aa35f6aSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS 69287aa35f6aSMatthias Ringwald static bool hci_run_iso_tasks(void){ 69297aa35f6aSMatthias Ringwald btstack_linked_list_iterator_t it; 69302a6c0f82SMatthias Ringwald 693126b93350SMatthias Ringwald if (hci_stack->iso_active_operation_type != HCI_ISO_TYPE_INVALID) { 693240f86dfdSMatthias Ringwald return false; 693340f86dfdSMatthias Ringwald } 693440f86dfdSMatthias Ringwald 69352a6c0f82SMatthias Ringwald // BIG 69367aa35f6aSMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->le_audio_bigs); 69377aa35f6aSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 69387aa35f6aSMatthias Ringwald le_audio_big_t * big = (le_audio_big_t *) btstack_linked_list_iterator_next(&it); 69397aa35f6aSMatthias Ringwald switch (big->state){ 69407aa35f6aSMatthias Ringwald case LE_AUDIO_BIG_STATE_CREATE: 694140f86dfdSMatthias Ringwald hci_stack->iso_active_operation_group_id = big->params->big_handle; 694240f86dfdSMatthias Ringwald hci_stack->iso_active_operation_type = HCI_ISO_TYPE_BIS; 69437aa35f6aSMatthias Ringwald big->state = LE_AUDIO_BIG_STATE_W4_ESTABLISHED; 69447aa35f6aSMatthias Ringwald hci_send_cmd(&hci_le_create_big, 69457aa35f6aSMatthias Ringwald big->params->big_handle, 69467aa35f6aSMatthias Ringwald big->params->advertising_handle, 69477aa35f6aSMatthias Ringwald big->params->num_bis, 69487aa35f6aSMatthias Ringwald big->params->sdu_interval_us, 69497aa35f6aSMatthias Ringwald big->params->max_sdu, 69507aa35f6aSMatthias Ringwald big->params->max_transport_latency_ms, 69517aa35f6aSMatthias Ringwald big->params->rtn, 69527aa35f6aSMatthias Ringwald big->params->phy, 69537aa35f6aSMatthias Ringwald big->params->packing, 69547aa35f6aSMatthias Ringwald big->params->framing, 69557aa35f6aSMatthias Ringwald big->params->encryption, 69567aa35f6aSMatthias Ringwald big->params->broadcast_code); 69577aa35f6aSMatthias Ringwald return true; 69587aa35f6aSMatthias Ringwald case LE_AUDIO_BIG_STATE_SETUP_ISO_PATH: 69597aa35f6aSMatthias Ringwald big->state = LE_AUDIO_BIG_STATE_W4_SETUP_ISO_PATH; 696085dc435bSDirk Helbig hci_send_cmd(&hci_le_setup_iso_data_path, big->bis_con_handles[big->state_vars.next_bis], 0, 0, HCI_AUDIO_CODING_FORMAT_TRANSPARENT, 0, 0, 0, 0, NULL); 69617aa35f6aSMatthias Ringwald return true; 69627aa35f6aSMatthias Ringwald case LE_AUDIO_BIG_STATE_SETUP_ISO_PATHS_FAILED: 69637aa35f6aSMatthias Ringwald big->state = LE_AUDIO_BIG_STATE_W4_TERMINATED_AFTER_SETUP_FAILED; 69642a6c0f82SMatthias Ringwald hci_send_cmd(&hci_le_terminate_big, big->big_handle, big->state_vars.status); 6965c1f83111SMatthias Ringwald return true; 69667aa35f6aSMatthias Ringwald case LE_AUDIO_BIG_STATE_TERMINATE: 69677aa35f6aSMatthias Ringwald big->state = LE_AUDIO_BIG_STATE_W4_TERMINATED; 69682a6c0f82SMatthias Ringwald hci_send_cmd(&hci_le_terminate_big, big->big_handle, ERROR_CODE_SUCCESS); 69697aa35f6aSMatthias Ringwald return true; 69707aa35f6aSMatthias Ringwald default: 69717aa35f6aSMatthias Ringwald break; 69727aa35f6aSMatthias Ringwald } 69737aa35f6aSMatthias Ringwald } 69742a6c0f82SMatthias Ringwald 69752a6c0f82SMatthias Ringwald // BIG Sync 69762a6c0f82SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->le_audio_big_syncs); 69772a6c0f82SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 69782a6c0f82SMatthias Ringwald le_audio_big_sync_t * big_sync = (le_audio_big_sync_t *) btstack_linked_list_iterator_next(&it); 69792a6c0f82SMatthias Ringwald switch (big_sync->state){ 69802a6c0f82SMatthias Ringwald case LE_AUDIO_BIG_STATE_CREATE: 698140f86dfdSMatthias Ringwald hci_stack->iso_active_operation_group_id = big_sync->params->big_handle; 698240f86dfdSMatthias Ringwald hci_stack->iso_active_operation_type = HCI_ISO_TYPE_BIS; 69832a6c0f82SMatthias Ringwald big_sync->state = LE_AUDIO_BIG_STATE_W4_ESTABLISHED; 69842a6c0f82SMatthias Ringwald hci_send_cmd(&hci_le_big_create_sync, 69852a6c0f82SMatthias Ringwald big_sync->params->big_handle, 69862a6c0f82SMatthias Ringwald big_sync->params->sync_handle, 69872a6c0f82SMatthias Ringwald big_sync->params->encryption, 69882a6c0f82SMatthias Ringwald big_sync->params->broadcast_code, 69892a6c0f82SMatthias Ringwald big_sync->params->mse, 69902a6c0f82SMatthias Ringwald big_sync->params->big_sync_timeout_10ms, 69912a6c0f82SMatthias Ringwald big_sync->params->num_bis, 69922a6c0f82SMatthias Ringwald big_sync->params->bis_indices); 69932a6c0f82SMatthias Ringwald return true; 69942a6c0f82SMatthias Ringwald case LE_AUDIO_BIG_STATE_SETUP_ISO_PATH: 69952a6c0f82SMatthias Ringwald big_sync->state = LE_AUDIO_BIG_STATE_W4_SETUP_ISO_PATH; 699685dc435bSDirk Helbig hci_send_cmd(&hci_le_setup_iso_data_path, big_sync->bis_con_handles[big_sync->state_vars.next_bis], 1, 0, HCI_AUDIO_CODING_FORMAT_TRANSPARENT, 0, 0, 0, 0, NULL); 69972a6c0f82SMatthias Ringwald return true; 69982a6c0f82SMatthias Ringwald case LE_AUDIO_BIG_STATE_SETUP_ISO_PATHS_FAILED: 69992a6c0f82SMatthias Ringwald big_sync->state = LE_AUDIO_BIG_STATE_W4_TERMINATED_AFTER_SETUP_FAILED; 70002a6c0f82SMatthias Ringwald hci_send_cmd(&hci_le_big_terminate_sync, big_sync->big_handle); 7001c1f83111SMatthias Ringwald return true; 70022a6c0f82SMatthias Ringwald case LE_AUDIO_BIG_STATE_TERMINATE: 70032a6c0f82SMatthias Ringwald big_sync->state = LE_AUDIO_BIG_STATE_W4_TERMINATED; 70042a6c0f82SMatthias Ringwald hci_send_cmd(&hci_le_big_terminate_sync, big_sync->big_handle); 70052a6c0f82SMatthias Ringwald return true; 70062a6c0f82SMatthias Ringwald default: 70072a6c0f82SMatthias Ringwald break; 70082a6c0f82SMatthias Ringwald } 70092a6c0f82SMatthias Ringwald } 70102a6c0f82SMatthias Ringwald 7011d3a89d91SMatthias Ringwald // CIG 7012d90722d4SMatthias Ringwald bool cig_active; 7013d3a89d91SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->le_audio_cigs); 7014d3a89d91SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)) { 7015d3a89d91SMatthias Ringwald le_audio_cig_t *cig = (le_audio_cig_t *) btstack_linked_list_iterator_next(&it); 7016d3a89d91SMatthias Ringwald uint8_t i; 7017444e371eSMatthias Ringwald // Set CIG Parameters 7018d3a89d91SMatthias Ringwald uint8_t cis_id[MAX_NR_CIS]; 7019d3a89d91SMatthias Ringwald uint16_t max_sdu_c_to_p[MAX_NR_CIS]; 7020d3a89d91SMatthias Ringwald uint16_t max_sdu_p_to_c[MAX_NR_CIS]; 7021d3a89d91SMatthias Ringwald uint8_t phy_c_to_p[MAX_NR_CIS]; 7022d3a89d91SMatthias Ringwald uint8_t phy_p_to_c[MAX_NR_CIS]; 7023d3a89d91SMatthias Ringwald uint8_t rtn_c_to_p[MAX_NR_CIS]; 7024d3a89d91SMatthias Ringwald uint8_t rtn_p_to_c[MAX_NR_CIS]; 7025d3a89d91SMatthias Ringwald switch (cig->state) { 7026d3a89d91SMatthias Ringwald case LE_AUDIO_CIG_STATE_CREATE: 7027d3a89d91SMatthias Ringwald hci_stack->iso_active_operation_group_id = cig->params->cig_id; 7028d3a89d91SMatthias Ringwald hci_stack->iso_active_operation_type = HCI_ISO_TYPE_CIS; 7029d3a89d91SMatthias Ringwald cig->state = LE_AUDIO_CIG_STATE_W4_ESTABLISHED; 7030d3a89d91SMatthias Ringwald le_audio_cig_params_t * params = cig->params; 7031d3a89d91SMatthias Ringwald for (i = 0; i < params->num_cis; i++) { 7032d3a89d91SMatthias Ringwald le_audio_cis_params_t * cis_params = &cig->params->cis_params[i]; 7033d3a89d91SMatthias Ringwald cis_id[i] = cis_params->cis_id; 7034d3a89d91SMatthias Ringwald max_sdu_c_to_p[i] = cis_params->max_sdu_c_to_p; 7035d3a89d91SMatthias Ringwald max_sdu_p_to_c[i] = cis_params->max_sdu_p_to_c; 7036d3a89d91SMatthias Ringwald phy_c_to_p[i] = cis_params->phy_c_to_p; 7037d3a89d91SMatthias Ringwald phy_p_to_c[i] = cis_params->phy_p_to_c; 7038d3a89d91SMatthias Ringwald rtn_c_to_p[i] = cis_params->rtn_c_to_p; 7039d3a89d91SMatthias Ringwald rtn_p_to_c[i] = cis_params->rtn_p_to_c; 7040d3a89d91SMatthias Ringwald } 7041d3a89d91SMatthias Ringwald hci_send_cmd(&hci_le_set_cig_parameters, 7042d3a89d91SMatthias Ringwald cig->cig_id, 7043d3a89d91SMatthias Ringwald params->sdu_interval_c_to_p, 7044d3a89d91SMatthias Ringwald params->sdu_interval_p_to_c, 7045d3a89d91SMatthias Ringwald params->worst_case_sca, 7046d3a89d91SMatthias Ringwald params->packing, 7047d3a89d91SMatthias Ringwald params->framing, 7048d3a89d91SMatthias Ringwald params->max_transport_latency_c_to_p, 7049d3a89d91SMatthias Ringwald params->max_transport_latency_p_to_c, 7050d3a89d91SMatthias Ringwald params->num_cis, 7051d3a89d91SMatthias Ringwald cis_id, 7052d3a89d91SMatthias Ringwald max_sdu_c_to_p, 7053d3a89d91SMatthias Ringwald max_sdu_p_to_c, 7054d3a89d91SMatthias Ringwald phy_c_to_p, 7055d3a89d91SMatthias Ringwald phy_p_to_c, 7056d3a89d91SMatthias Ringwald rtn_c_to_p, 7057d3a89d91SMatthias Ringwald rtn_p_to_c 7058d3a89d91SMatthias Ringwald ); 7059bb42b5c0SMatthias Ringwald return true; 7060444e371eSMatthias Ringwald case LE_AUDIO_CIG_STATE_CREATE_CIS: 7061bb42b5c0SMatthias Ringwald hci_stack->iso_active_operation_group_id = cig->params->cig_id; 7062bb42b5c0SMatthias Ringwald hci_stack->iso_active_operation_type = HCI_ISO_TYPE_CIS; 7063444e371eSMatthias Ringwald cig->state = LE_AUDIO_CIG_STATE_W4_CREATE_CIS; 70643abcd16cSMatthias Ringwald for (i=0;i<cig->num_cis;i++){ 70653abcd16cSMatthias Ringwald cig->cis_setup_active[i] = true; 70663abcd16cSMatthias Ringwald } 7067444e371eSMatthias Ringwald hci_send_cmd(&hci_le_create_cis, cig->num_cis, cig->cis_con_handles, cig->acl_con_handles); 7068bb42b5c0SMatthias Ringwald return true; 7069f9306a1aSMatthias Ringwald case LE_AUDIO_CIG_STATE_SETUP_ISO_PATH: 7070f9306a1aSMatthias Ringwald while (cig->state_vars.next_cis < (cig->num_cis * 2)){ 7071f9306a1aSMatthias Ringwald // find next path to setup 7072f9306a1aSMatthias Ringwald uint8_t cis_index = cig->state_vars.next_cis >> 1; 7073f9306a1aSMatthias Ringwald if (cig->cis_established[cis_index] == false) { 7074f9306a1aSMatthias Ringwald continue; 7075f9306a1aSMatthias Ringwald } 7076f9306a1aSMatthias Ringwald uint8_t cis_direction = cig->state_vars.next_cis & 1; 7077f9306a1aSMatthias Ringwald bool setup = true; 70788e58e4f7SMatthias Ringwald if (cis_direction == 0){ 7079f9306a1aSMatthias Ringwald // 0 - input - host to controller 7080f9306a1aSMatthias Ringwald // we are central => central to peripheral 7081f9306a1aSMatthias Ringwald setup &= cig->params->cis_params[cis_index].max_sdu_c_to_p > 0; 7082f9306a1aSMatthias Ringwald } else { 7083f9306a1aSMatthias Ringwald // 1 - output - controller to host 7084f9306a1aSMatthias Ringwald // we are central => peripheral to central 7085f9306a1aSMatthias Ringwald setup &= cig->params->cis_params[cis_index].max_sdu_p_to_c > 0; 7086f9306a1aSMatthias Ringwald } 7087f9306a1aSMatthias Ringwald if (setup){ 7088f9306a1aSMatthias Ringwald hci_stack->iso_active_operation_group_id = cig->params->cig_id; 7089f9306a1aSMatthias Ringwald hci_stack->iso_active_operation_type = HCI_ISO_TYPE_CIS; 7090f9306a1aSMatthias Ringwald cig->state = LE_AUDIO_CIG_STATE_W4_SETUP_ISO_PATH; 709185dc435bSDirk Helbig hci_send_cmd(&hci_le_setup_iso_data_path, cig->cis_con_handles[cis_index], cis_direction, 0, HCI_AUDIO_CODING_FORMAT_TRANSPARENT, 0, 0, 0, 0, NULL); 7092f9306a1aSMatthias Ringwald return true; 7093f9306a1aSMatthias Ringwald } 70948e58e4f7SMatthias Ringwald cig->state_vars.next_cis++; 7095f9306a1aSMatthias Ringwald } 7096f9306a1aSMatthias Ringwald // emit done 7097f9306a1aSMatthias Ringwald cig->state = LE_AUDIO_CIG_STATE_ACTIVE; 7098d90722d4SMatthias Ringwald break; 7099d90722d4SMatthias Ringwald case LE_AUDIO_CIG_STATE_REMOVE: 7100d90722d4SMatthias Ringwald // check if CIG Active 7101d90722d4SMatthias Ringwald cig_active = false; 7102d90722d4SMatthias Ringwald for (i = 0; i < cig->num_cis; i++) { 7103d90722d4SMatthias Ringwald if (cig->cis_con_handles[i] != HCI_CON_HANDLE_INVALID){ 7104d90722d4SMatthias Ringwald hci_iso_stream_t * stream = hci_iso_stream_for_con_handle(cig->cis_con_handles[i]); 7105d90722d4SMatthias Ringwald if (stream != NULL){ 7106d90722d4SMatthias Ringwald cig_active = true; 7107d90722d4SMatthias Ringwald break; 7108d90722d4SMatthias Ringwald } 7109d90722d4SMatthias Ringwald } 7110d90722d4SMatthias Ringwald } 7111d90722d4SMatthias Ringwald if (cig_active == false){ 7112d90722d4SMatthias Ringwald btstack_linked_list_iterator_remove(&it); 7113d90722d4SMatthias Ringwald hci_send_cmd(&hci_le_remove_cig, cig->cig_id); 7114d90722d4SMatthias Ringwald return true; 7115d90722d4SMatthias Ringwald } 7116d3a89d91SMatthias Ringwald default: 7117d3a89d91SMatthias Ringwald break; 7118d3a89d91SMatthias Ringwald } 7119d3a89d91SMatthias Ringwald } 7120d3a89d91SMatthias Ringwald 7121d90722d4SMatthias Ringwald // CIS Accept/Reject/Setup ISO Path/Close 712226b93350SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->iso_streams); 712326b93350SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)) { 712426b93350SMatthias Ringwald hci_iso_stream_t *iso_stream = (hci_iso_stream_t *) btstack_linked_list_iterator_next(&it); 712526b93350SMatthias Ringwald hci_con_handle_t con_handle; 712626b93350SMatthias Ringwald switch (iso_stream->state){ 712726b93350SMatthias Ringwald case HCI_ISO_STREAM_W2_ACCEPT: 712826b93350SMatthias Ringwald iso_stream->state = HCI_ISO_STREAM_STATE_W4_ESTABLISHED; 712926b93350SMatthias Ringwald hci_stack->iso_active_operation_type = HCI_ISO_TYPE_CIS; 713026b93350SMatthias Ringwald hci_stack->iso_active_operation_group_id = HCI_ISO_GROUP_ID_SINGLE_CIS; 7131969d876aSMatthias Ringwald hci_send_cmd(&hci_le_accept_cis_request, iso_stream->cis_handle); 713226b93350SMatthias Ringwald return true; 713326b93350SMatthias Ringwald case HCI_ISO_STREAM_W2_REJECT: 7134969d876aSMatthias Ringwald con_handle = iso_stream->cis_handle; 713526b93350SMatthias Ringwald hci_stack->iso_active_operation_type = HCI_ISO_TYPE_CIS; 713626b93350SMatthias Ringwald hci_stack->iso_active_operation_group_id = HCI_ISO_GROUP_ID_SINGLE_CIS; 713726b93350SMatthias Ringwald hci_iso_stream_finalize(iso_stream); 713826b93350SMatthias Ringwald hci_send_cmd(&hci_le_reject_cis_request, con_handle, ERROR_CODE_REMOTE_DEVICE_TERMINATED_CONNECTION_DUE_TO_LOW_RESOURCES); 713926b93350SMatthias Ringwald return true; 714026b93350SMatthias Ringwald case HCI_ISO_STREAM_STATE_W2_SETUP_ISO_INPUT: 714126b93350SMatthias Ringwald hci_stack->iso_active_operation_group_id = HCI_ISO_GROUP_ID_SINGLE_CIS; 714226b93350SMatthias Ringwald hci_stack->iso_active_operation_type = HCI_ISO_TYPE_CIS; 714326b93350SMatthias Ringwald iso_stream->state = HCI_ISO_STREAM_STATE_W4_ISO_SETUP_INPUT; 714485dc435bSDirk Helbig hci_send_cmd(&hci_le_setup_iso_data_path, iso_stream->cis_handle, 0, 0, HCI_AUDIO_CODING_FORMAT_TRANSPARENT, 0, 0, 0, 0, NULL); 714526b93350SMatthias Ringwald break; 714626b93350SMatthias Ringwald case HCI_ISO_STREAM_STATE_W2_SETUP_ISO_OUTPUT: 714726b93350SMatthias Ringwald hci_stack->iso_active_operation_group_id = HCI_ISO_GROUP_ID_SINGLE_CIS; 714826b93350SMatthias Ringwald hci_stack->iso_active_operation_type = HCI_ISO_TYPE_CIS; 714926b93350SMatthias Ringwald iso_stream->state = HCI_ISO_STREAM_STATE_W4_ISO_SETUP_OUTPUT; 715085dc435bSDirk Helbig hci_send_cmd(&hci_le_setup_iso_data_path, iso_stream->cis_handle, 1, 0, HCI_AUDIO_CODING_FORMAT_TRANSPARENT, 0, 0, 0, 0, NULL); 715126b93350SMatthias Ringwald break; 7152d90722d4SMatthias Ringwald case HCI_ISO_STREAM_STATE_W2_CLOSE: 7153d90722d4SMatthias Ringwald iso_stream->state = HCI_ISO_STREAM_STATE_W4_DISCONNECTED; 7154d90722d4SMatthias Ringwald hci_send_cmd(&hci_disconnect, iso_stream->cis_handle); 7155d90722d4SMatthias Ringwald break; 715626b93350SMatthias Ringwald default: 715726b93350SMatthias Ringwald break; 715826b93350SMatthias Ringwald } 715926b93350SMatthias Ringwald } 716026b93350SMatthias Ringwald 71617aa35f6aSMatthias Ringwald return false; 71627aa35f6aSMatthias Ringwald } 71637aa35f6aSMatthias Ringwald #endif /* ENABLE_LE_ISOCHRONOUS_STREAMS */ 7164b2f949feS[email protected] #endif 71657bdc6798S[email protected] 716688a03c8dSMatthias Ringwald static bool hci_run_general_pending_commands(void){ 7167f30077b7SMatthias Ringwald btstack_linked_item_t * it; 7168a0da043fSMatthias Ringwald for (it = (btstack_linked_item_t *) hci_stack->connections; it != NULL; it = it->next){ 716905ae8de3SMatthias Ringwald hci_connection_t * connection = (hci_connection_t *) it; 717032ab9390Smatthias.ringwald 71710bf6344aS[email protected] switch(connection->state){ 71720bf6344aS[email protected] case SEND_CREATE_CONNECTION: 71734f3229d8S[email protected] switch(connection->address_type){ 717435454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 7175f16129ceSMatthias Ringwald case BD_ADDR_TYPE_ACL: 71769da54300S[email protected] log_info("sending hci_create_connection"); 7177b4eb4420SMatthias Ringwald hci_send_cmd(&hci_create_connection, connection->address, hci_usable_acl_packet_types(), 0, 0, 0, hci_stack->allow_role_switch); 71784f3229d8S[email protected] break; 717935454696SMatthias Ringwald #endif 71804f3229d8S[email protected] default: 7181a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE 7182d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 71839da54300S[email protected] log_info("sending hci_le_create_connection"); 71846bcfa632SMatthias Ringwald hci_stack->le_connection_own_addr_type = hci_stack->le_own_addr_type; 71856bcfa632SMatthias Ringwald hci_get_own_address_for_addr_type(hci_stack->le_connection_own_addr_type, hci_stack->le_connection_own_address); 7186f346015eSMatthias Ringwald hci_send_le_create_connection(0, connection->address_type, connection->address); 71874f3229d8S[email protected] connection->state = SENT_CREATE_CONNECTION; 7188b2f949feS[email protected] #endif 7189d70217a2SMatthias Ringwald #endif 71904f3229d8S[email protected] break; 71914f3229d8S[email protected] } 7192f30077b7SMatthias Ringwald return true; 7193ad83dc6aS[email protected] 719435454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 71950bf6344aS[email protected] case RECEIVED_CONNECTION_REQUEST: 7196f16129ceSMatthias Ringwald if (connection->address_type == BD_ADDR_TYPE_ACL){ 719776ccfb2aSMatthias Ringwald log_info("sending hci_accept_connection_request"); 7198895f6685SMilanka Ringwald connection->state = ACCEPTED_CONNECTION_REQUEST; 7199c4c88f1bSJakob Krantz hci_send_cmd(&hci_accept_connection_request, connection->address, hci_stack->master_slave_policy); 7200f30077b7SMatthias Ringwald return true; 7201ee025741SMatthias Ringwald } 7202ee025741SMatthias Ringwald break; 720335454696SMatthias Ringwald #endif 72040bf6344aS[email protected] case SEND_DISCONNECT: 72050bf6344aS[email protected] connection->state = SENT_DISCONNECT; 72066ef3696aSMatthias Ringwald hci_send_cmd(&hci_disconnect, connection->con_handle, ERROR_CODE_REMOTE_USER_TERMINATED_CONNECTION); 7207f30077b7SMatthias Ringwald return true; 72080bf6344aS[email protected] 72090bf6344aS[email protected] default: 72100bf6344aS[email protected] break; 7211c7e0c5f6Smatthias.ringwald } 7212c7e0c5f6Smatthias.ringwald 7213cabf004eSMatthias Ringwald // no further commands if connection is about to get shut down 7214cabf004eSMatthias Ringwald if (connection->state == SENT_DISCONNECT) continue; 7215cabf004eSMatthias Ringwald 721694418890SMatthias Ringwald #ifdef ENABLE_CLASSIC 721794418890SMatthias Ringwald 7218ad20f0c8SMatthias Ringwald // Handling link key request requires remote supported features 721950f49832SMatthias Ringwald if (((connection->authentication_flags & AUTH_FLAG_HANDLE_LINK_KEY_REQUEST) != 0)){ 7220608f51bbSMatthias Ringwald log_info("responding to link key request, have link key db: %u", hci_stack->link_key_db != NULL); 72218daf94bcSMatthias Ringwald connectionClearAuthenticationFlags(connection, AUTH_FLAG_HANDLE_LINK_KEY_REQUEST); 722230e72d78SMatthias Ringwald 7223e9f98c4aSMatthias Ringwald bool have_link_key = connection->link_key_type != INVALID_LINK_KEY; 7224e9f98c4aSMatthias Ringwald bool security_level_sufficient = have_link_key && (gap_security_level_for_link_key_type(connection->link_key_type) >= connection->requested_security_level); 722530e72d78SMatthias Ringwald if (have_link_key && security_level_sufficient){ 7226e9f98c4aSMatthias Ringwald hci_send_cmd(&hci_link_key_request_reply, connection->address, &connection->link_key); 722732ab9390Smatthias.ringwald } else { 722832ab9390Smatthias.ringwald hci_send_cmd(&hci_link_key_request_negative_reply, connection->address); 722932ab9390Smatthias.ringwald } 7230f30077b7SMatthias Ringwald return true; 723132ab9390Smatthias.ringwald } 72321d6b20aeS[email protected] 72338daf94bcSMatthias Ringwald if (connection->authentication_flags & AUTH_FLAG_DENY_PIN_CODE_REQUEST){ 72349da54300S[email protected] log_info("denying to pin request"); 72358daf94bcSMatthias Ringwald connectionClearAuthenticationFlags(connection, AUTH_FLAG_DENY_PIN_CODE_REQUEST); 723634d2123cS[email protected] hci_send_cmd(&hci_pin_code_request_negative_reply, connection->address); 7237f30077b7SMatthias Ringwald return true; 72384c57c146S[email protected] } 72394c57c146S[email protected] 7240c950c316SMatthias Ringwald // security assessment requires remote features 72412dd8985bSMatthias Ringwald if ((connection->authentication_flags & AUTH_FLAG_RECV_IO_CAPABILITIES_REQUEST) != 0){ 7242c950c316SMatthias Ringwald connectionClearAuthenticationFlags(connection, AUTH_FLAG_RECV_IO_CAPABILITIES_REQUEST); 7243c950c316SMatthias Ringwald hci_ssp_assess_security_on_io_cap_request(connection); 7244c950c316SMatthias Ringwald // no return here as hci_ssp_assess_security_on_io_cap_request only sets AUTH_FLAG_SEND_IO_CAPABILITIES_REPLY or AUTH_FLAG_SEND_IO_CAPABILITIES_NEGATIVE_REPLY 7245c950c316SMatthias Ringwald } 7246c950c316SMatthias Ringwald 72478daf94bcSMatthias Ringwald if (connection->authentication_flags & AUTH_FLAG_SEND_IO_CAPABILITIES_REPLY){ 72488daf94bcSMatthias Ringwald connectionClearAuthenticationFlags(connection, AUTH_FLAG_SEND_IO_CAPABILITIES_REPLY); 7249a8d20135SMatthias Ringwald // set authentication requirements: 7250a8d20135SMatthias Ringwald // - MITM = ssp_authentication_requirement (USER) | requested_security_level (dynamic) 7251532454f9SMatthias Ringwald // - BONDING MODE: dedicated if requested, bondable otherwise. Drop bondable if not set for remote 7252a8d20135SMatthias Ringwald uint8_t authreq = hci_stack->ssp_authentication_requirement & 1; 72539faad3abS[email protected] if (gap_mitm_protection_required_for_security_level(connection->requested_security_level)){ 72549faad3abS[email protected] authreq |= 1; 7255106d6d11S[email protected] } 7256532454f9SMatthias Ringwald bool bonding = hci_stack->bondable; 72578daf94bcSMatthias Ringwald if (connection->authentication_flags & AUTH_FLAG_RECV_IO_CAPABILITIES_RESPONSE){ 7258532454f9SMatthias Ringwald // if we have received IO Cap Response, we're in responder role 7259532454f9SMatthias Ringwald bool remote_bonding = connection->io_cap_response_auth_req >= SSP_IO_AUTHREQ_MITM_PROTECTION_NOT_REQUIRED_DEDICATED_BONDING; 7260532454f9SMatthias Ringwald if (bonding && !remote_bonding){ 7261532454f9SMatthias Ringwald log_info("Remote not bonding, dropping local flag"); 7262532454f9SMatthias Ringwald bonding = false; 7263532454f9SMatthias Ringwald } 7264532454f9SMatthias Ringwald } 7265532454f9SMatthias Ringwald if (bonding){ 7266a8d20135SMatthias Ringwald if (connection->bonding_flags & BONDING_DEDICATED){ 7267a8d20135SMatthias Ringwald authreq |= SSP_IO_AUTHREQ_MITM_PROTECTION_NOT_REQUIRED_DEDICATED_BONDING; 7268532454f9SMatthias Ringwald } else { 7269a8d20135SMatthias Ringwald authreq |= SSP_IO_AUTHREQ_MITM_PROTECTION_NOT_REQUIRED_GENERAL_BONDING; 7270a8d20135SMatthias Ringwald } 7271532454f9SMatthias Ringwald } 72721849becdSMatthias Ringwald uint8_t have_oob_data = 0; 72731849becdSMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB 72741849becdSMatthias Ringwald if (connection->classic_oob_c_192 != NULL){ 72751849becdSMatthias Ringwald have_oob_data |= 1; 72761849becdSMatthias Ringwald } 72771849becdSMatthias Ringwald if (connection->classic_oob_c_256 != NULL){ 72781849becdSMatthias Ringwald have_oob_data |= 2; 72791849becdSMatthias Ringwald } 72801849becdSMatthias Ringwald #endif 72811849becdSMatthias Ringwald hci_send_cmd(&hci_io_capability_request_reply, &connection->address, hci_stack->ssp_io_capability, have_oob_data, authreq); 728211b03efaSMatthias Ringwald return true; 7283f8fb5f6eS[email protected] } 728411b03efaSMatthias Ringwald 72858daf94bcSMatthias Ringwald if (connection->authentication_flags & AUTH_FLAG_SEND_IO_CAPABILITIES_NEGATIVE_REPLY) { 72868daf94bcSMatthias Ringwald connectionClearAuthenticationFlags(connection, AUTH_FLAG_SEND_IO_CAPABILITIES_NEGATIVE_REPLY); 728711b03efaSMatthias Ringwald hci_send_cmd(&hci_io_capability_request_negative_reply, &connection->address, ERROR_CODE_PAIRING_NOT_ALLOWED); 7288f30077b7SMatthias Ringwald return true; 728932ab9390Smatthias.ringwald } 729032ab9390Smatthias.ringwald 72911849becdSMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB 72927ca4a7edSMatthias Ringwald if (connection->authentication_flags & AUTH_FLAG_SEND_REMOTE_OOB_DATA_REPLY){ 72937ca4a7edSMatthias Ringwald connectionClearAuthenticationFlags(connection, AUTH_FLAG_SEND_REMOTE_OOB_DATA_REPLY); 72941849becdSMatthias Ringwald const uint8_t zero[16] = { 0 }; 72951849becdSMatthias Ringwald const uint8_t * r_192 = zero; 72961849becdSMatthias Ringwald const uint8_t * c_192 = zero; 72971849becdSMatthias Ringwald const uint8_t * r_256 = zero; 72981849becdSMatthias Ringwald const uint8_t * c_256 = zero; 72991849becdSMatthias Ringwald // verify P-256 OOB 73001e83575aSMatthias Ringwald if ((connection->classic_oob_c_256 != NULL) && hci_command_supported(SUPPORTED_HCI_COMMAND_REMOTE_OOB_EXTENDED_DATA_REQUEST_REPLY)) { 73011849becdSMatthias Ringwald c_256 = connection->classic_oob_c_256; 73021849becdSMatthias Ringwald if (connection->classic_oob_r_256 != NULL) { 73031849becdSMatthias Ringwald r_256 = connection->classic_oob_r_256; 73041849becdSMatthias Ringwald } 73051849becdSMatthias Ringwald } 73061849becdSMatthias Ringwald // verify P-192 OOB 73071849becdSMatthias Ringwald if ((connection->classic_oob_c_192 != NULL)) { 73081849becdSMatthias Ringwald c_192 = connection->classic_oob_c_192; 73091849becdSMatthias Ringwald if (connection->classic_oob_r_192 != NULL) { 73101849becdSMatthias Ringwald r_192 = connection->classic_oob_r_192; 73111849becdSMatthias Ringwald } 73121849becdSMatthias Ringwald } 73137ca4a7edSMatthias Ringwald 73147ca4a7edSMatthias Ringwald // assess security 73157ca4a7edSMatthias Ringwald bool need_level_4 = hci_stack->gap_secure_connections_only_mode || (connection->requested_security_level == LEVEL_4); 73167ca4a7edSMatthias Ringwald bool can_reach_level_4 = hci_remote_sc_enabled(connection) && (c_256 != NULL); 73177ca4a7edSMatthias Ringwald if (need_level_4 && !can_reach_level_4){ 73187ca4a7edSMatthias Ringwald log_info("Level 4 required, but not possible -> abort"); 73197ca4a7edSMatthias Ringwald hci_pairing_complete(connection, ERROR_CODE_INSUFFICIENT_SECURITY); 73207ca4a7edSMatthias Ringwald // send oob negative reply 73217ca4a7edSMatthias Ringwald c_256 = NULL; 73227ca4a7edSMatthias Ringwald c_192 = NULL; 73237ca4a7edSMatthias Ringwald } 73247ca4a7edSMatthias Ringwald 73251849becdSMatthias Ringwald // Reply 73261849becdSMatthias Ringwald if (c_256 != zero) { 73271849becdSMatthias Ringwald hci_send_cmd(&hci_remote_oob_extended_data_request_reply, &connection->address, c_192, r_192, c_256, r_256); 73281849becdSMatthias Ringwald } else if (c_192 != zero){ 73291849becdSMatthias Ringwald hci_send_cmd(&hci_remote_oob_data_request_reply, &connection->address, c_192, r_192); 73301849becdSMatthias Ringwald } else { 73311ae74bf3SMatthias Ringwald hci_stack->classic_oob_con_handle = connection->con_handle; 73321849becdSMatthias Ringwald hci_send_cmd(&hci_remote_oob_data_request_negative_reply, &connection->address); 73331849becdSMatthias Ringwald } 73341849becdSMatthias Ringwald return true; 73351849becdSMatthias Ringwald } 73361849becdSMatthias Ringwald #endif 73371849becdSMatthias Ringwald 73388daf94bcSMatthias Ringwald if (connection->authentication_flags & AUTH_FLAG_SEND_USER_CONFIRM_REPLY){ 73398daf94bcSMatthias Ringwald connectionClearAuthenticationFlags(connection, AUTH_FLAG_SEND_USER_CONFIRM_REPLY); 734034d2123cS[email protected] hci_send_cmd(&hci_user_confirmation_request_reply, &connection->address); 7341f30077b7SMatthias Ringwald return true; 7342dbe1a790S[email protected] } 7343dbe1a790S[email protected] 7344367aedc0SMatthias Ringwald if (connection->authentication_flags & AUTH_FLAG_SEND_USER_CONFIRM_NEGATIVE_REPLY){ 7345367aedc0SMatthias Ringwald connectionClearAuthenticationFlags(connection, AUTH_FLAG_SEND_USER_CONFIRM_NEGATIVE_REPLY); 7346367aedc0SMatthias Ringwald hci_send_cmd(&hci_user_confirmation_request_negative_reply, &connection->address); 7347367aedc0SMatthias Ringwald return true; 7348367aedc0SMatthias Ringwald } 7349367aedc0SMatthias Ringwald 73508daf94bcSMatthias Ringwald if (connection->authentication_flags & AUTH_FLAG_SEND_USER_PASSKEY_REPLY){ 73518daf94bcSMatthias Ringwald connectionClearAuthenticationFlags(connection, AUTH_FLAG_SEND_USER_PASSKEY_REPLY); 735234d2123cS[email protected] hci_send_cmd(&hci_user_passkey_request_reply, &connection->address, 000000); 7353f30077b7SMatthias Ringwald return true; 7354dbe1a790S[email protected] } 7355afd4e962S[email protected] 7356ab0c69a9SMatthias Ringwald if ((connection->bonding_flags & (BONDING_DISCONNECT_DEDICATED_DONE | BONDING_DEDICATED_DEFER_DISCONNECT)) == BONDING_DISCONNECT_DEDICATED_DONE){ 7357ad83dc6aS[email protected] connection->bonding_flags &= ~BONDING_DISCONNECT_DEDICATED_DONE; 73581bd5283dS[email protected] connection->bonding_flags |= BONDING_EMIT_COMPLETE_ON_DISCONNECT; 73596ef3696aSMatthias Ringwald connection->state = SENT_DISCONNECT; 73606ef3696aSMatthias Ringwald hci_send_cmd(&hci_disconnect, connection->con_handle, ERROR_CODE_REMOTE_USER_TERMINATED_CONNECTION); 7361f30077b7SMatthias Ringwald return true; 7362ad83dc6aS[email protected] } 736376f27cffSMatthias Ringwald 73642a75353aSMatthias Ringwald if ((connection->bonding_flags & BONDING_SEND_AUTHENTICATE_REQUEST) && ((connection->bonding_flags & BONDING_RECEIVED_REMOTE_FEATURES) != 0)){ 736534d2123cS[email protected] connection->bonding_flags &= ~BONDING_SEND_AUTHENTICATE_REQUEST; 7366abdad579SMatthias Ringwald connection->bonding_flags |= BONDING_SENT_AUTHENTICATE_REQUEST; 736734d2123cS[email protected] hci_send_cmd(&hci_authentication_requested, connection->con_handle); 7368f30077b7SMatthias Ringwald return true; 7369afd4e962S[email protected] } 737076f27cffSMatthias Ringwald 7371dce78009S[email protected] if (connection->bonding_flags & BONDING_SEND_ENCRYPTION_REQUEST){ 7372dce78009S[email protected] connection->bonding_flags &= ~BONDING_SEND_ENCRYPTION_REQUEST; 7373dce78009S[email protected] hci_send_cmd(&hci_set_connection_encryption, connection->con_handle, 1); 7374f30077b7SMatthias Ringwald return true; 7375dce78009S[email protected] } 7376447016ffSMatthias Ringwald 7377573897a0SMatthias Ringwald if (connection->bonding_flags & BONDING_SEND_READ_ENCRYPTION_KEY_SIZE){ 7378573897a0SMatthias Ringwald connection->bonding_flags &= ~BONDING_SEND_READ_ENCRYPTION_KEY_SIZE; 7379573897a0SMatthias Ringwald hci_send_cmd(&hci_read_encryption_key_size, connection->con_handle, 1); 7380f30077b7SMatthias Ringwald return true; 7381573897a0SMatthias Ringwald } 7382447016ffSMatthias Ringwald 7383447016ffSMatthias Ringwald if (connection->bonding_flags & BONDING_REQUEST_REMOTE_FEATURES_PAGE_0){ 7384447016ffSMatthias Ringwald connection->bonding_flags &= ~BONDING_REQUEST_REMOTE_FEATURES_PAGE_0; 7385447016ffSMatthias Ringwald hci_send_cmd(&hci_read_remote_supported_features_command, connection->con_handle); 7386447016ffSMatthias Ringwald return true; 7387447016ffSMatthias Ringwald } 7388447016ffSMatthias Ringwald 7389447016ffSMatthias Ringwald if (connection->bonding_flags & BONDING_REQUEST_REMOTE_FEATURES_PAGE_1){ 7390447016ffSMatthias Ringwald connection->bonding_flags &= ~BONDING_REQUEST_REMOTE_FEATURES_PAGE_1; 7391447016ffSMatthias Ringwald hci_send_cmd(&hci_read_remote_extended_features_command, connection->con_handle, 1); 7392447016ffSMatthias Ringwald return true; 7393447016ffSMatthias Ringwald } 7394447016ffSMatthias Ringwald 7395447016ffSMatthias Ringwald if (connection->bonding_flags & BONDING_REQUEST_REMOTE_FEATURES_PAGE_2){ 7396447016ffSMatthias Ringwald connection->bonding_flags &= ~BONDING_REQUEST_REMOTE_FEATURES_PAGE_2; 7397447016ffSMatthias Ringwald hci_send_cmd(&hci_read_remote_extended_features_command, connection->con_handle, 2); 7398447016ffSMatthias Ringwald return true; 7399447016ffSMatthias Ringwald } 740076f27cffSMatthias Ringwald #endif 740176f27cffSMatthias Ringwald 740276f27cffSMatthias Ringwald if (connection->bonding_flags & BONDING_DISCONNECT_SECURITY_BLOCK){ 740376f27cffSMatthias Ringwald connection->bonding_flags &= ~BONDING_DISCONNECT_SECURITY_BLOCK; 74041714cbbdSMatthias Ringwald #ifdef ENABLE_CLASSIC 74051714cbbdSMatthias Ringwald hci_pairing_complete(connection, ERROR_CODE_CONNECTION_REJECTED_DUE_TO_SECURITY_REASONS); 74061714cbbdSMatthias Ringwald #endif 74076ef3696aSMatthias Ringwald if (connection->state != SENT_DISCONNECT){ 74086ef3696aSMatthias Ringwald connection->state = SENT_DISCONNECT; 74096ef3696aSMatthias Ringwald hci_send_cmd(&hci_disconnect, connection->con_handle, ERROR_CODE_AUTHENTICATION_FAILURE); 7410f30077b7SMatthias Ringwald return true; 741176f27cffSMatthias Ringwald } 74126ef3696aSMatthias Ringwald } 7413da886c03S[email protected] 74146cdc2862SMatthias Ringwald #ifdef ENABLE_CLASSIC 7415f8ee3071SMatthias Ringwald uint16_t sniff_min_interval; 7416f8ee3071SMatthias Ringwald switch (connection->sniff_min_interval){ 7417f8ee3071SMatthias Ringwald case 0: 7418f8ee3071SMatthias Ringwald break; 7419f8ee3071SMatthias Ringwald case 0xffff: 7420f8ee3071SMatthias Ringwald connection->sniff_min_interval = 0; 7421f8ee3071SMatthias Ringwald hci_send_cmd(&hci_exit_sniff_mode, connection->con_handle); 7422f30077b7SMatthias Ringwald return true; 7423f8ee3071SMatthias Ringwald default: 7424f8ee3071SMatthias Ringwald sniff_min_interval = connection->sniff_min_interval; 7425f8ee3071SMatthias Ringwald connection->sniff_min_interval = 0; 7426f8ee3071SMatthias Ringwald hci_send_cmd(&hci_sniff_mode, connection->con_handle, connection->sniff_max_interval, sniff_min_interval, connection->sniff_attempt, connection->sniff_timeout); 7427f30077b7SMatthias Ringwald return true; 7428f8ee3071SMatthias Ringwald } 742988a03c8dSMatthias Ringwald 7430140c0557SMatthias Ringwald if (connection->sniff_subrating_max_latency != 0xffff){ 7431140c0557SMatthias Ringwald uint16_t max_latency = connection->sniff_subrating_max_latency; 7432140c0557SMatthias Ringwald connection->sniff_subrating_max_latency = 0; 7433140c0557SMatthias Ringwald hci_send_cmd(&hci_sniff_subrating, connection->con_handle, max_latency, connection->sniff_subrating_min_remote_timeout, connection->sniff_subrating_min_local_timeout); 7434140c0557SMatthias Ringwald return true; 7435140c0557SMatthias Ringwald } 7436140c0557SMatthias Ringwald 7437965a4ccfSMatthias Ringwald if (connection->qos_service_type != HCI_SERVICE_TYPE_INVALID){ 7438278ff8a9SMatthias Ringwald uint8_t service_type = (uint8_t) connection->qos_service_type; 7439965a4ccfSMatthias Ringwald connection->qos_service_type = HCI_SERVICE_TYPE_INVALID; 7440278ff8a9SMatthias Ringwald hci_send_cmd(&hci_qos_setup, connection->con_handle, 0, service_type, connection->qos_token_rate, connection->qos_peak_bandwidth, connection->qos_latency, connection->qos_delay_variation); 7441278ff8a9SMatthias Ringwald return true; 7442278ff8a9SMatthias Ringwald } 7443278ff8a9SMatthias Ringwald 744488a03c8dSMatthias Ringwald if (connection->request_role != HCI_ROLE_INVALID){ 744588a03c8dSMatthias Ringwald hci_role_t role = connection->request_role; 744688a03c8dSMatthias Ringwald connection->request_role = HCI_ROLE_INVALID; 744788a03c8dSMatthias Ringwald hci_send_cmd(&hci_switch_role_command, connection->address, role); 744888a03c8dSMatthias Ringwald return true; 744988a03c8dSMatthias Ringwald } 745022df2fe2SMatthias Ringwald #endif 74519afaa4d4SMatthias Ringwald 74529afaa4d4SMatthias Ringwald if (connection->gap_connection_tasks != 0){ 745322df2fe2SMatthias Ringwald #ifdef ENABLE_CLASSIC 74549afaa4d4SMatthias Ringwald if ((connection->gap_connection_tasks & GAP_CONNECTION_TASK_WRITE_AUTOMATIC_FLUSH_TIMEOUT) != 0){ 74559afaa4d4SMatthias Ringwald connection->gap_connection_tasks &= ~GAP_CONNECTION_TASK_WRITE_AUTOMATIC_FLUSH_TIMEOUT; 74569afaa4d4SMatthias Ringwald hci_send_cmd(&hci_write_automatic_flush_timeout, connection->con_handle, hci_stack->automatic_flush_timeout); 74579afaa4d4SMatthias Ringwald return true; 74589afaa4d4SMatthias Ringwald } 745922df2fe2SMatthias Ringwald if (connection->gap_connection_tasks & GAP_CONNECTION_TASK_WRITE_SUPERVISION_TIMEOUT){ 746022df2fe2SMatthias Ringwald connection->gap_connection_tasks &= ~GAP_CONNECTION_TASK_WRITE_SUPERVISION_TIMEOUT; 746122df2fe2SMatthias Ringwald hci_send_cmd(&hci_write_link_supervision_timeout, connection->con_handle, hci_stack->link_supervision_timeout); 746222df2fe2SMatthias Ringwald return true; 74639afaa4d4SMatthias Ringwald } 74646cdc2862SMatthias Ringwald #endif 746522df2fe2SMatthias Ringwald if (connection->gap_connection_tasks & GAP_CONNECTION_TASK_READ_RSSI){ 746622df2fe2SMatthias Ringwald connection->gap_connection_tasks &= ~GAP_CONNECTION_TASK_READ_RSSI; 746722df2fe2SMatthias Ringwald hci_send_cmd(&hci_read_rssi, connection->con_handle); 746822df2fe2SMatthias Ringwald return true; 746922df2fe2SMatthias Ringwald } 7470ac0f6b83SMatthias Ringwald #ifdef ENABLE_BLE 7471ac0f6b83SMatthias Ringwald if (connection->gap_connection_tasks & GAP_CONNECTION_TASK_LE_READ_REMOTE_FEATURES){ 7472ac0f6b83SMatthias Ringwald connection->gap_connection_tasks &= ~GAP_CONNECTION_TASK_LE_READ_REMOTE_FEATURES; 7473ac0f6b83SMatthias Ringwald hci_send_cmd(&hci_le_read_remote_used_features, connection->con_handle); 7474ac0f6b83SMatthias Ringwald return true; 7475ac0f6b83SMatthias Ringwald } 7476ac0f6b83SMatthias Ringwald #endif 747722df2fe2SMatthias Ringwald } 7478f8ee3071SMatthias Ringwald 7479a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE 748073cd8a2aSMatthias Ringwald switch (connection->le_con_parameter_update_state){ 748173cd8a2aSMatthias Ringwald // response to L2CAP CON PARAMETER UPDATE REQUEST 748273cd8a2aSMatthias Ringwald case CON_PARAMETER_UPDATE_CHANGE_HCI_CON_PARAMETERS: 7483da886c03S[email protected] connection->le_con_parameter_update_state = CON_PARAMETER_UPDATE_NONE; 748473cd8a2aSMatthias Ringwald hci_send_cmd(&hci_le_connection_update, connection->con_handle, connection->le_conn_interval_min, 7485c37a3166S[email protected] connection->le_conn_interval_max, connection->le_conn_latency, connection->le_supervision_timeout, 7486d4876126SMatthias Ringwald hci_stack->le_minimum_ce_length, hci_stack->le_maximum_ce_length); 7487f30077b7SMatthias Ringwald return true; 748873cd8a2aSMatthias Ringwald case CON_PARAMETER_UPDATE_REPLY: 748973cd8a2aSMatthias Ringwald connection->le_con_parameter_update_state = CON_PARAMETER_UPDATE_NONE; 749073cd8a2aSMatthias Ringwald hci_send_cmd(&hci_le_remote_connection_parameter_request_reply, connection->con_handle, connection->le_conn_interval_min, 749173cd8a2aSMatthias Ringwald connection->le_conn_interval_max, connection->le_conn_latency, connection->le_supervision_timeout, 7492d4876126SMatthias Ringwald hci_stack->le_minimum_ce_length, hci_stack->le_maximum_ce_length); 7493f30077b7SMatthias Ringwald return true; 749473cd8a2aSMatthias Ringwald case CON_PARAMETER_UPDATE_NEGATIVE_REPLY: 749573cd8a2aSMatthias Ringwald connection->le_con_parameter_update_state = CON_PARAMETER_UPDATE_NONE; 74961e0338ebSMatthias Ringwald hci_send_cmd(&hci_le_remote_connection_parameter_request_negative_reply, connection->con_handle, 74971e0338ebSMatthias Ringwald ERROR_CODE_UNACCEPTABLE_CONNECTION_PARAMETERS); 7498f30077b7SMatthias Ringwald return true; 749973cd8a2aSMatthias Ringwald default: 750073cd8a2aSMatthias Ringwald break; 7501c37a3166S[email protected] } 75024ea43905SMatthias Ringwald if (connection->le_phy_update_all_phys != 0xffu){ 7503b90f6e0aSMatthias Ringwald uint8_t all_phys = connection->le_phy_update_all_phys; 7504b90f6e0aSMatthias Ringwald connection->le_phy_update_all_phys = 0xff; 7505b90f6e0aSMatthias Ringwald hci_send_cmd(&hci_le_set_phy, connection->con_handle, all_phys, connection->le_phy_update_tx_phys, connection->le_phy_update_rx_phys, connection->le_phy_update_phy_options); 7506f30077b7SMatthias Ringwald return true; 7507b90f6e0aSMatthias Ringwald } 75083bd96807SMatthias Ringwald #ifdef ENABLE_LE_PERIODIC_ADVERTISING 75093bd96807SMatthias Ringwald if (connection->le_past_sync_handle != HCI_CON_HANDLE_INVALID){ 75103bd96807SMatthias Ringwald hci_con_handle_t sync_handle = connection->le_past_sync_handle; 75113bd96807SMatthias Ringwald connection->le_past_sync_handle = HCI_CON_HANDLE_INVALID; 75123bd96807SMatthias Ringwald hci_send_cmd(&hci_le_periodic_advertising_sync_transfer, connection->con_handle, connection->le_past_service_data, sync_handle); 75133bd96807SMatthias Ringwald return true; 75143bd96807SMatthias Ringwald } 7515027f4677SMatthias Ringwald if (connection->le_past_advertising_handle != 0xff){ 7516027f4677SMatthias Ringwald uint8_t advertising_handle = connection->le_past_advertising_handle; 7517027f4677SMatthias Ringwald connection->le_past_advertising_handle = 0xff; 7518027f4677SMatthias Ringwald hci_send_cmd(&hci_le_periodic_advertising_set_info_transfer, connection->con_handle, connection->le_past_service_data, advertising_handle); 7519027f4677SMatthias Ringwald return true; 7520027f4677SMatthias Ringwald } 75213bd96807SMatthias Ringwald #endif 7522c37a3166S[email protected] #endif 7523dbe1a790S[email protected] } 7524f30077b7SMatthias Ringwald return false; 7525f30077b7SMatthias Ringwald } 7526c7e0c5f6Smatthias.ringwald 7527f30077b7SMatthias Ringwald static void hci_run(void){ 7528f30077b7SMatthias Ringwald 7529df9e2780SMatthias Ringwald // stack state sub statemachines 7530df9e2780SMatthias Ringwald switch (hci_stack->state) { 7531df9e2780SMatthias Ringwald case HCI_STATE_INITIALIZING: 7532df9e2780SMatthias Ringwald hci_initializing_run(); 7533d0dea5fbSMatthias Ringwald break; 7534df9e2780SMatthias Ringwald case HCI_STATE_HALTING: 7535df9e2780SMatthias Ringwald hci_halting_run(); 7536d0dea5fbSMatthias Ringwald break; 7537df9e2780SMatthias Ringwald case HCI_STATE_FALLING_ASLEEP: 7538df9e2780SMatthias Ringwald hci_falling_asleep_run(); 7539d0dea5fbSMatthias Ringwald break; 7540df9e2780SMatthias Ringwald default: 7541df9e2780SMatthias Ringwald break; 7542df9e2780SMatthias Ringwald } 7543df9e2780SMatthias Ringwald 7544d0dea5fbSMatthias Ringwald // allow to run after initialization to working transition 7545d0dea5fbSMatthias Ringwald if (hci_stack->state != HCI_STATE_WORKING){ 7546d0dea5fbSMatthias Ringwald return; 7547d0dea5fbSMatthias Ringwald } 7548d0dea5fbSMatthias Ringwald 7549f30077b7SMatthias Ringwald bool done; 7550f30077b7SMatthias Ringwald 7551f30077b7SMatthias Ringwald // send continuation fragments first, as they block the prepared packet buffer 7552f30077b7SMatthias Ringwald done = hci_run_acl_fragments(); 7553f30077b7SMatthias Ringwald if (done) return; 7554f30077b7SMatthias Ringwald 755568ab6207SMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS 755668ab6207SMatthias Ringwald done = hci_run_iso_fragments(); 755768ab6207SMatthias Ringwald if (done) return; 755868ab6207SMatthias Ringwald #endif 755968ab6207SMatthias Ringwald 7560f30077b7SMatthias Ringwald #ifdef ENABLE_HCI_CONTROLLER_TO_HOST_FLOW_CONTROL 7561f30077b7SMatthias Ringwald // send host num completed packets next as they don't require num_cmd_packets > 0 7562f30077b7SMatthias Ringwald if (!hci_can_send_comand_packet_transport()) return; 7563f30077b7SMatthias Ringwald if (hci_stack->host_completed_packets){ 7564f30077b7SMatthias Ringwald hci_host_num_completed_packets(); 7565f30077b7SMatthias Ringwald return; 7566f30077b7SMatthias Ringwald } 7567f30077b7SMatthias Ringwald #endif 7568f30077b7SMatthias Ringwald 7569f30077b7SMatthias Ringwald if (!hci_can_send_command_packet_now()) return; 7570f30077b7SMatthias Ringwald 7571f30077b7SMatthias Ringwald // global/non-connection oriented commands 7572f30077b7SMatthias Ringwald 7573f30077b7SMatthias Ringwald 7574f30077b7SMatthias Ringwald #ifdef ENABLE_CLASSIC 7575f30077b7SMatthias Ringwald // general gap classic 7576f30077b7SMatthias Ringwald done = hci_run_general_gap_classic(); 7577f30077b7SMatthias Ringwald if (done) return; 7578f30077b7SMatthias Ringwald #endif 7579f30077b7SMatthias Ringwald 7580f30077b7SMatthias Ringwald #ifdef ENABLE_BLE 7581f30077b7SMatthias Ringwald // general gap le 7582f30077b7SMatthias Ringwald done = hci_run_general_gap_le(); 7583f30077b7SMatthias Ringwald if (done) return; 75847aa35f6aSMatthias Ringwald 75857aa35f6aSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS 75867aa35f6aSMatthias Ringwald // ISO related tasks, e.g. BIG create/terminate/sync 75877aa35f6aSMatthias Ringwald done = hci_run_iso_tasks(); 75887aa35f6aSMatthias Ringwald if (done) return; 75897aa35f6aSMatthias Ringwald #endif 7590f30077b7SMatthias Ringwald #endif 7591f30077b7SMatthias Ringwald 7592f30077b7SMatthias Ringwald // send pending HCI commands 7593df9e2780SMatthias Ringwald hci_run_general_pending_commands(); 75943429f56bSmatthias.ringwald } 759516833f0aSmatthias.ringwald 75960f076adeSMatthias Ringwald #ifdef ENABLE_CLASSIC 7597d7891039SMatthias Ringwald static void hci_set_sco_payload_length_for_flipped_packet_types(hci_connection_t * hci_connection, uint16_t flipped_packet_types){ 7598d7891039SMatthias Ringwald // bits 6-9 are 'don't use' 7599d7891039SMatthias Ringwald uint16_t packet_types = flipped_packet_types ^ 0x03c0; 7600d7891039SMatthias Ringwald 7601d7891039SMatthias Ringwald // restrict packet types to local and remote supported 7602d7891039SMatthias Ringwald packet_types &= hci_connection->remote_supported_sco_packets & hci_stack->usable_packet_types_sco; 7603d7891039SMatthias Ringwald hci_connection->sco_payload_length = hci_sco_payload_length_for_packet_types(packet_types); 7604d7891039SMatthias Ringwald log_info("Possible SCO packet types 0x%04x => payload length %u", packet_types, hci_connection->sco_payload_length); 7605d7891039SMatthias Ringwald } 76060f076adeSMatthias Ringwald #endif 7607d7891039SMatthias Ringwald 7608ca6804fdSMatthias Ringwald // funnel for sending cmd packet using single outgoing buffer 7609ed208344SMatthias Ringwald static uint8_t hci_send_prepared_cmd_packet(void) { 7610ca6804fdSMatthias Ringwald btstack_assert(hci_stack->hci_packet_buffer_reserved); 7611f91accd3SMatthias Ringwald // cache opcode 7612f91accd3SMatthias Ringwald hci_stack->last_cmd_opcode = little_endian_read_16(hci_stack->hci_packet_buffer, 0); 7613f91accd3SMatthias Ringwald // get size 7614ca6804fdSMatthias Ringwald uint16_t size = 3u + hci_stack->hci_packet_buffer[2u]; 7615f91accd3SMatthias Ringwald // send packet 7616ca6804fdSMatthias Ringwald uint8_t status = hci_send_cmd_packet(hci_stack->hci_packet_buffer, size); 7617ca6804fdSMatthias Ringwald // release packet buffer on error or for synchronous transport implementations 7618ca6804fdSMatthias Ringwald if ((status != ERROR_CODE_SUCCESS) || hci_transport_synchronous()){ 7619ca6804fdSMatthias Ringwald hci_release_packet_buffer(); 7620ca6804fdSMatthias Ringwald } 7621ca6804fdSMatthias Ringwald return status; 7622ca6804fdSMatthias Ringwald } 7623ca6804fdSMatthias Ringwald 76243e2050f7SMatthias Ringwald uint8_t hci_send_cmd_packet(uint8_t *packet, int size){ 762535454696SMatthias Ringwald // house-keeping 762635454696SMatthias Ringwald 762735454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 7628c8e4258aSmatthias.ringwald bd_addr_t addr; 7629c8e4258aSmatthias.ringwald hci_connection_t * conn; 7630c123d999SMatthias Ringwald #endif 7631c123d999SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 76326f35bb46SMatthias Ringwald uint8_t initiator_filter_policy; 76339cbd2215SMatthias Ringwald #endif 7634c8e4258aSmatthias.ringwald 76356f35bb46SMatthias Ringwald uint16_t opcode = little_endian_read_16(packet, 0); 76366f35bb46SMatthias Ringwald switch (opcode) { 76379cbd2215SMatthias Ringwald case HCI_OPCODE_HCI_WRITE_LOOPBACK_MODE: 76389cbd2215SMatthias Ringwald hci_stack->loopback_mode = packet[3]; 76399cbd2215SMatthias Ringwald break; 76409cbd2215SMatthias Ringwald 76419cbd2215SMatthias Ringwald #ifdef ENABLE_CLASSIC 76426f35bb46SMatthias Ringwald case HCI_OPCODE_HCI_CREATE_CONNECTION: 7643724d70a2SMatthias Ringwald reverse_bd_addr(&packet[3], addr); 76449da54300S[email protected] log_info("Create_connection to %s", bd_addr_to_str(addr)); 7645c8e4258aSmatthias.ringwald 764672cf8859SMatthias Ringwald // CVE-2020-26555: reject outgoing connection to device with same BD ADDR 764772cf8859SMatthias Ringwald if (memcmp(hci_stack->local_bd_addr, addr, 6) == 0) { 764879e0fa07SMatthias Ringwald hci_emit_connection_complete(addr, 0, ERROR_CODE_CONNECTION_REJECTED_DUE_TO_UNACCEPTABLE_BD_ADDR); 76493e2050f7SMatthias Ringwald return ERROR_CODE_CONNECTION_REJECTED_DUE_TO_UNACCEPTABLE_BD_ADDR; 765072cf8859SMatthias Ringwald } 765172cf8859SMatthias Ringwald 7652f16129ceSMatthias Ringwald conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL); 7653ad83dc6aS[email protected] if (!conn) { 765488f925b1SMatthias Ringwald conn = create_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL, HCI_ROLE_MASTER); 765517f1ba2aSmatthias.ringwald if (!conn) { 765617f1ba2aSmatthias.ringwald // notify client that alloc failed 76572deddeceSMatthias Ringwald hci_emit_connection_complete(addr, 0, BTSTACK_MEMORY_ALLOC_FAILED); 76583e2050f7SMatthias Ringwald return BTSTACK_MEMORY_ALLOC_FAILED; // packet not sent to controller 765917f1ba2aSmatthias.ringwald } 7660ad83dc6aS[email protected] conn->state = SEND_CREATE_CONNECTION; 7661ad83dc6aS[email protected] } 7662aee5d5c1SMatthias Ringwald 7663ad83dc6aS[email protected] log_info("conn state %u", conn->state); 76643e2050f7SMatthias Ringwald // TODO: L2CAP should not send create connection command, instead a (new) gap function should be used 7665ad83dc6aS[email protected] switch (conn->state) { 7666ad83dc6aS[email protected] // if connection active exists 7667ad83dc6aS[email protected] case OPEN: 7668f5e5741dSMatthias Ringwald // and OPEN, emit connection complete command 766972cf8859SMatthias Ringwald hci_emit_connection_complete(addr, conn->con_handle, ERROR_CODE_SUCCESS); 76703e2050f7SMatthias Ringwald // packet not sent to controller 76713e2050f7SMatthias Ringwald return ERROR_CODE_ACL_CONNECTION_ALREADY_EXISTS; 7672672e36abSMatthias Ringwald case RECEIVED_DISCONNECTION_COMPLETE: 7673672e36abSMatthias Ringwald // create connection triggered in disconnect complete event, let's do it now 7674672e36abSMatthias Ringwald break; 7675ad83dc6aS[email protected] case SEND_CREATE_CONNECTION: 76766c0d5426SMatthias Ringwald #ifdef ENABLE_HCI_SERIALIZED_CONTROLLER_OPERATIONS 76776c0d5426SMatthias Ringwald if (hci_classic_operation_active()){ 76786c0d5426SMatthias Ringwald return ERROR_CODE_SUCCESS; 76796c0d5426SMatthias Ringwald } 76806c0d5426SMatthias Ringwald #endif 7681532f91a5SMatthias Ringwald // connection created by hci, e.g. dedicated bonding, but not executed yet, let's do it now 7682532f91a5SMatthias Ringwald break; 7683ad83dc6aS[email protected] default: 7684ad83dc6aS[email protected] // otherwise, just ignore as it is already in the open process 76853e2050f7SMatthias Ringwald // packet not sent to controller 76863e2050f7SMatthias Ringwald return ERROR_CODE_ACL_CONNECTION_ALREADY_EXISTS; 7687ad83dc6aS[email protected] } 7688c8e4258aSmatthias.ringwald conn->state = SENT_CREATE_CONNECTION; 7689229331c6SMatthias Ringwald 7690229331c6SMatthias Ringwald // track outgoing connection 7691f16129ceSMatthias Ringwald hci_stack->outgoing_addr_type = BD_ADDR_TYPE_ACL; 76926535961aSMatthias Ringwald (void) memcpy(hci_stack->outgoing_addr, addr, 6); 76936f35bb46SMatthias Ringwald break; 7694ee752bb8SMatthias Ringwald 76956f35bb46SMatthias Ringwald case HCI_OPCODE_HCI_SETUP_SYNCHRONOUS_CONNECTION: 76969071873aSMatthias Ringwald conn = hci_connection_for_handle(little_endian_read_16(packet, 3)); 76979071873aSMatthias Ringwald if (conn == NULL) { 76989071873aSMatthias Ringwald // neither SCO nor ACL connection for con handle 76999071873aSMatthias Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 77009071873aSMatthias Ringwald } else { 7701d7891039SMatthias Ringwald uint16_t remote_supported_sco_packets; 77029071873aSMatthias Ringwald switch (conn->address_type){ 77039071873aSMatthias Ringwald case BD_ADDR_TYPE_ACL: 77049071873aSMatthias Ringwald // assert SCO connection does not exit 7705d9290e95SMatthias Ringwald if (hci_connection_for_bd_addr_and_type(conn->address, BD_ADDR_TYPE_SCO) != NULL){ 77069071873aSMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 77079071873aSMatthias Ringwald } 7708d7891039SMatthias Ringwald // cache remote sco packet types 7709d7891039SMatthias Ringwald remote_supported_sco_packets = conn->remote_supported_sco_packets; 7710d7891039SMatthias Ringwald 77119071873aSMatthias Ringwald // allocate connection struct 771288f925b1SMatthias Ringwald conn = create_connection_for_bd_addr_and_type(conn->address, BD_ADDR_TYPE_SCO, 771388f925b1SMatthias Ringwald HCI_ROLE_MASTER); 77149071873aSMatthias Ringwald if (!conn) { 77159071873aSMatthias Ringwald return ERROR_CODE_MEMORY_CAPACITY_EXCEEDED; 77169071873aSMatthias Ringwald } 7717d7891039SMatthias Ringwald conn->remote_supported_sco_packets = remote_supported_sco_packets; 77189071873aSMatthias Ringwald break; 77199071873aSMatthias Ringwald case BD_ADDR_TYPE_SCO: 77209071873aSMatthias Ringwald // update of existing SCO connection 77219071873aSMatthias Ringwald break; 77229071873aSMatthias Ringwald default: 77239071873aSMatthias Ringwald return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS; 77249071873aSMatthias Ringwald } 77259071873aSMatthias Ringwald } 7726d9290e95SMatthias Ringwald 7727d9290e95SMatthias Ringwald // conn refers to hci connection of type sco now 7728d9290e95SMatthias Ringwald 77299071873aSMatthias Ringwald conn->state = SENT_CREATE_CONNECTION; 77309071873aSMatthias Ringwald 77319071873aSMatthias Ringwald // track outgoing connection to handle command status with error 77329071873aSMatthias Ringwald hci_stack->outgoing_addr_type = BD_ADDR_TYPE_SCO; 7733f728a932SMatthias Ringwald (void) memcpy(hci_stack->outgoing_addr, conn->address, 6); 77349071873aSMatthias Ringwald 7735ee752bb8SMatthias Ringwald // setup_synchronous_connection? Voice setting at offset 22 7736ee752bb8SMatthias Ringwald // TODO: compare to current setting if sco connection already active 7737ee752bb8SMatthias Ringwald hci_stack->sco_voice_setting_active = little_endian_read_16(packet, 15); 7738d7891039SMatthias Ringwald 7739d7891039SMatthias Ringwald // derive sco payload length from packet types 7740d7891039SMatthias Ringwald hci_set_sco_payload_length_for_flipped_packet_types(conn, little_endian_read_16(packet, 18)); 77416f35bb46SMatthias Ringwald break; 77429071873aSMatthias Ringwald 77436f35bb46SMatthias Ringwald case HCI_OPCODE_HCI_ACCEPT_SYNCHRONOUS_CONNECTION: 77449071873aSMatthias Ringwald // get SCO connection 77459071873aSMatthias Ringwald reverse_bd_addr(&packet[3], addr); 77469071873aSMatthias Ringwald conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_SCO); 77479071873aSMatthias Ringwald if (conn == NULL){ 77489071873aSMatthias Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 77499071873aSMatthias Ringwald } 77509071873aSMatthias Ringwald 77519071873aSMatthias Ringwald conn->state = ACCEPTED_CONNECTION_REQUEST; 77529071873aSMatthias Ringwald 77539071873aSMatthias Ringwald // track outgoing connection to handle command status with error 77549071873aSMatthias Ringwald hci_stack->outgoing_addr_type = BD_ADDR_TYPE_SCO; 77559071873aSMatthias Ringwald (void) memcpy(hci_stack->outgoing_addr, addr, 6); 77569071873aSMatthias Ringwald 7757c91e6e4fSMatthias Ringwald // accept_synchronous_connection? Voice setting at offset 18 7758ee752bb8SMatthias Ringwald // TODO: compare to current setting if sco connection already active 7759ee752bb8SMatthias Ringwald hci_stack->sco_voice_setting_active = little_endian_read_16(packet, 19); 7760d7891039SMatthias Ringwald 7761d7891039SMatthias Ringwald // derive sco payload length from packet types 7762d7891039SMatthias Ringwald hci_set_sco_payload_length_for_flipped_packet_types(conn, little_endian_read_16(packet, 22)); 77636f35bb46SMatthias Ringwald break; 7764ee752bb8SMatthias Ringwald #endif 77654b3e1e19SMatthias Ringwald 7766a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE 7767d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 77686f35bb46SMatthias Ringwald case HCI_OPCODE_HCI_LE_CREATE_CONNECTION: 7769b04dfa37SMatthias Ringwald // white list used? 77706f35bb46SMatthias Ringwald initiator_filter_policy = packet[7]; 7771b04dfa37SMatthias Ringwald switch (initiator_filter_policy) { 7772b04dfa37SMatthias Ringwald case 0: 7773b04dfa37SMatthias Ringwald // whitelist not used 7774b04dfa37SMatthias Ringwald hci_stack->le_connecting_state = LE_CONNECTING_DIRECT; 7775b04dfa37SMatthias Ringwald break; 7776b04dfa37SMatthias Ringwald case 1: 7777b04dfa37SMatthias Ringwald hci_stack->le_connecting_state = LE_CONNECTING_WHITELIST; 7778b04dfa37SMatthias Ringwald break; 7779b04dfa37SMatthias Ringwald default: 7780b04dfa37SMatthias Ringwald log_error("Invalid initiator_filter_policy in LE Create Connection %u", initiator_filter_policy); 7781b04dfa37SMatthias Ringwald break; 7782b04dfa37SMatthias Ringwald } 7783c163146eSMatthias Ringwald // track outgoing connection 77848f7da641SMatthias Ringwald hci_stack->outgoing_addr_type = (bd_addr_type_t) packet[8]; // peer address type 7785c163146eSMatthias Ringwald reverse_bd_addr( &packet[9], hci_stack->outgoing_addr); // peer address 77866f35bb46SMatthias Ringwald break; 77878f7da641SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 77888f7da641SMatthias Ringwald case HCI_OPCODE_HCI_LE_EXTENDED_CREATE_CONNECTION: 77898f7da641SMatthias Ringwald // white list used? 77908f7da641SMatthias Ringwald initiator_filter_policy = packet[3]; 77918f7da641SMatthias Ringwald switch (initiator_filter_policy) { 77928f7da641SMatthias Ringwald case 0: 77938f7da641SMatthias Ringwald // whitelist not used 77948f7da641SMatthias Ringwald hci_stack->le_connecting_state = LE_CONNECTING_DIRECT; 77958f7da641SMatthias Ringwald break; 77968f7da641SMatthias Ringwald case 1: 77978f7da641SMatthias Ringwald hci_stack->le_connecting_state = LE_CONNECTING_WHITELIST; 77988f7da641SMatthias Ringwald break; 77998f7da641SMatthias Ringwald default: 78008f7da641SMatthias Ringwald log_error("Invalid initiator_filter_policy in LE Create Connection %u", initiator_filter_policy); 78018f7da641SMatthias Ringwald break; 78028f7da641SMatthias Ringwald } 78038f7da641SMatthias Ringwald // track outgoing connection 78048f7da641SMatthias Ringwald hci_stack->outgoing_addr_type = (bd_addr_type_t) packet[5]; // peer address type 78058f7da641SMatthias Ringwald reverse_bd_addr( &packet[6], hci_stack->outgoing_addr); // peer address 78068f7da641SMatthias Ringwald break; 78078f7da641SMatthias Ringwald #endif 78086f35bb46SMatthias Ringwald case HCI_OPCODE_HCI_LE_CREATE_CONNECTION_CANCEL: 78096ea9315cSMatthias Ringwald hci_stack->le_connecting_state = LE_CONNECTING_CANCEL; 78106f35bb46SMatthias Ringwald break; 78119cbd2215SMatthias Ringwald #endif 781291036612SMatthias Ringwald #ifdef ENABLE_HCI_COMMAND_STATUS_DISCARDED_FOR_FAILED_CONNECTIONS_WORKAROUND 7813f48a5586SMatthias Ringwald case HCI_OPCODE_HCI_LE_CONNECTION_UPDATE: 7814f48a5586SMatthias Ringwald case HCI_OPCODE_HCI_LE_READ_REMOTE_USED_FEATURES: 7815f48a5586SMatthias Ringwald case HCI_OPCODE_HCI_LE_START_ENCRYPTION: 7816f48a5586SMatthias Ringwald case HCI_OPCODE_HCI_LE_LONG_TERM_KEY_REQUEST_REPLY: 7817f48a5586SMatthias Ringwald case HCI_OPCODE_HCI_LE_LONG_TERM_KEY_NEGATIVE_REPLY: 7818f48a5586SMatthias Ringwald case HCI_OPCODE_HCI_LE_REMOTE_CONNECTION_PARAMETER_REQUEST_REPLY: 7819f48a5586SMatthias Ringwald case HCI_OPCODE_HCI_LE_REMOTE_CONNECTION_PARAMETER_REQUEST_NEGATIVE_REPLY: 7820f48a5586SMatthias Ringwald case HCI_OPCODE_HCI_LE_SET_DATA_LENGTH: 7821f48a5586SMatthias Ringwald case HCI_OPCODE_HCI_LE_READ_PHY: 7822f48a5586SMatthias Ringwald case HCI_OPCODE_HCI_LE_SET_PHY: 7823f48a5586SMatthias Ringwald // conection handle is first command parameter 7824f48a5586SMatthias Ringwald hci_stack->hci_command_con_handle = little_endian_read_16(packet, 3); 7825f48a5586SMatthias Ringwald break; 7826f48a5586SMatthias Ringwald #endif 78274ae8623eSMatthias Ringwald #endif /* ENABLE_BLE */ 78286f35bb46SMatthias Ringwald default: 78296f35bb46SMatthias Ringwald break; 7830b04dfa37SMatthias Ringwald } 783169a97523S[email protected] 78323a9fb326S[email protected] hci_stack->num_cmd_packets--; 78335bb5bc3eS[email protected] 78345bb5bc3eS[email protected] hci_dump_packet(HCI_COMMAND_DATA_PACKET, 0, packet, size); 78353e2050f7SMatthias Ringwald int err = hci_stack->hci_transport->send_packet(HCI_COMMAND_DATA_PACKET, packet, size); 7836a84946b2SMatthias Ringwald uint8_t status; 7837a84946b2SMatthias Ringwald if (err == 0){ 7838a84946b2SMatthias Ringwald status = ERROR_CODE_SUCCESS; 7839a84946b2SMatthias Ringwald } else { 7840a84946b2SMatthias Ringwald status = ERROR_CODE_HARDWARE_FAILURE; 78413e2050f7SMatthias Ringwald } 7842a84946b2SMatthias Ringwald return status; 784331452debSmatthias.ringwald } 78448adf0ddaSmatthias.ringwald 78452bd8b7e7S[email protected] // disconnect because of security block 78462bd8b7e7S[email protected] void hci_disconnect_security_block(hci_con_handle_t con_handle){ 78472bd8b7e7S[email protected] hci_connection_t * connection = hci_connection_for_handle(con_handle); 78482bd8b7e7S[email protected] if (!connection) return; 78492bd8b7e7S[email protected] connection->bonding_flags |= BONDING_DISCONNECT_SECURITY_BLOCK; 78502bd8b7e7S[email protected] } 78512bd8b7e7S[email protected] 78522bd8b7e7S[email protected] 7853dbe1a790S[email protected] // Configure Secure Simple Pairing 7854dbe1a790S[email protected] 785535454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 785635454696SMatthias Ringwald 7857dbe1a790S[email protected] // enable will enable SSP during init 785815a95bd5SMatthias Ringwald void gap_ssp_set_enable(int enable){ 78593a9fb326S[email protected] hci_stack->ssp_enable = enable; 7860dbe1a790S[email protected] } 7861dbe1a790S[email protected] 786295d71764SMatthias Ringwald static int hci_local_ssp_activated(void){ 786315a95bd5SMatthias Ringwald return gap_ssp_supported() && hci_stack->ssp_enable; 78642bd8b7e7S[email protected] } 78652bd8b7e7S[email protected] 7866dbe1a790S[email protected] // if set, BTstack will respond to io capability request using authentication requirement 786715a95bd5SMatthias Ringwald void gap_ssp_set_io_capability(int io_capability){ 78683a9fb326S[email protected] hci_stack->ssp_io_capability = io_capability; 7869dbe1a790S[email protected] } 787015a95bd5SMatthias Ringwald void gap_ssp_set_authentication_requirement(int authentication_requirement){ 78713a9fb326S[email protected] hci_stack->ssp_authentication_requirement = authentication_requirement; 7872dbe1a790S[email protected] } 7873dbe1a790S[email protected] 7874dbe1a790S[email protected] // if set, BTstack will confirm a numberic comparion and enter '000000' if requested 787515a95bd5SMatthias Ringwald void gap_ssp_set_auto_accept(int auto_accept){ 78763a9fb326S[email protected] hci_stack->ssp_auto_accept = auto_accept; 7877dbe1a790S[email protected] } 78785d23aae8SMatthias Ringwald 78795d23aae8SMatthias Ringwald void gap_secure_connections_enable(bool enable){ 78805d23aae8SMatthias Ringwald hci_stack->secure_connections_enable = enable; 78815d23aae8SMatthias Ringwald } 788222d445d8SMatthias Ringwald bool gap_secure_connections_active(void){ 7883eaf85bc8SMatthias Ringwald return hci_stack->secure_connections_active; 788422d445d8SMatthias Ringwald } 78855d23aae8SMatthias Ringwald 788635454696SMatthias Ringwald #endif 7887dbe1a790S[email protected] 788894be1a66SMatthias Ringwald // va_list part of hci_send_cmd 78893e2050f7SMatthias Ringwald uint8_t hci_send_cmd_va_arg(const hci_cmd_t * cmd, va_list argptr){ 7890d94d3cafS[email protected] if (!hci_can_send_command_packet_now()){ 78919d14b626S[email protected] log_error("hci_send_cmd called but cannot send packet now"); 78923e2050f7SMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 78939d14b626S[email protected] } 78949d14b626S[email protected] 78959d14b626S[email protected] hci_reserve_packet_buffer(); 7896f91accd3SMatthias Ringwald hci_cmd_create_from_template(hci_stack->hci_packet_buffer, cmd, argptr); 7897ca6804fdSMatthias Ringwald return hci_send_prepared_cmd_packet(); 789894be1a66SMatthias Ringwald } 78999d14b626S[email protected] 790094be1a66SMatthias Ringwald /** 790194be1a66SMatthias Ringwald * pre: numcmds >= 0 - it's allowed to send a command to the controller 790294be1a66SMatthias Ringwald */ 79033e2050f7SMatthias Ringwald uint8_t hci_send_cmd(const hci_cmd_t * cmd, ...){ 79041cd208adSmatthias.ringwald va_list argptr; 79051cd208adSmatthias.ringwald va_start(argptr, cmd); 79063e2050f7SMatthias Ringwald uint8_t status = hci_send_cmd_va_arg(cmd, argptr); 79071cd208adSmatthias.ringwald va_end(argptr); 79083e2050f7SMatthias Ringwald return status; 790993b8dc03Smatthias.ringwald } 7910c8e4258aSmatthias.ringwald 7911ee091cf1Smatthias.ringwald // Create various non-HCI events. 7912ee091cf1Smatthias.ringwald // TODO: generalize, use table similar to hci_create_command 7913ee091cf1Smatthias.ringwald 7914d6b06661SMatthias Ringwald static void hci_emit_event(uint8_t * event, uint16_t size, int dump){ 7915fb37a842SMatthias Ringwald // dump packet 7916d6b06661SMatthias Ringwald if (dump) { 791792da54c4SMatthias Ringwald hci_dump_packet( HCI_EVENT_PACKET, 1, event, size); 7918d6b06661SMatthias Ringwald } 79191ef6bb52SMatthias Ringwald 7920fb37a842SMatthias Ringwald // dispatch to all event handlers 79211ef6bb52SMatthias Ringwald btstack_linked_list_iterator_t it; 79221ef6bb52SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->event_handlers); 79231ef6bb52SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 79241ef6bb52SMatthias Ringwald btstack_packet_callback_registration_t * entry = (btstack_packet_callback_registration_t*) btstack_linked_list_iterator_next(&it); 7925d9a7306aSMatthias Ringwald entry->callback(HCI_EVENT_PACKET, 0, event, size); 79261ef6bb52SMatthias Ringwald } 7927d6b06661SMatthias Ringwald } 7928d6b06661SMatthias Ringwald 7929d6b06661SMatthias Ringwald static void hci_emit_acl_packet(uint8_t * packet, uint16_t size){ 7930fb37a842SMatthias Ringwald if (!hci_stack->acl_packet_handler) return; 79313d50b4baSMatthias Ringwald hci_stack->acl_packet_handler(HCI_ACL_DATA_PACKET, 0, packet, size); 7932d6b06661SMatthias Ringwald } 7933d6b06661SMatthias Ringwald 793435454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 7935701e3307SMatthias Ringwald static void hci_notify_if_sco_can_send_now(void){ 79363bc639ceSMatthias Ringwald // notify SCO sender if waiting 7937701e3307SMatthias Ringwald if (!hci_stack->sco_waiting_for_can_send_now) return; 7938701e3307SMatthias Ringwald if (hci_can_send_sco_packet_now()){ 79393bc639ceSMatthias Ringwald hci_stack->sco_waiting_for_can_send_now = 0; 7940701e3307SMatthias Ringwald uint8_t event[2] = { HCI_EVENT_SCO_CAN_SEND_NOW, 0 }; 7941701e3307SMatthias Ringwald hci_dump_packet(HCI_EVENT_PACKET, 1, event, sizeof(event)); 79423d50b4baSMatthias Ringwald hci_stack->sco_packet_handler(HCI_EVENT_PACKET, 0, event, sizeof(event)); 79433bc639ceSMatthias Ringwald } 79443bc639ceSMatthias Ringwald } 79451cfb383eSMatthias Ringwald 79461cfb383eSMatthias Ringwald // parsing end emitting has been merged to reduce code size 79479784dac1SMatthias Ringwald static void gap_inquiry_explode(uint8_t *packet, uint16_t size) { 7948ac9136ccSMatthias Ringwald uint8_t event[28+GAP_INQUIRY_MAX_NAME_LEN]; 79491cfb383eSMatthias Ringwald 79501cfb383eSMatthias Ringwald uint8_t * eir_data; 79511cfb383eSMatthias Ringwald ad_context_t context; 79521cfb383eSMatthias Ringwald const uint8_t * name; 79531cfb383eSMatthias Ringwald uint8_t name_len; 79541cfb383eSMatthias Ringwald 79559784dac1SMatthias Ringwald if (size < 3) return; 79569784dac1SMatthias Ringwald 79571cfb383eSMatthias Ringwald int event_type = hci_event_packet_get_type(packet); 7958a1df452eSMatthias Ringwald int num_reserved_fields = (event_type == HCI_EVENT_INQUIRY_RESULT) ? 2 : 1; // 2 for old event, 1 otherwise 79591cfb383eSMatthias Ringwald int num_responses = hci_event_inquiry_result_get_num_responses(packet); 79601cfb383eSMatthias Ringwald 79619784dac1SMatthias Ringwald switch (event_type){ 79629784dac1SMatthias Ringwald case HCI_EVENT_INQUIRY_RESULT: 79639784dac1SMatthias Ringwald case HCI_EVENT_INQUIRY_RESULT_WITH_RSSI: 79649784dac1SMatthias Ringwald if (size != (3 + (num_responses * 14))) return; 79659784dac1SMatthias Ringwald break; 79669784dac1SMatthias Ringwald case HCI_EVENT_EXTENDED_INQUIRY_RESPONSE: 79679784dac1SMatthias Ringwald if (size != 257) return; 79689784dac1SMatthias Ringwald if (num_responses != 1) return; 79699784dac1SMatthias Ringwald break; 79709784dac1SMatthias Ringwald default: 79719784dac1SMatthias Ringwald return; 79729784dac1SMatthias Ringwald } 79739784dac1SMatthias Ringwald 79741cfb383eSMatthias Ringwald // event[1] is set at the end 79751cfb383eSMatthias Ringwald int i; 79761cfb383eSMatthias Ringwald for (i=0; i<num_responses;i++){ 79771cfb383eSMatthias Ringwald memset(event, 0, sizeof(event)); 79781cfb383eSMatthias Ringwald event[0] = GAP_EVENT_INQUIRY_RESULT; 7979ac973fd6SMatthias Ringwald uint8_t event_size = 27; // if name is not set by EIR 79801cfb383eSMatthias Ringwald 79816535961aSMatthias Ringwald (void)memcpy(&event[2], &packet[3 + (i * 6)], 6); // bd_addr 79820e588213SMatthias Ringwald event[8] = packet[3 + (num_responses*(6)) + (i*1)]; // page_scan_repetition_mode 79836535961aSMatthias Ringwald (void)memcpy(&event[9], 79846535961aSMatthias Ringwald &packet[3 + (num_responses * (6 + 1 + num_reserved_fields)) + (i * 3)], 79856535961aSMatthias Ringwald 3); // class of device 79866535961aSMatthias Ringwald (void)memcpy(&event[12], 79876535961aSMatthias Ringwald &packet[3 + (num_responses * (6 + 1 + num_reserved_fields + 3)) + (i * 2)], 79886535961aSMatthias Ringwald 2); // clock offset 79891cfb383eSMatthias Ringwald 79901cfb383eSMatthias Ringwald switch (event_type){ 79911cfb383eSMatthias Ringwald case HCI_EVENT_INQUIRY_RESULT: 79921cfb383eSMatthias Ringwald // 14,15,16,17 = 0, size 18 79931cfb383eSMatthias Ringwald break; 79941cfb383eSMatthias Ringwald case HCI_EVENT_INQUIRY_RESULT_WITH_RSSI: 79951cfb383eSMatthias Ringwald event[14] = 1; 7996a1df452eSMatthias Ringwald event[15] = packet [3 + (num_responses*(6+1+num_reserved_fields+3+2)) + (i*1)]; // rssi 79971cfb383eSMatthias Ringwald // 16,17 = 0, size 18 79981cfb383eSMatthias Ringwald break; 79991cfb383eSMatthias Ringwald case HCI_EVENT_EXTENDED_INQUIRY_RESPONSE: 80001cfb383eSMatthias Ringwald event[14] = 1; 8001a1df452eSMatthias Ringwald event[15] = packet [3 + (num_responses*(6+1+num_reserved_fields+3+2)) + (i*1)]; // rssi 800279186815SMatthias Ringwald // EIR packets only contain a single inquiry response 80031cfb383eSMatthias Ringwald eir_data = &packet[3 + (6+1+num_reserved_fields+3+2+1)]; 80041cfb383eSMatthias Ringwald name = NULL; 8005a8c4e5adSMatthias Ringwald // Iterate over EIR data 8006a8c4e5adSMatthias Ringwald for (ad_iterator_init(&context, EXTENDED_INQUIRY_RESPONSE_DATA_LEN, eir_data) ; ad_iterator_has_more(&context) ; ad_iterator_next(&context)){ 80071cfb383eSMatthias Ringwald uint8_t data_type = ad_iterator_get_data_type(&context); 80081cfb383eSMatthias Ringwald uint8_t data_size = ad_iterator_get_data_len(&context); 80091cfb383eSMatthias Ringwald const uint8_t * data = ad_iterator_get_data(&context); 8010ac9136ccSMatthias Ringwald // Prefer Complete Local Name over Shortened Local Name 80111cfb383eSMatthias Ringwald switch (data_type){ 80121cfb383eSMatthias Ringwald case BLUETOOTH_DATA_TYPE_SHORTENED_LOCAL_NAME: 80131cfb383eSMatthias Ringwald if (name) continue; 8014cf373d3aSMatthias Ringwald /* fall through */ 80151cfb383eSMatthias Ringwald case BLUETOOTH_DATA_TYPE_COMPLETE_LOCAL_NAME: 80161cfb383eSMatthias Ringwald name = data; 80171cfb383eSMatthias Ringwald name_len = data_size; 80181cfb383eSMatthias Ringwald break; 8019ac9136ccSMatthias Ringwald case BLUETOOTH_DATA_TYPE_DEVICE_ID: 8020ac9136ccSMatthias Ringwald if (data_size != 8) break; 8021ac9136ccSMatthias Ringwald event[16] = 1; 80223c0c7fefSMatthias Ringwald memcpy(&event[17], data, 8); 8023ac9136ccSMatthias Ringwald break; 80241cfb383eSMatthias Ringwald default: 80251cfb383eSMatthias Ringwald break; 80261cfb383eSMatthias Ringwald } 80271cfb383eSMatthias Ringwald } 80281cfb383eSMatthias Ringwald if (name){ 8029ac9136ccSMatthias Ringwald event[25] = 1; 80301cfb383eSMatthias Ringwald // truncate name if needed 80311cfb383eSMatthias Ringwald int len = btstack_min(name_len, GAP_INQUIRY_MAX_NAME_LEN); 8032ac9136ccSMatthias Ringwald event[26] = len; 8033ac9136ccSMatthias Ringwald (void)memcpy(&event[27], name, len); 80341cfb383eSMatthias Ringwald event_size += len; 80351cfb383eSMatthias Ringwald } 80361cfb383eSMatthias Ringwald break; 80377bbeb3adSMilanka Ringwald default: 80387bbeb3adSMilanka Ringwald return; 80391cfb383eSMatthias Ringwald } 80401cfb383eSMatthias Ringwald event[1] = event_size - 2; 80411cfb383eSMatthias Ringwald hci_emit_event(event, event_size, 1); 80421cfb383eSMatthias Ringwald } 80431cfb383eSMatthias Ringwald } 804435454696SMatthias Ringwald #endif 80453bc639ceSMatthias Ringwald 804671de195eSMatthias Ringwald void hci_emit_state(void){ 80473a9fb326S[email protected] log_info("BTSTACK_EVENT_STATE %u", hci_stack->state); 8048425d1371Smatthias.ringwald uint8_t event[3]; 804980d52d6bSmatthias.ringwald event[0] = BTSTACK_EVENT_STATE; 80504ea43905SMatthias Ringwald event[1] = sizeof(event) - 2u; 80513a9fb326S[email protected] event[2] = hci_stack->state; 8052d6b06661SMatthias Ringwald hci_emit_event(event, sizeof(event), 1); 8053c8e4258aSmatthias.ringwald } 8054c8e4258aSmatthias.ringwald 805535454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 80562deddeceSMatthias Ringwald static void hci_emit_connection_complete(bd_addr_t address, hci_con_handle_t con_handle, uint8_t status){ 8057425d1371Smatthias.ringwald uint8_t event[13]; 8058c8e4258aSmatthias.ringwald event[0] = HCI_EVENT_CONNECTION_COMPLETE; 8059425d1371Smatthias.ringwald event[1] = sizeof(event) - 2; 806017f1ba2aSmatthias.ringwald event[2] = status; 80612deddeceSMatthias Ringwald little_endian_store_16(event, 3, con_handle); 80622deddeceSMatthias Ringwald reverse_bd_addr(address, &event[5]); 8063c8e4258aSmatthias.ringwald event[11] = 1; // ACL connection 8064c8e4258aSmatthias.ringwald event[12] = 0; // encryption disabled 8065d6b06661SMatthias Ringwald hci_emit_event(event, sizeof(event), 1); 8066c8e4258aSmatthias.ringwald } 806752db98b2SMatthias Ringwald static void hci_emit_l2cap_check_timeout(hci_connection_t *conn){ 806852db98b2SMatthias Ringwald if (disable_l2cap_timeouts) return; 806952db98b2SMatthias Ringwald log_info("L2CAP_EVENT_TIMEOUT_CHECK"); 807052db98b2SMatthias Ringwald uint8_t event[4]; 807152db98b2SMatthias Ringwald event[0] = L2CAP_EVENT_TIMEOUT_CHECK; 807252db98b2SMatthias Ringwald event[1] = sizeof(event) - 2; 807352db98b2SMatthias Ringwald little_endian_store_16(event, 2, conn->con_handle); 807452db98b2SMatthias Ringwald hci_emit_event(event, sizeof(event), 1); 807552db98b2SMatthias Ringwald } 807635454696SMatthias Ringwald #endif 8077c8e4258aSmatthias.ringwald 807835454696SMatthias Ringwald #ifdef ENABLE_BLE 8079d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 8080667ba9d1SMatthias Ringwald static void hci_emit_le_connection_complete(uint8_t address_type, const bd_addr_t address, hci_con_handle_t con_handle, uint8_t status){ 8081ebd1b979SMatthias Ringwald uint8_t hci_event[21]; 8082ebd1b979SMatthias Ringwald hci_event[0] = HCI_EVENT_LE_META; 8083ebd1b979SMatthias Ringwald hci_event[1] = sizeof(hci_event) - 2u; 8084ebd1b979SMatthias Ringwald hci_event[2] = HCI_SUBEVENT_LE_CONNECTION_COMPLETE; 8085ebd1b979SMatthias Ringwald hci_event[3] = status; 8086ebd1b979SMatthias Ringwald little_endian_store_16(hci_event, 4, con_handle); 8087ebd1b979SMatthias Ringwald hci_event[6] = 0; // TODO: role 8088ebd1b979SMatthias Ringwald hci_event[7] = address_type; 8089ebd1b979SMatthias Ringwald reverse_bd_addr(address, &hci_event[8]); 8090ebd1b979SMatthias Ringwald little_endian_store_16(hci_event, 14, 0); // interval 8091ebd1b979SMatthias Ringwald little_endian_store_16(hci_event, 16, 0); // latency 8092ebd1b979SMatthias Ringwald little_endian_store_16(hci_event, 18, 0); // supervision timeout 8093ebd1b979SMatthias Ringwald hci_event[20] = 0; // master clock accuracy 8094ebd1b979SMatthias Ringwald hci_emit_event(hci_event, sizeof(hci_event), 1); 8095ebd1b979SMatthias Ringwald // emit GAP event, too 8096ebd1b979SMatthias Ringwald uint8_t gap_event[36]; 8097ebd1b979SMatthias Ringwald hci_create_gap_connection_complete_event(hci_event, gap_event); 8098ebd1b979SMatthias Ringwald hci_emit_event(gap_event, sizeof(gap_event), 1); 80994f3229d8S[email protected] } 810035454696SMatthias Ringwald #endif 8101d70217a2SMatthias Ringwald #endif 81024f3229d8S[email protected] 8103fd43c0e0SMatthias Ringwald static void hci_emit_transport_packet_sent(void){ 8104fd43c0e0SMatthias Ringwald // notify upper stack that it might be possible to send again 8105fd43c0e0SMatthias Ringwald uint8_t event[] = { HCI_EVENT_TRANSPORT_PACKET_SENT, 0}; 8106fd43c0e0SMatthias Ringwald hci_emit_event(&event[0], sizeof(event), 0); // don't dump 8107fd43c0e0SMatthias Ringwald } 8108fd43c0e0SMatthias Ringwald 8109fc64f94aSMatthias Ringwald static void hci_emit_disconnection_complete(hci_con_handle_t con_handle, uint8_t reason){ 8110425d1371Smatthias.ringwald uint8_t event[6]; 81113c4d4b90Smatthias.ringwald event[0] = HCI_EVENT_DISCONNECTION_COMPLETE; 81124ea43905SMatthias Ringwald event[1] = sizeof(event) - 2u; 81133c4d4b90Smatthias.ringwald event[2] = 0; // status = OK 8114fc64f94aSMatthias Ringwald little_endian_store_16(event, 3, con_handle); 81153c4d4b90Smatthias.ringwald event[5] = reason; 8116d6b06661SMatthias Ringwald hci_emit_event(event, sizeof(event), 1); 81173c4d4b90Smatthias.ringwald } 81183c4d4b90Smatthias.ringwald 8119b83d5eabSMatthias Ringwald static void hci_emit_nr_connections_changed(void){ 8120e0abb8e7S[email protected] log_info("BTSTACK_EVENT_NR_CONNECTIONS_CHANGED %u", nr_hci_connections()); 8121425d1371Smatthias.ringwald uint8_t event[3]; 812280d52d6bSmatthias.ringwald event[0] = BTSTACK_EVENT_NR_CONNECTIONS_CHANGED; 81234ea43905SMatthias Ringwald event[1] = sizeof(event) - 2u; 812443bfb1bdSmatthias.ringwald event[2] = nr_hci_connections(); 8125d6b06661SMatthias Ringwald hci_emit_event(event, sizeof(event), 1); 812643bfb1bdSmatthias.ringwald } 8127038bc64cSmatthias.ringwald 8128b83d5eabSMatthias Ringwald static void hci_emit_hci_open_failed(void){ 8129e0abb8e7S[email protected] log_info("BTSTACK_EVENT_POWERON_FAILED"); 8130425d1371Smatthias.ringwald uint8_t event[2]; 813180d52d6bSmatthias.ringwald event[0] = BTSTACK_EVENT_POWERON_FAILED; 81324ea43905SMatthias Ringwald event[1] = sizeof(event) - 2u; 8133d6b06661SMatthias Ringwald hci_emit_event(event, sizeof(event), 1); 8134038bc64cSmatthias.ringwald } 81351b0e3922Smatthias.ringwald 813635454696SMatthias Ringwald static void hci_emit_dedicated_bonding_result(bd_addr_t address, uint8_t status){ 813735454696SMatthias Ringwald log_info("hci_emit_dedicated_bonding_result %u ", status); 813835454696SMatthias Ringwald uint8_t event[9]; 813935454696SMatthias Ringwald int pos = 0; 814035454696SMatthias Ringwald event[pos++] = GAP_EVENT_DEDICATED_BONDING_COMPLETED; 81414ea43905SMatthias Ringwald event[pos++] = sizeof(event) - 2u; 814235454696SMatthias Ringwald event[pos++] = status; 814335454696SMatthias Ringwald reverse_bd_addr(address, &event[pos]); 8144d6b06661SMatthias Ringwald hci_emit_event(event, sizeof(event), 1); 8145381fbed8Smatthias.ringwald } 8146458bf4e8S[email protected] 814735454696SMatthias Ringwald 814835454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 814935454696SMatthias Ringwald 8150b83d5eabSMatthias Ringwald static void hci_emit_security_level(hci_con_handle_t con_handle, gap_security_level_t level){ 8151df3354fcS[email protected] log_info("hci_emit_security_level %u for handle %x", level, con_handle); 8152a00031e2S[email protected] uint8_t event[5]; 8153e00caf9cS[email protected] int pos = 0; 81545611a760SMatthias Ringwald event[pos++] = GAP_EVENT_SECURITY_LEVEL; 8155e00caf9cS[email protected] event[pos++] = sizeof(event) - 2; 8156f8fbdce0SMatthias Ringwald little_endian_store_16(event, 2, con_handle); 8157e00caf9cS[email protected] pos += 2; 8158e00caf9cS[email protected] event[pos++] = level; 8159d6b06661SMatthias Ringwald hci_emit_event(event, sizeof(event), 1); 8160e00caf9cS[email protected] } 8161e00caf9cS[email protected] 816235454696SMatthias Ringwald static gap_security_level_t gap_security_level_for_connection(hci_connection_t * connection){ 816335454696SMatthias Ringwald if (!connection) return LEVEL_0; 81648daf94bcSMatthias Ringwald if ((connection->authentication_flags & AUTH_FLAG_CONNECTION_ENCRYPTED) == 0) return LEVEL_0; 8165fcaf38b9SMatthias Ringwald // BIAS: we only consider Authenticated if the connection is already encrypted, which requires that both sides have link key 81668daf94bcSMatthias Ringwald if ((connection->authentication_flags & AUTH_FLAG_CONNECTION_AUTHENTICATED) == 0) return LEVEL_0; 8167170fafaeSMatthias Ringwald if (connection->encryption_key_size < hci_stack->gap_required_encyrption_key_size) return LEVEL_0; 81684051b7ffSMatthias Ringwald gap_security_level_t security_level = gap_security_level_for_link_key_type(connection->link_key_type); 8169170fafaeSMatthias Ringwald // LEVEL 4 always requires 128 bit encrytion key size 81700e588213SMatthias Ringwald if ((security_level == LEVEL_4) && (connection->encryption_key_size < 16)){ 8171170fafaeSMatthias Ringwald security_level = LEVEL_3; 8172170fafaeSMatthias Ringwald } 8173170fafaeSMatthias Ringwald return security_level; 817435454696SMatthias Ringwald } 817535454696SMatthias Ringwald 817671fd255dSMatthias Ringwald static void hci_emit_scan_mode_changed(uint8_t discoverable, uint8_t connectable){ 817771fd255dSMatthias Ringwald uint8_t event[4]; 817871fd255dSMatthias Ringwald event[0] = BTSTACK_EVENT_SCAN_MODE_CHANGED; 817935454696SMatthias Ringwald event[1] = sizeof(event) - 2; 818071fd255dSMatthias Ringwald event[2] = discoverable; 818171fd255dSMatthias Ringwald event[3] = connectable; 8182d6b06661SMatthias Ringwald hci_emit_event(event, sizeof(event), 1); 8183ad83dc6aS[email protected] } 8184ad83dc6aS[email protected] 818598a2fd1cSMatthias Ringwald // query if remote side supports eSCO 818620dcdd22SMatthias Ringwald bool hci_remote_esco_supported(hci_con_handle_t con_handle){ 818798a2fd1cSMatthias Ringwald hci_connection_t * connection = hci_connection_for_handle(con_handle); 818820dcdd22SMatthias Ringwald if (!connection) return false; 818976ccfb2aSMatthias Ringwald return (connection->remote_supported_features[0] & 1) != 0; 819098a2fd1cSMatthias Ringwald } 819198a2fd1cSMatthias Ringwald 81920b78a447SMatthias Ringwald uint16_t hci_remote_sco_packet_types(hci_con_handle_t con_handle){ 81930b78a447SMatthias Ringwald hci_connection_t * connection = hci_connection_for_handle(con_handle); 81940b78a447SMatthias Ringwald if (!connection) return 0; 81950b78a447SMatthias Ringwald return connection->remote_supported_sco_packets; 81960b78a447SMatthias Ringwald } 81970b78a447SMatthias Ringwald 819867aae551SMatthias Ringwald static bool hci_ssp_supported(hci_connection_t * connection){ 819967aae551SMatthias Ringwald const uint8_t mask = BONDING_REMOTE_SUPPORTS_SSP_CONTROLLER | BONDING_REMOTE_SUPPORTS_SSP_HOST; 820067aae551SMatthias Ringwald return (connection->bonding_flags & mask) == mask; 820167aae551SMatthias Ringwald } 820267aae551SMatthias Ringwald 82032bd8b7e7S[email protected] // query if remote side supports SSP 820420dcdd22SMatthias Ringwald bool hci_remote_ssp_supported(hci_con_handle_t con_handle){ 82052bd8b7e7S[email protected] hci_connection_t * connection = hci_connection_for_handle(con_handle); 820620dcdd22SMatthias Ringwald if (!connection) return false; 820767aae551SMatthias Ringwald return hci_ssp_supported(connection) ? 1 : 0; 82082bd8b7e7S[email protected] } 82092bd8b7e7S[email protected] 821020dcdd22SMatthias Ringwald bool gap_ssp_supported_on_both_sides(hci_con_handle_t handle){ 8211df3354fcS[email protected] return hci_local_ssp_activated() && hci_remote_ssp_supported(handle); 8212df3354fcS[email protected] } 8213df3354fcS[email protected] 82146ffc78ceSMatthias Ringwald /** 82156ffc78ceSMatthias Ringwald * Check if remote supported features query has completed 82166ffc78ceSMatthias Ringwald */ 82176ffc78ceSMatthias Ringwald bool hci_remote_features_available(hci_con_handle_t handle){ 82186ffc78ceSMatthias Ringwald hci_connection_t * connection = hci_connection_for_handle(handle); 82196ffc78ceSMatthias Ringwald if (!connection) return false; 82206ffc78ceSMatthias Ringwald return (connection->bonding_flags & BONDING_RECEIVED_REMOTE_FEATURES) != 0; 82216ffc78ceSMatthias Ringwald } 82226ffc78ceSMatthias Ringwald 8223d6596031SMatthias Ringwald /** 8224d6596031SMatthias Ringwald * Trigger remote supported features query 8225d6596031SMatthias Ringwald */ 8226c9742cd1SMatthias Ringwald 8227c9742cd1SMatthias Ringwald static void hci_trigger_remote_features_for_connection(hci_connection_t * connection){ 8228c9742cd1SMatthias Ringwald if ((connection->bonding_flags & (BONDING_REMOTE_FEATURES_QUERY_ACTIVE | BONDING_RECEIVED_REMOTE_FEATURES)) == 0){ 8229c9742cd1SMatthias Ringwald connection->bonding_flags |= BONDING_REMOTE_FEATURES_QUERY_ACTIVE | BONDING_REQUEST_REMOTE_FEATURES_PAGE_0; 8230c9742cd1SMatthias Ringwald } 8231c9742cd1SMatthias Ringwald } 8232c9742cd1SMatthias Ringwald 8233d6596031SMatthias Ringwald void hci_remote_features_query(hci_con_handle_t con_handle){ 8234d6596031SMatthias Ringwald hci_connection_t * connection = hci_connection_for_handle(con_handle); 8235d6596031SMatthias Ringwald if (!connection) return; 8236c9742cd1SMatthias Ringwald hci_trigger_remote_features_for_connection(connection); 8237d6596031SMatthias Ringwald hci_run(); 8238d6596031SMatthias Ringwald } 8239d6596031SMatthias Ringwald 8240458bf4e8S[email protected] // GAP API 8241458bf4e8S[email protected] /** 8242458bf4e8S[email protected] * @bbrief enable/disable bonding. default is enabled 8243458bf4e8S[email protected] * @praram enabled 8244458bf4e8S[email protected] */ 82454c57c146S[email protected] void gap_set_bondable_mode(int enable){ 82463a9fb326S[email protected] hci_stack->bondable = enable ? 1 : 0; 8247458bf4e8S[email protected] } 82484ef6443cSMatthias Ringwald /** 82494ef6443cSMatthias Ringwald * @brief Get bondable mode. 82504ef6443cSMatthias Ringwald * @return 1 if bondable 82514ef6443cSMatthias Ringwald */ 82524ef6443cSMatthias Ringwald int gap_get_bondable_mode(void){ 82534ef6443cSMatthias Ringwald return hci_stack->bondable; 82544ef6443cSMatthias Ringwald } 8255cb230b9dS[email protected] 8256cb230b9dS[email protected] /** 825734d2123cS[email protected] * @brief map link keys to security levels 8258cb230b9dS[email protected] */ 825934d2123cS[email protected] gap_security_level_t gap_security_level_for_link_key_type(link_key_type_t link_key_type){ 826034d2123cS[email protected] switch (link_key_type){ 82613c68dfa9S[email protected] case AUTHENTICATED_COMBINATION_KEY_GENERATED_FROM_P256: 82623c68dfa9S[email protected] return LEVEL_4; 82633c68dfa9S[email protected] case COMBINATION_KEY: 82643c68dfa9S[email protected] case AUTHENTICATED_COMBINATION_KEY_GENERATED_FROM_P192: 82653c68dfa9S[email protected] return LEVEL_3; 82663c68dfa9S[email protected] default: 82673c68dfa9S[email protected] return LEVEL_2; 82683c68dfa9S[email protected] } 8269cb230b9dS[email protected] } 8270cb230b9dS[email protected] 82718b35e16aSMatthias Ringwald /** 82728b35e16aSMatthias Ringwald * @brief map link keys to secure connection yes/no 82738b35e16aSMatthias Ringwald */ 827436c3546bSMatthias Ringwald bool gap_secure_connection_for_link_key_type(link_key_type_t link_key_type){ 82758b35e16aSMatthias Ringwald switch (link_key_type){ 82768b35e16aSMatthias Ringwald case AUTHENTICATED_COMBINATION_KEY_GENERATED_FROM_P256: 82778b35e16aSMatthias Ringwald case UNAUTHENTICATED_COMBINATION_KEY_GENERATED_FROM_P256: 827836c3546bSMatthias Ringwald return true; 82798b35e16aSMatthias Ringwald default: 828036c3546bSMatthias Ringwald return false; 82818b35e16aSMatthias Ringwald } 82828b35e16aSMatthias Ringwald } 82838b35e16aSMatthias Ringwald 82848b35e16aSMatthias Ringwald /** 82858b35e16aSMatthias Ringwald * @brief map link keys to authenticated 82868b35e16aSMatthias Ringwald */ 82877040ba26SMatthias Ringwald bool gap_authenticated_for_link_key_type(link_key_type_t link_key_type){ 82888b35e16aSMatthias Ringwald switch (link_key_type){ 82898b35e16aSMatthias Ringwald case AUTHENTICATED_COMBINATION_KEY_GENERATED_FROM_P256: 82908b35e16aSMatthias Ringwald case AUTHENTICATED_COMBINATION_KEY_GENERATED_FROM_P192: 82917040ba26SMatthias Ringwald return true; 82928b35e16aSMatthias Ringwald default: 82937040ba26SMatthias Ringwald return false; 82948b35e16aSMatthias Ringwald } 82958b35e16aSMatthias Ringwald } 82968b35e16aSMatthias Ringwald 8297552b9260SMatthias Ringwald bool gap_mitm_protection_required_for_security_level(gap_security_level_t level){ 82985127cc62S[email protected] log_info("gap_mitm_protection_required_for_security_level %u", level); 8299106d6d11S[email protected] return level > LEVEL_2; 8300106d6d11S[email protected] } 8301106d6d11S[email protected] 830234d2123cS[email protected] /** 830334d2123cS[email protected] * @brief get current security level 830434d2123cS[email protected] */ 830534d2123cS[email protected] gap_security_level_t gap_security_level(hci_con_handle_t con_handle){ 830634d2123cS[email protected] hci_connection_t * connection = hci_connection_for_handle(con_handle); 830734d2123cS[email protected] if (!connection) return LEVEL_0; 830834d2123cS[email protected] return gap_security_level_for_connection(connection); 830934d2123cS[email protected] } 831034d2123cS[email protected] 8311cb230b9dS[email protected] /** 8312cb230b9dS[email protected] * @brief request connection to device to 8313cb230b9dS[email protected] * @result GAP_AUTHENTICATION_RESULT 8314cb230b9dS[email protected] */ 831534d2123cS[email protected] void gap_request_security_level(hci_con_handle_t con_handle, gap_security_level_t requested_level){ 831634d2123cS[email protected] hci_connection_t * connection = hci_connection_for_handle(con_handle); 831734d2123cS[email protected] if (!connection){ 8318a00031e2S[email protected] hci_emit_security_level(con_handle, LEVEL_0); 831934d2123cS[email protected] return; 832034d2123cS[email protected] } 8321defbf200SMatthias Ringwald 8322defbf200SMatthias Ringwald btstack_assert(hci_is_le_connection(connection) == false); 8323defbf200SMatthias Ringwald 8324bc00e12cSMatthias Ringwald // Core Spec 5.2, GAP 5.2.2: "When in Secure Connections Only mode, all services (except those allowed to have Security Mode 4, Level 0) 8325bc00e12cSMatthias Ringwald // available on the BR/EDR physical transport require Security Mode 4, Level 4 " 8326bc00e12cSMatthias Ringwald if (hci_stack->gap_secure_connections_only_mode && (requested_level != LEVEL_0)){ 8327bc00e12cSMatthias Ringwald requested_level = LEVEL_4; 8328bc00e12cSMatthias Ringwald } 8329bc00e12cSMatthias Ringwald 833034d2123cS[email protected] gap_security_level_t current_level = gap_security_level(con_handle); 833183d08d7cSMatthias Ringwald log_info("gap_request_security_level requested level %u, planned level %u, current level %u", 833283d08d7cSMatthias Ringwald requested_level, connection->requested_security_level, current_level); 833383d08d7cSMatthias Ringwald 8334dbd5dcc3SMatthias Ringwald // authentication active if authentication request was sent or planned level > 0 8335dbd5dcc3SMatthias Ringwald bool authentication_active = ((connection->bonding_flags & BONDING_SENT_AUTHENTICATE_REQUEST) != 0) || (connection->requested_security_level > LEVEL_0); 8336dbd5dcc3SMatthias Ringwald if (authentication_active){ 83371cf0a6c8SMatthias Ringwald // authentication already active 833883d08d7cSMatthias Ringwald if (connection->requested_security_level < requested_level){ 833983d08d7cSMatthias Ringwald // increase requested level as new level is higher 834083d08d7cSMatthias Ringwald // TODO: handle re-authentication when done 834183d08d7cSMatthias Ringwald connection->requested_security_level = requested_level; 834283d08d7cSMatthias Ringwald } 83431cf0a6c8SMatthias Ringwald } else { 834483d08d7cSMatthias Ringwald // no request active, notify if security sufficient 834583d08d7cSMatthias Ringwald if (requested_level <= current_level){ 8346a00031e2S[email protected] hci_emit_security_level(con_handle, current_level); 834734d2123cS[email protected] return; 834834d2123cS[email protected] } 8349a00031e2S[email protected] 8350e060c07dSMatthias Ringwald // store request 835134d2123cS[email protected] connection->requested_security_level = requested_level; 8352a00031e2S[email protected] 83531cf0a6c8SMatthias Ringwald // start to authenticate connection 83541eb2563eS[email protected] connection->bonding_flags |= BONDING_SEND_AUTHENTICATE_REQUEST; 83557fdbaf79SMatthias Ringwald 83567fdbaf79SMatthias Ringwald // request remote features if not already active, also trigger hci_run 83577fdbaf79SMatthias Ringwald hci_remote_features_query(con_handle); 8358e00caf9cS[email protected] } 83591cf0a6c8SMatthias Ringwald } 8360ad83dc6aS[email protected] 8361ad83dc6aS[email protected] /** 8362ad83dc6aS[email protected] * @brief start dedicated bonding with device. disconnect after bonding 8363ad83dc6aS[email protected] * @param device 8364ad83dc6aS[email protected] * @param request MITM protection 8365ad83dc6aS[email protected] * @result GAP_DEDICATED_BONDING_COMPLETE 8366ad83dc6aS[email protected] */ 8367ad83dc6aS[email protected] int gap_dedicated_bonding(bd_addr_t device, int mitm_protection_required){ 8368ad83dc6aS[email protected] 8369ad83dc6aS[email protected] // create connection state machine 837088f925b1SMatthias Ringwald hci_connection_t * connection = create_connection_for_bd_addr_and_type(device, BD_ADDR_TYPE_ACL, HCI_ROLE_MASTER); 8371ad83dc6aS[email protected] 8372ad83dc6aS[email protected] if (!connection){ 8373ad83dc6aS[email protected] return BTSTACK_MEMORY_ALLOC_FAILED; 8374ad83dc6aS[email protected] } 8375ad83dc6aS[email protected] 83764cd03f8aSMatthias Ringwald // delete link key 837715a95bd5SMatthias Ringwald gap_drop_link_key_for_bd_addr(device); 8378ad83dc6aS[email protected] 8379ad83dc6aS[email protected] // configure LEVEL_2/3, dedicated bonding 8380ad83dc6aS[email protected] connection->state = SEND_CREATE_CONNECTION; 8381ad83dc6aS[email protected] connection->requested_security_level = mitm_protection_required ? LEVEL_3 : LEVEL_2; 8382f04a0c31SMatthias Ringwald log_info("gap_dedicated_bonding, mitm %d -> level %u", mitm_protection_required, connection->requested_security_level); 8383ad83dc6aS[email protected] connection->bonding_flags = BONDING_DEDICATED; 8384ad83dc6aS[email protected] 8385ad83dc6aS[email protected] hci_run(); 8386ad83dc6aS[email protected] 8387ad83dc6aS[email protected] return 0; 8388ad83dc6aS[email protected] } 83898e618f72S[email protected] 8390f82b8f4bSMatthias Ringwald uint8_t hci_dedicated_bonding_defer_disconnect(hci_con_handle_t con_handle, bool defer){ 8391ab0c69a9SMatthias Ringwald hci_connection_t * connection = hci_connection_for_handle(con_handle); 8392ab0c69a9SMatthias Ringwald if (connection == NULL){ 8393ab0c69a9SMatthias Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 8394ab0c69a9SMatthias Ringwald } 8395ab0c69a9SMatthias Ringwald if (defer){ 8396ab0c69a9SMatthias Ringwald connection->bonding_flags |= BONDING_DEDICATED_DEFER_DISCONNECT; 8397ab0c69a9SMatthias Ringwald } else { 8398ab0c69a9SMatthias Ringwald connection->bonding_flags &= ~BONDING_DEDICATED_DEFER_DISCONNECT; 8399ab0c69a9SMatthias Ringwald // trigger disconnect 8400ab0c69a9SMatthias Ringwald hci_run(); 8401ab0c69a9SMatthias Ringwald } 8402ab0c69a9SMatthias Ringwald return ERROR_CODE_SUCCESS; 8403ab0c69a9SMatthias Ringwald } 8404ab0c69a9SMatthias Ringwald 84058e618f72S[email protected] void gap_set_local_name(const char * local_name){ 84068e618f72S[email protected] hci_stack->local_name = local_name; 8407baa4881eSMatthias Ringwald hci_stack->gap_tasks_classic |= GAP_TASK_SET_LOCAL_NAME; 840859d59ecfSMatthias Ringwald // also update EIR if not set by user 840959d59ecfSMatthias Ringwald if (hci_stack->eir_data == NULL){ 8410baa4881eSMatthias Ringwald hci_stack->gap_tasks_classic |= GAP_TASK_SET_EIR_DATA; 841159d59ecfSMatthias Ringwald } 841259d59ecfSMatthias Ringwald hci_run(); 84138e618f72S[email protected] } 84141aeec2ebSMatthias Ringwald #endif 84158e618f72S[email protected] 841635454696SMatthias Ringwald 841735454696SMatthias Ringwald #ifdef ENABLE_BLE 841835454696SMatthias Ringwald 8419d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 8420d8e8f12aSMatthias Ringwald void gap_start_scan(void){ 8421fde725feSMatthias Ringwald hci_stack->le_scanning_enabled = true; 84227bdc6798S[email protected] hci_run(); 84237bdc6798S[email protected] } 84248e618f72S[email protected] 8425d8e8f12aSMatthias Ringwald void gap_stop_scan(void){ 8426fde725feSMatthias Ringwald hci_stack->le_scanning_enabled = false; 84277bdc6798S[email protected] hci_run(); 84287bdc6798S[email protected] } 84294f3229d8S[email protected] 8430a7a719e9SMatthias Ringwald void gap_set_scan_params(uint8_t scan_type, uint16_t scan_interval, uint16_t scan_window, uint8_t scanning_filter_policy){ 8431ef11999fSmatthias.ringwald hci_stack->le_scan_type = scan_type; 8432a7a719e9SMatthias Ringwald hci_stack->le_scan_filter_policy = scanning_filter_policy; 8433ef11999fSmatthias.ringwald hci_stack->le_scan_interval = scan_interval; 8434ef11999fSmatthias.ringwald hci_stack->le_scan_window = scan_window; 84358b69e4c7SMatthias Ringwald hci_stack->le_scanning_param_update = true; 8436ef11999fSmatthias.ringwald hci_run(); 8437ef11999fSmatthias.ringwald } 84384f3229d8S[email protected] 8439a7a719e9SMatthias Ringwald void gap_set_scan_parameters(uint8_t scan_type, uint16_t scan_interval, uint16_t scan_window){ 8440a7a719e9SMatthias Ringwald gap_set_scan_params(scan_type, scan_interval, scan_window, 0); 8441a7a719e9SMatthias Ringwald } 8442a7a719e9SMatthias Ringwald 84434856283bSMatthias Ringwald void gap_set_scan_duplicate_filter(bool enabled){ 84444856283bSMatthias Ringwald hci_stack->le_scan_filter_duplicates = enabled ? 1 : 0; 84454856283bSMatthias Ringwald } 84464856283bSMatthias Ringwald 84477eb5b27eSMatthias Ringwald void gap_set_scan_phys(uint8_t phys){ 84487eb5b27eSMatthias Ringwald // LE Coded and LE 1M PHY 84497eb5b27eSMatthias Ringwald hci_stack->le_scan_phys = phys & 0x05; 84507eb5b27eSMatthias Ringwald } 84517eb5b27eSMatthias Ringwald 8452667ba9d1SMatthias Ringwald uint8_t gap_connect(const bd_addr_t addr, bd_addr_type_t addr_type) { 84539cb52963SMatthias Ringwald // disallow le connection if outgoing already active 8454d32b3f05SMatthias Ringwald if (hci_is_le_connection_type(addr_type) && hci_stack->le_connecting_request != LE_CONNECTING_IDLE){ 84559cb52963SMatthias Ringwald log_error("le connect already active"); 8456d32b3f05SMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 8457d32b3f05SMatthias Ringwald } 8458d32b3f05SMatthias Ringwald 84599cb52963SMatthias Ringwald hci_connection_t * conn = hci_connection_for_bd_addr_and_type(addr, addr_type); 84609cb52963SMatthias Ringwald if (conn == NULL) { 846188f925b1SMatthias Ringwald conn = create_connection_for_bd_addr_and_type(addr, addr_type, HCI_ROLE_MASTER); 84629cb52963SMatthias Ringwald if (conn == false){ 84639cb52963SMatthias Ringwald // alloc failed 8464d8e8f12aSMatthias Ringwald log_info("gap_connect: failed to alloc hci_connection_t"); 84659cb52963SMatthias Ringwald return BTSTACK_MEMORY_ALLOC_FAILED; 84669cb52963SMatthias Ringwald } 84679cb52963SMatthias Ringwald } else { 84689cb52963SMatthias Ringwald switch (conn->state) { 84699cb52963SMatthias Ringwald case RECEIVED_DISCONNECTION_COMPLETE: 84709cb52963SMatthias Ringwald // connection was just disconnected, reset state and allow re-connect 84719cb52963SMatthias Ringwald conn->role = HCI_ROLE_MASTER; 84729cb52963SMatthias Ringwald break; 84739cb52963SMatthias Ringwald default: 84749cb52963SMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 84759cb52963SMatthias Ringwald } 84764f3229d8S[email protected] } 8477d5b1a89eSMatthias Ringwald 8478d5b1a89eSMatthias Ringwald // set le connecting state 8479d5b1a89eSMatthias Ringwald if (hci_is_le_connection_type(addr_type)){ 8480d5b1a89eSMatthias Ringwald hci_stack->le_connecting_request = LE_CONNECTING_DIRECT; 8481d5b1a89eSMatthias Ringwald } 8482d5b1a89eSMatthias Ringwald 84839cb52963SMatthias Ringwald // trigger connect 8484d8e8f12aSMatthias Ringwald log_info("gap_connect: send create connection next"); 8485b0136355SMatthias Ringwald conn->state = SEND_CREATE_CONNECTION; 8486b0136355SMatthias Ringwald hci_run(); 8487b0136355SMatthias Ringwald return ERROR_CODE_SUCCESS; 8488b0136355SMatthias Ringwald } 8489b0136355SMatthias Ringwald 84907851196eSmatthias.ringwald // @assumption: only a single outgoing LE Connection exists 8491ca0d6e5aSMatthias Ringwald static hci_connection_t * gap_get_outgoing_le_connection(void){ 8492665d90f2SMatthias Ringwald btstack_linked_item_t *it; 8493a0da043fSMatthias Ringwald for (it = (btstack_linked_item_t *) hci_stack->connections; it != NULL; it = it->next){ 84940bf6344aS[email protected] hci_connection_t * conn = (hci_connection_t *) it; 8495ca0d6e5aSMatthias Ringwald if (hci_is_le_connection(conn)){ 84960bf6344aS[email protected] switch (conn->state){ 8497a6725849S[email protected] case SEND_CREATE_CONNECTION: 84987851196eSmatthias.ringwald case SENT_CREATE_CONNECTION: 84997851196eSmatthias.ringwald return conn; 85007851196eSmatthias.ringwald default: 85017851196eSmatthias.ringwald break; 85027851196eSmatthias.ringwald }; 85037851196eSmatthias.ringwald } 8504ca0d6e5aSMatthias Ringwald } 85057851196eSmatthias.ringwald return NULL; 85067851196eSmatthias.ringwald } 85077851196eSmatthias.ringwald 8508d8e8f12aSMatthias Ringwald uint8_t gap_connect_cancel(void){ 850914f2d8f0SMatthias Ringwald hci_connection_t * conn; 851014f2d8f0SMatthias Ringwald switch (hci_stack->le_connecting_request){ 851114f2d8f0SMatthias Ringwald case LE_CONNECTING_IDLE: 851214f2d8f0SMatthias Ringwald break; 851314f2d8f0SMatthias Ringwald case LE_CONNECTING_WHITELIST: 851414f2d8f0SMatthias Ringwald hci_stack->le_connecting_request = LE_CONNECTING_IDLE; 851514f2d8f0SMatthias Ringwald hci_run(); 851614f2d8f0SMatthias Ringwald break; 851714f2d8f0SMatthias Ringwald case LE_CONNECTING_DIRECT: 851814f2d8f0SMatthias Ringwald hci_stack->le_connecting_request = LE_CONNECTING_IDLE; 8519ca0d6e5aSMatthias Ringwald conn = gap_get_outgoing_le_connection(); 852014f2d8f0SMatthias Ringwald if (conn == NULL){ 852114f2d8f0SMatthias Ringwald hci_run(); 852214f2d8f0SMatthias Ringwald } else { 85237851196eSmatthias.ringwald switch (conn->state){ 85247851196eSmatthias.ringwald case SEND_CREATE_CONNECTION: 85257851196eSmatthias.ringwald // skip sending create connection and emit event instead 85262e77e513S[email protected] hci_emit_le_connection_complete(conn->address_type, conn->address, 0, ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER); 8527665d90f2SMatthias Ringwald btstack_linked_list_remove(&hci_stack->connections, (btstack_linked_item_t *) conn); 85287851196eSmatthias.ringwald btstack_memory_hci_connection_free( conn ); 85290bf6344aS[email protected] break; 8530a6725849S[email protected] case SENT_CREATE_CONNECTION: 8531ea04fbd8SMatthias Ringwald // let hci_run_general_gap_le cancel outgoing connection 85320bf6344aS[email protected] hci_run(); 85330bf6344aS[email protected] break; 85340bf6344aS[email protected] default: 85350bf6344aS[email protected] break; 85360bf6344aS[email protected] } 853714f2d8f0SMatthias Ringwald } 853814f2d8f0SMatthias Ringwald break; 853943dfd98aSMatthias Ringwald default: 854014f2d8f0SMatthias Ringwald btstack_unreachable(); 854114f2d8f0SMatthias Ringwald break; 854214f2d8f0SMatthias Ringwald } 854314f2d8f0SMatthias Ringwald return ERROR_CODE_SUCCESS; 8544e31f89a7S[email protected] } 85454f3229d8S[email protected] 8546c37a3166S[email protected] /** 85476012052bSMatthias Ringwald * @brief Set connection parameters for outgoing connections 8548cbe54ab2SJakob Krantz * @param conn_scan_interval (unit: 0.625 msec), default: 60 ms 8549cbe54ab2SJakob Krantz * @param conn_scan_window (unit: 0.625 msec), default: 30 ms 85506012052bSMatthias Ringwald * @param conn_interval_min (unit: 1.25ms), default: 10 ms 85516012052bSMatthias Ringwald * @param conn_interval_max (unit: 1.25ms), default: 30 ms 85526012052bSMatthias Ringwald * @param conn_latency, default: 4 85536012052bSMatthias Ringwald * @param supervision_timeout (unit: 10ms), default: 720 ms 85546012052bSMatthias Ringwald * @param min_ce_length (unit: 0.625ms), default: 10 ms 85556012052bSMatthias Ringwald * @param max_ce_length (unit: 0.625ms), default: 30 ms 85566012052bSMatthias Ringwald */ 85576012052bSMatthias Ringwald 85580c2c5f79SMatthias Ringwald void gap_set_connection_phys(uint8_t phys){ 85590c2c5f79SMatthias Ringwald // LE Coded, LE 1M, LE 2M PHY 85600c2c5f79SMatthias Ringwald hci_stack->le_connection_phys = phys & 7; 85610c2c5f79SMatthias Ringwald } 85620c2c5f79SMatthias Ringwald 85630c2c5f79SMatthias Ringwald #endif 85640c2c5f79SMatthias Ringwald 8565cbe54ab2SJakob Krantz void gap_set_connection_parameters(uint16_t conn_scan_interval, uint16_t conn_scan_window, 8566cbe54ab2SJakob Krantz uint16_t conn_interval_min, uint16_t conn_interval_max, uint16_t conn_latency, 8567cbe54ab2SJakob Krantz uint16_t supervision_timeout, uint16_t min_ce_length, uint16_t max_ce_length){ 8568cbe54ab2SJakob Krantz hci_stack->le_connection_scan_interval = conn_scan_interval; 8569cbe54ab2SJakob Krantz hci_stack->le_connection_scan_window = conn_scan_window; 85706012052bSMatthias Ringwald hci_stack->le_connection_interval_min = conn_interval_min; 85716012052bSMatthias Ringwald hci_stack->le_connection_interval_max = conn_interval_max; 85726012052bSMatthias Ringwald hci_stack->le_connection_latency = conn_latency; 85736012052bSMatthias Ringwald hci_stack->le_supervision_timeout = supervision_timeout; 85746012052bSMatthias Ringwald hci_stack->le_minimum_ce_length = min_ce_length; 85756012052bSMatthias Ringwald hci_stack->le_maximum_ce_length = max_ce_length; 85766012052bSMatthias Ringwald } 85777eb5b27eSMatthias Ringwald 85786012052bSMatthias Ringwald /** 8579c37a3166S[email protected] * @brief Updates the connection parameters for a given LE connection 8580c37a3166S[email protected] * @param handle 8581c37a3166S[email protected] * @param conn_interval_min (unit: 1.25ms) 8582c37a3166S[email protected] * @param conn_interval_max (unit: 1.25ms) 8583c37a3166S[email protected] * @param conn_latency 8584c37a3166S[email protected] * @param supervision_timeout (unit: 10ms) 85856b65794dSMilanka Ringwald * @return 0 if ok 8586c37a3166S[email protected] */ 8587c37a3166S[email protected] int gap_update_connection_parameters(hci_con_handle_t con_handle, uint16_t conn_interval_min, 8588c37a3166S[email protected] uint16_t conn_interval_max, uint16_t conn_latency, uint16_t supervision_timeout){ 8589c37a3166S[email protected] hci_connection_t * connection = hci_connection_for_handle(con_handle); 8590c37a3166S[email protected] if (!connection) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 8591c37a3166S[email protected] connection->le_conn_interval_min = conn_interval_min; 8592c37a3166S[email protected] connection->le_conn_interval_max = conn_interval_max; 8593c37a3166S[email protected] connection->le_conn_latency = conn_latency; 8594c37a3166S[email protected] connection->le_supervision_timeout = supervision_timeout; 859584cf6d83SMatthias Ringwald connection->le_con_parameter_update_state = CON_PARAMETER_UPDATE_CHANGE_HCI_CON_PARAMETERS; 8596cfc59f1bSMatthias Ringwald hci_run(); 8597c37a3166S[email protected] return 0; 8598c37a3166S[email protected] } 8599c37a3166S[email protected] 860045c102fdSMatthias Ringwald /** 8601b68d7bc3SMatthias Ringwald * @brief Request an update of the connection parameter for a given LE connection 8602b68d7bc3SMatthias Ringwald * @param handle 8603b68d7bc3SMatthias Ringwald * @param conn_interval_min (unit: 1.25ms) 8604b68d7bc3SMatthias Ringwald * @param conn_interval_max (unit: 1.25ms) 8605b68d7bc3SMatthias Ringwald * @param conn_latency 8606b68d7bc3SMatthias Ringwald * @param supervision_timeout (unit: 10ms) 86076b65794dSMilanka Ringwald * @return 0 if ok 8608b68d7bc3SMatthias Ringwald */ 8609b68d7bc3SMatthias Ringwald int gap_request_connection_parameter_update(hci_con_handle_t con_handle, uint16_t conn_interval_min, 8610b68d7bc3SMatthias Ringwald uint16_t conn_interval_max, uint16_t conn_latency, uint16_t supervision_timeout){ 8611b68d7bc3SMatthias Ringwald hci_connection_t * connection = hci_connection_for_handle(con_handle); 8612b68d7bc3SMatthias Ringwald if (!connection) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 8613b68d7bc3SMatthias Ringwald connection->le_conn_interval_min = conn_interval_min; 8614b68d7bc3SMatthias Ringwald connection->le_conn_interval_max = conn_interval_max; 8615b68d7bc3SMatthias Ringwald connection->le_conn_latency = conn_latency; 8616b68d7bc3SMatthias Ringwald connection->le_supervision_timeout = supervision_timeout; 8617b68d7bc3SMatthias Ringwald connection->le_con_parameter_update_state = CON_PARAMETER_UPDATE_SEND_REQUEST; 861809c9c963SMatthias Ringwald uint8_t l2cap_trigger_run_event[2] = { L2CAP_EVENT_TRIGGER_RUN, 0}; 861909c9c963SMatthias Ringwald hci_emit_event(l2cap_trigger_run_event, sizeof(l2cap_trigger_run_event), 0); 8620b68d7bc3SMatthias Ringwald return 0; 8621b68d7bc3SMatthias Ringwald } 8622b68d7bc3SMatthias Ringwald 8623d70217a2SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 8624d70217a2SMatthias Ringwald 86255e05c0afSMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 86265e05c0afSMatthias Ringwald static void hci_assert_advertisement_set_0_ready(void){ 86275e05c0afSMatthias Ringwald // force advertising set creation for legacy LE Advertising 86285e05c0afSMatthias Ringwald if ((hci_stack->le_advertisements_state & LE_ADVERTISEMENT_STATE_PARAMS_SET) == 0){ 86295e05c0afSMatthias Ringwald hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_SET_PARAMS; 86305e05c0afSMatthias Ringwald } 86315e05c0afSMatthias Ringwald } 86325e05c0afSMatthias Ringwald #endif 86335e05c0afSMatthias Ringwald 8634b68d7bc3SMatthias Ringwald /** 863545c102fdSMatthias Ringwald * @brief Set Advertisement Data 863645c102fdSMatthias Ringwald * @param advertising_data_length 863745c102fdSMatthias Ringwald * @param advertising_data (max 31 octets) 863845c102fdSMatthias Ringwald * @note data is not copied, pointer has to stay valid 863945c102fdSMatthias Ringwald */ 864045c102fdSMatthias Ringwald void gap_advertisements_set_data(uint8_t advertising_data_length, uint8_t * advertising_data){ 864145c102fdSMatthias Ringwald hci_stack->le_advertisements_data_len = advertising_data_length; 864245c102fdSMatthias Ringwald hci_stack->le_advertisements_data = advertising_data; 8643501f56b3SMatthias Ringwald hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_SET_ADV_DATA; 86445e05c0afSMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 86455e05c0afSMatthias Ringwald hci_assert_advertisement_set_0_ready(); 86465e05c0afSMatthias Ringwald #endif 8647bbc366e6SMatthias Ringwald hci_run(); 864845c102fdSMatthias Ringwald } 8649501f56b3SMatthias Ringwald 8650501f56b3SMatthias Ringwald /** 8651501f56b3SMatthias Ringwald * @brief Set Scan Response Data 8652501f56b3SMatthias Ringwald * @param advertising_data_length 8653501f56b3SMatthias Ringwald * @param advertising_data (max 31 octets) 8654501f56b3SMatthias Ringwald * @note data is not copied, pointer has to stay valid 8655501f56b3SMatthias Ringwald */ 8656501f56b3SMatthias Ringwald void gap_scan_response_set_data(uint8_t scan_response_data_length, uint8_t * scan_response_data){ 8657501f56b3SMatthias Ringwald hci_stack->le_scan_response_data_len = scan_response_data_length; 8658501f56b3SMatthias Ringwald hci_stack->le_scan_response_data = scan_response_data; 8659501f56b3SMatthias Ringwald hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_SET_SCAN_DATA; 86605e05c0afSMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 86615e05c0afSMatthias Ringwald hci_assert_advertisement_set_0_ready(); 86625e05c0afSMatthias Ringwald #endif 8663bbc366e6SMatthias Ringwald hci_run(); 866445c102fdSMatthias Ringwald } 866545c102fdSMatthias Ringwald 866645c102fdSMatthias Ringwald /** 866745c102fdSMatthias Ringwald * @brief Set Advertisement Parameters 866845c102fdSMatthias Ringwald * @param adv_int_min 866945c102fdSMatthias Ringwald * @param adv_int_max 867045c102fdSMatthias Ringwald * @param adv_type 867145c102fdSMatthias Ringwald * @param direct_address_type 867245c102fdSMatthias Ringwald * @param direct_address 867345c102fdSMatthias Ringwald * @param channel_map 867445c102fdSMatthias Ringwald * @param filter_policy 867545c102fdSMatthias Ringwald * 867645c102fdSMatthias Ringwald * @note internal use. use gap_advertisements_set_params from gap_le.h instead. 867745c102fdSMatthias Ringwald */ 867845c102fdSMatthias Ringwald void hci_le_advertisements_set_params(uint16_t adv_int_min, uint16_t adv_int_max, uint8_t adv_type, 8679b95a5a35SMatthias Ringwald uint8_t direct_address_typ, bd_addr_t direct_address, 868045c102fdSMatthias Ringwald uint8_t channel_map, uint8_t filter_policy) { 868145c102fdSMatthias Ringwald 868245c102fdSMatthias Ringwald hci_stack->le_advertisements_interval_min = adv_int_min; 868345c102fdSMatthias Ringwald hci_stack->le_advertisements_interval_max = adv_int_max; 868445c102fdSMatthias Ringwald hci_stack->le_advertisements_type = adv_type; 868545c102fdSMatthias Ringwald hci_stack->le_advertisements_direct_address_type = direct_address_typ; 868645c102fdSMatthias Ringwald hci_stack->le_advertisements_channel_map = channel_map; 868745c102fdSMatthias Ringwald hci_stack->le_advertisements_filter_policy = filter_policy; 86886535961aSMatthias Ringwald (void)memcpy(hci_stack->le_advertisements_direct_address, direct_address, 86896535961aSMatthias Ringwald 6); 869045c102fdSMatthias Ringwald 86916bf435a6SMatthias Ringwald hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_SET_PARAMS; 86926bf435a6SMatthias Ringwald hci_stack->le_advertisements_state |= LE_ADVERTISEMENT_STATE_PARAMS_SET; 8693bbc366e6SMatthias Ringwald hci_run(); 869445c102fdSMatthias Ringwald } 869545c102fdSMatthias Ringwald 869645c102fdSMatthias Ringwald /** 869745c102fdSMatthias Ringwald * @brief Enable/Disable Advertisements 869845c102fdSMatthias Ringwald * @param enabled 869945c102fdSMatthias Ringwald */ 870045c102fdSMatthias Ringwald void gap_advertisements_enable(int enabled){ 8701a408e724SMatthias Ringwald if (enabled == 0){ 8702a408e724SMatthias Ringwald hci_stack->le_advertisements_state &= ~LE_ADVERTISEMENT_STATE_ENABLED; 8703a408e724SMatthias Ringwald } else { 8704a408e724SMatthias Ringwald hci_stack->le_advertisements_state |= LE_ADVERTISEMENT_STATE_ENABLED; 8705a408e724SMatthias Ringwald } 8706bbc366e6SMatthias Ringwald hci_update_advertisements_enabled_for_current_roles(); 8707cfc59f1bSMatthias Ringwald hci_run(); 870845c102fdSMatthias Ringwald } 870945c102fdSMatthias Ringwald 8710a5770ecbSMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 8711a5770ecbSMatthias Ringwald static le_advertising_set_t * hci_advertising_set_for_handle(uint8_t advertising_handle){ 8712a5770ecbSMatthias Ringwald btstack_linked_list_iterator_t it; 8713a5770ecbSMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->le_advertising_sets); 8714a5770ecbSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 8715a5770ecbSMatthias Ringwald le_advertising_set_t * item = (le_advertising_set_t *) btstack_linked_list_iterator_next(&it); 8716a5770ecbSMatthias Ringwald if ( item->advertising_handle == advertising_handle ) { 8717a5770ecbSMatthias Ringwald return item; 8718a5770ecbSMatthias Ringwald } 8719a5770ecbSMatthias Ringwald } 8720a5770ecbSMatthias Ringwald return NULL; 8721a5770ecbSMatthias Ringwald } 8722a5770ecbSMatthias Ringwald 87232052d96cSMatthias Ringwald uint8_t gap_extended_advertising_set_resolvable_private_address_update(uint16_t update_s){ 87242052d96cSMatthias Ringwald hci_stack->le_resolvable_private_address_update_s = update_s; 87252052d96cSMatthias Ringwald hci_run(); 87262052d96cSMatthias Ringwald return ERROR_CODE_SUCCESS; 87272052d96cSMatthias Ringwald } 87282052d96cSMatthias Ringwald 8729a5770ecbSMatthias Ringwald uint8_t gap_extended_advertising_setup(le_advertising_set_t * storage, const le_extended_advertising_parameters_t * advertising_parameters, uint8_t * out_advertising_handle){ 8730a5770ecbSMatthias Ringwald // find free advertisement handle 8731a5770ecbSMatthias Ringwald uint8_t advertisement_handle; 8732a5770ecbSMatthias Ringwald for (advertisement_handle = 1; advertisement_handle <= LE_EXTENDED_ADVERTISING_MAX_HANDLE; advertisement_handle++){ 8733a5770ecbSMatthias Ringwald if (hci_advertising_set_for_handle(advertisement_handle) == NULL) break; 8734a5770ecbSMatthias Ringwald } 8735a5770ecbSMatthias Ringwald if (advertisement_handle > LE_EXTENDED_ADVERTISING_MAX_HANDLE) return ERROR_CODE_MEMORY_CAPACITY_EXCEEDED; 8736a5770ecbSMatthias Ringwald // clear 8737a5770ecbSMatthias Ringwald memset(storage, 0, sizeof(le_advertising_set_t)); 8738a5770ecbSMatthias Ringwald // copy params 87390cbe4690SMatthias Ringwald storage->advertising_handle = advertisement_handle; 874057a04237SMatthias Ringwald memcpy(&storage->extended_params, advertising_parameters, sizeof(le_extended_advertising_parameters_t)); 8741a5770ecbSMatthias Ringwald // add to list 8742a5770ecbSMatthias Ringwald bool add_ok = btstack_linked_list_add(&hci_stack->le_advertising_sets, (btstack_linked_item_t *) storage); 8743a5770ecbSMatthias Ringwald if (!add_ok) return ERROR_CODE_ACL_CONNECTION_ALREADY_EXISTS; 87440cbe4690SMatthias Ringwald *out_advertising_handle = advertisement_handle; 8745a5770ecbSMatthias Ringwald // set tasks and start 8746a5770ecbSMatthias Ringwald storage->tasks = LE_ADVERTISEMENT_TASKS_SET_PARAMS; 8747a5770ecbSMatthias Ringwald hci_run(); 8748a5770ecbSMatthias Ringwald return ERROR_CODE_SUCCESS; 8749a5770ecbSMatthias Ringwald } 8750a5770ecbSMatthias Ringwald 8751a5770ecbSMatthias Ringwald uint8_t gap_extended_advertising_set_params(uint8_t advertising_handle, const le_extended_advertising_parameters_t * advertising_parameters){ 8752a5770ecbSMatthias Ringwald le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(advertising_handle); 8753a5770ecbSMatthias Ringwald if (advertising_set == NULL) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 875457a04237SMatthias Ringwald memcpy(&advertising_set->extended_params, advertising_parameters, sizeof(le_extended_advertising_parameters_t)); 8755a5770ecbSMatthias Ringwald // set tasks and start 8756a5770ecbSMatthias Ringwald advertising_set->tasks |= LE_ADVERTISEMENT_TASKS_SET_PARAMS; 8757a5770ecbSMatthias Ringwald hci_run(); 8758a5770ecbSMatthias Ringwald return ERROR_CODE_SUCCESS; 8759a5770ecbSMatthias Ringwald } 8760a5770ecbSMatthias Ringwald 8761a5770ecbSMatthias Ringwald uint8_t gap_extended_advertising_get_params(uint8_t advertising_handle, le_extended_advertising_parameters_t * advertising_parameters){ 8762a5770ecbSMatthias Ringwald le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(advertising_handle); 8763a5770ecbSMatthias Ringwald if (advertising_set == NULL) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 876457a04237SMatthias Ringwald memcpy(advertising_parameters, &advertising_set->extended_params, sizeof(le_extended_advertising_parameters_t)); 8765a5770ecbSMatthias Ringwald return ERROR_CODE_SUCCESS; 8766a5770ecbSMatthias Ringwald } 8767a5770ecbSMatthias Ringwald 8768a5770ecbSMatthias Ringwald uint8_t gap_extended_advertising_set_random_address(uint8_t advertising_handle, bd_addr_t random_address){ 8769a5770ecbSMatthias Ringwald le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(advertising_handle); 8770a5770ecbSMatthias Ringwald if (advertising_set == NULL) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 8771a5770ecbSMatthias Ringwald memcpy(advertising_set->random_address, random_address, 6); 8772a5770ecbSMatthias Ringwald // set tasks and start 8773a5770ecbSMatthias Ringwald advertising_set->tasks |= LE_ADVERTISEMENT_TASKS_SET_ADDRESS; 8774a5770ecbSMatthias Ringwald hci_run(); 8775a5770ecbSMatthias Ringwald return ERROR_CODE_SUCCESS; 8776a5770ecbSMatthias Ringwald } 8777a5770ecbSMatthias Ringwald 87782e4aaf70SMatthias Ringwald uint8_t gap_extended_advertising_set_adv_data(uint8_t advertising_handle, uint16_t advertising_data_length, const uint8_t * advertising_data){ 8779a5770ecbSMatthias Ringwald le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(advertising_handle); 8780a5770ecbSMatthias Ringwald if (advertising_set == NULL) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 8781a5770ecbSMatthias Ringwald advertising_set->adv_data = advertising_data; 8782a5770ecbSMatthias Ringwald advertising_set->adv_data_len = advertising_data_length; 8783a5770ecbSMatthias Ringwald // set tasks and start 8784a5770ecbSMatthias Ringwald advertising_set->tasks |= LE_ADVERTISEMENT_TASKS_SET_ADV_DATA; 8785a5770ecbSMatthias Ringwald hci_run(); 8786a5770ecbSMatthias Ringwald return ERROR_CODE_SUCCESS; 8787a5770ecbSMatthias Ringwald } 8788a5770ecbSMatthias Ringwald 87892e4aaf70SMatthias Ringwald uint8_t gap_extended_advertising_set_scan_response_data(uint8_t advertising_handle, uint16_t scan_response_data_length, const uint8_t * scan_response_data){ 8790a5770ecbSMatthias Ringwald le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(advertising_handle); 8791a5770ecbSMatthias Ringwald if (advertising_set == NULL) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 8792a5770ecbSMatthias Ringwald advertising_set->scan_data = scan_response_data; 8793a5770ecbSMatthias Ringwald advertising_set->scan_data_len = scan_response_data_length; 8794a5770ecbSMatthias Ringwald // set tasks and start 8795a5770ecbSMatthias Ringwald advertising_set->tasks |= LE_ADVERTISEMENT_TASKS_SET_SCAN_DATA; 8796a5770ecbSMatthias Ringwald hci_run(); 8797a5770ecbSMatthias Ringwald return ERROR_CODE_SUCCESS; 8798a5770ecbSMatthias Ringwald } 8799a5770ecbSMatthias Ringwald 8800a5770ecbSMatthias Ringwald uint8_t gap_extended_advertising_start(uint8_t advertising_handle, uint16_t timeout, uint8_t num_extended_advertising_events){ 8801a5770ecbSMatthias Ringwald le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(advertising_handle); 8802a5770ecbSMatthias Ringwald if (advertising_set == NULL) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 8803a5770ecbSMatthias Ringwald advertising_set->enable_timeout = timeout; 8804a5770ecbSMatthias Ringwald advertising_set->enable_max_scan_events = num_extended_advertising_events; 8805a5770ecbSMatthias Ringwald // set tasks and start 8806a5770ecbSMatthias Ringwald advertising_set->state |= LE_ADVERTISEMENT_STATE_ENABLED; 8807a5770ecbSMatthias Ringwald hci_run(); 8808a5770ecbSMatthias Ringwald return ERROR_CODE_SUCCESS; 8809a5770ecbSMatthias Ringwald } 8810a5770ecbSMatthias Ringwald 8811a5770ecbSMatthias Ringwald uint8_t gap_extended_advertising_stop(uint8_t advertising_handle){ 8812a5770ecbSMatthias Ringwald le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(advertising_handle); 8813a5770ecbSMatthias Ringwald if (advertising_set == NULL) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 8814a5770ecbSMatthias Ringwald // set tasks and start 8815a5770ecbSMatthias Ringwald advertising_set->state &= ~LE_ADVERTISEMENT_STATE_ENABLED; 8816a5770ecbSMatthias Ringwald hci_run(); 8817a5770ecbSMatthias Ringwald return ERROR_CODE_SUCCESS; 8818a5770ecbSMatthias Ringwald } 8819a5770ecbSMatthias Ringwald 8820c814a904SMatthias Ringwald uint8_t gap_extended_advertising_remove(uint8_t advertising_handle){ 8821c814a904SMatthias Ringwald le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(advertising_handle); 8822c814a904SMatthias Ringwald if (advertising_set == NULL) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 8823c814a904SMatthias Ringwald // set tasks and start 8824c814a904SMatthias Ringwald advertising_set->tasks |= LE_ADVERTISEMENT_TASKS_REMOVE_SET; 8825c814a904SMatthias Ringwald hci_run(); 8826c814a904SMatthias Ringwald return ERROR_CODE_SUCCESS; 8827c814a904SMatthias Ringwald } 8828c814a904SMatthias Ringwald 8829c814a904SMatthias Ringwald #ifdef ENABLE_LE_PERIODIC_ADVERTISING 8830c814a904SMatthias Ringwald uint8_t gap_periodic_advertising_set_params(uint8_t advertising_handle, const le_periodic_advertising_parameters_t * advertising_parameters){ 8831c814a904SMatthias Ringwald le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(advertising_handle); 8832c814a904SMatthias Ringwald if (advertising_set == NULL) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 8833c814a904SMatthias Ringwald // periodic advertising requires neither connectable, scannable, legacy or anonymous 8834c814a904SMatthias Ringwald if ((advertising_set->extended_params.advertising_event_properties & 0x1f) != 0) return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS; 8835c814a904SMatthias Ringwald memcpy(&advertising_set->periodic_params, advertising_parameters, sizeof(le_periodic_advertising_parameters_t)); 8836c814a904SMatthias Ringwald // set tasks and start 8837c814a904SMatthias Ringwald advertising_set->tasks |= LE_ADVERTISEMENT_TASKS_SET_PERIODIC_PARAMS; 8838c814a904SMatthias Ringwald hci_run(); 8839c814a904SMatthias Ringwald return ERROR_CODE_SUCCESS; 8840c814a904SMatthias Ringwald } 8841c814a904SMatthias Ringwald 8842c814a904SMatthias Ringwald uint8_t gap_periodic_advertising_get_params(uint8_t advertising_handle, le_periodic_advertising_parameters_t * advertising_parameters){ 8843c814a904SMatthias Ringwald le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(advertising_handle); 8844c814a904SMatthias Ringwald if (advertising_set == NULL) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 8845c814a904SMatthias Ringwald memcpy(advertising_parameters, &advertising_set->extended_params, sizeof(le_periodic_advertising_parameters_t)); 8846c814a904SMatthias Ringwald return ERROR_CODE_SUCCESS; 8847c814a904SMatthias Ringwald } 8848c814a904SMatthias Ringwald 8849c814a904SMatthias Ringwald uint8_t gap_periodic_advertising_set_data(uint8_t advertising_handle, uint16_t periodic_data_length, const uint8_t * periodic_data){ 8850c814a904SMatthias Ringwald le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(advertising_handle); 8851c814a904SMatthias Ringwald if (advertising_set == NULL) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 8852c814a904SMatthias Ringwald advertising_set->periodic_data = periodic_data; 8853c814a904SMatthias Ringwald advertising_set->periodic_data_len = periodic_data_length; 8854c814a904SMatthias Ringwald // set tasks and start 8855c814a904SMatthias Ringwald advertising_set->tasks |= LE_ADVERTISEMENT_TASKS_SET_PERIODIC_DATA; 8856c814a904SMatthias Ringwald hci_run(); 8857c814a904SMatthias Ringwald return ERROR_CODE_SUCCESS; 8858c814a904SMatthias Ringwald } 8859c814a904SMatthias Ringwald 886053f240c0SMatthias Ringwald uint8_t gap_periodic_advertising_start(uint8_t advertising_handle, bool include_adi){ 886153f240c0SMatthias Ringwald le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(advertising_handle); 886253f240c0SMatthias Ringwald if (advertising_set == NULL) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 886353f240c0SMatthias Ringwald // set tasks and start 886453f240c0SMatthias Ringwald advertising_set->periodic_include_adi = include_adi; 886553f240c0SMatthias Ringwald advertising_set->state |= LE_ADVERTISEMENT_STATE_PERIODIC_ENABLED; 886653f240c0SMatthias Ringwald hci_run(); 886753f240c0SMatthias Ringwald return ERROR_CODE_SUCCESS; 886853f240c0SMatthias Ringwald } 886953f240c0SMatthias Ringwald 887053f240c0SMatthias Ringwald uint8_t gap_periodic_advertising_stop(uint8_t advertising_handle){ 887153f240c0SMatthias Ringwald le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(advertising_handle); 887253f240c0SMatthias Ringwald if (advertising_set == NULL) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 887353f240c0SMatthias Ringwald // set tasks and start 887453f240c0SMatthias Ringwald advertising_set->state &= ~LE_ADVERTISEMENT_STATE_PERIODIC_ENABLED; 887553f240c0SMatthias Ringwald hci_run(); 887653f240c0SMatthias Ringwald return ERROR_CODE_SUCCESS; 887753f240c0SMatthias Ringwald } 887898aa715fSMatthias Ringwald 887998aa715fSMatthias Ringwald uint8_t gap_periodic_advertising_sync_transfer_set_default_parameters(uint8_t mode, uint16_t skip, uint16_t sync_timeout, uint8_t cte_type){ 888098aa715fSMatthias Ringwald hci_stack->le_past_mode = mode; 888198aa715fSMatthias Ringwald hci_stack->le_past_skip = skip; 888298aa715fSMatthias Ringwald hci_stack->le_past_sync_timeout = sync_timeout; 888398aa715fSMatthias Ringwald hci_stack->le_past_cte_type = cte_type; 888498aa715fSMatthias Ringwald hci_stack->le_past_set_default_params = true; 888598aa715fSMatthias Ringwald hci_run(); 888698aa715fSMatthias Ringwald return ERROR_CODE_SUCCESS; 888798aa715fSMatthias Ringwald } 888898aa715fSMatthias Ringwald 88893bd96807SMatthias Ringwald uint8_t gap_periodic_advertising_sync_transfer_send(hci_con_handle_t con_handle, uint16_t service_data, hci_con_handle_t sync_handle){ 88903bd96807SMatthias Ringwald hci_connection_t * hci_connection = hci_connection_for_handle(con_handle); 88913bd96807SMatthias Ringwald if (hci_connection == NULL){ 88923bd96807SMatthias Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 88933bd96807SMatthias Ringwald } 88943bd96807SMatthias Ringwald hci_connection->le_past_sync_handle = sync_handle; 88953bd96807SMatthias Ringwald hci_connection->le_past_service_data = service_data; 88963bd96807SMatthias Ringwald hci_run(); 88973bd96807SMatthias Ringwald return ERROR_CODE_SUCCESS; 88983bd96807SMatthias Ringwald } 88993bd96807SMatthias Ringwald 8900027f4677SMatthias Ringwald uint8_t gap_periodic_advertising_set_info_transfer_send(hci_con_handle_t con_handle, uint16_t service_data, uint8_t advertising_handle){ 8901027f4677SMatthias Ringwald hci_connection_t * hci_connection = hci_connection_for_handle(con_handle); 8902027f4677SMatthias Ringwald if (hci_connection == NULL){ 8903027f4677SMatthias Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 8904027f4677SMatthias Ringwald } 8905027f4677SMatthias Ringwald hci_connection->le_past_advertising_handle = advertising_handle; 8906027f4677SMatthias Ringwald hci_connection->le_past_service_data = service_data; 8907027f4677SMatthias Ringwald hci_run(); 8908027f4677SMatthias Ringwald return ERROR_CODE_SUCCESS; 8909027f4677SMatthias Ringwald } 8910027f4677SMatthias Ringwald 8911c814a904SMatthias Ringwald #endif /* ENABLE_LE_PERIODIC_ADVERTISING */ 891253f240c0SMatthias Ringwald 8913a5770ecbSMatthias Ringwald #endif 8914a5770ecbSMatthias Ringwald 891535454696SMatthias Ringwald #endif 891606e5cf96SMatthias Ringwald 891706e5cf96SMatthias Ringwald void hci_le_set_own_address_type(uint8_t own_address_type){ 891806e5cf96SMatthias Ringwald log_info("hci_le_set_own_address_type: old %u, new %u", hci_stack->le_own_addr_type, own_address_type); 891906e5cf96SMatthias Ringwald if (own_address_type == hci_stack->le_own_addr_type) return; 892006e5cf96SMatthias Ringwald hci_stack->le_own_addr_type = own_address_type; 892106e5cf96SMatthias Ringwald 892264068776SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 892306e5cf96SMatthias Ringwald // update advertisement parameters, too 892406e5cf96SMatthias Ringwald hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_SET_PARAMS; 8925bbc366e6SMatthias Ringwald hci_run(); 892664068776SMatthias Ringwald #endif 892764068776SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 892806e5cf96SMatthias Ringwald // note: we don't update scan parameters or modify ongoing connection attempts 892964068776SMatthias Ringwald #endif 893006e5cf96SMatthias Ringwald } 893106e5cf96SMatthias Ringwald 89329136bde8SMatthias Ringwald void hci_le_random_address_set(const bd_addr_t random_address){ 8933137a570aSMatthias Ringwald log_info("gap_privacy: hci_le_random_address_set %s", bd_addr_to_str(random_address)); 89349136bde8SMatthias Ringwald memcpy(hci_stack->le_random_address, random_address, 6); 89359136bde8SMatthias Ringwald hci_stack->le_random_address_set = true; 8936137a570aSMatthias Ringwald hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_SET_ADDRESS | LE_ADVERTISEMENT_TASKS_PRIVACY_NOTIFY; 89379ce6dfa1SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 893822f987e4SMatthias Ringwald if (hci_le_extended_advertising_supported()){ 89395e05c0afSMatthias Ringwald hci_assert_advertisement_set_0_ready(); 89409ce6dfa1SMatthias Ringwald hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_SET_ADDRESS_SET_0; 89419ce6dfa1SMatthias Ringwald } 89429ce6dfa1SMatthias Ringwald #endif 89439136bde8SMatthias Ringwald hci_run(); 89449136bde8SMatthias Ringwald } 89459136bde8SMatthias Ringwald 8946d70217a2SMatthias Ringwald #endif 894745c102fdSMatthias Ringwald 8948616edd56SMatthias Ringwald uint8_t gap_disconnect(hci_con_handle_t handle){ 89495917a5c5S[email protected] hci_connection_t * conn = hci_connection_for_handle(handle); 89505917a5c5S[email protected] if (!conn){ 89517851196eSmatthias.ringwald hci_emit_disconnection_complete(handle, 0); 8952616edd56SMatthias Ringwald return 0; 89535917a5c5S[email protected] } 89547fd7aa6fSMatthias Ringwald // ignore if already disconnected 89557fd7aa6fSMatthias Ringwald if (conn->state == RECEIVED_DISCONNECTION_COMPLETE){ 89567fd7aa6fSMatthias Ringwald return 0; 89577fd7aa6fSMatthias Ringwald } 89585917a5c5S[email protected] conn->state = SEND_DISCONNECT; 89595917a5c5S[email protected] hci_run(); 8960616edd56SMatthias Ringwald return 0; 89614f3229d8S[email protected] } 896204a6ef8cSmatthias.ringwald 8963228e430cSMatthias Ringwald int gap_read_rssi(hci_con_handle_t con_handle){ 8964228e430cSMatthias Ringwald hci_connection_t * hci_connection = hci_connection_for_handle(con_handle); 8965228e430cSMatthias Ringwald if (hci_connection == NULL) return 0; 896622df2fe2SMatthias Ringwald hci_connection->gap_connection_tasks |= GAP_CONNECTION_TASK_READ_RSSI; 8967228e430cSMatthias Ringwald hci_run(); 8968228e430cSMatthias Ringwald return 1; 8969228e430cSMatthias Ringwald } 8970228e430cSMatthias Ringwald 8971a1bf5ae7SMatthias Ringwald /** 8972a1bf5ae7SMatthias Ringwald * @brief Get connection type 8973a1bf5ae7SMatthias Ringwald * @param con_handle 8974a1bf5ae7SMatthias Ringwald * @result connection_type 8975a1bf5ae7SMatthias Ringwald */ 8976a1bf5ae7SMatthias Ringwald gap_connection_type_t gap_get_connection_type(hci_con_handle_t connection_handle){ 8977a1bf5ae7SMatthias Ringwald hci_connection_t * conn = hci_connection_for_handle(connection_handle); 8978a1bf5ae7SMatthias Ringwald if (!conn) return GAP_CONNECTION_INVALID; 8979a1bf5ae7SMatthias Ringwald switch (conn->address_type){ 8980a1bf5ae7SMatthias Ringwald case BD_ADDR_TYPE_LE_PUBLIC: 8981a1bf5ae7SMatthias Ringwald case BD_ADDR_TYPE_LE_RANDOM: 8982ad9f3530SMatthias Ringwald case BD_ADDR_TYPE_LE_PUBLIC_IDENTITY: 8983ad9f3530SMatthias Ringwald case BD_ADDR_TYPE_LE_RANDOM_IDENTITY: 8984a1bf5ae7SMatthias Ringwald return GAP_CONNECTION_LE; 8985a1bf5ae7SMatthias Ringwald case BD_ADDR_TYPE_SCO: 8986a1bf5ae7SMatthias Ringwald return GAP_CONNECTION_SCO; 8987f16129ceSMatthias Ringwald case BD_ADDR_TYPE_ACL: 8988a1bf5ae7SMatthias Ringwald return GAP_CONNECTION_ACL; 8989a1bf5ae7SMatthias Ringwald default: 8990a1bf5ae7SMatthias Ringwald return GAP_CONNECTION_INVALID; 8991a1bf5ae7SMatthias Ringwald } 8992a1bf5ae7SMatthias Ringwald } 8993a1bf5ae7SMatthias Ringwald 89942dceb1d6SMatthias Ringwald hci_role_t gap_get_role(hci_con_handle_t connection_handle){ 89952dceb1d6SMatthias Ringwald hci_connection_t * conn = hci_connection_for_handle(connection_handle); 89962dceb1d6SMatthias Ringwald if (!conn) return HCI_ROLE_INVALID; 89972dceb1d6SMatthias Ringwald return (hci_role_t) conn->role; 89982dceb1d6SMatthias Ringwald } 89992dceb1d6SMatthias Ringwald 90002dceb1d6SMatthias Ringwald 900144f858f3SMatthias Ringwald #ifdef ENABLE_CLASSIC 9002667ba9d1SMatthias Ringwald uint8_t gap_request_role(const bd_addr_t addr, hci_role_t role){ 900388a03c8dSMatthias Ringwald hci_connection_t * conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL); 900488a03c8dSMatthias Ringwald if (!conn) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 900588a03c8dSMatthias Ringwald conn->request_role = role; 900688a03c8dSMatthias Ringwald hci_run(); 9007d04a455eSMatthias Ringwald return ERROR_CODE_SUCCESS; 900888a03c8dSMatthias Ringwald } 900944f858f3SMatthias Ringwald #endif 901088a03c8dSMatthias Ringwald 9011a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE 90124f551432SMatthias Ringwald 90139d8be771SMatthias Ringwald uint8_t gap_le_set_phy(hci_con_handle_t con_handle, uint8_t all_phys, uint8_t tx_phys, uint8_t rx_phys, uint16_t phy_options){ 9014b45b7749SMilanka Ringwald hci_connection_t * conn = hci_connection_for_handle(con_handle); 9015b90f6e0aSMatthias Ringwald if (!conn) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 9016b90f6e0aSMatthias Ringwald 9017b90f6e0aSMatthias Ringwald conn->le_phy_update_all_phys = all_phys; 9018b90f6e0aSMatthias Ringwald conn->le_phy_update_tx_phys = tx_phys; 9019b90f6e0aSMatthias Ringwald conn->le_phy_update_rx_phys = rx_phys; 90209d8be771SMatthias Ringwald conn->le_phy_update_phy_options = (uint8_t) phy_options; 9021b90f6e0aSMatthias Ringwald 9022b90f6e0aSMatthias Ringwald hci_run(); 9023b90f6e0aSMatthias Ringwald 9024b90f6e0aSMatthias Ringwald return 0; 9025b90f6e0aSMatthias Ringwald } 9026b90f6e0aSMatthias Ringwald 9027667ba9d1SMatthias Ringwald static uint8_t hci_whitelist_add(bd_addr_type_t address_type, const bd_addr_t address){ 9028100da355SMatthias Ringwald 9029100da355SMatthias Ringwald #if !defined(HAVE_MALLOC) && (!defined(MAX_NR_WHITELIST_ENTRIES) || (MAX_NR_WHITELIST_ENTRIES == 0)) 9030100da355SMatthias Ringwald // incorrect configuration: 9031100da355SMatthias Ringwald // - as MAX_NR_WHITELIST_ENTRIES is not defined or zero this function always fails 9032100da355SMatthias Ringwald // - please set MAX_NR_WHITELIST_ENTRIES in btstack_config.h 9033100da355SMatthias Ringwald btstack_assert(false); 9034100da355SMatthias Ringwald #endif 9035100da355SMatthias Ringwald 90367a92a9dbSMatthias Ringwald // check if already in list 90377a92a9dbSMatthias Ringwald btstack_linked_list_iterator_t it; 90387a92a9dbSMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->le_whitelist); 90397a92a9dbSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)) { 90407a92a9dbSMatthias Ringwald whitelist_entry_t *entry = (whitelist_entry_t *) btstack_linked_list_iterator_next(&it); 90417a92a9dbSMatthias Ringwald if (entry->address_type != address_type) { 90427a92a9dbSMatthias Ringwald continue; 90437a92a9dbSMatthias Ringwald } 90447a92a9dbSMatthias Ringwald if (memcmp(entry->address, address, 6) != 0) { 90457a92a9dbSMatthias Ringwald continue; 90467a92a9dbSMatthias Ringwald } 9047caaf5151SMilanka Ringwald 9048caaf5151SMilanka Ringwald // if already on controller: 9049caaf5151SMilanka Ringwald if ((entry->state & LE_WHITELIST_ON_CONTROLLER) != 0){ 9050caaf5151SMilanka Ringwald if ((entry->state & LE_WHITELIST_REMOVE_FROM_CONTROLLER) != 0){ 9051caaf5151SMilanka Ringwald // drop remove request 9052caaf5151SMilanka Ringwald entry->state = LE_WHITELIST_ON_CONTROLLER; 9053caaf5151SMilanka Ringwald return ERROR_CODE_SUCCESS; 9054caaf5151SMilanka Ringwald } else { 9055caaf5151SMilanka Ringwald // disallow as already on controller 90567a92a9dbSMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 90577a92a9dbSMatthias Ringwald } 9058287379ccSMatthias Ringwald } 9059caaf5151SMilanka Ringwald 9060caaf5151SMilanka Ringwald // assume scheduled to add 9061caaf5151SMilanka Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 9062caaf5151SMilanka Ringwald } 9063caaf5151SMilanka Ringwald 90647a92a9dbSMatthias Ringwald // alloc and add to list 9065e83201bcSMatthias Ringwald whitelist_entry_t * entry = btstack_memory_whitelist_entry_get(); 9066e83201bcSMatthias Ringwald if (!entry) return BTSTACK_MEMORY_ALLOC_FAILED; 9067e83201bcSMatthias Ringwald entry->address_type = address_type; 90686535961aSMatthias Ringwald (void)memcpy(entry->address, address, 6); 9069e83201bcSMatthias Ringwald entry->state = LE_WHITELIST_ADD_TO_CONTROLLER; 9070665d90f2SMatthias Ringwald btstack_linked_list_add(&hci_stack->le_whitelist, (btstack_linked_item_t*) entry); 9071226db5efSMatthias Ringwald return ERROR_CODE_SUCCESS; 9072ac9c45e0SMatthias Ringwald } 9073ac9c45e0SMatthias Ringwald 9074667ba9d1SMatthias Ringwald static uint8_t hci_whitelist_remove(bd_addr_type_t address_type, const bd_addr_t address){ 9075665d90f2SMatthias Ringwald btstack_linked_list_iterator_t it; 9076665d90f2SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->le_whitelist); 9077665d90f2SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 9078665d90f2SMatthias Ringwald whitelist_entry_t * entry = (whitelist_entry_t*) btstack_linked_list_iterator_next(&it); 90797a92a9dbSMatthias Ringwald if (entry->address_type != address_type) { 90807a92a9dbSMatthias Ringwald continue; 90817a92a9dbSMatthias Ringwald } 90827a92a9dbSMatthias Ringwald if (memcmp(entry->address, address, 6) != 0) { 90837a92a9dbSMatthias Ringwald continue; 90847a92a9dbSMatthias Ringwald } 9085e83201bcSMatthias Ringwald if (entry->state & LE_WHITELIST_ON_CONTROLLER){ 9086e83201bcSMatthias Ringwald // remove from controller if already present 9087e83201bcSMatthias Ringwald entry->state |= LE_WHITELIST_REMOVE_FROM_CONTROLLER; 9088a3b69fdeSMatthias Ringwald } else { 9089226db5efSMatthias Ringwald // directly remove entry from whitelist 9090665d90f2SMatthias Ringwald btstack_linked_list_iterator_remove(&it); 9091e83201bcSMatthias Ringwald btstack_memory_whitelist_entry_free(entry); 9092e83201bcSMatthias Ringwald } 9093a3b69fdeSMatthias Ringwald return ERROR_CODE_SUCCESS; 9094a3b69fdeSMatthias Ringwald } 9095a3b69fdeSMatthias Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 909642ff5ba1SMatthias Ringwald } 909742ff5ba1SMatthias Ringwald 9098226db5efSMatthias Ringwald static void hci_whitelist_clear(void){ 9099665d90f2SMatthias Ringwald btstack_linked_list_iterator_t it; 9100665d90f2SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->le_whitelist); 9101665d90f2SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 9102665d90f2SMatthias Ringwald whitelist_entry_t * entry = (whitelist_entry_t*) btstack_linked_list_iterator_next(&it); 9103e83201bcSMatthias Ringwald if (entry->state & LE_WHITELIST_ON_CONTROLLER){ 9104e83201bcSMatthias Ringwald // remove from controller if already present 9105e83201bcSMatthias Ringwald entry->state |= LE_WHITELIST_REMOVE_FROM_CONTROLLER; 9106e83201bcSMatthias Ringwald continue; 9107e83201bcSMatthias Ringwald } 910891915b0bSMatthias Ringwald // directly remove entry from whitelist 9109665d90f2SMatthias Ringwald btstack_linked_list_iterator_remove(&it); 9110e83201bcSMatthias Ringwald btstack_memory_whitelist_entry_free(entry); 9111e83201bcSMatthias Ringwald } 9112226db5efSMatthias Ringwald } 9113226db5efSMatthias Ringwald 9114a3b69fdeSMatthias Ringwald /** 9115a3b69fdeSMatthias Ringwald * @brief Clear Whitelist 91166b65794dSMilanka Ringwald * @return 0 if ok 9117a3b69fdeSMatthias Ringwald */ 9118a3b69fdeSMatthias Ringwald uint8_t gap_whitelist_clear(void){ 9119a3b69fdeSMatthias Ringwald hci_whitelist_clear(); 9120a3b69fdeSMatthias Ringwald hci_run(); 9121a3b69fdeSMatthias Ringwald return ERROR_CODE_SUCCESS; 9122a3b69fdeSMatthias Ringwald } 9123a3b69fdeSMatthias Ringwald 9124a3b69fdeSMatthias Ringwald /** 9125a3b69fdeSMatthias Ringwald * @brief Add Device to Whitelist 9126a3b69fdeSMatthias Ringwald * @param address_typ 9127a3b69fdeSMatthias Ringwald * @param address 91286b65794dSMilanka Ringwald * @return 0 if ok 9129a3b69fdeSMatthias Ringwald */ 9130667ba9d1SMatthias Ringwald uint8_t gap_whitelist_add(bd_addr_type_t address_type, const bd_addr_t address){ 9131a3b69fdeSMatthias Ringwald uint8_t status = hci_whitelist_add(address_type, address); 9132a3b69fdeSMatthias Ringwald if (status){ 9133a3b69fdeSMatthias Ringwald return status; 9134a3b69fdeSMatthias Ringwald } 9135a3b69fdeSMatthias Ringwald hci_run(); 9136a3b69fdeSMatthias Ringwald return ERROR_CODE_SUCCESS; 9137a3b69fdeSMatthias Ringwald } 9138a3b69fdeSMatthias Ringwald 9139a3b69fdeSMatthias Ringwald /** 9140a3b69fdeSMatthias Ringwald * @brief Remove Device from Whitelist 9141a3b69fdeSMatthias Ringwald * @param address_typ 9142a3b69fdeSMatthias Ringwald * @param address 91436b65794dSMilanka Ringwald * @return 0 if ok 9144a3b69fdeSMatthias Ringwald */ 9145667ba9d1SMatthias Ringwald uint8_t gap_whitelist_remove(bd_addr_type_t address_type, const bd_addr_t address){ 9146a3b69fdeSMatthias Ringwald uint8_t status = hci_whitelist_remove(address_type, address); 9147a3b69fdeSMatthias Ringwald if (status){ 9148a3b69fdeSMatthias Ringwald return status; 9149a3b69fdeSMatthias Ringwald } 9150a3b69fdeSMatthias Ringwald hci_run(); 9151a3b69fdeSMatthias Ringwald return ERROR_CODE_SUCCESS; 9152a3b69fdeSMatthias Ringwald } 9153a3b69fdeSMatthias Ringwald 9154226db5efSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 9155226db5efSMatthias Ringwald /** 915695e257d9SMatthias Ringwald * @brief Connect with Whitelist 915795e257d9SMatthias Ringwald * @note Explicit whitelist management and this connect with whitelist replace deprecated gap_auto_connection_* functions 91586b65794dSMilanka Ringwald * @return - if ok 915995e257d9SMatthias Ringwald */ 916095e257d9SMatthias Ringwald uint8_t gap_connect_with_whitelist(void){ 916195e257d9SMatthias Ringwald if (hci_stack->le_connecting_request != LE_CONNECTING_IDLE){ 916295e257d9SMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 916395e257d9SMatthias Ringwald } 916495e257d9SMatthias Ringwald hci_stack->le_connecting_request = LE_CONNECTING_WHITELIST; 916595e257d9SMatthias Ringwald hci_run(); 916695e257d9SMatthias Ringwald return ERROR_CODE_SUCCESS; 916795e257d9SMatthias Ringwald } 916895e257d9SMatthias Ringwald 916995e257d9SMatthias Ringwald /** 9170226db5efSMatthias Ringwald * @brief Auto Connection Establishment - Start Connecting to device 9171226db5efSMatthias Ringwald * @param address_typ 9172226db5efSMatthias Ringwald * @param address 91736b65794dSMilanka Ringwald * @return 0 if ok 9174226db5efSMatthias Ringwald */ 9175667ba9d1SMatthias Ringwald uint8_t gap_auto_connection_start(bd_addr_type_t address_type, const bd_addr_t address){ 917695e257d9SMatthias Ringwald if (hci_stack->le_connecting_request == LE_CONNECTING_DIRECT){ 9177226db5efSMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 9178226db5efSMatthias Ringwald } 9179226db5efSMatthias Ringwald 9180226db5efSMatthias Ringwald uint8_t status = hci_whitelist_add(address_type, address); 918163f2efc9SMatthias Ringwald if (status == BTSTACK_MEMORY_ALLOC_FAILED) { 9182226db5efSMatthias Ringwald return status; 9183226db5efSMatthias Ringwald } 9184226db5efSMatthias Ringwald 9185226db5efSMatthias Ringwald hci_stack->le_connecting_request = LE_CONNECTING_WHITELIST; 9186226db5efSMatthias Ringwald 9187226db5efSMatthias Ringwald hci_run(); 918895e257d9SMatthias Ringwald return ERROR_CODE_SUCCESS; 9189226db5efSMatthias Ringwald } 9190226db5efSMatthias Ringwald 9191226db5efSMatthias Ringwald /** 9192226db5efSMatthias Ringwald * @brief Auto Connection Establishment - Stop Connecting to device 9193226db5efSMatthias Ringwald * @param address_typ 9194226db5efSMatthias Ringwald * @param address 91956b65794dSMilanka Ringwald * @return 0 if ok 9196226db5efSMatthias Ringwald */ 9197667ba9d1SMatthias Ringwald uint8_t gap_auto_connection_stop(bd_addr_type_t address_type, const bd_addr_t address){ 919895e257d9SMatthias Ringwald if (hci_stack->le_connecting_request == LE_CONNECTING_DIRECT){ 919995e257d9SMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 920095e257d9SMatthias Ringwald } 920195e257d9SMatthias Ringwald 9202226db5efSMatthias Ringwald hci_whitelist_remove(address_type, address); 920395e257d9SMatthias Ringwald if (btstack_linked_list_empty(&hci_stack->le_whitelist)){ 920495e257d9SMatthias Ringwald hci_stack->le_connecting_request = LE_CONNECTING_IDLE; 920595e257d9SMatthias Ringwald } 9206226db5efSMatthias Ringwald hci_run(); 9207226db5efSMatthias Ringwald return 0; 9208226db5efSMatthias Ringwald } 9209226db5efSMatthias Ringwald 9210226db5efSMatthias Ringwald /** 9211226db5efSMatthias Ringwald * @brief Auto Connection Establishment - Stop everything 9212226db5efSMatthias Ringwald * @note Convenience function to stop all active auto connection attempts 9213226db5efSMatthias Ringwald */ 921495e257d9SMatthias Ringwald uint8_t gap_auto_connection_stop_all(void){ 921595e257d9SMatthias Ringwald if (hci_stack->le_connecting_request == LE_CONNECTING_DIRECT) { 921695e257d9SMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 921795e257d9SMatthias Ringwald } 9218226db5efSMatthias Ringwald hci_whitelist_clear(); 9219226db5efSMatthias Ringwald hci_stack->le_connecting_request = LE_CONNECTING_IDLE; 9220e83201bcSMatthias Ringwald hci_run(); 922195e257d9SMatthias Ringwald return ERROR_CODE_SUCCESS; 9222ac9c45e0SMatthias Ringwald } 9223c9db5c21SMilanka Ringwald 9224b45b7749SMilanka Ringwald uint16_t gap_le_connection_interval(hci_con_handle_t con_handle){ 9225b45b7749SMilanka Ringwald hci_connection_t * conn = hci_connection_for_handle(con_handle); 9226c9db5c21SMilanka Ringwald if (!conn) return 0; 9227c9db5c21SMilanka Ringwald return conn->le_connection_interval; 9228c9db5c21SMilanka Ringwald } 9229d70217a2SMatthias Ringwald #endif 92304f551432SMatthias Ringwald #endif 92314f551432SMatthias Ringwald 923235454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 9233ac9c45e0SMatthias Ringwald /** 9234ff00ed1cSMatthias Ringwald * @brief Set Extended Inquiry Response data 9235a8c4e5adSMatthias Ringwald * @param eir_data size HCI_EXTENDED_INQUIRY_RESPONSE_DATA_LEN (240) bytes, is not copied make sure memory is accessible during stack startup 9236ff00ed1cSMatthias Ringwald * @note has to be done before stack starts up 9237ff00ed1cSMatthias Ringwald */ 9238ff00ed1cSMatthias Ringwald void gap_set_extended_inquiry_response(const uint8_t * data){ 9239ff00ed1cSMatthias Ringwald hci_stack->eir_data = data; 9240baa4881eSMatthias Ringwald hci_stack->gap_tasks_classic |= GAP_TASK_SET_EIR_DATA; 924159d59ecfSMatthias Ringwald hci_run(); 9242ff00ed1cSMatthias Ringwald } 9243ff00ed1cSMatthias Ringwald 9244ff00ed1cSMatthias Ringwald /** 9245f5875de5SMatthias Ringwald * @brief Start GAP Classic Inquiry 9246f5875de5SMatthias Ringwald * @param duration in 1.28s units 9247f5875de5SMatthias Ringwald * @return 0 if ok 9248f5875de5SMatthias Ringwald * @events: GAP_EVENT_INQUIRY_RESULT, GAP_EVENT_INQUIRY_COMPLETE 9249f5875de5SMatthias Ringwald */ 9250f5875de5SMatthias Ringwald int gap_inquiry_start(uint8_t duration_in_1280ms_units){ 925199449554SMatthias Ringwald if (hci_stack->state != HCI_STATE_WORKING) return ERROR_CODE_COMMAND_DISALLOWED; 9252f5875de5SMatthias Ringwald if (hci_stack->inquiry_state != GAP_INQUIRY_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED; 9253a1df452eSMatthias Ringwald if ((duration_in_1280ms_units < GAP_INQUIRY_DURATION_MIN) || (duration_in_1280ms_units > GAP_INQUIRY_DURATION_MAX)){ 9254f5875de5SMatthias Ringwald return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS; 9255f5875de5SMatthias Ringwald } 9256f5875de5SMatthias Ringwald hci_stack->inquiry_state = duration_in_1280ms_units; 925730199e24SMatthias Ringwald hci_stack->inquiry_max_period_length = 0; 925830199e24SMatthias Ringwald hci_stack->inquiry_min_period_length = 0; 925930199e24SMatthias Ringwald hci_run(); 926030199e24SMatthias Ringwald return 0; 926130199e24SMatthias Ringwald } 926230199e24SMatthias Ringwald 926330199e24SMatthias Ringwald uint8_t gap_inquiry_periodic_start(uint8_t duration, uint16_t max_period_length, uint16_t min_period_length){ 926430199e24SMatthias Ringwald if (hci_stack->state != HCI_STATE_WORKING) return ERROR_CODE_COMMAND_DISALLOWED; 926530199e24SMatthias Ringwald if (hci_stack->inquiry_state != GAP_INQUIRY_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED; 926630199e24SMatthias Ringwald if (duration < GAP_INQUIRY_DURATION_MIN) return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS; 926730199e24SMatthias Ringwald if (duration > GAP_INQUIRY_DURATION_MAX) return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS; 926830199e24SMatthias Ringwald if (max_period_length < GAP_INQUIRY_MAX_PERIODIC_LEN_MIN) return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS;; 926930199e24SMatthias Ringwald if (min_period_length < GAP_INQUIRY_MIN_PERIODIC_LEN_MIN) return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS;; 927030199e24SMatthias Ringwald 927130199e24SMatthias Ringwald hci_stack->inquiry_state = duration; 927230199e24SMatthias Ringwald hci_stack->inquiry_max_period_length = max_period_length; 927330199e24SMatthias Ringwald hci_stack->inquiry_min_period_length = min_period_length; 9274f5875de5SMatthias Ringwald hci_run(); 9275f5875de5SMatthias Ringwald return 0; 9276f5875de5SMatthias Ringwald } 9277f5875de5SMatthias Ringwald 9278f5875de5SMatthias Ringwald /** 9279f5875de5SMatthias Ringwald * @brief Stop GAP Classic Inquiry 92806b65794dSMilanka Ringwald * @return 0 if ok 9281f5875de5SMatthias Ringwald */ 9282f5875de5SMatthias Ringwald int gap_inquiry_stop(void){ 9283a1df452eSMatthias Ringwald if ((hci_stack->inquiry_state >= GAP_INQUIRY_DURATION_MIN) && (hci_stack->inquiry_state <= GAP_INQUIRY_DURATION_MAX)) { 9284f5875de5SMatthias Ringwald // emit inquiry complete event, before it even started 9285f5875de5SMatthias Ringwald uint8_t event[] = { GAP_EVENT_INQUIRY_COMPLETE, 1, 0}; 9286f5875de5SMatthias Ringwald hci_emit_event(event, sizeof(event), 1); 9287f5875de5SMatthias Ringwald return 0; 9288f5875de5SMatthias Ringwald } 928930199e24SMatthias Ringwald switch (hci_stack->inquiry_state){ 929030199e24SMatthias Ringwald case GAP_INQUIRY_STATE_ACTIVE: 9291f5875de5SMatthias Ringwald hci_stack->inquiry_state = GAP_INQUIRY_STATE_W2_CANCEL; 9292f5875de5SMatthias Ringwald hci_run(); 929330199e24SMatthias Ringwald return ERROR_CODE_SUCCESS; 929430199e24SMatthias Ringwald case GAP_INQUIRY_STATE_PERIODIC: 929530199e24SMatthias Ringwald hci_stack->inquiry_state = GAP_INQUIRY_STATE_W2_EXIT_PERIODIC; 929630199e24SMatthias Ringwald hci_run(); 929730199e24SMatthias Ringwald return ERROR_CODE_SUCCESS; 929830199e24SMatthias Ringwald default: 929930199e24SMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 930030199e24SMatthias Ringwald } 9301f5875de5SMatthias Ringwald } 9302f5875de5SMatthias Ringwald 9303496bb884SMatthias Ringwald void gap_inquiry_set_lap(uint32_t lap){ 9304496bb884SMatthias Ringwald hci_stack->inquiry_lap = lap; 9305496bb884SMatthias Ringwald } 9306496bb884SMatthias Ringwald 93071dc973e7SMatthias Ringwald void gap_inquiry_set_scan_activity(uint16_t inquiry_scan_interval, uint16_t inquiry_scan_window){ 9308c0c8a829SMatthias Ringwald hci_stack->inquiry_scan_interval = inquiry_scan_interval; 9309c0c8a829SMatthias Ringwald hci_stack->inquiry_scan_window = inquiry_scan_window; 9310baa4881eSMatthias Ringwald hci_stack->gap_tasks_classic |= GAP_TASK_WRITE_INQUIRY_SCAN_ACTIVITY; 9311c0c8a829SMatthias Ringwald hci_run(); 9312c0c8a829SMatthias Ringwald } 9313c0c8a829SMatthias Ringwald 9314f50ed5acSAndrey Fominykh void gap_inquiry_set_transmit_power_level(int8_t tx_power) 9315f50ed5acSAndrey Fominykh { 9316f50ed5acSAndrey Fominykh hci_stack->inquiry_tx_power_level = tx_power; 9317f50ed5acSAndrey Fominykh hci_stack->gap_tasks_classic |= GAP_TASK_WRITE_INQUIRY_TX_POWER_LEVEL; 9318f50ed5acSAndrey Fominykh hci_run(); 9319f50ed5acSAndrey Fominykh } 9320f50ed5acSAndrey Fominykh 9321b7f1ee76SMatthias Ringwald 9322b7f1ee76SMatthias Ringwald /** 9323b7f1ee76SMatthias Ringwald * @brief Remote Name Request 9324b7f1ee76SMatthias Ringwald * @param addr 9325b7f1ee76SMatthias Ringwald * @param page_scan_repetition_mode 9326b7f1ee76SMatthias Ringwald * @param clock_offset only used when bit 15 is set 9327b7f1ee76SMatthias Ringwald * @events: HCI_EVENT_REMOTE_NAME_REQUEST_COMPLETE 9328b7f1ee76SMatthias Ringwald */ 9329667ba9d1SMatthias Ringwald int gap_remote_name_request(const bd_addr_t addr, uint8_t page_scan_repetition_mode, uint16_t clock_offset){ 9330b7f1ee76SMatthias Ringwald if (hci_stack->remote_name_state != GAP_REMOTE_NAME_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED; 93316535961aSMatthias Ringwald (void)memcpy(hci_stack->remote_name_addr, addr, 6); 9332b7f1ee76SMatthias Ringwald hci_stack->remote_name_page_scan_repetition_mode = page_scan_repetition_mode; 9333b7f1ee76SMatthias Ringwald hci_stack->remote_name_clock_offset = clock_offset; 9334b7f1ee76SMatthias Ringwald hci_stack->remote_name_state = GAP_REMOTE_NAME_STATE_W2_SEND; 9335b7f1ee76SMatthias Ringwald hci_run(); 9336b7f1ee76SMatthias Ringwald return 0; 9337b7f1ee76SMatthias Ringwald } 9338b7f1ee76SMatthias Ringwald 9339667ba9d1SMatthias Ringwald static int gap_pairing_set_state_and_run(const bd_addr_t addr, uint8_t state){ 93400a51f88bSMatthias Ringwald hci_stack->gap_pairing_state = state; 93416535961aSMatthias Ringwald (void)memcpy(hci_stack->gap_pairing_addr, addr, 6); 93420a51f88bSMatthias Ringwald hci_run(); 93430a51f88bSMatthias Ringwald return 0; 93440a51f88bSMatthias Ringwald } 93450a51f88bSMatthias Ringwald 93460a51f88bSMatthias Ringwald /** 9347aad97216SMatthias Ringwald * @brief Legacy Pairing Pin Code Response for binary data / non-strings 9348aad97216SMatthias Ringwald * @param addr 9349aad97216SMatthias Ringwald * @param pin_data 9350aad97216SMatthias Ringwald * @param pin_len 9351aad97216SMatthias Ringwald * @return 0 if ok 9352aad97216SMatthias Ringwald */ 9353667ba9d1SMatthias Ringwald int gap_pin_code_response_binary(const bd_addr_t addr, const uint8_t * pin_data, uint8_t pin_len){ 9354aad97216SMatthias Ringwald if (hci_stack->gap_pairing_state != GAP_PAIRING_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED; 9355c26f2c7bSMatthias Ringwald if (pin_len > PIN_CODE_LEN) return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS; 9356aad97216SMatthias Ringwald hci_stack->gap_pairing_input.gap_pairing_pin = pin_data; 9357aad97216SMatthias Ringwald hci_stack->gap_pairing_pin_len = pin_len; 9358aad97216SMatthias Ringwald return gap_pairing_set_state_and_run(addr, GAP_PAIRING_STATE_SEND_PIN); 9359aad97216SMatthias Ringwald } 9360aad97216SMatthias Ringwald 9361aad97216SMatthias Ringwald /** 93620a51f88bSMatthias Ringwald * @brief Legacy Pairing Pin Code Response 93630a51f88bSMatthias Ringwald * @param addr 93640a51f88bSMatthias Ringwald * @param pin 93650a51f88bSMatthias Ringwald * @return 0 if ok 93660a51f88bSMatthias Ringwald */ 9367667ba9d1SMatthias Ringwald int gap_pin_code_response(const bd_addr_t addr, const char * pin){ 93689d78a7ecSMatthias Ringwald return gap_pin_code_response_binary(addr, (const uint8_t*) pin, (uint8_t) strlen(pin)); 93690a51f88bSMatthias Ringwald } 93700a51f88bSMatthias Ringwald 93710a51f88bSMatthias Ringwald /** 93720a51f88bSMatthias Ringwald * @brief Abort Legacy Pairing 93730a51f88bSMatthias Ringwald * @param addr 93740a51f88bSMatthias Ringwald * @param pin 93750a51f88bSMatthias Ringwald * @return 0 if ok 93760a51f88bSMatthias Ringwald */ 93770a51f88bSMatthias Ringwald int gap_pin_code_negative(bd_addr_t addr){ 9378cd74063aSMatthias Ringwald if (hci_stack->gap_pairing_state != GAP_PAIRING_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED; 93790a51f88bSMatthias Ringwald return gap_pairing_set_state_and_run(addr, GAP_PAIRING_STATE_SEND_PIN_NEGATIVE); 93800a51f88bSMatthias Ringwald } 93810a51f88bSMatthias Ringwald 93820a51f88bSMatthias Ringwald /** 93830a51f88bSMatthias Ringwald * @brief SSP Passkey Response 93840a51f88bSMatthias Ringwald * @param addr 93850a51f88bSMatthias Ringwald * @param passkey 93860a51f88bSMatthias Ringwald * @return 0 if ok 93870a51f88bSMatthias Ringwald */ 9388667ba9d1SMatthias Ringwald int gap_ssp_passkey_response(const bd_addr_t addr, uint32_t passkey){ 9389cd74063aSMatthias Ringwald if (hci_stack->gap_pairing_state != GAP_PAIRING_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED; 9390d504181aSMatthias Ringwald hci_stack->gap_pairing_input.gap_pairing_passkey = passkey; 93910a51f88bSMatthias Ringwald return gap_pairing_set_state_and_run(addr, GAP_PAIRING_STATE_SEND_PASSKEY); 93920a51f88bSMatthias Ringwald } 93930a51f88bSMatthias Ringwald 93940a51f88bSMatthias Ringwald /** 93950a51f88bSMatthias Ringwald * @brief Abort SSP Passkey Entry/Pairing 93960a51f88bSMatthias Ringwald * @param addr 93970a51f88bSMatthias Ringwald * @param pin 93980a51f88bSMatthias Ringwald * @return 0 if ok 93990a51f88bSMatthias Ringwald */ 9400667ba9d1SMatthias Ringwald int gap_ssp_passkey_negative(const bd_addr_t addr){ 9401cd74063aSMatthias Ringwald if (hci_stack->gap_pairing_state != GAP_PAIRING_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED; 94020a51f88bSMatthias Ringwald return gap_pairing_set_state_and_run(addr, GAP_PAIRING_STATE_SEND_PASSKEY_NEGATIVE); 94030a51f88bSMatthias Ringwald } 94040a51f88bSMatthias Ringwald 94050a51f88bSMatthias Ringwald /** 94060a51f88bSMatthias Ringwald * @brief Accept SSP Numeric Comparison 94070a51f88bSMatthias Ringwald * @param addr 94080a51f88bSMatthias Ringwald * @param passkey 94090a51f88bSMatthias Ringwald * @return 0 if ok 94100a51f88bSMatthias Ringwald */ 9411667ba9d1SMatthias Ringwald int gap_ssp_confirmation_response(const bd_addr_t addr){ 9412cd74063aSMatthias Ringwald if (hci_stack->gap_pairing_state != GAP_PAIRING_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED; 94130a51f88bSMatthias Ringwald return gap_pairing_set_state_and_run(addr, GAP_PAIRING_STATE_SEND_CONFIRMATION); 94140a51f88bSMatthias Ringwald } 94150a51f88bSMatthias Ringwald 94160a51f88bSMatthias Ringwald /** 94170a51f88bSMatthias Ringwald * @brief Abort SSP Numeric Comparison/Pairing 94180a51f88bSMatthias Ringwald * @param addr 94190a51f88bSMatthias Ringwald * @param pin 94200a51f88bSMatthias Ringwald * @return 0 if ok 94210a51f88bSMatthias Ringwald */ 9422667ba9d1SMatthias Ringwald int gap_ssp_confirmation_negative(const bd_addr_t addr){ 9423cd74063aSMatthias Ringwald if (hci_stack->gap_pairing_state != GAP_PAIRING_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED; 94240a51f88bSMatthias Ringwald return gap_pairing_set_state_and_run(addr, GAP_PAIRING_STATE_SEND_CONFIRMATION_NEGATIVE); 94250a51f88bSMatthias Ringwald } 94260a51f88bSMatthias Ringwald 9427308eeaffSMatthias Ringwald #if defined(ENABLE_EXPLICIT_IO_CAPABILITIES_REPLY) || defined(ENABLE_EXPLICIT_LINK_KEY_REPLY) 942844565b0cSMatthias Ringwald static uint8_t gap_set_auth_flag_and_run(const bd_addr_t addr, hci_authentication_flags_t flag){ 942944565b0cSMatthias Ringwald hci_connection_t * conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL); 943044565b0cSMatthias Ringwald if (!conn) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 943144565b0cSMatthias Ringwald connectionSetAuthenticationFlags(conn, flag); 943244565b0cSMatthias Ringwald hci_run(); 943344565b0cSMatthias Ringwald return ERROR_CODE_SUCCESS; 943444565b0cSMatthias Ringwald } 9435308eeaffSMatthias Ringwald #endif 943644565b0cSMatthias Ringwald 9437308eeaffSMatthias Ringwald #ifdef ENABLE_EXPLICIT_IO_CAPABILITIES_REPLY 943844565b0cSMatthias Ringwald uint8_t gap_ssp_io_capabilities_response(const bd_addr_t addr){ 94397ca4a7edSMatthias Ringwald return gap_set_auth_flag_and_run(addr, AUTH_FLAG_SEND_IO_CAPABILITIES_REPLY); 944044565b0cSMatthias Ringwald } 944144565b0cSMatthias Ringwald 944244565b0cSMatthias Ringwald uint8_t gap_ssp_io_capabilities_negative(const bd_addr_t addr){ 94437ca4a7edSMatthias Ringwald return gap_set_auth_flag_and_run(addr, AUTH_FLAG_SEND_IO_CAPABILITIES_NEGATIVE_REPLY); 944444565b0cSMatthias Ringwald } 944544565b0cSMatthias Ringwald #endif 944644565b0cSMatthias Ringwald 94471849becdSMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB 94481849becdSMatthias Ringwald /** 94491849becdSMatthias Ringwald * @brief Report Remote OOB Data 94501849becdSMatthias Ringwald * @param bd_addr 94511849becdSMatthias Ringwald * @param c_192 Simple Pairing Hash C derived from P-192 public key 94521849becdSMatthias Ringwald * @param r_192 Simple Pairing Randomizer derived from P-192 public key 94531849becdSMatthias Ringwald * @param c_256 Simple Pairing Hash C derived from P-256 public key 94541849becdSMatthias Ringwald * @param r_256 Simple Pairing Randomizer derived from P-256 public key 94551849becdSMatthias Ringwald */ 94561849becdSMatthias Ringwald uint8_t gap_ssp_remote_oob_data(const bd_addr_t addr, const uint8_t * c_192, const uint8_t * r_192, const uint8_t * c_256, const uint8_t * r_256){ 94571849becdSMatthias Ringwald hci_connection_t * connection = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL); 94581849becdSMatthias Ringwald if (connection == NULL) { 94591849becdSMatthias Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 94601849becdSMatthias Ringwald } 94611849becdSMatthias Ringwald connection->classic_oob_c_192 = c_192; 94621849becdSMatthias Ringwald connection->classic_oob_r_192 = r_192; 9463204e8f1dSMatthias Ringwald 9464204e8f1dSMatthias Ringwald // ignore P-256 if not supported by us 9465204e8f1dSMatthias Ringwald if (hci_stack->secure_connections_active){ 94661849becdSMatthias Ringwald connection->classic_oob_c_256 = c_256; 94671849becdSMatthias Ringwald connection->classic_oob_r_256 = r_256; 9468204e8f1dSMatthias Ringwald } 9469204e8f1dSMatthias Ringwald 94701849becdSMatthias Ringwald return ERROR_CODE_SUCCESS; 94711849becdSMatthias Ringwald } 9472cf01e888SMatthias Ringwald /** 9473cf01e888SMatthias Ringwald * @brief Generate new OOB data 9474cf01e888SMatthias Ringwald * @note OOB data will be provided in GAP_EVENT_LOCAL_OOB_DATA and be used in future pairing procedures 9475cf01e888SMatthias Ringwald */ 9476cf01e888SMatthias Ringwald void gap_ssp_generate_oob_data(void){ 9477cf01e888SMatthias Ringwald hci_stack->classic_read_local_oob_data = true; 9478cf01e888SMatthias Ringwald hci_run(); 9479cf01e888SMatthias Ringwald } 9480cf01e888SMatthias Ringwald 94811849becdSMatthias Ringwald #endif 94821849becdSMatthias Ringwald 9483308eeaffSMatthias Ringwald #ifdef ENABLE_EXPLICIT_LINK_KEY_REPLY 9484308eeaffSMatthias Ringwald uint8_t gap_send_link_key_response(const bd_addr_t addr, link_key_t link_key, link_key_type_t type){ 9485308eeaffSMatthias Ringwald hci_connection_t * connection = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL); 9486308eeaffSMatthias Ringwald if (connection == NULL) { 9487308eeaffSMatthias Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 9488308eeaffSMatthias Ringwald } 9489308eeaffSMatthias Ringwald 9490308eeaffSMatthias Ringwald memcpy(connection->link_key, link_key, sizeof(link_key_t)); 9491308eeaffSMatthias Ringwald connection->link_key_type = type; 9492308eeaffSMatthias Ringwald 9493308eeaffSMatthias Ringwald return gap_set_auth_flag_and_run(addr, AUTH_FLAG_HANDLE_LINK_KEY_REQUEST); 9494308eeaffSMatthias Ringwald } 9495308eeaffSMatthias Ringwald 9496308eeaffSMatthias Ringwald #endif // ENABLE_EXPLICIT_LINK_KEY_REPLY 9497f5875de5SMatthias Ringwald /** 9498f6858d14SMatthias Ringwald * @brief Set inquiry mode: standard, with RSSI, with RSSI + Extended Inquiry Results. Has to be called before power on. 9499f5875de5SMatthias Ringwald * @param inquiry_mode see bluetooth_defines.h 9500f6858d14SMatthias Ringwald */ 9501b45b7749SMilanka Ringwald void hci_set_inquiry_mode(inquiry_mode_t inquiry_mode){ 9502b45b7749SMilanka Ringwald hci_stack->inquiry_mode = inquiry_mode; 9503f6858d14SMatthias Ringwald } 9504f6858d14SMatthias Ringwald 9505f6858d14SMatthias Ringwald /** 9506d950d659SMatthias Ringwald * @brief Configure Voice Setting for use with SCO data in HSP/HFP 9507d950d659SMatthias Ringwald */ 9508d950d659SMatthias Ringwald void hci_set_sco_voice_setting(uint16_t voice_setting){ 9509d950d659SMatthias Ringwald hci_stack->sco_voice_setting = voice_setting; 9510d950d659SMatthias Ringwald } 9511d950d659SMatthias Ringwald 9512d950d659SMatthias Ringwald /** 9513d950d659SMatthias Ringwald * @brief Get SCO Voice Setting 9514d950d659SMatthias Ringwald * @return current voice setting 9515d950d659SMatthias Ringwald */ 95160cb5b971SMatthias Ringwald uint16_t hci_get_sco_voice_setting(void){ 9517d950d659SMatthias Ringwald return hci_stack->sco_voice_setting; 9518d950d659SMatthias Ringwald } 9519d950d659SMatthias Ringwald 9520400ff5abSMatthias Ringwald static int hci_have_usb_transport(void){ 9521400ff5abSMatthias Ringwald if (!hci_stack->hci_transport) return 0; 9522400ff5abSMatthias Ringwald const char * transport_name = hci_stack->hci_transport->name; 9523400ff5abSMatthias Ringwald if (!transport_name) return 0; 9524400ff5abSMatthias Ringwald return (transport_name[0] == 'H') && (transport_name[1] == '2'); 9525400ff5abSMatthias Ringwald } 9526400ff5abSMatthias Ringwald 95279427aeb5SMatthias Ringwald static uint16_t hci_sco_packet_length_for_payload_length(uint16_t payload_size){ 952820dcdd22SMatthias Ringwald uint16_t sco_packet_length = 0; 9529cf119f3bSMatthias Ringwald 953091dfed7eSMatthias Ringwald #if defined(ENABLE_SCO_OVER_HCI) || defined (HAVE_SCO_TRANSPORT) 95316f28d2eeSMatthias Ringwald // Transparent = mSBC => 1, CVSD with 16-bit samples requires twice as much bytes 953273f498e7SMatthias Ringwald int multiplier; 953373f498e7SMatthias Ringwald if (((hci_stack->sco_voice_setting_active & 0x03) != 0x03) && 953473f498e7SMatthias Ringwald ((hci_stack->sco_voice_setting_active & 0x20) == 0x20)) { 953573f498e7SMatthias Ringwald multiplier = 2; 953673f498e7SMatthias Ringwald } else { 953773f498e7SMatthias Ringwald multiplier = 1; 953873f498e7SMatthias Ringwald } 953991dfed7eSMatthias Ringwald #endif 954091dfed7eSMatthias Ringwald 95419427aeb5SMatthias Ringwald #ifdef ENABLE_SCO_OVER_HCI 9542400ff5abSMatthias Ringwald if (hci_have_usb_transport()){ 9543400ff5abSMatthias Ringwald // see Core Spec for H2 USB Transfer. 9544cf119f3bSMatthias Ringwald // 3 byte SCO header + 24 bytes per connection 95459427aeb5SMatthias Ringwald // @note multiple sco connections not supported currently 95469427aeb5SMatthias Ringwald sco_packet_length = 3 + 24 * multiplier; 9547400ff5abSMatthias Ringwald } else { 95489427aeb5SMatthias Ringwald // 3 byte SCO header + SCO packet length over the air 95499427aeb5SMatthias Ringwald sco_packet_length = 3 + payload_size * multiplier; 9550d966a453SMatthias Ringwald // assert that it still fits inside an SCO buffer 9551ad915196SMatthias Ringwald if (sco_packet_length > (hci_stack->sco_data_packet_length + 3)){ 95529427aeb5SMatthias Ringwald sco_packet_length = 3 + hci_stack->sco_data_packet_length; 9553d966a453SMatthias Ringwald } 9554400ff5abSMatthias Ringwald } 9555a3069afeSMatthias Ringwald #endif 95565b7087c7SMatthias Ringwald #ifdef HAVE_SCO_TRANSPORT 95579427aeb5SMatthias Ringwald // 3 byte SCO header + SCO packet length over the air 95589427aeb5SMatthias Ringwald sco_packet_length = 3 + payload_size * multiplier; 95599427aeb5SMatthias Ringwald // assert that it still fits inside an SCO buffer 95609427aeb5SMatthias Ringwald if (sco_packet_length > (hci_stack->sco_data_packet_length + 3)){ 95619427aeb5SMatthias Ringwald sco_packet_length = 3 + hci_stack->sco_data_packet_length; 95629427aeb5SMatthias Ringwald } 95635b7087c7SMatthias Ringwald #endif 9564a3069afeSMatthias Ringwald return sco_packet_length; 9565b3aad8daSMatthias Ringwald } 9566b3aad8daSMatthias Ringwald 95679427aeb5SMatthias Ringwald uint16_t hci_get_sco_packet_length_for_connection(hci_con_handle_t sco_con_handle){ 95689427aeb5SMatthias Ringwald hci_connection_t * connection = hci_connection_for_handle(sco_con_handle); 95699427aeb5SMatthias Ringwald if (connection != NULL){ 95709427aeb5SMatthias Ringwald return hci_sco_packet_length_for_payload_length(connection->sco_payload_length); 95719427aeb5SMatthias Ringwald } 95729427aeb5SMatthias Ringwald return 0; 95739427aeb5SMatthias Ringwald } 95749427aeb5SMatthias Ringwald 95759427aeb5SMatthias Ringwald uint16_t hci_get_sco_packet_length(void){ 95769427aeb5SMatthias Ringwald btstack_linked_list_iterator_t it; 95779427aeb5SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->connections); 95789427aeb5SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 95799427aeb5SMatthias Ringwald hci_connection_t * connection = (hci_connection_t *) btstack_linked_list_iterator_next(&it); 95809427aeb5SMatthias Ringwald if ( connection->address_type == BD_ADDR_TYPE_SCO ) { 95819427aeb5SMatthias Ringwald return hci_sco_packet_length_for_payload_length(connection->sco_payload_length);; 95829427aeb5SMatthias Ringwald } 95839427aeb5SMatthias Ringwald } 95849427aeb5SMatthias Ringwald return 0; 95859427aeb5SMatthias Ringwald } 95869427aeb5SMatthias Ringwald 9587c4c88f1bSJakob Krantz /** 9588c4c88f1bSJakob Krantz * @brief Sets the master/slave policy 9589c4c88f1bSJakob Krantz * @param policy (0: attempt to become master, 1: let connecting device decide) 9590c4c88f1bSJakob Krantz */ 9591c4c88f1bSJakob Krantz void hci_set_master_slave_policy(uint8_t policy){ 9592c4c88f1bSJakob Krantz hci_stack->master_slave_policy = policy; 9593c4c88f1bSJakob Krantz } 9594c4c88f1bSJakob Krantz 9595c4c88f1bSJakob Krantz #endif 9596ec111c8bSMatthias Ringwald 9597ec111c8bSMatthias Ringwald HCI_STATE hci_get_state(void){ 9598ec111c8bSMatthias Ringwald return hci_stack->state; 9599ec111c8bSMatthias Ringwald } 9600ec111c8bSMatthias Ringwald 960107e010b6SMilanka Ringwald #ifdef ENABLE_CLASSIC 96025e91d96cSMatthias Ringwald void gap_register_classic_connection_filter(int (*accept_callback)(bd_addr_t addr, hci_link_type_t link_type)){ 960307e010b6SMilanka Ringwald hci_stack->gap_classic_accept_callback = accept_callback; 960407e010b6SMilanka Ringwald } 960507e010b6SMilanka Ringwald #endif 9606ec111c8bSMatthias Ringwald 9607d950d659SMatthias Ringwald /** 9608d23838ecSMatthias Ringwald * @brief Set callback for Bluetooth Hardware Error 9609d23838ecSMatthias Ringwald */ 9610c2e1fa60SMatthias Ringwald void hci_set_hardware_error_callback(void (*fn)(uint8_t error)){ 9611d23838ecSMatthias Ringwald hci_stack->hardware_error_callback = fn; 9612d23838ecSMatthias Ringwald } 9613d23838ecSMatthias Ringwald 961471de195eSMatthias Ringwald void hci_disconnect_all(void){ 9615665d90f2SMatthias Ringwald btstack_linked_list_iterator_t it; 9616665d90f2SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->connections); 9617665d90f2SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 9618665d90f2SMatthias Ringwald hci_connection_t * con = (hci_connection_t*) btstack_linked_list_iterator_next(&it); 961904a6ef8cSmatthias.ringwald if (con->state == SENT_DISCONNECT) continue; 962004a6ef8cSmatthias.ringwald con->state = SEND_DISCONNECT; 962104a6ef8cSmatthias.ringwald } 9622d31fba26S[email protected] hci_run(); 962304a6ef8cSmatthias.ringwald } 962433373e40SMatthias Ringwald 962533373e40SMatthias Ringwald uint16_t hci_get_manufacturer(void){ 962633373e40SMatthias Ringwald return hci_stack->manufacturer; 962733373e40SMatthias Ringwald } 96289c6e867eSMatthias Ringwald 96293e329ddfSandryblack #ifdef ENABLE_BLE 96309c6e867eSMatthias Ringwald static sm_connection_t * sm_get_connection_for_handle(hci_con_handle_t con_handle){ 96319c6e867eSMatthias Ringwald hci_connection_t * hci_con = hci_connection_for_handle(con_handle); 96329c6e867eSMatthias Ringwald if (!hci_con) return NULL; 96339c6e867eSMatthias Ringwald return &hci_con->sm_connection; 96349c6e867eSMatthias Ringwald } 96359c6e867eSMatthias Ringwald 96369c6e867eSMatthias Ringwald // extracted from sm.c to allow enabling of l2cap le data channels without adding sm.c to the build 96379c6e867eSMatthias Ringwald // without sm.c default values from create_connection_for_bd_addr_and_type() resulg in non-encrypted, not-authenticated 96386a79f6baSMatthias Ringwald #endif 96399c6e867eSMatthias Ringwald 96406d105c71SMatthias Ringwald uint8_t gap_encryption_key_size(hci_con_handle_t con_handle){ 9641c5fb5ca4SMatthias Ringwald hci_connection_t * hci_connection = hci_connection_for_handle(con_handle); 9642c5fb5ca4SMatthias Ringwald if (hci_connection == NULL) return 0; 9643c5fb5ca4SMatthias Ringwald if (hci_is_le_connection(hci_connection)){ 96446a79f6baSMatthias Ringwald #ifdef ENABLE_BLE 9645c5fb5ca4SMatthias Ringwald sm_connection_t * sm_conn = &hci_connection->sm_connection; 9646c7bead46SMatthias Ringwald if (sm_conn->sm_connection_encrypted != 0u) { 96479c6e867eSMatthias Ringwald return sm_conn->sm_actual_encryption_key_size; 96489c6e867eSMatthias Ringwald } 96496a79f6baSMatthias Ringwald #endif 96506a79f6baSMatthias Ringwald } else { 9651c5fb5ca4SMatthias Ringwald #ifdef ENABLE_CLASSIC 96528daf94bcSMatthias Ringwald if ((hci_connection->authentication_flags & AUTH_FLAG_CONNECTION_ENCRYPTED)){ 9653c5fb5ca4SMatthias Ringwald return hci_connection->encryption_key_size; 9654c5fb5ca4SMatthias Ringwald } 9655c5fb5ca4SMatthias Ringwald #endif 96566a79f6baSMatthias Ringwald } 9657c5fb5ca4SMatthias Ringwald return 0; 9658c5fb5ca4SMatthias Ringwald } 96599c6e867eSMatthias Ringwald 9660ff3f1026SMatthias Ringwald bool gap_authenticated(hci_con_handle_t con_handle){ 9661c5fb5ca4SMatthias Ringwald hci_connection_t * hci_connection = hci_connection_for_handle(con_handle); 9662ff3f1026SMatthias Ringwald if (hci_connection == NULL) return false; 96635f3981bfSMatthias Ringwald 9664c5fb5ca4SMatthias Ringwald switch (hci_connection->address_type){ 96656a79f6baSMatthias Ringwald #ifdef ENABLE_BLE 96665f3981bfSMatthias Ringwald case BD_ADDR_TYPE_LE_PUBLIC: 96675f3981bfSMatthias Ringwald case BD_ADDR_TYPE_LE_RANDOM: 9668d9e1bf33SMatthias Ringwald case BD_ADDR_TYPE_LE_PUBLIC_IDENTITY: 9669d9e1bf33SMatthias Ringwald case BD_ADDR_TYPE_LE_RANDOM_IDENTITY: 9670c5fb5ca4SMatthias Ringwald if (hci_connection->sm_connection.sm_connection_encrypted == 0) return 0; // unencrypted connection cannot be authenticated 9671ff3f1026SMatthias Ringwald return hci_connection->sm_connection.sm_connection_authenticated != 0; 96726a79f6baSMatthias Ringwald #endif 967359a1a47aSMatthias Ringwald #ifdef ENABLE_CLASSIC 96745f3981bfSMatthias Ringwald case BD_ADDR_TYPE_SCO: 9675f16129ceSMatthias Ringwald case BD_ADDR_TYPE_ACL: 9676ff3f1026SMatthias Ringwald return gap_authenticated_for_link_key_type(hci_connection->link_key_type); 967759a1a47aSMatthias Ringwald #endif 96785f3981bfSMatthias Ringwald default: 9679ff3f1026SMatthias Ringwald return false; 96805f3981bfSMatthias Ringwald } 96819c6e867eSMatthias Ringwald } 96829c6e867eSMatthias Ringwald 9683f461b3dfSMatthias Ringwald bool gap_secure_connection(hci_con_handle_t con_handle){ 9684c5fb5ca4SMatthias Ringwald hci_connection_t * hci_connection = hci_connection_for_handle(con_handle); 9685c5fb5ca4SMatthias Ringwald if (hci_connection == NULL) return 0; 96868b35e16aSMatthias Ringwald 9687c5fb5ca4SMatthias Ringwald switch (hci_connection->address_type){ 96886a79f6baSMatthias Ringwald #ifdef ENABLE_BLE 96898b35e16aSMatthias Ringwald case BD_ADDR_TYPE_LE_PUBLIC: 96908b35e16aSMatthias Ringwald case BD_ADDR_TYPE_LE_RANDOM: 9691d9e1bf33SMatthias Ringwald case BD_ADDR_TYPE_LE_PUBLIC_IDENTITY: 9692d9e1bf33SMatthias Ringwald case BD_ADDR_TYPE_LE_RANDOM_IDENTITY: 9693f461b3dfSMatthias Ringwald if (hci_connection->sm_connection.sm_connection_encrypted == 0) return false; // unencrypted connection cannot be authenticated 9694d7dbf891SMatthias Ringwald return hci_connection->sm_connection.sm_connection_sc; 96956a79f6baSMatthias Ringwald #endif 969659a1a47aSMatthias Ringwald #ifdef ENABLE_CLASSIC 96978b35e16aSMatthias Ringwald case BD_ADDR_TYPE_SCO: 9698f16129ceSMatthias Ringwald case BD_ADDR_TYPE_ACL: 9699f461b3dfSMatthias Ringwald return gap_secure_connection_for_link_key_type(hci_connection->link_key_type); 970059a1a47aSMatthias Ringwald #endif 97018b35e16aSMatthias Ringwald default: 9702f461b3dfSMatthias Ringwald return false; 97038b35e16aSMatthias Ringwald } 9704f1dfbe18SMatthias Ringwald } 9705f1dfbe18SMatthias Ringwald 97061e122704SMatthias Ringwald bool gap_bonded(hci_con_handle_t con_handle){ 97071e122704SMatthias Ringwald hci_connection_t * hci_connection = hci_connection_for_handle(con_handle); 97081e122704SMatthias Ringwald if (hci_connection == NULL) return 0; 97091e122704SMatthias Ringwald 971048f33f37SMatthias Ringwald #ifdef ENABLE_CLASSIC 97111e122704SMatthias Ringwald link_key_t link_key; 97121e122704SMatthias Ringwald link_key_type_t link_key_type; 971348f33f37SMatthias Ringwald #endif 97141e122704SMatthias Ringwald switch (hci_connection->address_type){ 97156a79f6baSMatthias Ringwald #ifdef ENABLE_BLE 97161e122704SMatthias Ringwald case BD_ADDR_TYPE_LE_PUBLIC: 97171e122704SMatthias Ringwald case BD_ADDR_TYPE_LE_RANDOM: 9718d9e1bf33SMatthias Ringwald case BD_ADDR_TYPE_LE_PUBLIC_IDENTITY: 9719d9e1bf33SMatthias Ringwald case BD_ADDR_TYPE_LE_RANDOM_IDENTITY: 97201e122704SMatthias Ringwald return hci_connection->sm_connection.sm_le_db_index >= 0; 97216a79f6baSMatthias Ringwald #endif 97221e122704SMatthias Ringwald #ifdef ENABLE_CLASSIC 97231e122704SMatthias Ringwald case BD_ADDR_TYPE_SCO: 97241e122704SMatthias Ringwald case BD_ADDR_TYPE_ACL: 97251e122704SMatthias Ringwald return hci_stack->link_key_db && hci_stack->link_key_db->get_link_key(hci_connection->address, link_key, &link_key_type); 97261e122704SMatthias Ringwald #endif 97271e122704SMatthias Ringwald default: 97281e122704SMatthias Ringwald return false; 97291e122704SMatthias Ringwald } 97301e122704SMatthias Ringwald } 97311e122704SMatthias Ringwald 97326a79f6baSMatthias Ringwald #ifdef ENABLE_BLE 97339c6e867eSMatthias Ringwald authorization_state_t gap_authorization_state(hci_con_handle_t con_handle){ 97349c6e867eSMatthias Ringwald sm_connection_t * sm_conn = sm_get_connection_for_handle(con_handle); 9735c7bead46SMatthias Ringwald if (sm_conn == NULL) return AUTHORIZATION_UNKNOWN; // wrong connection 9736c7bead46SMatthias Ringwald if (sm_conn->sm_connection_encrypted == 0u) return AUTHORIZATION_UNKNOWN; // unencrypted connection cannot be authorized 9737c7bead46SMatthias Ringwald if (sm_conn->sm_connection_authenticated == 0u) return AUTHORIZATION_UNKNOWN; // unauthenticatd connection cannot be authorized 97389c6e867eSMatthias Ringwald return sm_conn->sm_connection_authorization_state; 97399c6e867eSMatthias Ringwald } 97409c6e867eSMatthias Ringwald #endif 9741f8ee3071SMatthias Ringwald 9742f8ee3071SMatthias Ringwald #ifdef ENABLE_CLASSIC 9743f8ee3071SMatthias Ringwald uint8_t gap_sniff_mode_enter(hci_con_handle_t con_handle, uint16_t sniff_min_interval, uint16_t sniff_max_interval, uint16_t sniff_attempt, uint16_t sniff_timeout){ 9744f8ee3071SMatthias Ringwald hci_connection_t * conn = hci_connection_for_handle(con_handle); 97457f839e2cSMatthias Ringwald if (!conn) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 9746f8ee3071SMatthias Ringwald conn->sniff_min_interval = sniff_min_interval; 9747f8ee3071SMatthias Ringwald conn->sniff_max_interval = sniff_max_interval; 9748f8ee3071SMatthias Ringwald conn->sniff_attempt = sniff_attempt; 9749f8ee3071SMatthias Ringwald conn->sniff_timeout = sniff_timeout; 9750f8ee3071SMatthias Ringwald hci_run(); 9751f8ee3071SMatthias Ringwald return 0; 9752f8ee3071SMatthias Ringwald } 9753f8ee3071SMatthias Ringwald 9754f8ee3071SMatthias Ringwald /** 9755f8ee3071SMatthias Ringwald * @brief Exit Sniff mode 9756f8ee3071SMatthias Ringwald * @param con_handle 9757f8ee3071SMatthias Ringwald @ @return 0 if ok 9758f8ee3071SMatthias Ringwald */ 9759f8ee3071SMatthias Ringwald uint8_t gap_sniff_mode_exit(hci_con_handle_t con_handle){ 9760f8ee3071SMatthias Ringwald hci_connection_t * conn = hci_connection_for_handle(con_handle); 97617f839e2cSMatthias Ringwald if (!conn) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 9762f8ee3071SMatthias Ringwald conn->sniff_min_interval = 0xffff; 9763f8ee3071SMatthias Ringwald hci_run(); 9764f8ee3071SMatthias Ringwald return 0; 9765f8ee3071SMatthias Ringwald } 9766bea424a5SMatthias Ringwald 9767140c0557SMatthias Ringwald uint8_t gap_sniff_subrating_configure(hci_con_handle_t con_handle, uint16_t max_latency, uint16_t min_remote_timeout, uint16_t min_local_timeout){ 9768140c0557SMatthias Ringwald hci_connection_t * conn = hci_connection_for_handle(con_handle); 97697f839e2cSMatthias Ringwald if (!conn) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 9770140c0557SMatthias Ringwald conn->sniff_subrating_max_latency = max_latency; 9771140c0557SMatthias Ringwald conn->sniff_subrating_min_remote_timeout = min_remote_timeout; 9772140c0557SMatthias Ringwald conn->sniff_subrating_min_local_timeout = min_local_timeout; 9773140c0557SMatthias Ringwald hci_run(); 9774dc8d5bd3SMatthias Ringwald return ERROR_CODE_SUCCESS; 9775140c0557SMatthias Ringwald } 9776140c0557SMatthias Ringwald 9777278ff8a9SMatthias Ringwald uint8_t gap_qos_set(hci_con_handle_t con_handle, hci_service_type_t service_type, uint32_t token_rate, uint32_t peak_bandwidth, uint32_t latency, uint32_t delay_variation){ 9778278ff8a9SMatthias Ringwald hci_connection_t * conn = hci_connection_for_handle(con_handle); 97797f839e2cSMatthias Ringwald if (!conn) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 9780278ff8a9SMatthias Ringwald conn->qos_service_type = service_type; 9781278ff8a9SMatthias Ringwald conn->qos_token_rate = token_rate; 9782278ff8a9SMatthias Ringwald conn->qos_peak_bandwidth = peak_bandwidth; 9783278ff8a9SMatthias Ringwald conn->qos_latency = latency; 9784278ff8a9SMatthias Ringwald conn->qos_delay_variation = delay_variation; 9785278ff8a9SMatthias Ringwald hci_run(); 9786278ff8a9SMatthias Ringwald return ERROR_CODE_SUCCESS; 9787278ff8a9SMatthias Ringwald } 9788278ff8a9SMatthias Ringwald 9789bea424a5SMatthias Ringwald void gap_set_page_scan_activity(uint16_t page_scan_interval, uint16_t page_scan_window){ 9790bea424a5SMatthias Ringwald hci_stack->new_page_scan_interval = page_scan_interval; 9791bea424a5SMatthias Ringwald hci_stack->new_page_scan_window = page_scan_window; 9792baa4881eSMatthias Ringwald hci_stack->gap_tasks_classic |= GAP_TASK_WRITE_PAGE_SCAN_ACTIVITY; 9793bea424a5SMatthias Ringwald hci_run(); 9794bea424a5SMatthias Ringwald } 9795bea424a5SMatthias Ringwald 9796bea424a5SMatthias Ringwald void gap_set_page_scan_type(page_scan_type_t page_scan_type){ 9797bea424a5SMatthias Ringwald hci_stack->new_page_scan_type = (uint8_t) page_scan_type; 9798baa4881eSMatthias Ringwald hci_stack->gap_tasks_classic |= GAP_TASK_WRITE_PAGE_SCAN_TYPE; 9799bea424a5SMatthias Ringwald hci_run(); 9800bea424a5SMatthias Ringwald } 9801bea424a5SMatthias Ringwald 980232a12730SMatthias Ringwald void gap_set_page_timeout(uint16_t page_timeout){ 980332a12730SMatthias Ringwald hci_stack->page_timeout = page_timeout; 9804baa4881eSMatthias Ringwald hci_stack->gap_tasks_classic |= GAP_TASK_WRITE_PAGE_TIMEOUT; 980532a12730SMatthias Ringwald hci_run(); 980632a12730SMatthias Ringwald } 980732a12730SMatthias Ringwald 9808f8ee3071SMatthias Ringwald #endif 9809beceeddeSMatthias Ringwald 981021debf25SMatthias Ringwald #ifdef ENABLE_LE_PRIVACY_ADDRESS_RESOLUTION 981121debf25SMatthias Ringwald void hci_load_le_device_db_entry_into_resolving_list(uint16_t le_device_db_index){ 981221debf25SMatthias Ringwald if (le_device_db_index >= MAX_NUM_RESOLVING_LIST_ENTRIES) return; 981321debf25SMatthias Ringwald if (le_device_db_index >= le_device_db_max_count()) return; 981421debf25SMatthias Ringwald uint8_t offset = le_device_db_index >> 3; 981521debf25SMatthias Ringwald uint8_t mask = 1 << (le_device_db_index & 7); 981602b02cffSMatthias Ringwald hci_stack->le_resolving_list_add_entries[offset] |= mask; 9817e8ca66c6SMatthias Ringwald hci_stack->le_resolving_list_set_privacy_mode[offset] |= mask; 981821debf25SMatthias Ringwald if (hci_stack->le_resolving_list_state == LE_RESOLVING_LIST_DONE){ 981902b02cffSMatthias Ringwald // note: go back to remove entries, otherwise, a remove + add will skip the add 98205f3ccd83SMatthias Ringwald hci_stack->le_resolving_list_state = LE_RESOLVING_LIST_UPDATES_ENTRIES; 982102b02cffSMatthias Ringwald } 982202b02cffSMatthias Ringwald } 982302b02cffSMatthias Ringwald 982402b02cffSMatthias Ringwald void hci_remove_le_device_db_entry_from_resolving_list(uint16_t le_device_db_index){ 982502b02cffSMatthias Ringwald if (le_device_db_index >= MAX_NUM_RESOLVING_LIST_ENTRIES) return; 982602b02cffSMatthias Ringwald if (le_device_db_index >= le_device_db_max_count()) return; 982702b02cffSMatthias Ringwald uint8_t offset = le_device_db_index >> 3; 982802b02cffSMatthias Ringwald uint8_t mask = 1 << (le_device_db_index & 7); 982902b02cffSMatthias Ringwald hci_stack->le_resolving_list_remove_entries[offset] |= mask; 983002b02cffSMatthias Ringwald if (hci_stack->le_resolving_list_state == LE_RESOLVING_LIST_DONE){ 98315f3ccd83SMatthias Ringwald hci_stack->le_resolving_list_state = LE_RESOLVING_LIST_UPDATES_ENTRIES; 983221debf25SMatthias Ringwald } 983321debf25SMatthias Ringwald } 9834cf38a091SMatthias Ringwald 9835cf38a091SMatthias Ringwald uint8_t gap_load_resolving_list_from_le_device_db(void){ 98361ffa425cSMatthias Ringwald if (hci_command_supported(SUPPORTED_HCI_COMMAND_LE_SET_ADDRESS_RESOLUTION_ENABLE) == false){ 9837cf38a091SMatthias Ringwald return ERROR_CODE_UNSUPPORTED_FEATURE_OR_PARAMETER_VALUE; 9838cf38a091SMatthias Ringwald } 9839cf38a091SMatthias Ringwald if (hci_stack->le_resolving_list_state != LE_RESOLVING_LIST_SEND_ENABLE_ADDRESS_RESOLUTION){ 9840cf38a091SMatthias Ringwald // restart le resolving list update 9841cf38a091SMatthias Ringwald hci_stack->le_resolving_list_state = LE_RESOLVING_LIST_READ_SIZE; 9842cf38a091SMatthias Ringwald } 9843cf38a091SMatthias Ringwald return ERROR_CODE_SUCCESS; 9844cf38a091SMatthias Ringwald } 9845c3d19a30SMatthias Ringwald 9846c3d19a30SMatthias Ringwald void gap_set_peer_privacy_mode(le_privacy_mode_t privacy_mode ){ 9847c3d19a30SMatthias Ringwald hci_stack->le_privacy_mode = privacy_mode; 9848c3d19a30SMatthias Ringwald } 984921debf25SMatthias Ringwald #endif 985021debf25SMatthias Ringwald 9851f40c73b4SMatthias Ringwald #ifdef ENABLE_BLE 9852f40c73b4SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 9853f40c73b4SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 9854f40c73b4SMatthias Ringwald 9855f40c73b4SMatthias Ringwald static uint8_t hci_periodic_advertiser_list_add(bd_addr_type_t address_type, const bd_addr_t address, uint8_t advertising_sid){ 9856100da355SMatthias Ringwald 9857100da355SMatthias Ringwald #if !defined(HAVE_MALLOC) && (!defined(MAX_NR_PERIODIC_ADVERTISER_LIST_ENTRIES) || (MAX_NR_PERIODIC_ADVERTISER_LIST_ENTRIES == 0)) 9858100da355SMatthias Ringwald // incorrect configuration: 9859100da355SMatthias Ringwald // - as MAX_NR_PERIODIC_ADVERTISER_LIST_ENTRIES is not defined or zero this function always fails 9860100da355SMatthias Ringwald // - please set MAX_NR_PERIODIC_ADVERTISER_LIST_ENTRIES in btstack_config.h 9861100da355SMatthias Ringwald btstack_assert(false); 9862100da355SMatthias Ringwald #endif 9863100da355SMatthias Ringwald 9864f40c73b4SMatthias Ringwald // check if already in list 9865f40c73b4SMatthias Ringwald btstack_linked_list_iterator_t it; 9866f40c73b4SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->le_periodic_advertiser_list); 9867f40c73b4SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)) { 9868f40c73b4SMatthias Ringwald periodic_advertiser_list_entry_t *entry = (periodic_advertiser_list_entry_t *) btstack_linked_list_iterator_next(&it); 9869f40c73b4SMatthias Ringwald if (entry->sid != advertising_sid) { 9870f40c73b4SMatthias Ringwald continue; 9871f40c73b4SMatthias Ringwald } 9872f40c73b4SMatthias Ringwald if (entry->address_type != address_type) { 9873f40c73b4SMatthias Ringwald continue; 9874f40c73b4SMatthias Ringwald } 9875f40c73b4SMatthias Ringwald if (memcmp(entry->address, address, 6) != 0) { 9876f40c73b4SMatthias Ringwald continue; 9877f40c73b4SMatthias Ringwald } 9878f40c73b4SMatthias Ringwald // disallow if already scheduled to add 9879f40c73b4SMatthias Ringwald if ((entry->state & LE_PERIODIC_ADVERTISER_LIST_ENTRY_ADD_TO_CONTROLLER) != 0){ 9880f40c73b4SMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 9881f40c73b4SMatthias Ringwald } 9882f40c73b4SMatthias Ringwald // still on controller, but scheduled to remove -> re-add 9883f40c73b4SMatthias Ringwald entry->state |= LE_PERIODIC_ADVERTISER_LIST_ENTRY_ADD_TO_CONTROLLER; 9884f40c73b4SMatthias Ringwald return ERROR_CODE_SUCCESS; 9885f40c73b4SMatthias Ringwald } 9886f40c73b4SMatthias Ringwald // alloc and add to list 9887f40c73b4SMatthias Ringwald periodic_advertiser_list_entry_t * entry = btstack_memory_periodic_advertiser_list_entry_get(); 9888f40c73b4SMatthias Ringwald if (!entry) return BTSTACK_MEMORY_ALLOC_FAILED; 9889f40c73b4SMatthias Ringwald entry->sid = advertising_sid; 9890f40c73b4SMatthias Ringwald entry->address_type = address_type; 9891f40c73b4SMatthias Ringwald (void)memcpy(entry->address, address, 6); 9892f40c73b4SMatthias Ringwald entry->state = LE_PERIODIC_ADVERTISER_LIST_ENTRY_ADD_TO_CONTROLLER; 9893f40c73b4SMatthias Ringwald btstack_linked_list_add(&hci_stack->le_periodic_advertiser_list, (btstack_linked_item_t*) entry); 9894f40c73b4SMatthias Ringwald return ERROR_CODE_SUCCESS; 9895f40c73b4SMatthias Ringwald } 9896f40c73b4SMatthias Ringwald 9897f40c73b4SMatthias Ringwald static uint8_t hci_periodic_advertiser_list_remove(bd_addr_type_t address_type, const bd_addr_t address, uint8_t advertising_sid){ 9898f40c73b4SMatthias Ringwald btstack_linked_list_iterator_t it; 9899f40c73b4SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->le_periodic_advertiser_list); 9900f40c73b4SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 9901f40c73b4SMatthias Ringwald periodic_advertiser_list_entry_t * entry = (periodic_advertiser_list_entry_t*) btstack_linked_list_iterator_next(&it); 9902f40c73b4SMatthias Ringwald if (entry->sid != advertising_sid) { 9903f40c73b4SMatthias Ringwald continue; 9904f40c73b4SMatthias Ringwald } 9905f40c73b4SMatthias Ringwald if (entry->address_type != address_type) { 9906f40c73b4SMatthias Ringwald continue; 9907f40c73b4SMatthias Ringwald } 9908f40c73b4SMatthias Ringwald if (memcmp(entry->address, address, 6) != 0) { 9909f40c73b4SMatthias Ringwald continue; 9910f40c73b4SMatthias Ringwald } 9911f40c73b4SMatthias Ringwald if (entry->state & LE_PERIODIC_ADVERTISER_LIST_ENTRY_ON_CONTROLLER){ 9912f40c73b4SMatthias Ringwald // remove from controller if already present 9913f40c73b4SMatthias Ringwald entry->state |= LE_PERIODIC_ADVERTISER_LIST_ENTRY_REMOVE_FROM_CONTROLLER; 9914f40c73b4SMatthias Ringwald } else { 9915f40c73b4SMatthias Ringwald // directly remove entry from whitelist 9916f40c73b4SMatthias Ringwald btstack_linked_list_iterator_remove(&it); 9917f40c73b4SMatthias Ringwald btstack_memory_periodic_advertiser_list_entry_free(entry); 9918f40c73b4SMatthias Ringwald } 9919f40c73b4SMatthias Ringwald return ERROR_CODE_SUCCESS; 9920f40c73b4SMatthias Ringwald } 9921f40c73b4SMatthias Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 9922f40c73b4SMatthias Ringwald } 9923f40c73b4SMatthias Ringwald 9924f40c73b4SMatthias Ringwald static void hci_periodic_advertiser_list_clear(void){ 9925f40c73b4SMatthias Ringwald btstack_linked_list_iterator_t it; 9926f40c73b4SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->le_periodic_advertiser_list); 9927f40c73b4SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 9928f40c73b4SMatthias Ringwald periodic_advertiser_list_entry_t * entry = (periodic_advertiser_list_entry_t*) btstack_linked_list_iterator_next(&it); 9929f40c73b4SMatthias Ringwald if (entry->state & LE_PERIODIC_ADVERTISER_LIST_ENTRY_ON_CONTROLLER){ 9930f40c73b4SMatthias Ringwald // remove from controller if already present 9931f40c73b4SMatthias Ringwald entry->state |= LE_PERIODIC_ADVERTISER_LIST_ENTRY_REMOVE_FROM_CONTROLLER; 9932f40c73b4SMatthias Ringwald continue; 9933f40c73b4SMatthias Ringwald } 9934f40c73b4SMatthias Ringwald // directly remove entry from whitelist 9935f40c73b4SMatthias Ringwald btstack_linked_list_iterator_remove(&it); 9936f40c73b4SMatthias Ringwald btstack_memory_periodic_advertiser_list_entry_free(entry); 9937f40c73b4SMatthias Ringwald } 9938f40c73b4SMatthias Ringwald } 9939f40c73b4SMatthias Ringwald 9940f40c73b4SMatthias Ringwald uint8_t gap_periodic_advertiser_list_clear(void){ 9941f40c73b4SMatthias Ringwald hci_periodic_advertiser_list_clear(); 9942f40c73b4SMatthias Ringwald hci_run(); 9943f40c73b4SMatthias Ringwald return ERROR_CODE_SUCCESS; 9944f40c73b4SMatthias Ringwald } 9945f40c73b4SMatthias Ringwald 9946f40c73b4SMatthias Ringwald uint8_t gap_periodic_advertiser_list_add(bd_addr_type_t address_type, const bd_addr_t address, uint8_t advertising_sid){ 9947f40c73b4SMatthias Ringwald uint8_t status = hci_periodic_advertiser_list_add(address_type, address, advertising_sid); 9948f40c73b4SMatthias Ringwald if (status){ 9949f40c73b4SMatthias Ringwald return status; 9950f40c73b4SMatthias Ringwald } 9951f40c73b4SMatthias Ringwald hci_run(); 9952f40c73b4SMatthias Ringwald return ERROR_CODE_SUCCESS; 9953f40c73b4SMatthias Ringwald } 9954f40c73b4SMatthias Ringwald 9955f40c73b4SMatthias Ringwald uint8_t gap_periodic_advertiser_list_remove(bd_addr_type_t address_type, const bd_addr_t address, uint8_t advertising_sid){ 9956f40c73b4SMatthias Ringwald uint8_t status = hci_periodic_advertiser_list_remove(address_type, address, advertising_sid); 9957f40c73b4SMatthias Ringwald if (status){ 9958f40c73b4SMatthias Ringwald return status; 9959f40c73b4SMatthias Ringwald } 9960f40c73b4SMatthias Ringwald hci_run(); 9961f40c73b4SMatthias Ringwald return ERROR_CODE_SUCCESS; 9962f40c73b4SMatthias Ringwald } 99634bafedd5SMatthias Ringwald 99644bafedd5SMatthias Ringwald uint8_t gap_periodic_advertising_create_sync(uint8_t options, uint8_t advertising_sid, bd_addr_type_t advertiser_address_type, 99654bafedd5SMatthias Ringwald bd_addr_t advertiser_address, uint16_t skip, uint16_t sync_timeout, uint8_t sync_cte_type){ 99664bafedd5SMatthias Ringwald // abort if already active 99674bafedd5SMatthias Ringwald if (hci_stack->le_periodic_sync_request != LE_CONNECTING_IDLE) { 99684bafedd5SMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 99694bafedd5SMatthias Ringwald } 99704bafedd5SMatthias Ringwald // store request 99714bafedd5SMatthias Ringwald hci_stack->le_periodic_sync_request = ((options & 0) != 0) ? LE_CONNECTING_WHITELIST : LE_CONNECTING_DIRECT; 99724bafedd5SMatthias Ringwald hci_stack->le_periodic_sync_options = options; 99734bafedd5SMatthias Ringwald hci_stack->le_periodic_sync_advertising_sid = advertising_sid; 99744bafedd5SMatthias Ringwald hci_stack->le_periodic_sync_advertiser_address_type = advertiser_address_type; 99754bafedd5SMatthias Ringwald memcpy(hci_stack->le_periodic_sync_advertiser_address, advertiser_address, 6); 99764bafedd5SMatthias Ringwald hci_stack->le_periodic_sync_skip = skip; 99774bafedd5SMatthias Ringwald hci_stack->le_periodic_sync_timeout = sync_timeout; 99784bafedd5SMatthias Ringwald hci_stack->le_periodic_sync_cte_type = sync_cte_type; 99794bafedd5SMatthias Ringwald 99804bafedd5SMatthias Ringwald hci_run(); 99814bafedd5SMatthias Ringwald return ERROR_CODE_SUCCESS; 99824bafedd5SMatthias Ringwald } 99834bafedd5SMatthias Ringwald 99844bafedd5SMatthias Ringwald uint8_t gap_periodic_advertising_create_sync_cancel(void){ 99854bafedd5SMatthias Ringwald // abort if not requested 99864bafedd5SMatthias Ringwald if (hci_stack->le_periodic_sync_request == LE_CONNECTING_IDLE) { 99874bafedd5SMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 99884bafedd5SMatthias Ringwald } 99894bafedd5SMatthias Ringwald hci_stack->le_periodic_sync_request = LE_CONNECTING_IDLE; 99904bafedd5SMatthias Ringwald hci_run(); 99914bafedd5SMatthias Ringwald return ERROR_CODE_SUCCESS; 99924bafedd5SMatthias Ringwald } 99934bafedd5SMatthias Ringwald 99944bafedd5SMatthias Ringwald uint8_t gap_periodic_advertising_terminate_sync(uint16_t sync_handle){ 999549a6c69cSMatthias Ringwald if (hci_stack->le_periodic_terminate_sync_handle != HCI_CON_HANDLE_INVALID){ 999649a6c69cSMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 999749a6c69cSMatthias Ringwald } 999849a6c69cSMatthias Ringwald hci_stack->le_periodic_terminate_sync_handle = sync_handle; 999949a6c69cSMatthias Ringwald hci_run(); 1000049a6c69cSMatthias Ringwald return ERROR_CODE_SUCCESS; 100014bafedd5SMatthias Ringwald } 100024bafedd5SMatthias Ringwald 10003f40c73b4SMatthias Ringwald #endif 10004f40c73b4SMatthias Ringwald #endif 100054ae8623eSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS 10006969d876aSMatthias Ringwald static hci_iso_stream_t * 10007969d876aSMatthias Ringwald hci_iso_stream_create(hci_iso_type_t iso_type, hci_iso_stream_state_t state, uint8_t group_id, uint8_t stream_id) { 100084ae8623eSMatthias Ringwald hci_iso_stream_t * iso_stream = btstack_memory_hci_iso_stream_get(); 10009969d876aSMatthias Ringwald if (iso_stream != NULL){ 100108d72db10SMatthias Ringwald iso_stream->iso_type = iso_type; 1001126b93350SMatthias Ringwald iso_stream->state = state; 100128d72db10SMatthias Ringwald iso_stream->group_id = group_id; 10013969d876aSMatthias Ringwald iso_stream->stream_id = stream_id; 10014969d876aSMatthias Ringwald iso_stream->cis_handle = HCI_CON_HANDLE_INVALID; 10015969d876aSMatthias Ringwald iso_stream->acl_handle = HCI_CON_HANDLE_INVALID; 100164ae8623eSMatthias Ringwald btstack_linked_list_add(&hci_stack->iso_streams, (btstack_linked_item_t*) iso_stream); 100174ae8623eSMatthias Ringwald } 10018969d876aSMatthias Ringwald return iso_stream; 100194ae8623eSMatthias Ringwald } 100204ae8623eSMatthias Ringwald 1002115a15be3SMatthias Ringwald static hci_iso_stream_t * hci_iso_stream_for_con_handle(hci_con_handle_t con_handle){ 100224ae8623eSMatthias Ringwald btstack_linked_list_iterator_t it; 100234ae8623eSMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->iso_streams); 100244ae8623eSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 100254ae8623eSMatthias Ringwald hci_iso_stream_t * iso_stream = (hci_iso_stream_t *) btstack_linked_list_iterator_next(&it); 10026969d876aSMatthias Ringwald if (iso_stream->cis_handle == con_handle ) { 100274ae8623eSMatthias Ringwald return iso_stream; 100284ae8623eSMatthias Ringwald } 100294ae8623eSMatthias Ringwald } 100304ae8623eSMatthias Ringwald return NULL; 100314ae8623eSMatthias Ringwald } 100324ae8623eSMatthias Ringwald 100334ae8623eSMatthias Ringwald static void hci_iso_stream_finalize(hci_iso_stream_t * iso_stream){ 10034969d876aSMatthias Ringwald log_info("hci_iso_stream_finalize con_handle 0x%04x, group_id 0x%02x", iso_stream->cis_handle, iso_stream->group_id); 100354ae8623eSMatthias Ringwald btstack_linked_list_remove(&hci_stack->iso_streams, (btstack_linked_item_t*) iso_stream); 100364ae8623eSMatthias Ringwald btstack_memory_hci_iso_stream_free(iso_stream); 100374ae8623eSMatthias Ringwald } 100384ae8623eSMatthias Ringwald 10039778463d0SMatthias Ringwald static void hci_iso_stream_finalize_by_type_and_group_id(hci_iso_type_t iso_type, uint8_t group_id) { 10040778463d0SMatthias Ringwald btstack_linked_list_iterator_t it; 10041778463d0SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->iso_streams); 10042778463d0SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 10043778463d0SMatthias Ringwald hci_iso_stream_t * iso_stream = (hci_iso_stream_t *) btstack_linked_list_iterator_next(&it); 10044778463d0SMatthias Ringwald if ((iso_stream->group_id == group_id) && 10045778463d0SMatthias Ringwald (iso_stream->iso_type == iso_type)){ 10046778463d0SMatthias Ringwald btstack_linked_list_iterator_remove(&it); 10047778463d0SMatthias Ringwald btstack_memory_hci_iso_stream_free(iso_stream); 10048778463d0SMatthias Ringwald } 10049778463d0SMatthias Ringwald } 10050778463d0SMatthias Ringwald } 10051778463d0SMatthias Ringwald 100528d72db10SMatthias Ringwald static void hci_iso_stream_requested_finalize(uint8_t group_id) { 100534ae8623eSMatthias Ringwald btstack_linked_list_iterator_t it; 100544ae8623eSMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->iso_streams); 100554ae8623eSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 100564ae8623eSMatthias Ringwald hci_iso_stream_t * iso_stream = (hci_iso_stream_t *) btstack_linked_list_iterator_next(&it); 10057a90016deSMatthias Ringwald if ((iso_stream->state == HCI_ISO_STREAM_STATE_REQUESTED ) && 100588d72db10SMatthias Ringwald (iso_stream->group_id == group_id)){ 100594ae8623eSMatthias Ringwald btstack_linked_list_iterator_remove(&it); 100604ae8623eSMatthias Ringwald btstack_memory_hci_iso_stream_free(iso_stream); 100614ae8623eSMatthias Ringwald } 100624ae8623eSMatthias Ringwald } 100634ae8623eSMatthias Ringwald } 10064a90016deSMatthias Ringwald static void hci_iso_stream_requested_confirm(uint8_t big_handle){ 100654ae8623eSMatthias Ringwald btstack_linked_list_iterator_t it; 100664ae8623eSMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->iso_streams); 100674ae8623eSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 100684ae8623eSMatthias Ringwald hci_iso_stream_t * iso_stream = (hci_iso_stream_t *) btstack_linked_list_iterator_next(&it); 100694ae8623eSMatthias Ringwald if ( iso_stream->state == HCI_ISO_STREAM_STATE_REQUESTED ) { 100704ae8623eSMatthias Ringwald iso_stream->state = HCI_ISO_STREAM_STATE_W4_ESTABLISHED; 100714ae8623eSMatthias Ringwald } 100724ae8623eSMatthias Ringwald } 100734ae8623eSMatthias Ringwald } 10074d39e4f95SMatthias Ringwald 10075d39e4f95SMatthias Ringwald static bool hci_iso_sdu_complete(uint8_t * packet, uint16_t size){ 10076d39e4f95SMatthias Ringwald uint8_t sdu_ts_flag = (packet[1] >> 6) & 1; 10077d39e4f95SMatthias Ringwald uint16_t sdu_len_offset = 6 + (sdu_ts_flag * 4); 10078d39e4f95SMatthias Ringwald uint16_t sdu_len = little_endian_read_16(packet, sdu_len_offset) & 0x0fff; 10079d39e4f95SMatthias Ringwald return (sdu_len_offset + 2 + sdu_len) == size; 10080d39e4f95SMatthias Ringwald } 10081d39e4f95SMatthias Ringwald 10082750818acSMatthias Ringwald static void hci_iso_packet_handler(hci_iso_stream_t *iso_stream, uint8_t *packet, uint16_t size) { 10083750818acSMatthias Ringwald if (iso_stream == NULL){ 10084750818acSMatthias Ringwald log_error("acl_handler called with non-registered handle %u!" , READ_ISO_CONNECTION_HANDLE(packet)); 10085d39e4f95SMatthias Ringwald return; 10086d39e4f95SMatthias Ringwald } 10087750818acSMatthias Ringwald 10088750818acSMatthias Ringwald if (hci_stack->iso_packet_handler == NULL) { 10089d39e4f95SMatthias Ringwald return; 10090d39e4f95SMatthias Ringwald } 10091d39e4f95SMatthias Ringwald 10092d39e4f95SMatthias Ringwald // parse header 10093a14c18deSMatthias Ringwald uint16_t con_handle_and_flags = little_endian_read_16(packet, 0); 10094a14c18deSMatthias Ringwald uint16_t data_total_length = little_endian_read_16(packet, 2); 10095a14c18deSMatthias Ringwald uint8_t pb_flag = (con_handle_and_flags >> 12) & 3; 10096d39e4f95SMatthias Ringwald 10097d39e4f95SMatthias Ringwald // assert packet is complete 10098a14c18deSMatthias Ringwald if ((data_total_length + 4u) != size){ 10099d39e4f95SMatthias Ringwald return; 10100d39e4f95SMatthias Ringwald } 10101d39e4f95SMatthias Ringwald 10102d39e4f95SMatthias Ringwald if ((pb_flag & 0x01) == 0){ 10103d39e4f95SMatthias Ringwald if (pb_flag == 0x02){ 10104a14c18deSMatthias Ringwald // The ISO_SDU_Fragment field contains a header and a complete SDU. 10105d39e4f95SMatthias Ringwald if (hci_iso_sdu_complete(packet, size)) { 10106d39e4f95SMatthias Ringwald (hci_stack->iso_packet_handler)(HCI_ISO_DATA_PACKET, 0, packet, size); 10107d39e4f95SMatthias Ringwald } 10108d39e4f95SMatthias Ringwald } else { 10109d39e4f95SMatthias Ringwald // The ISO_Data_Load field contains a header and the first fragment of a fragmented SDU. 1011060468fb4SMatthias Ringwald if (size > sizeof(iso_stream->reassembly_buffer)){ 10111d39e4f95SMatthias Ringwald return; 10112d39e4f95SMatthias Ringwald } 10113d39e4f95SMatthias Ringwald memcpy(iso_stream->reassembly_buffer, packet, size); 10114d39e4f95SMatthias Ringwald // fix pb_flag 10115d39e4f95SMatthias Ringwald iso_stream->reassembly_buffer[1] = (iso_stream->reassembly_buffer[1] & 0xcf) | 0x20; 10116d39e4f95SMatthias Ringwald iso_stream->reassembly_pos = size; 10117d39e4f95SMatthias Ringwald } 10118d39e4f95SMatthias Ringwald } else { 10119a14c18deSMatthias Ringwald // ISO_SDU_Fragment contains continuation or last fragment of an SDU 10120a14c18deSMatthias Ringwald uint8_t ts_flag = (con_handle_and_flags >> 14) & 1; 10121d39e4f95SMatthias Ringwald if (ts_flag != 0){ 10122d39e4f95SMatthias Ringwald return; 10123d39e4f95SMatthias Ringwald } 10124d39e4f95SMatthias Ringwald // append fragment 10125d39e4f95SMatthias Ringwald if (iso_stream->reassembly_pos == 0){ 10126d39e4f95SMatthias Ringwald return; 10127d39e4f95SMatthias Ringwald } 1012860468fb4SMatthias Ringwald 10129a14c18deSMatthias Ringwald if ((iso_stream->reassembly_pos + data_total_length) > sizeof(iso_stream->reassembly_buffer)){ 10130d39e4f95SMatthias Ringwald // reset reassembly buffer 10131d39e4f95SMatthias Ringwald iso_stream->reassembly_pos = 0; 10132d39e4f95SMatthias Ringwald return; 10133d39e4f95SMatthias Ringwald } 10134a14c18deSMatthias Ringwald memcpy(&iso_stream->reassembly_buffer[iso_stream->reassembly_pos], &packet[4], data_total_length); 10135a14c18deSMatthias Ringwald iso_stream->reassembly_pos += data_total_length; 10136d39e4f95SMatthias Ringwald 10137d39e4f95SMatthias Ringwald // deliver if last fragment and SDU complete 10138d39e4f95SMatthias Ringwald if (pb_flag == 0x03){ 10139d39e4f95SMatthias Ringwald if (hci_iso_sdu_complete(iso_stream->reassembly_buffer, iso_stream->reassembly_pos)){ 10140a14c18deSMatthias Ringwald // fix data_total_length 1014160468fb4SMatthias Ringwald little_endian_store_16(iso_stream->reassembly_buffer, 2, iso_stream->reassembly_pos - HCI_ISO_HEADER_SIZE); 10142d39e4f95SMatthias Ringwald (hci_stack->iso_packet_handler)(HCI_ISO_DATA_PACKET, 0, iso_stream->reassembly_buffer, iso_stream->reassembly_pos); 10143d39e4f95SMatthias Ringwald } 10144a14c18deSMatthias Ringwald // reset reassembly buffer 10145d39e4f95SMatthias Ringwald iso_stream->reassembly_pos = 0; 10146d39e4f95SMatthias Ringwald } 10147d39e4f95SMatthias Ringwald } 10148d39e4f95SMatthias Ringwald } 10149d39e4f95SMatthias Ringwald 101507aa35f6aSMatthias Ringwald static void hci_emit_big_created(const le_audio_big_t * big, uint8_t status){ 101517aa35f6aSMatthias Ringwald uint8_t event [6 + (MAX_NR_BIS * 2)]; 101527aa35f6aSMatthias Ringwald uint16_t pos = 0; 101537aa35f6aSMatthias Ringwald event[pos++] = HCI_EVENT_META_GAP; 101547aa35f6aSMatthias Ringwald event[pos++] = 4 + (2 * big->num_bis); 101557aa35f6aSMatthias Ringwald event[pos++] = GAP_SUBEVENT_BIG_CREATED; 101567aa35f6aSMatthias Ringwald event[pos++] = status; 101577aa35f6aSMatthias Ringwald event[pos++] = big->big_handle; 101587aa35f6aSMatthias Ringwald event[pos++] = big->num_bis; 101597aa35f6aSMatthias Ringwald uint8_t i; 101607aa35f6aSMatthias Ringwald for (i=0;i<big->num_bis;i++){ 101617aa35f6aSMatthias Ringwald little_endian_store_16(event, pos, big->bis_con_handles[i]); 101627aa35f6aSMatthias Ringwald pos += 2; 101637aa35f6aSMatthias Ringwald } 101647aa35f6aSMatthias Ringwald hci_emit_event(event, pos, 0); 101657aa35f6aSMatthias Ringwald } 101667aa35f6aSMatthias Ringwald 10167d3a89d91SMatthias Ringwald static void hci_emit_cig_created(const le_audio_cig_t * cig, uint8_t status){ 10168d3a89d91SMatthias Ringwald uint8_t event [6 + (MAX_NR_CIS * 2)]; 10169d3a89d91SMatthias Ringwald uint16_t pos = 0; 10170d3a89d91SMatthias Ringwald event[pos++] = HCI_EVENT_META_GAP; 10171d3a89d91SMatthias Ringwald event[pos++] = 4 + (2 * cig->num_cis); 10172d3a89d91SMatthias Ringwald event[pos++] = GAP_SUBEVENT_CIG_CREATED; 10173d3a89d91SMatthias Ringwald event[pos++] = status; 10174d3a89d91SMatthias Ringwald event[pos++] = cig->cig_id; 10175d3a89d91SMatthias Ringwald event[pos++] = cig->num_cis; 10176d3a89d91SMatthias Ringwald uint8_t i; 10177d3a89d91SMatthias Ringwald for (i=0;i<cig->num_cis;i++){ 10178d3a89d91SMatthias Ringwald little_endian_store_16(event, pos, cig->cis_con_handles[i]); 10179d3a89d91SMatthias Ringwald pos += 2; 10180d3a89d91SMatthias Ringwald } 10181d3a89d91SMatthias Ringwald hci_emit_event(event, pos, 0); 10182d3a89d91SMatthias Ringwald } 10183f06bb90fSMatthias Ringwald 10184620553bdSMatthias Ringwald static uint16_t hci_setup_cis_created(uint8_t * event, hci_iso_stream_t * iso_stream, uint8_t status) { 10185f06bb90fSMatthias Ringwald uint16_t pos = 0; 10186f06bb90fSMatthias Ringwald event[pos++] = HCI_EVENT_META_GAP; 10187cf439c63SMatthias Ringwald event[pos++] = 8; 10188f06bb90fSMatthias Ringwald event[pos++] = GAP_SUBEVENT_CIS_CREATED; 10189f06bb90fSMatthias Ringwald event[pos++] = status; 10190620553bdSMatthias Ringwald event[pos++] = iso_stream->group_id; 10191620553bdSMatthias Ringwald event[pos++] = iso_stream->stream_id; 10192620553bdSMatthias Ringwald little_endian_store_16(event, pos, iso_stream->cis_handle); 10193f06bb90fSMatthias Ringwald pos += 2; 10194620553bdSMatthias Ringwald little_endian_store_16(event, pos, iso_stream->acl_handle); 10195cf439c63SMatthias Ringwald pos += 2; 101967dd97f73SMatthias Ringwald little_endian_store_16(event, pos, iso_stream->iso_interval_1250us); 101977dd97f73SMatthias Ringwald pos += 2; 101987dd97f73SMatthias Ringwald event[pos++] = iso_stream->number_of_subevents; 101997dd97f73SMatthias Ringwald event[pos++] = iso_stream->burst_number_c_to_p; 102007dd97f73SMatthias Ringwald event[pos++] = iso_stream->burst_number_p_to_c; 102017dd97f73SMatthias Ringwald event[pos++] = iso_stream->flush_timeout_c_to_p; 102027dd97f73SMatthias Ringwald event[pos++] = iso_stream->flush_timeout_p_to_c; 10203620553bdSMatthias Ringwald return pos; 10204f06bb90fSMatthias Ringwald } 10205f06bb90fSMatthias Ringwald 1020614045fdbSMatthias Ringwald // emits GAP_SUBEVENT_CIS_CREATED after calling hci_iso_finalize 1020714045fdbSMatthias Ringwald static void hci_cis_handle_created(hci_iso_stream_t * iso_stream, uint8_t status){ 1020814045fdbSMatthias Ringwald // cache data before finalizing struct 102097dd97f73SMatthias Ringwald uint8_t event [17]; 10210620553bdSMatthias Ringwald uint16_t pos = hci_setup_cis_created(event, iso_stream, status); 10211620553bdSMatthias Ringwald btstack_assert(pos <= sizeof(event)); 1021214045fdbSMatthias Ringwald if (status != ERROR_CODE_SUCCESS){ 1021314045fdbSMatthias Ringwald hci_iso_stream_finalize(iso_stream); 1021414045fdbSMatthias Ringwald } 10215620553bdSMatthias Ringwald hci_emit_event(event, pos, 0); 1021614045fdbSMatthias Ringwald } 1021714045fdbSMatthias Ringwald 102187aa35f6aSMatthias Ringwald static void hci_emit_big_terminated(const le_audio_big_t * big){ 102197aa35f6aSMatthias Ringwald uint8_t event [4]; 102207aa35f6aSMatthias Ringwald uint16_t pos = 0; 102217aa35f6aSMatthias Ringwald event[pos++] = HCI_EVENT_META_GAP; 102227aa35f6aSMatthias Ringwald event[pos++] = 2; 102237aa35f6aSMatthias Ringwald event[pos++] = GAP_SUBEVENT_BIG_TERMINATED; 102247aa35f6aSMatthias Ringwald event[pos++] = big->big_handle; 102257aa35f6aSMatthias Ringwald hci_emit_event(event, pos, 0); 102267aa35f6aSMatthias Ringwald } 102277aa35f6aSMatthias Ringwald 102282a6c0f82SMatthias Ringwald static void hci_emit_big_sync_created(const le_audio_big_sync_t * big_sync, uint8_t status){ 102292a6c0f82SMatthias Ringwald uint8_t event [6 + (MAX_NR_BIS * 2)]; 102302a6c0f82SMatthias Ringwald uint16_t pos = 0; 102312a6c0f82SMatthias Ringwald event[pos++] = HCI_EVENT_META_GAP; 102322a6c0f82SMatthias Ringwald event[pos++] = 4; 102332a6c0f82SMatthias Ringwald event[pos++] = GAP_SUBEVENT_BIG_SYNC_CREATED; 102342a6c0f82SMatthias Ringwald event[pos++] = status; 102352a6c0f82SMatthias Ringwald event[pos++] = big_sync->big_handle; 102362a6c0f82SMatthias Ringwald event[pos++] = big_sync->num_bis; 102372a6c0f82SMatthias Ringwald uint8_t i; 102382a6c0f82SMatthias Ringwald for (i=0;i<big_sync->num_bis;i++){ 102392a6c0f82SMatthias Ringwald little_endian_store_16(event, pos, big_sync->bis_con_handles[i]); 102402a6c0f82SMatthias Ringwald pos += 2; 102412a6c0f82SMatthias Ringwald } 102422a6c0f82SMatthias Ringwald hci_emit_event(event, pos, 0); 102432a6c0f82SMatthias Ringwald } 102442a6c0f82SMatthias Ringwald 10245d04a9afcSMatthias Ringwald static void hci_emit_big_sync_stopped(uint8_t big_handle){ 102462a6c0f82SMatthias Ringwald uint8_t event [4]; 102472a6c0f82SMatthias Ringwald uint16_t pos = 0; 102482a6c0f82SMatthias Ringwald event[pos++] = HCI_EVENT_META_GAP; 102492a6c0f82SMatthias Ringwald event[pos++] = 2; 102502a6c0f82SMatthias Ringwald event[pos++] = GAP_SUBEVENT_BIG_SYNC_STOPPED; 10251d04a9afcSMatthias Ringwald event[pos++] = big_handle; 102522a6c0f82SMatthias Ringwald hci_emit_event(event, pos, 0); 102532a6c0f82SMatthias Ringwald } 102542a6c0f82SMatthias Ringwald 102555ade6657SMatthias Ringwald static void hci_emit_bis_can_send_now(const le_audio_big_t *big, uint8_t bis_index) { 102565ade6657SMatthias Ringwald uint8_t event[6]; 102575ade6657SMatthias Ringwald uint16_t pos = 0; 102585ade6657SMatthias Ringwald event[pos++] = HCI_EVENT_BIS_CAN_SEND_NOW; 102595ade6657SMatthias Ringwald event[pos++] = sizeof(event) - 2; 102605ade6657SMatthias Ringwald event[pos++] = big->big_handle; 102615ade6657SMatthias Ringwald event[pos++] = bis_index; 102625ade6657SMatthias Ringwald little_endian_store_16(event, pos, big->bis_con_handles[bis_index]); 102635ade6657SMatthias Ringwald hci_emit_event(&event[0], sizeof(event), 0); // don't dump 102645ade6657SMatthias Ringwald } 102655ade6657SMatthias Ringwald 102662c077771SMatthias Ringwald static void hci_emit_cis_can_send_now(hci_con_handle_t cis_con_handle) { 102672c077771SMatthias Ringwald uint8_t event[4]; 102682c077771SMatthias Ringwald uint16_t pos = 0; 102692c077771SMatthias Ringwald event[pos++] = HCI_EVENT_CIS_CAN_SEND_NOW; 102702c077771SMatthias Ringwald event[pos++] = sizeof(event) - 2; 102712c077771SMatthias Ringwald little_endian_store_16(event, pos, cis_con_handle); 102722c077771SMatthias Ringwald hci_emit_event(&event[0], sizeof(event), 0); // don't dump 102732c077771SMatthias Ringwald } 102742c077771SMatthias Ringwald 102757aa35f6aSMatthias Ringwald static le_audio_big_t * hci_big_for_handle(uint8_t big_handle){ 102767aa35f6aSMatthias Ringwald btstack_linked_list_iterator_t it; 102777aa35f6aSMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->le_audio_bigs); 102787aa35f6aSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 102797aa35f6aSMatthias Ringwald le_audio_big_t * big = (le_audio_big_t *) btstack_linked_list_iterator_next(&it); 102807aa35f6aSMatthias Ringwald if ( big->big_handle == big_handle ) { 102817aa35f6aSMatthias Ringwald return big; 102827aa35f6aSMatthias Ringwald } 102837aa35f6aSMatthias Ringwald } 102847aa35f6aSMatthias Ringwald return NULL; 102857aa35f6aSMatthias Ringwald } 102867aa35f6aSMatthias Ringwald 102872a6c0f82SMatthias Ringwald static le_audio_big_sync_t * hci_big_sync_for_handle(uint8_t big_handle){ 102882a6c0f82SMatthias Ringwald btstack_linked_list_iterator_t it; 102892a6c0f82SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->le_audio_big_syncs); 102902a6c0f82SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 102912a6c0f82SMatthias Ringwald le_audio_big_sync_t * big_sync = (le_audio_big_sync_t *) btstack_linked_list_iterator_next(&it); 102922a6c0f82SMatthias Ringwald if ( big_sync->big_handle == big_handle ) { 102932a6c0f82SMatthias Ringwald return big_sync; 102942a6c0f82SMatthias Ringwald } 102952a6c0f82SMatthias Ringwald } 102962a6c0f82SMatthias Ringwald return NULL; 102972a6c0f82SMatthias Ringwald } 102982a6c0f82SMatthias Ringwald 1029901d4f05fSMatthias Ringwald void hci_set_num_iso_packets_to_queue(uint8_t num_packets){ 1030001d4f05fSMatthias Ringwald hci_stack->iso_packets_to_queue = num_packets; 1030101d4f05fSMatthias Ringwald } 1030201d4f05fSMatthias Ringwald 10303d3a89d91SMatthias Ringwald static le_audio_cig_t * hci_cig_for_id(uint8_t cig_id){ 10304d3a89d91SMatthias Ringwald btstack_linked_list_iterator_t it; 10305d3a89d91SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->le_audio_cigs); 10306d3a89d91SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 10307d3a89d91SMatthias Ringwald le_audio_cig_t * cig = (le_audio_cig_t *) btstack_linked_list_iterator_next(&it); 10308d3a89d91SMatthias Ringwald if ( cig->cig_id == cig_id ) { 10309d3a89d91SMatthias Ringwald return cig; 10310d3a89d91SMatthias Ringwald } 10311d3a89d91SMatthias Ringwald } 10312d3a89d91SMatthias Ringwald return NULL; 10313d3a89d91SMatthias Ringwald } 10314d3a89d91SMatthias Ringwald 103155ade6657SMatthias Ringwald static void hci_iso_notify_can_send_now(void){ 103162c077771SMatthias Ringwald 103172c077771SMatthias Ringwald // BIG 103182c077771SMatthias Ringwald 103195ade6657SMatthias Ringwald btstack_linked_list_iterator_t it; 103205ade6657SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->le_audio_bigs); 103215ade6657SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 103225ade6657SMatthias Ringwald le_audio_big_t * big = (le_audio_big_t *) btstack_linked_list_iterator_next(&it); 10323aacb1081SMatthias Ringwald // track number completed packet timestamps 10324aacb1081SMatthias Ringwald if (big->num_completed_timestamp_current_valid){ 10325aacb1081SMatthias Ringwald big->num_completed_timestamp_current_valid = false; 10326aacb1081SMatthias Ringwald if (big->num_completed_timestamp_previous_valid){ 10327aacb1081SMatthias Ringwald // detect delayed sending of all BIS: tolerate up to 50% delayed event handling 10328aacb1081SMatthias Ringwald uint32_t iso_interval_missed_threshold_ms = big->params->sdu_interval_us * 3 / 2000; 10329aacb1081SMatthias Ringwald int32_t num_completed_timestamp_delta_ms = btstack_time_delta(big->num_completed_timestamp_current_ms, 10330aacb1081SMatthias Ringwald big->num_completed_timestamp_previous_ms); 10331aacb1081SMatthias Ringwald if (num_completed_timestamp_delta_ms > iso_interval_missed_threshold_ms){ 10332aacb1081SMatthias Ringwald // to catch up, skip packet on all BIS 10333aacb1081SMatthias Ringwald uint8_t i; 10334aacb1081SMatthias Ringwald for (i=0;i<big->num_bis;i++){ 10335aacb1081SMatthias Ringwald hci_iso_stream_t * iso_stream = hci_iso_stream_for_con_handle(big->bis_con_handles[i]); 10336aacb1081SMatthias Ringwald if (iso_stream){ 10337aacb1081SMatthias Ringwald iso_stream->num_packets_to_skip++; 10338aacb1081SMatthias Ringwald } 10339aacb1081SMatthias Ringwald } 10340aacb1081SMatthias Ringwald } 10341aacb1081SMatthias Ringwald } 10342aacb1081SMatthias Ringwald big->num_completed_timestamp_previous_valid = true; 10343aacb1081SMatthias Ringwald big->num_completed_timestamp_previous_ms = big->num_completed_timestamp_current_ms; 10344aacb1081SMatthias Ringwald } 10345aacb1081SMatthias Ringwald 103465ade6657SMatthias Ringwald if (big->can_send_now_requested){ 10347d4e5d4faSMatthias Ringwald // check if no outgoing iso packets pending and no can send now have to be emitted 103485ade6657SMatthias Ringwald uint8_t i; 103495ade6657SMatthias Ringwald bool can_send = true; 10350aacb1081SMatthias Ringwald uint8_t num_iso_queued_minimum = 0; 103515ade6657SMatthias Ringwald for (i=0;i<big->num_bis;i++){ 103525ade6657SMatthias Ringwald hci_iso_stream_t * iso_stream = hci_iso_stream_for_con_handle(big->bis_con_handles[i]); 10353aacb1081SMatthias Ringwald if (iso_stream == NULL) continue; 10354aacb1081SMatthias Ringwald // handle case where individual ISO packet was sent too late: 10355aacb1081SMatthias Ringwald // for each additionally queued packet, a new one needs to get skipped 10356aacb1081SMatthias Ringwald if (i==0){ 10357aacb1081SMatthias Ringwald num_iso_queued_minimum = iso_stream->num_packets_sent; 10358aacb1081SMatthias Ringwald } else if (iso_stream->num_packets_sent > num_iso_queued_minimum){ 10359aacb1081SMatthias Ringwald uint8_t num_packets_to_skip = iso_stream->num_packets_sent - num_iso_queued_minimum; 10360aacb1081SMatthias Ringwald iso_stream->num_packets_to_skip += num_packets_to_skip; 10361aacb1081SMatthias Ringwald iso_stream->num_packets_sent -= num_packets_to_skip; 10362aacb1081SMatthias Ringwald } 10363aacb1081SMatthias Ringwald // check if we can send now 10364aacb1081SMatthias Ringwald if ((iso_stream->num_packets_sent >= hci_stack->iso_packets_to_queue) || (iso_stream->emit_ready_to_send)){ 103655ade6657SMatthias Ringwald can_send = false; 103665ade6657SMatthias Ringwald break; 103675ade6657SMatthias Ringwald } 103685ade6657SMatthias Ringwald } 103695ade6657SMatthias Ringwald if (can_send){ 103705ade6657SMatthias Ringwald // propagate can send now to individual streams 103715ade6657SMatthias Ringwald big->can_send_now_requested = false; 103725ade6657SMatthias Ringwald for (i=0;i<big->num_bis;i++){ 103735ade6657SMatthias Ringwald hci_iso_stream_t * iso_stream = hci_iso_stream_for_con_handle(big->bis_con_handles[i]); 103745ade6657SMatthias Ringwald iso_stream->emit_ready_to_send = true; 103755ade6657SMatthias Ringwald } 103765ade6657SMatthias Ringwald } 103775ade6657SMatthias Ringwald } 103785ade6657SMatthias Ringwald } 103795ade6657SMatthias Ringwald 103805ade6657SMatthias Ringwald if (hci_stack->hci_packet_buffer_reserved) return; 103815ade6657SMatthias Ringwald 103825ade6657SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->le_audio_bigs); 103835ade6657SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 103845ade6657SMatthias Ringwald le_audio_big_t * big = (le_audio_big_t *) btstack_linked_list_iterator_next(&it); 103855ade6657SMatthias Ringwald // report bis ready 103865ade6657SMatthias Ringwald uint8_t i; 103875ade6657SMatthias Ringwald for (i=0;i<big->num_bis;i++){ 103885ade6657SMatthias Ringwald hci_iso_stream_t * iso_stream = hci_iso_stream_for_con_handle(big->bis_con_handles[i]); 103895ade6657SMatthias Ringwald if ((iso_stream != NULL) && iso_stream->emit_ready_to_send){ 103905ade6657SMatthias Ringwald iso_stream->emit_ready_to_send = false; 103915ade6657SMatthias Ringwald hci_emit_bis_can_send_now(big, i); 103925ade6657SMatthias Ringwald break; 103935ade6657SMatthias Ringwald } 103945ade6657SMatthias Ringwald } 103955ade6657SMatthias Ringwald } 103962c077771SMatthias Ringwald 103972c077771SMatthias Ringwald // CIS 103982c077771SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->iso_streams); 103992c077771SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)) { 104002c077771SMatthias Ringwald hci_iso_stream_t *iso_stream = (hci_iso_stream_t *) btstack_linked_list_iterator_next(&it); 104012c077771SMatthias Ringwald if ((iso_stream->can_send_now_requested) && 104022c077771SMatthias Ringwald (iso_stream->num_packets_sent < hci_stack->iso_packets_to_queue)){ 104032c077771SMatthias Ringwald iso_stream->can_send_now_requested = false; 10404969d876aSMatthias Ringwald hci_emit_cis_can_send_now(iso_stream->cis_handle); 104052c077771SMatthias Ringwald } 104062c077771SMatthias Ringwald } 104075ade6657SMatthias Ringwald } 104085ade6657SMatthias Ringwald 10409c7308688SMatthias Ringwald static uint8_t gap_big_setup_iso_streams(uint8_t num_bis, uint8_t big_handle){ 10410d034696aSMatthias Ringwald // make big handle unique and usuable for big and big sync 10411c7308688SMatthias Ringwald if (hci_big_for_handle(big_handle) != NULL){ 104127aa35f6aSMatthias Ringwald return ERROR_CODE_ACL_CONNECTION_ALREADY_EXISTS; 104137aa35f6aSMatthias Ringwald } 10414c7308688SMatthias Ringwald if (hci_big_sync_for_handle(big_handle) != NULL){ 10415d034696aSMatthias Ringwald return ERROR_CODE_ACL_CONNECTION_ALREADY_EXISTS; 10416d034696aSMatthias Ringwald } 10417c7308688SMatthias Ringwald if (num_bis == 0){ 104187aa35f6aSMatthias Ringwald return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS; 104197aa35f6aSMatthias Ringwald } 10420c7308688SMatthias Ringwald if (num_bis > MAX_NR_BIS){ 104217aa35f6aSMatthias Ringwald return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS; 104227aa35f6aSMatthias Ringwald } 104237aa35f6aSMatthias Ringwald 10424fb16346aSMatthias Ringwald // reserve ISO Streams 10425fb16346aSMatthias Ringwald uint8_t i; 10426fb16346aSMatthias Ringwald uint8_t status = ERROR_CODE_SUCCESS; 10427c7308688SMatthias Ringwald for (i=0;i<num_bis;i++){ 10428c7308688SMatthias Ringwald hci_iso_stream_t * iso_stream = hci_iso_stream_create(HCI_ISO_TYPE_BIS, HCI_ISO_STREAM_STATE_REQUESTED, big_handle, i); 10429969d876aSMatthias Ringwald if (iso_stream == NULL) { 10430969d876aSMatthias Ringwald status = ERROR_CODE_MEMORY_CAPACITY_EXCEEDED; 10431fb16346aSMatthias Ringwald break; 10432fb16346aSMatthias Ringwald } 10433fb16346aSMatthias Ringwald } 10434fb16346aSMatthias Ringwald 10435fb16346aSMatthias Ringwald // free structs on error 10436fb16346aSMatthias Ringwald if (status != ERROR_CODE_SUCCESS){ 10437c7308688SMatthias Ringwald hci_iso_stream_finalize_by_type_and_group_id(HCI_ISO_TYPE_BIS, big_handle); 10438c7308688SMatthias Ringwald } 10439c7308688SMatthias Ringwald 10440c7308688SMatthias Ringwald return status; 10441c7308688SMatthias Ringwald } 10442c7308688SMatthias Ringwald 10443c7308688SMatthias Ringwald uint8_t gap_big_create(le_audio_big_t * storage, le_audio_big_params_t * big_params){ 10444c7308688SMatthias Ringwald uint8_t status = gap_big_setup_iso_streams(big_params->num_bis, big_params->big_handle); 10445c7308688SMatthias Ringwald if (status != ERROR_CODE_SUCCESS){ 10446fb16346aSMatthias Ringwald return status; 10447fb16346aSMatthias Ringwald } 10448fb16346aSMatthias Ringwald 104497aa35f6aSMatthias Ringwald le_audio_big_t * big = storage; 104507aa35f6aSMatthias Ringwald big->big_handle = big_params->big_handle; 104517aa35f6aSMatthias Ringwald big->params = big_params; 104527aa35f6aSMatthias Ringwald big->state = LE_AUDIO_BIG_STATE_CREATE; 104537aa35f6aSMatthias Ringwald big->num_bis = big_params->num_bis; 104547aa35f6aSMatthias Ringwald btstack_linked_list_add(&hci_stack->le_audio_bigs, (btstack_linked_item_t *) big); 104557aa35f6aSMatthias Ringwald 104567aa35f6aSMatthias Ringwald hci_run(); 104577aa35f6aSMatthias Ringwald 104587aa35f6aSMatthias Ringwald return ERROR_CODE_SUCCESS; 104597aa35f6aSMatthias Ringwald } 104607aa35f6aSMatthias Ringwald 104612a6c0f82SMatthias Ringwald uint8_t gap_big_sync_create(le_audio_big_sync_t * storage, le_audio_big_sync_params_t * big_sync_params){ 10462c7308688SMatthias Ringwald uint8_t status = gap_big_setup_iso_streams(big_sync_params->num_bis, big_sync_params->big_handle); 1046302e19895SMatthias Ringwald if (status != ERROR_CODE_SUCCESS){ 1046402e19895SMatthias Ringwald return status; 1046502e19895SMatthias Ringwald } 1046602e19895SMatthias Ringwald 104672a6c0f82SMatthias Ringwald le_audio_big_sync_t * big_sync = storage; 104682a6c0f82SMatthias Ringwald big_sync->big_handle = big_sync_params->big_handle; 104692a6c0f82SMatthias Ringwald big_sync->params = big_sync_params; 104702a6c0f82SMatthias Ringwald big_sync->state = LE_AUDIO_BIG_STATE_CREATE; 104712a6c0f82SMatthias Ringwald big_sync->num_bis = big_sync_params->num_bis; 104722a6c0f82SMatthias Ringwald btstack_linked_list_add(&hci_stack->le_audio_big_syncs, (btstack_linked_item_t *) big_sync); 104732a6c0f82SMatthias Ringwald 104742a6c0f82SMatthias Ringwald hci_run(); 104752a6c0f82SMatthias Ringwald 104762a6c0f82SMatthias Ringwald return ERROR_CODE_SUCCESS; 104772a6c0f82SMatthias Ringwald } 104782a6c0f82SMatthias Ringwald 104797aa35f6aSMatthias Ringwald uint8_t gap_big_terminate(uint8_t big_handle){ 104807aa35f6aSMatthias Ringwald le_audio_big_t * big = hci_big_for_handle(big_handle); 104817aa35f6aSMatthias Ringwald if (big == NULL){ 104827aa35f6aSMatthias Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 104837aa35f6aSMatthias Ringwald } 104847aa35f6aSMatthias Ringwald switch (big->state){ 104857aa35f6aSMatthias Ringwald case LE_AUDIO_BIG_STATE_CREATE: 104867aa35f6aSMatthias Ringwald btstack_linked_list_remove(&hci_stack->le_audio_bigs, (btstack_linked_item_t *) big); 104872a6c0f82SMatthias Ringwald hci_emit_big_terminated(big); 104882a6c0f82SMatthias Ringwald break; 104892a6c0f82SMatthias Ringwald case LE_AUDIO_BIG_STATE_W4_SETUP_ISO_PATH: 104902a6c0f82SMatthias Ringwald big->state = LE_AUDIO_BIG_STATE_W4_SETUP_ISO_PATH_THEN_TERMINATE; 104917aa35f6aSMatthias Ringwald break; 104927aa35f6aSMatthias Ringwald case LE_AUDIO_BIG_STATE_W4_ESTABLISHED: 104937aa35f6aSMatthias Ringwald case LE_AUDIO_BIG_STATE_SETUP_ISO_PATH: 104947aa35f6aSMatthias Ringwald case LE_AUDIO_BIG_STATE_ACTIVE: 104957aa35f6aSMatthias Ringwald big->state = LE_AUDIO_BIG_STATE_TERMINATE; 104967aa35f6aSMatthias Ringwald hci_run(); 104977aa35f6aSMatthias Ringwald break; 104982a6c0f82SMatthias Ringwald default: 104992a6c0f82SMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 105002a6c0f82SMatthias Ringwald } 105012a6c0f82SMatthias Ringwald return ERROR_CODE_SUCCESS; 105022a6c0f82SMatthias Ringwald } 105032a6c0f82SMatthias Ringwald 105042a6c0f82SMatthias Ringwald uint8_t gap_big_sync_terminate(uint8_t big_handle){ 105052a6c0f82SMatthias Ringwald le_audio_big_sync_t * big_sync = hci_big_sync_for_handle(big_handle); 105062a6c0f82SMatthias Ringwald if (big_sync == NULL){ 105072a6c0f82SMatthias Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 105082a6c0f82SMatthias Ringwald } 105092a6c0f82SMatthias Ringwald switch (big_sync->state){ 105102a6c0f82SMatthias Ringwald case LE_AUDIO_BIG_STATE_CREATE: 105112a6c0f82SMatthias Ringwald btstack_linked_list_remove(&hci_stack->le_audio_big_syncs, (btstack_linked_item_t *) big_sync); 10512d04a9afcSMatthias Ringwald hci_emit_big_sync_stopped(big_handle); 105132a6c0f82SMatthias Ringwald break; 105147aa35f6aSMatthias Ringwald case LE_AUDIO_BIG_STATE_W4_SETUP_ISO_PATH: 105152a6c0f82SMatthias Ringwald big_sync->state = LE_AUDIO_BIG_STATE_W4_SETUP_ISO_PATH_THEN_TERMINATE; 105162a6c0f82SMatthias Ringwald break; 105172a6c0f82SMatthias Ringwald case LE_AUDIO_BIG_STATE_W4_ESTABLISHED: 105182a6c0f82SMatthias Ringwald case LE_AUDIO_BIG_STATE_SETUP_ISO_PATH: 105192a6c0f82SMatthias Ringwald case LE_AUDIO_BIG_STATE_ACTIVE: 105202a6c0f82SMatthias Ringwald big_sync->state = LE_AUDIO_BIG_STATE_TERMINATE; 105212a6c0f82SMatthias Ringwald hci_run(); 105227aa35f6aSMatthias Ringwald break; 105237aa35f6aSMatthias Ringwald default: 105247aa35f6aSMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 105257aa35f6aSMatthias Ringwald } 105267aa35f6aSMatthias Ringwald return ERROR_CODE_SUCCESS; 105277aa35f6aSMatthias Ringwald } 10528d39e4f95SMatthias Ringwald 105295ade6657SMatthias Ringwald uint8_t hci_request_bis_can_send_now_events(uint8_t big_handle){ 105305ade6657SMatthias Ringwald le_audio_big_t * big = hci_big_for_handle(big_handle); 105315ade6657SMatthias Ringwald if (big == NULL){ 105325ade6657SMatthias Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 105335ade6657SMatthias Ringwald } 105345ade6657SMatthias Ringwald if (big->state != LE_AUDIO_BIG_STATE_ACTIVE){ 105355ade6657SMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 105365ade6657SMatthias Ringwald } 105375ade6657SMatthias Ringwald big->can_send_now_requested = true; 105385ade6657SMatthias Ringwald hci_iso_notify_can_send_now(); 105395ade6657SMatthias Ringwald return ERROR_CODE_SUCCESS; 105405ade6657SMatthias Ringwald } 10541d3a89d91SMatthias Ringwald 105422c077771SMatthias Ringwald uint8_t hci_request_cis_can_send_now_events(hci_con_handle_t cis_con_handle){ 105432c077771SMatthias Ringwald hci_iso_stream_t * iso_stream = hci_iso_stream_for_con_handle(cis_con_handle); 105442c077771SMatthias Ringwald if (iso_stream == NULL){ 105452c077771SMatthias Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 105462c077771SMatthias Ringwald } 105472c077771SMatthias Ringwald if ((iso_stream->iso_type != HCI_ISO_TYPE_CIS) && (iso_stream->state != HCI_ISO_STREAM_STATE_ESTABLISHED)) { 105482c077771SMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 105492c077771SMatthias Ringwald } 105502c077771SMatthias Ringwald iso_stream->can_send_now_requested = true; 105512c077771SMatthias Ringwald hci_iso_notify_can_send_now(); 105522c077771SMatthias Ringwald return ERROR_CODE_SUCCESS; 105532c077771SMatthias Ringwald } 105542c077771SMatthias Ringwald 10555d3a89d91SMatthias Ringwald uint8_t gap_cig_create(le_audio_cig_t * storage, le_audio_cig_params_t * cig_params){ 10556d3a89d91SMatthias Ringwald if (hci_cig_for_id(cig_params->cig_id) != NULL){ 10557d3a89d91SMatthias Ringwald return ERROR_CODE_ACL_CONNECTION_ALREADY_EXISTS; 10558d3a89d91SMatthias Ringwald } 10559d3a89d91SMatthias Ringwald if (cig_params->num_cis == 0){ 10560d3a89d91SMatthias Ringwald return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS; 10561d3a89d91SMatthias Ringwald } 105623e377057SMatthias Ringwald if (cig_params->num_cis > MAX_NR_CIS){ 10563d3a89d91SMatthias Ringwald return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS; 10564d3a89d91SMatthias Ringwald } 10565d3a89d91SMatthias Ringwald 10566d3a89d91SMatthias Ringwald // reserve ISO Streams 10567d3a89d91SMatthias Ringwald uint8_t i; 10568d3a89d91SMatthias Ringwald uint8_t status = ERROR_CODE_SUCCESS; 10569d3a89d91SMatthias Ringwald for (i=0;i<cig_params->num_cis;i++){ 10570969d876aSMatthias Ringwald hci_iso_stream_t * iso_stream = hci_iso_stream_create(HCI_ISO_TYPE_CIS,HCI_ISO_STREAM_STATE_REQUESTED, cig_params->cig_id, i); 1057136468e6fSMatthias Ringwald if (iso_stream == NULL) { 10572969d876aSMatthias Ringwald status = ERROR_CODE_MEMORY_CAPACITY_EXCEEDED; 10573d3a89d91SMatthias Ringwald break; 10574d3a89d91SMatthias Ringwald } 10575d3a89d91SMatthias Ringwald } 10576d3a89d91SMatthias Ringwald 10577d3a89d91SMatthias Ringwald // free structs on error 10578d3a89d91SMatthias Ringwald if (status != ERROR_CODE_SUCCESS){ 10579d3a89d91SMatthias Ringwald hci_iso_stream_finalize_by_type_and_group_id(HCI_ISO_TYPE_CIS, cig_params->cig_id); 10580d3a89d91SMatthias Ringwald return status; 10581d3a89d91SMatthias Ringwald } 10582d3a89d91SMatthias Ringwald 10583d3a89d91SMatthias Ringwald le_audio_cig_t * cig = storage; 10584d3a89d91SMatthias Ringwald cig->cig_id = cig_params->cig_id; 10585d3a89d91SMatthias Ringwald cig->num_cis = cig_params->num_cis; 10586d3a89d91SMatthias Ringwald cig->params = cig_params; 10587d3a89d91SMatthias Ringwald cig->state = LE_AUDIO_CIG_STATE_CREATE; 10588444e371eSMatthias Ringwald for (i=0;i<cig->num_cis;i++){ 10589444e371eSMatthias Ringwald cig->cis_con_handles[i] = HCI_CON_HANDLE_INVALID; 10590444e371eSMatthias Ringwald cig->acl_con_handles[i] = HCI_CON_HANDLE_INVALID; 105910f0ba168SMatthias Ringwald cig->cis_setup_active[i] = false; 105920f0ba168SMatthias Ringwald cig->cis_established[i] = false; 10593444e371eSMatthias Ringwald } 10594d3a89d91SMatthias Ringwald btstack_linked_list_add(&hci_stack->le_audio_cigs, (btstack_linked_item_t *) cig); 10595d3a89d91SMatthias Ringwald 10596d3a89d91SMatthias Ringwald hci_run(); 10597d3a89d91SMatthias Ringwald 10598d3a89d91SMatthias Ringwald return ERROR_CODE_SUCCESS; 10599d3a89d91SMatthias Ringwald } 10600d3a89d91SMatthias Ringwald 10601d90722d4SMatthias Ringwald uint8_t gap_cig_remove(uint8_t cig_id){ 10602d90722d4SMatthias Ringwald le_audio_cig_t * cig = hci_cig_for_id(cig_id); 10603d90722d4SMatthias Ringwald if (cig == NULL){ 10604d90722d4SMatthias Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 10605d90722d4SMatthias Ringwald } 10606d90722d4SMatthias Ringwald 10607d90722d4SMatthias Ringwald // close active CIS 10608d90722d4SMatthias Ringwald uint8_t i; 10609d90722d4SMatthias Ringwald for (i=0;i<cig->num_cis;i++){ 10610d90722d4SMatthias Ringwald hci_iso_stream_t * stream = hci_iso_stream_for_con_handle(cig->cis_con_handles[i]); 10611d90722d4SMatthias Ringwald if (stream != NULL){ 10612d90722d4SMatthias Ringwald stream->state = HCI_ISO_STREAM_STATE_W2_CLOSE; 10613d90722d4SMatthias Ringwald } 10614d90722d4SMatthias Ringwald } 10615d90722d4SMatthias Ringwald cig->state = LE_AUDIO_CIG_STATE_REMOVE; 10616d90722d4SMatthias Ringwald 10617d90722d4SMatthias Ringwald hci_run(); 10618d90722d4SMatthias Ringwald 10619d90722d4SMatthias Ringwald return ERROR_CODE_SUCCESS; 10620d90722d4SMatthias Ringwald } 10621d90722d4SMatthias Ringwald 10622f2e409f3SMatthias Ringwald uint8_t gap_cis_create(uint8_t cig_id, hci_con_handle_t cis_con_handles [], hci_con_handle_t acl_con_handles []){ 10623f2e409f3SMatthias Ringwald le_audio_cig_t * cig = hci_cig_for_id(cig_id); 10624444e371eSMatthias Ringwald if (cig == NULL){ 10625444e371eSMatthias Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 10626444e371eSMatthias Ringwald } 10627444e371eSMatthias Ringwald 10628444e371eSMatthias Ringwald if (cig->state != LE_AUDIO_CIG_STATE_W4_CIS_REQUEST){ 10629444e371eSMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 10630444e371eSMatthias Ringwald } 10631444e371eSMatthias Ringwald 10632444e371eSMatthias Ringwald // store ACL Connection Handles 10633444e371eSMatthias Ringwald uint8_t i; 10634444e371eSMatthias Ringwald for (i=0;i<cig->num_cis;i++){ 1063556bd2ec0SMatthias Ringwald // check that all con handles exist and store 10636444e371eSMatthias Ringwald hci_con_handle_t cis_handle = cis_con_handles[i]; 1063736468e6fSMatthias Ringwald if (cis_handle == HCI_CON_HANDLE_INVALID){ 1063836468e6fSMatthias Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 1063936468e6fSMatthias Ringwald } 10640444e371eSMatthias Ringwald uint8_t j; 10641444e371eSMatthias Ringwald bool found = false; 10642444e371eSMatthias Ringwald for (j=0;j<cig->num_cis;j++){ 10643444e371eSMatthias Ringwald if (cig->cis_con_handles[j] == cis_handle){ 10644444e371eSMatthias Ringwald cig->acl_con_handles[j] = acl_con_handles[j]; 1064556bd2ec0SMatthias Ringwald hci_iso_stream_t * iso_stream = hci_iso_stream_for_con_handle(cis_handle); 1064656bd2ec0SMatthias Ringwald btstack_assert(iso_stream != NULL); 1064756bd2ec0SMatthias Ringwald iso_stream->acl_handle = acl_con_handles[j]; 1064836468e6fSMatthias Ringwald found = true; 10649444e371eSMatthias Ringwald break; 10650444e371eSMatthias Ringwald } 10651444e371eSMatthias Ringwald } 10652444e371eSMatthias Ringwald if (!found){ 10653444e371eSMatthias Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 10654444e371eSMatthias Ringwald } 10655444e371eSMatthias Ringwald } 10656444e371eSMatthias Ringwald 10657444e371eSMatthias Ringwald cig->state = LE_AUDIO_CIG_STATE_CREATE_CIS; 10658444e371eSMatthias Ringwald hci_run(); 10659444e371eSMatthias Ringwald 10660444e371eSMatthias Ringwald return ERROR_CODE_SUCCESS; 10661444e371eSMatthias Ringwald } 10662444e371eSMatthias Ringwald 10663969d876aSMatthias Ringwald static uint8_t hci_cis_accept_or_reject(hci_con_handle_t cis_handle, hci_iso_stream_state_t state){ 10664969d876aSMatthias Ringwald hci_iso_stream_t * iso_stream = hci_iso_stream_for_con_handle(cis_handle); 106656fd1d2c8SMatthias Ringwald if (iso_stream == NULL){ 106666fd1d2c8SMatthias Ringwald // if we got a CIS Request but fail to allocate a hci_iso_stream_t object, we won't find it here 10667969d876aSMatthias Ringwald return ERROR_CODE_MEMORY_CAPACITY_EXCEEDED; 1066826b93350SMatthias Ringwald } 1066926b93350SMatthias Ringwald 106706fd1d2c8SMatthias Ringwald // set next state and continue 106716fd1d2c8SMatthias Ringwald iso_stream->state = state; 1067226b93350SMatthias Ringwald hci_run(); 1067326b93350SMatthias Ringwald return ERROR_CODE_SUCCESS; 1067426b93350SMatthias Ringwald } 1067526b93350SMatthias Ringwald 1067626b93350SMatthias Ringwald uint8_t gap_cis_accept(hci_con_handle_t cis_con_handle){ 1067726b93350SMatthias Ringwald return hci_cis_accept_or_reject(cis_con_handle, HCI_ISO_STREAM_W2_ACCEPT); 1067826b93350SMatthias Ringwald } 1067926b93350SMatthias Ringwald 1068026b93350SMatthias Ringwald uint8_t gap_cis_reject(hci_con_handle_t cis_con_handle){ 1068126b93350SMatthias Ringwald return hci_cis_accept_or_reject(cis_con_handle, HCI_ISO_STREAM_W2_REJECT); 1068226b93350SMatthias Ringwald } 1068326b93350SMatthias Ringwald 10684137a570aSMatthias Ringwald #endif /* ENABLE_LE_ISOCHRONOUS_STREAMS */ 1068526b93350SMatthias Ringwald 10686137a570aSMatthias Ringwald // GAP Privacy - notify clients before random address update 10687137a570aSMatthias Ringwald 10688137a570aSMatthias Ringwald static bool gap_privacy_client_all_ready(void){ 10689137a570aSMatthias Ringwald // check if all ready 10690137a570aSMatthias Ringwald btstack_linked_list_iterator_t it; 10691137a570aSMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->gap_privacy_clients); 10692137a570aSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)) { 10693137a570aSMatthias Ringwald gap_privacy_client_t *client = (gap_privacy_client_t *) btstack_linked_list_iterator_next(&it); 10694137a570aSMatthias Ringwald if (client->state != GAP_PRIVACY_CLIENT_STATE_READY){ 10695137a570aSMatthias Ringwald return false; 10696137a570aSMatthias Ringwald } 10697137a570aSMatthias Ringwald } 10698137a570aSMatthias Ringwald return true; 10699137a570aSMatthias Ringwald } 10700137a570aSMatthias Ringwald 10701137a570aSMatthias Ringwald static void gap_privacy_clients_handle_ready(void){ 10702137a570aSMatthias Ringwald // clear 'ready' 10703137a570aSMatthias Ringwald btstack_linked_list_iterator_t it; 10704137a570aSMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->gap_privacy_clients); 10705137a570aSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)) { 10706137a570aSMatthias Ringwald gap_privacy_client_t *client = (gap_privacy_client_t *) btstack_linked_list_iterator_next(&it); 10707137a570aSMatthias Ringwald client->state = GAP_PRIVACY_CLIENT_STATE_IDLE; 10708137a570aSMatthias Ringwald } 10709137a570aSMatthias Ringwald hci_stack->le_advertisements_state &= ~LE_ADVERTISEMENT_STATE_PRIVACY_PENDING; 10710137a570aSMatthias Ringwald hci_run(); 10711137a570aSMatthias Ringwald } 10712137a570aSMatthias Ringwald 10713137a570aSMatthias Ringwald static void gap_privacy_clients_notify(bd_addr_t new_random_address){ 10714137a570aSMatthias Ringwald btstack_linked_list_iterator_t it; 10715137a570aSMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->gap_privacy_clients); 10716137a570aSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)) { 10717137a570aSMatthias Ringwald gap_privacy_client_t *client = (gap_privacy_client_t *) btstack_linked_list_iterator_next(&it); 10718137a570aSMatthias Ringwald if (client->state == GAP_PRIVACY_CLIENT_STATE_IDLE){ 10719137a570aSMatthias Ringwald client->state = GAP_PRIVACY_CLIENT_STATE_PENDING; 10720137a570aSMatthias Ringwald (*client->callback)(client, new_random_address); 10721137a570aSMatthias Ringwald } 10722137a570aSMatthias Ringwald } 10723137a570aSMatthias Ringwald if (gap_privacy_client_all_ready()){ 10724137a570aSMatthias Ringwald gap_privacy_clients_handle_ready(); 10725137a570aSMatthias Ringwald } 10726137a570aSMatthias Ringwald } 10727137a570aSMatthias Ringwald 10728137a570aSMatthias Ringwald void gap_privacy_client_register(gap_privacy_client_t * client){ 10729137a570aSMatthias Ringwald client->state = GAP_PRIVACY_CLIENT_STATE_IDLE; 10730137a570aSMatthias Ringwald btstack_linked_list_add(&hci_stack->gap_privacy_clients, (btstack_linked_item_t *) client); 10731137a570aSMatthias Ringwald } 10732137a570aSMatthias Ringwald 10733137a570aSMatthias Ringwald void gap_privacy_client_ready(gap_privacy_client_t * client){ 10734137a570aSMatthias Ringwald client->state = GAP_PRIVACY_CLIENT_STATE_READY; 10735137a570aSMatthias Ringwald if (gap_privacy_client_all_ready()){ 10736137a570aSMatthias Ringwald gap_privacy_clients_handle_ready(); 10737137a570aSMatthias Ringwald } 10738137a570aSMatthias Ringwald } 10739137a570aSMatthias Ringwald 10740137a570aSMatthias Ringwald void gap_privacy_client_unregister(gap_privacy_client_t * client){ 10741137a570aSMatthias Ringwald btstack_linked_list_remove(&hci_stack->gap_privacy_clients, (btstack_linked_item_t *) client); 10742137a570aSMatthias Ringwald } 10743137a570aSMatthias Ringwald 107444ae8623eSMatthias Ringwald #endif /* ENABLE_BLE */ 10745f40c73b4SMatthias Ringwald 10746eddac615SMatthias Ringwald #ifdef FUZZING_BUILD_MODE_UNSAFE_FOR_PRODUCTION 1074718976c74SMatthias Ringwald void hci_setup_test_connections_fuzz(void){ 1074818976c74SMatthias Ringwald hci_connection_t * conn; 1074918976c74SMatthias Ringwald 1075018976c74SMatthias Ringwald // default address: 66:55:44:33:00:01 1075118976c74SMatthias Ringwald bd_addr_t addr = { 0x66, 0x55, 0x44, 0x33, 0x00, 0x00}; 1075218976c74SMatthias Ringwald 107537d33cb26SMilanka Ringwald // setup Controller info 107547d33cb26SMilanka Ringwald hci_stack->num_cmd_packets = 255; 107557d33cb26SMilanka Ringwald hci_stack->acl_packets_total_num = 255; 107567d33cb26SMilanka Ringwald 1075718976c74SMatthias Ringwald // setup incoming Classic ACL connection with con handle 0x0001, 66:55:44:33:22:01 1075818976c74SMatthias Ringwald addr[5] = 0x01; 1075917ab8643SMatthias Ringwald conn = create_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL, HCI_ROLE_SLAVE); 1076018976c74SMatthias Ringwald conn->con_handle = addr[5]; 1076118976c74SMatthias Ringwald conn->state = RECEIVED_CONNECTION_REQUEST; 107627d33cb26SMilanka Ringwald conn->sm_connection.sm_role = HCI_ROLE_SLAVE; 1076318976c74SMatthias Ringwald 1076418976c74SMatthias Ringwald // setup incoming Classic SCO connection with con handle 0x0002 1076518976c74SMatthias Ringwald addr[5] = 0x02; 1076617ab8643SMatthias Ringwald conn = create_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_SCO, HCI_ROLE_SLAVE); 1076718976c74SMatthias Ringwald conn->con_handle = addr[5]; 1076818976c74SMatthias Ringwald conn->state = RECEIVED_CONNECTION_REQUEST; 107697d33cb26SMilanka Ringwald conn->sm_connection.sm_role = HCI_ROLE_SLAVE; 1077018976c74SMatthias Ringwald 1077118976c74SMatthias Ringwald // setup ready Classic ACL connection with con handle 0x0003 1077218976c74SMatthias Ringwald addr[5] = 0x03; 1077317ab8643SMatthias Ringwald conn = create_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL, HCI_ROLE_SLAVE); 1077418976c74SMatthias Ringwald conn->con_handle = addr[5]; 1077518976c74SMatthias Ringwald conn->state = OPEN; 107767d33cb26SMilanka Ringwald conn->sm_connection.sm_role = HCI_ROLE_SLAVE; 1077718976c74SMatthias Ringwald 1077818976c74SMatthias Ringwald // setup ready Classic SCO connection with con handle 0x0004 1077918976c74SMatthias Ringwald addr[5] = 0x04; 1078017ab8643SMatthias Ringwald conn = create_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_SCO, HCI_ROLE_SLAVE); 1078118976c74SMatthias Ringwald conn->con_handle = addr[5]; 1078218976c74SMatthias Ringwald conn->state = OPEN; 107837d33cb26SMilanka Ringwald conn->sm_connection.sm_role = HCI_ROLE_SLAVE; 1078418976c74SMatthias Ringwald 1078518976c74SMatthias Ringwald // setup ready LE ACL connection with con handle 0x005 and public address 1078618976c74SMatthias Ringwald addr[5] = 0x05; 1078717ab8643SMatthias Ringwald conn = create_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_LE_PUBLIC, HCI_ROLE_SLAVE); 1078818976c74SMatthias Ringwald conn->con_handle = addr[5]; 1078918976c74SMatthias Ringwald conn->state = OPEN; 107907d33cb26SMilanka Ringwald conn->sm_connection.sm_role = HCI_ROLE_SLAVE; 107918046a24aSMatthias Ringwald conn->sm_connection.sm_connection_encrypted = 1; 1079218976c74SMatthias Ringwald } 1079318976c74SMatthias Ringwald 10794eddac615SMatthias Ringwald void hci_free_connections_fuzz(void){ 10795eddac615SMatthias Ringwald btstack_linked_list_iterator_t it; 10796eddac615SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->connections); 10797eddac615SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 10798eddac615SMatthias Ringwald hci_connection_t * con = (hci_connection_t*) btstack_linked_list_iterator_next(&it); 10799eddac615SMatthias Ringwald btstack_linked_list_iterator_remove(&it); 10800eddac615SMatthias Ringwald btstack_memory_hci_connection_free(con); 10801eddac615SMatthias Ringwald } 10802eddac615SMatthias Ringwald } 108031470db0cSMatthias Ringwald void hci_simulate_working_fuzz(void){ 10804b6ffb67fSMatthias Ringwald hci_stack->le_scanning_param_update = false; 108051470db0cSMatthias Ringwald hci_init_done(); 108061470db0cSMatthias Ringwald hci_stack->num_cmd_packets = 255; 108071470db0cSMatthias Ringwald } 10808eddac615SMatthias Ringwald #endif 10809