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 \ 163a858a414SMatthias Ringwald X( SUPPORTED_HCI_COMMAND_READ_REMOTE_EXTENDED_FEATURES , 2, 6) \ 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) \ 178d0753e0fSMatthias Ringwald X( SUPPORTED_HCI_COMMAND_LE_SET_EXTENDED_ADVERTISING_ENABLE , 36, 5) \ 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); 2179da9850bSMatthias Ringwald static void hci_emit_btstack_event(uint8_t * event, uint16_t size, int dump); 218b83d5eabSMatthias Ringwald static void hci_emit_acl_packet(uint8_t * packet, uint16_t size); 21995d71764SMatthias Ringwald static void hci_run(void); 220617c03d6SMatthias Ringwald static bool hci_is_le_connection(hci_connection_t * connection); 221ed208344SMatthias Ringwald static uint8_t hci_send_prepared_cmd_packet(void); 2226a5ffed8SMatthias Ringwald 2236a5ffed8SMatthias Ringwald #ifdef ENABLE_CLASSIC 224f234b250SMatthias Ringwald static int hci_have_usb_transport(void); 225dbe0d85cSMatthias Ringwald static void hci_trigger_remote_features_for_connection(hci_connection_t * connection); 2266a5ffed8SMatthias Ringwald #endif 2275d509858SMatthias Ringwald 228a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE 229137a570aSMatthias Ringwald static bool hci_run_general_gap_le(void); 230137a570aSMatthias Ringwald static void gap_privacy_clients_handle_ready(void); 231137a570aSMatthias Ringwald static void gap_privacy_clients_notify(bd_addr_t new_random_address); 232e8c8828eSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 23339677e66SMatthias Ringwald // called from test/ble_client/advertising_data_parser.c 234384b59deSMatthias Ringwald void le_handle_advertisement_report(uint8_t *packet, uint16_t size); 235667ba9d1SMatthias Ringwald static uint8_t hci_whitelist_remove(bd_addr_type_t address_type, const bd_addr_t address); 236ca0d6e5aSMatthias Ringwald static hci_connection_t * gap_get_outgoing_le_connection(void); 237c42da3bcSMatthias Ringwald static void hci_le_scan_stop(void); 2385d509858SMatthias Ringwald #endif 23925df6c61SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 240ee54aff5SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 24125df6c61SMatthias Ringwald static le_advertising_set_t * hci_advertising_set_for_handle(uint8_t advertising_handle); 242033393eeSBob Abeles static uint8_t hci_le_extended_advertising_operation_for_chunk(uint16_t pos, uint16_t len); 243033393eeSBob Abeles static void le_handle_extended_advertisement_report(uint8_t *packet, uint16_t size); 244ee54aff5SMatthias Ringwald #endif /* ENABLE_LE_EXTENDED_ADVERTISING */ 245ee54aff5SMatthias Ringwald #endif /* ENABLE_LE_PERIPHERAL */ 2464ae8623eSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS 247969d876aSMatthias 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); 2484ae8623eSMatthias Ringwald static void hci_iso_stream_finalize(hci_iso_stream_t * iso_stream); 249778463d0SMatthias Ringwald static void hci_iso_stream_finalize_by_type_and_group_id(hci_iso_type_t iso_type, uint8_t group_id); 25015a15be3SMatthias Ringwald static hci_iso_stream_t * hci_iso_stream_for_con_handle(hci_con_handle_t con_handle); 25115a15be3SMatthias Ringwald static void hci_iso_stream_requested_finalize(uint8_t big_handle); 25215a15be3SMatthias Ringwald static void hci_iso_stream_requested_confirm(uint8_t big_handle); 253750818acSMatthias Ringwald static void hci_iso_packet_handler(hci_iso_stream_t *iso_stream, uint8_t *packet, uint16_t size); 2547aa35f6aSMatthias Ringwald static le_audio_big_t * hci_big_for_handle(uint8_t big_handle); 255d3a89d91SMatthias Ringwald static le_audio_cig_t * hci_cig_for_id(uint8_t cig_id); 2565ade6657SMatthias Ringwald static void hci_iso_notify_can_send_now(void); 2577aa35f6aSMatthias Ringwald static void hci_emit_big_created(const le_audio_big_t * big, uint8_t status); 2587aa35f6aSMatthias Ringwald static void hci_emit_big_terminated(const le_audio_big_t * big); 2592a6c0f82SMatthias Ringwald static void hci_emit_big_sync_created(const le_audio_big_sync_t * big_sync, uint8_t status); 260d04a9afcSMatthias Ringwald static void hci_emit_big_sync_stopped(uint8_t big_handle); 261d3a89d91SMatthias Ringwald static void hci_emit_cig_created(const le_audio_cig_t * cig, uint8_t status); 26214045fdbSMatthias Ringwald static void hci_cis_handle_created(hci_iso_stream_t * iso_stream, uint8_t status); 2632a6c0f82SMatthias Ringwald static le_audio_big_sync_t * hci_big_sync_for_handle(uint8_t big_handle); 2644ae8623eSMatthias Ringwald #endif /* ENABLE_LE_ISOCHRONOUS_STREAMS */ 265ee54aff5SMatthias Ringwald #endif /* ENABLE_BLE */ 266758b46ceSmatthias.ringwald 26706b35ec0Smatthias.ringwald // the STACK is here 2683a9fb326S[email protected] #ifndef HAVE_MALLOC 2693a9fb326S[email protected] static hci_stack_t hci_stack_static; 2703a9fb326S[email protected] #endif 2713a9fb326S[email protected] static hci_stack_t * hci_stack = NULL; 27216833f0aSmatthias.ringwald 2731c9e5e9dSMatthias Ringwald #ifdef ENABLE_CLASSIC 27463168530SMatthias Ringwald // default name 27563168530SMatthias Ringwald static const char * default_classic_name = "BTstack 00:00:00:00:00:00"; 27663168530SMatthias Ringwald 27766fb9560S[email protected] // test helper 27866fb9560S[email protected] static uint8_t disable_l2cap_timeouts = 0; 2791c9e5e9dSMatthias Ringwald #endif 28066fb9560S[email protected] 281aee5d5c1SMatthias Ringwald // reset connection state on create and on reconnect 282aee5d5c1SMatthias Ringwald // don't overwrite addr, con handle, role 283aee5d5c1SMatthias Ringwald static void hci_connection_init(hci_connection_t * conn){ 2848daf94bcSMatthias Ringwald conn->authentication_flags = AUTH_FLAG_NONE; 28596a45072S[email protected] conn->bonding_flags = 0; 28696a45072S[email protected] conn->requested_security_level = LEVEL_0; 2878ce18681SMatthias Ringwald conn->link_key_type = INVALID_LINK_KEY; 28852db98b2SMatthias Ringwald #ifdef ENABLE_CLASSIC 28988a03c8dSMatthias Ringwald conn->request_role = HCI_ROLE_INVALID; 290140c0557SMatthias Ringwald conn->sniff_subrating_max_latency = 0xffff; 291965a4ccfSMatthias Ringwald conn->qos_service_type = HCI_SERVICE_TYPE_INVALID; 29291a977e8SMatthias Ringwald btstack_run_loop_set_timer_handler(&conn->timeout, hci_connection_timeout_handler); 29391a977e8SMatthias Ringwald btstack_run_loop_set_timer_context(&conn->timeout, conn); 29496a45072S[email protected] hci_connection_timestamp(conn); 29552db98b2SMatthias Ringwald #endif 29696a45072S[email protected] conn->acl_recombination_length = 0; 29796a45072S[email protected] conn->acl_recombination_pos = 0; 298ce41473eSMatthias Ringwald conn->num_packets_sent = 0; 299760b20efSMatthias Ringwald 300da886c03S[email protected] conn->le_con_parameter_update_state = CON_PARAMETER_UPDATE_NONE; 301b90f6e0aSMatthias Ringwald #ifdef ENABLE_BLE 302b90f6e0aSMatthias Ringwald conn->le_phy_update_all_phys = 0xff; 303b90f6e0aSMatthias Ringwald #endif 3040f3b27c5SMatthias Ringwald #ifdef ENABLE_LE_LIMIT_ACL_FRAGMENT_BY_MAX_OCTETS 3050f3b27c5SMatthias Ringwald conn->le_max_tx_octets = 27; 3060f3b27c5SMatthias Ringwald #endif 307cb439cf1SMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB 308cb439cf1SMatthias Ringwald conn->classic_oob_c_192 = NULL; 309cb439cf1SMatthias Ringwald conn->classic_oob_r_192 = NULL; 310cb439cf1SMatthias Ringwald conn->classic_oob_c_256 = NULL; 311cb439cf1SMatthias Ringwald conn->classic_oob_r_256 = NULL; 312cb439cf1SMatthias Ringwald #endif 3134dcab8b6SMatthias Ringwald #ifdef ENABLE_LE_PERIODIC_ADVERTISING 3144dcab8b6SMatthias Ringwald conn->le_past_sync_handle = HCI_CON_HANDLE_INVALID; 3154dcab8b6SMatthias Ringwald conn->le_past_advertising_handle = 0xff; 3164dcab8b6SMatthias Ringwald #endif 317aee5d5c1SMatthias Ringwald } 318aee5d5c1SMatthias Ringwald 319aee5d5c1SMatthias Ringwald /** 320aee5d5c1SMatthias Ringwald * create connection for given address 321aee5d5c1SMatthias Ringwald * 322aee5d5c1SMatthias Ringwald * @return connection OR NULL, if no memory left 323aee5d5c1SMatthias Ringwald */ 32488f925b1SMatthias Ringwald static hci_connection_t * 32588f925b1SMatthias Ringwald create_connection_for_bd_addr_and_type(const bd_addr_t addr, bd_addr_type_t addr_type, hci_role_t role) { 326aee5d5c1SMatthias Ringwald log_info("create_connection_for_addr %s, type %x", bd_addr_to_str(addr), addr_type); 327aee5d5c1SMatthias Ringwald 328aee5d5c1SMatthias Ringwald hci_connection_t * conn = btstack_memory_hci_connection_get(); 329aee5d5c1SMatthias Ringwald if (!conn) return NULL; 330aee5d5c1SMatthias Ringwald hci_connection_init(conn); 331aee5d5c1SMatthias Ringwald 332aee5d5c1SMatthias Ringwald bd_addr_copy(conn->address, addr); 333aee5d5c1SMatthias Ringwald conn->address_type = addr_type; 334aee5d5c1SMatthias Ringwald conn->con_handle = HCI_CON_HANDLE_INVALID; 33588f925b1SMatthias Ringwald conn->role = role; 336665d90f2SMatthias Ringwald btstack_linked_list_add(&hci_stack->connections, (btstack_linked_item_t *) conn); 337aee5d5c1SMatthias Ringwald 33896a45072S[email protected] return conn; 33996a45072S[email protected] } 34066fb9560S[email protected] 341da886c03S[email protected] 342da886c03S[email protected] /** 343da886c03S[email protected] * get le connection parameter range 344da886c03S[email protected] * 345da886c03S[email protected] * @return le connection parameter range struct 346da886c03S[email protected] */ 3474ced4e8cSMatthias Ringwald void gap_get_connection_parameter_range(le_connection_parameter_range_t * range){ 3484ced4e8cSMatthias Ringwald *range = hci_stack->le_connection_parameter_range; 349da886c03S[email protected] } 350da886c03S[email protected] 351da886c03S[email protected] /** 352da886c03S[email protected] * set le connection parameter range 353da886c03S[email protected] * 354da886c03S[email protected] */ 355da886c03S[email protected] 3564ced4e8cSMatthias Ringwald void gap_set_connection_parameter_range(le_connection_parameter_range_t *range){ 3574ced4e8cSMatthias Ringwald hci_stack->le_connection_parameter_range = *range; 358da886c03S[email protected] } 359da886c03S[email protected] 360da886c03S[email protected] /** 36173cd8a2aSMatthias Ringwald * @brief Test if connection parameters are inside in existing rage 36273cd8a2aSMatthias Ringwald * @param conn_interval_min (unit: 1.25ms) 36373cd8a2aSMatthias Ringwald * @param conn_interval_max (unit: 1.25ms) 36473cd8a2aSMatthias Ringwald * @param conn_latency 36573cd8a2aSMatthias Ringwald * @param supervision_timeout (unit: 10ms) 3666b65794dSMilanka Ringwald * @return 1 if included 36773cd8a2aSMatthias Ringwald */ 36873cd8a2aSMatthias 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){ 36973cd8a2aSMatthias Ringwald if (le_conn_interval_min < existing_range->le_conn_interval_min) return 0; 37073cd8a2aSMatthias Ringwald if (le_conn_interval_max > existing_range->le_conn_interval_max) return 0; 37173cd8a2aSMatthias Ringwald 37273cd8a2aSMatthias Ringwald if (le_conn_latency < existing_range->le_conn_latency_min) return 0; 37373cd8a2aSMatthias Ringwald if (le_conn_latency > existing_range->le_conn_latency_max) return 0; 37473cd8a2aSMatthias Ringwald 37573cd8a2aSMatthias Ringwald if (le_supervision_timeout < existing_range->le_supervision_timeout_min) return 0; 37673cd8a2aSMatthias Ringwald if (le_supervision_timeout > existing_range->le_supervision_timeout_max) return 0; 37773cd8a2aSMatthias Ringwald 37873cd8a2aSMatthias Ringwald return 1; 37973cd8a2aSMatthias Ringwald } 38073cd8a2aSMatthias Ringwald 38173cd8a2aSMatthias Ringwald /** 3822b6ab3e6SMatthias Ringwald * @brief Set max number of connections in LE Peripheral role (if Bluetooth Controller supports it) 3832b6ab3e6SMatthias Ringwald * @note: default: 1 3842b6ab3e6SMatthias Ringwald * @param max_peripheral_connections 3852b6ab3e6SMatthias Ringwald */ 386d4e4907bSMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 3872b6ab3e6SMatthias Ringwald void gap_set_max_number_peripheral_connections(int max_peripheral_connections){ 3882b6ab3e6SMatthias Ringwald hci_stack->le_max_number_peripheral_connections = max_peripheral_connections; 3892b6ab3e6SMatthias Ringwald } 390d4e4907bSMatthias Ringwald #endif 3912b6ab3e6SMatthias Ringwald 3922b6ab3e6SMatthias Ringwald /** 393da886c03S[email protected] * get hci connections iterator 394da886c03S[email protected] * 395da886c03S[email protected] * @return hci connections iterator 396da886c03S[email protected] */ 397da886c03S[email protected] 398665d90f2SMatthias Ringwald void hci_connections_get_iterator(btstack_linked_list_iterator_t *it){ 399665d90f2SMatthias Ringwald btstack_linked_list_iterator_init(it, &hci_stack->connections); 400da886c03S[email protected] } 401da886c03S[email protected] 40297addcc5Smatthias.ringwald /** 403ee091cf1Smatthias.ringwald * get connection for a given handle 404ee091cf1Smatthias.ringwald * 405ee091cf1Smatthias.ringwald * @return connection OR NULL, if not found 406ee091cf1Smatthias.ringwald */ 4075061f3afS[email protected] hci_connection_t * hci_connection_for_handle(hci_con_handle_t con_handle){ 408665d90f2SMatthias Ringwald btstack_linked_list_iterator_t it; 409665d90f2SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->connections); 410665d90f2SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 411665d90f2SMatthias Ringwald hci_connection_t * item = (hci_connection_t *) btstack_linked_list_iterator_next(&it); 4123ac2fe56S[email protected] if ( item->con_handle == con_handle ) { 413da886c03S[email protected] return item; 414ee091cf1Smatthias.ringwald } 415ee091cf1Smatthias.ringwald } 416ee091cf1Smatthias.ringwald return NULL; 417ee091cf1Smatthias.ringwald } 418ee091cf1Smatthias.ringwald 41996a45072S[email protected] /** 42096a45072S[email protected] * get connection for given address 42196a45072S[email protected] * 42296a45072S[email protected] * @return connection OR NULL, if not found 42396a45072S[email protected] */ 424667ba9d1SMatthias Ringwald hci_connection_t * hci_connection_for_bd_addr_and_type(const bd_addr_t addr, bd_addr_type_t addr_type){ 425665d90f2SMatthias Ringwald btstack_linked_list_iterator_t it; 426665d90f2SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->connections); 427665d90f2SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 428665d90f2SMatthias Ringwald hci_connection_t * connection = (hci_connection_t *) btstack_linked_list_iterator_next(&it); 42996a45072S[email protected] if (connection->address_type != addr_type) continue; 43096a45072S[email protected] if (memcmp(addr, connection->address, 6) != 0) continue; 43162bda3fbS[email protected] return connection; 43262bda3fbS[email protected] } 43362bda3fbS[email protected] return NULL; 43462bda3fbS[email protected] } 43562bda3fbS[email protected] 436d5f71a7eSMatthias Ringwald #ifdef ENABLE_CLASSIC 437d5f71a7eSMatthias Ringwald 4383e5e0926SMatthias Ringwald inline static void connectionClearAuthenticationFlags(hci_connection_t * conn, hci_authentication_flags_t flags){ 4393e5e0926SMatthias Ringwald conn->authentication_flags = (hci_authentication_flags_t)(conn->authentication_flags & ~flags); 4403e5e0926SMatthias Ringwald } 44152db98b2SMatthias Ringwald 442228e430cSMatthias Ringwald inline static void connectionSetAuthenticationFlags(hci_connection_t * conn, hci_authentication_flags_t flags){ 443228e430cSMatthias Ringwald conn->authentication_flags = (hci_authentication_flags_t)(conn->authentication_flags | flags); 444228e430cSMatthias Ringwald } 445228e430cSMatthias Ringwald 446ee752bb8SMatthias Ringwald #ifdef ENABLE_SCO_OVER_HCI 447ee752bb8SMatthias Ringwald static int hci_number_sco_connections(void){ 448ee752bb8SMatthias Ringwald int connections = 0; 449ee752bb8SMatthias Ringwald btstack_linked_list_iterator_t it; 450ee752bb8SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->connections); 451ee752bb8SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 452ee752bb8SMatthias Ringwald hci_connection_t * connection = (hci_connection_t *) btstack_linked_list_iterator_next(&it); 453ee752bb8SMatthias Ringwald if (connection->address_type != BD_ADDR_TYPE_SCO) continue; 454ee752bb8SMatthias Ringwald connections++; 455ee752bb8SMatthias Ringwald } 456ee752bb8SMatthias Ringwald return connections; 457ee752bb8SMatthias Ringwald } 458ee752bb8SMatthias Ringwald #endif 459ee752bb8SMatthias Ringwald 460ec820d77SMatthias Ringwald static void hci_connection_timeout_handler(btstack_timer_source_t *timer){ 46191a977e8SMatthias Ringwald hci_connection_t * connection = (hci_connection_t *) btstack_run_loop_get_timer_context(timer); 462aec7654dSMatthias Ringwald #ifdef HAVE_EMBEDDED_TICK 463528a4a3bSMatthias Ringwald if (btstack_run_loop_embedded_get_ticks() > connection->timestamp + btstack_run_loop_embedded_ticks_for_ms(HCI_CONNECTION_TIMEOUT_MS)){ 464c785ef68Smatthias.ringwald // connections might be timed out 465c785ef68Smatthias.ringwald hci_emit_l2cap_check_timeout(connection); 466c785ef68Smatthias.ringwald } 467f316a845SMatthias Ringwald #else 468c1ab6cc1SMatthias Ringwald if (btstack_run_loop_get_time_ms() > (connection->timestamp + HCI_CONNECTION_TIMEOUT_MS)){ 4695f26aadcSMatthias Ringwald // connections might be timed out 4705f26aadcSMatthias Ringwald hci_emit_l2cap_check_timeout(connection); 4715f26aadcSMatthias Ringwald } 4725f26aadcSMatthias Ringwald #endif 473c785ef68Smatthias.ringwald } 474ee091cf1Smatthias.ringwald 475ee091cf1Smatthias.ringwald static void hci_connection_timestamp(hci_connection_t *connection){ 476aec7654dSMatthias Ringwald #ifdef HAVE_EMBEDDED_TICK 477528a4a3bSMatthias Ringwald connection->timestamp = btstack_run_loop_embedded_get_ticks(); 478f316a845SMatthias Ringwald #else 479528a4a3bSMatthias Ringwald connection->timestamp = btstack_run_loop_get_time_ms(); 4805f26aadcSMatthias Ringwald #endif 481ee091cf1Smatthias.ringwald } 482ee091cf1Smatthias.ringwald 48343bfb1bdSmatthias.ringwald /** 48480ca58a0Smatthias.ringwald * add authentication flags and reset timer 48596a45072S[email protected] * @note: assumes classic connection 486a086dc35SMatthias Ringwald * @note: bd_addr is passed in as little endian uint8_t * as it is called from parsing packets 4877fde4af9Smatthias.ringwald */ 4887fde4af9Smatthias.ringwald static void hci_add_connection_flags_for_flipped_bd_addr(uint8_t *bd_addr, hci_authentication_flags_t flags){ 4897fde4af9Smatthias.ringwald bd_addr_t addr; 490724d70a2SMatthias Ringwald reverse_bd_addr(bd_addr, addr); 491f16129ceSMatthias Ringwald hci_connection_t * conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL); 4927fde4af9Smatthias.ringwald if (conn) { 49328ca2b46S[email protected] connectionSetAuthenticationFlags(conn, flags); 49480ca58a0Smatthias.ringwald hci_connection_timestamp(conn); 4957fde4af9Smatthias.ringwald } 4967fde4af9Smatthias.ringwald } 4977fde4af9Smatthias.ringwald 4981714cbbdSMatthias Ringwald static bool hci_pairing_active(hci_connection_t * hci_connection){ 4998daf94bcSMatthias Ringwald return (hci_connection->authentication_flags & AUTH_FLAG_PAIRING_ACTIVE_MASK) != 0; 5001714cbbdSMatthias Ringwald } 5011714cbbdSMatthias Ringwald 5021714cbbdSMatthias Ringwald static void hci_pairing_started(hci_connection_t * hci_connection, bool ssp){ 5031714cbbdSMatthias Ringwald if (hci_pairing_active(hci_connection)) return; 5041714cbbdSMatthias Ringwald if (ssp){ 5058daf94bcSMatthias Ringwald hci_connection->authentication_flags |= AUTH_FLAG_SSP_PAIRING_ACTIVE; 5061714cbbdSMatthias Ringwald } else { 5078daf94bcSMatthias Ringwald hci_connection->authentication_flags |= AUTH_FLAG_LEGACY_PAIRING_ACTIVE; 5081714cbbdSMatthias Ringwald } 5091714cbbdSMatthias Ringwald // if we are initiator, we have sent an HCI Authenticate Request 5101714cbbdSMatthias Ringwald bool initiator = (hci_connection->bonding_flags & BONDING_SENT_AUTHENTICATE_REQUEST) != 0; 5111714cbbdSMatthias Ringwald 5125a561920SMatthias Ringwald // if we are responder, use minimal service security level as required level 5135a561920SMatthias Ringwald if (!initiator){ 514acadfdd0SMatthias 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); 5155a561920SMatthias Ringwald } 5165a561920SMatthias Ringwald 5175a561920SMatthias Ringwald log_info("pairing started, ssp %u, initiator %u, requested level %u", (int) ssp, (int) initiator, hci_connection->requested_security_level); 51877208d90SMatthias Ringwald 51977208d90SMatthias Ringwald uint8_t event[12]; 52077208d90SMatthias Ringwald event[0] = GAP_EVENT_PAIRING_STARTED; 52177208d90SMatthias Ringwald event[1] = 10; 522bfaf6993SMatthias Ringwald little_endian_store_16(event, 2, (uint16_t) hci_connection->con_handle); 5234159a80bSMatthias Ringwald reverse_bd_addr(hci_connection->address, &event[4]); 52477208d90SMatthias Ringwald event[10] = (uint8_t) ssp; 52577208d90SMatthias Ringwald event[11] = (uint8_t) initiator; 5269da9850bSMatthias Ringwald hci_emit_btstack_event(event, sizeof(event), 1); 5271714cbbdSMatthias Ringwald } 5281714cbbdSMatthias Ringwald 5291714cbbdSMatthias Ringwald static void hci_pairing_complete(hci_connection_t * hci_connection, uint8_t status){ 5303c439ac4SMatthias Ringwald hci_connection->requested_security_level = LEVEL_0; 5311714cbbdSMatthias Ringwald if (!hci_pairing_active(hci_connection)) return; 5328daf94bcSMatthias Ringwald hci_connection->authentication_flags &= ~AUTH_FLAG_PAIRING_ACTIVE_MASK; 5331e7371deSMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB 534cb439cf1SMatthias Ringwald hci_connection->classic_oob_c_192 = NULL; 535cb439cf1SMatthias Ringwald hci_connection->classic_oob_r_192 = NULL; 536cb439cf1SMatthias Ringwald hci_connection->classic_oob_c_256 = NULL; 537cb439cf1SMatthias Ringwald hci_connection->classic_oob_r_256 = NULL; 5381e7371deSMatthias Ringwald #endif 5391714cbbdSMatthias Ringwald log_info("pairing complete, status %02x", status); 54077208d90SMatthias Ringwald 5413176c896SMatthias Ringwald uint8_t event[11]; 54277208d90SMatthias Ringwald event[0] = GAP_EVENT_PAIRING_COMPLETE; 54377208d90SMatthias Ringwald event[1] = 9; 544bfaf6993SMatthias Ringwald little_endian_store_16(event, 2, (uint16_t) hci_connection->con_handle); 5454159a80bSMatthias Ringwald reverse_bd_addr(hci_connection->address, &event[4]); 54677208d90SMatthias Ringwald event[10] = status; 5479da9850bSMatthias Ringwald hci_emit_btstack_event(event, sizeof(event), 1); 5485999ee11SMatthias Ringwald 5495999ee11SMatthias Ringwald // emit dedicated bonding done on failure, otherwise verify that connection can be encrypted 5505999ee11SMatthias Ringwald if ((status != ERROR_CODE_SUCCESS) && ((hci_connection->bonding_flags & BONDING_DEDICATED) != 0)){ 5515999ee11SMatthias Ringwald hci_connection->bonding_flags &= ~BONDING_DEDICATED; 5525999ee11SMatthias Ringwald hci_connection->bonding_flags |= BONDING_DISCONNECT_DEDICATED_DONE; 5535999ee11SMatthias Ringwald hci_connection->bonding_status = status; 5545999ee11SMatthias Ringwald } 5551714cbbdSMatthias Ringwald } 5561714cbbdSMatthias Ringwald 55720dcdd22SMatthias Ringwald bool hci_authentication_active_for_handle(hci_con_handle_t handle){ 5585061f3afS[email protected] hci_connection_t * conn = hci_connection_for_handle(handle); 55920dcdd22SMatthias Ringwald if (!conn) return false; 56020dcdd22SMatthias Ringwald return hci_pairing_active(conn); 56180ca58a0Smatthias.ringwald } 56280ca58a0Smatthias.ringwald 56315a95bd5SMatthias Ringwald void gap_drop_link_key_for_bd_addr(bd_addr_t addr){ 56455597469SMatthias Ringwald if (!hci_stack->link_key_db) return; 5652bacf595SMatthias Ringwald log_info("gap_drop_link_key_for_bd_addr: %s", bd_addr_to_str(addr)); 566a98592bcSMatthias Ringwald hci_stack->link_key_db->delete_link_key(addr); 567c12e46e7Smatthias.ringwald } 56855597469SMatthias Ringwald 56955597469SMatthias Ringwald void gap_store_link_key_for_bd_addr(bd_addr_t addr, link_key_t link_key, link_key_type_t type){ 57055597469SMatthias Ringwald if (!hci_stack->link_key_db) return; 5712bacf595SMatthias Ringwald log_info("gap_store_link_key_for_bd_addr: %s, type %u", bd_addr_to_str(addr), type); 57255597469SMatthias Ringwald hci_stack->link_key_db->put_link_key(addr, link_key, type); 573c12e46e7Smatthias.ringwald } 5741b6fb31bSMatthias Ringwald 575e8ad470fSMatthias Ringwald bool gap_get_link_key_for_bd_addr(bd_addr_t addr, link_key_t link_key, link_key_type_t * type){ 576e8ad470fSMatthias Ringwald if (!hci_stack->link_key_db) return false; 57776b0318eSMatthias Ringwald int result = hci_stack->link_key_db->get_link_key(addr, link_key, type) != 0; 57876b0318eSMatthias Ringwald log_info("link key for %s available %u, type %u", bd_addr_to_str(addr), result, (int) *type); 57976b0318eSMatthias Ringwald return result; 580e8ad470fSMatthias Ringwald } 581e8ad470fSMatthias Ringwald 582ceecb9d9SMatthias Ringwald void gap_delete_all_link_keys(void){ 583ceecb9d9SMatthias Ringwald bd_addr_t addr; 584ceecb9d9SMatthias Ringwald link_key_t link_key; 585ceecb9d9SMatthias Ringwald link_key_type_t type; 586ceecb9d9SMatthias Ringwald btstack_link_key_iterator_t it; 587ceecb9d9SMatthias Ringwald int ok = gap_link_key_iterator_init(&it); 588ceecb9d9SMatthias Ringwald if (!ok) { 589ceecb9d9SMatthias Ringwald log_error("could not initialize iterator"); 590ceecb9d9SMatthias Ringwald return; 591ceecb9d9SMatthias Ringwald } 592ceecb9d9SMatthias Ringwald while (gap_link_key_iterator_get_next(&it, addr, link_key, &type)){ 593ceecb9d9SMatthias Ringwald gap_drop_link_key_for_bd_addr(addr); 594ceecb9d9SMatthias Ringwald } 595ceecb9d9SMatthias Ringwald gap_link_key_iterator_done(&it); 596ceecb9d9SMatthias Ringwald } 597ceecb9d9SMatthias Ringwald 5981b6fb31bSMatthias Ringwald int gap_link_key_iterator_init(btstack_link_key_iterator_t * it){ 5991b6fb31bSMatthias Ringwald if (!hci_stack->link_key_db) return 0; 6001b6fb31bSMatthias Ringwald if (!hci_stack->link_key_db->iterator_init) return 0; 6011b6fb31bSMatthias Ringwald return hci_stack->link_key_db->iterator_init(it); 6021b6fb31bSMatthias Ringwald } 6031b6fb31bSMatthias 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){ 6041b6fb31bSMatthias Ringwald if (!hci_stack->link_key_db) return 0; 6051b6fb31bSMatthias Ringwald return hci_stack->link_key_db->iterator_get_next(it, bd_addr, link_key, type); 6061b6fb31bSMatthias Ringwald } 6071b6fb31bSMatthias Ringwald void gap_link_key_iterator_done(btstack_link_key_iterator_t * it){ 6081b6fb31bSMatthias Ringwald if (!hci_stack->link_key_db) return; 6091b6fb31bSMatthias Ringwald hci_stack->link_key_db->iterator_done(it); 6101b6fb31bSMatthias Ringwald } 61135454696SMatthias Ringwald #endif 612c12e46e7Smatthias.ringwald 6138e97a820SMatthias Ringwald bool hci_is_le_connection_type(bd_addr_type_t address_type){ 614eb8076ddSMatthias Ringwald switch (address_type){ 615ce41473eSMatthias Ringwald case BD_ADDR_TYPE_LE_PUBLIC: 616ce41473eSMatthias Ringwald case BD_ADDR_TYPE_LE_RANDOM: 6173739bc96SMatthias Ringwald case BD_ADDR_TYPE_LE_PUBLIC_IDENTITY: 6183739bc96SMatthias Ringwald case BD_ADDR_TYPE_LE_RANDOM_IDENTITY: 619eb8076ddSMatthias Ringwald return true; 620ce41473eSMatthias Ringwald default: 621eb8076ddSMatthias Ringwald return false; 622ce41473eSMatthias Ringwald } 6230bf6344aS[email protected] } 6240bf6344aS[email protected] 6250890cf2bSMatthias Ringwald bool hci_is_le_identity_address_type(bd_addr_type_t address_type){ 6260890cf2bSMatthias Ringwald switch (address_type){ 6270890cf2bSMatthias Ringwald case BD_ADDR_TYPE_LE_PUBLIC_IDENTITY: 6280890cf2bSMatthias Ringwald case BD_ADDR_TYPE_LE_RANDOM_IDENTITY: 6290890cf2bSMatthias Ringwald return true; 6300890cf2bSMatthias Ringwald default: 6310890cf2bSMatthias Ringwald return false; 6320890cf2bSMatthias Ringwald } 6330890cf2bSMatthias Ringwald } 6340890cf2bSMatthias Ringwald 635617c03d6SMatthias Ringwald static bool hci_is_le_connection(hci_connection_t * connection){ 636eb8076ddSMatthias Ringwald return hci_is_le_connection_type(connection->address_type); 637eb8076ddSMatthias Ringwald } 638eb8076ddSMatthias Ringwald 6397fde4af9Smatthias.ringwald /** 64043bfb1bdSmatthias.ringwald * count connections 64143bfb1bdSmatthias.ringwald */ 64240d1c7a4Smatthias.ringwald static int nr_hci_connections(void){ 64356c253c9Smatthias.ringwald int count = 0; 644665d90f2SMatthias Ringwald btstack_linked_item_t *it; 645a0da043fSMatthias Ringwald for (it = (btstack_linked_item_t *) hci_stack->connections; it != NULL ; it = it->next){ 64615a27967SMatthias Ringwald count++; 64715a27967SMatthias Ringwald } 64843bfb1bdSmatthias.ringwald return count; 64943bfb1bdSmatthias.ringwald } 650c8e4258aSmatthias.ringwald 6518f733c6fSMatthias Ringwald uint16_t hci_number_free_acl_slots_for_connection_type(bd_addr_type_t address_type){ 652ee303eddS[email protected] 653f04a0c31SMatthias Ringwald unsigned int num_packets_sent_classic = 0; 654f04a0c31SMatthias Ringwald unsigned int num_packets_sent_le = 0; 655ee303eddS[email protected] 656665d90f2SMatthias Ringwald btstack_linked_item_t *it; 657a0da043fSMatthias Ringwald for (it = (btstack_linked_item_t *) hci_stack->connections; it != NULL; it = it->next){ 658998906cdSmatthias.ringwald hci_connection_t * connection = (hci_connection_t *) it; 659ce41473eSMatthias Ringwald if (hci_is_le_connection(connection)){ 660ce41473eSMatthias Ringwald num_packets_sent_le += connection->num_packets_sent; 661ce41473eSMatthias Ringwald } 662f16129ceSMatthias Ringwald if (connection->address_type == BD_ADDR_TYPE_ACL){ 663ce41473eSMatthias Ringwald num_packets_sent_classic += connection->num_packets_sent; 664ee303eddS[email protected] } 665ee303eddS[email protected] } 666d999b54eSMatthias Ringwald log_debug("ACL classic buffers: %u used of %u", num_packets_sent_classic, hci_stack->acl_packets_total_num); 667ee303eddS[email protected] int free_slots_classic = hci_stack->acl_packets_total_num - num_packets_sent_classic; 668ee303eddS[email protected] int free_slots_le = 0; 669ee303eddS[email protected] 670ee303eddS[email protected] if (free_slots_classic < 0){ 6719da54300S[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); 672998906cdSmatthias.ringwald return 0; 673998906cdSmatthias.ringwald } 674ee303eddS[email protected] 675ee303eddS[email protected] if (hci_stack->le_acl_packets_total_num){ 676ee303eddS[email protected] // if we have LE slots, they are used 677ee303eddS[email protected] free_slots_le = hci_stack->le_acl_packets_total_num - num_packets_sent_le; 678ee303eddS[email protected] if (free_slots_le < 0){ 6799da54300S[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); 680ee303eddS[email protected] return 0; 681998906cdSmatthias.ringwald } 682ee303eddS[email protected] } else { 683ee303eddS[email protected] // otherwise, classic slots are used for LE, too 684ee303eddS[email protected] free_slots_classic -= num_packets_sent_le; 685ee303eddS[email protected] if (free_slots_classic < 0){ 6869da54300S[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); 687ee303eddS[email protected] return 0; 688ee303eddS[email protected] } 689ee303eddS[email protected] } 690ee303eddS[email protected] 691ee303eddS[email protected] switch (address_type){ 692ee303eddS[email protected] case BD_ADDR_TYPE_UNKNOWN: 6932125de09SMatthias Ringwald log_error("hci_number_free_acl_slots: unknown address type"); 694ee303eddS[email protected] return 0; 695ee303eddS[email protected] 696f16129ceSMatthias Ringwald case BD_ADDR_TYPE_ACL: 6978f733c6fSMatthias Ringwald return (uint16_t) free_slots_classic; 698ee303eddS[email protected] 699ee303eddS[email protected] default: 7008f733c6fSMatthias Ringwald if (hci_stack->le_acl_packets_total_num > 0){ 7018f733c6fSMatthias Ringwald return (uint16_t) free_slots_le; 702ee303eddS[email protected] } 7038f733c6fSMatthias Ringwald return (uint16_t) free_slots_classic; 704cb00d3aaS[email protected] } 705998906cdSmatthias.ringwald } 706998906cdSmatthias.ringwald 7072125de09SMatthias Ringwald int hci_number_free_acl_slots_for_handle(hci_con_handle_t con_handle){ 7082125de09SMatthias Ringwald // get connection type 7092125de09SMatthias Ringwald hci_connection_t * connection = hci_connection_for_handle(con_handle); 7102125de09SMatthias Ringwald if (!connection){ 7112125de09SMatthias Ringwald log_error("hci_number_free_acl_slots: handle 0x%04x not in connection list", con_handle); 7122125de09SMatthias Ringwald return 0; 7132125de09SMatthias Ringwald } 7142125de09SMatthias Ringwald return hci_number_free_acl_slots_for_connection_type(connection->address_type); 7152125de09SMatthias Ringwald } 7162125de09SMatthias Ringwald 71735454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 718701e3307SMatthias Ringwald static int hci_number_free_sco_slots(void){ 719f04a0c31SMatthias Ringwald unsigned int num_sco_packets_sent = 0; 720665d90f2SMatthias Ringwald btstack_linked_item_t *it; 721760b20efSMatthias Ringwald if (hci_stack->synchronous_flow_control_enabled){ 722760b20efSMatthias Ringwald // explicit flow control 723665d90f2SMatthias Ringwald for (it = (btstack_linked_item_t *) hci_stack->connections; it ; it = it->next){ 724e35edcc1S[email protected] hci_connection_t * connection = (hci_connection_t *) it; 725ce41473eSMatthias Ringwald if (connection->address_type != BD_ADDR_TYPE_SCO) continue; 726ce41473eSMatthias Ringwald num_sco_packets_sent += connection->num_packets_sent; 727e35edcc1S[email protected] } 728e35edcc1S[email protected] if (num_sco_packets_sent > hci_stack->sco_packets_total_num){ 729701e3307SMatthias Ringwald log_info("hci_number_free_sco_slots:packets (%u) > total packets (%u)", num_sco_packets_sent, hci_stack->sco_packets_total_num); 73044d0e3d5S[email protected] return 0; 73144d0e3d5S[email protected] } 732e35edcc1S[email protected] return hci_stack->sco_packets_total_num - num_sco_packets_sent; 73349205f5dSMatthias Ringwald } else { 734fa7f2dfdSMatthias Ringwald // implicit flow control 7356f28d2eeSMatthias Ringwald int num_ready = 0; 7366f28d2eeSMatthias Ringwald for (it = (btstack_linked_item_t *) hci_stack->connections; it ; it = it->next){ 7376f28d2eeSMatthias Ringwald hci_connection_t * connection = (hci_connection_t *) it; 7386f28d2eeSMatthias Ringwald if (connection->address_type != BD_ADDR_TYPE_SCO) continue; 7396f28d2eeSMatthias Ringwald if (connection->sco_tx_ready == 0) continue; 7406f28d2eeSMatthias Ringwald num_ready++; 74149205f5dSMatthias Ringwald } 7426f28d2eeSMatthias Ringwald return num_ready; 7436f28d2eeSMatthias Ringwald } 744e35edcc1S[email protected] } 74535454696SMatthias Ringwald #endif 74644d0e3d5S[email protected] 7472b838201SMatthias Ringwald // only used to send HCI Host Number Completed Packets 748a086dc35SMatthias Ringwald static int hci_can_send_command_packet_transport(void){ 749ac928cc2S[email protected] if (hci_stack->hci_packet_buffer_reserved) return 0; 750ac928cc2S[email protected] 751ac928cc2S[email protected] // check for async hci transport implementations 752ac928cc2S[email protected] if (hci_stack->hci_transport->can_send_packet_now){ 753ac928cc2S[email protected] if (!hci_stack->hci_transport->can_send_packet_now(HCI_COMMAND_DATA_PACKET)){ 754ac928cc2S[email protected] return 0; 755ac928cc2S[email protected] } 756ac928cc2S[email protected] } 7572b838201SMatthias Ringwald return 1; 7582b838201SMatthias Ringwald } 759ac928cc2S[email protected] 7602b838201SMatthias Ringwald // new functions replacing hci_can_send_packet_now[_using_packet_buffer] 7611972f31fSMatthias Ringwald bool hci_can_send_command_packet_now(void){ 762a086dc35SMatthias Ringwald if (hci_can_send_command_packet_transport() == 0) return false; 7634ea43905SMatthias Ringwald return hci_stack->num_cmd_packets > 0u; 764ac928cc2S[email protected] } 765ac928cc2S[email protected] 7669d04d3a7SMatthias Ringwald static int hci_transport_can_send_prepared_packet_now(uint8_t packet_type){ 767ac928cc2S[email protected] // check for async hci transport implementations 7681972f31fSMatthias Ringwald if (!hci_stack->hci_transport->can_send_packet_now) return true; 7699d04d3a7SMatthias Ringwald return hci_stack->hci_transport->can_send_packet_now(packet_type); 770ac928cc2S[email protected] } 7719d04d3a7SMatthias Ringwald 7721972f31fSMatthias Ringwald static bool hci_can_send_prepared_acl_packet_for_address_type(bd_addr_type_t address_type){ 7731972f31fSMatthias Ringwald if (!hci_transport_can_send_prepared_packet_now(HCI_ACL_DATA_PACKET)) return false; 7749d04d3a7SMatthias Ringwald return hci_number_free_acl_slots_for_connection_type(address_type) > 0; 775ac928cc2S[email protected] } 7769d04d3a7SMatthias Ringwald 7771972f31fSMatthias Ringwald bool hci_can_send_acl_le_packet_now(void){ 7781972f31fSMatthias Ringwald if (hci_stack->hci_packet_buffer_reserved) return false; 7799d04d3a7SMatthias Ringwald return hci_can_send_prepared_acl_packet_for_address_type(BD_ADDR_TYPE_LE_PUBLIC); 7809d04d3a7SMatthias Ringwald } 7819d04d3a7SMatthias Ringwald 7821972f31fSMatthias Ringwald bool hci_can_send_prepared_acl_packet_now(hci_con_handle_t con_handle) { 7831972f31fSMatthias Ringwald if (!hci_transport_can_send_prepared_packet_now(HCI_ACL_DATA_PACKET)) return false; 784e79abdd6S[email protected] return hci_number_free_acl_slots_for_handle(con_handle) > 0; 785ac928cc2S[email protected] } 786ac928cc2S[email protected] 7871972f31fSMatthias Ringwald bool hci_can_send_acl_packet_now(hci_con_handle_t con_handle){ 7881972f31fSMatthias Ringwald if (hci_stack->hci_packet_buffer_reserved) return false; 789ac928cc2S[email protected] return hci_can_send_prepared_acl_packet_now(con_handle); 7906b4af23dS[email protected] } 7916b4af23dS[email protected] 79235454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 7931972f31fSMatthias Ringwald bool hci_can_send_acl_classic_packet_now(void){ 7941972f31fSMatthias Ringwald if (hci_stack->hci_packet_buffer_reserved) return false; 795f16129ceSMatthias Ringwald return hci_can_send_prepared_acl_packet_for_address_type(BD_ADDR_TYPE_ACL); 79635454696SMatthias Ringwald } 79735454696SMatthias Ringwald 7981972f31fSMatthias Ringwald bool hci_can_send_prepared_sco_packet_now(void){ 7991972f31fSMatthias Ringwald if (!hci_transport_can_send_prepared_packet_now(HCI_SCO_DATA_PACKET)) return false; 800f234b250SMatthias Ringwald if (hci_have_usb_transport()){ 801f234b250SMatthias Ringwald return hci_stack->sco_can_send_now; 802f234b250SMatthias Ringwald } else { 803701e3307SMatthias Ringwald return hci_number_free_sco_slots() > 0; 80444d0e3d5S[email protected] } 805f234b250SMatthias Ringwald } 80644d0e3d5S[email protected] 8071972f31fSMatthias Ringwald bool hci_can_send_sco_packet_now(void){ 8081972f31fSMatthias Ringwald if (hci_stack->hci_packet_buffer_reserved) return false; 809701e3307SMatthias Ringwald return hci_can_send_prepared_sco_packet_now(); 81044d0e3d5S[email protected] } 81144d0e3d5S[email protected] 812d057580eSMatthias Ringwald void hci_request_sco_can_send_now_event(void){ 813d057580eSMatthias Ringwald hci_stack->sco_waiting_for_can_send_now = 1; 814d057580eSMatthias Ringwald hci_notify_if_sco_can_send_now(); 815d057580eSMatthias Ringwald } 81635454696SMatthias Ringwald #endif 817d057580eSMatthias Ringwald 81895d71764SMatthias Ringwald // used for internal checks in l2cap.c 81902c7fc01SMatthias Ringwald bool hci_is_packet_buffer_reserved(void){ 820c8b9416aS[email protected] return hci_stack->hci_packet_buffer_reserved; 821c8b9416aS[email protected] } 822c8b9416aS[email protected] 8238f4649e3SMatthias Ringwald void hci_reserve_packet_buffer(void){ 8245d350981SMatthias Ringwald btstack_assert(hci_stack->hci_packet_buffer_reserved == false); 82502c7fc01SMatthias Ringwald hci_stack->hci_packet_buffer_reserved = true; 8266b4af23dS[email protected] } 8276b4af23dS[email protected] 82868a0fcf7S[email protected] void hci_release_packet_buffer(void){ 8295d350981SMatthias Ringwald btstack_assert(hci_stack->hci_packet_buffer_reserved); 83002c7fc01SMatthias Ringwald hci_stack->hci_packet_buffer_reserved = false; 8315daaa52eSMatthias Ringwald hci_emit_transport_packet_sent(); 83268a0fcf7S[email protected] } 83368a0fcf7S[email protected] 8346b4af23dS[email protected] // assumption: synchronous implementations don't provide can_send_packet_now as they don't keep the buffer after the call 8357f02f414SMatthias Ringwald static int hci_transport_synchronous(void){ 8366b4af23dS[email protected] return hci_stack->hci_transport->can_send_packet_now == NULL; 8376b4af23dS[email protected] } 8386b4af23dS[email protected] 8398ad9cf99SMatthias Ringwald // used for debugging 8408ad9cf99SMatthias Ringwald #ifdef ENABLE_CONTROLLER_DUMP_PACKETS 8418ad9cf99SMatthias Ringwald static void hci_controller_dump_packets(void){ 8428ad9cf99SMatthias Ringwald // format: "{handle:04x}:{count:02d} " 8438ad9cf99SMatthias Ringwald char summaries[3][7 * 8 + 1]; 8448ad9cf99SMatthias Ringwald uint16_t totals[3]; 8458ad9cf99SMatthias Ringwald uint8_t index; 8468ad9cf99SMatthias Ringwald for (index = 0 ; index < 3 ; index++){ 8478ad9cf99SMatthias Ringwald summaries[index][0] = 0; 8488ad9cf99SMatthias Ringwald totals[index] = 0; 8498ad9cf99SMatthias Ringwald } 8508ad9cf99SMatthias Ringwald btstack_linked_item_t *it; 8518ad9cf99SMatthias Ringwald for (it = (btstack_linked_item_t *) hci_stack->connections; it != NULL; it = it->next){ 8528ad9cf99SMatthias Ringwald hci_connection_t * connection = (hci_connection_t *) it; 8538ad9cf99SMatthias Ringwald switch (connection->address_type){ 8548ad9cf99SMatthias Ringwald case BD_ADDR_TYPE_ACL: 8558ad9cf99SMatthias Ringwald index = 0; 8568ad9cf99SMatthias Ringwald break; 8578ad9cf99SMatthias Ringwald case BD_ADDR_TYPE_SCO: 8588ad9cf99SMatthias Ringwald index = 2; 8598ad9cf99SMatthias Ringwald break; 8608ad9cf99SMatthias Ringwald default: 8618ad9cf99SMatthias Ringwald index = 1; 862ce7ca7c8SMatthias Ringwald break; 8638ad9cf99SMatthias Ringwald } 8648ad9cf99SMatthias Ringwald totals[index] += connection->num_packets_sent; 8658ad9cf99SMatthias Ringwald char item_text[10]; 8668ad9cf99SMatthias Ringwald sprintf(item_text, "%04x:%02d ", connection->con_handle,connection->num_packets_sent); 8678ad9cf99SMatthias Ringwald btstack_strcat(summaries[index], sizeof(summaries[0]), item_text); 8688ad9cf99SMatthias Ringwald } 8698ad9cf99SMatthias Ringwald for (index = 0 ; index < 3 ; index++){ 8708ad9cf99SMatthias Ringwald if (summaries[index][0] == 0){ 8718ad9cf99SMatthias Ringwald summaries[index][0] = '-'; 8728ad9cf99SMatthias Ringwald summaries[index][1] = 0; 8738ad9cf99SMatthias Ringwald } 8748ad9cf99SMatthias Ringwald } 8758ad9cf99SMatthias 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]); 8768ad9cf99SMatthias Ringwald } 8778ad9cf99SMatthias Ringwald #endif 8788ad9cf99SMatthias Ringwald 8793e2050f7SMatthias Ringwald static uint8_t hci_send_acl_packet_fragments(hci_connection_t *connection){ 880452cf3bbS[email protected] 881452cf3bbS[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); 882452cf3bbS[email protected] 883452cf3bbS[email protected] // max ACL data packet length depends on connection type (LE vs. Classic) and available buffers 884452cf3bbS[email protected] uint16_t max_acl_data_packet_length = hci_stack->acl_data_packet_length; 8854ea43905SMatthias Ringwald if (hci_is_le_connection(connection) && (hci_stack->le_data_packets_length > 0u)){ 886452cf3bbS[email protected] max_acl_data_packet_length = hci_stack->le_data_packets_length; 887452cf3bbS[email protected] } 888452cf3bbS[email protected] 8890f3b27c5SMatthias Ringwald #ifdef ENABLE_LE_LIMIT_ACL_FRAGMENT_BY_MAX_OCTETS 890fcf88f47SMatthias Ringwald if (hci_is_le_connection(connection) && (connection->le_max_tx_octets < max_acl_data_packet_length)){ 8910f3b27c5SMatthias Ringwald max_acl_data_packet_length = connection->le_max_tx_octets; 8920f3b27c5SMatthias Ringwald } 8930f3b27c5SMatthias Ringwald #endif 894452cf3bbS[email protected] 895d999b54eSMatthias Ringwald log_debug("hci_send_acl_packet_fragments entered"); 896d999b54eSMatthias Ringwald 8973e2050f7SMatthias Ringwald uint8_t status = ERROR_CODE_SUCCESS; 898a086dc35SMatthias Ringwald // multiple packets could be sent on a synchronous HCI transport 899ff3cc4a5SMatthias Ringwald while (true){ 900452cf3bbS[email protected] 901d999b54eSMatthias Ringwald log_debug("hci_send_acl_packet_fragments loop entered"); 902d999b54eSMatthias Ringwald 903452cf3bbS[email protected] // get current data 9044ea43905SMatthias Ringwald const uint16_t acl_header_pos = hci_stack->acl_fragmentation_pos - 4u; 905452cf3bbS[email protected] int current_acl_data_packet_length = hci_stack->acl_fragmentation_total_size - hci_stack->acl_fragmentation_pos; 9061979f09cSMatthias Ringwald bool more_fragments = false; 907452cf3bbS[email protected] 908452cf3bbS[email protected] // if ACL packet is larger than Bluetooth packet buffer, only send max_acl_data_packet_length 909452cf3bbS[email protected] if (current_acl_data_packet_length > max_acl_data_packet_length){ 9101979f09cSMatthias Ringwald more_fragments = true; 9116bcf18c2SMatthias Ringwald current_acl_data_packet_length = max_acl_data_packet_length & (~(HCI_ACL_CHUNK_SIZE_ALIGNMENT-1)); 912452cf3bbS[email protected] } 913452cf3bbS[email protected] 914a086dc35SMatthias Ringwald // copy handle_and_flags if not first fragment and update packet boundary flags to be 01 (continuing fragment) 9154ea43905SMatthias Ringwald if (acl_header_pos > 0u){ 916f8fbdce0SMatthias Ringwald uint16_t handle_and_flags = little_endian_read_16(hci_stack->hci_packet_buffer, 0); 9174ea43905SMatthias Ringwald handle_and_flags = (handle_and_flags & 0xcfffu) | (1u << 12u); 918f8fbdce0SMatthias Ringwald little_endian_store_16(hci_stack->hci_packet_buffer, acl_header_pos, handle_and_flags); 919452cf3bbS[email protected] } 920452cf3bbS[email protected] 921452cf3bbS[email protected] // update header len 9224ea43905SMatthias Ringwald little_endian_store_16(hci_stack->hci_packet_buffer, acl_header_pos + 2u, current_acl_data_packet_length); 923452cf3bbS[email protected] 924452cf3bbS[email protected] // count packet 925ce41473eSMatthias Ringwald connection->num_packets_sent++; 9261979f09cSMatthias Ringwald log_debug("hci_send_acl_packet_fragments loop before send (more fragments %d)", (int) more_fragments); 927d999b54eSMatthias Ringwald 928d999b54eSMatthias Ringwald // update state for next fragment (if any) as "transport done" might be sent during send_packet already 929d999b54eSMatthias Ringwald if (more_fragments){ 930d999b54eSMatthias Ringwald // update start of next fragment to send 931d999b54eSMatthias Ringwald hci_stack->acl_fragmentation_pos += current_acl_data_packet_length; 932d999b54eSMatthias Ringwald } else { 933d999b54eSMatthias Ringwald // done 934d999b54eSMatthias Ringwald hci_stack->acl_fragmentation_pos = 0; 935d999b54eSMatthias Ringwald hci_stack->acl_fragmentation_total_size = 0; 936d999b54eSMatthias Ringwald } 937452cf3bbS[email protected] 938452cf3bbS[email protected] // send packet 939452cf3bbS[email protected] uint8_t * packet = &hci_stack->hci_packet_buffer[acl_header_pos]; 940452cf3bbS[email protected] const int size = current_acl_data_packet_length + 4; 9415bb5bc3eS[email protected] hci_dump_packet(HCI_ACL_DATA_PACKET, 0, packet, size); 94281d2bdb2SMatthias Ringwald hci_stack->acl_fragmentation_tx_active = 1; 9433e2050f7SMatthias Ringwald int err = hci_stack->hci_transport->send_packet(HCI_ACL_DATA_PACKET, packet, size); 9443e2050f7SMatthias Ringwald if (err != 0){ 9453e2050f7SMatthias Ringwald // no error from HCI Transport expected 9463e2050f7SMatthias Ringwald status = ERROR_CODE_HARDWARE_FAILURE; 947a84946b2SMatthias Ringwald break; 9483e2050f7SMatthias Ringwald } 949452cf3bbS[email protected] 9508ad9cf99SMatthias Ringwald #ifdef ENABLE_CONTROLLER_DUMP_PACKETS 9518ad9cf99SMatthias Ringwald hci_controller_dump_packets(); 9528ad9cf99SMatthias Ringwald #endif 9538ad9cf99SMatthias Ringwald 9541979f09cSMatthias Ringwald log_debug("hci_send_acl_packet_fragments loop after send (more fragments %d)", (int) more_fragments); 955d999b54eSMatthias Ringwald 956452cf3bbS[email protected] // done yet? 957452cf3bbS[email protected] if (!more_fragments) break; 958452cf3bbS[email protected] 959452cf3bbS[email protected] // can send more? 9603e2050f7SMatthias Ringwald if (!hci_can_send_prepared_acl_packet_now(connection->con_handle)) return status; 961452cf3bbS[email protected] } 962452cf3bbS[email protected] 963d999b54eSMatthias Ringwald log_debug("hci_send_acl_packet_fragments loop over"); 964452cf3bbS[email protected] 965d051460cS[email protected] // release buffer now for synchronous transport 966203bace6S[email protected] if (hci_transport_synchronous()){ 96781d2bdb2SMatthias Ringwald hci_stack->acl_fragmentation_tx_active = 0; 968452cf3bbS[email protected] hci_release_packet_buffer(); 969452cf3bbS[email protected] } 970452cf3bbS[email protected] 9713e2050f7SMatthias Ringwald return status; 972452cf3bbS[email protected] } 973452cf3bbS[email protected] 974826f7347S[email protected] // pre: caller has reserved the packet buffer 9753e2050f7SMatthias Ringwald uint8_t hci_send_acl_packet_buffer(int size){ 9763e2050f7SMatthias Ringwald btstack_assert(hci_stack->hci_packet_buffer_reserved); 977826f7347S[email protected] 978d713a683S[email protected] uint8_t * packet = hci_stack->hci_packet_buffer; 979d713a683S[email protected] hci_con_handle_t con_handle = READ_ACL_CONNECTION_HANDLE(packet); 980d713a683S[email protected] 9815061f3afS[email protected] hci_connection_t *connection = hci_connection_for_handle( con_handle); 98297b61c7bS[email protected] if (!connection) { 9835fa0b7cfS[email protected] log_error("hci_send_acl_packet_buffer called but no connection for handle 0x%04x", con_handle); 98497b61c7bS[email protected] hci_release_packet_buffer(); 9853e2050f7SMatthias Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 98697b61c7bS[email protected] } 98752db98b2SMatthias Ringwald 98879a2851bSMilanka Ringwald // check for free places on Bluetooth module 98979a2851bSMilanka Ringwald if (!hci_can_send_prepared_acl_packet_now(con_handle)) { 99079a2851bSMilanka Ringwald log_error("hci_send_acl_packet_buffer called but no free ACL buffers on controller"); 99179a2851bSMilanka Ringwald hci_release_packet_buffer(); 99279a2851bSMilanka Ringwald return BTSTACK_ACL_BUFFERS_FULL; 99379a2851bSMilanka Ringwald } 99479a2851bSMilanka Ringwald 99552db98b2SMatthias Ringwald #ifdef ENABLE_CLASSIC 99656cf178bSmatthias.ringwald hci_connection_timestamp(connection); 99752db98b2SMatthias Ringwald #endif 99856cf178bSmatthias.ringwald 999452cf3bbS[email protected] // hci_dump_packet( HCI_ACL_DATA_PACKET, 0, packet, size); 10007856c818Smatthias.ringwald 1001452cf3bbS[email protected] // setup data 1002452cf3bbS[email protected] hci_stack->acl_fragmentation_total_size = size; 1003452cf3bbS[email protected] hci_stack->acl_fragmentation_pos = 4; // start of L2CAP packet 10046218e6f1Smatthias.ringwald 1005452cf3bbS[email protected] return hci_send_acl_packet_fragments(connection); 1006ee091cf1Smatthias.ringwald } 1007ee091cf1Smatthias.ringwald 100835454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 100944d0e3d5S[email protected] // pre: caller has reserved the packet buffer 10103e2050f7SMatthias Ringwald uint8_t hci_send_sco_packet_buffer(int size){ 10113e2050f7SMatthias Ringwald btstack_assert(hci_stack->hci_packet_buffer_reserved); 101244d0e3d5S[email protected] 101344d0e3d5S[email protected] uint8_t * packet = hci_stack->hci_packet_buffer; 10144b3e1e19SMatthias Ringwald 10154b3e1e19SMatthias Ringwald // skip checks in loopback mode 10164b3e1e19SMatthias Ringwald if (!hci_stack->loopback_mode){ 101744d0e3d5S[email protected] hci_con_handle_t con_handle = READ_ACL_CONNECTION_HANDLE(packet); // same for ACL and SCO 101844d0e3d5S[email protected] 101944d0e3d5S[email protected] // check for free places on Bluetooth module 1020701e3307SMatthias Ringwald if (!hci_can_send_prepared_sco_packet_now()) { 1021cbf638a9SMatthias Ringwald log_error("hci_send_sco_packet_buffer called but no free SCO buffers on controller"); 102244d0e3d5S[email protected] hci_release_packet_buffer(); 102344d0e3d5S[email protected] return BTSTACK_ACL_BUFFERS_FULL; 102444d0e3d5S[email protected] } 102544d0e3d5S[email protected] 1026e35edcc1S[email protected] // track send packet in connection struct 1027e35edcc1S[email protected] hci_connection_t *connection = hci_connection_for_handle( con_handle); 1028e35edcc1S[email protected] if (!connection) { 1029e35edcc1S[email protected] log_error("hci_send_sco_packet_buffer called but no connection for handle 0x%04x", con_handle); 1030e35edcc1S[email protected] hci_release_packet_buffer(); 10313e2050f7SMatthias Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 1032e35edcc1S[email protected] } 1033f234b250SMatthias Ringwald 1034f234b250SMatthias Ringwald if (hci_have_usb_transport()){ 1035f234b250SMatthias Ringwald // token used 10361972f31fSMatthias Ringwald hci_stack->sco_can_send_now = false; 1037f234b250SMatthias Ringwald } else { 1038760b20efSMatthias Ringwald if (hci_stack->synchronous_flow_control_enabled){ 1039ce41473eSMatthias Ringwald connection->num_packets_sent++; 10406f28d2eeSMatthias Ringwald } else { 1041e4157653SMatthias Ringwald connection->sco_tx_ready--; 1042760b20efSMatthias Ringwald } 10434b3e1e19SMatthias Ringwald } 1044f234b250SMatthias Ringwald } 104544d0e3d5S[email protected] 104644d0e3d5S[email protected] hci_dump_packet( HCI_SCO_DATA_PACKET, 0, packet, size); 1047543e835cSMatthias Ringwald 104843149fc9SMatthias Ringwald #ifdef HAVE_SCO_TRANSPORT 104943149fc9SMatthias Ringwald hci_stack->sco_transport->send_packet(packet, size); 105043149fc9SMatthias Ringwald hci_release_packet_buffer(); 105143149fc9SMatthias Ringwald hci_emit_transport_packet_sent(); 105243149fc9SMatthias Ringwald 105343149fc9SMatthias Ringwald return 0; 105443149fc9SMatthias Ringwald #else 105543149fc9SMatthias Ringwald int err = hci_stack->hci_transport->send_packet(HCI_SCO_DATA_PACKET, packet, size); 1056a84946b2SMatthias Ringwald uint8_t status; 1057a84946b2SMatthias Ringwald if (err == 0){ 1058a84946b2SMatthias Ringwald status = ERROR_CODE_SUCCESS; 1059a84946b2SMatthias Ringwald } else { 1060a84946b2SMatthias Ringwald status = ERROR_CODE_HARDWARE_FAILURE; 1061a84946b2SMatthias Ringwald } 1062a84946b2SMatthias Ringwald if ((status != ERROR_CODE_SUCCESS) || hci_transport_synchronous()){ 1063543e835cSMatthias Ringwald hci_release_packet_buffer(); 1064543e835cSMatthias Ringwald } 1065a84946b2SMatthias Ringwald return status; 106643149fc9SMatthias Ringwald #endif 106744d0e3d5S[email protected] } 106835454696SMatthias Ringwald #endif 106944d0e3d5S[email protected] 10700a8cccd5SMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS 107168ab6207SMatthias Ringwald static uint8_t hci_send_iso_packet_fragments(void){ 107268ab6207SMatthias Ringwald 107368ab6207SMatthias Ringwald uint16_t max_iso_data_packet_length = hci_stack->le_iso_packets_length; 107468ab6207SMatthias Ringwald uint8_t status = ERROR_CODE_SUCCESS; 107568ab6207SMatthias Ringwald // multiple packets could be send on a synchronous HCI transport 107668ab6207SMatthias Ringwald while (true){ 107768ab6207SMatthias Ringwald 107868ab6207SMatthias Ringwald // get current data 107968ab6207SMatthias Ringwald const uint16_t iso_header_pos = hci_stack->iso_fragmentation_pos - 4u; 108068ab6207SMatthias Ringwald int current_iso_data_packet_length = hci_stack->iso_fragmentation_total_size - hci_stack->iso_fragmentation_pos; 108168ab6207SMatthias Ringwald bool more_fragments = false; 108268ab6207SMatthias Ringwald 108368ab6207SMatthias Ringwald // if ISO packet is larger than Bluetooth packet buffer, only send max_acl_data_packet_length 108468ab6207SMatthias Ringwald if (current_iso_data_packet_length > max_iso_data_packet_length){ 108568ab6207SMatthias Ringwald more_fragments = true; 108668ab6207SMatthias Ringwald current_iso_data_packet_length = max_iso_data_packet_length; 108768ab6207SMatthias Ringwald } 108868ab6207SMatthias Ringwald 108968ab6207SMatthias Ringwald // copy handle_and_flags if not first fragment and update packet boundary flags to be 01 (continuing fragmnent) 109068ab6207SMatthias Ringwald uint16_t handle_and_flags = little_endian_read_16(hci_stack->hci_packet_buffer, 0); 109168ab6207SMatthias Ringwald uint8_t pb_flags; 109268ab6207SMatthias Ringwald if (iso_header_pos == 0u){ 109368ab6207SMatthias Ringwald // first fragment, keep TS field 109468ab6207SMatthias Ringwald pb_flags = more_fragments ? 0x00 : 0x02; 109568ab6207SMatthias Ringwald handle_and_flags = (handle_and_flags & 0x4fffu) | (pb_flags << 12u); 109668ab6207SMatthias Ringwald } else { 109768ab6207SMatthias Ringwald // later fragment, drop TS field 109868ab6207SMatthias Ringwald pb_flags = more_fragments ? 0x01 : 0x03; 109968ab6207SMatthias Ringwald handle_and_flags = (handle_and_flags & 0x0fffu) | (pb_flags << 12u); 110068ab6207SMatthias Ringwald } 110168ab6207SMatthias Ringwald little_endian_store_16(hci_stack->hci_packet_buffer, iso_header_pos, handle_and_flags); 110268ab6207SMatthias Ringwald 110368ab6207SMatthias Ringwald // update header len 110468ab6207SMatthias Ringwald little_endian_store_16(hci_stack->hci_packet_buffer, iso_header_pos + 2u, current_iso_data_packet_length); 110568ab6207SMatthias Ringwald 110668ab6207SMatthias Ringwald // update state for next fragment (if any) as "transport done" might be sent during send_packet already 110768ab6207SMatthias Ringwald if (more_fragments){ 110868ab6207SMatthias Ringwald // update start of next fragment to send 110968ab6207SMatthias Ringwald hci_stack->iso_fragmentation_pos += current_iso_data_packet_length; 111068ab6207SMatthias Ringwald } else { 111168ab6207SMatthias Ringwald // done 111268ab6207SMatthias Ringwald hci_stack->iso_fragmentation_pos = 0; 111368ab6207SMatthias Ringwald hci_stack->iso_fragmentation_total_size = 0; 111468ab6207SMatthias Ringwald } 111568ab6207SMatthias Ringwald 111668ab6207SMatthias Ringwald // send packet 111768ab6207SMatthias Ringwald uint8_t * packet = &hci_stack->hci_packet_buffer[iso_header_pos]; 111868ab6207SMatthias Ringwald const int size = current_iso_data_packet_length + 4; 111968ab6207SMatthias Ringwald hci_dump_packet(HCI_ISO_DATA_PACKET, 0, packet, size); 112068ab6207SMatthias Ringwald hci_stack->iso_fragmentation_tx_active = true; 112168ab6207SMatthias Ringwald int err = hci_stack->hci_transport->send_packet(HCI_ISO_DATA_PACKET, packet, size); 112268ab6207SMatthias Ringwald if (err != 0){ 112368ab6207SMatthias Ringwald // no error from HCI Transport expected 112468ab6207SMatthias Ringwald status = ERROR_CODE_HARDWARE_FAILURE; 112568ab6207SMatthias Ringwald } 112668ab6207SMatthias Ringwald 112768ab6207SMatthias Ringwald // done yet? 112868ab6207SMatthias Ringwald if (!more_fragments) break; 112968ab6207SMatthias Ringwald 113068ab6207SMatthias Ringwald // can send more? 113168ab6207SMatthias Ringwald if (!hci_transport_can_send_prepared_packet_now(HCI_ISO_DATA_PACKET)) return false; 113268ab6207SMatthias Ringwald } 113368ab6207SMatthias Ringwald 113468ab6207SMatthias Ringwald // release buffer now for synchronous transport 113568ab6207SMatthias Ringwald if (hci_transport_synchronous()){ 113668ab6207SMatthias Ringwald hci_stack->iso_fragmentation_tx_active = false; 113768ab6207SMatthias Ringwald hci_release_packet_buffer(); 113868ab6207SMatthias Ringwald hci_emit_transport_packet_sent(); 113968ab6207SMatthias Ringwald } 114068ab6207SMatthias Ringwald 114168ab6207SMatthias Ringwald return status; 114268ab6207SMatthias Ringwald } 114368ab6207SMatthias Ringwald 1144ace08712SMatthias Ringwald uint8_t hci_send_iso_packet_buffer(uint16_t size){ 1145ace08712SMatthias Ringwald btstack_assert(hci_stack->hci_packet_buffer_reserved); 1146ace08712SMatthias Ringwald 1147e5413aa0SMatthias Ringwald hci_con_handle_t con_handle = (hci_con_handle_t) little_endian_read_16(hci_stack->hci_packet_buffer, 0) & 0xfff; 1148e5413aa0SMatthias Ringwald hci_iso_stream_t * iso_stream = hci_iso_stream_for_con_handle(con_handle); 1149e5413aa0SMatthias Ringwald if (iso_stream == NULL){ 1150977f918dSMatthias Ringwald hci_release_packet_buffer(); 1151977f918dSMatthias Ringwald hci_iso_notify_can_send_now(); 1152e5413aa0SMatthias Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 1153e5413aa0SMatthias Ringwald } 1154e5413aa0SMatthias Ringwald 1155e5413aa0SMatthias Ringwald // TODO: check for space on controller 1156e5413aa0SMatthias Ringwald 1157977f918dSMatthias Ringwald // skip iso packets if needed 1158977f918dSMatthias Ringwald if (iso_stream->num_packets_to_skip > 0){ 1159977f918dSMatthias Ringwald iso_stream->num_packets_to_skip--; 1160977f918dSMatthias Ringwald // pretend it was processed and trigger next one 1161977f918dSMatthias Ringwald hci_release_packet_buffer(); 1162977f918dSMatthias Ringwald hci_iso_notify_can_send_now(); 1163977f918dSMatthias Ringwald return ERROR_CODE_SUCCESS; 1164977f918dSMatthias Ringwald } 1165977f918dSMatthias Ringwald 1166e5413aa0SMatthias Ringwald // track outgoing packet sent 1167e5413aa0SMatthias Ringwald log_info("Outgoing ISO packet for con handle 0x%04x", con_handle); 1168e5413aa0SMatthias Ringwald iso_stream->num_packets_sent++; 1169e5413aa0SMatthias Ringwald 117068ab6207SMatthias Ringwald // setup data 117168ab6207SMatthias Ringwald hci_stack->iso_fragmentation_total_size = size; 117268ab6207SMatthias Ringwald hci_stack->iso_fragmentation_pos = 4; // start of L2CAP packet 117368ab6207SMatthias Ringwald 117468ab6207SMatthias Ringwald return hci_send_iso_packet_fragments(); 1175ace08712SMatthias Ringwald } 1176ace08712SMatthias Ringwald #endif 1177ace08712SMatthias Ringwald 1178c3b46f5aSMatthias Ringwald static void acl_handler(uint8_t *packet, uint16_t size){ 1179e76a89eeS[email protected] 11807856c818Smatthias.ringwald // get info 11817856c818Smatthias.ringwald hci_con_handle_t con_handle = READ_ACL_CONNECTION_HANDLE(packet); 11825061f3afS[email protected] hci_connection_t *conn = hci_connection_for_handle(con_handle); 11837856c818Smatthias.ringwald uint8_t acl_flags = READ_ACL_FLAGS(packet); 11847856c818Smatthias.ringwald uint16_t acl_length = READ_ACL_LENGTH(packet); 11857856c818Smatthias.ringwald 11867856c818Smatthias.ringwald // ignore non-registered handle 11877856c818Smatthias.ringwald if (!conn){ 1188c3b46f5aSMatthias Ringwald log_error("acl_handler called with non-registered handle %u!" , con_handle); 11897856c818Smatthias.ringwald return; 11907856c818Smatthias.ringwald } 11917856c818Smatthias.ringwald 1192e76a89eeS[email protected] // assert packet is complete 11934ea43905SMatthias Ringwald if ((acl_length + 4u) != size){ 1194c3b46f5aSMatthias Ringwald log_error("acl_handler called with ACL packet of wrong size %d, expected %u => dropping packet", size, acl_length + 4); 1195e76a89eeS[email protected] return; 1196e76a89eeS[email protected] } 1197e76a89eeS[email protected] 119852db98b2SMatthias Ringwald #ifdef ENABLE_CLASSIC 11997856c818Smatthias.ringwald // update idle timestamp 12007856c818Smatthias.ringwald hci_connection_timestamp(conn); 120152db98b2SMatthias Ringwald #endif 12027856c818Smatthias.ringwald 12032b838201SMatthias Ringwald #ifdef ENABLE_HCI_CONTROLLER_TO_HOST_FLOW_CONTROL 12042b838201SMatthias Ringwald hci_stack->host_completed_packets = 1; 12052b838201SMatthias Ringwald conn->num_packets_completed++; 12062b838201SMatthias Ringwald #endif 12072b838201SMatthias Ringwald 12087856c818Smatthias.ringwald // handle different packet types 12094ea43905SMatthias Ringwald switch (acl_flags & 0x03u) { 12107856c818Smatthias.ringwald 12117856c818Smatthias.ringwald case 0x01: // continuation fragment 12127856c818Smatthias.ringwald 12130ca847afS[email protected] // sanity checks 12144ea43905SMatthias Ringwald if (conn->acl_recombination_pos == 0u) { 12159da54300S[email protected] log_error( "ACL Cont Fragment but no first fragment for handle 0x%02x", con_handle); 12167856c818Smatthias.ringwald return; 12177856c818Smatthias.ringwald } 12184ea43905SMatthias Ringwald if ((conn->acl_recombination_pos + acl_length) > (4u + HCI_ACL_BUFFER_SIZE)){ 12190ca847afS[email protected] log_error( "ACL Cont Fragment to large: combined packet %u > buffer size %u for handle 0x%02x", 12200ca847afS[email protected] conn->acl_recombination_pos + acl_length, 4 + HCI_ACL_BUFFER_SIZE, con_handle); 12210ca847afS[email protected] conn->acl_recombination_pos = 0; 12220ca847afS[email protected] return; 12230ca847afS[email protected] } 12247856c818Smatthias.ringwald 12257856c818Smatthias.ringwald // append fragment payload (header already stored) 12266535961aSMatthias Ringwald (void)memcpy(&conn->acl_recombination_buffer[HCI_INCOMING_PRE_BUFFER_SIZE + conn->acl_recombination_pos], 12276535961aSMatthias Ringwald &packet[4], acl_length); 12287856c818Smatthias.ringwald conn->acl_recombination_pos += acl_length; 12297856c818Smatthias.ringwald 12307856c818Smatthias.ringwald // forward complete L2CAP packet if complete. 12314ea43905SMatthias Ringwald if (conn->acl_recombination_pos >= (conn->acl_recombination_length + 4u + 4u)){ // pos already incl. ACL header 1232d6b06661SMatthias Ringwald hci_emit_acl_packet(&conn->acl_recombination_buffer[HCI_INCOMING_PRE_BUFFER_SIZE], conn->acl_recombination_pos); 12337856c818Smatthias.ringwald // reset recombination buffer 12347856c818Smatthias.ringwald conn->acl_recombination_length = 0; 12357856c818Smatthias.ringwald conn->acl_recombination_pos = 0; 12367856c818Smatthias.ringwald } 12377856c818Smatthias.ringwald break; 12387856c818Smatthias.ringwald 12397856c818Smatthias.ringwald case 0x02: { // first fragment 12407856c818Smatthias.ringwald 124123a77e1aS[email protected] // sanity check 124223a77e1aS[email protected] if (conn->acl_recombination_pos) { 124360737d2bSMatthias Ringwald // we just received the first fragment, but still have data. Only warn if the packet wasn't a flushable packet 124460737d2bSMatthias Ringwald if ((conn->acl_recombination_buffer[HCI_INCOMING_PRE_BUFFER_SIZE+1] >> 4) != 0x02){ 124560737d2bSMatthias Ringwald log_error( "ACL First Fragment but %u bytes in buffer for handle 0x%02x, dropping stale fragments", conn->acl_recombination_pos, con_handle); 124660737d2bSMatthias Ringwald } 124723a77e1aS[email protected] conn->acl_recombination_pos = 0; 124823a77e1aS[email protected] } 124923a77e1aS[email protected] 12507856c818Smatthias.ringwald // peek into L2CAP packet! 12517856c818Smatthias.ringwald uint16_t l2cap_length = READ_L2CAP_LENGTH( packet ); 12527856c818Smatthias.ringwald 12537856c818Smatthias.ringwald // compare fragment size to L2CAP packet size 12544ea43905SMatthias Ringwald if (acl_length >= (l2cap_length + 4u)){ 12557856c818Smatthias.ringwald // forward fragment as L2CAP packet 1256*9244e83cSMatthias Ringwald hci_emit_acl_packet(packet, l2cap_length + 8u); 12577856c818Smatthias.ringwald } else { 12580ca847afS[email protected] 12590ca847afS[email protected] if (acl_length > HCI_ACL_BUFFER_SIZE){ 12600ca847afS[email protected] log_error( "ACL First Fragment to large: fragment %u > buffer size %u for handle 0x%02x", 12610ca847afS[email protected] 4 + acl_length, 4 + HCI_ACL_BUFFER_SIZE, con_handle); 12620ca847afS[email protected] return; 12630ca847afS[email protected] } 12640ca847afS[email protected] 12657856c818Smatthias.ringwald // store first fragment and tweak acl length for complete package 12666535961aSMatthias Ringwald (void)memcpy(&conn->acl_recombination_buffer[HCI_INCOMING_PRE_BUFFER_SIZE], 12674ea43905SMatthias Ringwald packet, acl_length + 4u); 12684ea43905SMatthias Ringwald conn->acl_recombination_pos = acl_length + 4u; 12697856c818Smatthias.ringwald conn->acl_recombination_length = l2cap_length; 12704ea43905SMatthias Ringwald little_endian_store_16(conn->acl_recombination_buffer, HCI_INCOMING_PRE_BUFFER_SIZE + 2u, l2cap_length +4u); 12717856c818Smatthias.ringwald } 12727856c818Smatthias.ringwald break; 12737856c818Smatthias.ringwald 12747856c818Smatthias.ringwald } 12757856c818Smatthias.ringwald default: 1276c3b46f5aSMatthias Ringwald log_error( "acl_handler called with invalid packet boundary flags %u", acl_flags & 0x03); 12777856c818Smatthias.ringwald return; 12787856c818Smatthias.ringwald } 127994ab26f8Smatthias.ringwald 128094ab26f8Smatthias.ringwald // execute main loop 128194ab26f8Smatthias.ringwald hci_run(); 128216833f0aSmatthias.ringwald } 128322909952Smatthias.ringwald 12841ab2dc58SMatthias Ringwald static void hci_connection_stop_timer(hci_connection_t * conn){ 12851ab2dc58SMatthias Ringwald btstack_run_loop_remove_timer(&conn->timeout); 12861ab2dc58SMatthias Ringwald #ifdef ENABLE_CLASSIC 12871ab2dc58SMatthias Ringwald btstack_run_loop_remove_timer(&conn->timeout_sco); 12881ab2dc58SMatthias Ringwald #endif 12891ab2dc58SMatthias Ringwald } 12901ab2dc58SMatthias Ringwald 129167a3e8ecSmatthias.ringwald static void hci_shutdown_connection(hci_connection_t *conn){ 12929da54300S[email protected] log_info("Connection closed: handle 0x%x, %s", conn->con_handle, bd_addr_to_str(conn->address)); 12933c4d4b90Smatthias.ringwald 1294b3264428SMatthias Ringwald #ifdef ENABLE_CLASSIC 1295cb70c5abSMatthias Ringwald #if defined(ENABLE_SCO_OVER_HCI) || defined(HAVE_SCO_TRANSPORT) 1296cb70c5abSMatthias Ringwald bd_addr_type_t addr_type = conn->address_type; 1297cb70c5abSMatthias Ringwald #endif 1298cb70c5abSMatthias Ringwald #ifdef HAVE_SCO_TRANSPORT 1299cb70c5abSMatthias Ringwald hci_con_handle_t con_handle = conn->con_handle; 1300ee752bb8SMatthias Ringwald #endif 1301b3264428SMatthias Ringwald #endif 1302ee752bb8SMatthias Ringwald 13031ab2dc58SMatthias Ringwald hci_connection_stop_timer(conn); 1304c785ef68Smatthias.ringwald 1305665d90f2SMatthias Ringwald btstack_linked_list_remove(&hci_stack->connections, (btstack_linked_item_t *) conn); 1306a3b02b71Smatthias.ringwald btstack_memory_hci_connection_free( conn ); 13073c4d4b90Smatthias.ringwald 13083c4d4b90Smatthias.ringwald // now it's gone 1309c7e0c5f6Smatthias.ringwald hci_emit_nr_connections_changed(); 1310ee752bb8SMatthias Ringwald 1311b3264428SMatthias Ringwald #ifdef ENABLE_CLASSIC 1312034e9b53SMatthias Ringwald #ifdef ENABLE_SCO_OVER_HCI 1313ee752bb8SMatthias Ringwald // update SCO 1314cb70c5abSMatthias Ringwald if ((addr_type == BD_ADDR_TYPE_SCO) && (hci_stack->hci_transport != NULL) && (hci_stack->hci_transport->set_sco_config != NULL)){ 1315ee752bb8SMatthias Ringwald hci_stack->hci_transport->set_sco_config(hci_stack->sco_voice_setting_active, hci_number_sco_connections()); 1316ee752bb8SMatthias Ringwald } 1317034e9b53SMatthias Ringwald #endif 1318cb70c5abSMatthias Ringwald #ifdef HAVE_SCO_TRANSPORT 1319cb70c5abSMatthias Ringwald if ((addr_type == BD_ADDR_TYPE_SCO) && (hci_stack->sco_transport != NULL)){ 1320cb70c5abSMatthias Ringwald hci_stack->sco_transport->close(con_handle); 1321cb70c5abSMatthias Ringwald } 1322cb70c5abSMatthias Ringwald #endif 1323b3264428SMatthias Ringwald #endif 1324c7e0c5f6Smatthias.ringwald } 1325c7e0c5f6Smatthias.ringwald 132635454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 132735454696SMatthias Ringwald 132829e39de4SMatthias Ringwald static const uint16_t hci_acl_packet_type_sizes[] = { 13298f8108aaSmatthias.ringwald 0, HCI_ACL_2DH1_SIZE, HCI_ACL_3DH1_SIZE, HCI_ACL_DM1_SIZE, 13308f8108aaSmatthias.ringwald HCI_ACL_DH1_SIZE, 0, 0, 0, 13318f8108aaSmatthias.ringwald HCI_ACL_2DH3_SIZE, HCI_ACL_3DH3_SIZE, HCI_ACL_DM3_SIZE, HCI_ACL_DH3_SIZE, 13328f8108aaSmatthias.ringwald HCI_ACL_2DH5_SIZE, HCI_ACL_3DH5_SIZE, HCI_ACL_DM5_SIZE, HCI_ACL_DH5_SIZE 13338f8108aaSmatthias.ringwald }; 133429e39de4SMatthias Ringwald static const uint8_t hci_acl_packet_type_feature_requirement_bit[] = { 133565389bfcS[email protected] 0, // 3 slot packets 133665389bfcS[email protected] 1, // 5 slot packets 133765389bfcS[email protected] 25, // EDR 2 mpbs 133865389bfcS[email protected] 26, // EDR 3 mbps 1339a086dc35SMatthias Ringwald 39, // 3 slot EDR packtes 134065389bfcS[email protected] 40, // 5 slot EDR packet 134165389bfcS[email protected] }; 134229e39de4SMatthias Ringwald static const uint16_t hci_acl_packet_type_feature_packet_mask[] = { 134365389bfcS[email protected] 0x0f00, // 3 slot packets 134465389bfcS[email protected] 0xf000, // 5 slot packets 134565389bfcS[email protected] 0x1102, // EDR 2 mpbs 134665389bfcS[email protected] 0x2204, // EDR 3 mbps 1347a086dc35SMatthias Ringwald 0x0300, // 3 slot EDR packtes 134865389bfcS[email protected] 0x3000, // 5 slot EDR packet 134965389bfcS[email protected] }; 13508f8108aaSmatthias.ringwald 135165389bfcS[email protected] static uint16_t hci_acl_packet_types_for_buffer_size_and_local_features(uint16_t buffer_size, uint8_t * local_supported_features){ 135265389bfcS[email protected] // enable packet types based on size 13538f8108aaSmatthias.ringwald uint16_t packet_types = 0; 1354f16a69bbS[email protected] unsigned int i; 13558f8108aaSmatthias.ringwald for (i=0;i<16;i++){ 135629e39de4SMatthias Ringwald if (hci_acl_packet_type_sizes[i] == 0) continue; 135729e39de4SMatthias Ringwald if (hci_acl_packet_type_sizes[i] <= buffer_size){ 13588f8108aaSmatthias.ringwald packet_types |= 1 << i; 13598f8108aaSmatthias.ringwald } 13608f8108aaSmatthias.ringwald } 136165389bfcS[email protected] // disable packet types due to missing local supported features 136229e39de4SMatthias Ringwald for (i=0;i<sizeof(hci_acl_packet_type_feature_requirement_bit); i++){ 136329e39de4SMatthias Ringwald unsigned int bit_idx = hci_acl_packet_type_feature_requirement_bit[i]; 136465389bfcS[email protected] int feature_set = (local_supported_features[bit_idx >> 3] & (1<<(bit_idx & 7))) != 0; 136565389bfcS[email protected] if (feature_set) continue; 136629e39de4SMatthias Ringwald log_info("Features bit %02u is not set, removing packet types 0x%04x", bit_idx, hci_acl_packet_type_feature_packet_mask[i]); 136729e39de4SMatthias Ringwald packet_types &= ~hci_acl_packet_type_feature_packet_mask[i]; 136865389bfcS[email protected] } 13698f8108aaSmatthias.ringwald return packet_types; 13708f8108aaSmatthias.ringwald } 13718f8108aaSmatthias.ringwald 13728f8108aaSmatthias.ringwald uint16_t hci_usable_acl_packet_types(void){ 1373028ead5eSMatthias Ringwald uint16_t active_packet_types = (hci_stack->usable_packet_types_acl & hci_stack->enabled_packet_types_acl); 137429e39de4SMatthias Ringwald // flip bits for "may not be used" 1375028ead5eSMatthias Ringwald return active_packet_types ^ 0x3306; 1376028ead5eSMatthias Ringwald } 1377028ead5eSMatthias Ringwald 1378028ead5eSMatthias Ringwald void hci_enable_acl_packet_types(uint16_t packet_types){ 1379028ead5eSMatthias Ringwald hci_stack->enabled_packet_types_acl = packet_types; 13808f8108aaSmatthias.ringwald } 138129e39de4SMatthias Ringwald 1382c92ca2c8SMatthias Ringwald static const struct { 1383c92ca2c8SMatthias Ringwald uint8_t feature_index; 1384c92ca2c8SMatthias Ringwald uint16_t feature_packet_mask; 1385c92ca2c8SMatthias Ringwald } hci_sco_packet_type_feature_requirements[] = { 1386c92ca2c8SMatthias Ringwald { 12, SCO_PACKET_TYPES_HV2 }, // HV2 packets 1387c92ca2c8SMatthias Ringwald { 13, SCO_PACKET_TYPES_HV3 }, // HV3 packets 1388c92ca2c8SMatthias Ringwald { 31, SCO_PACKET_TYPES_ESCO }, // eSCO links (EV3 packets) 1389c92ca2c8SMatthias Ringwald { 32, SCO_PACKET_TYPES_EV4 }, // EV4 packets 1390c92ca2c8SMatthias Ringwald { 45, SCO_PACKET_TYPES_2EV3 | SCO_PACKET_TYPES_2EV5 }, // EDR eSCO 2 Mb/s 1391c92ca2c8SMatthias Ringwald { 46, SCO_PACKET_TYPES_3EV3 | SCO_PACKET_TYPES_3EV5 }, // EDR eSCO 3 Mb/s 13926afff830SMatthias Ringwald { 47, SCO_PACKET_TYPES_2EV5 | SCO_PACKET_TYPES_3EV5 }, // 3-slot EDR eSCO packets, 2-EV3/3-EV3 use single slot 1393c92ca2c8SMatthias Ringwald }; 1394c92ca2c8SMatthias Ringwald 1395d7891039SMatthias Ringwald // map packet types to payload length, prefer eSCO over SCO and large over small packets 1396d7891039SMatthias Ringwald static const struct { 1397d7891039SMatthias Ringwald uint16_t type; 1398d7891039SMatthias Ringwald uint16_t payload_length; 1399d7891039SMatthias Ringwald } hci_sco_packet_type_to_payload_length[] = { 1400d7891039SMatthias Ringwald {SCO_PACKET_TYPES_3EV5, HCI_SCO_3EV5_SIZE}, // 540 1401d7891039SMatthias Ringwald {SCO_PACKET_TYPES_2EV5, HCI_SCO_2EV5_SIZE}, // 360 1402d7891039SMatthias Ringwald {SCO_PACKET_TYPES_EV5, HCI_SCO_EV5_SIZE}, // 180 1403d7891039SMatthias Ringwald {SCO_PACKET_TYPES_EV4, HCI_SCO_EV4_SIZE}, // 120 1404d7891039SMatthias Ringwald {SCO_PACKET_TYPES_3EV3, HCI_SCO_3EV3_SIZE}, // 90 1405d7891039SMatthias Ringwald {SCO_PACKET_TYPES_2EV3, HCI_SCO_2EV3_SIZE}, // 60 1406d7891039SMatthias Ringwald {SCO_PACKET_TYPES_EV3, HCI_SCO_EV3_SIZE}, // 30 1407d7891039SMatthias Ringwald {SCO_PACKET_TYPES_HV3, HCI_SCO_HV3_SIZE}, // 30 1408d7891039SMatthias Ringwald {SCO_PACKET_TYPES_HV2, HCI_SCO_HV2_SIZE}, // 20 1409d7891039SMatthias Ringwald {SCO_PACKET_TYPES_HV1, HCI_SCO_HV1_SIZE} // 10 1410d7891039SMatthias Ringwald }; 1411d7891039SMatthias Ringwald 1412c92ca2c8SMatthias Ringwald static uint16_t hci_sco_packet_types_for_features(const uint8_t * local_supported_features){ 1413c92ca2c8SMatthias Ringwald uint16_t packet_types = SCO_PACKET_TYPES_ALL; 1414c92ca2c8SMatthias Ringwald unsigned int i; 1415c92ca2c8SMatthias Ringwald // disable packet types due to missing local supported features 1416c92ca2c8SMatthias Ringwald for (i=0;i<(sizeof(hci_sco_packet_type_feature_requirements)/sizeof(hci_sco_packet_type_feature_requirements[0])); i++){ 1417c92ca2c8SMatthias Ringwald unsigned int bit_idx = hci_sco_packet_type_feature_requirements[i].feature_index; 1418c92ca2c8SMatthias Ringwald bool feature_set = (local_supported_features[bit_idx >> 3] & (1<<(bit_idx & 7))) != 0; 1419c92ca2c8SMatthias Ringwald if (feature_set) continue; 1420c92ca2c8SMatthias 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); 1421c92ca2c8SMatthias Ringwald packet_types &= ~hci_sco_packet_type_feature_requirements[i].feature_packet_mask; 1422c92ca2c8SMatthias Ringwald } 1423c92ca2c8SMatthias Ringwald return packet_types; 1424c92ca2c8SMatthias Ringwald } 1425c92ca2c8SMatthias Ringwald 1426c92ca2c8SMatthias Ringwald uint16_t hci_usable_sco_packet_types(void){ 1427c92ca2c8SMatthias Ringwald return hci_stack->usable_packet_types_sco; 1428c92ca2c8SMatthias Ringwald } 1429c92ca2c8SMatthias Ringwald 1430d7891039SMatthias Ringwald static uint16_t hci_sco_payload_length_for_packet_types(uint16_t packet_types){ 1431d7891039SMatthias Ringwald uint8_t i; 1432d7891039SMatthias Ringwald for (i=0;i<sizeof(hci_sco_packet_type_to_payload_length)/sizeof(hci_sco_packet_type_to_payload_length[0]);i++){ 1433d7891039SMatthias Ringwald if ((hci_sco_packet_type_to_payload_length[i].type & packet_types) != 0){ 1434d7891039SMatthias Ringwald return hci_sco_packet_type_to_payload_length[i].payload_length; 1435d7891039SMatthias Ringwald } 1436d7891039SMatthias Ringwald } 1437d7891039SMatthias Ringwald return 0; 1438d7891039SMatthias Ringwald } 1439d7891039SMatthias Ringwald 144035454696SMatthias Ringwald #endif 14418f8108aaSmatthias.ringwald 1442facf93fdS[email protected] uint8_t* hci_get_outgoing_packet_buffer(void){ 14437dc17943Smatthias.ringwald // hci packet buffer is >= acl data packet length 14443a9fb326S[email protected] return hci_stack->hci_packet_buffer; 14457dc17943Smatthias.ringwald } 14467dc17943Smatthias.ringwald 1447f5d8d141S[email protected] uint16_t hci_max_acl_data_packet_length(void){ 14483a9fb326S[email protected] return hci_stack->acl_data_packet_length; 14497dc17943Smatthias.ringwald } 14507dc17943Smatthias.ringwald 145106b9e820SMatthias Ringwald #ifdef ENABLE_CLASSIC 145220dcdd22SMatthias Ringwald bool hci_extended_sco_link_supported(void){ 14533e68d23dSMatthias Ringwald // No. 31, byte 3, bit 7 14543e68d23dSMatthias Ringwald return (hci_stack->local_supported_features[3] & (1 << 7)) != 0; 14553e68d23dSMatthias Ringwald } 145606b9e820SMatthias Ringwald #endif 14573e68d23dSMatthias Ringwald 145820dcdd22SMatthias Ringwald bool hci_non_flushable_packet_boundary_flag_supported(void){ 14596ac9a97eS[email protected] // No. 54, byte 6, bit 6 14604ea43905SMatthias Ringwald return (hci_stack->local_supported_features[6u] & (1u << 6u)) != 0u; 14616ac9a97eS[email protected] } 14626ac9a97eS[email protected] 14639885fb2dSMatthias Ringwald #ifdef ENABLE_CLASSIC 146457514786SMatthias Ringwald static bool gap_ssp_supported(void){ 14656ac9a97eS[email protected] // No. 51, byte 6, bit 3 14664ea43905SMatthias Ringwald return (hci_stack->local_supported_features[6u] & (1u << 3u)) != 0u; 1467f5d8d141S[email protected] } 14689885fb2dSMatthias Ringwald #endif 1469f5d8d141S[email protected] 1470ad58a385SMatthias Ringwald bool hci_classic_supported(void){ 147135454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 14726ac9a97eS[email protected] // No. 37, byte 4, bit 5, = No BR/EDR Support 14733a9fb326S[email protected] return (hci_stack->local_supported_features[4] & (1 << 5)) == 0; 147435454696SMatthias Ringwald #else 147557514786SMatthias Ringwald return false; 147635454696SMatthias Ringwald #endif 1477f5d8d141S[email protected] } 1478f5d8d141S[email protected] 1479ad58a385SMatthias Ringwald bool hci_le_supported(void){ 1480a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE 14816ac9a97eS[email protected] // No. 37, byte 4, bit 6 = LE Supported (Controller) 14824ea43905SMatthias Ringwald return (hci_stack->local_supported_features[4u] & (1u << 6u)) != 0u; 1483f5d8d141S[email protected] #else 148457514786SMatthias Ringwald return false; 1485f5d8d141S[email protected] #endif 1486f5d8d141S[email protected] } 1487f5d8d141S[email protected] 14881ffa425cSMatthias Ringwald static bool hci_command_supported(uint8_t command_index){ 14891ffa425cSMatthias Ringwald return (hci_stack->local_supported_commands & (1LU << command_index)) != 0; 14901ffa425cSMatthias Ringwald } 14911ffa425cSMatthias Ringwald 1492b95a5a35SMatthias Ringwald #ifdef ENABLE_BLE 1493b95a5a35SMatthias Ringwald 149463671e69SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 149522f987e4SMatthias Ringwald bool hci_le_extended_advertising_supported(void){ 149663671e69SMatthias Ringwald return hci_command_supported(SUPPORTED_HCI_COMMAND_LE_SET_EXTENDED_ADVERTISING_ENABLE); 149763671e69SMatthias Ringwald } 149863671e69SMatthias Ringwald #endif 149963671e69SMatthias Ringwald 1500f5873674SMatthias Ringwald static void hci_get_own_address_for_addr_type(uint8_t own_addr_type, bd_addr_t own_addr){ 15016bcfa632SMatthias Ringwald if (own_addr_type == BD_ADDR_TYPE_LE_PUBLIC){ 15026bcfa632SMatthias Ringwald (void)memcpy(own_addr, hci_stack->local_bd_addr, 6); 150369a97523S[email protected] } else { 15046bcfa632SMatthias Ringwald (void)memcpy(own_addr, hci_stack->le_random_address, 6); 150569a97523S[email protected] } 150669a97523S[email protected] } 150769a97523S[email protected] 15086bcfa632SMatthias Ringwald void gap_le_get_own_address(uint8_t * addr_type, bd_addr_t addr){ 15096bcfa632SMatthias Ringwald *addr_type = hci_stack->le_own_addr_type; 15106bcfa632SMatthias Ringwald hci_get_own_address_for_addr_type(hci_stack->le_own_addr_type, addr); 15116bcfa632SMatthias Ringwald } 15126bcfa632SMatthias Ringwald 15136bcfa632SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 15146bcfa632SMatthias Ringwald void gap_le_get_own_advertisements_address(uint8_t * addr_type, bd_addr_t addr){ 15156bcfa632SMatthias Ringwald *addr_type = hci_stack->le_advertisements_own_addr_type; 15166bcfa632SMatthias Ringwald hci_get_own_address_for_addr_type(hci_stack->le_advertisements_own_addr_type, addr); 151736916f81SDirk Helbig } 1518efc77985SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 1519efc77985SMatthias Ringwald void gap_le_get_own_advertising_set_address(uint8_t * addr_type, bd_addr_t addr, uint8_t advertising_handle){ 1520efc77985SMatthias Ringwald if (advertising_handle == 0){ 1521efc77985SMatthias Ringwald gap_le_get_own_advertisements_address(addr_type, addr); 1522efc77985SMatthias Ringwald } else { 1523efc77985SMatthias Ringwald le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(advertising_handle); 1524efc77985SMatthias Ringwald if (advertising_set != NULL){ 1525efc77985SMatthias Ringwald switch (advertising_set->extended_params.own_address_type){ 1526efc77985SMatthias Ringwald case BD_ADDR_TYPE_LE_PUBLIC: 1527efc77985SMatthias Ringwald *addr_type = BD_ADDR_TYPE_LE_PUBLIC; 1528efc77985SMatthias Ringwald memcpy(addr, hci_stack->local_bd_addr, 6); 1529efc77985SMatthias Ringwald break; 1530efc77985SMatthias Ringwald case BD_ADDR_TYPE_LE_RANDOM: 1531efc77985SMatthias Ringwald *addr_type = BD_ADDR_TYPE_LE_RANDOM; 1532efc77985SMatthias Ringwald memcpy(addr, advertising_set->random_address, 6); 1533efc77985SMatthias Ringwald break; 1534efc77985SMatthias Ringwald case BD_ADDR_TYPE_LE_PUBLIC_IDENTITY: 1535efc77985SMatthias Ringwald case BD_ADDR_TYPE_LE_RANDOM_IDENTITY: 1536efc77985SMatthias Ringwald // do nothing as random address was already set from enhanced connection complete 1537efc77985SMatthias Ringwald break; 1538efc77985SMatthias Ringwald default: 1539efc77985SMatthias Ringwald break; 1540efc77985SMatthias Ringwald } 1541efc77985SMatthias Ringwald } 1542efc77985SMatthias Ringwald } 154336916f81SDirk Helbig } 1544efc77985SMatthias Ringwald #endif 15456bcfa632SMatthias Ringwald #endif 15466bcfa632SMatthias Ringwald 1547e8c8828eSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 15486bcfa632SMatthias Ringwald 15496bcfa632SMatthias Ringwald /** 15506bcfa632SMatthias Ringwald * @brief Get own addr type and address used for LE connections (Central) 15516bcfa632SMatthias Ringwald */ 15526bcfa632SMatthias Ringwald void gap_le_get_own_connection_address(uint8_t * addr_type, bd_addr_t addr){ 15536bcfa632SMatthias Ringwald *addr_type = hci_stack->le_connection_own_addr_type; 15546bcfa632SMatthias Ringwald hci_get_own_address_for_addr_type(hci_stack->le_connection_own_addr_type, addr); 15556bcfa632SMatthias Ringwald } 15566bcfa632SMatthias Ringwald 1557384b59deSMatthias Ringwald void le_handle_advertisement_report(uint8_t *packet, uint16_t size){ 15589ec2630cSMatthias Ringwald 1559a0698cb4SMatthias Ringwald uint16_t offset = 3; 1560a0698cb4SMatthias Ringwald uint8_t num_reports = packet[offset]; 1561d1dc057bS[email protected] offset += 1; 1562d1dc057bS[email protected] 1563a0698cb4SMatthias Ringwald uint16_t i; 156403fbe9c6S[email protected] uint8_t event[12 + LE_ADVERTISING_DATA_SIZE]; // use upper bound to avoid var size automatic var 1565a1df452eSMatthias Ringwald for (i=0; (i<num_reports) && (offset < size);i++){ 156633e6948bSMatthias Ringwald // sanity checks on data_length: 156733e6948bSMatthias Ringwald uint8_t data_length = packet[offset + 8]; 156833e6948bSMatthias Ringwald if (data_length > LE_ADVERTISING_DATA_SIZE) return; 15694ea43905SMatthias Ringwald if ((offset + 9u + data_length + 1u) > size) return; 157033e6948bSMatthias Ringwald // setup event 15714ea43905SMatthias Ringwald uint8_t event_size = 10u + data_length; 1572a0698cb4SMatthias Ringwald uint16_t pos = 0; 1573045013feSMatthias Ringwald event[pos++] = GAP_EVENT_ADVERTISING_REPORT; 157457c9da5bS[email protected] event[pos++] = event_size; 15756535961aSMatthias Ringwald (void)memcpy(&event[pos], &packet[offset], 1 + 1 + 6); // event type + address type + address 1576d1dc057bS[email protected] offset += 8; 1577d1dc057bS[email protected] pos += 8; 1578d1dc057bS[email protected] event[pos++] = packet[offset + 1 + data_length]; // rssi 157933e6948bSMatthias Ringwald event[pos++] = data_length; 158033e6948bSMatthias Ringwald offset++; 15816535961aSMatthias Ringwald (void)memcpy(&event[pos], &packet[offset], data_length); 158257c9da5bS[email protected] pos += data_length; 15834ea43905SMatthias Ringwald offset += data_length + 1u; // rssi 15849da9850bSMatthias Ringwald hci_emit_btstack_event(event, pos, 1); 158557c9da5bS[email protected] } 158657c9da5bS[email protected] } 1587a0698cb4SMatthias Ringwald 1588a0698cb4SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 1589033393eeSBob Abeles static void le_handle_extended_advertisement_report(uint8_t *packet, uint16_t size) { 1590a0698cb4SMatthias Ringwald uint16_t offset = 3; 1591a0698cb4SMatthias Ringwald uint8_t num_reports = packet[offset++]; 1592c95a0fc7SMatthias Ringwald uint8_t event[2 + 255]; // use upper bound to avoid var size automatic var 1593a0698cb4SMatthias Ringwald uint8_t i; 1594a0698cb4SMatthias Ringwald for (i=0; (i<num_reports) && (offset < size);i++){ 1595a0698cb4SMatthias Ringwald // sanity checks on data_length: 1596a0698cb4SMatthias Ringwald uint16_t data_length = packet[offset + 23]; 159743ce0351SMatthias Ringwald if (data_length > LE_EXTENDED_ADVERTISING_DATA_SIZE) return; 1598a0698cb4SMatthias Ringwald if ((offset + 24u + data_length) > size) return; 1599a0698cb4SMatthias Ringwald uint16_t event_type = little_endian_read_16(packet, offset); 1600a0698cb4SMatthias Ringwald offset += 2; 1601a0698cb4SMatthias Ringwald if ((event_type & 0x10) != 0) { 1602a0698cb4SMatthias Ringwald // setup legacy event 1603a0698cb4SMatthias Ringwald uint8_t legacy_event_type; 1604a0698cb4SMatthias Ringwald switch (event_type){ 160536916f81SDirk Helbig case 0x13: // 0b0010011 1606a0698cb4SMatthias Ringwald // ADV_IND 1607a0698cb4SMatthias Ringwald legacy_event_type = 0; 1608a0698cb4SMatthias Ringwald break; 160936916f81SDirk Helbig case 0x15: // 0b0010101 1610a0698cb4SMatthias Ringwald // ADV_DIRECT_IND 1611a0698cb4SMatthias Ringwald legacy_event_type = 1; 1612a0698cb4SMatthias Ringwald break; 161336916f81SDirk Helbig case 0x12: // 0b0010010 1614a0698cb4SMatthias Ringwald // ADV_SCAN_IND 1615a0698cb4SMatthias Ringwald legacy_event_type = 2; 1616a0698cb4SMatthias Ringwald break; 161736916f81SDirk Helbig case 0x10: // 0b0010000: 1618a0698cb4SMatthias Ringwald // ADV_NONCONN_IND 1619a0698cb4SMatthias Ringwald legacy_event_type = 3; 1620a0698cb4SMatthias Ringwald break; 162136916f81SDirk Helbig case 0x1B: // 0b0011011 162236916f81SDirk Helbig case 0x1A: // 0b0011010 1623a0698cb4SMatthias Ringwald // SCAN_RSP 1624a0698cb4SMatthias Ringwald legacy_event_type = 4; 1625a0698cb4SMatthias Ringwald break; 1626a0698cb4SMatthias Ringwald default: 1627a0698cb4SMatthias Ringwald legacy_event_type = 0; 1628a0698cb4SMatthias Ringwald break; 1629a0698cb4SMatthias Ringwald } 1630a0698cb4SMatthias Ringwald uint16_t pos = 0; 1631a0698cb4SMatthias Ringwald event[pos++] = GAP_EVENT_ADVERTISING_REPORT; 1632a0698cb4SMatthias Ringwald event[pos++] = 10u + data_length; 1633a0698cb4SMatthias Ringwald event[pos++] = legacy_event_type; 1634a0698cb4SMatthias Ringwald // copy address type + address 1635a0698cb4SMatthias Ringwald (void) memcpy(&event[pos], &packet[offset], 1 + 6); 1636a0698cb4SMatthias Ringwald offset += 7; 1637a0698cb4SMatthias Ringwald pos += 7; 1638a0698cb4SMatthias Ringwald // skip primary_phy, secondary_phy, advertising_sid, tx_power 1639a0698cb4SMatthias Ringwald offset += 4; 1640a0698cb4SMatthias Ringwald // copy rssi 1641a0698cb4SMatthias Ringwald event[pos++] = packet[offset++]; 1642a0698cb4SMatthias Ringwald // skip periodic advertising interval and direct address 1643a0698cb4SMatthias Ringwald offset += 9; 1644a0698cb4SMatthias Ringwald // copy data len + data; 1645a0698cb4SMatthias Ringwald (void) memcpy(&event[pos], &packet[offset], 1 + data_length); 1646a0698cb4SMatthias Ringwald pos += 1 +data_length; 1647a0698cb4SMatthias Ringwald offset += 1+ data_length; 16489da9850bSMatthias Ringwald hci_emit_btstack_event(event, pos, 1); 1649a0698cb4SMatthias Ringwald } else { 1650c95a0fc7SMatthias Ringwald event[0] = GAP_EVENT_EXTENDED_ADVERTISING_REPORT; 1651c95a0fc7SMatthias Ringwald uint8_t report_len = 24 + data_length; 1652c95a0fc7SMatthias Ringwald event[1] = report_len; 16530f7610adSMatthias Ringwald little_endian_store_16(event, 2, event_type); 16540f7610adSMatthias Ringwald memcpy(&event[4], &packet[offset], report_len); 1655c95a0fc7SMatthias Ringwald offset += report_len; 16569da9850bSMatthias Ringwald hci_emit_btstack_event(event, 2 + report_len, 1); 1657a0698cb4SMatthias Ringwald } 1658a0698cb4SMatthias Ringwald } 1659a0698cb4SMatthias Ringwald } 1660a0698cb4SMatthias Ringwald #endif 1661a0698cb4SMatthias Ringwald 1662b2f949feS[email protected] #endif 1663e8c8828eSMatthias Ringwald #endif 166457c9da5bS[email protected] 16652b6ab3e6SMatthias Ringwald #ifdef ENABLE_BLE 16662b6ab3e6SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 1667bbc366e6SMatthias Ringwald static void hci_update_advertisements_enabled_for_current_roles(void){ 1668a408e724SMatthias Ringwald if ((hci_stack->le_advertisements_state & LE_ADVERTISEMENT_STATE_ENABLED) != 0){ 16692b6ab3e6SMatthias Ringwald // get number of active le slave connections 16702b6ab3e6SMatthias Ringwald int num_slave_connections = 0; 16712b6ab3e6SMatthias Ringwald btstack_linked_list_iterator_t it; 16722b6ab3e6SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->connections); 16732b6ab3e6SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 16742b6ab3e6SMatthias Ringwald hci_connection_t * con = (hci_connection_t*) btstack_linked_list_iterator_next(&it); 16752b6ab3e6SMatthias Ringwald log_info("state %u, role %u, le_con %u", con->state, con->role, hci_is_le_connection(con)); 16762b6ab3e6SMatthias Ringwald if (con->state != OPEN) continue; 16772b6ab3e6SMatthias Ringwald if (con->role != HCI_ROLE_SLAVE) continue; 16782b6ab3e6SMatthias Ringwald if (!hci_is_le_connection(con)) continue; 16792b6ab3e6SMatthias Ringwald num_slave_connections++; 16802b6ab3e6SMatthias Ringwald } 16812b6ab3e6SMatthias Ringwald log_info("Num LE Peripheral roles: %u of %u", num_slave_connections, hci_stack->le_max_number_peripheral_connections); 1682bbc366e6SMatthias Ringwald hci_stack->le_advertisements_enabled_for_current_roles = num_slave_connections < hci_stack->le_max_number_peripheral_connections; 1683bbc366e6SMatthias Ringwald } else { 1684bbc366e6SMatthias Ringwald hci_stack->le_advertisements_enabled_for_current_roles = false; 16852b6ab3e6SMatthias Ringwald } 16862b6ab3e6SMatthias Ringwald } 16872b6ab3e6SMatthias Ringwald #endif 16882b6ab3e6SMatthias Ringwald #endif 16892b6ab3e6SMatthias Ringwald 169059d59ecfSMatthias Ringwald #ifdef ENABLE_CLASSIC 169159d59ecfSMatthias Ringwald static void gap_run_set_local_name(void){ 169259d59ecfSMatthias Ringwald hci_reserve_packet_buffer(); 169359d59ecfSMatthias Ringwald uint8_t * packet = hci_stack->hci_packet_buffer; 169459d59ecfSMatthias Ringwald // construct HCI Command and send 169559d59ecfSMatthias Ringwald uint16_t opcode = hci_write_local_name.opcode; 169659d59ecfSMatthias Ringwald packet[0] = opcode & 0xff; 169759d59ecfSMatthias Ringwald packet[1] = opcode >> 8; 169859d59ecfSMatthias Ringwald packet[2] = DEVICE_NAME_LEN; 169959d59ecfSMatthias Ringwald memset(&packet[3], 0, DEVICE_NAME_LEN); 170059d59ecfSMatthias Ringwald uint16_t name_len = (uint16_t) strlen(hci_stack->local_name); 170159d59ecfSMatthias Ringwald uint16_t bytes_to_copy = btstack_min(name_len, DEVICE_NAME_LEN); 170259d59ecfSMatthias Ringwald // if shorter than DEVICE_NAME_LEN, it's implicitly NULL-terminated by memset call 170359d59ecfSMatthias Ringwald (void)memcpy(&packet[3], hci_stack->local_name, bytes_to_copy); 170459d59ecfSMatthias Ringwald // expand '00:00:00:00:00:00' in name with bd_addr 170559d59ecfSMatthias Ringwald btstack_replace_bd_addr_placeholder(&packet[3], bytes_to_copy, hci_stack->local_bd_addr); 1706ca6804fdSMatthias Ringwald hci_send_prepared_cmd_packet(); 170759d59ecfSMatthias Ringwald } 170859d59ecfSMatthias Ringwald 170959d59ecfSMatthias Ringwald static void gap_run_set_eir_data(void){ 171059d59ecfSMatthias Ringwald hci_reserve_packet_buffer(); 171159d59ecfSMatthias Ringwald uint8_t * packet = hci_stack->hci_packet_buffer; 171259d59ecfSMatthias Ringwald // construct HCI Command in-place and send 171359d59ecfSMatthias Ringwald uint16_t opcode = hci_write_extended_inquiry_response.opcode; 171459d59ecfSMatthias Ringwald uint16_t offset = 0; 171559d59ecfSMatthias Ringwald packet[offset++] = opcode & 0xff; 171659d59ecfSMatthias Ringwald packet[offset++] = opcode >> 8; 171759d59ecfSMatthias Ringwald packet[offset++] = 1 + EXTENDED_INQUIRY_RESPONSE_DATA_LEN; 171859d59ecfSMatthias Ringwald packet[offset++] = 0; // FEC not required 171959d59ecfSMatthias Ringwald memset(&packet[offset], 0, EXTENDED_INQUIRY_RESPONSE_DATA_LEN); 172059d59ecfSMatthias Ringwald if (hci_stack->eir_data){ 172159d59ecfSMatthias Ringwald // copy items and expand '00:00:00:00:00:00' in name with bd_addr 172259d59ecfSMatthias Ringwald ad_context_t context; 172359d59ecfSMatthias Ringwald for (ad_iterator_init(&context, EXTENDED_INQUIRY_RESPONSE_DATA_LEN, hci_stack->eir_data) ; ad_iterator_has_more(&context) ; ad_iterator_next(&context)) { 172459d59ecfSMatthias Ringwald uint8_t data_type = ad_iterator_get_data_type(&context); 172559d59ecfSMatthias Ringwald uint8_t size = ad_iterator_get_data_len(&context); 172659d59ecfSMatthias Ringwald const uint8_t *data = ad_iterator_get_data(&context); 172759d59ecfSMatthias Ringwald // copy item 172859d59ecfSMatthias Ringwald packet[offset++] = size + 1; 172959d59ecfSMatthias Ringwald packet[offset++] = data_type; 173059d59ecfSMatthias Ringwald memcpy(&packet[offset], data, size); 173159d59ecfSMatthias Ringwald // update name item 173259d59ecfSMatthias Ringwald if ((data_type == BLUETOOTH_DATA_TYPE_SHORTENED_LOCAL_NAME) || (data_type == BLUETOOTH_DATA_TYPE_COMPLETE_LOCAL_NAME)){ 173359d59ecfSMatthias Ringwald btstack_replace_bd_addr_placeholder(&packet[offset], size, hci_stack->local_bd_addr); 173459d59ecfSMatthias Ringwald } 173559d59ecfSMatthias Ringwald offset += size; 173659d59ecfSMatthias Ringwald } 173759d59ecfSMatthias Ringwald } else { 173859d59ecfSMatthias Ringwald uint16_t name_len = (uint16_t) strlen(hci_stack->local_name); 173959d59ecfSMatthias Ringwald uint16_t bytes_to_copy = btstack_min(name_len, EXTENDED_INQUIRY_RESPONSE_DATA_LEN - 2); 174059d59ecfSMatthias Ringwald packet[offset++] = bytes_to_copy + 1; 174159d59ecfSMatthias Ringwald packet[offset++] = BLUETOOTH_DATA_TYPE_COMPLETE_LOCAL_NAME; 174259d59ecfSMatthias Ringwald (void)memcpy(&packet[6], hci_stack->local_name, bytes_to_copy); 174359d59ecfSMatthias Ringwald // expand '00:00:00:00:00:00' in name with bd_addr 174459d59ecfSMatthias Ringwald btstack_replace_bd_addr_placeholder(&packet[offset], bytes_to_copy, hci_stack->local_bd_addr); 174559d59ecfSMatthias Ringwald } 1746ca6804fdSMatthias Ringwald hci_send_prepared_cmd_packet(); 174759d59ecfSMatthias Ringwald } 1748ab4831a3SMatthias Ringwald 1749ab4831a3SMatthias Ringwald static void hci_run_gap_tasks_classic(void){ 1750baa4881eSMatthias Ringwald if ((hci_stack->gap_tasks_classic & GAP_TASK_SET_CLASS_OF_DEVICE) != 0) { 1751baa4881eSMatthias Ringwald hci_stack->gap_tasks_classic &= ~GAP_TASK_SET_CLASS_OF_DEVICE; 1752ab4831a3SMatthias Ringwald hci_send_cmd(&hci_write_class_of_device, hci_stack->class_of_device); 1753ab4831a3SMatthias Ringwald return; 1754ab4831a3SMatthias Ringwald } 1755baa4881eSMatthias Ringwald if ((hci_stack->gap_tasks_classic & GAP_TASK_SET_LOCAL_NAME) != 0) { 1756baa4881eSMatthias Ringwald hci_stack->gap_tasks_classic &= ~GAP_TASK_SET_LOCAL_NAME; 1757ab4831a3SMatthias Ringwald gap_run_set_local_name(); 1758ab4831a3SMatthias Ringwald return; 1759ab4831a3SMatthias Ringwald } 1760baa4881eSMatthias Ringwald if ((hci_stack->gap_tasks_classic & GAP_TASK_SET_EIR_DATA) != 0) { 1761baa4881eSMatthias Ringwald hci_stack->gap_tasks_classic &= ~GAP_TASK_SET_EIR_DATA; 1762ab4831a3SMatthias Ringwald gap_run_set_eir_data(); 1763ab4831a3SMatthias Ringwald return; 1764ab4831a3SMatthias Ringwald } 1765baa4881eSMatthias Ringwald if ((hci_stack->gap_tasks_classic & GAP_TASK_SET_DEFAULT_LINK_POLICY) != 0) { 1766baa4881eSMatthias Ringwald hci_stack->gap_tasks_classic &= ~GAP_TASK_SET_DEFAULT_LINK_POLICY; 1767ab4831a3SMatthias Ringwald hci_send_cmd(&hci_write_default_link_policy_setting, hci_stack->default_link_policy_settings); 1768ab4831a3SMatthias Ringwald return; 1769ab4831a3SMatthias Ringwald } 1770ab4831a3SMatthias Ringwald // write page scan activity 1771baa4881eSMatthias Ringwald if ((hci_stack->gap_tasks_classic & GAP_TASK_WRITE_PAGE_SCAN_ACTIVITY) != 0) { 1772baa4881eSMatthias Ringwald hci_stack->gap_tasks_classic &= ~GAP_TASK_WRITE_PAGE_SCAN_ACTIVITY; 1773ab4831a3SMatthias Ringwald hci_send_cmd(&hci_write_page_scan_activity, hci_stack->new_page_scan_interval, hci_stack->new_page_scan_window); 1774ab4831a3SMatthias Ringwald return; 1775ab4831a3SMatthias Ringwald } 1776ab4831a3SMatthias Ringwald // write page scan type 1777baa4881eSMatthias Ringwald if ((hci_stack->gap_tasks_classic & GAP_TASK_WRITE_PAGE_SCAN_TYPE) != 0) { 1778baa4881eSMatthias Ringwald hci_stack->gap_tasks_classic &= ~GAP_TASK_WRITE_PAGE_SCAN_TYPE; 1779ab4831a3SMatthias Ringwald hci_send_cmd(&hci_write_page_scan_type, hci_stack->new_page_scan_type); 1780ab4831a3SMatthias Ringwald return; 1781ab4831a3SMatthias Ringwald } 178232a12730SMatthias Ringwald // write page timeout 1783baa4881eSMatthias Ringwald if ((hci_stack->gap_tasks_classic & GAP_TASK_WRITE_PAGE_TIMEOUT) != 0) { 1784baa4881eSMatthias Ringwald hci_stack->gap_tasks_classic &= ~GAP_TASK_WRITE_PAGE_TIMEOUT; 178532a12730SMatthias Ringwald hci_send_cmd(&hci_write_page_timeout, hci_stack->page_timeout); 178632a12730SMatthias Ringwald return; 178732a12730SMatthias Ringwald } 1788ab4831a3SMatthias Ringwald // send scan enable 1789baa4881eSMatthias Ringwald if ((hci_stack->gap_tasks_classic & GAP_TASK_WRITE_SCAN_ENABLE) != 0) { 1790baa4881eSMatthias Ringwald hci_stack->gap_tasks_classic &= ~GAP_TASK_WRITE_SCAN_ENABLE; 1791ab4831a3SMatthias Ringwald hci_send_cmd(&hci_write_scan_enable, hci_stack->new_scan_enable_value); 1792ab4831a3SMatthias Ringwald return; 1793ab4831a3SMatthias Ringwald } 1794c0c8a829SMatthias Ringwald // send write scan activity 1795baa4881eSMatthias Ringwald if ((hci_stack->gap_tasks_classic & GAP_TASK_WRITE_INQUIRY_SCAN_ACTIVITY) != 0) { 1796baa4881eSMatthias Ringwald hci_stack->gap_tasks_classic &= ~GAP_TASK_WRITE_INQUIRY_SCAN_ACTIVITY; 1797c0c8a829SMatthias Ringwald hci_send_cmd(&hci_write_inquiry_scan_activity, hci_stack->inquiry_scan_interval, hci_stack->inquiry_scan_window); 1798c0c8a829SMatthias Ringwald return; 1799c0c8a829SMatthias Ringwald } 1800f50ed5acSAndrey Fominykh // send write inquiry transmit power level 1801f50ed5acSAndrey Fominykh if ((hci_stack->gap_tasks_classic & GAP_TASK_WRITE_INQUIRY_TX_POWER_LEVEL) != 0) { 1802f50ed5acSAndrey Fominykh hci_stack->gap_tasks_classic &= ~GAP_TASK_WRITE_INQUIRY_TX_POWER_LEVEL; 1803f50ed5acSAndrey Fominykh hci_send_cmd(&hci_write_inquiry_transmit_power_level, hci_stack->inquiry_tx_power_level); 1804f50ed5acSAndrey Fominykh return; 1805f50ed5acSAndrey Fominykh } 1806ab4831a3SMatthias Ringwald } 180759d59ecfSMatthias Ringwald #endif 180859d59ecfSMatthias Ringwald 18096fad2c37SMatthias Ringwald #ifndef HAVE_HOST_CONTROLLER_API 181006b9e820SMatthias Ringwald 181196b53536SMatthias Ringwald static uint32_t hci_transport_uart_get_main_baud_rate(void){ 181296b53536SMatthias Ringwald if (!hci_stack->config) return 0; 18139796ebeaSMatthias Ringwald uint32_t baud_rate = ((hci_transport_config_uart_t *)hci_stack->config)->baudrate_main; 181496b53536SMatthias Ringwald return baud_rate; 181596b53536SMatthias Ringwald } 181696b53536SMatthias Ringwald 1817ec820d77SMatthias Ringwald static void hci_initialization_timeout_handler(btstack_timer_source_t * ds){ 18189ec2630cSMatthias Ringwald UNUSED(ds); 18199ec2630cSMatthias Ringwald 18200305bdeaSMatthias Ringwald switch (hci_stack->substate){ 18210305bdeaSMatthias Ringwald case HCI_INIT_W4_SEND_RESET: 18227b0d7667SMatthias Ringwald log_info("Resend HCI Reset"); 18230305bdeaSMatthias Ringwald hci_stack->substate = HCI_INIT_SEND_RESET; 18247b0d7667SMatthias Ringwald hci_stack->num_cmd_packets = 1; 18250305bdeaSMatthias Ringwald hci_run(); 18260305bdeaSMatthias Ringwald break; 18279f007422SMatthias Ringwald case HCI_INIT_W4_CUSTOM_INIT_CSR_WARM_BOOT_LINK_RESET: 18289f007422SMatthias Ringwald log_info("Resend HCI Reset - CSR Warm Boot with Link Reset"); 18299f007422SMatthias Ringwald if (hci_stack->hci_transport->reset_link){ 18309f007422SMatthias Ringwald hci_stack->hci_transport->reset_link(); 18319f007422SMatthias Ringwald } 1832cf373d3aSMatthias Ringwald 1833cf373d3aSMatthias Ringwald /* fall through */ 1834cf373d3aSMatthias Ringwald 1835e47e68c7SMatthias Ringwald case HCI_INIT_W4_CUSTOM_INIT_CSR_WARM_BOOT: 1836e47e68c7SMatthias Ringwald log_info("Resend HCI Reset - CSR Warm Boot"); 1837e47e68c7SMatthias Ringwald hci_stack->substate = HCI_INIT_SEND_RESET_CSR_WARM_BOOT; 1838e47e68c7SMatthias Ringwald hci_stack->num_cmd_packets = 1; 1839e47e68c7SMatthias Ringwald hci_run(); 1840688c2635SMatthias Ringwald break; 18417224be7eSMatthias Ringwald case HCI_INIT_W4_SEND_BAUD_CHANGE: 18427224be7eSMatthias Ringwald if (hci_stack->hci_transport->set_baudrate){ 184396b53536SMatthias Ringwald uint32_t baud_rate = hci_transport_uart_get_main_baud_rate(); 1844cd724cb7SMatthias Ringwald log_info("Local baud rate change to %" PRIu32 "(timeout handler)", baud_rate); 18457dd9d0ecSMatthias Ringwald hci_stack->hci_transport->set_baudrate(baud_rate); 18467224be7eSMatthias Ringwald } 1847834bce8cSMatthias Ringwald // For CSR, HCI Reset is sent on new baud rate. Don't forget to reset link for H5/BCSP 184861f37892SMatthias Ringwald if (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_CAMBRIDGE_SILICON_RADIO){ 1849834bce8cSMatthias Ringwald if (hci_stack->hci_transport->reset_link){ 1850834bce8cSMatthias Ringwald log_info("Link Reset"); 1851834bce8cSMatthias Ringwald hci_stack->hci_transport->reset_link(); 1852834bce8cSMatthias Ringwald } 1853772a36d3SMatthias Ringwald hci_stack->substate = HCI_INIT_SEND_RESET_CSR_WARM_BOOT; 1854772a36d3SMatthias Ringwald hci_run(); 1855772a36d3SMatthias Ringwald } 18564696bddbSMatthias Ringwald break; 1857559961d0SMatthias Ringwald case HCI_INIT_W4_CUSTOM_INIT_BCM_DELAY: 1858559961d0SMatthias Ringwald // otherwise continue 1859559961d0SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_READ_LOCAL_SUPPORTED_COMMANDS; 1860559961d0SMatthias Ringwald hci_send_cmd(&hci_read_local_supported_commands); 1861559961d0SMatthias Ringwald break; 18620305bdeaSMatthias Ringwald default: 18630305bdeaSMatthias Ringwald break; 18640305bdeaSMatthias Ringwald } 18650305bdeaSMatthias Ringwald } 186606b9e820SMatthias Ringwald #endif 18670305bdeaSMatthias Ringwald 186871de195eSMatthias Ringwald static void hci_initializing_next_state(void){ 186974b323a9SMatthias Ringwald hci_stack->substate = (hci_substate_t )( ((int) hci_stack->substate) + 1); 187074b323a9SMatthias Ringwald } 187174b323a9SMatthias Ringwald 1872f795c86eSMatthias Ringwald static void hci_init_done(void){ 1873f795c86eSMatthias Ringwald // done. tell the app 1874f795c86eSMatthias Ringwald log_info("hci_init_done -> HCI_STATE_WORKING"); 1875f795c86eSMatthias Ringwald hci_stack->state = HCI_STATE_WORKING; 1876f795c86eSMatthias Ringwald hci_emit_state(); 1877f795c86eSMatthias Ringwald } 1878f795c86eSMatthias Ringwald 187974b323a9SMatthias Ringwald // assumption: hci_can_send_command_packet_now() == true 188071de195eSMatthias Ringwald static void hci_initializing_run(void){ 1881148ca237SMatthias Ringwald log_debug("hci_initializing_run: substate %u, can send %u", hci_stack->substate, hci_can_send_command_packet_now()); 1882f4c579d4SMatthias Ringwald 18830d37aff3SMatthias Ringwald if (!hci_can_send_command_packet_now()) return; 18840d37aff3SMatthias Ringwald 1885f4c579d4SMatthias Ringwald #ifndef HAVE_HOST_CONTROLLER_API 1886f9fd20c2SMatthias Ringwald bool need_baud_change = hci_stack->config 1887f4c579d4SMatthias Ringwald && hci_stack->chipset 1888f4c579d4SMatthias Ringwald && hci_stack->chipset->set_baudrate_command 1889f4c579d4SMatthias Ringwald && hci_stack->hci_transport->set_baudrate 1890f4c579d4SMatthias Ringwald && ((hci_transport_config_uart_t *)hci_stack->config)->baudrate_main; 1891f4c579d4SMatthias Ringwald #endif 1892f4c579d4SMatthias Ringwald 189374b323a9SMatthias Ringwald switch (hci_stack->substate){ 189474b323a9SMatthias Ringwald case HCI_INIT_SEND_RESET: 189574b323a9SMatthias Ringwald hci_state_reset(); 1896a0cf2f3fSMatthias Ringwald 18976fad2c37SMatthias Ringwald #ifndef HAVE_HOST_CONTROLLER_API 18980305bdeaSMatthias Ringwald // prepare reset if command complete not received in 100ms 1899659d758cSMatthias Ringwald btstack_run_loop_set_timer(&hci_stack->timeout, HCI_RESET_RESEND_TIMEOUT_MS); 1900528a4a3bSMatthias Ringwald btstack_run_loop_set_timer_handler(&hci_stack->timeout, hci_initialization_timeout_handler); 1901528a4a3bSMatthias Ringwald btstack_run_loop_add_timer(&hci_stack->timeout); 1902a0cf2f3fSMatthias Ringwald #endif 19030305bdeaSMatthias Ringwald // send command 190474b323a9SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_SEND_RESET; 19050305bdeaSMatthias Ringwald hci_send_cmd(&hci_reset); 190674b323a9SMatthias Ringwald break; 190776fcb19bSMatthias Ringwald case HCI_INIT_SEND_READ_LOCAL_VERSION_INFORMATION: 190876fcb19bSMatthias Ringwald hci_send_cmd(&hci_read_local_version_information); 190976fcb19bSMatthias Ringwald hci_stack->substate = HCI_INIT_W4_SEND_READ_LOCAL_VERSION_INFORMATION; 191076fcb19bSMatthias Ringwald break; 1911e28e41c0SMatthias Ringwald 1912e28e41c0SMatthias Ringwald #ifndef HAVE_HOST_CONTROLLER_API 1913e47e68c7SMatthias Ringwald case HCI_INIT_SEND_RESET_CSR_WARM_BOOT: 1914e47e68c7SMatthias Ringwald hci_state_reset(); 1915e47e68c7SMatthias Ringwald // prepare reset if command complete not received in 100ms 1916659d758cSMatthias Ringwald btstack_run_loop_set_timer(&hci_stack->timeout, HCI_RESET_RESEND_TIMEOUT_MS); 1917528a4a3bSMatthias Ringwald btstack_run_loop_set_timer_handler(&hci_stack->timeout, hci_initialization_timeout_handler); 1918528a4a3bSMatthias Ringwald btstack_run_loop_add_timer(&hci_stack->timeout); 1919e47e68c7SMatthias Ringwald // send command 1920e47e68c7SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_CUSTOM_INIT_CSR_WARM_BOOT; 1921e47e68c7SMatthias Ringwald hci_send_cmd(&hci_reset); 1922e47e68c7SMatthias Ringwald break; 19238d29070eSMatthias Ringwald case HCI_INIT_SEND_RESET_ST_WARM_BOOT: 19248d29070eSMatthias Ringwald hci_state_reset(); 19258d29070eSMatthias Ringwald hci_stack->substate = HCI_INIT_W4_SEND_RESET_ST_WARM_BOOT; 19268d29070eSMatthias Ringwald hci_send_cmd(&hci_reset); 19278d29070eSMatthias Ringwald break; 1928f4c579d4SMatthias Ringwald case HCI_INIT_SEND_BAUD_CHANGE_BCM: { 1929a784d71bSMatthias Ringwald hci_reserve_packet_buffer(); 1930f4c579d4SMatthias Ringwald uint32_t baud_rate = hci_transport_uart_get_main_baud_rate(); 1931f4c579d4SMatthias Ringwald hci_stack->chipset->set_baudrate_command(baud_rate, hci_stack->hci_packet_buffer); 1932f4c579d4SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_SEND_BAUD_CHANGE_BCM; 1933ca6804fdSMatthias Ringwald hci_send_prepared_cmd_packet(); 1934f4c579d4SMatthias Ringwald break; 1935f4c579d4SMatthias Ringwald } 1936c97af506SMatthias Ringwald case HCI_INIT_SET_BD_ADDR: 1937a784d71bSMatthias Ringwald hci_reserve_packet_buffer(); 1938c97af506SMatthias Ringwald log_info("Set Public BD ADDR to %s", bd_addr_to_str(hci_stack->custom_bd_addr)); 1939c97af506SMatthias Ringwald hci_stack->chipset->set_bd_addr_command(hci_stack->custom_bd_addr, hci_stack->hci_packet_buffer); 1940c97af506SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_SET_BD_ADDR; 1941ca6804fdSMatthias Ringwald hci_send_prepared_cmd_packet(); 1942c97af506SMatthias Ringwald break; 19438250c242SMatthias Ringwald case HCI_INIT_SEND_READ_LOCAL_NAME: 19448250c242SMatthias Ringwald #ifdef ENABLE_CLASSIC 19458250c242SMatthias Ringwald hci_send_cmd(&hci_read_local_name); 19468250c242SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_SEND_READ_LOCAL_NAME; 19478250c242SMatthias Ringwald break; 19488250c242SMatthias Ringwald #endif 19498250c242SMatthias Ringwald /* fall through */ 19508250c242SMatthias Ringwald 1951f4c579d4SMatthias Ringwald case HCI_INIT_SEND_BAUD_CHANGE: 1952f4c579d4SMatthias Ringwald if (need_baud_change) { 1953a784d71bSMatthias Ringwald hci_reserve_packet_buffer(); 195496b53536SMatthias Ringwald uint32_t baud_rate = hci_transport_uart_get_main_baud_rate(); 19553fb36a29SMatthias Ringwald hci_stack->chipset->set_baudrate_command(baud_rate, hci_stack->hci_packet_buffer); 195674b323a9SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_SEND_BAUD_CHANGE; 1957ca6804fdSMatthias Ringwald hci_send_prepared_cmd_packet(); 19584696bddbSMatthias Ringwald // STLC25000D: baudrate change happens within 0.5 s after command was send, 19594696bddbSMatthias Ringwald // use timer to update baud rate after 100 ms (knowing exactly, when command was sent is non-trivial) 196061f37892SMatthias Ringwald if (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_ST_MICROELECTRONICS){ 1961659d758cSMatthias Ringwald btstack_run_loop_set_timer(&hci_stack->timeout, HCI_RESET_RESEND_TIMEOUT_MS); 1962528a4a3bSMatthias Ringwald btstack_run_loop_add_timer(&hci_stack->timeout); 19634696bddbSMatthias Ringwald } 196474b323a9SMatthias Ringwald break; 1965fab26ab3SMatthias Ringwald } 19666fe16221SMatthias Ringwald hci_stack->substate = HCI_INIT_CUSTOM_INIT; 1967f4c579d4SMatthias Ringwald 1968f4c579d4SMatthias Ringwald /* fall through */ 1969f4c579d4SMatthias Ringwald 197074b323a9SMatthias Ringwald case HCI_INIT_CUSTOM_INIT: 19716fe16221SMatthias Ringwald case HCI_INIT_CUSTOM_PRE_INIT: 197274b323a9SMatthias Ringwald // Custom initialization 19733fb36a29SMatthias Ringwald if (hci_stack->chipset && hci_stack->chipset->next_command){ 1974ee418d0fSMatthias Ringwald hci_reserve_packet_buffer(); 1975ae334e9eSMatthias Ringwald hci_stack->chipset_result = (*hci_stack->chipset->next_command)(hci_stack->hci_packet_buffer); 19761979f09cSMatthias Ringwald bool send_cmd = false; 1977ae334e9eSMatthias Ringwald switch (hci_stack->chipset_result){ 1978f41911edSMatthias Ringwald case BTSTACK_CHIPSET_VALID_COMMAND: 19791979f09cSMatthias Ringwald send_cmd = true; 19806fe16221SMatthias Ringwald switch (hci_stack->substate){ 19816fe16221SMatthias Ringwald case HCI_INIT_CUSTOM_INIT: 1982e47e68c7SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_CUSTOM_INIT; 1983e47e68c7SMatthias Ringwald break; 19846fe16221SMatthias Ringwald case HCI_INIT_CUSTOM_PRE_INIT: 19856fe16221SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_CUSTOM_PRE_INIT; 19866fe16221SMatthias Ringwald break; 19876fe16221SMatthias Ringwald default: 19886fe16221SMatthias Ringwald btstack_assert(false); 19896fe16221SMatthias Ringwald break; 19906fe16221SMatthias Ringwald } 19916fe16221SMatthias Ringwald break; 1992f41911edSMatthias Ringwald case BTSTACK_CHIPSET_WARMSTART_REQUIRED: 19931979f09cSMatthias Ringwald send_cmd = true; 1994f41911edSMatthias Ringwald // CSR Warm Boot: Wait a bit, then send HCI Reset until HCI Command Complete 1995e47e68c7SMatthias Ringwald log_info("CSR Warm Boot"); 1996659d758cSMatthias Ringwald btstack_run_loop_set_timer(&hci_stack->timeout, HCI_RESET_RESEND_TIMEOUT_MS); 1997528a4a3bSMatthias Ringwald btstack_run_loop_set_timer_handler(&hci_stack->timeout, hci_initialization_timeout_handler); 1998528a4a3bSMatthias Ringwald btstack_run_loop_add_timer(&hci_stack->timeout); 1999a1df452eSMatthias Ringwald if ((hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_CAMBRIDGE_SILICON_RADIO) 2000772a36d3SMatthias Ringwald && hci_stack->config 20013fb36a29SMatthias Ringwald && hci_stack->chipset 20023fb36a29SMatthias Ringwald // && hci_stack->chipset->set_baudrate_command -- there's no such command 2003772a36d3SMatthias Ringwald && hci_stack->hci_transport->set_baudrate 20042caefae9SMatthias Ringwald && hci_transport_uart_get_main_baud_rate()){ 2005772a36d3SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_SEND_BAUD_CHANGE; 2006772a36d3SMatthias Ringwald } else { 20079f007422SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_CUSTOM_INIT_CSR_WARM_BOOT_LINK_RESET; 2008772a36d3SMatthias Ringwald } 2009e47e68c7SMatthias Ringwald break; 2010f41911edSMatthias Ringwald default: 2011f41911edSMatthias Ringwald break; 2012e47e68c7SMatthias Ringwald } 2013ee720f3aSMatthias Ringwald 2014ee720f3aSMatthias Ringwald if (send_cmd){ 2015ca6804fdSMatthias Ringwald hci_send_prepared_cmd_packet(); 201674b323a9SMatthias Ringwald break; 2017ee418d0fSMatthias Ringwald } else { 2018ee418d0fSMatthias Ringwald hci_release_packet_buffer(); 201974b323a9SMatthias Ringwald } 2020148ca237SMatthias Ringwald log_info("Init script done"); 202192a0d36dSMatthias Ringwald 20226fe16221SMatthias Ringwald // Custom Pre-Init complete, start regular init with HCI Reset 20236fe16221SMatthias Ringwald if (hci_stack->substate == HCI_INIT_CUSTOM_PRE_INIT){ 20246fe16221SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_SEND_RESET; 20256fe16221SMatthias Ringwald hci_send_cmd(&hci_reset); 20266fe16221SMatthias Ringwald break; 20276fe16221SMatthias Ringwald } 20286fe16221SMatthias Ringwald 2029559961d0SMatthias Ringwald // Init script download on Broadcom chipsets causes: 2030ae334e9eSMatthias Ringwald if ( (hci_stack->chipset_result != BTSTACK_CHIPSET_NO_INIT_SCRIPT) && 2031a1df452eSMatthias Ringwald ( (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_BROADCOM_CORPORATION) 2032a1df452eSMatthias Ringwald || (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_EM_MICROELECTRONIC_MARIN_SA)) ){ 2033e021ff1eSMatthias Ringwald 2034559961d0SMatthias Ringwald // - baud rate to reset, restore UART baud rate if needed 203592a0d36dSMatthias Ringwald if (need_baud_change) { 20369796ebeaSMatthias Ringwald uint32_t baud_rate = ((hci_transport_config_uart_t *)hci_stack->config)->baudrate_init; 2037cd724cb7SMatthias Ringwald log_info("Local baud rate change to %" PRIu32 " after init script (bcm)", baud_rate); 203892a0d36dSMatthias Ringwald hci_stack->hci_transport->set_baudrate(baud_rate); 203992a0d36dSMatthias Ringwald } 2040559961d0SMatthias Ringwald 2041f19b3c9eSMatthias Ringwald uint16_t bcm_delay_ms = 300; 2042f19b3c9eSMatthias Ringwald // - UART may or may not be disabled during update and Controller RTS may or may not be high during this time 2043f19b3c9eSMatthias Ringwald // -> Work around: wait here. 2044f19b3c9eSMatthias Ringwald log_info("BCM delay (%u ms) after init script", bcm_delay_ms); 2045559961d0SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_CUSTOM_INIT_BCM_DELAY; 2046f19b3c9eSMatthias Ringwald btstack_run_loop_set_timer(&hci_stack->timeout, bcm_delay_ms); 2047559961d0SMatthias Ringwald btstack_run_loop_set_timer_handler(&hci_stack->timeout, hci_initialization_timeout_handler); 2048559961d0SMatthias Ringwald btstack_run_loop_add_timer(&hci_stack->timeout); 2049559961d0SMatthias Ringwald break; 205092a0d36dSMatthias Ringwald } 205174b323a9SMatthias Ringwald } 205206b9e820SMatthias Ringwald #endif 2053521bd5ffSMatthias Ringwald /* fall through */ 205406b9e820SMatthias Ringwald 205506b9e820SMatthias Ringwald case HCI_INIT_READ_LOCAL_SUPPORTED_COMMANDS: 205606b9e820SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_READ_LOCAL_SUPPORTED_COMMANDS; 205706b9e820SMatthias Ringwald hci_send_cmd(&hci_read_local_supported_commands); 205806b9e820SMatthias Ringwald break; 205953860077SMatthias Ringwald case HCI_INIT_READ_BD_ADDR: 206053860077SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_READ_BD_ADDR; 206153860077SMatthias Ringwald hci_send_cmd(&hci_read_bd_addr); 206253860077SMatthias Ringwald break; 206374b323a9SMatthias Ringwald case HCI_INIT_READ_BUFFER_SIZE: 20645ffe9d0bSMatthias Ringwald // only read buffer size if supported 20651ffa425cSMatthias Ringwald if (hci_command_supported(SUPPORTED_HCI_COMMAND_READ_BUFFER_SIZE)){ 206674b323a9SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_READ_BUFFER_SIZE; 20670305bdeaSMatthias Ringwald hci_send_cmd(&hci_read_buffer_size); 206874b323a9SMatthias Ringwald break; 20695ffe9d0bSMatthias Ringwald } 2070521bd5ffSMatthias Ringwald 20715ffe9d0bSMatthias Ringwald /* fall through */ 20725ffe9d0bSMatthias Ringwald 207353860077SMatthias Ringwald case HCI_INIT_READ_LOCAL_SUPPORTED_FEATURES: 207453860077SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_READ_LOCAL_SUPPORTED_FEATURES; 20750305bdeaSMatthias Ringwald hci_send_cmd(&hci_read_local_supported_features); 207674b323a9SMatthias Ringwald break; 20772b838201SMatthias Ringwald 20782b838201SMatthias Ringwald #ifdef ENABLE_HCI_CONTROLLER_TO_HOST_FLOW_CONTROL 20792b838201SMatthias Ringwald case HCI_INIT_SET_CONTROLLER_TO_HOST_FLOW_CONTROL: 20802b838201SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_SET_CONTROLLER_TO_HOST_FLOW_CONTROL; 20812b838201SMatthias Ringwald hci_send_cmd(&hci_set_controller_to_host_flow_control, 3); // ACL + SCO Flow Control 20822b838201SMatthias Ringwald break; 20832b838201SMatthias Ringwald case HCI_INIT_HOST_BUFFER_SIZE: 20842b838201SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_HOST_BUFFER_SIZE; 20852b838201SMatthias Ringwald hci_send_cmd(&hci_host_buffer_size, HCI_HOST_ACL_PACKET_LEN, HCI_HOST_SCO_PACKET_LEN, 20862b838201SMatthias Ringwald HCI_HOST_ACL_PACKET_NUM, HCI_HOST_SCO_PACKET_NUM); 20872b838201SMatthias Ringwald break; 20882b838201SMatthias Ringwald #endif 20892b838201SMatthias Ringwald 209074b323a9SMatthias Ringwald case HCI_INIT_SET_EVENT_MASK: 20910305bdeaSMatthias Ringwald hci_stack->substate = HCI_INIT_W4_SET_EVENT_MASK; 209274b323a9SMatthias Ringwald if (hci_le_supported()){ 20935ce1359eSMatthias Ringwald hci_send_cmd(&hci_set_event_mask,0xFFFFFFFFU, 0x3FFFFFFFU); 209474b323a9SMatthias Ringwald } else { 209574b323a9SMatthias Ringwald // Kensington Bluetooth 2.1 USB Dongle (CSR Chipset) returns an error for 0xffff... 20965ce1359eSMatthias Ringwald hci_send_cmd(&hci_set_event_mask,0xFFFFFFFFU, 0x1FFFFFFFU); 209774b323a9SMatthias Ringwald } 209874b323a9SMatthias Ringwald break; 20992b838201SMatthias Ringwald 2100ff7d1758SMatthias Ringwald case HCI_INIT_SET_EVENT_MASK_2: 2101a086dc35SMatthias Ringwald // On Bluetooth PTS dongle (BL 654) with PacketCraft HCI Firmware (LMP subversion) 0x5244, 21028254e329SMatthias Ringwald // setting Event Mask 2 causes Controller to drop Encryption Change events. 21038254e329SMatthias Ringwald if (hci_command_supported(SUPPORTED_HCI_COMMAND_SET_EVENT_MASK_PAGE_2) 21048254e329SMatthias Ringwald && (hci_stack->manufacturer != BLUETOOTH_COMPANY_ID_PACKETCRAFT_INC)){ 2105ff7d1758SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_SET_EVENT_MASK_2; 2106ff7d1758SMatthias Ringwald // Encryption Change Event v2 - bit 25 2107ff7d1758SMatthias Ringwald hci_send_cmd(&hci_set_event_mask_2,0x02000000U, 0x0); 2108ff7d1758SMatthias Ringwald break; 2109ff7d1758SMatthias Ringwald } 2110ff7d1758SMatthias Ringwald 211135454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 2112ff7d1758SMatthias Ringwald /* fall through */ 2113ff7d1758SMatthias Ringwald 211474b323a9SMatthias Ringwald case HCI_INIT_WRITE_SIMPLE_PAIRING_MODE: 2115f795c86eSMatthias Ringwald if (hci_classic_supported() && gap_ssp_supported()){ 211674b323a9SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_WRITE_SIMPLE_PAIRING_MODE; 21170305bdeaSMatthias Ringwald hci_send_cmd(&hci_write_simple_pairing_mode, hci_stack->ssp_enable); 211874b323a9SMatthias Ringwald break; 2119e7c662faSMatthias Ringwald } 2120521bd5ffSMatthias Ringwald 2121e7c662faSMatthias Ringwald /* fall through */ 2122e7c662faSMatthias Ringwald 2123f6858d14SMatthias Ringwald case HCI_INIT_WRITE_INQUIRY_MODE: 2124f795c86eSMatthias Ringwald if (hci_classic_supported()){ 2125f6858d14SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_WRITE_INQUIRY_MODE; 21268a114470SMatthias Ringwald hci_send_cmd(&hci_write_inquiry_mode, (int) hci_stack->inquiry_mode); 2127f6858d14SMatthias Ringwald break; 2128f795c86eSMatthias Ringwald } 2129521bd5ffSMatthias Ringwald 2130f795c86eSMatthias Ringwald /* fall through */ 2131f795c86eSMatthias Ringwald 21325d23aae8SMatthias Ringwald case HCI_INIT_WRITE_SECURE_CONNECTIONS_HOST_ENABLE: 2133f3052906SMatthias Ringwald // skip write secure connections host support if not supported or disabled 21341ffa425cSMatthias Ringwald if (hci_classic_supported() && hci_stack->secure_connections_enable 21351ffa425cSMatthias Ringwald && hci_command_supported(SUPPORTED_HCI_COMMAND_WRITE_SECURE_CONNECTIONS_HOST)) { 2136c214d65bSMatthias Ringwald hci_stack->secure_connections_active = true; 21375d23aae8SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_WRITE_SECURE_CONNECTIONS_HOST_ENABLE; 21381ffa425cSMatthias Ringwald hci_send_cmd(&hci_write_secure_connections_host_support, 1); 21395d23aae8SMatthias Ringwald break; 2140f3052906SMatthias Ringwald } 2141521bd5ffSMatthias Ringwald 2142a391128dSMatthias Ringwald /* fall through */ 2143a391128dSMatthias Ringwald 2144a391128dSMatthias Ringwald case HCI_INIT_SET_MIN_ENCRYPTION_KEY_SIZE: 2145a391128dSMatthias Ringwald // skip set min encryption key size 2146a391128dSMatthias Ringwald if (hci_classic_supported() && hci_command_supported(SUPPORTED_HCI_COMMAND_SET_MIN_ENCRYPTION_KEY_SIZE)) { 2147a391128dSMatthias Ringwald hci_stack->substate = HCI_INIT_W4_SET_MIN_ENCRYPTION_KEY_SIZE; 2148a391128dSMatthias Ringwald hci_send_cmd(&hci_set_min_encryption_key_size, hci_stack->gap_required_encyrption_key_size); 2149a391128dSMatthias Ringwald break; 2150a391128dSMatthias Ringwald } 2151a391128dSMatthias Ringwald 2152e4c6114dSMatthias Ringwald #ifdef ENABLE_SCO_OVER_HCI 2153521bd5ffSMatthias Ringwald /* fall through */ 2154521bd5ffSMatthias Ringwald 2155483c5078SMatthias Ringwald // only sent if ENABLE_SCO_OVER_HCI is defined 2156729ed62eSMatthias Ringwald case HCI_INIT_WRITE_SYNCHRONOUS_FLOW_CONTROL_ENABLE: 2157e4c6114dSMatthias Ringwald // skip write synchronous flow control if not supported 21581ffa425cSMatthias Ringwald if (hci_classic_supported() 21591ffa425cSMatthias Ringwald && hci_command_supported(SUPPORTED_HCI_COMMAND_WRITE_SYNCHRONOUS_FLOW_CONTROL_ENABLE)) { 2160729ed62eSMatthias Ringwald hci_stack->substate = HCI_INIT_W4_WRITE_SYNCHRONOUS_FLOW_CONTROL_ENABLE; 2161729ed62eSMatthias Ringwald hci_send_cmd(&hci_write_synchronous_flow_control_enable, 1); // SCO tracking enabled 2162729ed62eSMatthias Ringwald break; 2163f795c86eSMatthias Ringwald } 2164f795c86eSMatthias Ringwald /* fall through */ 2165f795c86eSMatthias Ringwald 2166483c5078SMatthias Ringwald case HCI_INIT_WRITE_DEFAULT_ERRONEOUS_DATA_REPORTING: 2167e4c6114dSMatthias Ringwald // skip write default erroneous data reporting if not supported 21681ffa425cSMatthias Ringwald if (hci_classic_supported() 21691ffa425cSMatthias Ringwald && hci_command_supported(SUPPORTED_HCI_COMMAND_WRITE_DEFAULT_ERRONEOUS_DATA_REPORTING)) { 2170483c5078SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_WRITE_DEFAULT_ERRONEOUS_DATA_REPORTING; 2171483c5078SMatthias Ringwald hci_send_cmd(&hci_write_default_erroneous_data_reporting, 1); 2172483c5078SMatthias Ringwald break; 2173f795c86eSMatthias Ringwald } 2174e4c6114dSMatthias Ringwald #endif 2175f795c86eSMatthias Ringwald 2176f795c86eSMatthias Ringwald #if defined(ENABLE_SCO_OVER_HCI) || defined(ENABLE_SCO_OVER_PCM) 2177521bd5ffSMatthias Ringwald /* fall through */ 2178521bd5ffSMatthias Ringwald 21798051253fSMatthias Ringwald // only sent if manufacturer is Broadcom and ENABLE_SCO_OVER_HCI or ENABLE_SCO_OVER_PCM is defined 2180a42798c3SMatthias Ringwald case HCI_INIT_BCM_WRITE_SCO_PCM_INT: 2181e4c6114dSMatthias Ringwald if (hci_classic_supported() && (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_BROADCOM_CORPORATION)){ 2182a42798c3SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_BCM_WRITE_SCO_PCM_INT; 21838051253fSMatthias Ringwald #ifdef ENABLE_SCO_OVER_HCI 2184a42798c3SMatthias Ringwald log_info("BCM: Route SCO data via HCI transport"); 2185a42798c3SMatthias Ringwald hci_send_cmd(&hci_bcm_write_sco_pcm_int, 1, 0, 0, 0, 0); 21868051253fSMatthias Ringwald #endif 21878051253fSMatthias Ringwald #ifdef ENABLE_SCO_OVER_PCM 21888051253fSMatthias Ringwald log_info("BCM: Route SCO data via PCM interface"); 21891d2bbd54SMatthias Ringwald #ifdef ENABLE_BCM_PCM_WBS 2190f795c86eSMatthias Ringwald // 512 kHz bit clock for 2 channels x 16 bit x 16 kHz 21911d2bbd54SMatthias Ringwald hci_send_cmd(&hci_bcm_write_sco_pcm_int, 0, 2, 0, 1, 1); 21921d2bbd54SMatthias Ringwald #else 21931d2bbd54SMatthias Ringwald // 256 kHz bit clock for 2 channels x 16 bit x 8 kHz 21941d2bbd54SMatthias Ringwald hci_send_cmd(&hci_bcm_write_sco_pcm_int, 0, 1, 0, 1, 1); 21951d2bbd54SMatthias Ringwald #endif 21968051253fSMatthias Ringwald #endif 2197a42798c3SMatthias Ringwald break; 2198f795c86eSMatthias Ringwald } 2199f795c86eSMatthias Ringwald #endif 2200f795c86eSMatthias Ringwald 22014e821764SMatthias Ringwald #ifdef ENABLE_SCO_OVER_PCM 2202521bd5ffSMatthias Ringwald /* fall through */ 2203521bd5ffSMatthias Ringwald 22044e821764SMatthias Ringwald case HCI_INIT_BCM_WRITE_I2SPCM_INTERFACE_PARAM: 2205e4c6114dSMatthias Ringwald if (hci_classic_supported() && (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_BROADCOM_CORPORATION)){ 22064e821764SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_BCM_WRITE_I2SPCM_INTERFACE_PARAM; 22074e821764SMatthias Ringwald log_info("BCM: Config PCM interface for I2S"); 22081d2bbd54SMatthias Ringwald #ifdef ENABLE_BCM_PCM_WBS 22091d2bbd54SMatthias Ringwald // 512 kHz bit clock for 2 channels x 16 bit x 8 kHz 22101d2bbd54SMatthias Ringwald hci_send_cmd(&hci_bcm_write_i2spcm_interface_param, 1, 1, 0, 2); 22111d2bbd54SMatthias Ringwald #else 22121d2bbd54SMatthias Ringwald // 256 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, 1); 22141d2bbd54SMatthias Ringwald #endif 22154e821764SMatthias Ringwald break; 2216f795c86eSMatthias Ringwald } 22171be678e9SMatthias Ringwald case HCI_INIT_BCM_WRITE_PCM_DATA_FORMAT_PARAM: 22181be678e9SMatthias Ringwald if (hci_classic_supported() && (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_BROADCOM_CORPORATION)){ 22191be678e9SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_BCM_WRITE_PCM_DATA_FORMAT_PARAM; 22201be678e9SMatthias Ringwald log_info("BCM: Config PCM Data format"); 22211be678e9SMatthias Ringwald // msb first, fill bits 0, left justified 22221be678e9SMatthias Ringwald hci_send_cmd(&hci_bcm_write_pcm_data_format_param, 0, 0, 3, 3, 0); 22231be678e9SMatthias Ringwald break; 22241be678e9SMatthias Ringwald } 2225dd1f98b4SMatthias Ringwald #ifdef HAVE_BCM_PCM2 2226dd1f98b4SMatthias Ringwald case HCI_INIT_BCM_PCM2_SETUP: 2227dd1f98b4SMatthias Ringwald if (hci_classic_supported() && (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_BROADCOM_CORPORATION)) { 2228dd1f98b4SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_BCM_PCM2_SETUP; 2229dd1f98b4SMatthias Ringwald uint8_t op_mode = 0; // Op_Mode = 0 = PCM, 1 = I2S 2230dd1f98b4SMatthias Ringwald uint32_t pcm_clock_freq; 2231dd1f98b4SMatthias Ringwald uint8_t ch_0_period; 2232dd1f98b4SMatthias Ringwald #ifdef ENABLE_BCM_PCM_WBS 2233dd1f98b4SMatthias Ringwald // 512 kHz, resample 8 kHz to 16 khz 2234dd1f98b4SMatthias Ringwald pcm_clock_freq = 512000; 2235dd1f98b4SMatthias Ringwald ch_0_period = 1; 2236dd1f98b4SMatthias Ringwald #else 2237dd1f98b4SMatthias Ringwald // 256 khz, 8 khz output 2238dd1f98b4SMatthias Ringwald pcm_clock_freq = 256000; 2239dd1f98b4SMatthias Ringwald ch_0_period = 0; 224035454696SMatthias Ringwald #endif 2241dd1f98b4SMatthias Ringwald log_info("BCM: Config PCM2 - op mode %u, pcm clock %" PRIu32 ", ch0_period %u", op_mode, pcm_clock_freq, ch_0_period); 2242dd1f98b4SMatthias Ringwald hci_send_cmd(&hci_bcm_pcm2_setup, 2243dd1f98b4SMatthias Ringwald 0x00, // Action = Write 2244dd1f98b4SMatthias Ringwald 0x00, // Test_Options = None 2245dd1f98b4SMatthias Ringwald op_mode, // Op_Mode 2246dd1f98b4SMatthias Ringwald 0x1D, // Sync_and_Clock_Options Sync = Signal | Sync Output Enable | Generate PCM_CLK | Tristate When Idle 2247dd1f98b4SMatthias Ringwald pcm_clock_freq, // PCM_Clock_Freq 2248dd1f98b4SMatthias Ringwald 0x01, // Sync_Signal_Width 2249dd1f98b4SMatthias Ringwald 0x0F, // Slot_Width 2250dd1f98b4SMatthias Ringwald 0x01, // NumberOfSlots 2251dd1f98b4SMatthias Ringwald 0x00, // Bank_0_Fill_Mode = 0s 2252dd1f98b4SMatthias Ringwald 0x00, // Bank_0_Number_of_Fill_Bits 2253dd1f98b4SMatthias Ringwald 0x00, // Bank_0_Programmable_Fill_Data 2254dd1f98b4SMatthias Ringwald 0x00, // Bank_1_Fill_Mode = 0s 2255dd1f98b4SMatthias Ringwald 0x00, // Bank_1_Number_of_Fill_Bits 2256dd1f98b4SMatthias Ringwald 0x00, // Bank_1_Programmable_Fill_Data 2257dd1f98b4SMatthias Ringwald 0x00, // Data_Justify_And_Bit_Order_Options = Left Justify 2258dd1f98b4SMatthias Ringwald 0x00, // Ch_0_Slot_Number 2259dd1f98b4SMatthias Ringwald 0x01, // Ch_1_Slot_Number 2260dd1f98b4SMatthias Ringwald 0x02, // Ch_2_Slot_Number 2261dd1f98b4SMatthias Ringwald 0x03, // Ch_3_Slot_Number 2262dd1f98b4SMatthias Ringwald 0x04, // Ch_4_Slot_Number 2263dd1f98b4SMatthias Ringwald ch_0_period, // Ch_0_Period 2264dd1f98b4SMatthias Ringwald 0x00, // Ch_1_Period 2265dd1f98b4SMatthias Ringwald 0x00 // Ch_2_Period 2266dd1f98b4SMatthias Ringwald ); 2267dd1f98b4SMatthias Ringwald break; 2268dd1f98b4SMatthias Ringwald } 22694e821764SMatthias Ringwald #endif 2270dd1f98b4SMatthias Ringwald #endif /* ENABLE_SCO_OVER_PCM */ 2271dd1f98b4SMatthias Ringwald #endif /* ENABLE_CLASSIC */ 22724e821764SMatthias Ringwald 2273a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE 2274521bd5ffSMatthias Ringwald /* fall through */ 2275521bd5ffSMatthias Ringwald 227674b323a9SMatthias Ringwald // LE INIT 227774b323a9SMatthias Ringwald case HCI_INIT_LE_READ_BUFFER_SIZE: 2278f795c86eSMatthias Ringwald if (hci_le_supported()){ 227974b323a9SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_LE_READ_BUFFER_SIZE; 228079b7ea2dSMatthias Ringwald if (hci_command_supported(SUPPORTED_HCI_COMMAND_LE_READ_BUFFER_SIZE_V2)){ 228179b7ea2dSMatthias Ringwald hci_send_cmd(&hci_le_read_buffer_size_v2); 228279b7ea2dSMatthias Ringwald } else { 22830305bdeaSMatthias Ringwald hci_send_cmd(&hci_le_read_buffer_size); 228479b7ea2dSMatthias Ringwald } 228574b323a9SMatthias Ringwald break; 2286f795c86eSMatthias Ringwald } 2287521bd5ffSMatthias Ringwald 2288f795c86eSMatthias Ringwald /* fall through */ 2289f795c86eSMatthias Ringwald 2290699a5fcaSMatthias Ringwald case HCI_INIT_WRITE_LE_HOST_SUPPORTED: 2291699a5fcaSMatthias Ringwald // skip write le host if not supported (e.g. on LE only EM9301) 22921ffa425cSMatthias Ringwald if (hci_le_supported() 22931ffa425cSMatthias Ringwald && hci_command_supported(SUPPORTED_HCI_COMMAND_WRITE_LE_HOST_SUPPORTED)) { 2294699a5fcaSMatthias Ringwald // LE Supported Host = 1, Simultaneous Host = 0 2295699a5fcaSMatthias Ringwald hci_stack->substate = HCI_INIT_W4_WRITE_LE_HOST_SUPPORTED; 2296699a5fcaSMatthias Ringwald hci_send_cmd(&hci_write_le_host_supported, 1, 0); 2297daabb8b8SMatthias Ringwald break; 2298f795c86eSMatthias Ringwald } 2299521bd5ffSMatthias Ringwald 2300f795c86eSMatthias Ringwald /* fall through */ 2301f795c86eSMatthias Ringwald 2302699a5fcaSMatthias Ringwald case HCI_INIT_LE_SET_EVENT_MASK: 2303f795c86eSMatthias Ringwald if (hci_le_supported()){ 2304699a5fcaSMatthias Ringwald hci_stack->substate = HCI_INIT_W4_LE_SET_EVENT_MASK; 23055d6688b0SMatthias Ringwald #ifdef ENABLE_LE_ENHANCED_CONNECTION_COMPLETE_EVENT 2306920a6ac5SMatthias Ringwald hci_send_cmd(&hci_le_set_event_mask, 0xffffffff, 0x0107); // all events from core v5.3 23075d6688b0SMatthias Ringwald #else 2308920a6ac5SMatthias Ringwald hci_send_cmd(&hci_le_set_event_mask, 0xfffffdff, 0x0007); // all events from core v5.3 without LE Enhanced Connection Complete 23095d6688b0SMatthias Ringwald #endif 231074b323a9SMatthias Ringwald break; 2311f795c86eSMatthias Ringwald } 2312b435e062SMatthias Ringwald #endif 2313b435e062SMatthias Ringwald 2314b435e062SMatthias Ringwald #ifdef ENABLE_LE_DATA_LENGTH_EXTENSION 2315521bd5ffSMatthias Ringwald /* fall through */ 2316521bd5ffSMatthias Ringwald 2317dcd678baSMatthias Ringwald case HCI_INIT_LE_READ_MAX_DATA_LENGTH: 23181ffa425cSMatthias Ringwald if (hci_le_supported() 23191ffa425cSMatthias Ringwald && hci_command_supported(SUPPORTED_HCI_COMMAND_LE_READ_MAXIMUM_DATA_LENGTH)) { 2320dcd678baSMatthias Ringwald hci_stack->substate = HCI_INIT_W4_LE_READ_MAX_DATA_LENGTH; 2321dcd678baSMatthias Ringwald hci_send_cmd(&hci_le_read_maximum_data_length); 2322dcd678baSMatthias Ringwald break; 2323f795c86eSMatthias Ringwald } 2324521bd5ffSMatthias Ringwald 2325f795c86eSMatthias Ringwald /* fall through */ 2326f795c86eSMatthias Ringwald 2327dcd678baSMatthias Ringwald case HCI_INIT_LE_WRITE_SUGGESTED_DATA_LENGTH: 23281ffa425cSMatthias Ringwald if (hci_le_supported() 23291ffa425cSMatthias Ringwald && hci_command_supported(SUPPORTED_HCI_COMMAND_LE_WRITE_SUGGESTED_DEFAULT_DATA_LENGTH)) { 2330dcd678baSMatthias Ringwald hci_stack->substate = HCI_INIT_W4_LE_WRITE_SUGGESTED_DATA_LENGTH; 2331b435e062SMatthias 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); 2332dcd678baSMatthias Ringwald break; 2333f795c86eSMatthias Ringwald } 2334b435e062SMatthias Ringwald #endif 2335b435e062SMatthias Ringwald 2336b95a5a35SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 2337521bd5ffSMatthias Ringwald /* fall through */ 2338521bd5ffSMatthias Ringwald 23393b6d4121SMatthias Ringwald case HCI_INIT_READ_WHITE_LIST_SIZE: 2340f795c86eSMatthias Ringwald if (hci_le_supported()){ 23413b6d4121SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_READ_WHITE_LIST_SIZE; 23423b6d4121SMatthias Ringwald hci_send_cmd(&hci_le_read_white_list_size); 23433b6d4121SMatthias Ringwald break; 2344f795c86eSMatthias Ringwald } 2345521bd5ffSMatthias Ringwald 234674b323a9SMatthias Ringwald #endif 23474f982f31SMatthias Ringwald 23483a74541eSMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 23493a74541eSMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 23503a74541eSMatthias Ringwald /* fall through */ 23513a74541eSMatthias Ringwald 23523a74541eSMatthias Ringwald case HCI_INIT_LE_READ_MAX_ADV_DATA_LEN: 235322f987e4SMatthias Ringwald if (hci_le_extended_advertising_supported()){ 23543a74541eSMatthias Ringwald hci_stack->substate = HCI_INIT_W4_LE_READ_MAX_ADV_DATA_LEN; 23553a74541eSMatthias Ringwald hci_send_cmd(&hci_le_read_maximum_advertising_data_length); 23563a74541eSMatthias Ringwald break; 23573a74541eSMatthias Ringwald } 23583a74541eSMatthias Ringwald #endif 23593a74541eSMatthias Ringwald #endif 2360521bd5ffSMatthias Ringwald 2361c63ee49aSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS 236236916f81SDirk Helbig /* fall through */ 236336916f81SDirk Helbig 2364c63ee49aSMatthias Ringwald case HCI_INIT_LE_SET_HOST_FEATURE_CONNECTED_ISO_STREAMS: 2365c63ee49aSMatthias Ringwald if (hci_le_supported()) { 2366c63ee49aSMatthias Ringwald hci_stack->substate = HCI_INIT_W4_LE_SET_HOST_FEATURE_CONNECTED_ISO_STREAMS; 2367c63ee49aSMatthias Ringwald hci_send_cmd(&hci_le_set_host_feature, 32, 1); 2368c63ee49aSMatthias Ringwald break; 2369c63ee49aSMatthias Ringwald } 2370c63ee49aSMatthias Ringwald #endif 2371c63ee49aSMatthias Ringwald 2372f266fcb1SMatthias Ringwald #ifdef ENABLE_BLE 2373f266fcb1SMatthias Ringwald /* fall through */ 2374f266fcb1SMatthias Ringwald case HCI_INIT_LE_SET_HOST_FEATURE_CONNECTION_SUBRATING: 2375f266fcb1SMatthias Ringwald if (hci_le_supported()) { 2376f266fcb1SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_LE_SET_HOST_FEATURE_CONNECTION_SUBRATING; 2377f266fcb1SMatthias Ringwald hci_send_cmd(&hci_le_set_host_feature, 38, 1); 2378f266fcb1SMatthias Ringwald break; 2379f266fcb1SMatthias Ringwald } 2380f266fcb1SMatthias Ringwald #endif 2381c63ee49aSMatthias Ringwald /* fall through */ 2382c63ee49aSMatthias Ringwald 2383f795c86eSMatthias Ringwald case HCI_INIT_DONE: 23844f982f31SMatthias Ringwald hci_stack->substate = HCI_INIT_DONE; 238573799937SMatthias Ringwald // main init sequence complete 23864f982f31SMatthias Ringwald #ifdef ENABLE_CLASSIC 238773799937SMatthias Ringwald // check if initial Classic GAP Tasks are completed 2388baa4881eSMatthias Ringwald if (hci_classic_supported() && (hci_stack->gap_tasks_classic != 0)) { 23894f982f31SMatthias Ringwald hci_run_gap_tasks_classic(); 23904f982f31SMatthias Ringwald break; 23914f982f31SMatthias Ringwald } 23924f982f31SMatthias Ringwald #endif 239373799937SMatthias Ringwald #ifdef ENABLE_BLE 239473799937SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 239573799937SMatthias Ringwald // check if initial LE GAP Tasks are completed 239673799937SMatthias Ringwald if (hci_le_supported() && hci_stack->le_scanning_param_update) { 239773799937SMatthias Ringwald hci_run_general_gap_le(); 239873799937SMatthias Ringwald break; 239973799937SMatthias Ringwald } 240073799937SMatthias Ringwald #endif 240173799937SMatthias Ringwald #endif 2402f795c86eSMatthias Ringwald hci_init_done(); 2403f795c86eSMatthias Ringwald break; 2404f795c86eSMatthias Ringwald 240574b323a9SMatthias Ringwald default: 240674b323a9SMatthias Ringwald return; 240774b323a9SMatthias Ringwald } 240855975f88SMatthias Ringwald } 240955975f88SMatthias Ringwald 241007fd2f31SMatthias Ringwald static bool hci_initializing_event_handler_command_completed(const uint8_t * packet){ 241107fd2f31SMatthias Ringwald bool command_completed = false; 24120e2df43fSMatthias Ringwald if (hci_event_packet_get_type(packet) == HCI_EVENT_COMMAND_COMPLETE){ 2413f8fbdce0SMatthias Ringwald uint16_t opcode = little_endian_read_16(packet,3); 24146155b3d3S[email protected] if (opcode == hci_stack->last_cmd_opcode){ 241507fd2f31SMatthias Ringwald command_completed = true; 2416148ca237SMatthias Ringwald log_debug("Command complete for expected opcode %04x at substate %u", opcode, hci_stack->substate); 24176155b3d3S[email protected] } else { 2418d58dd308SMatthias Ringwald log_info("Command complete for different opcode %04x, expected %04x, at substate %u", opcode, hci_stack->last_cmd_opcode, hci_stack->substate); 24196155b3d3S[email protected] } 24206155b3d3S[email protected] } 24210f97eae7SMatthias Ringwald 24220e2df43fSMatthias Ringwald if (hci_event_packet_get_type(packet) == HCI_EVENT_COMMAND_STATUS){ 24236155b3d3S[email protected] uint8_t status = packet[2]; 2424f8fbdce0SMatthias Ringwald uint16_t opcode = little_endian_read_16(packet,4); 24256155b3d3S[email protected] if (opcode == hci_stack->last_cmd_opcode){ 24266155b3d3S[email protected] if (status){ 242707fd2f31SMatthias Ringwald command_completed = true; 2428148ca237SMatthias Ringwald log_debug("Command status error 0x%02x for expected opcode %04x at substate %u", status, opcode, hci_stack->substate); 24296155b3d3S[email protected] } else { 24306155b3d3S[email protected] log_info("Command status OK for expected opcode %04x, waiting for command complete", opcode); 24316155b3d3S[email protected] } 24326155b3d3S[email protected] } else { 2433148ca237SMatthias Ringwald log_debug("Command status for opcode %04x, expected %04x", opcode, hci_stack->last_cmd_opcode); 24346155b3d3S[email protected] } 24356155b3d3S[email protected] } 24366fad2c37SMatthias Ringwald #ifndef HAVE_HOST_CONTROLLER_API 2437e47e68c7SMatthias Ringwald // Vendor == CSR 24380e588213SMatthias Ringwald if ((hci_stack->substate == HCI_INIT_W4_CUSTOM_INIT) && (hci_event_packet_get_type(packet) == HCI_EVENT_VENDOR_SPECIFIC)){ 2439e47e68c7SMatthias Ringwald // TODO: track actual command 244007fd2f31SMatthias Ringwald command_completed = true; 2441e47e68c7SMatthias Ringwald } 2442a2481739S[email protected] 24434e9daa6fSMatthias Ringwald // Vendor == Toshiba 24440e588213SMatthias Ringwald if ((hci_stack->substate == HCI_INIT_W4_SEND_BAUD_CHANGE) && (hci_event_packet_get_type(packet) == HCI_EVENT_VENDOR_SPECIFIC)){ 24454e9daa6fSMatthias Ringwald // TODO: track actual command 244607fd2f31SMatthias Ringwald command_completed = true; 2447004902f1SMatthias Ringwald // Fix: no HCI Command Complete received, so num_cmd_packets not reset 2448004902f1SMatthias Ringwald hci_stack->num_cmd_packets = 1; 24494e9daa6fSMatthias Ringwald } 245007fd2f31SMatthias Ringwald #endif 245107fd2f31SMatthias Ringwald 245207fd2f31SMatthias Ringwald return command_completed; 245307fd2f31SMatthias Ringwald } 245407fd2f31SMatthias Ringwald 245507fd2f31SMatthias Ringwald static void hci_initializing_event_handler(const uint8_t * packet, uint16_t size){ 245607fd2f31SMatthias Ringwald 245707fd2f31SMatthias Ringwald UNUSED(size); // ok: less than 6 bytes are read from our buffer 245807fd2f31SMatthias Ringwald 245907fd2f31SMatthias Ringwald bool command_completed = hci_initializing_event_handler_command_completed(packet); 246007fd2f31SMatthias Ringwald 24616fad2c37SMatthias Ringwald #ifndef HAVE_HOST_CONTROLLER_API 24624e9daa6fSMatthias Ringwald 24630f97eae7SMatthias Ringwald // Late response (> 100 ms) for HCI Reset e.g. on Toshiba TC35661: 24640f97eae7SMatthias Ringwald // Command complete for HCI Reset arrives after we've resent the HCI Reset command 24650f97eae7SMatthias Ringwald // 24660f97eae7SMatthias Ringwald // HCI Reset 24670f97eae7SMatthias Ringwald // Timeout 100 ms 24680f97eae7SMatthias Ringwald // HCI Reset 24690f97eae7SMatthias Ringwald // Command Complete Reset 24700f97eae7SMatthias Ringwald // HCI Read Local Version Information 24710f97eae7SMatthias Ringwald // Command Complete Reset - but we expected Command Complete Read Local Version Information 24720f97eae7SMatthias Ringwald // hang... 24730f97eae7SMatthias Ringwald // 24740f97eae7SMatthias Ringwald // Fix: Command Complete for HCI Reset in HCI_INIT_W4_SEND_READ_LOCAL_VERSION_INFORMATION trigger resend 24750f97eae7SMatthias Ringwald if (!command_completed 2476a1df452eSMatthias Ringwald && (hci_event_packet_get_type(packet) == HCI_EVENT_COMMAND_COMPLETE) 24770e588213SMatthias Ringwald && (hci_stack->substate == HCI_INIT_W4_SEND_READ_LOCAL_VERSION_INFORMATION)){ 24780f97eae7SMatthias Ringwald 2479f8fbdce0SMatthias Ringwald uint16_t opcode = little_endian_read_16(packet,3); 24800f97eae7SMatthias Ringwald if (opcode == hci_reset.opcode){ 24810f97eae7SMatthias Ringwald hci_stack->substate = HCI_INIT_SEND_READ_LOCAL_VERSION_INFORMATION; 24820f97eae7SMatthias Ringwald return; 24830f97eae7SMatthias Ringwald } 24840f97eae7SMatthias Ringwald } 24850f97eae7SMatthias Ringwald 24869f007422SMatthias Ringwald // CSR & H5 24879f007422SMatthias Ringwald // Fix: Command Complete for HCI Reset in HCI_INIT_W4_SEND_READ_LOCAL_VERSION_INFORMATION trigger resend 24889f007422SMatthias Ringwald if (!command_completed 2489a1df452eSMatthias Ringwald && (hci_event_packet_get_type(packet) == HCI_EVENT_COMMAND_COMPLETE) 24900e588213SMatthias Ringwald && (hci_stack->substate == HCI_INIT_W4_READ_LOCAL_SUPPORTED_COMMANDS)){ 24919f007422SMatthias Ringwald 24929f007422SMatthias Ringwald uint16_t opcode = little_endian_read_16(packet,3); 24939f007422SMatthias Ringwald if (opcode == hci_reset.opcode){ 24949f007422SMatthias Ringwald hci_stack->substate = HCI_INIT_READ_LOCAL_SUPPORTED_COMMANDS; 24959f007422SMatthias Ringwald return; 24969f007422SMatthias Ringwald } 24979f007422SMatthias Ringwald } 24989f007422SMatthias Ringwald 24999f007422SMatthias 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 25009f007422SMatthias Ringwald // fix: Correct substate and behave as command below 25019f007422SMatthias Ringwald if (command_completed){ 25029f007422SMatthias Ringwald switch (hci_stack->substate){ 25039f007422SMatthias Ringwald case HCI_INIT_SEND_RESET: 25049f007422SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_SEND_RESET; 25059f007422SMatthias Ringwald break; 25069f007422SMatthias Ringwald case HCI_INIT_SEND_RESET_CSR_WARM_BOOT: 25079f007422SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_CUSTOM_INIT_CSR_WARM_BOOT; 25089f007422SMatthias Ringwald break; 25099f007422SMatthias Ringwald default: 25109f007422SMatthias Ringwald break; 25119f007422SMatthias Ringwald } 25129f007422SMatthias Ringwald } 25130f97eae7SMatthias Ringwald 251406b9e820SMatthias Ringwald #endif 25150f97eae7SMatthias Ringwald 2516a2481739S[email protected] if (!command_completed) return; 2517a2481739S[email protected] 251807fd2f31SMatthias Ringwald bool need_baud_change = false; 251907fd2f31SMatthias Ringwald bool need_addr_change = false; 252006b9e820SMatthias Ringwald 25216fad2c37SMatthias Ringwald #ifndef HAVE_HOST_CONTROLLER_API 252206b9e820SMatthias Ringwald need_baud_change = hci_stack->config 25233fb36a29SMatthias Ringwald && hci_stack->chipset 25243fb36a29SMatthias Ringwald && hci_stack->chipset->set_baudrate_command 2525db8bc6ffSMatthias Ringwald && hci_stack->hci_transport->set_baudrate 25269796ebeaSMatthias Ringwald && ((hci_transport_config_uart_t *)hci_stack->config)->baudrate_main; 2527db8bc6ffSMatthias Ringwald 252806b9e820SMatthias Ringwald need_addr_change = hci_stack->custom_bd_addr_set 25293fb36a29SMatthias Ringwald && hci_stack->chipset 25303fb36a29SMatthias Ringwald && hci_stack->chipset->set_bd_addr_command; 253106b9e820SMatthias Ringwald #endif 2532a80162e9SMatthias Ringwald 25335c363727SMatthias Ringwald switch(hci_stack->substate){ 253406b9e820SMatthias Ringwald 25356fad2c37SMatthias Ringwald #ifndef HAVE_HOST_CONTROLLER_API 25369f007422SMatthias Ringwald case HCI_INIT_SEND_RESET: 2537d58dd308SMatthias Ringwald // on CSR with BCSP/H5, resend triggers resend of HCI Reset and leads to substate == HCI_INIT_SEND_RESET 25389f007422SMatthias Ringwald // fix: just correct substate and behave as command below 2539f4c579d4SMatthias Ringwald 2540f4c579d4SMatthias Ringwald /* fall through */ 2541f4c579d4SMatthias Ringwald #endif 2542f4c579d4SMatthias Ringwald 254374b323a9SMatthias Ringwald case HCI_INIT_W4_SEND_RESET: 2544528a4a3bSMatthias Ringwald btstack_run_loop_remove_timer(&hci_stack->timeout); 2545f4c579d4SMatthias Ringwald hci_stack->substate = HCI_INIT_SEND_READ_LOCAL_VERSION_INFORMATION; 25462f48d920SMatthias Ringwald return; 2547f4c579d4SMatthias Ringwald 2548f4c579d4SMatthias Ringwald #ifndef HAVE_HOST_CONTROLLER_API 2549a80162e9SMatthias Ringwald case HCI_INIT_W4_SEND_BAUD_CHANGE: 25504696bddbSMatthias Ringwald // for STLC2500D, baud rate change already happened. 2551fab26ab3SMatthias Ringwald // for others, baud rate gets changed now 255261f37892SMatthias Ringwald if ((hci_stack->manufacturer != BLUETOOTH_COMPANY_ID_ST_MICROELECTRONICS) && need_baud_change){ 255396b53536SMatthias Ringwald uint32_t baud_rate = hci_transport_uart_get_main_baud_rate(); 2554cd724cb7SMatthias Ringwald log_info("Local baud rate change to %" PRIu32 "(w4_send_baud_change)", baud_rate); 2555fab26ab3SMatthias Ringwald hci_stack->hci_transport->set_baudrate(baud_rate); 25564696bddbSMatthias Ringwald } 255774b323a9SMatthias Ringwald hci_stack->substate = HCI_INIT_CUSTOM_INIT; 255874b323a9SMatthias Ringwald return; 2559a80162e9SMatthias Ringwald case HCI_INIT_W4_CUSTOM_INIT_CSR_WARM_BOOT: 2560528a4a3bSMatthias Ringwald btstack_run_loop_remove_timer(&hci_stack->timeout); 2561a80162e9SMatthias Ringwald hci_stack->substate = HCI_INIT_CUSTOM_INIT; 2562a80162e9SMatthias Ringwald return; 256374b323a9SMatthias Ringwald case HCI_INIT_W4_CUSTOM_INIT: 256474b323a9SMatthias Ringwald // repeat custom init 256574b323a9SMatthias Ringwald hci_stack->substate = HCI_INIT_CUSTOM_INIT; 256674b323a9SMatthias Ringwald return; 25676fe16221SMatthias Ringwald case HCI_INIT_W4_CUSTOM_PRE_INIT: 25686fe16221SMatthias Ringwald // repeat custom init 25696fe16221SMatthias Ringwald hci_stack->substate = HCI_INIT_CUSTOM_PRE_INIT; 25706fe16221SMatthias Ringwald return; 257106b9e820SMatthias Ringwald #endif 257206b9e820SMatthias Ringwald 2573a828a756SMatthias Ringwald case HCI_INIT_W4_READ_LOCAL_SUPPORTED_COMMANDS: 25740e588213SMatthias Ringwald if (need_baud_change && (hci_stack->chipset_result != BTSTACK_CHIPSET_NO_INIT_SCRIPT) && 2575efd3b327SMatthias Ringwald ((hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_BROADCOM_CORPORATION) || 2576efd3b327SMatthias Ringwald (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_EM_MICROELECTRONIC_MARIN_SA))) { 2577eb3a5314SMatthias Ringwald hci_stack->substate = HCI_INIT_SEND_BAUD_CHANGE_BCM; 2578eb3a5314SMatthias Ringwald return; 2579eb3a5314SMatthias Ringwald } 258053860077SMatthias Ringwald if (need_addr_change){ 258153860077SMatthias Ringwald hci_stack->substate = HCI_INIT_SET_BD_ADDR; 258253860077SMatthias Ringwald return; 258353860077SMatthias Ringwald } 258453860077SMatthias Ringwald hci_stack->substate = HCI_INIT_READ_BD_ADDR; 258553860077SMatthias Ringwald return; 25866fad2c37SMatthias Ringwald #ifndef HAVE_HOST_CONTROLLER_API 25877224be7eSMatthias Ringwald case HCI_INIT_W4_SEND_BAUD_CHANGE_BCM: 25887224be7eSMatthias Ringwald if (need_baud_change){ 258996b53536SMatthias Ringwald uint32_t baud_rate = hci_transport_uart_get_main_baud_rate(); 2590cd724cb7SMatthias Ringwald log_info("Local baud rate change to %" PRIu32 "(w4_send_baud_change_bcm))", baud_rate); 2591fab26ab3SMatthias Ringwald hci_stack->hci_transport->set_baudrate(baud_rate); 25927224be7eSMatthias Ringwald } 2593eb3a5314SMatthias Ringwald if (need_addr_change){ 2594eb3a5314SMatthias Ringwald hci_stack->substate = HCI_INIT_SET_BD_ADDR; 2595eb3a5314SMatthias Ringwald return; 2596eb3a5314SMatthias Ringwald } 2597eb3a5314SMatthias Ringwald hci_stack->substate = HCI_INIT_READ_BD_ADDR; 2598eb3a5314SMatthias Ringwald return; 259953860077SMatthias Ringwald case HCI_INIT_W4_SET_BD_ADDR: 26006ca9a99aSMatthias Ringwald // for STLC2500D + ATWILC3000, bd addr change only gets active after sending reset command 26016ca9a99aSMatthias Ringwald if ((hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_ST_MICROELECTRONICS) 26026ca9a99aSMatthias Ringwald || (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_ATMEL_CORPORATION)){ 260353860077SMatthias Ringwald hci_stack->substate = HCI_INIT_SEND_RESET_ST_WARM_BOOT; 260453860077SMatthias Ringwald return; 260553860077SMatthias Ringwald } 260653860077SMatthias Ringwald // skipping st warm boot 260753860077SMatthias Ringwald hci_stack->substate = HCI_INIT_READ_BD_ADDR; 260853860077SMatthias Ringwald return; 260953860077SMatthias Ringwald case HCI_INIT_W4_SEND_RESET_ST_WARM_BOOT: 261053860077SMatthias Ringwald hci_stack->substate = HCI_INIT_READ_BD_ADDR; 261153860077SMatthias Ringwald return; 261206b9e820SMatthias Ringwald #endif 2613e7c662faSMatthias Ringwald 2614f795c86eSMatthias Ringwald case HCI_INIT_DONE: 2615eb8d95caSMatthias Ringwald // set state if we came here by fall through 2616eb8d95caSMatthias Ringwald hci_stack->substate = HCI_INIT_DONE; 2617f795c86eSMatthias Ringwald return; 2618a650ba4dSMatthias Ringwald 26196155b3d3S[email protected] default: 262074b323a9SMatthias Ringwald break; 26216155b3d3S[email protected] } 262255975f88SMatthias Ringwald hci_initializing_next_state(); 26236155b3d3S[email protected] } 26246155b3d3S[email protected] 26250bbba85bSMatthias Ringwald static void hci_handle_connection_failed(hci_connection_t * conn, uint8_t status){ 26263bb5ff27SMatthias Ringwald // CC2564C might emit Connection Complete for rejected incoming SCO connection 2627a086dc35SMatthias Ringwald // To prevent accidentally freeing the HCI connection for the ACL connection, 26281a4fdac4SMatthias Ringwald // check if we have been aware of the HCI connection 26291f34df2cSMatthias Ringwald switch (conn->state){ 26301a4fdac4SMatthias Ringwald case SENT_CREATE_CONNECTION: 26311f34df2cSMatthias Ringwald case RECEIVED_CONNECTION_REQUEST: 26329071873aSMatthias Ringwald case ACCEPTED_CONNECTION_REQUEST: 26331f34df2cSMatthias Ringwald break; 26341f34df2cSMatthias Ringwald default: 26351f34df2cSMatthias Ringwald return; 26361f34df2cSMatthias Ringwald } 26373bb5ff27SMatthias Ringwald 2638229331c6SMatthias Ringwald log_info("Outgoing connection to %s failed", bd_addr_to_str(conn->address)); 26390bbba85bSMatthias Ringwald bd_addr_t bd_address; 26406535961aSMatthias Ringwald (void)memcpy(&bd_address, conn->address, 6); 26410bbba85bSMatthias Ringwald 26426bc9fa5eSMatthias Ringwald #ifdef ENABLE_CLASSIC 26436bc9fa5eSMatthias Ringwald // cache needed data 26446bc9fa5eSMatthias Ringwald int notify_dedicated_bonding_failed = conn->bonding_flags & BONDING_DEDICATED; 26456bc9fa5eSMatthias Ringwald #endif 26466bc9fa5eSMatthias Ringwald 26470bbba85bSMatthias Ringwald // connection failed, remove entry 26480bbba85bSMatthias Ringwald btstack_linked_list_remove(&hci_stack->connections, (btstack_linked_item_t *) conn); 26490bbba85bSMatthias Ringwald btstack_memory_hci_connection_free( conn ); 26500bbba85bSMatthias Ringwald 26516bc9fa5eSMatthias Ringwald #ifdef ENABLE_CLASSIC 26520bbba85bSMatthias Ringwald // notify client if dedicated bonding 26530bbba85bSMatthias Ringwald if (notify_dedicated_bonding_failed){ 26540bbba85bSMatthias Ringwald log_info("hci notify_dedicated_bonding_failed"); 26550bbba85bSMatthias Ringwald hci_emit_dedicated_bonding_result(bd_address, status); 26560bbba85bSMatthias Ringwald } 26570bbba85bSMatthias Ringwald 26580bbba85bSMatthias Ringwald // if authentication error, also delete link key 26590bbba85bSMatthias Ringwald if (status == ERROR_CODE_AUTHENTICATION_FAILURE) { 26600bbba85bSMatthias Ringwald gap_drop_link_key_for_bd_addr(bd_address); 26610bbba85bSMatthias Ringwald } 26621c79b5e3SMatthias Ringwald #else 26631c79b5e3SMatthias Ringwald UNUSED(status); 26646bc9fa5eSMatthias Ringwald #endif 26650bbba85bSMatthias Ringwald } 26660bbba85bSMatthias Ringwald 2667be500194SMatthias Ringwald #ifdef ENABLE_CLASSIC 26682f5c44baSMatthias Ringwald static void hci_handle_remote_features_page_0(hci_connection_t * conn, const uint8_t * features){ 26692f5c44baSMatthias Ringwald // SSP Controller 26702f5c44baSMatthias Ringwald if (features[6] & (1 << 3)){ 26712f5c44baSMatthias Ringwald conn->bonding_flags |= BONDING_REMOTE_SUPPORTS_SSP_CONTROLLER; 26722f5c44baSMatthias Ringwald } 26732f5c44baSMatthias Ringwald // eSCO 26742f5c44baSMatthias Ringwald if (features[3] & (1<<7)){ 26752f5c44baSMatthias Ringwald conn->remote_supported_features[0] |= 1; 26762f5c44baSMatthias Ringwald } 26772f5c44baSMatthias Ringwald // Extended features 26782f5c44baSMatthias Ringwald if (features[7] & (1<<7)){ 26792f5c44baSMatthias Ringwald conn->remote_supported_features[0] |= 2; 26802f5c44baSMatthias Ringwald } 26810b78a447SMatthias Ringwald // SCO packet types 26820b78a447SMatthias Ringwald conn->remote_supported_sco_packets = hci_sco_packet_types_for_features(features); 26832f5c44baSMatthias Ringwald } 26842f5c44baSMatthias Ringwald 26852f5c44baSMatthias Ringwald static void hci_handle_remote_features_page_1(hci_connection_t * conn, const uint8_t * features){ 26862f5c44baSMatthias Ringwald // SSP Host 26872f5c44baSMatthias Ringwald if (features[0] & (1 << 0)){ 26882f5c44baSMatthias Ringwald conn->bonding_flags |= BONDING_REMOTE_SUPPORTS_SSP_HOST; 26892f5c44baSMatthias Ringwald } 269050c51a77SMatthias Ringwald // SC Host 269150c51a77SMatthias Ringwald if (features[0] & (1 << 3)){ 269250c51a77SMatthias Ringwald conn->bonding_flags |= BONDING_REMOTE_SUPPORTS_SC_HOST; 269350c51a77SMatthias Ringwald } 269450c51a77SMatthias Ringwald } 269550c51a77SMatthias Ringwald 269650c51a77SMatthias Ringwald static void hci_handle_remote_features_page_2(hci_connection_t * conn, const uint8_t * features){ 269750c51a77SMatthias Ringwald // SC Controller 269850c51a77SMatthias Ringwald if (features[1] & (1 << 0)){ 269950c51a77SMatthias Ringwald conn->bonding_flags |= BONDING_REMOTE_SUPPORTS_SC_CONTROLLER; 270050c51a77SMatthias Ringwald } 27012f5c44baSMatthias Ringwald } 27022f5c44baSMatthias Ringwald 2703de0df013SMatthias Ringwald static void hci_handle_remote_features_received(hci_connection_t * conn){ 2704461a2bc4SMatthias Ringwald conn->bonding_flags &= ~BONDING_REMOTE_FEATURES_QUERY_ACTIVE; 2705de0df013SMatthias Ringwald conn->bonding_flags |= BONDING_RECEIVED_REMOTE_FEATURES; 2706cb7b3e6fSMatthias Ringwald log_info("Remote features %02x, bonding flags %" PRIx32, conn->remote_supported_features[0], conn->bonding_flags); 2707de0df013SMatthias Ringwald if (conn->bonding_flags & BONDING_DEDICATED){ 2708de0df013SMatthias Ringwald conn->bonding_flags |= BONDING_SEND_AUTHENTICATE_REQUEST; 2709de0df013SMatthias Ringwald } 2710de0df013SMatthias Ringwald } 2711128825c3SMatthias Ringwald static bool hci_remote_sc_enabled(hci_connection_t * connection){ 2712128825c3SMatthias Ringwald const uint16_t sc_enabled_mask = BONDING_REMOTE_SUPPORTS_SC_HOST | BONDING_REMOTE_SUPPORTS_SC_CONTROLLER; 2713128825c3SMatthias Ringwald return (connection->bonding_flags & sc_enabled_mask) == sc_enabled_mask; 2714128825c3SMatthias Ringwald } 2715128825c3SMatthias Ringwald 2716be500194SMatthias Ringwald #endif 2717de0df013SMatthias Ringwald 271867c6c9dcSMatthias Ringwald static void handle_event_for_current_stack_state(const uint8_t * packet, uint16_t size) { 271967c6c9dcSMatthias Ringwald // handle BT initialization 272067c6c9dcSMatthias Ringwald if (hci_stack->state == HCI_STATE_INITIALIZING) { 272167c6c9dcSMatthias Ringwald hci_initializing_event_handler(packet, size); 272267c6c9dcSMatthias Ringwald } 272367c6c9dcSMatthias Ringwald 272467c6c9dcSMatthias Ringwald // help with BT sleep 272567c6c9dcSMatthias Ringwald if ((hci_stack->state == HCI_STATE_FALLING_ASLEEP) 272667c6c9dcSMatthias Ringwald && (hci_stack->substate == HCI_FALLING_ASLEEP_W4_WRITE_SCAN_ENABLE) 272772a2585aSMatthias Ringwald && (hci_event_packet_get_type(packet) == HCI_EVENT_COMMAND_COMPLETE) 272872a2585aSMatthias Ringwald && (hci_event_command_complete_get_command_opcode(packet) == HCI_OPCODE_HCI_WRITE_SCAN_ENABLE)){ 272967c6c9dcSMatthias Ringwald hci_initializing_next_state(); 273067c6c9dcSMatthias Ringwald } 273167c6c9dcSMatthias Ringwald } 273267c6c9dcSMatthias Ringwald 27339866fdc7SMatthias Ringwald #ifdef ENABLE_CLASSIC 27344aa2f135SMatthias Ringwald static void hci_handle_mutual_authentication_completed(hci_connection_t * conn){ 27354aa2f135SMatthias Ringwald // bonding complete if connection is authenticated (either initiated or BR/EDR SC) 27364aa2f135SMatthias Ringwald conn->requested_security_level = LEVEL_0; 27374aa2f135SMatthias Ringwald gap_security_level_t security_level = gap_security_level_for_connection(conn); 27384aa2f135SMatthias Ringwald hci_emit_security_level(conn->con_handle, security_level); 27394aa2f135SMatthias Ringwald 274067718330SMatthias Ringwald // dedicated bonding 2741de9f0299SMatthias Ringwald if ((conn->bonding_flags & BONDING_DEDICATED) != 0){ 2742de9f0299SMatthias Ringwald conn->bonding_flags &= ~BONDING_DEDICATED; 2743de9f0299SMatthias Ringwald conn->bonding_status = security_level == 0 ? ERROR_CODE_INSUFFICIENT_SECURITY : ERROR_CODE_SUCCESS; 2744db3c1f89SMatthias Ringwald #ifdef ENABLE_EXPLICIT_DEDICATED_BONDING_DISCONNECT 2745db3c1f89SMatthias Ringwald // emit dedicated bonding complete, don't disconnect 2746db3c1f89SMatthias Ringwald hci_emit_dedicated_bonding_result(conn->address, conn->bonding_status); 2747db3c1f89SMatthias Ringwald #else 2748db3c1f89SMatthias Ringwald // request disconnect, event is emitted after disconnect 2749db3c1f89SMatthias Ringwald conn->bonding_flags |= BONDING_DISCONNECT_DEDICATED_DONE; 2750db3c1f89SMatthias Ringwald #endif 2751de9f0299SMatthias Ringwald } 275267718330SMatthias Ringwald } 2753abdad579SMatthias Ringwald 275467718330SMatthias Ringwald static void hci_handle_read_encryption_key_size_complete(hci_connection_t * conn, uint8_t encryption_key_size) { 275567718330SMatthias Ringwald conn->authentication_flags |= AUTH_FLAG_CONNECTION_ENCRYPTED; 275667718330SMatthias Ringwald conn->encryption_key_size = encryption_key_size; 275767718330SMatthias Ringwald 275867718330SMatthias Ringwald // mutual authentication complete if authenticated and we have retrieved the encryption key size 27598daf94bcSMatthias Ringwald if ((conn->authentication_flags & AUTH_FLAG_CONNECTION_AUTHENTICATED) != 0) { 27604aa2f135SMatthias Ringwald hci_handle_mutual_authentication_completed(conn); 27614cd03f8aSMatthias Ringwald } else { 27624cd03f8aSMatthias Ringwald // otherwise trigger remote feature request and send authentication request 2763dbe0d85cSMatthias Ringwald hci_trigger_remote_features_for_connection(conn); 27644cd03f8aSMatthias Ringwald if ((conn->bonding_flags & BONDING_SENT_AUTHENTICATE_REQUEST) == 0) { 2765abdad579SMatthias Ringwald conn->bonding_flags |= BONDING_SEND_AUTHENTICATE_REQUEST; 27669866fdc7SMatthias Ringwald } 27674cd03f8aSMatthias Ringwald } 27684cd03f8aSMatthias Ringwald } 27699866fdc7SMatthias Ringwald #endif 27709866fdc7SMatthias Ringwald 27713b631737SMatthias Ringwald static void hci_store_local_supported_commands(const uint8_t * packet){ 277225e46151SMatthias Ringwald // create mapping table 277325e46151SMatthias Ringwald #define X(name, offset, bit) { offset, bit }, 277425e46151SMatthias Ringwald static struct { 277525e46151SMatthias Ringwald uint8_t byte_offset; 277625e46151SMatthias Ringwald uint8_t bit_position; 277725e46151SMatthias Ringwald } supported_hci_commands_map [] = { 277825e46151SMatthias Ringwald SUPPORTED_HCI_COMMANDS 277925e46151SMatthias Ringwald }; 278025e46151SMatthias Ringwald #undef X 278125e46151SMatthias Ringwald 278225e46151SMatthias Ringwald // create names for debug purposes 278325e46151SMatthias Ringwald #ifdef ENABLE_LOG_DEBUG 278425e46151SMatthias Ringwald #define X(name, offset, bit) #name, 278525e46151SMatthias Ringwald static const char * command_names[] = { 278625e46151SMatthias Ringwald SUPPORTED_HCI_COMMANDS 278725e46151SMatthias Ringwald }; 278825e46151SMatthias Ringwald #undef X 278925e46151SMatthias Ringwald #endif 279025e46151SMatthias Ringwald 27911ffa425cSMatthias Ringwald hci_stack->local_supported_commands = 0; 279225e46151SMatthias Ringwald const uint8_t * commands_map = &packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1]; 279325e46151SMatthias Ringwald uint16_t i; 279425e46151SMatthias Ringwald for (i = 0 ; i < SUPPORTED_HCI_COMMANDS_COUNT ; i++){ 279525e46151SMatthias Ringwald if ((commands_map[supported_hci_commands_map[i].byte_offset] & (1 << supported_hci_commands_map[i].bit_position)) != 0){ 279625e46151SMatthias Ringwald #ifdef ENABLE_LOG_DEBUG 2797345352acSMatthias Ringwald log_debug("Command %s (%u) supported %u/%u", command_names[i], i, supported_hci_commands_map[i].byte_offset, supported_hci_commands_map[i].bit_position); 279825e46151SMatthias Ringwald #else 27991ffa425cSMatthias Ringwald log_info("Command 0x%02x supported %u/%u", i, supported_hci_commands_map[i].byte_offset, supported_hci_commands_map[i].bit_position); 280025e46151SMatthias Ringwald #endif 28011ffa425cSMatthias Ringwald hci_stack->local_supported_commands |= (1LU << i); 280225e46151SMatthias Ringwald } 280325e46151SMatthias Ringwald } 2804cb7b3e6fSMatthias Ringwald log_info("Local supported commands summary %08" PRIx32, hci_stack->local_supported_commands); 28053b631737SMatthias Ringwald } 28063b631737SMatthias Ringwald 28074f781026SMatthias Ringwald static void handle_command_complete_event(uint8_t * packet, uint16_t size){ 2808b08371a9SMilanka Ringwald UNUSED(size); 2809e76a89eeS[email protected] 28104781fa78SDirk Helbig uint8_t status = 0; 28114781fa78SDirk Helbig if( size > OFFSET_OF_DATA_IN_COMMAND_COMPLETE ) { 28124781fa78SDirk Helbig status = hci_event_command_complete_get_return_parameters(packet)[0]; 28134781fa78SDirk Helbig } 28149cbd2215SMatthias Ringwald uint16_t manufacturer; 28159cbd2215SMatthias Ringwald #ifdef ENABLE_CLASSIC 28161f7b95a1Smatthias.ringwald hci_connection_t * conn; 2817c7a108afSMatthias Ringwald #endif 281836916f81SDirk Helbig #if defined(ENABLE_CLASSIC) 28194781fa78SDirk Helbig hci_con_handle_t handle; 28209cbd2215SMatthias Ringwald #endif 2821d3a89d91SMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS 2822d3a89d91SMatthias Ringwald le_audio_cig_t * cig; 2823d3a89d91SMatthias Ringwald #endif 282491036612SMatthias Ringwald #if defined(ENABLE_BLE) && defined(ENABLE_HCI_COMMAND_STATUS_DISCARDED_FOR_FAILED_CONNECTIONS_WORKAROUND) 2825f48a5586SMatthias Ringwald hci_stack->hci_command_con_handle = HCI_CON_HANDLE_INVALID; 2826f48a5586SMatthias Ringwald #endif 2827d3a89d91SMatthias Ringwald 28286bef4003SMatthias Ringwald // get num cmd packets - limit to 1 to reduce complexity 28296bef4003SMatthias Ringwald hci_stack->num_cmd_packets = packet[2] ? 1 : 0; 28307ec5eeaaSmatthias.ringwald 2831645b7c25SMatthias Ringwald uint16_t opcode = hci_event_command_complete_get_command_opcode(packet); 2832645b7c25SMatthias Ringwald switch (opcode){ 2833645b7c25SMatthias Ringwald case HCI_OPCODE_HCI_READ_LOCAL_NAME: 28344781fa78SDirk Helbig if (status) break; 28359e263bd7SMatthias Ringwald // terminate, name 248 chars 28369e263bd7SMatthias Ringwald packet[6+248] = 0; 28379e263bd7SMatthias Ringwald log_info("local name: %s", &packet[6]); 2838645b7c25SMatthias Ringwald break; 2839645b7c25SMatthias Ringwald case HCI_OPCODE_HCI_READ_BUFFER_SIZE: 28401d279b20Smatthias.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" 2841c3b46f5aSMatthias Ringwald if (hci_stack->state == HCI_STATE_INITIALIZING) { 2842429122ccSMatthias Ringwald uint16_t acl_len = little_endian_read_16(packet, 6); 2843429122ccSMatthias Ringwald uint16_t sco_len = packet[8]; 2844429122ccSMatthias Ringwald 2845429122ccSMatthias Ringwald // determine usable ACL/SCO payload size 2846429122ccSMatthias Ringwald hci_stack->acl_data_packet_length = btstack_min(acl_len, HCI_ACL_PAYLOAD_SIZE); 2847429122ccSMatthias Ringwald hci_stack->sco_data_packet_length = btstack_min(sco_len, HCI_ACL_PAYLOAD_SIZE); 2848429122ccSMatthias Ringwald 2849616cfd90SMatthias Ringwald hci_stack->acl_packets_total_num = (uint8_t) btstack_min(little_endian_read_16(packet, 9), MAX_NR_CONTROLLER_ACL_BUFFERS); 2850616cfd90SMatthias Ringwald hci_stack->sco_packets_total_num = (uint8_t) btstack_min(little_endian_read_16(packet, 11), MAX_NR_CONTROLLER_SCO_PACKETS); 2851a8b12447S[email protected] 2852429122ccSMatthias Ringwald log_info("hci_read_buffer_size: ACL size module %u -> used %u, count %u / SCO size %u, count %u", 2853429122ccSMatthias Ringwald acl_len, hci_stack->acl_data_packet_length, hci_stack->acl_packets_total_num, 28541a06f663S[email protected] hci_stack->sco_data_packet_length, hci_stack->sco_packets_total_num); 2855c3b46f5aSMatthias Ringwald } 2856645b7c25SMatthias Ringwald break; 2857645b7c25SMatthias Ringwald case HCI_OPCODE_HCI_READ_RSSI: 28584781fa78SDirk Helbig if (status == ERROR_CODE_SUCCESS){ 2859891b9fc2SMatthias Ringwald uint8_t event[5]; 2860891b9fc2SMatthias Ringwald event[0] = GAP_EVENT_RSSI_MEASUREMENT; 2861891b9fc2SMatthias Ringwald event[1] = 3; 28626535961aSMatthias Ringwald (void)memcpy(&event[2], &packet[6], 3); 28639da9850bSMatthias Ringwald hci_emit_btstack_event(event, sizeof(event), 1); 2864891b9fc2SMatthias Ringwald } 2865645b7c25SMatthias Ringwald break; 2866a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE 286779b7ea2dSMatthias Ringwald case HCI_OPCODE_HCI_LE_READ_BUFFER_SIZE_V2: 286879b7ea2dSMatthias Ringwald hci_stack->le_iso_packets_length = little_endian_read_16(packet, 9); 286979b7ea2dSMatthias Ringwald hci_stack->le_iso_packets_total_num = packet[11]; 287079b7ea2dSMatthias Ringwald log_info("hci_le_read_buffer_size_v2: iso size %u, iso count %u", 287179b7ea2dSMatthias Ringwald hci_stack->le_iso_packets_length, hci_stack->le_iso_packets_total_num); 287279b7ea2dSMatthias Ringwald 287379b7ea2dSMatthias Ringwald /* fall through */ 287479b7ea2dSMatthias Ringwald 2875645b7c25SMatthias Ringwald case HCI_OPCODE_HCI_LE_READ_BUFFER_SIZE: 2876f8fbdce0SMatthias Ringwald hci_stack->le_data_packets_length = little_endian_read_16(packet, 6); 2877ee303eddS[email protected] hci_stack->le_acl_packets_total_num = packet[8]; 28786c26b087S[email protected] // determine usable ACL payload size 28796c26b087S[email protected] if (HCI_ACL_PAYLOAD_SIZE < hci_stack->le_data_packets_length){ 28806c26b087S[email protected] hci_stack->le_data_packets_length = HCI_ACL_PAYLOAD_SIZE; 28816c26b087S[email protected] } 288279b7ea2dSMatthias 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); 2883645b7c25SMatthias Ringwald break; 2884b435e062SMatthias Ringwald #endif 2885b435e062SMatthias Ringwald #ifdef ENABLE_LE_DATA_LENGTH_EXTENSION 2886645b7c25SMatthias Ringwald case HCI_OPCODE_HCI_LE_READ_MAXIMUM_DATA_LENGTH: 2887dcd678baSMatthias Ringwald hci_stack->le_supported_max_tx_octets = little_endian_read_16(packet, 6); 2888dcd678baSMatthias Ringwald hci_stack->le_supported_max_tx_time = little_endian_read_16(packet, 8); 2889dcd678baSMatthias 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); 2890645b7c25SMatthias Ringwald break; 2891b435e062SMatthias Ringwald #endif 2892d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 2893645b7c25SMatthias Ringwald case HCI_OPCODE_HCI_LE_READ_WHITE_LIST_SIZE: 2894e691bb38SMatthias Ringwald hci_stack->le_whitelist_capacity = packet[6]; 289515d0a15bSMatthias Ringwald log_info("hci_le_read_white_list_size: size %u", hci_stack->le_whitelist_capacity); 2896645b7c25SMatthias Ringwald break; 289765a46ef3S[email protected] #endif 28983a74541eSMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 28993a74541eSMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 29003a74541eSMatthias Ringwald case HCI_OPCODE_HCI_LE_READ_MAXIMUM_ADVERTISING_DATA_LENGTH: 29013a74541eSMatthias Ringwald hci_stack->le_maximum_advertising_data_length = little_endian_read_16(packet, 6); 29023a74541eSMatthias Ringwald break; 290325df6c61SMatthias Ringwald case HCI_OPCODE_HCI_LE_SET_EXTENDED_ADVERTISING_PARAMETERS: 290425df6c61SMatthias Ringwald if (hci_stack->le_advertising_set_in_current_command != 0) { 290525df6c61SMatthias Ringwald le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(hci_stack->le_advertising_set_in_current_command); 290625df6c61SMatthias Ringwald hci_stack->le_advertising_set_in_current_command = 0; 290725df6c61SMatthias Ringwald if (advertising_set == NULL) break; 290825df6c61SMatthias Ringwald uint8_t adv_status = packet[6]; 290925df6c61SMatthias Ringwald uint8_t tx_power = packet[7]; 291025df6c61SMatthias 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 }; 291125df6c61SMatthias Ringwald if (adv_status == 0){ 291225df6c61SMatthias Ringwald advertising_set->state |= LE_ADVERTISEMENT_STATE_PARAMS_SET; 291325df6c61SMatthias Ringwald } 29149da9850bSMatthias Ringwald hci_emit_btstack_event(event, sizeof(event), 1); 291525df6c61SMatthias Ringwald } 291625df6c61SMatthias Ringwald break; 291725df6c61SMatthias Ringwald case HCI_OPCODE_HCI_LE_REMOVE_ADVERTISING_SET: 291825df6c61SMatthias Ringwald if (hci_stack->le_advertising_set_in_current_command != 0) { 291925df6c61SMatthias Ringwald le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(hci_stack->le_advertising_set_in_current_command); 292025df6c61SMatthias Ringwald hci_stack->le_advertising_set_in_current_command = 0; 292125df6c61SMatthias Ringwald if (advertising_set == NULL) break; 29224781fa78SDirk Helbig uint8_t event[] = { HCI_EVENT_META_GAP, 3, GAP_SUBEVENT_ADVERTISING_SET_REMOVED, hci_stack->le_advertising_set_in_current_command, status }; 29234781fa78SDirk Helbig if (status == 0){ 292425df6c61SMatthias Ringwald btstack_linked_list_remove(&hci_stack->le_advertising_sets, (btstack_linked_item_t *) advertising_set); 292525df6c61SMatthias Ringwald } 29269da9850bSMatthias Ringwald hci_emit_btstack_event(event, sizeof(event), 1); 292725df6c61SMatthias Ringwald } 292825df6c61SMatthias Ringwald break; 29293a74541eSMatthias Ringwald #endif 29303a74541eSMatthias Ringwald #endif 2931645b7c25SMatthias Ringwald case HCI_OPCODE_HCI_READ_BD_ADDR: 2932645b7c25SMatthias Ringwald reverse_bd_addr(&packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE + 1], hci_stack->local_bd_addr); 29334781fa78SDirk Helbig log_info("Local Address, Status: 0x%02x: Addr: %s", status, bd_addr_to_str(hci_stack->local_bd_addr)); 293433373e40SMatthias Ringwald #ifdef ENABLE_CLASSIC 29351624665aSMatthias Ringwald if (hci_stack->link_key_db){ 29361624665aSMatthias Ringwald hci_stack->link_key_db->set_local_bd_addr(hci_stack->local_bd_addr); 29371624665aSMatthias Ringwald } 293833373e40SMatthias Ringwald #endif 2939645b7c25SMatthias Ringwald break; 294035454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 2941645b7c25SMatthias Ringwald case HCI_OPCODE_HCI_WRITE_SCAN_ENABLE: 294271fd255dSMatthias Ringwald hci_emit_scan_mode_changed(hci_stack->discoverable, hci_stack->connectable); 2943645b7c25SMatthias Ringwald break; 29443d1f2d24SMatthias Ringwald case HCI_OPCODE_HCI_PERIODIC_INQUIRY_MODE: 29453d1f2d24SMatthias Ringwald if (status == ERROR_CODE_SUCCESS) { 29463d1f2d24SMatthias Ringwald hci_stack->inquiry_state = GAP_INQUIRY_STATE_PERIODIC; 29473d1f2d24SMatthias Ringwald } else { 29483d1f2d24SMatthias Ringwald hci_stack->inquiry_state = GAP_INQUIRY_STATE_IDLE; 29493d1f2d24SMatthias Ringwald } 29503d1f2d24SMatthias Ringwald break; 2951645b7c25SMatthias Ringwald case HCI_OPCODE_HCI_INQUIRY_CANCEL: 295230199e24SMatthias Ringwald case HCI_OPCODE_HCI_EXIT_PERIODIC_INQUIRY_MODE: 2953f5875de5SMatthias Ringwald if (hci_stack->inquiry_state == GAP_INQUIRY_STATE_W4_CANCELLED){ 2954f5875de5SMatthias Ringwald hci_stack->inquiry_state = GAP_INQUIRY_STATE_IDLE; 2955f5875de5SMatthias Ringwald uint8_t event[] = { GAP_EVENT_INQUIRY_COMPLETE, 1, 0}; 29569da9850bSMatthias Ringwald hci_emit_btstack_event(event, sizeof(event), 1); 2957f5875de5SMatthias Ringwald } 2958645b7c25SMatthias Ringwald break; 295935454696SMatthias Ringwald #endif 2960645b7c25SMatthias Ringwald case HCI_OPCODE_HCI_READ_LOCAL_SUPPORTED_FEATURES: 29614f781026SMatthias Ringwald (void)memcpy(hci_stack->local_supported_features, &packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE + 1], 8); 296265389bfcS[email protected] 296335454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 2964a5a23fc2S[email protected] // determine usable ACL packet types based on host buffer size and supported features 296529e39de4SMatthias 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]); 2966c92ca2c8SMatthias Ringwald log_info("ACL Packet types %04x", hci_stack->usable_packet_types_acl); 2967c92ca2c8SMatthias Ringwald // determine usable SCO packet types based on supported features 2968c92ca2c8SMatthias Ringwald hci_stack->usable_packet_types_sco = hci_sco_packet_types_for_features( 2969c92ca2c8SMatthias Ringwald &hci_stack->local_supported_features[0]); 2970c92ca2c8SMatthias Ringwald log_info("SCO Packet types %04x - eSCO %u", hci_stack->usable_packet_types_sco, hci_extended_sco_link_supported()); 297135454696SMatthias Ringwald #endif 2972f5d8d141S[email protected] // Classic/LE 2973f5d8d141S[email protected] log_info("BR/EDR support %u, LE support %u", hci_classic_supported(), hci_le_supported()); 2974645b7c25SMatthias Ringwald break; 2975645b7c25SMatthias Ringwald case HCI_OPCODE_HCI_READ_LOCAL_VERSION_INFORMATION: 2976645b7c25SMatthias Ringwald manufacturer = little_endian_read_16(packet, 10); 2977547a29a6SMatthias Ringwald // map Cypress & Infineon to Broadcom 2978547a29a6SMatthias Ringwald switch (manufacturer){ 2979547a29a6SMatthias Ringwald case BLUETOOTH_COMPANY_ID_CYPRESS_SEMICONDUCTOR: 2980547a29a6SMatthias Ringwald case BLUETOOTH_COMPANY_ID_INFINEON_TECHNOLOGIES_AG: 2981547a29a6SMatthias Ringwald log_info("Treat Cypress/Infineon as Broadcom"); 2982c21d89f3SMatthias Ringwald manufacturer = BLUETOOTH_COMPANY_ID_BROADCOM_CORPORATION; 2983c21d89f3SMatthias Ringwald little_endian_store_16(packet, 10, manufacturer); 2984547a29a6SMatthias Ringwald break; 2985547a29a6SMatthias Ringwald default: 2986547a29a6SMatthias Ringwald break; 2987c21d89f3SMatthias Ringwald } 2988c21d89f3SMatthias Ringwald hci_stack->manufacturer = manufacturer; 29894696bddbSMatthias Ringwald log_info("Manufacturer: 0x%04x", hci_stack->manufacturer); 2990645b7c25SMatthias Ringwald break; 2991645b7c25SMatthias Ringwald case HCI_OPCODE_HCI_READ_LOCAL_SUPPORTED_COMMANDS: 29923b631737SMatthias Ringwald hci_store_local_supported_commands(packet); 2993645b7c25SMatthias Ringwald break; 2994e8c8828eSMatthias Ringwald #ifdef ENABLE_CLASSIC 2995645b7c25SMatthias Ringwald case HCI_OPCODE_HCI_WRITE_SYNCHRONOUS_FLOW_CONTROL_ENABLE: 29964781fa78SDirk Helbig if (status) return; 29975b9b590fSMatthias Ringwald hci_stack->synchronous_flow_control_enabled = 1; 2998645b7c25SMatthias Ringwald break; 2999645b7c25SMatthias Ringwald case HCI_OPCODE_HCI_READ_ENCRYPTION_KEY_SIZE: 3000573897a0SMatthias Ringwald handle = little_endian_read_16(packet, OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1); 3001573897a0SMatthias Ringwald conn = hci_connection_for_handle(handle); 3002c3b46f5aSMatthias Ringwald if (conn != NULL) { 30039866fdc7SMatthias Ringwald uint8_t key_size = 0; 3004573897a0SMatthias Ringwald if (status == 0){ 30059866fdc7SMatthias Ringwald key_size = packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+3]; 30064a659b0eSMatthias Ringwald log_info("Handle %04x key Size: %u", handle, key_size); 3007170fafaeSMatthias Ringwald } else { 3008e9f98c4aSMatthias Ringwald key_size = 1; 30099866fdc7SMatthias Ringwald log_info("Read Encryption Key Size failed 0x%02x-> assuming insecure connection with key size of 1", status); 3010573897a0SMatthias Ringwald } 30119866fdc7SMatthias Ringwald hci_handle_read_encryption_key_size_complete(conn, key_size); 3012c3b46f5aSMatthias Ringwald } 3013645b7c25SMatthias Ringwald break; 3014cc15bb2cSMatthias Ringwald // assert pairing complete event is emitted. 3015cc15bb2cSMatthias Ringwald // note: for SSP, Simple Pairing Complete Event is sufficient, but we want to be more robust 3016cc15bb2cSMatthias Ringwald case HCI_OPCODE_HCI_PIN_CODE_REQUEST_NEGATIVE_REPLY: 3017cc15bb2cSMatthias Ringwald case HCI_OPCODE_HCI_USER_PASSKEY_REQUEST_NEGATIVE_REPLY: 3018cc15bb2cSMatthias Ringwald case HCI_OPCODE_HCI_USER_CONFIRMATION_REQUEST_NEGATIVE_REPLY: 30198cc1507eSMatthias Ringwald hci_stack->gap_pairing_state = GAP_PAIRING_STATE_IDLE; 3020cc15bb2cSMatthias Ringwald // lookup connection by gap pairing addr 3021cc15bb2cSMatthias Ringwald conn = hci_connection_for_bd_addr_and_type(hci_stack->gap_pairing_addr, BD_ADDR_TYPE_ACL); 3022cc15bb2cSMatthias Ringwald if (conn == NULL) break; 3023cc15bb2cSMatthias Ringwald hci_pairing_complete(conn, ERROR_CODE_AUTHENTICATION_FAILURE); 3024cc15bb2cSMatthias Ringwald break; 3025cc15bb2cSMatthias Ringwald 302675a8e4faSMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB 302775a8e4faSMatthias Ringwald case HCI_OPCODE_HCI_READ_LOCAL_OOB_DATA: 302875a8e4faSMatthias Ringwald case HCI_OPCODE_HCI_READ_LOCAL_EXTENDED_OOB_DATA:{ 302975a8e4faSMatthias Ringwald uint8_t event[67]; 303075a8e4faSMatthias Ringwald event[0] = GAP_EVENT_LOCAL_OOB_DATA; 303175a8e4faSMatthias Ringwald event[1] = 65; 303275a8e4faSMatthias Ringwald (void)memset(&event[2], 0, 65); 30334781fa78SDirk Helbig if (status == ERROR_CODE_SUCCESS){ 303475a8e4faSMatthias Ringwald (void)memcpy(&event[3], &packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1], 32); 303575a8e4faSMatthias Ringwald if (opcode == HCI_OPCODE_HCI_READ_LOCAL_EXTENDED_OOB_DATA){ 303675a8e4faSMatthias Ringwald event[2] = 3; 303775a8e4faSMatthias Ringwald (void)memcpy(&event[35], &packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+33], 32); 303875a8e4faSMatthias Ringwald } else { 303975a8e4faSMatthias Ringwald event[2] = 1; 304075a8e4faSMatthias Ringwald } 304175a8e4faSMatthias Ringwald } 30429da9850bSMatthias Ringwald hci_emit_btstack_event(event, sizeof(event), 0); 304375a8e4faSMatthias Ringwald break; 304475a8e4faSMatthias Ringwald } 30451ae74bf3SMatthias Ringwald 30461ae74bf3SMatthias Ringwald // note: only needed if user does not provide OOB data 30471ae74bf3SMatthias Ringwald case HCI_OPCODE_HCI_REMOTE_OOB_DATA_REQUEST_NEGATIVE_REPLY: 30481ae74bf3SMatthias Ringwald conn = hci_connection_for_handle(hci_stack->classic_oob_con_handle); 30491ae74bf3SMatthias Ringwald hci_stack->classic_oob_con_handle = HCI_CON_HANDLE_INVALID; 30501ae74bf3SMatthias Ringwald if (conn == NULL) break; 30511ae74bf3SMatthias Ringwald hci_pairing_complete(conn, ERROR_CODE_AUTHENTICATION_FAILURE); 30521ae74bf3SMatthias Ringwald break; 3053e8c8828eSMatthias Ringwald #endif 305475a8e4faSMatthias Ringwald #endif 30554ae8623eSMatthias Ringwald #ifdef ENABLE_BLE 30564ae8623eSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS 3057d3a89d91SMatthias Ringwald case HCI_OPCODE_HCI_LE_SET_CIG_PARAMETERS: 3058d3a89d91SMatthias Ringwald // lookup CIG 3059d3a89d91SMatthias Ringwald cig = hci_cig_for_id(hci_stack->iso_active_operation_group_id); 3060d3a89d91SMatthias Ringwald if (cig != NULL){ 3061d3a89d91SMatthias Ringwald uint8_t i = 0; 3062d3a89d91SMatthias Ringwald if (status == ERROR_CODE_SUCCESS){ 3063d3a89d91SMatthias Ringwald // assign CIS handles to pre-allocated CIS 3064d3a89d91SMatthias Ringwald btstack_linked_list_iterator_t it; 3065d3a89d91SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->iso_streams); 3066d3a89d91SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it) && (i < cig->num_cis)) { 3067d3a89d91SMatthias Ringwald hci_iso_stream_t *iso_stream = (hci_iso_stream_t *) btstack_linked_list_iterator_next(&it); 3068d3a89d91SMatthias Ringwald if ((iso_stream->group_id == hci_stack->iso_active_operation_group_id) && 3069d3a89d91SMatthias Ringwald (iso_stream->iso_type == HCI_ISO_TYPE_CIS)){ 3070d3a89d91SMatthias Ringwald hci_con_handle_t cis_handle = little_endian_read_16(packet, OFFSET_OF_DATA_IN_COMMAND_COMPLETE+3+(2*i)); 3071969d876aSMatthias Ringwald iso_stream->cis_handle = cis_handle; 3072d3a89d91SMatthias Ringwald cig->cis_con_handles[i] = cis_handle; 3073d3a89d91SMatthias Ringwald i++; 3074d3a89d91SMatthias Ringwald } 3075d3a89d91SMatthias Ringwald } 3076444e371eSMatthias Ringwald cig->state = LE_AUDIO_CIG_STATE_W4_CIS_REQUEST; 3077d3a89d91SMatthias Ringwald hci_emit_cig_created(cig, status); 3078d3a89d91SMatthias Ringwald } else { 3079d3a89d91SMatthias Ringwald hci_emit_cig_created(cig, status); 3080d3a89d91SMatthias Ringwald btstack_linked_list_remove(&hci_stack->le_audio_cigs, (btstack_linked_item_t *) cig); 3081d3a89d91SMatthias Ringwald } 3082d3a89d91SMatthias Ringwald } 308326b93350SMatthias Ringwald hci_stack->iso_active_operation_type = HCI_ISO_TYPE_INVALID; 3084d3a89d91SMatthias Ringwald break; 30854ae8623eSMatthias Ringwald case HCI_OPCODE_HCI_LE_CREATE_CIS: 30864ae8623eSMatthias Ringwald if (status != ERROR_CODE_SUCCESS){ 3087d75a6bbfSMatthias Ringwald hci_iso_stream_requested_finalize(HCI_ISO_GROUP_ID_INVALID); 30884ae8623eSMatthias Ringwald } 30894ae8623eSMatthias Ringwald break; 309042529435SMatthias Ringwald case HCI_OPCODE_HCI_LE_ACCEPT_CIS_REQUEST: 309142529435SMatthias Ringwald if (status != ERROR_CODE_SUCCESS){ 3092d75a6bbfSMatthias Ringwald hci_iso_stream_requested_finalize(HCI_ISO_GROUP_ID_INVALID); 309342529435SMatthias Ringwald } 309442529435SMatthias Ringwald break; 30957aa35f6aSMatthias Ringwald case HCI_OPCODE_HCI_LE_SETUP_ISO_DATA_PATH: { 30967aa35f6aSMatthias Ringwald // lookup BIG by state 30977aa35f6aSMatthias Ringwald btstack_linked_list_iterator_t it; 30987aa35f6aSMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->le_audio_bigs); 30997aa35f6aSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)) { 31007aa35f6aSMatthias Ringwald le_audio_big_t *big = (le_audio_big_t *) btstack_linked_list_iterator_next(&it); 31017aa35f6aSMatthias Ringwald if (big->state == LE_AUDIO_BIG_STATE_W4_SETUP_ISO_PATH){ 31027aa35f6aSMatthias Ringwald if (status == ERROR_CODE_SUCCESS){ 31037aa35f6aSMatthias Ringwald big->state_vars.next_bis++; 31047aa35f6aSMatthias Ringwald if (big->state_vars.next_bis == big->num_bis){ 31057aa35f6aSMatthias Ringwald big->state = LE_AUDIO_BIG_STATE_ACTIVE; 31067aa35f6aSMatthias Ringwald hci_emit_big_created(big, ERROR_CODE_SUCCESS); 31077aa35f6aSMatthias Ringwald } else { 31087aa35f6aSMatthias Ringwald big->state = LE_AUDIO_BIG_STATE_SETUP_ISO_PATH; 31097aa35f6aSMatthias Ringwald } 31107aa35f6aSMatthias Ringwald } else { 31117aa35f6aSMatthias Ringwald big->state = LE_AUDIO_BIG_STATE_SETUP_ISO_PATHS_FAILED; 31127aa35f6aSMatthias Ringwald big->state_vars.status = status; 31132a6c0f82SMatthias Ringwald } 31142a6c0f82SMatthias Ringwald return; 31152a6c0f82SMatthias Ringwald } 31162a6c0f82SMatthias Ringwald } 31172a6c0f82SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->le_audio_big_syncs); 31182a6c0f82SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)) { 31192a6c0f82SMatthias Ringwald le_audio_big_sync_t *big_sync = (le_audio_big_sync_t *) btstack_linked_list_iterator_next(&it); 31202a6c0f82SMatthias Ringwald if (big_sync->state == LE_AUDIO_BIG_STATE_W4_SETUP_ISO_PATH){ 31212a6c0f82SMatthias Ringwald if (status == ERROR_CODE_SUCCESS){ 31222a6c0f82SMatthias Ringwald big_sync->state_vars.next_bis++; 31232a6c0f82SMatthias Ringwald if (big_sync->state_vars.next_bis == big_sync->num_bis){ 31242a6c0f82SMatthias Ringwald big_sync->state = LE_AUDIO_BIG_STATE_ACTIVE; 31252a6c0f82SMatthias Ringwald hci_emit_big_sync_created(big_sync, ERROR_CODE_SUCCESS); 31262a6c0f82SMatthias Ringwald } else { 31272a6c0f82SMatthias Ringwald big_sync->state = LE_AUDIO_BIG_STATE_SETUP_ISO_PATH; 31282a6c0f82SMatthias Ringwald } 31292a6c0f82SMatthias Ringwald } else { 31302a6c0f82SMatthias Ringwald big_sync->state = LE_AUDIO_BIG_STATE_SETUP_ISO_PATHS_FAILED; 31312a6c0f82SMatthias Ringwald big_sync->state_vars.status = status; 31322a6c0f82SMatthias Ringwald } 31332a6c0f82SMatthias Ringwald return; 31342a6c0f82SMatthias Ringwald } 31352a6c0f82SMatthias Ringwald } 3136f9306a1aSMatthias Ringwald // Lookup CIS via active group operation 3137f9306a1aSMatthias Ringwald if (hci_stack->iso_active_operation_type == HCI_ISO_TYPE_CIS){ 313826b93350SMatthias Ringwald if (hci_stack->iso_active_operation_group_id == HCI_ISO_GROUP_ID_SINGLE_CIS){ 313926b93350SMatthias Ringwald hci_stack->iso_active_operation_type = HCI_ISO_TYPE_INVALID; 314026b93350SMatthias Ringwald 314126b93350SMatthias Ringwald // lookup CIS by state 314226b93350SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->iso_streams); 314326b93350SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 314426b93350SMatthias Ringwald hci_iso_stream_t * iso_stream = (hci_iso_stream_t *) btstack_linked_list_iterator_next(&it); 3145532211feSMatthias Ringwald bool emit_cis_created = false; 314626b93350SMatthias Ringwald switch (iso_stream->state){ 314726b93350SMatthias Ringwald case HCI_ISO_STREAM_STATE_W4_ISO_SETUP_INPUT: 314826b93350SMatthias Ringwald if (status != ERROR_CODE_SUCCESS){ 3149532211feSMatthias Ringwald emit_cis_created = true; 315026b93350SMatthias Ringwald break; 315126b93350SMatthias Ringwald } 315226b93350SMatthias Ringwald if (iso_stream->max_sdu_c_to_p > 0){ 31531418332dSMatthias Ringwald iso_stream->state = HCI_ISO_STREAM_STATE_W2_SETUP_ISO_OUTPUT; 315426b93350SMatthias Ringwald } else { 3155532211feSMatthias Ringwald emit_cis_created = true; 315626b93350SMatthias Ringwald } 315726b93350SMatthias Ringwald break; 315826b93350SMatthias Ringwald case HCI_ISO_STREAM_STATE_W4_ISO_SETUP_OUTPUT: 3159532211feSMatthias Ringwald emit_cis_created = true; 316026b93350SMatthias Ringwald break; 316126b93350SMatthias Ringwald default: 316226b93350SMatthias Ringwald break; 316326b93350SMatthias Ringwald } 3164532211feSMatthias Ringwald if (emit_cis_created){ 316514045fdbSMatthias Ringwald hci_cis_handle_created(iso_stream, status); 3166532211feSMatthias Ringwald } 316726b93350SMatthias Ringwald } 316826b93350SMatthias Ringwald } else { 3169f9306a1aSMatthias Ringwald cig = hci_cig_for_id(hci_stack->iso_active_operation_group_id); 3170532211feSMatthias Ringwald hci_stack->iso_active_operation_type = HCI_ISO_TYPE_INVALID; 3171f9306a1aSMatthias Ringwald if (cig != NULL) { 3172f9306a1aSMatthias Ringwald // emit cis created if all ISO Paths have been created 3173f9306a1aSMatthias Ringwald // assume we are central 3174f9306a1aSMatthias Ringwald uint8_t cis_index = cig->state_vars.next_cis >> 1; 3175f9306a1aSMatthias Ringwald uint8_t cis_direction = cig->state_vars.next_cis & 1; 3176f9306a1aSMatthias Ringwald bool outgoing_needed = cig->params->cis_params[cis_index].max_sdu_p_to_c > 0; 3177f9306a1aSMatthias Ringwald // if outgoing has been setup, or incoming was setup but outgoing not required 3178f9306a1aSMatthias Ringwald if ((cis_direction == 1) || (outgoing_needed == false)){ 3179532211feSMatthias Ringwald // lookup iso stream by cig/cis 3180b5ecaedbSMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->iso_streams); 3181532211feSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)) { 3182532211feSMatthias Ringwald hci_iso_stream_t *iso_stream = (hci_iso_stream_t *) btstack_linked_list_iterator_next(&it); 3183532211feSMatthias Ringwald if ((iso_stream->group_id == cig->cig_id) && (iso_stream->stream_id == cis_index)){ 318414045fdbSMatthias Ringwald hci_cis_handle_created(iso_stream, status); 3185532211feSMatthias Ringwald } 3186532211feSMatthias Ringwald } 3187f9306a1aSMatthias Ringwald } 3188f9306a1aSMatthias Ringwald // next state 3189f9306a1aSMatthias Ringwald cig->state_vars.next_cis++; 3190f9306a1aSMatthias Ringwald cig->state = LE_AUDIO_CIG_STATE_SETUP_ISO_PATH; 3191f9306a1aSMatthias Ringwald } 3192f9306a1aSMatthias Ringwald } 319326b93350SMatthias Ringwald } 31942a6c0f82SMatthias Ringwald break; 31952a6c0f82SMatthias Ringwald } 31962a6c0f82SMatthias Ringwald case HCI_OPCODE_HCI_LE_BIG_TERMINATE_SYNC: { 31972a6c0f82SMatthias Ringwald // lookup BIG by state 31982a6c0f82SMatthias Ringwald btstack_linked_list_iterator_t it; 31992a6c0f82SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->le_audio_big_syncs); 32002a6c0f82SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)) { 32012a6c0f82SMatthias Ringwald le_audio_big_sync_t *big_sync = (le_audio_big_sync_t *) btstack_linked_list_iterator_next(&it); 3202d04a9afcSMatthias Ringwald uint8_t big_handle = big_sync->big_handle; 32032a6c0f82SMatthias Ringwald switch (big_sync->state){ 32042a6c0f82SMatthias Ringwald case LE_AUDIO_BIG_STATE_W4_TERMINATED_AFTER_SETUP_FAILED: 3205d04a9afcSMatthias Ringwald btstack_linked_list_iterator_remove(&it); 32062a6c0f82SMatthias Ringwald hci_emit_big_sync_created(big_sync, big_sync->state_vars.status); 3207d04a9afcSMatthias Ringwald return; 32082a6c0f82SMatthias Ringwald default: 3209d04a9afcSMatthias Ringwald btstack_linked_list_iterator_remove(&it); 3210d04a9afcSMatthias Ringwald hci_emit_big_sync_stopped(big_handle); 32117aa35f6aSMatthias Ringwald return; 32127aa35f6aSMatthias Ringwald } 32137aa35f6aSMatthias Ringwald } 32147aa35f6aSMatthias Ringwald break; 32157aa35f6aSMatthias Ringwald } 32164ae8623eSMatthias Ringwald #endif 32174ae8623eSMatthias Ringwald #endif 32186f35bb46SMatthias Ringwald default: 32196f35bb46SMatthias Ringwald break; 32204f781026SMatthias Ringwald } 3221645b7c25SMatthias Ringwald } 32224f781026SMatthias Ringwald 3223d8905293SMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS 3224d8905293SMatthias Ringwald static void 3225d8905293SMatthias Ringwald hci_iso_create_big_failed(const le_audio_big_t *big, uint8_t status) { 3226d8905293SMatthias Ringwald hci_iso_stream_finalize_by_type_and_group_id(HCI_ISO_TYPE_BIS, big->big_handle); 3227d8905293SMatthias Ringwald btstack_linked_list_remove(&hci_stack->le_audio_bigs, (btstack_linked_item_t *) big); 3228d8905293SMatthias Ringwald if (big->state == LE_AUDIO_BIG_STATE_W4_ESTABLISHED){ 3229d8905293SMatthias Ringwald hci_emit_big_created(big, status); 3230d8905293SMatthias Ringwald } else { 3231d8905293SMatthias Ringwald hci_emit_big_terminated(big); 3232d8905293SMatthias Ringwald } 3233d8905293SMatthias Ringwald } 3234d8905293SMatthias Ringwald 3235d8905293SMatthias Ringwald static void hci_iso_big_sync_failed(const le_audio_big_sync_t *big_sync, uint8_t status) { 3236d8905293SMatthias Ringwald btstack_linked_list_remove(&hci_stack->le_audio_big_syncs, (btstack_linked_item_t *) big_sync); 3237d8905293SMatthias Ringwald if (big_sync->state == LE_AUDIO_BIG_STATE_W4_ESTABLISHED) { 3238d8905293SMatthias Ringwald hci_emit_big_sync_created(big_sync, status); 3239d8905293SMatthias Ringwald } else { 3240d8905293SMatthias Ringwald hci_emit_big_sync_stopped(big_sync->big_handle); 3241d8905293SMatthias Ringwald } 3242d8905293SMatthias Ringwald } 3243d8905293SMatthias Ringwald #endif 3244d8905293SMatthias Ringwald 3245afbf1cd7SMatthias Ringwald static void handle_command_status_event(uint8_t * packet, uint16_t size) { 3246afbf1cd7SMatthias Ringwald UNUSED(size); 3247afbf1cd7SMatthias Ringwald 3248afbf1cd7SMatthias Ringwald // get num cmd packets - limit to 1 to reduce complexity 3249afbf1cd7SMatthias Ringwald hci_stack->num_cmd_packets = packet[3] ? 1 : 0; 3250afbf1cd7SMatthias Ringwald 3251c70df5f8SMatthias Ringwald // get opcode and command status 3252c70df5f8SMatthias Ringwald uint16_t opcode = hci_event_command_status_get_command_opcode(packet); 3253c70df5f8SMatthias Ringwald 3254c70df5f8SMatthias Ringwald #if defined(ENABLE_CLASSIC) || defined(ENABLE_LE_CENTRAL) || defined(ENABLE_LE_ISOCHRONOUS_STREAMS) 3255c70df5f8SMatthias Ringwald uint8_t status = hci_event_command_status_get_status(packet); 3256c70df5f8SMatthias Ringwald #endif 3257c70df5f8SMatthias Ringwald 3258c70df5f8SMatthias Ringwald #if defined(ENABLE_CLASSIC) || defined(ENABLE_LE_CENTRAL) 3259c70df5f8SMatthias Ringwald bd_addr_type_t addr_type; 326073bccf35Slouislee91 bd_addr_t addr; 3261c70df5f8SMatthias Ringwald #endif 3262c70df5f8SMatthias Ringwald 326391036612SMatthias Ringwald #if defined(ENABLE_BLE) && defined (ENABLE_HCI_COMMAND_STATUS_DISCARDED_FOR_FAILED_CONNECTIONS_WORKAROUND) 3264f48a5586SMatthias Ringwald hci_stack->hci_command_con_handle = HCI_CON_HANDLE_INVALID; 3265f48a5586SMatthias Ringwald #endif 3266f48a5586SMatthias Ringwald 3267c70df5f8SMatthias Ringwald switch (opcode){ 3268afbf1cd7SMatthias Ringwald #ifdef ENABLE_CLASSIC 3269c70df5f8SMatthias Ringwald case HCI_OPCODE_HCI_CREATE_CONNECTION: 32709071873aSMatthias Ringwald case HCI_OPCODE_HCI_SETUP_SYNCHRONOUS_CONNECTION: 3271c70df5f8SMatthias Ringwald case HCI_OPCODE_HCI_ACCEPT_SYNCHRONOUS_CONNECTION: 3272afbf1cd7SMatthias Ringwald #endif 3273afbf1cd7SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 3274c70df5f8SMatthias Ringwald case HCI_OPCODE_HCI_LE_CREATE_CONNECTION: 3275afbf1cd7SMatthias Ringwald #endif 3276c70df5f8SMatthias Ringwald #if defined(ENABLE_CLASSIC) || defined(ENABLE_LE_CENTRAL) 3277afbf1cd7SMatthias Ringwald addr_type = hci_stack->outgoing_addr_type; 327873bccf35Slouislee91 memcpy(addr, hci_stack->outgoing_addr, 6); 3279afbf1cd7SMatthias Ringwald 3280afbf1cd7SMatthias Ringwald // reset outgoing address info 3281afbf1cd7SMatthias Ringwald memset(hci_stack->outgoing_addr, 0, 6); 3282afbf1cd7SMatthias Ringwald hci_stack->outgoing_addr_type = BD_ADDR_TYPE_UNKNOWN; 3283afbf1cd7SMatthias Ringwald 3284afbf1cd7SMatthias Ringwald // on error 3285afbf1cd7SMatthias Ringwald if (status != ERROR_CODE_SUCCESS){ 3286afbf1cd7SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 3287afbf1cd7SMatthias Ringwald if (hci_is_le_connection_type(addr_type)){ 3288afbf1cd7SMatthias Ringwald hci_stack->le_connecting_state = LE_CONNECTING_IDLE; 3289afbf1cd7SMatthias Ringwald hci_stack->le_connecting_request = LE_CONNECTING_IDLE; 3290afbf1cd7SMatthias Ringwald } 3291afbf1cd7SMatthias Ringwald #endif 3292afbf1cd7SMatthias Ringwald // error => outgoing connection failed 329373bccf35Slouislee91 hci_connection_t * conn = hci_connection_for_bd_addr_and_type(addr, addr_type); 3294afbf1cd7SMatthias Ringwald if (conn != NULL){ 3295afbf1cd7SMatthias Ringwald hci_handle_connection_failed(conn, status); 3296afbf1cd7SMatthias Ringwald } 3297afbf1cd7SMatthias Ringwald } 3298c70df5f8SMatthias Ringwald break; 3299c70df5f8SMatthias Ringwald #endif 3300afbf1cd7SMatthias Ringwald #ifdef ENABLE_CLASSIC 3301c70df5f8SMatthias Ringwald case HCI_OPCODE_HCI_INQUIRY: 3302afbf1cd7SMatthias Ringwald if (status == ERROR_CODE_SUCCESS) { 3303afbf1cd7SMatthias Ringwald hci_stack->inquiry_state = GAP_INQUIRY_STATE_ACTIVE; 3304afbf1cd7SMatthias Ringwald } else { 3305afbf1cd7SMatthias Ringwald hci_stack->inquiry_state = GAP_INQUIRY_STATE_IDLE; 3306afbf1cd7SMatthias Ringwald } 3307c70df5f8SMatthias Ringwald break; 3308c70df5f8SMatthias Ringwald #endif 3309afbf1cd7SMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS 3310c70df5f8SMatthias Ringwald case HCI_OPCODE_HCI_LE_CREATE_CIS: 3311c70df5f8SMatthias Ringwald case HCI_OPCODE_HCI_LE_ACCEPT_CIS_REQUEST: 3312afbf1cd7SMatthias Ringwald if (status == ERROR_CODE_SUCCESS){ 3313d75a6bbfSMatthias Ringwald hci_iso_stream_requested_confirm(HCI_ISO_GROUP_ID_INVALID); 3314afbf1cd7SMatthias Ringwald } else { 3315d75a6bbfSMatthias Ringwald hci_iso_stream_requested_finalize(HCI_ISO_GROUP_ID_INVALID); 3316afbf1cd7SMatthias Ringwald } 3317c70df5f8SMatthias Ringwald break; 331815f9bb6dSMatthias Ringwald case HCI_OPCODE_HCI_LE_CREATE_BIG: 331915f9bb6dSMatthias Ringwald if (status != ERROR_CODE_SUCCESS){ 332015f9bb6dSMatthias Ringwald hci_stack->iso_active_operation_type = HCI_ISO_TYPE_INVALID; 3321d8905293SMatthias Ringwald // get current big 3322d8905293SMatthias Ringwald le_audio_big_t * big = hci_big_for_handle(hci_stack->iso_active_operation_group_id); 3323d8905293SMatthias Ringwald if (big != NULL){ 3324d8905293SMatthias Ringwald hci_iso_create_big_failed(big, status); 3325d8905293SMatthias Ringwald } 332615f9bb6dSMatthias Ringwald } 332715f9bb6dSMatthias Ringwald break; 332815f9bb6dSMatthias Ringwald case HCI_OPCODE_HCI_LE_BIG_CREATE_SYNC: 332915f9bb6dSMatthias Ringwald if (status != ERROR_CODE_SUCCESS){ 333015f9bb6dSMatthias Ringwald hci_stack->iso_active_operation_type = HCI_ISO_TYPE_INVALID; 3331d8905293SMatthias Ringwald // get current big sync 3332d8905293SMatthias Ringwald le_audio_big_sync_t * big_sync = hci_big_sync_for_handle(hci_stack->iso_active_operation_group_id); 3333d8905293SMatthias Ringwald if (big_sync != NULL){ 3334d8905293SMatthias Ringwald hci_iso_big_sync_failed(big_sync, status); 3335d8905293SMatthias Ringwald } 333615f9bb6dSMatthias Ringwald } 333715f9bb6dSMatthias Ringwald break; 3338afbf1cd7SMatthias Ringwald #endif /* ENABLE_LE_ISOCHRONOUS_STREAMS */ 3339c70df5f8SMatthias Ringwald default: 3340c70df5f8SMatthias Ringwald break; 3341c70df5f8SMatthias Ringwald } 3342afbf1cd7SMatthias Ringwald } 3343afbf1cd7SMatthias Ringwald 33440ce3f217SMatthias Ringwald #ifdef ENABLE_BLE 3345e4def797SMatthias Ringwald static void hci_create_gap_connection_complete_event(const uint8_t * hci_event, uint8_t * gap_event) { 3346e4def797SMatthias Ringwald gap_event[0] = HCI_EVENT_META_GAP; 3347e4def797SMatthias Ringwald gap_event[1] = 36 - 2; 3348e4def797SMatthias Ringwald gap_event[2] = GAP_SUBEVENT_LE_CONNECTION_COMPLETE; 3349bede2a55SMatthias Ringwald switch (hci_event_le_meta_get_subevent_code(hci_event)){ 3350a9212437SMatthias Ringwald case HCI_SUBEVENT_LE_CONNECTION_COMPLETE: 3351e4def797SMatthias Ringwald memcpy(&gap_event[3], &hci_event[3], 11); 3352e4def797SMatthias Ringwald memset(&gap_event[14], 0, 12); 3353e4def797SMatthias Ringwald memcpy(&gap_event[26], &hci_event[14], 7); 3354e4def797SMatthias Ringwald memset(&gap_event[33], 0xff, 3); 33557efb077fSMatthias Ringwald // Some Controllers incorrectly report a resolved identity address in HCI_SUBEVENT_LE_CONNECTION_COMPLETE. 33567efb077fSMatthias Ringwald // If an address is resolved, we're working with it, but this event does not provide it. 33577efb077fSMatthias Ringwald // As a workaround, we map identity addresses to regular addresses. 33587efb077fSMatthias Ringwald gap_event[7] = gap_event[7] & 1; 3359a9212437SMatthias Ringwald break; 3360a9212437SMatthias Ringwald case HCI_SUBEVENT_LE_ENHANCED_CONNECTION_COMPLETE_V1: 3361e4def797SMatthias Ringwald memcpy(&gap_event[3], &hci_event[3], 30); 3362e4def797SMatthias Ringwald memset(&gap_event[33], 0xff, 3); 3363a9212437SMatthias Ringwald break; 3364a9212437SMatthias Ringwald case HCI_SUBEVENT_LE_ENHANCED_CONNECTION_COMPLETE_V2: 3365e4def797SMatthias Ringwald memcpy(&gap_event[3], &hci_event[3], 33); 3366a9212437SMatthias Ringwald break; 3367a9212437SMatthias Ringwald default: 3368a9212437SMatthias Ringwald btstack_unreachable(); 3369a9212437SMatthias Ringwald break; 3370a9212437SMatthias Ringwald } 3371a9212437SMatthias Ringwald } 3372a9212437SMatthias Ringwald 3373688bcdb4SMatthias Ringwald static void hci_handle_le_connection_complete_event(const uint8_t * hci_event){ 337498e0165dSMatthias Ringwald // create GAP_SUBEVENT_LE_CONNECTION_COMPLETE 3375a9212437SMatthias Ringwald uint8_t gap_event[36]; 3376a9212437SMatthias Ringwald hci_create_gap_connection_complete_event(hci_event, gap_event); 337760fb273dSMatthias Ringwald 337898e0165dSMatthias Ringwald // read fields 3379a9212437SMatthias Ringwald uint8_t status = gap_subevent_le_connection_complete_get_status(gap_event); 3380a9212437SMatthias Ringwald hci_role_t role = (hci_role_t) gap_subevent_le_connection_complete_get_role(gap_event); 3381a9212437SMatthias Ringwald uint16_t conn_interval = gap_subevent_le_connection_complete_get_conn_interval(gap_event); 338298e0165dSMatthias Ringwald 33830ce3f217SMatthias Ringwald // Connection management 3384138e942eSMatthias Ringwald bd_addr_t addr; 3385a9212437SMatthias Ringwald gap_subevent_le_connection_complete_get_peer_address(gap_event, addr); 3386138e942eSMatthias Ringwald bd_addr_type_t addr_type = (bd_addr_type_t) gap_subevent_le_connection_complete_get_peer_address_type(gap_event); 3387138e942eSMatthias Ringwald hci_con_handle_t con_handle = gap_subevent_le_connection_complete_get_connection_handle(gap_event); 338860fb273dSMatthias Ringwald log_info("LE Connection_complete (status=%u) type %u, %s", status, addr_type, bd_addr_to_str(addr)); 3389138e942eSMatthias Ringwald hci_connection_t * conn = hci_connection_for_bd_addr_and_type(addr, addr_type); 33900ce3f217SMatthias Ringwald 33910ce3f217SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 33920ce3f217SMatthias Ringwald // handle error: error is reported only to the initiator -> outgoing connection 339360fb273dSMatthias Ringwald if (status){ 33940ce3f217SMatthias Ringwald 33950ce3f217SMatthias Ringwald // handle cancelled outgoing connection 33960ce3f217SMatthias Ringwald // "If the cancellation was successful then, after the Command Complete event for the LE_Create_Connection_Cancel command, 33970ce3f217SMatthias Ringwald // either an LE Connection Complete or an LE Enhanced Connection Complete event shall be generated. 33980ce3f217SMatthias Ringwald // In either case, the event shall be sent with the error code Unknown Connection Identifier (0x02)." 3399f24eac89SMatthias Ringwald bool connection_was_cancelled = false; 340060fb273dSMatthias Ringwald if (status == ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER){ 3401f24eac89SMatthias Ringwald connection_was_cancelled = true; 34021f468175SMatthias Ringwald // reset state 34030ce3f217SMatthias Ringwald hci_stack->le_connecting_state = LE_CONNECTING_IDLE; 34040ce3f217SMatthias Ringwald // get outgoing connection conn struct for direct connect 3405ca0d6e5aSMatthias Ringwald conn = gap_get_outgoing_le_connection(); 34061f4510f5SMatthias Ringwald // prepare restart if still active 34071f4510f5SMatthias Ringwald if (hci_stack->le_connecting_request == LE_CONNECTING_DIRECT){ 34089fd274a1SMatthias Ringwald conn->state = SEND_CREATE_CONNECTION; 34099fd274a1SMatthias Ringwald } 34100ce3f217SMatthias Ringwald } 34110ce3f217SMatthias Ringwald 3412c1281a25SMatthias Ringwald // free connection if cancelled by user (request == IDLE) 3413f24eac89SMatthias Ringwald bool cancelled_by_user = hci_stack->le_connecting_request == LE_CONNECTING_IDLE; 3414f24eac89SMatthias Ringwald if ((conn != NULL) && cancelled_by_user){ 34150ce3f217SMatthias Ringwald // remove entry 34160ce3f217SMatthias Ringwald btstack_linked_list_remove(&hci_stack->connections, (btstack_linked_item_t *) conn); 34170ce3f217SMatthias Ringwald btstack_memory_hci_connection_free( conn ); 34180ce3f217SMatthias Ringwald } 34194dbe0476SMatthias Ringwald 3420f24eac89SMatthias Ringwald // emit GAP_SUBEVENT_LE_CONNECTION_COMPLETE for: 3421f24eac89SMatthias Ringwald // - outgoing error not caused by connection cancel 3422f24eac89SMatthias Ringwald // - connection cancelled by user 3423f24eac89SMatthias Ringwald // by this, no event is emitted for intermediate connection cancel required filterlist modification 3424f24eac89SMatthias Ringwald if ((connection_was_cancelled == false) || cancelled_by_user){ 34251f4510f5SMatthias Ringwald hci_emit_btstack_event(gap_event, sizeof(gap_event), 1); 3426f24eac89SMatthias Ringwald } 34270ce3f217SMatthias Ringwald return; 34280ce3f217SMatthias Ringwald } 34290ce3f217SMatthias Ringwald #endif 34300ce3f217SMatthias Ringwald 34310ce3f217SMatthias Ringwald // on success, both hosts receive connection complete event 343260fb273dSMatthias Ringwald if (role == HCI_ROLE_MASTER){ 34330ce3f217SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 34345bb205a5SMatthias Ringwald // if we're master, it was an outgoing connection 34350ce3f217SMatthias Ringwald // note: no hci_connection_t object exists yet for connect with whitelist 34365bb205a5SMatthias Ringwald 3437a086dc35SMatthias Ringwald // if an identity addresses was used without enhanced connection complete event, 343858babb64SMatthias Ringwald // the connection complete event contains the current random address of the peer device. 343958babb64SMatthias Ringwald // This random address is needed in the case of a re-pairing 344058babb64SMatthias Ringwald if (hci_event_le_meta_get_subevent_code(hci_event) == HCI_SUBEVENT_LE_CONNECTION_COMPLETE){ 34415bb205a5SMatthias Ringwald conn = gap_get_outgoing_le_connection(); 344258babb64SMatthias Ringwald // if outgoing connection object is available, check if identity address was used. 344358babb64SMatthias Ringwald // if yes, track resolved random address and provide rpa 34445bb205a5SMatthias Ringwald // note: we don't update hci le subevent connection complete 34455bb205a5SMatthias Ringwald if (conn != NULL){ 344658babb64SMatthias Ringwald if (hci_is_le_identity_address_type(conn->address_type)){ 344758babb64SMatthias Ringwald memcpy(&gap_event[20], &gap_event[8], 6); 34485bb205a5SMatthias Ringwald gap_event[7] = conn->address_type; 34495bb205a5SMatthias Ringwald reverse_bd_addr(conn->address, &gap_event[8]); 34505bb205a5SMatthias Ringwald } 345158babb64SMatthias Ringwald } 345258babb64SMatthias Ringwald } 34535bb205a5SMatthias Ringwald 34545bb205a5SMatthias Ringwald // we're done with it 34550ce3f217SMatthias Ringwald hci_stack->le_connecting_state = LE_CONNECTING_IDLE; 34560ce3f217SMatthias Ringwald hci_stack->le_connecting_request = LE_CONNECTING_IDLE; 34570ce3f217SMatthias Ringwald #endif 34580ce3f217SMatthias Ringwald } else { 34590ce3f217SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 34602775f8e2SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 34612775f8e2SMatthias Ringwald if (hci_le_extended_advertising_supported()) { 3462f7043595SMatthias Ringwald // advertisement state managed with HCI_SUBEVENT_LE_ADVERTISING_SET_TERMINATED 3463f7043595SMatthias Ringwald 3464f7043595SMatthias Ringwald // if advertisement set terminated event arrives before connection complete, connection struct has been prepared 3465f7043595SMatthias Ringwald // set missing peer address + address type 3466f7043595SMatthias Ringwald conn = hci_connection_for_handle(con_handle); 3467f7043595SMatthias Ringwald if (conn != NULL){ 3468f7043595SMatthias Ringwald memcpy(conn->address, addr, 6); 3469f7043595SMatthias Ringwald conn->address_type = addr_type; 3470f7043595SMatthias Ringwald } 34712775f8e2SMatthias Ringwald } 34722775f8e2SMatthias Ringwald else 34732775f8e2SMatthias Ringwald #endif 34742775f8e2SMatthias Ringwald { 34752775f8e2SMatthias Ringwald // if we're slave, it was an incoming connection and advertisements have stopped 3476935aa76eSMatthias Ringwald hci_stack->le_advertisements_state &= ~LE_ADVERTISEMENT_STATE_ACTIVE; 34772775f8e2SMatthias Ringwald } 34780ce3f217SMatthias Ringwald #endif 34790ce3f217SMatthias Ringwald } 34800ce3f217SMatthias Ringwald 34810ce3f217SMatthias Ringwald // LE connections are auto-accepted, so just create a connection if there isn't one already 34820ce3f217SMatthias Ringwald if (!conn){ 348388f925b1SMatthias Ringwald conn = create_connection_for_bd_addr_and_type(addr, addr_type, role); 34840ce3f217SMatthias Ringwald } 34850ce3f217SMatthias Ringwald 34860ce3f217SMatthias Ringwald // no memory, sorry. 34870ce3f217SMatthias Ringwald if (!conn){ 34880ce3f217SMatthias Ringwald return; 34890ce3f217SMatthias Ringwald } 34900ce3f217SMatthias Ringwald 34910ce3f217SMatthias Ringwald conn->state = OPEN; 3492138e942eSMatthias Ringwald conn->con_handle = con_handle; 349360fb273dSMatthias Ringwald conn->le_connection_interval = conn_interval; 34940ce3f217SMatthias Ringwald 34954639b1e4SMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS 3496ac0f6b83SMatthias Ringwald // workaround: PAST doesn't work without LE Read Remote Features on PacketCraft Controller with LMP 568B 34974639b1e4SMatthias Ringwald if (hci_command_supported(SUPPORTED_HCI_COMMAND_LE_READ_REMOTE_FEATURES)){ 3498ac0f6b83SMatthias Ringwald conn->gap_connection_tasks = GAP_CONNECTION_TASK_LE_READ_REMOTE_FEATURES; 34994639b1e4SMatthias Ringwald } 35004639b1e4SMatthias Ringwald #endif 3501ac0f6b83SMatthias Ringwald 35020ce3f217SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 350360fb273dSMatthias Ringwald if (role == HCI_ROLE_SLAVE){ 35040ce3f217SMatthias Ringwald hci_update_advertisements_enabled_for_current_roles(); 35050ce3f217SMatthias Ringwald } 35060ce3f217SMatthias Ringwald #endif 35070ce3f217SMatthias Ringwald 3508dde9ff1eSMatthias Ringwald // init unenhanced att bearer mtu 3509dde9ff1eSMatthias Ringwald conn->att_connection.mtu = ATT_DEFAULT_MTU; 3510dde9ff1eSMatthias Ringwald conn->att_connection.mtu_exchanged = false; 3511dde9ff1eSMatthias Ringwald 35120ce3f217SMatthias Ringwald // TODO: store - role, peer address type, conn_interval, conn_latency, supervision timeout, master clock 35130ce3f217SMatthias Ringwald 35140ce3f217SMatthias Ringwald // restart timer 35150ce3f217SMatthias Ringwald // btstack_run_loop_set_timer(&conn->timeout, HCI_CONNECTION_TIMEOUT_MS); 35160ce3f217SMatthias Ringwald // btstack_run_loop_add_timer(&conn->timeout); 35170ce3f217SMatthias Ringwald 35180ce3f217SMatthias Ringwald log_info("New connection: handle %u, %s", conn->con_handle, bd_addr_to_str(conn->address)); 35190ce3f217SMatthias Ringwald 352098e0165dSMatthias Ringwald // emit GAP_SUBEVENT_LE_CONNECTION_COMPLETE 35219da9850bSMatthias Ringwald hci_emit_btstack_event(gap_event, sizeof(gap_event), 1); 352298e0165dSMatthias Ringwald 352398e0165dSMatthias Ringwald // emit BTSTACK_EVENT_NR_CONNECTIONS_CHANGED; 35240ce3f217SMatthias Ringwald hci_emit_nr_connections_changed(); 35250ce3f217SMatthias Ringwald } 35260ce3f217SMatthias Ringwald #endif 35270ce3f217SMatthias Ringwald 352817c6fe5cSMatthias Ringwald #ifdef ENABLE_CLASSIC 352917c6fe5cSMatthias 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){ 353017c6fe5cSMatthias Ringwald if (io_cap_local == SSP_IO_CAPABILITY_UNKNOWN) return false; 353117c6fe5cSMatthias Ringwald // LEVEL_4 is tested by l2cap 35329a8f78c1SMatthias Ringwald // LEVEL 3 requires MITM protection -> check io capabilities if Authenticated is possible 35339a8f78c1SMatthias Ringwald // @see: Core Spec v5.3, Vol 3, Part C, Table 5.7 353417c6fe5cSMatthias Ringwald if (level >= LEVEL_3){ 35359a8f78c1SMatthias Ringwald // MITM not possible without keyboard or display 353617c6fe5cSMatthias Ringwald if (io_cap_remote >= SSP_IO_CAPABILITY_NO_INPUT_NO_OUTPUT) return false; 353717c6fe5cSMatthias Ringwald if (io_cap_local >= SSP_IO_CAPABILITY_NO_INPUT_NO_OUTPUT) return false; 35389a8f78c1SMatthias Ringwald 35399a8f78c1SMatthias Ringwald // MITM possible if one side has keyboard and the other has keyboard or display 35409a8f78c1SMatthias Ringwald if (io_cap_remote == SSP_IO_CAPABILITY_KEYBOARD_ONLY) return true; 35419a8f78c1SMatthias Ringwald if (io_cap_local == SSP_IO_CAPABILITY_KEYBOARD_ONLY) return true; 35429a8f78c1SMatthias Ringwald 35439a8f78c1SMatthias Ringwald // MITM not possible if one side has only display and other side has no keyboard 35449a8f78c1SMatthias Ringwald if (io_cap_remote == SSP_IO_CAPABILITY_DISPLAY_ONLY) return false; 35459a8f78c1SMatthias Ringwald if (io_cap_local == SSP_IO_CAPABILITY_DISPLAY_ONLY) return false; 354617c6fe5cSMatthias Ringwald } 354717c6fe5cSMatthias Ringwald // LEVEL 2 requires SSP, which is a given 354817c6fe5cSMatthias Ringwald return true; 354917c6fe5cSMatthias Ringwald } 35503817f9dfSMatthias Ringwald 3551b3c4163bSMatthias Ringwald static void hci_ssp_assess_security_on_io_cap_request(hci_connection_t * conn){ 35522dd8985bSMatthias Ringwald // get requested security level 35532dd8985bSMatthias Ringwald gap_security_level_t requested_security_level = conn->requested_security_level; 35542dd8985bSMatthias Ringwald if (hci_stack->gap_secure_connections_only_mode){ 35552dd8985bSMatthias Ringwald requested_security_level = LEVEL_4; 35562dd8985bSMatthias Ringwald } 35572dd8985bSMatthias Ringwald 3558b3c4163bSMatthias Ringwald // assess security: LEVEL 4 requires SC 35592dd8985bSMatthias Ringwald // skip this preliminary test if remote features are not available yet to work around potential issue in ESP32 controller 35602dd8985bSMatthias Ringwald if ((requested_security_level == LEVEL_4) && 35612dd8985bSMatthias Ringwald ((conn->bonding_flags & BONDING_RECEIVED_REMOTE_FEATURES) != 0) && 35622dd8985bSMatthias Ringwald !hci_remote_sc_enabled(conn)){ 3563b3c4163bSMatthias Ringwald log_info("Level 4 required, but SC not supported -> abort"); 3564b3c4163bSMatthias Ringwald hci_pairing_complete(conn, ERROR_CODE_INSUFFICIENT_SECURITY); 3565b3c4163bSMatthias Ringwald connectionSetAuthenticationFlags(conn, AUTH_FLAG_SEND_IO_CAPABILITIES_NEGATIVE_REPLY); 3566b3c4163bSMatthias Ringwald return; 3567b3c4163bSMatthias Ringwald } 3568b3c4163bSMatthias Ringwald 3569c2414c00SMatthias Ringwald // assess bonding requirements: abort if remote in dedicated bonding mode but we are non-bonding 3570c2414c00SMatthias Ringwald // - GAP/MOD/NBON/BV-02-C 3571c2414c00SMatthias Ringwald // - GAP/DM/NBON/BV-01-C 3572c2414c00SMatthias Ringwald if (conn->authentication_flags & AUTH_FLAG_RECV_IO_CAPABILITIES_RESPONSE){ 3573c2414c00SMatthias Ringwald switch (conn->io_cap_response_auth_req){ 3574c2414c00SMatthias Ringwald case SSP_IO_AUTHREQ_MITM_PROTECTION_NOT_REQUIRED_DEDICATED_BONDING: 3575c2414c00SMatthias Ringwald case SSP_IO_AUTHREQ_MITM_PROTECTION_REQUIRED_DEDICATED_BONDING: 3576c2414c00SMatthias Ringwald if (hci_stack->bondable == false){ 3577c2414c00SMatthias Ringwald log_info("Dedicated vs. non-bondable -> abort"); 3578c2414c00SMatthias Ringwald hci_pairing_complete(conn, ERROR_CODE_INSUFFICIENT_SECURITY); 3579c2414c00SMatthias Ringwald connectionSetAuthenticationFlags(conn, AUTH_FLAG_SEND_IO_CAPABILITIES_NEGATIVE_REPLY); 3580c2414c00SMatthias Ringwald return; 3581c2414c00SMatthias Ringwald } 3582c2414c00SMatthias Ringwald default: 3583c2414c00SMatthias Ringwald break; 3584c2414c00SMatthias Ringwald } 3585c2414c00SMatthias Ringwald } 3586c2414c00SMatthias Ringwald 3587b3c4163bSMatthias Ringwald // assess security based on io capabilities 3588b3c4163bSMatthias Ringwald if (conn->authentication_flags & AUTH_FLAG_RECV_IO_CAPABILITIES_RESPONSE){ 3589b3c4163bSMatthias Ringwald // responder: fully validate io caps of both sides as well as OOB data 3590b3c4163bSMatthias Ringwald bool security_possible = false; 3591b3c4163bSMatthias Ringwald security_possible = hci_ssp_security_level_possible_for_io_cap(requested_security_level, hci_stack->ssp_io_capability, conn->io_cap_response_io); 3592b3c4163bSMatthias Ringwald 3593b3c4163bSMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB 3594b3c4163bSMatthias Ringwald // We assume that both Controller can reach LEVEL 4, if one side has received P-192 and the other has received P-256, 3595b3c4163bSMatthias Ringwald // so we merge the OOB data availability 3596b3c4163bSMatthias Ringwald uint8_t have_oob_data = conn->io_cap_response_oob_data; 3597b3c4163bSMatthias Ringwald if (conn->classic_oob_c_192 != NULL){ 3598b3c4163bSMatthias Ringwald have_oob_data |= 1; 3599b3c4163bSMatthias Ringwald } 3600b3c4163bSMatthias Ringwald if (conn->classic_oob_c_256 != NULL){ 3601b3c4163bSMatthias Ringwald have_oob_data |= 2; 3602b3c4163bSMatthias Ringwald } 3603b3c4163bSMatthias Ringwald // for up to Level 3, either P-192 as well as P-256 will do 3604b3c4163bSMatthias 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 3605b3c4163bSMatthias Ringwald // if remote does not SC, we should not receive P-256 data either 3606b3c4163bSMatthias Ringwald if ((requested_security_level <= LEVEL_3) && (have_oob_data != 0)){ 3607b3c4163bSMatthias Ringwald security_possible = true; 3608b3c4163bSMatthias Ringwald } 3609b3c4163bSMatthias Ringwald // for Level 4, P-256 is needed 3610b3c4163bSMatthias Ringwald if ((requested_security_level == LEVEL_4 && ((have_oob_data & 2) != 0))){ 3611b3c4163bSMatthias Ringwald security_possible = true; 3612b3c4163bSMatthias Ringwald } 3613b3c4163bSMatthias Ringwald #endif 3614b3c4163bSMatthias Ringwald 3615b3c4163bSMatthias Ringwald if (security_possible == false){ 36162dd8985bSMatthias Ringwald log_info("IOCap/OOB insufficient for level %u -> abort", requested_security_level); 3617b3c4163bSMatthias Ringwald hci_pairing_complete(conn, ERROR_CODE_INSUFFICIENT_SECURITY); 3618b3c4163bSMatthias Ringwald connectionSetAuthenticationFlags(conn, AUTH_FLAG_SEND_IO_CAPABILITIES_NEGATIVE_REPLY); 3619b3c4163bSMatthias Ringwald return; 3620b3c4163bSMatthias Ringwald } 3621b3c4163bSMatthias Ringwald } else { 3622b3c4163bSMatthias Ringwald // initiator: remote io cap not yet, only check if we have ability for MITM protection if requested and OOB is not supported 36231fe968f5SMatthias Ringwald #ifndef ENABLE_CLASSIC_PAIRING_OOB 36241fe968f5SMatthias Ringwald #ifndef ENABLE_EXPLICIT_IO_CAPABILITIES_REPLY 3625b3c4163bSMatthias Ringwald if ((conn->requested_security_level >= LEVEL_3) && (hci_stack->ssp_io_capability >= SSP_IO_CAPABILITY_NO_INPUT_NO_OUTPUT)){ 3626b3c4163bSMatthias Ringwald log_info("Level 3+ required, but no input/output -> abort"); 3627b3c4163bSMatthias Ringwald hci_pairing_complete(conn, ERROR_CODE_INSUFFICIENT_SECURITY); 3628b3c4163bSMatthias Ringwald connectionSetAuthenticationFlags(conn, AUTH_FLAG_SEND_IO_CAPABILITIES_NEGATIVE_REPLY); 3629b3c4163bSMatthias Ringwald return; 3630b3c4163bSMatthias Ringwald } 3631b3c4163bSMatthias Ringwald #endif 36321fe968f5SMatthias Ringwald #endif 3633b3c4163bSMatthias Ringwald } 3634b3c4163bSMatthias Ringwald 3635b3c4163bSMatthias Ringwald #ifndef ENABLE_EXPLICIT_IO_CAPABILITIES_REPLY 3636b3c4163bSMatthias Ringwald if (hci_stack->ssp_io_capability != SSP_IO_CAPABILITY_UNKNOWN){ 3637b3c4163bSMatthias Ringwald connectionSetAuthenticationFlags(conn, AUTH_FLAG_SEND_IO_CAPABILITIES_REPLY); 3638b3c4163bSMatthias Ringwald } else { 3639b3c4163bSMatthias Ringwald connectionSetAuthenticationFlags(conn, AUTH_FLAG_SEND_IO_CAPABILITIES_NEGATIVE_REPLY); 3640b3c4163bSMatthias Ringwald } 3641b3c4163bSMatthias Ringwald #endif 3642b3c4163bSMatthias Ringwald } 3643b3c4163bSMatthias Ringwald 364417c6fe5cSMatthias Ringwald #endif 364517c6fe5cSMatthias Ringwald 3646c3b46f5aSMatthias Ringwald static void event_handler(uint8_t *packet, uint16_t size){ 36474f781026SMatthias Ringwald 36484f781026SMatthias Ringwald uint16_t event_length = packet[1]; 36494f781026SMatthias Ringwald 36504f781026SMatthias Ringwald // assert packet is complete 36514ea43905SMatthias Ringwald if (size != (event_length + 2u)){ 36524f781026SMatthias Ringwald log_error("event_handler called with packet of wrong size %d, expected %u => dropping packet", size, event_length + 2); 36534f781026SMatthias Ringwald return; 36544f781026SMatthias Ringwald } 36554f781026SMatthias Ringwald 36564f781026SMatthias Ringwald hci_con_handle_t handle; 36574f781026SMatthias Ringwald hci_connection_t * conn; 36584f781026SMatthias Ringwald int i; 36594f781026SMatthias Ringwald 36604f781026SMatthias Ringwald #ifdef ENABLE_CLASSIC 36615e91d96cSMatthias Ringwald hci_link_type_t link_type; 366248f33f37SMatthias Ringwald bd_addr_t addr; 3663cef94710SMatthias Ringwald bd_addr_type_t addr_type; 36644f781026SMatthias Ringwald #endif 36654ae8623eSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS 36664ae8623eSMatthias Ringwald hci_iso_stream_t * iso_stream; 36677aa35f6aSMatthias Ringwald le_audio_big_t * big; 36682a6c0f82SMatthias Ringwald le_audio_big_sync_t * big_sync; 36694ae8623eSMatthias Ringwald #endif 367089254d99SMatthias Ringwald #if defined(ENABLE_LE_ISOCHRONOUS_STREAMS) || defined(ENABLE_LE_EXTENDED_ADVERTISING) 367189254d99SMatthias Ringwald btstack_linked_list_iterator_t it; 367289254d99SMatthias Ringwald #endif 3673759e0a0dSMatthias Ringwald #if defined(ENABLE_LE_EXTENDED_ADVERTISING) && defined(ENABLE_LE_CENTRAL) 367489254d99SMatthias Ringwald uint8_t advertising_handle; 367589254d99SMatthias Ringwald #endif 36764f781026SMatthias Ringwald 36774f781026SMatthias Ringwald // log_info("HCI:EVENT:%02x", hci_event_packet_get_type(packet)); 36784f781026SMatthias Ringwald 36794f781026SMatthias Ringwald switch (hci_event_packet_get_type(packet)) { 36804f781026SMatthias Ringwald 36814f781026SMatthias Ringwald case HCI_EVENT_COMMAND_COMPLETE: 36824f781026SMatthias Ringwald handle_command_complete_event(packet, size); 368356cf178bSmatthias.ringwald break; 368456cf178bSmatthias.ringwald 36857ec5eeaaSmatthias.ringwald case HCI_EVENT_COMMAND_STATUS: 3686afbf1cd7SMatthias Ringwald handle_command_status_event(packet, size); 36877ec5eeaaSmatthias.ringwald break; 36887ec5eeaaSmatthias.ringwald 36892e440c8aS[email protected] case HCI_EVENT_NUMBER_OF_COMPLETED_PACKETS:{ 36909784dac1SMatthias Ringwald if (size < 3) return; 36919784dac1SMatthias Ringwald uint16_t num_handles = packet[2]; 36924ea43905SMatthias Ringwald if (size != (3u + num_handles * 4u)) return; 3693d9a1d8edSMatthias Ringwald #ifdef ENABLE_CLASSIC 3694d9a1d8edSMatthias Ringwald bool notify_sco = false; 3695d9a1d8edSMatthias Ringwald #endif 3696d9a1d8edSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS 3697d9a1d8edSMatthias Ringwald bool notify_iso = false; 3698d9a1d8edSMatthias Ringwald #endif 36999784dac1SMatthias Ringwald uint16_t offset = 3; 37009784dac1SMatthias Ringwald for (i=0; i<num_handles;i++){ 37014ea43905SMatthias Ringwald handle = little_endian_read_16(packet, offset) & 0x0fffu; 37024ea43905SMatthias Ringwald offset += 2u; 3703f8fbdce0SMatthias Ringwald uint16_t num_packets = little_endian_read_16(packet, offset); 37044ea43905SMatthias Ringwald offset += 2u; 37052e440c8aS[email protected] 37065061f3afS[email protected] conn = hci_connection_for_handle(handle); 3707e5413aa0SMatthias Ringwald if (conn != NULL) { 370823bed257S[email protected] 3709ce41473eSMatthias Ringwald if (conn->num_packets_sent >= num_packets) { 3710ce41473eSMatthias Ringwald conn->num_packets_sent -= num_packets; 3711e35edcc1S[email protected] } else { 3712ce41473eSMatthias Ringwald log_error("hci_number_completed_packets, more packet slots freed then sent."); 3713ce41473eSMatthias Ringwald conn->num_packets_sent = 0; 3714e35edcc1S[email protected] } 3715ce41473eSMatthias Ringwald // log_info("hci_number_completed_packet %u processed for handle %u, outstanding %u", num_packets, handle, conn->num_packets_sent); 3716d9a1d8edSMatthias Ringwald #ifdef ENABLE_CLASSIC 3717d9a1d8edSMatthias Ringwald if (conn->address_type == BD_ADDR_TYPE_SCO){ 3718d9a1d8edSMatthias Ringwald notify_sco = true; 3719d9a1d8edSMatthias Ringwald } 3720d9a1d8edSMatthias Ringwald #endif 3721e5413aa0SMatthias Ringwald } 3722e5413aa0SMatthias Ringwald 37238ad9cf99SMatthias Ringwald #ifdef ENABLE_CONTROLLER_DUMP_PACKETS 37248ad9cf99SMatthias Ringwald hci_controller_dump_packets(); 37258ad9cf99SMatthias Ringwald #endif 37268ad9cf99SMatthias Ringwald 3727e5413aa0SMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS 3728e5413aa0SMatthias Ringwald if (conn == NULL){ 3729c30bd0a5SMatthias Ringwald iso_stream = hci_iso_stream_for_con_handle(handle); 3730e5413aa0SMatthias Ringwald if (iso_stream != NULL){ 3731e5413aa0SMatthias Ringwald if (iso_stream->num_packets_sent >= num_packets) { 3732e5413aa0SMatthias Ringwald iso_stream->num_packets_sent -= num_packets; 3733e5413aa0SMatthias Ringwald } else { 3734e5413aa0SMatthias Ringwald log_error("hci_number_completed_packets, more packet slots freed then sent."); 3735e5413aa0SMatthias Ringwald iso_stream->num_packets_sent = 0; 3736e5413aa0SMatthias Ringwald } 37378d72db10SMatthias Ringwald if (iso_stream->iso_type == HCI_ISO_TYPE_BIS){ 3738c30bd0a5SMatthias Ringwald big = hci_big_for_handle(iso_stream->group_id); 3739fe977b37SMatthias Ringwald if (big != NULL){ 3740fe977b37SMatthias Ringwald big->num_completed_timestamp_current_valid = true; 3741fe977b37SMatthias Ringwald big->num_completed_timestamp_current_ms = btstack_run_loop_get_time_ms(); 3742fe977b37SMatthias Ringwald } 3743fe977b37SMatthias Ringwald } 3744e5413aa0SMatthias Ringwald log_info("hci_number_completed_packet %u processed for handle %u, outstanding %u", 3745e5413aa0SMatthias Ringwald num_packets, handle, iso_stream->num_packets_sent); 3746d9a1d8edSMatthias Ringwald notify_iso = true; 3747e5413aa0SMatthias Ringwald } 3748d9a1d8edSMatthias Ringwald } 3749d9a1d8edSMatthias Ringwald #endif 3750d9a1d8edSMatthias Ringwald } 3751d9a1d8edSMatthias Ringwald 3752d9a1d8edSMatthias Ringwald #ifdef ENABLE_CLASSIC 3753d9a1d8edSMatthias Ringwald if (notify_sco){ 3754d9a1d8edSMatthias Ringwald hci_notify_if_sco_can_send_now(); 3755d9a1d8edSMatthias Ringwald } 3756d9a1d8edSMatthias Ringwald #endif 3757d9a1d8edSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS 3758d9a1d8edSMatthias Ringwald if (notify_iso){ 37595ade6657SMatthias Ringwald hci_iso_notify_can_send_now(); 3760e5413aa0SMatthias Ringwald } 3761e5413aa0SMatthias Ringwald #endif 37626772a24cSmatthias.ringwald break; 37632e440c8aS[email protected] } 376435454696SMatthias Ringwald 376535454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 37669afaa4d4SMatthias Ringwald case HCI_EVENT_FLUSH_OCCURRED: 37679afaa4d4SMatthias Ringwald // flush occurs only if automatic flush has been enabled by gap_enable_link_watchdog() 37689afaa4d4SMatthias Ringwald handle = hci_event_flush_occurred_get_handle(packet); 37699afaa4d4SMatthias Ringwald conn = hci_connection_for_handle(handle); 37709afaa4d4SMatthias Ringwald if (conn) { 37719afaa4d4SMatthias Ringwald log_info("Flush occurred, disconnect 0x%04x", handle); 37729afaa4d4SMatthias Ringwald conn->state = SEND_DISCONNECT; 37739afaa4d4SMatthias Ringwald } 37749afaa4d4SMatthias Ringwald break; 37759afaa4d4SMatthias Ringwald 3776f5875de5SMatthias Ringwald case HCI_EVENT_INQUIRY_COMPLETE: 3777f5875de5SMatthias Ringwald if (hci_stack->inquiry_state == GAP_INQUIRY_STATE_ACTIVE){ 3778f5875de5SMatthias Ringwald hci_stack->inquiry_state = GAP_INQUIRY_STATE_IDLE; 3779f5875de5SMatthias Ringwald uint8_t event[] = { GAP_EVENT_INQUIRY_COMPLETE, 1, 0}; 37809da9850bSMatthias Ringwald hci_emit_btstack_event(event, sizeof(event), 1); 3781f5875de5SMatthias Ringwald } 3782f5875de5SMatthias Ringwald break; 3783b7f1ee76SMatthias Ringwald case HCI_EVENT_REMOTE_NAME_REQUEST_COMPLETE: 3784b7f1ee76SMatthias Ringwald if (hci_stack->remote_name_state == GAP_REMOTE_NAME_STATE_W4_COMPLETE){ 3785b7f1ee76SMatthias Ringwald hci_stack->remote_name_state = GAP_REMOTE_NAME_STATE_IDLE; 3786b7f1ee76SMatthias Ringwald } 3787b7f1ee76SMatthias Ringwald break; 37881f7b95a1Smatthias.ringwald case HCI_EVENT_CONNECTION_REQUEST: 3789724d70a2SMatthias Ringwald reverse_bd_addr(&packet[2], addr); 37905e91d96cSMatthias Ringwald link_type = (hci_link_type_t) packet[11]; 379172cf8859SMatthias Ringwald 379272cf8859SMatthias Ringwald // CVE-2020-26555: reject incoming connection from device with same BD ADDR 379372cf8859SMatthias Ringwald if (memcmp(hci_stack->local_bd_addr, addr, 6) == 0){ 379472cf8859SMatthias Ringwald hci_stack->decline_reason = ERROR_CODE_CONNECTION_REJECTED_DUE_TO_UNACCEPTABLE_BD_ADDR; 379572cf8859SMatthias Ringwald bd_addr_copy(hci_stack->decline_addr, addr); 379672cf8859SMatthias Ringwald break; 379772cf8859SMatthias Ringwald } 379872cf8859SMatthias Ringwald 379907e010b6SMilanka Ringwald if (hci_stack->gap_classic_accept_callback != NULL){ 38005e91d96cSMatthias Ringwald if ((*hci_stack->gap_classic_accept_callback)(addr, link_type) == 0){ 3801d152b6c6SMatthias Ringwald hci_stack->decline_reason = ERROR_CODE_CONNECTION_REJECTED_DUE_TO_SECURITY_REASONS; 380207e010b6SMilanka Ringwald bd_addr_copy(hci_stack->decline_addr, addr); 380307e010b6SMilanka Ringwald break; 380407e010b6SMilanka Ringwald } 380507e010b6SMilanka Ringwald } 380607e010b6SMilanka Ringwald 380737eaa4cfSmatthias.ringwald // TODO: eval COD 8-10 38085e91d96cSMatthias Ringwald log_info("Connection_incoming: %s, type %u", bd_addr_to_str(addr), (unsigned int) link_type); 38095e91d96cSMatthias Ringwald addr_type = (link_type == HCI_LINK_TYPE_ACL) ? BD_ADDR_TYPE_ACL : BD_ADDR_TYPE_SCO; 38102e77e513S[email protected] conn = hci_connection_for_bd_addr_and_type(addr, addr_type); 38111f7b95a1Smatthias.ringwald if (!conn) { 381288f925b1SMatthias Ringwald conn = create_connection_for_bd_addr_and_type(addr, addr_type, HCI_ROLE_SLAVE); 38131f7b95a1Smatthias.ringwald } 3814ce4c8fabSmatthias.ringwald if (!conn) { 3815ce4c8fabSmatthias.ringwald // CONNECTION REJECTED DUE TO LIMITED RESOURCES (0X0D) 38164536712cSMilanka Ringwald hci_stack->decline_reason = ERROR_CODE_CONNECTION_REJECTED_DUE_TO_LIMITED_RESOURCES; 3817058e3d6bSMatthias Ringwald bd_addr_copy(hci_stack->decline_addr, addr); 3818f23819bcSMatthias Ringwald hci_run(); 3819f23819bcSMatthias Ringwald // avoid event to higher layer 3820f23819bcSMatthias Ringwald return; 3821ce4c8fabSmatthias.ringwald } 382232ab9390Smatthias.ringwald conn->state = RECEIVED_CONNECTION_REQUEST; 3823f3a16b9aSMatthias Ringwald // store info about eSCO 38245e91d96cSMatthias Ringwald if (link_type == HCI_LINK_TYPE_ESCO){ 382576ccfb2aSMatthias Ringwald conn->remote_supported_features[0] |= 1; 3826f3a16b9aSMatthias Ringwald } 3827d7891039SMatthias Ringwald // propagate remote supported sco packet packets from existing ACL to new SCO connection 3828d7891039SMatthias Ringwald if (addr_type == BD_ADDR_TYPE_SCO){ 3829182d886dSMatthias Ringwald const hci_connection_t * acl_conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL); 3830182d886dSMatthias Ringwald // ACL exists unless fuzzing 3831182d886dSMatthias Ringwald if (acl_conn != NULL) { 3832d7891039SMatthias Ringwald conn->remote_supported_sco_packets = acl_conn->remote_supported_sco_packets; 3833d7891039SMatthias Ringwald } 3834182d886dSMatthias Ringwald } 383532ab9390Smatthias.ringwald hci_run(); 38361f7b95a1Smatthias.ringwald break; 38371f7b95a1Smatthias.ringwald 38386772a24cSmatthias.ringwald case HCI_EVENT_CONNECTION_COMPLETE: 3839fe1ed1b8Smatthias.ringwald // Connection management 3840724d70a2SMatthias Ringwald reverse_bd_addr(&packet[5], addr); 38419da54300S[email protected] log_info("Connection_complete (status=%u) %s", packet[2], bd_addr_to_str(addr)); 3842f16129ceSMatthias Ringwald addr_type = BD_ADDR_TYPE_ACL; 38432e77e513S[email protected] conn = hci_connection_for_bd_addr_and_type(addr, addr_type); 3844fe1ed1b8Smatthias.ringwald if (conn) { 3845893b4ccdSMatthias Ringwald switch (conn->state){ 3846893b4ccdSMatthias Ringwald // expected states 3847893b4ccdSMatthias Ringwald case ACCEPTED_CONNECTION_REQUEST: 3848893b4ccdSMatthias Ringwald case SENT_CREATE_CONNECTION: 3849893b4ccdSMatthias Ringwald break; 3850893b4ccdSMatthias Ringwald // unexpected state -> ignore 3851893b4ccdSMatthias Ringwald default: 3852893b4ccdSMatthias Ringwald // don't forward event to app 3853893b4ccdSMatthias Ringwald return; 3854893b4ccdSMatthias Ringwald } 3855b448a0e7Smatthias.ringwald if (!packet[2]){ 3856c8e4258aSmatthias.ringwald conn->state = OPEN; 3857f8fbdce0SMatthias Ringwald conn->con_handle = little_endian_read_16(packet, 3); 38586909f064SMatthias Ringwald 385922df2fe2SMatthias Ringwald // trigger write supervision timeout if we're master 3860d821984bSMatthias Ringwald if ((hci_stack->link_supervision_timeout != HCI_LINK_SUPERVISION_TIMEOUT_DEFAULT) && (conn->role == HCI_ROLE_MASTER)){ 386122df2fe2SMatthias Ringwald conn->gap_connection_tasks |= GAP_CONNECTION_TASK_WRITE_SUPERVISION_TIMEOUT; 38626909f064SMatthias Ringwald } 38636909f064SMatthias Ringwald 386422df2fe2SMatthias Ringwald // trigger write automatic flush timeout 38659afaa4d4SMatthias Ringwald if (hci_stack->automatic_flush_timeout != 0){ 38669afaa4d4SMatthias Ringwald conn->gap_connection_tasks |= GAP_CONNECTION_TASK_WRITE_AUTOMATIC_FLUSH_TIMEOUT; 38679afaa4d4SMatthias Ringwald } 38689afaa4d4SMatthias Ringwald 3869c785ef68Smatthias.ringwald // restart timer 3870528a4a3bSMatthias Ringwald btstack_run_loop_set_timer(&conn->timeout, HCI_CONNECTION_TIMEOUT_MS); 3871528a4a3bSMatthias Ringwald btstack_run_loop_add_timer(&conn->timeout); 3872c785ef68Smatthias.ringwald 387318c4a0a3SMatthias Ringwald // trigger remote features for dedicated bonding 387418c4a0a3SMatthias Ringwald if ((conn->bonding_flags & BONDING_DEDICATED) != 0){ 387518c4a0a3SMatthias Ringwald hci_trigger_remote_features_for_connection(conn); 387618c4a0a3SMatthias Ringwald } 387718c4a0a3SMatthias Ringwald 38789da54300S[email protected] log_info("New connection: handle %u, %s", conn->con_handle, bd_addr_to_str(conn->address)); 387943bfb1bdSmatthias.ringwald 388043bfb1bdSmatthias.ringwald hci_emit_nr_connections_changed(); 3881b448a0e7Smatthias.ringwald } else { 38820bbba85bSMatthias Ringwald // connection failed 38830bbba85bSMatthias Ringwald hci_handle_connection_failed(conn, packet[2]); 3884fe1ed1b8Smatthias.ringwald } 3885fe1ed1b8Smatthias.ringwald } 38866772a24cSmatthias.ringwald break; 3887fe1ed1b8Smatthias.ringwald 388844d0e3d5S[email protected] case HCI_EVENT_SYNCHRONOUS_CONNECTION_COMPLETE: 3889724d70a2SMatthias Ringwald reverse_bd_addr(&packet[5], addr); 38901f34df2cSMatthias Ringwald conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_SCO); 38911f34df2cSMatthias Ringwald log_info("Synchronous Connection Complete for %p (status=%u) %s", conn, packet[2], bd_addr_to_str(addr)); 3892182d886dSMatthias Ringwald 3893182d886dSMatthias Ringwald // SCO exists unless fuzzer 3894182d886dSMatthias Ringwald if (conn == NULL) break; 38959071873aSMatthias Ringwald 38969071873aSMatthias Ringwald if (packet[2] != ERROR_CODE_SUCCESS){ 38979071873aSMatthias Ringwald // connection failed, remove entry 38981f34df2cSMatthias Ringwald hci_handle_connection_failed(conn, packet[2]); 389944d0e3d5S[email protected] break; 390044d0e3d5S[email protected] } 39019071873aSMatthias Ringwald 39021a06f663S[email protected] conn->state = OPEN; 3903f8fbdce0SMatthias Ringwald conn->con_handle = little_endian_read_16(packet, 3); 3904ee752bb8SMatthias Ringwald 3905d7891039SMatthias Ringwald // update sco payload length for eSCO connections 3906d7891039SMatthias Ringwald if (hci_event_synchronous_connection_complete_get_tx_packet_length(packet) > 0){ 3907d7891039SMatthias Ringwald conn->sco_payload_length = hci_event_synchronous_connection_complete_get_tx_packet_length(packet); 3908d7891039SMatthias Ringwald log_info("eSCO Complete, set payload len %u", conn->sco_payload_length); 3909d7891039SMatthias Ringwald } 3910d7891039SMatthias Ringwald 3911ee752bb8SMatthias Ringwald #ifdef ENABLE_SCO_OVER_HCI 3912ee752bb8SMatthias Ringwald // update SCO 3913ee752bb8SMatthias Ringwald if (conn->address_type == BD_ADDR_TYPE_SCO && hci_stack->hci_transport && hci_stack->hci_transport->set_sco_config){ 3914ee752bb8SMatthias Ringwald hci_stack->hci_transport->set_sco_config(hci_stack->sco_voice_setting_active, hci_number_sco_connections()); 3915ee752bb8SMatthias Ringwald } 3916f234b250SMatthias Ringwald // trigger can send now 3917f234b250SMatthias Ringwald if (hci_have_usb_transport()){ 39181972f31fSMatthias Ringwald hci_stack->sco_can_send_now = true; 3919f234b250SMatthias Ringwald } 3920fa7f2dfdSMatthias Ringwald 3921a086dc35SMatthias Ringwald // setup implicit sco flow control 3922fa7f2dfdSMatthias Ringwald conn->sco_tx_ready = 0; 3923fa7f2dfdSMatthias Ringwald conn->sco_tx_active = 0; 3924fa7f2dfdSMatthias Ringwald conn->sco_established_ms = btstack_run_loop_get_time_ms(); 3925fa7f2dfdSMatthias Ringwald 3926ee752bb8SMatthias Ringwald #endif 3927cb70c5abSMatthias Ringwald #ifdef HAVE_SCO_TRANSPORT 3928cb70c5abSMatthias Ringwald // configure sco transport 3929cb70c5abSMatthias Ringwald if (hci_stack->sco_transport != NULL){ 3930cb70c5abSMatthias Ringwald sco_format_t sco_format = ((hci_stack->sco_voice_setting_active & 0x03) == 0x03) ? SCO_FORMAT_8_BIT : SCO_FORMAT_16_BIT; 3931cb70c5abSMatthias Ringwald hci_stack->sco_transport->open(conn->con_handle, sco_format); 3932cb70c5abSMatthias Ringwald } 3933cb70c5abSMatthias Ringwald #endif 393444d0e3d5S[email protected] break; 393544d0e3d5S[email protected] 3936afd4e962S[email protected] case HCI_EVENT_READ_REMOTE_SUPPORTED_FEATURES_COMPLETE: 3937f8fbdce0SMatthias Ringwald handle = little_endian_read_16(packet, 3); 3938afd4e962S[email protected] conn = hci_connection_for_handle(handle); 3939afd4e962S[email protected] if (!conn) break; 3940afd4e962S[email protected] if (!packet[2]){ 39412f5c44baSMatthias Ringwald const uint8_t * features = &packet[5]; 39422f5c44baSMatthias Ringwald hci_handle_remote_features_page_0(conn, features); 39432f5c44baSMatthias Ringwald 39445ccef624SMatthias Ringwald // read extended features if possible 39451ffa425cSMatthias Ringwald if (hci_command_supported(SUPPORTED_HCI_COMMAND_READ_REMOTE_EXTENDED_FEATURES) 39461ffa425cSMatthias Ringwald && ((conn->remote_supported_features[0] & 2) != 0)) { 39475ccef624SMatthias Ringwald conn->bonding_flags |= BONDING_REQUEST_REMOTE_FEATURES_PAGE_1; 39485ccef624SMatthias Ringwald break; 39495ccef624SMatthias Ringwald } 39505ccef624SMatthias Ringwald } 39515ccef624SMatthias Ringwald hci_handle_remote_features_received(conn); 39525ccef624SMatthias Ringwald break; 39535ccef624SMatthias Ringwald 39545ccef624SMatthias Ringwald case HCI_EVENT_READ_REMOTE_EXTENDED_FEATURES_COMPLETE: 39555ccef624SMatthias Ringwald handle = little_endian_read_16(packet, 3); 39565ccef624SMatthias Ringwald conn = hci_connection_for_handle(handle); 39575ccef624SMatthias Ringwald if (!conn) break; 39585ccef624SMatthias Ringwald // status = ok, page = 1 395950c51a77SMatthias Ringwald if (!packet[2]) { 396050c51a77SMatthias Ringwald uint8_t page_number = packet[5]; 396150c51a77SMatthias Ringwald uint8_t maximum_page_number = packet[6]; 39625ccef624SMatthias Ringwald const uint8_t * features = &packet[7]; 396350c51a77SMatthias Ringwald bool done = false; 396450c51a77SMatthias Ringwald switch (page_number){ 396550c51a77SMatthias Ringwald case 1: 39662f5c44baSMatthias Ringwald hci_handle_remote_features_page_1(conn, features); 396750c51a77SMatthias Ringwald if (maximum_page_number >= 2){ 396850c51a77SMatthias Ringwald // get Secure Connections (Controller) from Page 2 if available 396950c51a77SMatthias Ringwald conn->bonding_flags |= BONDING_REQUEST_REMOTE_FEATURES_PAGE_2; 397050c51a77SMatthias Ringwald } else { 397150c51a77SMatthias Ringwald // otherwise, assume SC (Controller) == SC (Host) 397250c51a77SMatthias Ringwald if ((conn->bonding_flags & BONDING_REMOTE_SUPPORTS_SC_HOST) != 0){ 397350c51a77SMatthias Ringwald conn->bonding_flags |= BONDING_REMOTE_SUPPORTS_SC_CONTROLLER; 397450c51a77SMatthias Ringwald } 397550c51a77SMatthias Ringwald done = true; 397650c51a77SMatthias Ringwald } 397750c51a77SMatthias Ringwald break; 397850c51a77SMatthias Ringwald case 2: 397950c51a77SMatthias Ringwald hci_handle_remote_features_page_2(conn, features); 398050c51a77SMatthias Ringwald done = true; 398150c51a77SMatthias Ringwald break; 398250c51a77SMatthias Ringwald default: 398350c51a77SMatthias Ringwald break; 398450c51a77SMatthias Ringwald } 398550c51a77SMatthias Ringwald if (!done) break; 3986afd4e962S[email protected] } 3987de0df013SMatthias Ringwald hci_handle_remote_features_received(conn); 3988afd4e962S[email protected] break; 3989afd4e962S[email protected] 39907fde4af9Smatthias.ringwald case HCI_EVENT_LINK_KEY_REQUEST: 3991308eeaffSMatthias Ringwald #ifndef ENABLE_EXPLICIT_LINK_KEY_REPLY 399263c0b2fdSMatthias Ringwald hci_event_link_key_request_get_bd_addr(packet, addr); 399363c0b2fdSMatthias Ringwald conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL); 399463c0b2fdSMatthias Ringwald if (!conn) break; 399563c0b2fdSMatthias Ringwald 399663c0b2fdSMatthias Ringwald // lookup link key in db if not cached 399763c0b2fdSMatthias Ringwald if ((conn->link_key_type == INVALID_LINK_KEY) && (hci_stack->link_key_db != NULL)){ 399863c0b2fdSMatthias Ringwald hci_stack->link_key_db->get_link_key(conn->address, conn->link_key, &conn->link_key_type); 399963c0b2fdSMatthias Ringwald } 400063c0b2fdSMatthias Ringwald 400163c0b2fdSMatthias Ringwald // response sent by hci_run() 400263c0b2fdSMatthias Ringwald conn->authentication_flags |= AUTH_FLAG_HANDLE_LINK_KEY_REQUEST; 400363c0b2fdSMatthias Ringwald #endif 4004608f51bbSMatthias Ringwald break; 40057fde4af9Smatthias.ringwald 40069ab95c90S[email protected] case HCI_EVENT_LINK_KEY_NOTIFICATION: { 40071714cbbdSMatthias Ringwald hci_event_link_key_request_get_bd_addr(packet, addr); 4008f16129ceSMatthias Ringwald conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL); 40099ab95c90S[email protected] if (!conn) break; 40101714cbbdSMatthias Ringwald 40111714cbbdSMatthias Ringwald hci_pairing_complete(conn, ERROR_CODE_SUCCESS); 40121714cbbdSMatthias Ringwald 40133817f9dfSMatthias Ringwald // CVE-2020-26555: ignore NULL link key 40143817f9dfSMatthias Ringwald // default link_key_type = INVALID_LINK_KEY asserts that NULL key won't be used for encryption 40153817f9dfSMatthias Ringwald if (btstack_is_null(&packet[8], 16)) break; 40163817f9dfSMatthias Ringwald 40177bdc6798S[email protected] link_key_type_t link_key_type = (link_key_type_t)packet[24]; 40189ab95c90S[email protected] // Change Connection Encryption keeps link key type 40199ab95c90S[email protected] if (link_key_type != CHANGED_COMBINATION_KEY){ 40209ab95c90S[email protected] conn->link_key_type = link_key_type; 40219ab95c90S[email protected] } 40223817f9dfSMatthias Ringwald 4023e9f98c4aSMatthias Ringwald // cache link key. link keys stored in little-endian format for legacy reasons 4024e9f98c4aSMatthias Ringwald memcpy(&conn->link_key, &packet[8], 16); 4025e9f98c4aSMatthias Ringwald 4026bec5f683SMatthias Ringwald // only store link key: 4027bec5f683SMatthias Ringwald // - if bondable enabled 4028bec5f683SMatthias Ringwald if (hci_stack->bondable == false) break; 4029af411b3fSMatthias Ringwald // - if at least one side requests bonding during the IO Capabilities exchange. 4030af411b3fSMatthias Ringwald // Note: we drop bonding flag in acceptor role if remote doesn't request it 4031af411b3fSMatthias Ringwald bool bonding_local = conn->io_cap_request_auth_req >= SSP_IO_AUTHREQ_MITM_PROTECTION_NOT_REQUIRED_DEDICATED_BONDING; 4032af411b3fSMatthias Ringwald bool bonding_remote = conn->io_cap_response_auth_req >= SSP_IO_AUTHREQ_MITM_PROTECTION_NOT_REQUIRED_DEDICATED_BONDING; 4033af411b3fSMatthias Ringwald if ((bonding_local == false) && (bonding_remote == false)) break; 40346edaed7fSMatthias Ringwald // - if security level sufficient 40356edaed7fSMatthias Ringwald if (gap_security_level_for_link_key_type(link_key_type) < conn->requested_security_level) break; 403655597469SMatthias Ringwald gap_store_link_key_for_bd_addr(addr, &packet[8], conn->link_key_type); 40377fde4af9Smatthias.ringwald break; 40389ab95c90S[email protected] } 40397fde4af9Smatthias.ringwald 40407fde4af9Smatthias.ringwald case HCI_EVENT_PIN_CODE_REQUEST: 40411714cbbdSMatthias Ringwald hci_event_pin_code_request_get_bd_addr(packet, addr); 40421714cbbdSMatthias Ringwald conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL); 40431714cbbdSMatthias Ringwald if (!conn) break; 40441714cbbdSMatthias Ringwald 40451714cbbdSMatthias Ringwald hci_pairing_started(conn, false); 4046a800d95eSMatthias Ringwald // abort pairing if: non-bondable mode (pin code request is not forwarded to app) 40473a9fb326S[email protected] if (!hci_stack->bondable ){ 40488daf94bcSMatthias Ringwald conn->authentication_flags |= AUTH_FLAG_DENY_PIN_CODE_REQUEST; 40491714cbbdSMatthias Ringwald hci_pairing_complete(conn, ERROR_CODE_PAIRING_NOT_ALLOWED); 4050f8fb5f6eS[email protected] hci_run(); 4051f8fb5f6eS[email protected] return; 40524c57c146S[email protected] } 4053a800d95eSMatthias Ringwald // abort pairing if: LEVEL_4 required (pin code request is not forwarded to app) 4054a800d95eSMatthias Ringwald if ((hci_stack->gap_secure_connections_only_mode) || (conn->requested_security_level == LEVEL_4)){ 4055a800d95eSMatthias Ringwald log_info("Level 4 required, but SC not supported -> abort"); 405650dcc63cSMatthias Ringwald conn->authentication_flags |= AUTH_FLAG_DENY_PIN_CODE_REQUEST; 405750dcc63cSMatthias Ringwald hci_pairing_complete(conn, ERROR_CODE_INSUFFICIENT_SECURITY); 405850dcc63cSMatthias Ringwald hci_run(); 405950dcc63cSMatthias Ringwald return; 406050dcc63cSMatthias Ringwald } 40617fde4af9Smatthias.ringwald break; 40627fde4af9Smatthias.ringwald 406350d7398cSMatthias Ringwald case HCI_EVENT_IO_CAPABILITY_RESPONSE: 406450d7398cSMatthias Ringwald hci_event_io_capability_response_get_bd_addr(packet, addr); 406550d7398cSMatthias Ringwald conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL); 406650d7398cSMatthias Ringwald if (!conn) break; 40671714cbbdSMatthias Ringwald 40688daf94bcSMatthias Ringwald hci_add_connection_flags_for_flipped_bd_addr(&packet[2], AUTH_FLAG_RECV_IO_CAPABILITIES_RESPONSE); 40691714cbbdSMatthias Ringwald hci_pairing_started(conn, true); 407050d7398cSMatthias Ringwald conn->io_cap_response_auth_req = hci_event_io_capability_response_get_authentication_requirements(packet); 4071e276e383SMatthias Ringwald conn->io_cap_response_io = hci_event_io_capability_response_get_io_capability(packet); 4072d22b82d6SMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB 4073d22b82d6SMatthias Ringwald conn->io_cap_response_oob_data = hci_event_io_capability_response_get_oob_data_present(packet); 4074d22b82d6SMatthias Ringwald #endif 407550d7398cSMatthias Ringwald break; 407650d7398cSMatthias Ringwald 40771d6b20aeS[email protected] case HCI_EVENT_IO_CAPABILITY_REQUEST: 40781714cbbdSMatthias Ringwald hci_event_io_capability_response_get_bd_addr(packet, addr); 40791714cbbdSMatthias Ringwald conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL); 40801714cbbdSMatthias Ringwald if (!conn) break; 40811714cbbdSMatthias Ringwald 4082c950c316SMatthias Ringwald hci_add_connection_flags_for_flipped_bd_addr(&packet[2], AUTH_FLAG_RECV_IO_CAPABILITIES_REQUEST); 40839671e615SMatthias Ringwald hci_connection_timestamp(conn); 40841714cbbdSMatthias Ringwald hci_pairing_started(conn, true); 4085dbe1a790S[email protected] break; 4086dbe1a790S[email protected] 40871849becdSMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB 40881849becdSMatthias Ringwald case HCI_EVENT_REMOTE_OOB_DATA_REQUEST: 40897ca4a7edSMatthias Ringwald hci_event_remote_oob_data_request_get_bd_addr(packet, addr); 40907ca4a7edSMatthias Ringwald conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL); 40917ca4a7edSMatthias Ringwald if (!conn) break; 40927ca4a7edSMatthias Ringwald 40937ca4a7edSMatthias Ringwald hci_connection_timestamp(conn); 40947ca4a7edSMatthias Ringwald 40957ca4a7edSMatthias Ringwald hci_pairing_started(conn, true); 40967ca4a7edSMatthias Ringwald 40977ca4a7edSMatthias Ringwald connectionSetAuthenticationFlags(conn, AUTH_FLAG_SEND_REMOTE_OOB_DATA_REPLY); 40981849becdSMatthias Ringwald break; 40991849becdSMatthias Ringwald #endif 41001849becdSMatthias Ringwald 4101dbe1a790S[email protected] case HCI_EVENT_USER_CONFIRMATION_REQUEST: 410217c6fe5cSMatthias Ringwald hci_event_user_confirmation_request_get_bd_addr(packet, addr); 4103367aedc0SMatthias Ringwald conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL); 4104367aedc0SMatthias Ringwald if (!conn) break; 4105367aedc0SMatthias Ringwald if (hci_ssp_security_level_possible_for_io_cap(conn->requested_security_level, hci_stack->ssp_io_capability, conn->io_cap_response_io)) { 4106367aedc0SMatthias Ringwald if (hci_stack->ssp_auto_accept){ 41078daf94bcSMatthias Ringwald hci_add_connection_flags_for_flipped_bd_addr(&packet[2], AUTH_FLAG_SEND_USER_CONFIRM_REPLY); 4108367aedc0SMatthias Ringwald }; 4109367aedc0SMatthias Ringwald } else { 4110367aedc0SMatthias Ringwald hci_pairing_complete(conn, ERROR_CODE_INSUFFICIENT_SECURITY); 4111367aedc0SMatthias Ringwald hci_add_connection_flags_for_flipped_bd_addr(&packet[2], AUTH_FLAG_SEND_USER_CONFIRM_NEGATIVE_REPLY); 4112367aedc0SMatthias Ringwald // don't forward event to app 4113367aedc0SMatthias Ringwald hci_run(); 4114367aedc0SMatthias Ringwald return; 4115367aedc0SMatthias Ringwald } 4116dbe1a790S[email protected] break; 4117dbe1a790S[email protected] 4118dbe1a790S[email protected] case HCI_EVENT_USER_PASSKEY_REQUEST: 4119367aedc0SMatthias Ringwald // Pairing using Passkey results in MITM protection. If Level 4 is required, support for SC is validated on IO Cap Request 4120367aedc0SMatthias Ringwald if (hci_stack->ssp_auto_accept){ 41218daf94bcSMatthias Ringwald hci_add_connection_flags_for_flipped_bd_addr(&packet[2], AUTH_FLAG_SEND_USER_PASSKEY_REPLY); 4122367aedc0SMatthias Ringwald }; 41231d6b20aeS[email protected] break; 41241849becdSMatthias Ringwald 41253dce6128SMatthias Ringwald case HCI_EVENT_MODE_CHANGE: 41263dce6128SMatthias Ringwald handle = hci_event_mode_change_get_handle(packet); 41273dce6128SMatthias Ringwald conn = hci_connection_for_handle(handle); 41283dce6128SMatthias Ringwald if (!conn) break; 41293dce6128SMatthias Ringwald conn->connection_mode = hci_event_mode_change_get_mode(packet); 41303dce6128SMatthias Ringwald log_info("HCI_EVENT_MODE_CHANGE, handle 0x%04x, mode %u", handle, conn->connection_mode); 41313dce6128SMatthias Ringwald break; 413235454696SMatthias Ringwald #endif 41331d6b20aeS[email protected] 4134f0944df2S[email protected] case HCI_EVENT_ENCRYPTION_CHANGE: 4135a355334eSMatthias Ringwald case HCI_EVENT_ENCRYPTION_CHANGE_V2: 4136254b78eeSMatthias Ringwald handle = hci_event_encryption_change_get_connection_handle(packet); 4137f0944df2S[email protected] conn = hci_connection_for_handle(handle); 4138f0944df2S[email protected] if (!conn) break; 4139db3c1f89SMatthias Ringwald if (hci_event_encryption_change_get_status(packet) == ERROR_CODE_SUCCESS) { 4140254b78eeSMatthias Ringwald uint8_t encryption_enabled = hci_event_encryption_change_get_encryption_enabled(packet); 4141254b78eeSMatthias Ringwald if (encryption_enabled){ 4142573897a0SMatthias Ringwald if (hci_is_le_connection(conn)){ 4143573897a0SMatthias Ringwald // For LE, we accept connection as encrypted 41448daf94bcSMatthias Ringwald conn->authentication_flags |= AUTH_FLAG_CONNECTION_ENCRYPTED; 4145573897a0SMatthias Ringwald } 4146573897a0SMatthias Ringwald #ifdef ENABLE_CLASSIC 4147573897a0SMatthias Ringwald else { 4148fcaf38b9SMatthias Ringwald 4149254b78eeSMatthias Ringwald // Detect Secure Connection -> Legacy Connection Downgrade Attack (BIAS) 415036c3546bSMatthias Ringwald bool sc_used_during_pairing = gap_secure_connection_for_link_key_type(conn->link_key_type); 4151254b78eeSMatthias Ringwald bool connected_uses_aes_ccm = encryption_enabled == 2; 4152edc1ac20SMatthias Ringwald if (hci_stack->secure_connections_active && sc_used_during_pairing && !connected_uses_aes_ccm){ 4153813a09c6SMatthias Ringwald #ifdef ENABLE_TESTING_SUPPORT 4154813a09c6SMatthias Ringwald // The following tests require to reject L2CAP connection as SC has been disabled on the remote 4155813a09c6SMatthias Ringwald // - GAP/SEC/SEM/BI-31-C 4156813a09c6SMatthias Ringwald // - GAP/SEC/SEM/BI-32-C 4157813a09c6SMatthias Ringwald // - GAP/SEC/SEM/BI-33-C 4158813a09c6SMatthias Ringwald 4159813a09c6SMatthias Ringwald // Our release code (aggressively) disconnects the HCI connection, without a chance to respond to PTS 4160813a09c6SMatthias Ringwald // To pass the tests, we only downgrade the link key type instead of the more secure disconnect 416129d4766dSMatthias Ringwald link_key_type_t new_link_key_type = UNAUTHENTICATED_COMBINATION_KEY_GENERATED_FROM_P192; 416229d4766dSMatthias Ringwald if (conn->link_key_type == AUTHENTICATED_COMBINATION_KEY_GENERATED_FROM_P256){ 4163813a09c6SMatthias Ringwald new_link_key_type = AUTHENTICATED_COMBINATION_KEY_GENERATED_FROM_P192; 4164813a09c6SMatthias Ringwald } 4165813a09c6SMatthias Ringwald log_info("SC during pairing, but only E0 now -> downgrade link key type from %u to %u", 4166813a09c6SMatthias Ringwald conn->link_key_type, new_link_key_type); 4167813a09c6SMatthias Ringwald conn->link_key_type = new_link_key_type; 4168813a09c6SMatthias Ringwald #else 4169254b78eeSMatthias Ringwald log_info("SC during pairing, but only E0 now -> abort"); 41709ece71c2SMatthias Ringwald conn->bonding_flags |= BONDING_DISCONNECT_SECURITY_BLOCK; 4171254b78eeSMatthias Ringwald break; 4172813a09c6SMatthias Ringwald #endif 4173254b78eeSMatthias Ringwald } 4174254b78eeSMatthias Ringwald 417562daa441SMatthias Ringwald #ifdef ENABLE_MUTUAL_AUTHENTICATION_FOR_LEGACY_SECURE_CONNECTIONS 4176aa2fe986SMatthias Ringwald // if AES-CCM is used, authentication used SC -> authentication was mutual and we can skip explicit authentication 4177aa2fe986SMatthias Ringwald if (connected_uses_aes_ccm){ 4178aa2fe986SMatthias Ringwald conn->authentication_flags |= AUTH_FLAG_CONNECTION_AUTHENTICATED; 4179aa2fe986SMatthias Ringwald } 418062daa441SMatthias Ringwald #else 418162daa441SMatthias Ringwald // We consider even Legacy Secure Connections as authenticated as BTstack mandates encryption 4182a086dc35SMatthias Ringwald // with encryption key size > hci_stack->gap_required_encryption_key_size 418362daa441SMatthias Ringwald // for all operations that require any security. See BIAS attacks. 4184aa2fe986SMatthias Ringwald conn->authentication_flags |= AUTH_FLAG_CONNECTION_AUTHENTICATED; 4185aa2fe986SMatthias Ringwald #endif 4186a355334eSMatthias Ringwald // validate encryption key size 4187a355334eSMatthias Ringwald if (hci_event_packet_get_type(packet) == HCI_EVENT_ENCRYPTION_CHANGE_V2) { 4188a355334eSMatthias Ringwald uint8_t encryption_key_size = hci_event_encryption_change_v2_get_encryption_key_size(packet); 4189a355334eSMatthias Ringwald // already got encryption key size 4190a355334eSMatthias Ringwald hci_handle_read_encryption_key_size_complete(conn, encryption_key_size); 4191a355334eSMatthias Ringwald } else { 41921ffa425cSMatthias Ringwald if (hci_command_supported(SUPPORTED_HCI_COMMAND_READ_ENCRYPTION_KEY_SIZE)) { 41936e058d3fSMatthias Ringwald // For Classic, we need to validate encryption key size first, if possible (== supported by Controller) 4194573897a0SMatthias Ringwald conn->bonding_flags |= BONDING_SEND_READ_ENCRYPTION_KEY_SIZE; 41956e058d3fSMatthias Ringwald } else { 41966e058d3fSMatthias Ringwald // if not, pretend everything is perfect 41979866fdc7SMatthias Ringwald hci_handle_read_encryption_key_size_complete(conn, 16); 41986e058d3fSMatthias Ringwald } 4199573897a0SMatthias Ringwald } 4200a355334eSMatthias Ringwald } 4201573897a0SMatthias Ringwald #endif 4202f0944df2S[email protected] } else { 42038daf94bcSMatthias Ringwald conn->authentication_flags &= ~AUTH_FLAG_CONNECTION_ENCRYPTED; 4204f0944df2S[email protected] } 42055999ee11SMatthias Ringwald } else { 42068eae094cSMatthias Ringwald #ifdef ENABLE_CLASSIC 42078eae094cSMatthias Ringwald if (!hci_is_le_connection(conn)){ 42085999ee11SMatthias Ringwald uint8_t status = hci_event_encryption_change_get_status(packet); 42095999ee11SMatthias Ringwald if ((conn->bonding_flags & BONDING_DEDICATED) != 0){ 42105999ee11SMatthias Ringwald conn->bonding_flags &= ~BONDING_DEDICATED; 42115999ee11SMatthias Ringwald conn->bonding_flags |= BONDING_DISCONNECT_DEDICATED_DONE; 42125999ee11SMatthias Ringwald conn->bonding_status = status; 42135999ee11SMatthias Ringwald } 421427b992efSMatthias Ringwald // trigger security update -> level 0 421527b992efSMatthias Ringwald hci_handle_mutual_authentication_completed(conn); 4216ad83dc6aS[email protected] } 42178eae094cSMatthias Ringwald #endif 42188eae094cSMatthias Ringwald } 4219573897a0SMatthias Ringwald 4220f0944df2S[email protected] break; 4221f0944df2S[email protected] 422235454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 42231eb2563eS[email protected] case HCI_EVENT_AUTHENTICATION_COMPLETE_EVENT: 4224abdad579SMatthias Ringwald handle = hci_event_authentication_complete_get_connection_handle(packet); 42251eb2563eS[email protected] conn = hci_connection_for_handle(handle); 42261eb2563eS[email protected] if (!conn) break; 4227ad83dc6aS[email protected] 4228dbd5dcc3SMatthias Ringwald // clear authentication active flag 4229dbd5dcc3SMatthias Ringwald conn->bonding_flags &= ~BONDING_SENT_AUTHENTICATE_REQUEST; 42301714cbbdSMatthias Ringwald hci_pairing_complete(conn, hci_event_authentication_complete_get_status(packet)); 4231dbd5dcc3SMatthias Ringwald 4232abdad579SMatthias Ringwald // authenticated only if auth status == 0 4233abdad579SMatthias Ringwald if (hci_event_authentication_complete_get_status(packet) == 0){ 4234abdad579SMatthias Ringwald // authenticated 42358daf94bcSMatthias Ringwald conn->authentication_flags |= AUTH_FLAG_CONNECTION_AUTHENTICATED; 4236abdad579SMatthias Ringwald 4237131ef17aSMatthias Ringwald // If not already encrypted, start encryption 42388daf94bcSMatthias Ringwald if ((conn->authentication_flags & AUTH_FLAG_CONNECTION_ENCRYPTED) == 0){ 42391eb2563eS[email protected] conn->bonding_flags |= BONDING_SEND_ENCRYPTION_REQUEST; 4240ad83dc6aS[email protected] break; 4241ad83dc6aS[email protected] } 4242abdad579SMatthias Ringwald } 4243abdad579SMatthias Ringwald 42444aa2f135SMatthias Ringwald // emit updated security level (will be 0 if not authenticated) 42454aa2f135SMatthias Ringwald hci_handle_mutual_authentication_completed(conn); 42461eb2563eS[email protected] break; 42471714cbbdSMatthias Ringwald 42481714cbbdSMatthias Ringwald case HCI_EVENT_SIMPLE_PAIRING_COMPLETE: 42491714cbbdSMatthias Ringwald hci_event_simple_pairing_complete_get_bd_addr(packet, addr); 42501714cbbdSMatthias Ringwald conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL); 42511714cbbdSMatthias Ringwald if (!conn) break; 42521714cbbdSMatthias Ringwald 4253aa2fe986SMatthias Ringwald // treat successfully paired connection as authenticated 4254aa2fe986SMatthias Ringwald if (hci_event_simple_pairing_complete_get_status(packet) == ERROR_CODE_SUCCESS){ 4255f3aafff1SMatthias Ringwald conn->authentication_flags |= AUTH_FLAG_CONNECTION_AUTHENTICATED; 4256aa2fe986SMatthias Ringwald } 4257aa2fe986SMatthias Ringwald 42581714cbbdSMatthias Ringwald hci_pairing_complete(conn, hci_event_simple_pairing_complete_get_status(packet)); 42591714cbbdSMatthias Ringwald break; 426035454696SMatthias Ringwald #endif 426134d2123cS[email protected] 426286805605S[email protected] // HCI_EVENT_DISCONNECTION_COMPLETE 4263ccda6e14S[email protected] // has been split, to first notify stack before shutting connection down 4264ccda6e14S[email protected] // see end of function, too. 4265a4f30ec0S[email protected] case HCI_EVENT_DISCONNECTION_COMPLETE: 4266a4f30ec0S[email protected] if (packet[2]) break; // status != 0 4267f8fbdce0SMatthias Ringwald handle = little_endian_read_16(packet, 3); 426881d2bdb2SMatthias Ringwald // drop outgoing ACL fragments if it is for closed connection and release buffer if tx not active 42694ea43905SMatthias Ringwald if (hci_stack->acl_fragmentation_total_size > 0u) { 4270c6a37cfdSMatthias Ringwald if (handle == READ_ACL_CONNECTION_HANDLE(hci_stack->hci_packet_buffer)){ 42714ea43905SMatthias Ringwald int release_buffer = hci_stack->acl_fragmentation_tx_active == 0u; 427281d2bdb2SMatthias Ringwald log_info("drop fragmented ACL data for closed connection, release buffer %u", release_buffer); 4273c6a37cfdSMatthias Ringwald hci_stack->acl_fragmentation_total_size = 0; 4274c6a37cfdSMatthias Ringwald hci_stack->acl_fragmentation_pos = 0; 427581d2bdb2SMatthias Ringwald if (release_buffer){ 427681d2bdb2SMatthias Ringwald hci_release_packet_buffer(); 427781d2bdb2SMatthias Ringwald } 4278c6a37cfdSMatthias Ringwald } 4279c6a37cfdSMatthias Ringwald } 428035454696SMatthias Ringwald 42814ae8623eSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS 4282098c2716SMatthias Ringwald // drop outgoing ISO fragments if it is for closed connection and release buffer if tx not active 4283098c2716SMatthias Ringwald if (hci_stack->iso_fragmentation_total_size > 0u) { 4284098c2716SMatthias Ringwald if (handle == READ_ISO_CONNECTION_HANDLE(hci_stack->hci_packet_buffer)){ 4285098c2716SMatthias Ringwald int release_buffer = hci_stack->iso_fragmentation_tx_active == 0u; 4286098c2716SMatthias Ringwald log_info("drop fragmented ISO data for closed connection, release buffer %u", release_buffer); 4287098c2716SMatthias Ringwald hci_stack->iso_fragmentation_total_size = 0; 4288098c2716SMatthias Ringwald hci_stack->iso_fragmentation_pos = 0; 4289098c2716SMatthias Ringwald if (release_buffer){ 4290098c2716SMatthias Ringwald hci_release_packet_buffer(); 4291098c2716SMatthias Ringwald } 4292098c2716SMatthias Ringwald } 4293098c2716SMatthias Ringwald } 4294098c2716SMatthias Ringwald 42956fd1d2c8SMatthias Ringwald // finalize iso stream for CIS handle 429615a15be3SMatthias Ringwald iso_stream = hci_iso_stream_for_con_handle(handle); 42974ae8623eSMatthias Ringwald if (iso_stream != NULL){ 42984ae8623eSMatthias Ringwald hci_iso_stream_finalize(iso_stream); 42994ae8623eSMatthias Ringwald break; 43004ae8623eSMatthias Ringwald } 43014ae8623eSMatthias Ringwald #endif 43024ae8623eSMatthias Ringwald 430391036612SMatthias Ringwald #if defined(ENABLE_BLE) && defined (ENABLE_HCI_COMMAND_STATUS_DISCARDED_FOR_FAILED_CONNECTIONS_WORKAROUND) 4304f48a5586SMatthias Ringwald if ((handle != HCI_CON_HANDLE_INVALID) && (handle == hci_stack->hci_command_con_handle)){ 4305f48a5586SMatthias Ringwald // we did not receive a HCI Command Complete or HCI Command Status event for the disconnected connection 4306f48a5586SMatthias Ringwald // if needed, we could also track the hci command opcode and simulate a hci command complete with status 4307f48a5586SMatthias Ringwald // but the connection has failed anyway, so for now, we only set the num hci commands back to 1 430805acf48bSMatthias Ringwald log_info("Disconnect for conn handle 0x%04x in pending HCI command, assume command failed", handle); 430905acf48bSMatthias Ringwald hci_stack->hci_command_con_handle = HCI_CON_HANDLE_INVALID; 4310f48a5586SMatthias Ringwald hci_stack->num_cmd_packets = 1; 4311f48a5586SMatthias Ringwald } 4312f48a5586SMatthias Ringwald #endif 4313f48a5586SMatthias Ringwald 4314c6a37cfdSMatthias Ringwald conn = hci_connection_for_handle(handle); 4315c6a37cfdSMatthias Ringwald if (!conn) break; 43161714cbbdSMatthias Ringwald #ifdef ENABLE_CLASSIC 43171714cbbdSMatthias Ringwald // pairing failed if it was ongoing 43181714cbbdSMatthias Ringwald hci_pairing_complete(conn, ERROR_CODE_REMOTE_USER_TERMINATED_CONNECTION); 43191714cbbdSMatthias Ringwald #endif 4320046ec007SMatthias Ringwald 4321a086dc35SMatthias Ringwald // emit dedicated bonding event 4322046ec007SMatthias Ringwald if (conn->bonding_flags & BONDING_EMIT_COMPLETE_ON_DISCONNECT){ 4323046ec007SMatthias Ringwald hci_emit_dedicated_bonding_result(conn->address, conn->bonding_status); 4324046ec007SMatthias Ringwald } 4325046ec007SMatthias Ringwald 4326459d27b9SMatthias Ringwald // mark connection for shutdown, stop timers, reset state 4327459d27b9SMatthias Ringwald conn->state = RECEIVED_DISCONNECTION_COMPLETE; 4328459d27b9SMatthias Ringwald hci_connection_stop_timer(conn); 4329459d27b9SMatthias Ringwald hci_connection_init(conn); 4330459d27b9SMatthias Ringwald 433135454696SMatthias Ringwald #ifdef ENABLE_BLE 4332d70217a2SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 4333046ec007SMatthias Ringwald // re-enable advertisements for le connections if active 43342b6ab3e6SMatthias Ringwald if (hci_is_le_connection(conn)){ 4335bbc366e6SMatthias Ringwald hci_update_advertisements_enabled_for_current_roles(); 43369a2e4658SMatthias Ringwald } 433735454696SMatthias Ringwald #endif 4338d70217a2SMatthias Ringwald #endif 4339ccda6e14S[email protected] break; 43406772a24cSmatthias.ringwald 4341c68bdf90Smatthias.ringwald case HCI_EVENT_HARDWARE_ERROR: 4342313e5f9cSMatthias Ringwald log_error("Hardware Error: 0x%02x", packet[2]); 4343d23838ecSMatthias Ringwald if (hci_stack->hardware_error_callback){ 4344c2e1fa60SMatthias Ringwald (*hci_stack->hardware_error_callback)(packet[2]); 43457586ee35S[email protected] } else { 43467586ee35S[email protected] // if no special requests, just reboot stack 43477586ee35S[email protected] hci_power_control_off(); 43487586ee35S[email protected] hci_power_control_on(); 4349c68bdf90Smatthias.ringwald } 4350c68bdf90Smatthias.ringwald break; 4351c68bdf90Smatthias.ringwald 43520e6f3837SMatthias Ringwald #ifdef ENABLE_CLASSIC 43535cf766e8SMatthias Ringwald case HCI_EVENT_ROLE_CHANGE: 43545cf766e8SMatthias Ringwald if (packet[2]) break; // status != 0 4355c4c88f1bSJakob Krantz reverse_bd_addr(&packet[3], addr); 4356f16129ceSMatthias Ringwald addr_type = BD_ADDR_TYPE_ACL; 4357c4c88f1bSJakob Krantz conn = hci_connection_for_bd_addr_and_type(addr, addr_type); 4358c4c88f1bSJakob Krantz if (!conn) break; 435988f925b1SMatthias Ringwald conn->role = (hci_role_t) packet[9]; 43605cf766e8SMatthias Ringwald break; 43610e6f3837SMatthias Ringwald #endif 43625cf766e8SMatthias Ringwald 436363fa3374SMatthias Ringwald case HCI_EVENT_TRANSPORT_PACKET_SENT: 4364098c2716SMatthias Ringwald // release packet buffer only for asynchronous transport and if there are not further fragments 43654fa24b5fS[email protected] if (hci_transport_synchronous()) { 436663fa3374SMatthias Ringwald log_error("Synchronous HCI Transport shouldn't send HCI_EVENT_TRANSPORT_PACKET_SENT"); 43674fa24b5fS[email protected] return; // instead of break: to avoid re-entering hci_run() 43684fa24b5fS[email protected] } 436981d2bdb2SMatthias Ringwald hci_stack->acl_fragmentation_tx_active = 0; 4370098c2716SMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS 4371098c2716SMatthias Ringwald hci_stack->iso_fragmentation_tx_active = 0; 4372098c2716SMatthias Ringwald if (hci_stack->iso_fragmentation_total_size) break; 4373098c2716SMatthias Ringwald #endif 4374d051460cS[email protected] if (hci_stack->acl_fragmentation_total_size) break; 43755daaa52eSMatthias Ringwald 43765daaa52eSMatthias Ringwald // release packet buffer without HCI_EVENT_TRANSPORT_PACKET_SENT (as it will be later) 43775daaa52eSMatthias Ringwald hci_stack->hci_packet_buffer_reserved = false; 4378701e3307SMatthias Ringwald 43795ade6657SMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS 43805ade6657SMatthias Ringwald hci_iso_notify_can_send_now(); 43815ade6657SMatthias Ringwald #endif 438263fa3374SMatthias Ringwald // L2CAP receives this event via the hci_emit_event below 438363fa3374SMatthias Ringwald 438435454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 438563fa3374SMatthias Ringwald // For SCO, we do the can_send_now_check here 4386701e3307SMatthias Ringwald hci_notify_if_sco_can_send_now(); 438735454696SMatthias Ringwald #endif 43886b4af23dS[email protected] break; 43896b4af23dS[email protected] 439035454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 439163fa3374SMatthias Ringwald case HCI_EVENT_SCO_CAN_SEND_NOW: 439263fa3374SMatthias Ringwald // For SCO, we do the can_send_now_check here 43931972f31fSMatthias Ringwald hci_stack->sco_can_send_now = true; 439463fa3374SMatthias Ringwald hci_notify_if_sco_can_send_now(); 439563fa3374SMatthias Ringwald return; 43961cfb383eSMatthias Ringwald 4397a086dc35SMatthias Ringwald // explode inquiry results for easier consumption 43981cfb383eSMatthias Ringwald case HCI_EVENT_INQUIRY_RESULT: 43991cfb383eSMatthias Ringwald case HCI_EVENT_INQUIRY_RESULT_WITH_RSSI: 44001cfb383eSMatthias Ringwald case HCI_EVENT_EXTENDED_INQUIRY_RESPONSE: 44019784dac1SMatthias Ringwald gap_inquiry_explode(packet, size); 44021cfb383eSMatthias Ringwald break; 440335454696SMatthias Ringwald #endif 440463fa3374SMatthias Ringwald 4405a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE 44065909f7f2Smatthias.ringwald case HCI_EVENT_LE_META: 44075909f7f2Smatthias.ringwald switch (packet[2]){ 4408d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 440957c9da5bS[email protected] case HCI_SUBEVENT_LE_ADVERTISING_REPORT: 44106fab74dbSMatthias Ringwald if (!hci_stack->le_scanning_enabled) break; 441157c9da5bS[email protected] le_handle_advertisement_report(packet, size); 44127bdc6798S[email protected] break; 4413a0698cb4SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 4414a0698cb4SMatthias Ringwald case HCI_SUBEVENT_LE_EXTENDED_ADVERTISING_REPORT: 4415a0698cb4SMatthias Ringwald if (!hci_stack->le_scanning_enabled) break; 4416a0698cb4SMatthias Ringwald le_handle_extended_advertisement_report(packet, size); 4417a0698cb4SMatthias Ringwald break; 4418ce56b945SMatthias Ringwald case HCI_SUBEVENT_LE_PERIODIC_ADVERTISING_SYNC_ESTABLISHMENT: 4419ce56b945SMatthias Ringwald hci_stack->le_periodic_sync_request = LE_CONNECTING_IDLE; 4420ce56b945SMatthias Ringwald hci_stack->le_periodic_sync_state = LE_CONNECTING_IDLE; 4421ce56b945SMatthias Ringwald break; 442289254d99SMatthias Ringwald case HCI_SUBEVENT_LE_ADVERTISING_SET_TERMINATED: 442389254d99SMatthias Ringwald advertising_handle = hci_subevent_le_advertising_set_terminated_get_advertising_handle(packet); 44242daa339aSMatthias Ringwald if (advertising_handle == LE_EXTENDED_ADVERTISING_LEGACY_HANDLE){ 44252daa339aSMatthias Ringwald // legacy advertisements 44262daa339aSMatthias Ringwald hci_stack->le_advertisements_state &= ~LE_ADVERTISEMENT_STATE_ACTIVE; 44272daa339aSMatthias Ringwald hci_update_advertisements_enabled_for_current_roles(); 44282daa339aSMatthias Ringwald } else { 442989254d99SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->le_advertising_sets); 443089254d99SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)) { 443189254d99SMatthias Ringwald le_advertising_set_t *advertising_set = (le_advertising_set_t *) btstack_linked_list_iterator_next(&it); 443289254d99SMatthias Ringwald if (advertising_set->advertising_handle == advertising_handle){ 443389254d99SMatthias Ringwald advertising_set->state &= ~(LE_ADVERTISEMENT_STATE_ACTIVE | LE_ADVERTISEMENT_STATE_ENABLED); 443489254d99SMatthias Ringwald } 443589254d99SMatthias Ringwald } 44362775f8e2SMatthias Ringwald } 4437f7043595SMatthias Ringwald // event may come before le connection complete and announces new connection 4438f7043595SMatthias Ringwald if (hci_subevent_le_advertising_set_terminated_get_status(packet) == ERROR_CODE_SUCCESS){ 4439f7043595SMatthias Ringwald handle = hci_subevent_le_advertising_set_terminated_get_connection_handle(packet); 4440f7043595SMatthias Ringwald conn = hci_connection_for_handle(handle); 4441f7043595SMatthias Ringwald if (conn == NULL){ 444294791381SMatthias Ringwald // use placeholder address for peer, will be overwritten in hci_handle_le_connection_complete_event() 444394791381SMatthias Ringwald bd_addr_t addr; 444494791381SMatthias Ringwald memset(addr, 0, 6); 444594791381SMatthias Ringwald conn = create_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_UNKNOWN, HCI_ROLE_SLAVE); 4446f7043595SMatthias Ringwald if (conn != NULL){ 4447f7043595SMatthias Ringwald conn->state = ANNOUNCED; 4448f7043595SMatthias Ringwald conn->con_handle = handle; 4449f7043595SMatthias Ringwald } 4450f7043595SMatthias Ringwald } 4451f7043595SMatthias Ringwald } 445289254d99SMatthias Ringwald break; 4453a0698cb4SMatthias Ringwald #endif 4454d70217a2SMatthias Ringwald #endif 44555909f7f2Smatthias.ringwald case HCI_SUBEVENT_LE_CONNECTION_COMPLETE: 445660fb273dSMatthias Ringwald case HCI_SUBEVENT_LE_ENHANCED_CONNECTION_COMPLETE_V1: 445760fb273dSMatthias Ringwald case HCI_SUBEVENT_LE_ENHANCED_CONNECTION_COMPLETE_V2: 4458688bcdb4SMatthias Ringwald hci_handle_le_connection_complete_event(packet); 44595909f7f2Smatthias.ringwald break; 44605909f7f2Smatthias.ringwald 4461f8fbdce0SMatthias Ringwald // log_info("LE buffer size: %u, count %u", little_endian_read_16(packet,6), packet[8]); 4462c9db5c21SMilanka Ringwald case HCI_SUBEVENT_LE_CONNECTION_UPDATE_COMPLETE: 4463c9db5c21SMilanka Ringwald handle = hci_subevent_le_connection_update_complete_get_connection_handle(packet); 4464c9db5c21SMilanka Ringwald conn = hci_connection_for_handle(handle); 4465c9db5c21SMilanka Ringwald if (!conn) break; 4466c9db5c21SMilanka Ringwald conn->le_connection_interval = hci_subevent_le_connection_update_complete_get_conn_interval(packet); 4467c9db5c21SMilanka Ringwald break; 446865a46ef3S[email protected] 446973cd8a2aSMatthias Ringwald case HCI_SUBEVENT_LE_REMOTE_CONNECTION_PARAMETER_REQUEST: 447073cd8a2aSMatthias Ringwald // connection 447173cd8a2aSMatthias Ringwald handle = hci_subevent_le_remote_connection_parameter_request_get_connection_handle(packet); 447273cd8a2aSMatthias Ringwald conn = hci_connection_for_handle(handle); 447373cd8a2aSMatthias Ringwald if (conn) { 447473cd8a2aSMatthias Ringwald // read arguments 447573cd8a2aSMatthias Ringwald uint16_t le_conn_interval_min = hci_subevent_le_remote_connection_parameter_request_get_interval_min(packet); 447673cd8a2aSMatthias Ringwald uint16_t le_conn_interval_max = hci_subevent_le_remote_connection_parameter_request_get_interval_max(packet); 447773cd8a2aSMatthias Ringwald uint16_t le_conn_latency = hci_subevent_le_remote_connection_parameter_request_get_latency(packet); 447873cd8a2aSMatthias Ringwald uint16_t le_supervision_timeout = hci_subevent_le_remote_connection_parameter_request_get_timeout(packet); 447973cd8a2aSMatthias Ringwald 448073cd8a2aSMatthias Ringwald // validate against current connection parameter range 448173cd8a2aSMatthias Ringwald le_connection_parameter_range_t existing_range; 448273cd8a2aSMatthias Ringwald gap_get_connection_parameter_range(&existing_range); 448373cd8a2aSMatthias 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); 448473cd8a2aSMatthias Ringwald if (update_parameter){ 448573cd8a2aSMatthias Ringwald conn->le_con_parameter_update_state = CON_PARAMETER_UPDATE_REPLY; 448673cd8a2aSMatthias Ringwald conn->le_conn_interval_min = le_conn_interval_min; 448773cd8a2aSMatthias Ringwald conn->le_conn_interval_max = le_conn_interval_max; 448873cd8a2aSMatthias Ringwald conn->le_conn_latency = le_conn_latency; 448973cd8a2aSMatthias Ringwald conn->le_supervision_timeout = le_supervision_timeout; 449073cd8a2aSMatthias Ringwald } else { 4491c3898ca4SMatthias Ringwald conn->le_con_parameter_update_state = CON_PARAMETER_UPDATE_NEGATIVE_REPLY; 449273cd8a2aSMatthias Ringwald } 449373cd8a2aSMatthias Ringwald } 449473cd8a2aSMatthias Ringwald break; 44950f3b27c5SMatthias Ringwald #ifdef ENABLE_LE_LIMIT_ACL_FRAGMENT_BY_MAX_OCTETS 44960f3b27c5SMatthias Ringwald case HCI_SUBEVENT_LE_DATA_LENGTH_CHANGE: 44970f3b27c5SMatthias Ringwald handle = hci_subevent_le_data_length_change_get_connection_handle(packet); 44980f3b27c5SMatthias Ringwald conn = hci_connection_for_handle(handle); 44990f3b27c5SMatthias Ringwald if (conn) { 45000f3b27c5SMatthias Ringwald conn->le_max_tx_octets = hci_subevent_le_data_length_change_get_max_tx_octets(packet); 45010f3b27c5SMatthias Ringwald } 45020f3b27c5SMatthias Ringwald break; 45030f3b27c5SMatthias Ringwald #endif 45044ae8623eSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS 45056fd1d2c8SMatthias Ringwald case HCI_SUBEVENT_LE_CIS_REQUEST: 45066fd1d2c8SMatthias Ringwald // incoming CIS request, allocate iso stream object and cache metadata 45076fd1d2c8SMatthias Ringwald iso_stream = hci_iso_stream_create(HCI_ISO_TYPE_CIS, HCI_ISO_STREAM_W4_USER, 45086fd1d2c8SMatthias Ringwald hci_subevent_le_cis_request_get_cig_id(packet), 45096fd1d2c8SMatthias Ringwald hci_subevent_le_cis_request_get_cis_id(packet)); 45106fd1d2c8SMatthias Ringwald // if there's no memory, gap_cis_accept/gap_cis_reject will fail 45116fd1d2c8SMatthias Ringwald if (iso_stream != NULL){ 45126fd1d2c8SMatthias Ringwald iso_stream->cis_handle = hci_subevent_le_cis_request_get_cis_connection_handle(packet); 45136fd1d2c8SMatthias Ringwald iso_stream->acl_handle = hci_subevent_le_cis_request_get_acl_connection_handle(packet); 45146fd1d2c8SMatthias Ringwald } 45156fd1d2c8SMatthias Ringwald break; 45164ae8623eSMatthias Ringwald case HCI_SUBEVENT_LE_CIS_ESTABLISHED: 45178e58e4f7SMatthias Ringwald if (hci_stack->iso_active_operation_type == HCI_ISO_TYPE_CIS){ 45184ae8623eSMatthias Ringwald handle = hci_subevent_le_cis_established_get_connection_handle(packet); 45194ae8623eSMatthias Ringwald uint8_t status = hci_subevent_le_cis_established_get_status(packet); 45208e58e4f7SMatthias Ringwald iso_stream = hci_iso_stream_for_con_handle(handle); 45218e58e4f7SMatthias Ringwald btstack_assert(iso_stream != NULL); 45227dd97f73SMatthias Ringwald // track connection info 45237dd97f73SMatthias Ringwald iso_stream->number_of_subevents = hci_subevent_le_cis_established_get_nse(packet); 45247dd97f73SMatthias Ringwald iso_stream->burst_number_c_to_p = hci_subevent_le_cis_established_get_bn_c_to_p(packet); 45257dd97f73SMatthias Ringwald iso_stream->burst_number_p_to_c = hci_subevent_le_cis_established_get_bn_p_to_c(packet); 45267dd97f73SMatthias Ringwald iso_stream->flush_timeout_c_to_p = hci_subevent_le_cis_established_get_ft_c_to_p(packet); 45277dd97f73SMatthias Ringwald iso_stream->flush_timeout_p_to_c = hci_subevent_le_cis_established_get_ft_p_to_c(packet); 452826b93350SMatthias Ringwald iso_stream->max_sdu_c_to_p = hci_subevent_le_cis_established_get_max_pdu_c_to_p(packet); 452926b93350SMatthias Ringwald iso_stream->max_sdu_p_to_c = hci_subevent_le_cis_established_get_max_pdu_p_to_c(packet); 45307dd97f73SMatthias Ringwald iso_stream->iso_interval_1250us = hci_subevent_le_cis_established_get_iso_interval(packet); 453126b93350SMatthias Ringwald if (hci_stack->iso_active_operation_group_id == HCI_ISO_GROUP_ID_SINGLE_CIS){ 453226b93350SMatthias Ringwald // CIS Accept by Peripheral 453326b93350SMatthias Ringwald if (status == ERROR_CODE_SUCCESS){ 453426b93350SMatthias Ringwald if (iso_stream->max_sdu_p_to_c > 0){ 453526b93350SMatthias Ringwald // we're peripheral and we will send data 453626b93350SMatthias Ringwald iso_stream->state = HCI_ISO_STREAM_STATE_W2_SETUP_ISO_INPUT; 453726b93350SMatthias Ringwald } else { 453826b93350SMatthias Ringwald // we're peripheral and we will only receive data 453926b93350SMatthias Ringwald iso_stream->state = HCI_ISO_STREAM_STATE_W2_SETUP_ISO_OUTPUT; 454026b93350SMatthias Ringwald } 454126b93350SMatthias Ringwald } else { 454214045fdbSMatthias Ringwald hci_cis_handle_created(iso_stream, status); 454326b93350SMatthias Ringwald } 454426b93350SMatthias Ringwald hci_stack->iso_active_operation_type = HCI_ISO_TYPE_INVALID; 454526b93350SMatthias Ringwald } else { 454626b93350SMatthias Ringwald // CIG Setup by Central 454726b93350SMatthias Ringwald le_audio_cig_t * cig = hci_cig_for_id(hci_stack->iso_active_operation_group_id); 454826b93350SMatthias Ringwald btstack_assert(cig != NULL); 454926b93350SMatthias Ringwald // update iso stream state 45504ae8623eSMatthias Ringwald if (status == ERROR_CODE_SUCCESS){ 45514ae8623eSMatthias Ringwald iso_stream->state = HCI_ISO_STREAM_STATE_ESTABLISHED; 45524ae8623eSMatthias Ringwald } else { 45538e58e4f7SMatthias Ringwald iso_stream->state = HCI_ISO_STREAM_STATE_IDLE; 45544ae8623eSMatthias Ringwald } 45558e58e4f7SMatthias Ringwald // update cig state 4556f06bb90fSMatthias Ringwald for (i=0;i<cig->num_cis;i++){ 4557f06bb90fSMatthias Ringwald if (cig->cis_con_handles[i] == handle){ 45583abcd16cSMatthias Ringwald cig->cis_setup_active[i] = false; 4559f9306a1aSMatthias Ringwald if (status == ERROR_CODE_SUCCESS){ 4560f9306a1aSMatthias Ringwald cig->cis_established[i] = true; 4561f9306a1aSMatthias Ringwald } else { 456214045fdbSMatthias Ringwald hci_cis_handle_created(iso_stream, status); 4563f06bb90fSMatthias Ringwald } 4564f06bb90fSMatthias Ringwald } 4565f06bb90fSMatthias Ringwald } 45668e58e4f7SMatthias Ringwald 45678e58e4f7SMatthias Ringwald // trigger iso path setup if complete 45680f0ba168SMatthias Ringwald bool cis_setup_active = false; 4569f9306a1aSMatthias Ringwald for (i=0;i<cig->num_cis;i++){ 45700f0ba168SMatthias Ringwald cis_setup_active |= cig->cis_setup_active[i]; 4571f9306a1aSMatthias Ringwald } 45720f0ba168SMatthias Ringwald if (cis_setup_active == false){ 4573f9306a1aSMatthias Ringwald cig->state_vars.next_cis = 0; 4574f9306a1aSMatthias Ringwald cig->state = LE_AUDIO_CIG_STATE_SETUP_ISO_PATH; 457526b93350SMatthias Ringwald hci_stack->iso_active_operation_type = HCI_ISO_TYPE_INVALID; 457626b93350SMatthias Ringwald } 4577f06bb90fSMatthias Ringwald } 45784ae8623eSMatthias Ringwald } 45797aa35f6aSMatthias Ringwald break; 45807aa35f6aSMatthias Ringwald case HCI_SUBEVENT_LE_CREATE_BIG_COMPLETE: 458126b93350SMatthias Ringwald hci_stack->iso_active_operation_type = HCI_ISO_TYPE_INVALID; 45827aa35f6aSMatthias Ringwald big = hci_big_for_handle(packet[4]); 45837aa35f6aSMatthias Ringwald if (big != NULL){ 45847aa35f6aSMatthias Ringwald uint8_t status = packet[3]; 45857aa35f6aSMatthias Ringwald if (status == ERROR_CODE_SUCCESS){ 45867aa35f6aSMatthias Ringwald // store bis_con_handles and trigger iso path setup 45875fd415a6SMatthias Ringwald uint8_t num_bis = btstack_min(big->num_bis, packet[20]); 4588c30bd0a5SMatthias Ringwald 45897aa35f6aSMatthias Ringwald for (i=0;i<num_bis;i++){ 4590fb16346aSMatthias Ringwald hci_con_handle_t bis_handle = (hci_con_handle_t) little_endian_read_16(packet, 21 + (2 * i)); 4591fb16346aSMatthias Ringwald big->bis_con_handles[i] = bis_handle; 4592fb16346aSMatthias Ringwald // assign bis handle 4593fb16346aSMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->iso_streams); 4594fb16346aSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 4595c30bd0a5SMatthias Ringwald iso_stream = (hci_iso_stream_t *) btstack_linked_list_iterator_next(&it); 4596fb16346aSMatthias Ringwald if ((iso_stream->state == HCI_ISO_STREAM_STATE_REQUESTED ) && 45978d72db10SMatthias Ringwald (iso_stream->group_id == big->big_handle)){ 4598969d876aSMatthias Ringwald iso_stream->cis_handle = bis_handle; 4599fb16346aSMatthias Ringwald iso_stream->state = HCI_ISO_STREAM_STATE_ESTABLISHED; 4600cd1139aaSMatthias Ringwald break; 4601fb16346aSMatthias Ringwald } 4602fb16346aSMatthias Ringwald } 46037aa35f6aSMatthias Ringwald } 46042a6c0f82SMatthias Ringwald if (big->state == LE_AUDIO_BIG_STATE_W4_ESTABLISHED) { 46057aa35f6aSMatthias Ringwald big->state = LE_AUDIO_BIG_STATE_SETUP_ISO_PATH; 46067aa35f6aSMatthias Ringwald big->state_vars.next_bis = 0; 46072a6c0f82SMatthias Ringwald } 46087aa35f6aSMatthias Ringwald } else { 46092a6c0f82SMatthias Ringwald // create BIG failed or has been stopped by us 4610d8905293SMatthias Ringwald hci_iso_create_big_failed(big, status); 46117aa35f6aSMatthias Ringwald } 46127aa35f6aSMatthias Ringwald } 46137aa35f6aSMatthias Ringwald break; 46147aa35f6aSMatthias Ringwald case HCI_SUBEVENT_LE_TERMINATE_BIG_COMPLETE: 4615c45ca112SMatthias Ringwald hci_stack->iso_active_operation_type = HCI_ISO_TYPE_INVALID; 46167aa35f6aSMatthias Ringwald big = hci_big_for_handle(hci_subevent_le_terminate_big_complete_get_big_handle(packet)); 46177aa35f6aSMatthias Ringwald if (big != NULL){ 4618fb16346aSMatthias Ringwald // finalize associated ISO streams 4619c30bd0a5SMatthias Ringwald 4620fb16346aSMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->iso_streams); 4621fb16346aSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 4622c30bd0a5SMatthias Ringwald iso_stream = (hci_iso_stream_t *) btstack_linked_list_iterator_next(&it); 46238d72db10SMatthias Ringwald if (iso_stream->group_id == big->big_handle){ 4624969d876aSMatthias Ringwald log_info("BIG Terminated, big_handle 0x%02x, con handle 0x%04x", iso_stream->group_id, iso_stream->cis_handle); 4625fb16346aSMatthias Ringwald btstack_linked_list_iterator_remove(&it); 4626fb16346aSMatthias Ringwald btstack_memory_hci_iso_stream_free(iso_stream); 4627fb16346aSMatthias Ringwald } 4628fb16346aSMatthias Ringwald } 46297aa35f6aSMatthias Ringwald btstack_linked_list_remove(&hci_stack->le_audio_bigs, (btstack_linked_item_t *) big); 46307aa35f6aSMatthias Ringwald switch (big->state){ 46317aa35f6aSMatthias Ringwald case LE_AUDIO_BIG_STATE_W4_TERMINATED_AFTER_SETUP_FAILED: 46327aa35f6aSMatthias Ringwald hci_emit_big_created(big, big->state_vars.status); 46337aa35f6aSMatthias Ringwald break; 46347aa35f6aSMatthias Ringwald default: 46357aa35f6aSMatthias Ringwald hci_emit_big_terminated(big); 46367aa35f6aSMatthias Ringwald break; 46377aa35f6aSMatthias Ringwald } 46387aa35f6aSMatthias Ringwald } 46397aa35f6aSMatthias Ringwald break; 46402a6c0f82SMatthias Ringwald case HCI_SUBEVENT_LE_BIG_SYNC_ESTABLISHED: 4641c45ca112SMatthias Ringwald hci_stack->iso_active_operation_type = HCI_ISO_TYPE_INVALID; 46422a6c0f82SMatthias Ringwald big_sync = hci_big_sync_for_handle(packet[4]); 46432a6c0f82SMatthias Ringwald if (big_sync != NULL){ 46442a6c0f82SMatthias Ringwald uint8_t status = packet[3]; 46452a6c0f82SMatthias Ringwald if (status == ERROR_CODE_SUCCESS){ 46462a6c0f82SMatthias Ringwald // store bis_con_handles and trigger iso path setup 46475fd415a6SMatthias Ringwald uint8_t num_bis = btstack_min(big_sync->num_bis, packet[16]); 46482a6c0f82SMatthias Ringwald for (i=0;i<num_bis;i++){ 464902e19895SMatthias Ringwald hci_con_handle_t bis_handle = little_endian_read_16(packet, 17 + (2 * i)); 465002e19895SMatthias Ringwald big_sync->bis_con_handles[i] = bis_handle; 465102e19895SMatthias Ringwald // setup iso_stream_t 465202e19895SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->iso_streams); 465302e19895SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 4654c30bd0a5SMatthias Ringwald iso_stream = (hci_iso_stream_t *) btstack_linked_list_iterator_next(&it); 465502e19895SMatthias Ringwald if ((iso_stream->state == HCI_ISO_STREAM_STATE_REQUESTED ) && 465602e19895SMatthias Ringwald (iso_stream->group_id == big_sync->big_handle)){ 465702e19895SMatthias Ringwald iso_stream->cis_handle = bis_handle; 465802e19895SMatthias Ringwald iso_stream->state = HCI_ISO_STREAM_STATE_ESTABLISHED; 465902e19895SMatthias Ringwald break; 466002e19895SMatthias Ringwald } 466102e19895SMatthias Ringwald } 46622a6c0f82SMatthias Ringwald } 46632a6c0f82SMatthias Ringwald if (big_sync->state == LE_AUDIO_BIG_STATE_W4_ESTABLISHED) { 46642a6c0f82SMatthias Ringwald // trigger iso path setup 46652a6c0f82SMatthias Ringwald big_sync->state = LE_AUDIO_BIG_STATE_SETUP_ISO_PATH; 46662a6c0f82SMatthias Ringwald big_sync->state_vars.next_bis = 0; 46672a6c0f82SMatthias Ringwald } 46682a6c0f82SMatthias Ringwald } else { 46692a6c0f82SMatthias Ringwald // create BIG Sync failed or has been stopped by us 4670d8905293SMatthias Ringwald hci_iso_big_sync_failed(big_sync, status); 46712a6c0f82SMatthias Ringwald } 46722a6c0f82SMatthias Ringwald } 46732a6c0f82SMatthias Ringwald break; 46742a6c0f82SMatthias Ringwald case HCI_SUBEVENT_LE_BIG_SYNC_LOST: 4675c45ca112SMatthias Ringwald hci_stack->iso_active_operation_type = HCI_ISO_TYPE_INVALID; 46762a6c0f82SMatthias Ringwald big_sync = hci_big_sync_for_handle(packet[4]); 46772a6c0f82SMatthias Ringwald if (big_sync != NULL){ 4678d04a9afcSMatthias Ringwald uint8_t big_handle = packet[4]; 46792a6c0f82SMatthias Ringwald btstack_linked_list_remove(&hci_stack->le_audio_big_syncs, (btstack_linked_item_t *) big_sync); 4680d04a9afcSMatthias Ringwald hci_emit_big_sync_stopped(big_handle); 46812a6c0f82SMatthias Ringwald } 46822a6c0f82SMatthias Ringwald break; 46834ae8623eSMatthias Ringwald #endif 46845909f7f2Smatthias.ringwald default: 46855909f7f2Smatthias.ringwald break; 46865909f7f2Smatthias.ringwald } 46875909f7f2Smatthias.ringwald break; 46885909f7f2Smatthias.ringwald #endif 46890b36101dSMatthias Ringwald case HCI_EVENT_VENDOR_SPECIFIC: 46900b36101dSMatthias Ringwald // Vendor specific commands often create vendor specific event instead of num completed packets 46910b36101dSMatthias Ringwald // To avoid getting stuck as num_cmds_packets is zero, reset it to 1 for controllers with this behaviour 46920b36101dSMatthias Ringwald switch (hci_stack->manufacturer){ 46930b36101dSMatthias Ringwald case BLUETOOTH_COMPANY_ID_CAMBRIDGE_SILICON_RADIO: 46940b36101dSMatthias Ringwald hci_stack->num_cmd_packets = 1; 46950b36101dSMatthias Ringwald break; 46960b36101dSMatthias Ringwald default: 46970b36101dSMatthias Ringwald break; 46980b36101dSMatthias Ringwald } 46990b36101dSMatthias Ringwald break; 47006772a24cSmatthias.ringwald default: 47016772a24cSmatthias.ringwald break; 4702fe1ed1b8Smatthias.ringwald } 4703fe1ed1b8Smatthias.ringwald 470467c6c9dcSMatthias Ringwald handle_event_for_current_stack_state(packet, size); 470589db417bSmatthias.ringwald 470686805605S[email protected] // notify upper stack 4707d6b06661SMatthias Ringwald hci_emit_event(packet, size, 0); // don't dump, already happened in packet handler 470894ab26f8Smatthias.ringwald 470986805605S[email protected] // moved here to give upper stack a chance to close down everything with hci_connection_t intact 4710797b2a3fSMatthias Ringwald if ((hci_event_packet_get_type(packet) == HCI_EVENT_DISCONNECTION_COMPLETE) && (packet[2] == 0)){ 4711f8fbdce0SMatthias Ringwald handle = little_endian_read_16(packet, 3); 471205ae8de3SMatthias Ringwald hci_connection_t * aConn = hci_connection_for_handle(handle); 4713046ec007SMatthias Ringwald // discard connection if app did not trigger a reconnect in the event handler 4714797b2a3fSMatthias Ringwald if (aConn && aConn->state == RECEIVED_DISCONNECTION_COMPLETE){ 471505ae8de3SMatthias Ringwald hci_shutdown_connection(aConn); 4716b0136355SMatthias Ringwald } 47178ad9cf99SMatthias Ringwald #ifdef ENABLE_CONTROLLER_DUMP_PACKETS 47188ad9cf99SMatthias Ringwald hci_controller_dump_packets(); 47198ad9cf99SMatthias Ringwald #endif 472086805605S[email protected] } 472186805605S[email protected] 472294ab26f8Smatthias.ringwald // execute main loop 472394ab26f8Smatthias.ringwald hci_run(); 472416833f0aSmatthias.ringwald } 472516833f0aSmatthias.ringwald 472635454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 47276f28d2eeSMatthias Ringwald 4728c91d150bS[email protected] static void sco_handler(uint8_t * packet, uint16_t size){ 47290b3f95dfSMatthias Ringwald // lookup connection struct 47302b838201SMatthias Ringwald hci_con_handle_t con_handle = READ_SCO_CONNECTION_HANDLE(packet); 47312b838201SMatthias Ringwald hci_connection_t * conn = hci_connection_for_handle(con_handle); 47320b3f95dfSMatthias Ringwald if (!conn) return; 47330b3f95dfSMatthias Ringwald 47346be3cf7fSMatthias Ringwald #ifdef ENABLE_SCO_OVER_HCI 4735760b20efSMatthias Ringwald // CSR 8811 prefixes 60 byte SCO packet in transparent mode with 20 zero bytes -> skip first 20 payload bytes 4736760b20efSMatthias Ringwald if (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_CAMBRIDGE_SILICON_RADIO){ 4737a1df452eSMatthias Ringwald if ((size == 83) && ((hci_stack->sco_voice_setting_active & 0x03) == 0x03)){ 4738760b20efSMatthias Ringwald packet[2] = 0x3c; 4739760b20efSMatthias Ringwald memmove(&packet[3], &packet[23], 63); 4740760b20efSMatthias Ringwald size = 63; 47410b3f95dfSMatthias Ringwald } 47420b3f95dfSMatthias Ringwald } 4743760b20efSMatthias Ringwald 4744f234b250SMatthias Ringwald if (hci_have_usb_transport()){ 4745f234b250SMatthias Ringwald // Nothing to do 4746f234b250SMatthias Ringwald } else { 474749205f5dSMatthias 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); 4748760b20efSMatthias Ringwald if (hci_stack->synchronous_flow_control_enabled == 0){ 4749fa7f2dfdSMatthias Ringwald // ignore received SCO packets for the first 10 ms, then allow for max two HCI_SCO_2EV3_SIZE packets 4750b1202089SMatthias 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); 4751fa7f2dfdSMatthias Ringwald if (conn->sco_tx_active == 0){ 4752fa7f2dfdSMatthias Ringwald if (btstack_time_delta(btstack_run_loop_get_time_ms(), conn->sco_established_ms) > 10){ 4753fa7f2dfdSMatthias Ringwald conn->sco_tx_active = 1; 4754fa7f2dfdSMatthias Ringwald conn->sco_tx_ready = max_sco_packets; 4755fa7f2dfdSMatthias Ringwald log_info("Start SCO sending, %u packets", conn->sco_tx_ready); 4756fa7f2dfdSMatthias Ringwald hci_notify_if_sco_can_send_now(); 475759c33575SMatthias Ringwald } 475859c33575SMatthias Ringwald } else { 4759fa7f2dfdSMatthias Ringwald if (conn->sco_tx_ready < max_sco_packets){ 4760fa7f2dfdSMatthias Ringwald conn->sco_tx_ready++; 476159c33575SMatthias Ringwald } 4762fa7f2dfdSMatthias Ringwald hci_notify_if_sco_can_send_now(); 47636f28d2eeSMatthias Ringwald } 4764760b20efSMatthias Ringwald } 4765f234b250SMatthias Ringwald } 47666be3cf7fSMatthias Ringwald #endif 47676be3cf7fSMatthias Ringwald 47680b3f95dfSMatthias Ringwald // deliver to app 47690b3f95dfSMatthias Ringwald if (hci_stack->sco_packet_handler) { 47700b3f95dfSMatthias Ringwald hci_stack->sco_packet_handler(HCI_SCO_DATA_PACKET, 0, packet, size); 47710b3f95dfSMatthias Ringwald } 47720b3f95dfSMatthias Ringwald 4773ed325439SMatthias Ringwald #ifdef HAVE_SCO_TRANSPORT 4774ed325439SMatthias Ringwald // We can send one packet for each received packet 4775ed325439SMatthias Ringwald conn->sco_tx_ready++; 4776ed325439SMatthias Ringwald hci_notify_if_sco_can_send_now(); 4777ed325439SMatthias Ringwald #endif 4778ed325439SMatthias Ringwald 47790b3f95dfSMatthias Ringwald #ifdef ENABLE_HCI_CONTROLLER_TO_HOST_FLOW_CONTROL 47802b838201SMatthias Ringwald conn->num_packets_completed++; 47812b838201SMatthias Ringwald hci_stack->host_completed_packets = 1; 47822b838201SMatthias Ringwald hci_run(); 47832b838201SMatthias Ringwald #endif 4784c91d150bS[email protected] } 478535454696SMatthias Ringwald #endif 4786c91d150bS[email protected] 47870a57e69fSmatthias.ringwald static void packet_handler(uint8_t packet_type, uint8_t *packet, uint16_t size){ 47884248f37eSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS 47894248f37eSMatthias Ringwald // propagate ISO packets received as ACL 4790062276f9SMatthias Ringwald hci_iso_stream_t * iso_stream = NULL; 47914248f37eSMatthias Ringwald if ((packet_type == HCI_ACL_DATA_PACKET) && (size >= HCI_ACL_HEADER_SIZE)){ 47924248f37eSMatthias Ringwald hci_con_handle_t con_handle = READ_ACL_CONNECTION_HANDLE(packet); 47934248f37eSMatthias Ringwald iso_stream = hci_iso_stream_for_con_handle(con_handle); 47944248f37eSMatthias Ringwald if (iso_stream != NULL){ 47954248f37eSMatthias Ringwald packet_type = HCI_ISO_DATA_PACKET; 47964248f37eSMatthias Ringwald } 47974248f37eSMatthias Ringwald } 47984248f37eSMatthias Ringwald #endif 47994248f37eSMatthias Ringwald 4800b09f7410SMatthias Ringwald // don't log internal events unless requested 4801b09f7410SMatthias Ringwald bool internal_event = (packet_type == HCI_EVENT_PACKET) && (hci_event_packet_get_type(packet) >= BTSTACK_EVENT_FIRST); 4802b09f7410SMatthias Ringwald bool log_packet = internal_event == false; 4803b09f7410SMatthias Ringwald #ifdef ENABLE_LOG_BTSTACK_EVENTS 4804b09f7410SMatthias Ringwald log_packet = true; 4805b09f7410SMatthias Ringwald #endif 4806b09f7410SMatthias Ringwald if (log_packet){ 48075bb5bc3eS[email protected] hci_dump_packet(packet_type, 1, packet, size); 4808b09f7410SMatthias Ringwald } 4809b09f7410SMatthias Ringwald 481010e830c9Smatthias.ringwald switch (packet_type) { 481110e830c9Smatthias.ringwald case HCI_EVENT_PACKET: 481210e830c9Smatthias.ringwald event_handler(packet, size); 481310e830c9Smatthias.ringwald break; 481410e830c9Smatthias.ringwald case HCI_ACL_DATA_PACKET: 481510e830c9Smatthias.ringwald acl_handler(packet, size); 481610e830c9Smatthias.ringwald break; 481735454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 4818c91d150bS[email protected] case HCI_SCO_DATA_PACKET: 4819c91d150bS[email protected] sco_handler(packet, size); 4820202c8a4cSMatthias Ringwald break; 482135454696SMatthias Ringwald #endif 48220a8cccd5SMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS 48235027c498SMatthias Ringwald case HCI_ISO_DATA_PACKET: 4824750818acSMatthias Ringwald if ((iso_stream == NULL) && (size >= HCI_ISO_HEADER_SIZE)){ 4825750818acSMatthias Ringwald hci_con_handle_t con_handle = READ_ISO_CONNECTION_HANDLE(packet); 4826750818acSMatthias Ringwald iso_stream = hci_iso_stream_for_con_handle(con_handle); 4827750818acSMatthias Ringwald } 4828750818acSMatthias Ringwald hci_iso_packet_handler(iso_stream, packet, size); 48295027c498SMatthias Ringwald break; 48305027c498SMatthias Ringwald #endif 483110e830c9Smatthias.ringwald default: 483210e830c9Smatthias.ringwald break; 483310e830c9Smatthias.ringwald } 483410e830c9Smatthias.ringwald } 483510e830c9Smatthias.ringwald 4836d6b06661SMatthias Ringwald /** 4837d6b06661SMatthias Ringwald * @brief Add event packet handler. 4838d6b06661SMatthias Ringwald */ 4839d6b06661SMatthias Ringwald void hci_add_event_handler(btstack_packet_callback_registration_t * callback_handler){ 4840d6b06661SMatthias Ringwald btstack_linked_list_add_tail(&hci_stack->event_handlers, (btstack_linked_item_t*) callback_handler); 4841d6b06661SMatthias Ringwald } 4842d6b06661SMatthias Ringwald 484367f708e0SMatthias Ringwald /** 484467f708e0SMatthias Ringwald * @brief Remove event packet handler. 484567f708e0SMatthias Ringwald */ 484667f708e0SMatthias Ringwald void hci_remove_event_handler(btstack_packet_callback_registration_t * callback_handler){ 484767f708e0SMatthias Ringwald btstack_linked_list_remove(&hci_stack->event_handlers, (btstack_linked_item_t*) callback_handler); 484867f708e0SMatthias Ringwald } 4849d6b06661SMatthias Ringwald 4850fcadd0caSmatthias.ringwald /** Register HCI packet handlers */ 48513d50b4baSMatthias Ringwald void hci_register_acl_packet_handler(btstack_packet_handler_t handler){ 4852fb37a842SMatthias Ringwald hci_stack->acl_packet_handler = handler; 485316833f0aSmatthias.ringwald } 485416833f0aSmatthias.ringwald 485535454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 48568abbe8b5SMatthias Ringwald /** 48578abbe8b5SMatthias Ringwald * @brief Registers a packet handler for SCO data. Used for HSP and HFP profiles. 48588abbe8b5SMatthias Ringwald */ 48593d50b4baSMatthias Ringwald void hci_register_sco_packet_handler(btstack_packet_handler_t handler){ 48608abbe8b5SMatthias Ringwald hci_stack->sco_packet_handler = handler; 48618abbe8b5SMatthias Ringwald } 486235454696SMatthias Ringwald #endif 48638abbe8b5SMatthias Ringwald 48640a8cccd5SMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS 48655027c498SMatthias Ringwald void hci_register_iso_packet_handler(btstack_packet_handler_t handler){ 48665027c498SMatthias Ringwald hci_stack->iso_packet_handler = handler; 48675027c498SMatthias Ringwald } 48685027c498SMatthias Ringwald #endif 48695027c498SMatthias Ringwald 487071de195eSMatthias Ringwald static void hci_state_reset(void){ 4871595bdbfbS[email protected] // no connections yet 4872595bdbfbS[email protected] hci_stack->connections = NULL; 487374308b23Smatthias.ringwald 487474308b23Smatthias.ringwald // keep discoverable/connectable as this has been requested by the client(s) 487574308b23Smatthias.ringwald // hci_stack->discoverable = 0; 487674308b23Smatthias.ringwald // hci_stack->connectable = 0; 487774308b23Smatthias.ringwald // hci_stack->bondable = 1; 4878b95a5a35SMatthias Ringwald // hci_stack->own_addr_type = 0; 4879595bdbfbS[email protected] 488044935e40S[email protected] // buffer is free 488102c7fc01SMatthias Ringwald hci_stack->hci_packet_buffer_reserved = false; 488244935e40S[email protected] 4883595bdbfbS[email protected] // no pending cmds 4884595bdbfbS[email protected] hci_stack->decline_reason = 0; 4885595bdbfbS[email protected] 4886c214d65bSMatthias Ringwald hci_stack->secure_connections_active = false; 4887c214d65bSMatthias Ringwald 4888bea424a5SMatthias Ringwald #ifdef ENABLE_CLASSIC 4889496bb884SMatthias Ringwald hci_stack->inquiry_lap = GAP_IAC_GENERAL_INQUIRY; 489032a12730SMatthias Ringwald 4891baa4881eSMatthias Ringwald hci_stack->gap_tasks_classic = 489259d59ecfSMatthias Ringwald GAP_TASK_SET_DEFAULT_LINK_POLICY | 489359d59ecfSMatthias Ringwald GAP_TASK_SET_CLASS_OF_DEVICE | 489459d59ecfSMatthias Ringwald GAP_TASK_SET_LOCAL_NAME | 4895bc2dcc03SMatthias Ringwald GAP_TASK_SET_EIR_DATA | 489632a12730SMatthias Ringwald GAP_TASK_WRITE_SCAN_ENABLE | 489732a12730SMatthias Ringwald GAP_TASK_WRITE_PAGE_TIMEOUT; 4898bea424a5SMatthias Ringwald #endif 4899bea424a5SMatthias Ringwald 4900cf01e888SMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB 49018d5f0979SMatthias Ringwald hci_stack->classic_read_local_oob_data = false; 49021ae74bf3SMatthias Ringwald hci_stack->classic_oob_con_handle = HCI_CON_HANDLE_INVALID; 4903cf01e888SMatthias Ringwald #endif 4904cf01e888SMatthias Ringwald 4905595bdbfbS[email protected] // LE 4906b95a5a35SMatthias Ringwald #ifdef ENABLE_BLE 4907b95a5a35SMatthias Ringwald memset(hci_stack->le_random_address, 0, 6); 4908b95a5a35SMatthias Ringwald hci_stack->le_random_address_set = 0; 4909d70217a2SMatthias Ringwald #endif 4910d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 4911a61834b6SMatthias Ringwald hci_stack->le_scanning_active = false; 491273799937SMatthias Ringwald hci_stack->le_scanning_param_update = true; 4913b04dfa37SMatthias Ringwald hci_stack->le_connecting_state = LE_CONNECTING_IDLE; 4914d5b1a89eSMatthias Ringwald hci_stack->le_connecting_request = LE_CONNECTING_IDLE; 4915e83201bcSMatthias Ringwald hci_stack->le_whitelist_capacity = 0; 49164bafedd5SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 49174bafedd5SMatthias Ringwald hci_stack->le_periodic_terminate_sync_handle = HCI_CON_HANDLE_INVALID; 49184bafedd5SMatthias Ringwald #endif 4919d70217a2SMatthias Ringwald #endif 4920a61834b6SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 4921935aa76eSMatthias Ringwald hci_stack->le_advertisements_state &= ~LE_ADVERTISEMENT_STATE_ACTIVE; 49226bf435a6SMatthias Ringwald if ((hci_stack->le_advertisements_state & LE_ADVERTISEMENT_STATE_PARAMS_SET) != 0){ 4923a61834b6SMatthias Ringwald hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_SET_PARAMS; 4924a61834b6SMatthias Ringwald } 4925a61834b6SMatthias Ringwald if (hci_stack->le_advertisements_data != NULL){ 4926a61834b6SMatthias Ringwald hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_SET_ADV_DATA; 4927a61834b6SMatthias Ringwald } 4928a61834b6SMatthias Ringwald #endif 4929d320e123SMatthias Ringwald #ifdef ENABLE_LE_PRIVACY_ADDRESS_RESOLUTION 4930d320e123SMatthias Ringwald hci_stack->le_resolving_list_state = LE_RESOLVING_LIST_SEND_ENABLE_ADDRESS_RESOLUTION; 4931d320e123SMatthias Ringwald #endif 493240f86dfdSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS 493326b93350SMatthias Ringwald hci_stack->iso_active_operation_type = HCI_ISO_TYPE_INVALID; 4934d75a6bbfSMatthias Ringwald hci_stack->iso_active_operation_group_id = HCI_ISO_GROUP_ID_INVALID; 493540f86dfdSMatthias Ringwald #endif 493691036612SMatthias Ringwald #ifdef ENABLE_HCI_COMMAND_STATUS_DISCARDED_FOR_FAILED_CONNECTIONS_WORKAROUND 4937f48a5586SMatthias Ringwald hci_stack->hci_command_con_handle = HCI_CON_HANDLE_INVALID; 4938f48a5586SMatthias Ringwald #endif 4939595bdbfbS[email protected] } 4940595bdbfbS[email protected] 494135454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 49422d5e09d6SMatthias Ringwald /** 49432d5e09d6SMatthias Ringwald * @brief Configure Bluetooth hardware control. Has to be called before power on. 49442d5e09d6SMatthias Ringwald */ 49452d5e09d6SMatthias Ringwald void hci_set_link_key_db(btstack_link_key_db_t const * link_key_db){ 49462d5e09d6SMatthias Ringwald // store and open remote device db 49472d5e09d6SMatthias Ringwald hci_stack->link_key_db = link_key_db; 49482d5e09d6SMatthias Ringwald if (hci_stack->link_key_db) { 49492d5e09d6SMatthias Ringwald hci_stack->link_key_db->open(); 49502d5e09d6SMatthias Ringwald } 49512d5e09d6SMatthias Ringwald } 495235454696SMatthias Ringwald #endif 49532d5e09d6SMatthias Ringwald 49542d5e09d6SMatthias Ringwald void hci_init(const hci_transport_t *transport, const void *config){ 4955475c8125Smatthias.ringwald 49563a9fb326S[email protected] #ifdef HAVE_MALLOC 49573a9fb326S[email protected] if (!hci_stack) { 49583a9fb326S[email protected] hci_stack = (hci_stack_t*) malloc(sizeof(hci_stack_t)); 49593a9fb326S[email protected] } 4960b1202089SMatthias Ringwald btstack_assert(hci_stack != NULL); 49613a9fb326S[email protected] #else 49623a9fb326S[email protected] hci_stack = &hci_stack_static; 49633a9fb326S[email protected] #endif 496466fb9560S[email protected] memset(hci_stack, 0, sizeof(hci_stack_t)); 49653a9fb326S[email protected] 4966475c8125Smatthias.ringwald // reference to use transport layer implementation 49673a9fb326S[email protected] hci_stack->hci_transport = transport; 4968475c8125Smatthias.ringwald 496911e23e5fSmatthias.ringwald // reference to used config 49703a9fb326S[email protected] hci_stack->config = config; 497111e23e5fSmatthias.ringwald 497226a9b6daSMatthias Ringwald // setup pointer for outgoing packet buffer 497326a9b6daSMatthias Ringwald hci_stack->hci_packet_buffer = &hci_stack->hci_packet_buffer_data[HCI_OUTGOING_PRE_BUFFER_SIZE]; 497426a9b6daSMatthias Ringwald 49758fcba05dSmatthias.ringwald // max acl payload size defined in config.h 49763a9fb326S[email protected] hci_stack->acl_data_packet_length = HCI_ACL_PAYLOAD_SIZE; 49778fcba05dSmatthias.ringwald 497816833f0aSmatthias.ringwald // register packet handlers with transport 497910e830c9Smatthias.ringwald transport->register_packet_handler(&packet_handler); 4980f5454fc6Smatthias.ringwald 49813a9fb326S[email protected] hci_stack->state = HCI_STATE_OFF; 4982e2386ba1S[email protected] 4983e2386ba1S[email protected] // class of device 49843a9fb326S[email protected] hci_stack->class_of_device = 0x007a020c; // Smartphone 4985a45d6b9fS[email protected] 4986f20168b8Smatthias.ringwald // bondable by default 4987f20168b8Smatthias.ringwald hci_stack->bondable = 1; 4988f20168b8Smatthias.ringwald 4989e9f343c8SMatthias Ringwald #ifdef ENABLE_CLASSIC 499063168530SMatthias Ringwald // classic name 499163168530SMatthias Ringwald hci_stack->local_name = default_classic_name; 4992c4c88f1bSJakob Krantz 4993c4c88f1bSJakob Krantz // Master slave policy 4994c4c88f1bSJakob Krantz hci_stack->master_slave_policy = 1; 4995170fafaeSMatthias Ringwald 4996b4eb4420SMatthias Ringwald // Allow Role Switch 4997b4eb4420SMatthias Ringwald hci_stack->allow_role_switch = 1; 4998b4eb4420SMatthias Ringwald 499978315a58SMatthias Ringwald // Default / minimum security level = 2 500078315a58SMatthias Ringwald hci_stack->gap_security_level = LEVEL_2; 500178315a58SMatthias Ringwald 50025dbec6b3SMatthias Ringwald // Default Security Mode 4 50035dbec6b3SMatthias Ringwald hci_stack->gap_security_mode = GAP_SECURITY_MODE_4; 50045dbec6b3SMatthias Ringwald 5005cd345294SMatthias Ringwald // Errata-11838 mandates 7 bytes for GAP Security Level 1-3 5006cd345294SMatthias Ringwald hci_stack->gap_required_encyrption_key_size = 7; 5007d821984bSMatthias Ringwald 5008d821984bSMatthias Ringwald // Link Supervision Timeout 5009d821984bSMatthias Ringwald hci_stack->link_supervision_timeout = HCI_LINK_SUPERVISION_TIMEOUT_DEFAULT; 5010d821984bSMatthias Ringwald 5011c874aa46SMatthias Ringwald // Page Timeout 5012c874aa46SMatthias Ringwald hci_stack->page_timeout = 0x6000; // ca. 15 sec 5013c874aa46SMatthias Ringwald 5014a086dc35SMatthias Ringwald // All ACL packet types are enabled 5015028ead5eSMatthias Ringwald hci_stack->enabled_packet_types_acl = ACL_PACKET_TYPES_ALL; 5016e9f343c8SMatthias Ringwald #endif 501763168530SMatthias Ringwald 501863048403S[email protected] // Secure Simple Pairing default: enable, no I/O capabilities, general bonding, mitm not required, auto accept 50193a9fb326S[email protected] hci_stack->ssp_enable = 1; 50203a9fb326S[email protected] hci_stack->ssp_io_capability = SSP_IO_CAPABILITY_NO_INPUT_NO_OUTPUT; 50213a9fb326S[email protected] hci_stack->ssp_authentication_requirement = SSP_IO_AUTHREQ_MITM_PROTECTION_NOT_REQUIRED_GENERAL_BONDING; 50223a9fb326S[email protected] hci_stack->ssp_auto_accept = 1; 502369a97523S[email protected] 50245d23aae8SMatthias Ringwald // Secure Connections: enable (requires support from Controller) 50255d23aae8SMatthias Ringwald hci_stack->secure_connections_enable = true; 50265d23aae8SMatthias Ringwald 5027fac2e2feSMatthias Ringwald // voice setting - signed 16 bit pcm data with CVSD over the air 5028fac2e2feSMatthias Ringwald hci_stack->sco_voice_setting = 0x60; 5029d950d659SMatthias Ringwald 50300c2c5f79SMatthias Ringwald #ifdef ENABLE_BLE 5031cbe54ab2SJakob Krantz hci_stack->le_connection_scan_interval = 0x0060; // 60 ms 5032cbe54ab2SJakob Krantz hci_stack->le_connection_scan_window = 0x0030; // 30 ms 5033831711daSMatthias Ringwald hci_stack->le_connection_interval_min = 0x0008; // 10 ms 5034831711daSMatthias Ringwald hci_stack->le_connection_interval_max = 0x0018; // 30 ms 5035831711daSMatthias Ringwald hci_stack->le_connection_latency = 4; // 4 5036831711daSMatthias Ringwald hci_stack->le_supervision_timeout = 0x0048; // 720 ms 503724d14ae3SMatthias Ringwald hci_stack->le_minimum_ce_length = 0; // 0 ms 503824d14ae3SMatthias Ringwald hci_stack->le_maximum_ce_length = 0; // 0 ms 50390c2c5f79SMatthias Ringwald #endif 50400c2c5f79SMatthias Ringwald 50410c2c5f79SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 50427eb5b27eSMatthias Ringwald hci_stack->le_connection_phys = 0x01; // LE 1M PHY 50437261e5d8SMatthias Ringwald 50447261e5d8SMatthias Ringwald // default LE Scanning 50457eb5b27eSMatthias Ringwald hci_stack->le_scan_type = 0x01; // active 50468b69e4c7SMatthias Ringwald hci_stack->le_scan_interval = 0x1e0; // 300 ms 50478b69e4c7SMatthias Ringwald hci_stack->le_scan_window = 0x30; // 30 ms 50487eb5b27eSMatthias Ringwald hci_stack->le_scan_phys = 0x01; // LE 1M PHY 5049831711daSMatthias Ringwald #endif 5050831711daSMatthias Ringwald 50512b6ab3e6SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 50522b6ab3e6SMatthias Ringwald hci_stack->le_max_number_peripheral_connections = 1; // only single connection as peripheral 5053ee605458SMatthias Ringwald 5054ee605458SMatthias Ringwald // default advertising parameters from Core v5.4 -- needed to use random address without prior adv setup 5055ee605458SMatthias Ringwald hci_stack->le_advertisements_interval_min = 0x0800; 5056ee605458SMatthias Ringwald hci_stack->le_advertisements_interval_max = 0x0800; 5057ee605458SMatthias Ringwald hci_stack->le_advertisements_type = 0; 5058ee605458SMatthias Ringwald hci_stack->le_own_addr_type = BD_ADDR_TYPE_LE_PUBLIC; 5059ee605458SMatthias Ringwald hci_stack->le_advertisements_direct_address_type = BD_ADDR_TYPE_LE_PUBLIC; 5060ee605458SMatthias Ringwald hci_stack->le_advertisements_channel_map = 0x07; 5061ee605458SMatthias Ringwald hci_stack->le_advertisements_filter_policy = 0; 50622b6ab3e6SMatthias Ringwald #endif 50632b6ab3e6SMatthias Ringwald 5064831711daSMatthias Ringwald // connection parameter range used to answer connection parameter update requests in l2cap 5065831711daSMatthias Ringwald hci_stack->le_connection_parameter_range.le_conn_interval_min = 6; 5066831711daSMatthias Ringwald hci_stack->le_connection_parameter_range.le_conn_interval_max = 3200; 5067831711daSMatthias Ringwald hci_stack->le_connection_parameter_range.le_conn_latency_min = 0; 5068831711daSMatthias Ringwald hci_stack->le_connection_parameter_range.le_conn_latency_max = 500; 5069831711daSMatthias Ringwald hci_stack->le_connection_parameter_range.le_supervision_timeout_min = 10; 5070831711daSMatthias Ringwald hci_stack->le_connection_parameter_range.le_supervision_timeout_max = 3200; 5071831711daSMatthias Ringwald 507201d4f05fSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS 507301d4f05fSMatthias Ringwald hci_stack->iso_packets_to_queue = 1; 507401d4f05fSMatthias Ringwald #endif 507501d4f05fSMatthias Ringwald 5076c3d19a30SMatthias Ringwald #ifdef ENABLE_LE_PRIVACY_ADDRESS_RESOLUTION 5077c3d19a30SMatthias Ringwald hci_stack->le_privacy_mode = LE_PRIVACY_MODE_DEVICE; 5078c3d19a30SMatthias Ringwald #endif 5079c3d19a30SMatthias Ringwald 5080595bdbfbS[email protected] hci_state_reset(); 5081475c8125Smatthias.ringwald } 5082475c8125Smatthias.ringwald 50834688f216SMatthias Ringwald void hci_deinit(void){ 5084b02cfc15SMatthias Ringwald btstack_run_loop_remove_timer(&hci_stack->timeout); 50854688f216SMatthias Ringwald #ifdef HAVE_MALLOC 50864688f216SMatthias Ringwald if (hci_stack) { 50874688f216SMatthias Ringwald free(hci_stack); 50884688f216SMatthias Ringwald } 50894688f216SMatthias Ringwald #endif 50904688f216SMatthias Ringwald hci_stack = NULL; 5091b5bbcbf4SMatthias Ringwald 5092b5bbcbf4SMatthias Ringwald #ifdef ENABLE_CLASSIC 50934688f216SMatthias Ringwald disable_l2cap_timeouts = 0; 5094b5bbcbf4SMatthias Ringwald #endif 50954688f216SMatthias Ringwald } 50964688f216SMatthias Ringwald 50973fb36a29SMatthias Ringwald /** 50983fb36a29SMatthias Ringwald * @brief Configure Bluetooth chipset driver. Has to be called before power on, or right after receiving the local version information 50993fb36a29SMatthias Ringwald */ 51003fb36a29SMatthias Ringwald void hci_set_chipset(const btstack_chipset_t *chipset_driver){ 51013fb36a29SMatthias Ringwald hci_stack->chipset = chipset_driver; 51023fb36a29SMatthias Ringwald 51033fb36a29SMatthias Ringwald // reset chipset driver - init is also called on power_up 51043fb36a29SMatthias Ringwald if (hci_stack->chipset && hci_stack->chipset->init){ 51053fb36a29SMatthias Ringwald hci_stack->chipset->init(hci_stack->config); 51063fb36a29SMatthias Ringwald } 51073fb36a29SMatthias Ringwald } 51083fb36a29SMatthias Ringwald 51096fe16221SMatthias Ringwald void hci_enable_custom_pre_init(void){ 51106fe16221SMatthias Ringwald hci_stack->chipset_pre_init = true; 51116fe16221SMatthias Ringwald } 51126fe16221SMatthias Ringwald 5113fb55bd0aSMatthias Ringwald /** 5114d0b87befSMatthias Ringwald * @brief Configure Bluetooth hardware control. Has to be called after hci_init() but before power on. 5115fb55bd0aSMatthias Ringwald */ 5116fb55bd0aSMatthias Ringwald void hci_set_control(const btstack_control_t *hardware_control){ 5117fb55bd0aSMatthias Ringwald // references to used control implementation 5118fb55bd0aSMatthias Ringwald hci_stack->control = hardware_control; 5119d0b87befSMatthias Ringwald // init with transport config 5120d0b87befSMatthias Ringwald hardware_control->init(hci_stack->config); 5121fb55bd0aSMatthias Ringwald } 5122fb55bd0aSMatthias Ringwald 51231f9eb2ccSMatthias Ringwald static void hci_discard_connections(void){ 5124346f8c2cSMatthias Ringwald btstack_linked_list_iterator_t it; 5125346f8c2cSMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->connections); 5126346f8c2cSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 5127a086dc35SMatthias Ringwald // cancel all l2cap connections by emitting disconnection complete before shutdown (free) connection 5128346f8c2cSMatthias Ringwald hci_connection_t * connection = (hci_connection_t*) btstack_linked_list_iterator_next(&it); 51291f9eb2ccSMatthias Ringwald hci_emit_disconnection_complete(connection->con_handle, 0x16); // terminated by local host 51301f9eb2ccSMatthias Ringwald hci_shutdown_connection(connection); 51311f9eb2ccSMatthias Ringwald } 5132346f8c2cSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS 5133346f8c2cSMatthias Ringwald while (hci_stack->iso_streams != NULL){ 5134346f8c2cSMatthias Ringwald hci_iso_stream_finalize((hci_iso_stream_t *) hci_stack->iso_streams); 5135346f8c2cSMatthias Ringwald } 5136346f8c2cSMatthias Ringwald #endif 51371f9eb2ccSMatthias Ringwald } 51381f9eb2ccSMatthias Ringwald 513971de195eSMatthias Ringwald void hci_close(void){ 5140e6d6524dSMatthias Ringwald 5141e6d6524dSMatthias Ringwald #ifdef ENABLE_CLASSIC 5142404843c1Smatthias.ringwald // close remote device db 5143a98592bcSMatthias Ringwald if (hci_stack->link_key_db) { 5144a98592bcSMatthias Ringwald hci_stack->link_key_db->close(); 5145404843c1Smatthias.ringwald } 5146e6d6524dSMatthias Ringwald #endif 51477224be7eSMatthias Ringwald 51481f9eb2ccSMatthias Ringwald hci_discard_connections(); 51497224be7eSMatthias Ringwald 5150f5454fc6Smatthias.ringwald hci_power_control(HCI_POWER_OFF); 51513a9fb326S[email protected] 51523a9fb326S[email protected] #ifdef HAVE_MALLOC 51533a9fb326S[email protected] free(hci_stack); 51543a9fb326S[email protected] #endif 51553a9fb326S[email protected] hci_stack = NULL; 5156404843c1Smatthias.ringwald } 5157404843c1Smatthias.ringwald 5158cb70c5abSMatthias Ringwald #ifdef HAVE_SCO_TRANSPORT 5159cb70c5abSMatthias Ringwald void hci_set_sco_transport(const btstack_sco_transport_t *sco_transport){ 5160cb70c5abSMatthias Ringwald hci_stack->sco_transport = sco_transport; 5161cb70c5abSMatthias Ringwald sco_transport->register_packet_handler(&packet_handler); 5162cb70c5abSMatthias Ringwald } 5163cb70c5abSMatthias Ringwald #endif 5164cb70c5abSMatthias Ringwald 516535454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 5166170fafaeSMatthias Ringwald void gap_set_required_encryption_key_size(uint8_t encryption_key_size){ 5167a086dc35SMatthias Ringwald // validate range and set 5168170fafaeSMatthias Ringwald if (encryption_key_size < 7) return; 5169170fafaeSMatthias Ringwald if (encryption_key_size > 16) return; 5170170fafaeSMatthias Ringwald hci_stack->gap_required_encyrption_key_size = encryption_key_size; 5171170fafaeSMatthias Ringwald } 517278315a58SMatthias Ringwald 5173137715ebSMatthias Ringwald uint8_t gap_set_security_mode(gap_security_mode_t security_mode){ 5174137715ebSMatthias Ringwald if ((security_mode == GAP_SECURITY_MODE_4) || (security_mode == GAP_SECURITY_MODE_2)){ 51755dbec6b3SMatthias Ringwald hci_stack->gap_security_mode = security_mode; 5176137715ebSMatthias Ringwald return ERROR_CODE_SUCCESS; 5177137715ebSMatthias Ringwald } else { 5178137715ebSMatthias Ringwald return ERROR_CODE_UNSUPPORTED_FEATURE_OR_PARAMETER_VALUE; 5179137715ebSMatthias Ringwald } 51805dbec6b3SMatthias Ringwald } 51815dbec6b3SMatthias Ringwald 51825dbec6b3SMatthias Ringwald gap_security_mode_t gap_get_security_mode(void){ 51835dbec6b3SMatthias Ringwald return hci_stack->gap_security_mode; 51845dbec6b3SMatthias Ringwald } 51855dbec6b3SMatthias Ringwald 518678315a58SMatthias Ringwald void gap_set_security_level(gap_security_level_t security_level){ 518778315a58SMatthias Ringwald hci_stack->gap_security_level = security_level; 518878315a58SMatthias Ringwald } 518978315a58SMatthias Ringwald 519078315a58SMatthias Ringwald gap_security_level_t gap_get_security_level(void){ 5191d7387af3SMatthias Ringwald if (hci_stack->gap_secure_connections_only_mode){ 5192d7387af3SMatthias Ringwald return LEVEL_4; 5193d7387af3SMatthias Ringwald } 519478315a58SMatthias Ringwald return hci_stack->gap_security_level; 519578315a58SMatthias Ringwald } 519630cdf3c6SMatthias Ringwald 51978ad4dfffSMatthias Ringwald void gap_set_minimal_service_security_level(gap_security_level_t security_level){ 51988ad4dfffSMatthias Ringwald hci_stack->gap_minimal_service_security_level = security_level; 51998ad4dfffSMatthias Ringwald } 52008ad4dfffSMatthias Ringwald 520130cdf3c6SMatthias Ringwald void gap_set_secure_connections_only_mode(bool enable){ 520230cdf3c6SMatthias Ringwald hci_stack->gap_secure_connections_only_mode = enable; 520330cdf3c6SMatthias Ringwald } 520430cdf3c6SMatthias Ringwald 520530cdf3c6SMatthias Ringwald bool gap_get_secure_connections_only_mode(void){ 520630cdf3c6SMatthias Ringwald return hci_stack->gap_secure_connections_only_mode; 520730cdf3c6SMatthias Ringwald } 5208170fafaeSMatthias Ringwald #endif 5209170fafaeSMatthias Ringwald 5210170fafaeSMatthias Ringwald #ifdef ENABLE_CLASSIC 521160b9e82fSMatthias Ringwald void gap_set_class_of_device(uint32_t class_of_device){ 52129e61646fS[email protected] hci_stack->class_of_device = class_of_device; 5213baa4881eSMatthias Ringwald hci_stack->gap_tasks_classic |= GAP_TASK_SET_CLASS_OF_DEVICE; 521459d59ecfSMatthias Ringwald hci_run(); 52159e61646fS[email protected] } 521676f27cffSMatthias Ringwald 5217c33e56d3SMatthias Ringwald void gap_set_default_link_policy_settings(uint16_t default_link_policy_settings){ 5218c33e56d3SMatthias Ringwald hci_stack->default_link_policy_settings = default_link_policy_settings; 5219baa4881eSMatthias Ringwald hci_stack->gap_tasks_classic |= GAP_TASK_SET_DEFAULT_LINK_POLICY; 522059d59ecfSMatthias Ringwald hci_run(); 5221c33e56d3SMatthias Ringwald } 5222c33e56d3SMatthias Ringwald 5223b4eb4420SMatthias Ringwald void gap_set_allow_role_switch(bool allow_role_switch){ 5224b4eb4420SMatthias Ringwald hci_stack->allow_role_switch = allow_role_switch ? 1 : 0; 5225b4eb4420SMatthias Ringwald } 5226b4eb4420SMatthias Ringwald 5227b4eb4420SMatthias Ringwald uint8_t hci_get_allow_role_switch(void){ 5228b4eb4420SMatthias Ringwald return hci_stack->allow_role_switch; 5229b4eb4420SMatthias Ringwald } 5230b4eb4420SMatthias Ringwald 52310c3eb48dSMatthias Ringwald void gap_set_link_supervision_timeout(uint16_t link_supervision_timeout){ 52320c3eb48dSMatthias Ringwald hci_stack->link_supervision_timeout = link_supervision_timeout; 52330c3eb48dSMatthias Ringwald } 52340c3eb48dSMatthias Ringwald 52359afaa4d4SMatthias Ringwald void gap_enable_link_watchdog(uint16_t timeout_ms){ 52369afaa4d4SMatthias Ringwald hci_stack->automatic_flush_timeout = btstack_min(timeout_ms, 1280) * 8 / 5; // divide by 0.625 52379afaa4d4SMatthias Ringwald } 52389afaa4d4SMatthias Ringwald 52399afaa4d4SMatthias Ringwald uint16_t hci_automatic_flush_timeout(void){ 52409afaa4d4SMatthias Ringwald return hci_stack->automatic_flush_timeout; 52419afaa4d4SMatthias Ringwald } 52429afaa4d4SMatthias Ringwald 524376f27cffSMatthias Ringwald void hci_disable_l2cap_timeout_check(void){ 524476f27cffSMatthias Ringwald disable_l2cap_timeouts = 1; 524576f27cffSMatthias Ringwald } 524635454696SMatthias Ringwald #endif 52479e61646fS[email protected] 52486fad2c37SMatthias Ringwald #ifndef HAVE_HOST_CONTROLLER_API 5249f456b2d0S[email protected] // Set Public BD ADDR - passed on to Bluetooth chipset if supported in bt_control_h 5250f456b2d0S[email protected] void hci_set_bd_addr(bd_addr_t addr){ 52516535961aSMatthias Ringwald (void)memcpy(hci_stack->custom_bd_addr, addr, 6); 5252f456b2d0S[email protected] hci_stack->custom_bd_addr_set = 1; 5253f456b2d0S[email protected] } 525476f27cffSMatthias Ringwald #endif 5255f456b2d0S[email protected] 52568d213e1aSmatthias.ringwald // State-Module-Driver overview 52578d213e1aSmatthias.ringwald // state module low-level 52588d213e1aSmatthias.ringwald // HCI_STATE_OFF off close 52598d213e1aSmatthias.ringwald // HCI_STATE_INITIALIZING, on open 52608d213e1aSmatthias.ringwald // HCI_STATE_WORKING, on open 52618d213e1aSmatthias.ringwald // HCI_STATE_HALTING, on open 5262d661ed19Smatthias.ringwald // HCI_STATE_SLEEPING, off/sleep close 5263d661ed19Smatthias.ringwald // HCI_STATE_FALLING_ASLEEP on open 5264c7e0c5f6Smatthias.ringwald 526540d1c7a4Smatthias.ringwald static int hci_power_control_on(void){ 52667301ad89Smatthias.ringwald 5267038bc64cSmatthias.ringwald // power on 5268f9a30166Smatthias.ringwald int err = 0; 52693a9fb326S[email protected] if (hci_stack->control && hci_stack->control->on){ 5270d0b87befSMatthias Ringwald err = (*hci_stack->control->on)(); 5271f9a30166Smatthias.ringwald } 5272038bc64cSmatthias.ringwald if (err){ 52739da54300S[email protected] log_error( "POWER_ON failed"); 5274038bc64cSmatthias.ringwald hci_emit_hci_open_failed(); 5275038bc64cSmatthias.ringwald return err; 5276038bc64cSmatthias.ringwald } 5277038bc64cSmatthias.ringwald 527824b3c629SMatthias Ringwald // int chipset driver 52793fb36a29SMatthias Ringwald if (hci_stack->chipset && hci_stack->chipset->init){ 52803fb36a29SMatthias Ringwald hci_stack->chipset->init(hci_stack->config); 52813fb36a29SMatthias Ringwald } 52823fb36a29SMatthias Ringwald 528324b3c629SMatthias Ringwald // init transport 528424b3c629SMatthias Ringwald if (hci_stack->hci_transport->init){ 528524b3c629SMatthias Ringwald hci_stack->hci_transport->init(hci_stack->config); 528624b3c629SMatthias Ringwald } 528724b3c629SMatthias Ringwald 528824b3c629SMatthias Ringwald // open transport 528924b3c629SMatthias Ringwald err = hci_stack->hci_transport->open(); 5290038bc64cSmatthias.ringwald if (err){ 52919da54300S[email protected] log_error( "HCI_INIT failed, turning Bluetooth off again"); 52923a9fb326S[email protected] if (hci_stack->control && hci_stack->control->off){ 5293d0b87befSMatthias Ringwald (*hci_stack->control->off)(); 5294f9a30166Smatthias.ringwald } 5295038bc64cSmatthias.ringwald hci_emit_hci_open_failed(); 5296038bc64cSmatthias.ringwald return err; 5297038bc64cSmatthias.ringwald } 52988d213e1aSmatthias.ringwald return 0; 52998d213e1aSmatthias.ringwald } 5300038bc64cSmatthias.ringwald 530140d1c7a4Smatthias.ringwald static void hci_power_control_off(void){ 53028d213e1aSmatthias.ringwald 53039da54300S[email protected] log_info("hci_power_control_off"); 53049418f9c9Smatthias.ringwald 53058d213e1aSmatthias.ringwald // close low-level device 530624b3c629SMatthias Ringwald hci_stack->hci_transport->close(); 53078d213e1aSmatthias.ringwald 53089da54300S[email protected] log_info("hci_power_control_off - hci_transport closed"); 53099418f9c9Smatthias.ringwald 53108d213e1aSmatthias.ringwald // power off 53113a9fb326S[email protected] if (hci_stack->control && hci_stack->control->off){ 5312d0b87befSMatthias Ringwald (*hci_stack->control->off)(); 53138d213e1aSmatthias.ringwald } 53149418f9c9Smatthias.ringwald 53159da54300S[email protected] log_info("hci_power_control_off - control closed"); 53169418f9c9Smatthias.ringwald 53173a9fb326S[email protected] hci_stack->state = HCI_STATE_OFF; 531872ea5239Smatthias.ringwald } 531972ea5239Smatthias.ringwald 532040d1c7a4Smatthias.ringwald static void hci_power_control_sleep(void){ 532172ea5239Smatthias.ringwald 53229da54300S[email protected] log_info("hci_power_control_sleep"); 53233144bce4Smatthias.ringwald 5324b429b9b7Smatthias.ringwald #if 0 5325b429b9b7Smatthias.ringwald // don't close serial port during sleep 5326b429b9b7Smatthias.ringwald 532772ea5239Smatthias.ringwald // close low-level device 53283a9fb326S[email protected] hci_stack->hci_transport->close(hci_stack->config); 5329b429b9b7Smatthias.ringwald #endif 533072ea5239Smatthias.ringwald 533172ea5239Smatthias.ringwald // sleep mode 53323a9fb326S[email protected] if (hci_stack->control && hci_stack->control->sleep){ 5333d0b87befSMatthias Ringwald (*hci_stack->control->sleep)(); 533472ea5239Smatthias.ringwald } 5335b429b9b7Smatthias.ringwald 53363a9fb326S[email protected] hci_stack->state = HCI_STATE_SLEEPING; 53378d213e1aSmatthias.ringwald } 53388d213e1aSmatthias.ringwald 533940d1c7a4Smatthias.ringwald static int hci_power_control_wake(void){ 5340b429b9b7Smatthias.ringwald 53419da54300S[email protected] log_info("hci_power_control_wake"); 5342b429b9b7Smatthias.ringwald 5343b429b9b7Smatthias.ringwald // wake on 53443a9fb326S[email protected] if (hci_stack->control && hci_stack->control->wake){ 5345d0b87befSMatthias Ringwald (*hci_stack->control->wake)(); 5346b429b9b7Smatthias.ringwald } 5347b429b9b7Smatthias.ringwald 5348b429b9b7Smatthias.ringwald #if 0 5349b429b9b7Smatthias.ringwald // open low-level device 53503a9fb326S[email protected] int err = hci_stack->hci_transport->open(hci_stack->config); 5351b429b9b7Smatthias.ringwald if (err){ 53529da54300S[email protected] log_error( "HCI_INIT failed, turning Bluetooth off again"); 53533a9fb326S[email protected] if (hci_stack->control && hci_stack->control->off){ 5354d0b87befSMatthias Ringwald (*hci_stack->control->off)(); 5355b429b9b7Smatthias.ringwald } 5356b429b9b7Smatthias.ringwald hci_emit_hci_open_failed(); 5357b429b9b7Smatthias.ringwald return err; 5358b429b9b7Smatthias.ringwald } 5359b429b9b7Smatthias.ringwald #endif 5360b429b9b7Smatthias.ringwald 5361b429b9b7Smatthias.ringwald return 0; 5362b429b9b7Smatthias.ringwald } 5363b429b9b7Smatthias.ringwald 53640c88d5efSMatthias Ringwald static void hci_power_enter_initializing_state(void){ 536544935e40S[email protected] // set up state machine 536644935e40S[email protected] hci_stack->num_cmd_packets = 1; // assume that one cmd can be sent 536702c7fc01SMatthias Ringwald hci_stack->hci_packet_buffer_reserved = false; 536844935e40S[email protected] hci_stack->state = HCI_STATE_INITIALIZING; 53696fe16221SMatthias Ringwald 53700535e08cSMatthias Ringwald #ifndef HAVE_HOST_CONTROLLER_API 53716fe16221SMatthias Ringwald if (hci_stack->chipset_pre_init) { 53726fe16221SMatthias Ringwald hci_stack->substate = HCI_INIT_CUSTOM_PRE_INIT; 53730535e08cSMatthias Ringwald } else 53740535e08cSMatthias Ringwald #endif 53750535e08cSMatthias Ringwald { 53765c363727SMatthias Ringwald hci_stack->substate = HCI_INIT_SEND_RESET; 537744935e40S[email protected] } 53786fe16221SMatthias Ringwald } 5379b429b9b7Smatthias.ringwald 53800c88d5efSMatthias Ringwald static void hci_power_enter_halting_state(void){ 53810c88d5efSMatthias Ringwald #ifdef ENABLE_BLE 53821e907691SMatthias Ringwald // drop entries scheduled for removal, mark others for re-adding 53831e907691SMatthias Ringwald btstack_linked_list_iterator_t it; 53841e907691SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->le_whitelist); 53851e907691SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 53861e907691SMatthias Ringwald whitelist_entry_t * entry = (whitelist_entry_t*) btstack_linked_list_iterator_next(&it); 53871e907691SMatthias Ringwald if ((entry->state & (LE_WHITELIST_REMOVE_FROM_CONTROLLER | LE_WHITELIST_ADD_TO_CONTROLLER)) == LE_WHITELIST_REMOVE_FROM_CONTROLLER){ 53881e907691SMatthias Ringwald btstack_linked_list_iterator_remove(&it); 53891e907691SMatthias Ringwald btstack_memory_whitelist_entry_free(entry); 53901e907691SMatthias Ringwald } else { 53911e907691SMatthias Ringwald entry->state = LE_WHITELIST_ADD_TO_CONTROLLER; 53921e907691SMatthias Ringwald } 53931e907691SMatthias Ringwald } 53944718c38dSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 5395a2c9d908SMatthias Ringwald #ifdef ENABLE_LE_PERIODIC_ADVERTISING 5396e8d160b3SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->le_periodic_advertiser_list); 5397e8d160b3SMatthias Ringwald const uint8_t mask = LE_PERIODIC_ADVERTISER_LIST_ENTRY_REMOVE_FROM_CONTROLLER | LE_PERIODIC_ADVERTISER_LIST_ENTRY_REMOVE_FROM_CONTROLLER; 5398e8d160b3SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 5399e8d160b3SMatthias Ringwald periodic_advertiser_list_entry_t * entry = (periodic_advertiser_list_entry_t*) btstack_linked_list_iterator_next(&it); 5400e8d160b3SMatthias Ringwald if ((entry->state & mask) == LE_PERIODIC_ADVERTISER_LIST_ENTRY_REMOVE_FROM_CONTROLLER) { 5401e8d160b3SMatthias Ringwald btstack_linked_list_iterator_remove(&it); 5402e8d160b3SMatthias Ringwald btstack_memory_periodic_advertiser_list_entry_free(entry); 5403e8d160b3SMatthias Ringwald } else { 5404e8d160b3SMatthias Ringwald entry->state |= LE_PERIODIC_ADVERTISER_LIST_ENTRY_ADD_TO_CONTROLLER; 5405e8d160b3SMatthias Ringwald continue; 5406e8d160b3SMatthias Ringwald } 5407e8d160b3SMatthias Ringwald } 5408a2c9d908SMatthias Ringwald #endif 54090c88d5efSMatthias Ringwald #endif 54104718c38dSMatthias Ringwald #endif 5411184dbe2fSMatthias Ringwald // see hci_run 5412184dbe2fSMatthias Ringwald hci_stack->state = HCI_STATE_HALTING; 54130c88d5efSMatthias Ringwald hci_stack->substate = HCI_HALTING_CLASSIC_STOP; 5414184dbe2fSMatthias Ringwald // setup watchdog timer for disconnect - only triggers if Controller does not respond anymore 5415184dbe2fSMatthias Ringwald btstack_run_loop_set_timer(&hci_stack->timeout, 1000); 5416184dbe2fSMatthias Ringwald btstack_run_loop_set_timer_handler(&hci_stack->timeout, hci_halting_timeout_handler); 5417184dbe2fSMatthias Ringwald btstack_run_loop_add_timer(&hci_stack->timeout); 5418184dbe2fSMatthias Ringwald } 5419184dbe2fSMatthias Ringwald 542042bd3d77SMatthias Ringwald // returns error 542142bd3d77SMatthias Ringwald static int hci_power_control_state_off(HCI_POWER_MODE power_mode){ 542242bd3d77SMatthias Ringwald int err; 54238d213e1aSmatthias.ringwald switch (power_mode){ 54248d213e1aSmatthias.ringwald case HCI_POWER_ON: 54258d213e1aSmatthias.ringwald err = hci_power_control_on(); 542642bd3d77SMatthias Ringwald if (err != 0) { 5427f04a0c31SMatthias Ringwald log_error("hci_power_control_on() error %d", err); 542897b61c7bS[email protected] return err; 542997b61c7bS[email protected] } 54300c88d5efSMatthias Ringwald hci_power_enter_initializing_state(); 54318d213e1aSmatthias.ringwald break; 54328d213e1aSmatthias.ringwald case HCI_POWER_OFF: 54338d213e1aSmatthias.ringwald // do nothing 54348d213e1aSmatthias.ringwald break; 54358d213e1aSmatthias.ringwald case HCI_POWER_SLEEP: 5436b546ac54Smatthias.ringwald // do nothing (with SLEEP == OFF) 54378d213e1aSmatthias.ringwald break; 54387bbeb3adSMilanka Ringwald default: 54397bbeb3adSMilanka Ringwald btstack_assert(false); 54407bbeb3adSMilanka Ringwald break; 54418d213e1aSmatthias.ringwald } 544242bd3d77SMatthias Ringwald return ERROR_CODE_SUCCESS; 544342bd3d77SMatthias Ringwald } 54447301ad89Smatthias.ringwald 544542bd3d77SMatthias Ringwald static int hci_power_control_state_initializing(HCI_POWER_MODE power_mode){ 54468d213e1aSmatthias.ringwald switch (power_mode){ 54478d213e1aSmatthias.ringwald case HCI_POWER_ON: 54488d213e1aSmatthias.ringwald // do nothing 54498d213e1aSmatthias.ringwald break; 54508d213e1aSmatthias.ringwald case HCI_POWER_OFF: 54518d213e1aSmatthias.ringwald // no connections yet, just turn it off 54528d213e1aSmatthias.ringwald hci_power_control_off(); 54538d213e1aSmatthias.ringwald break; 54548d213e1aSmatthias.ringwald case HCI_POWER_SLEEP: 5455b546ac54Smatthias.ringwald // no connections yet, just turn it off 545672ea5239Smatthias.ringwald hci_power_control_sleep(); 54578d213e1aSmatthias.ringwald break; 54587bbeb3adSMilanka Ringwald default: 54597bbeb3adSMilanka Ringwald btstack_assert(false); 54607bbeb3adSMilanka Ringwald break; 54618d213e1aSmatthias.ringwald } 546242bd3d77SMatthias Ringwald return ERROR_CODE_SUCCESS; 546342bd3d77SMatthias Ringwald } 54647301ad89Smatthias.ringwald 546542bd3d77SMatthias Ringwald static int hci_power_control_state_working(HCI_POWER_MODE power_mode) { 54668d213e1aSmatthias.ringwald switch (power_mode){ 54678d213e1aSmatthias.ringwald case HCI_POWER_ON: 54688d213e1aSmatthias.ringwald // do nothing 54698d213e1aSmatthias.ringwald break; 54708d213e1aSmatthias.ringwald case HCI_POWER_OFF: 54710c88d5efSMatthias Ringwald hci_power_enter_halting_state(); 54728d213e1aSmatthias.ringwald break; 54738d213e1aSmatthias.ringwald case HCI_POWER_SLEEP: 5474b546ac54Smatthias.ringwald // see hci_run 54753a9fb326S[email protected] hci_stack->state = HCI_STATE_FALLING_ASLEEP; 547674b323a9SMatthias Ringwald hci_stack->substate = HCI_FALLING_ASLEEP_DISCONNECT; 54778d213e1aSmatthias.ringwald break; 54787bbeb3adSMilanka Ringwald default: 54797bbeb3adSMilanka Ringwald btstack_assert(false); 54807bbeb3adSMilanka Ringwald break; 54818d213e1aSmatthias.ringwald } 548242bd3d77SMatthias Ringwald return ERROR_CODE_SUCCESS; 548342bd3d77SMatthias Ringwald } 54847301ad89Smatthias.ringwald 548542bd3d77SMatthias Ringwald static int hci_power_control_state_halting(HCI_POWER_MODE power_mode) { 54868d213e1aSmatthias.ringwald switch (power_mode){ 54878d213e1aSmatthias.ringwald case HCI_POWER_ON: 54880c88d5efSMatthias Ringwald hci_power_enter_initializing_state(); 54898d213e1aSmatthias.ringwald break; 54908d213e1aSmatthias.ringwald case HCI_POWER_OFF: 54918d213e1aSmatthias.ringwald // do nothing 54928d213e1aSmatthias.ringwald break; 54938d213e1aSmatthias.ringwald case HCI_POWER_SLEEP: 5494b546ac54Smatthias.ringwald // see hci_run 54953a9fb326S[email protected] hci_stack->state = HCI_STATE_FALLING_ASLEEP; 549674b323a9SMatthias Ringwald hci_stack->substate = HCI_FALLING_ASLEEP_DISCONNECT; 54978d213e1aSmatthias.ringwald break; 54987bbeb3adSMilanka Ringwald default: 54997bbeb3adSMilanka Ringwald btstack_assert(false); 55007bbeb3adSMilanka Ringwald break; 55018d213e1aSmatthias.ringwald } 550200278272SMatthias Ringwald return ERROR_CODE_SUCCESS; 550342bd3d77SMatthias Ringwald } 55048d213e1aSmatthias.ringwald 550542bd3d77SMatthias Ringwald static int hci_power_control_state_falling_asleep(HCI_POWER_MODE power_mode) { 55068d213e1aSmatthias.ringwald switch (power_mode){ 55078d213e1aSmatthias.ringwald case HCI_POWER_ON: 55080c88d5efSMatthias Ringwald hci_power_enter_initializing_state(); 55098d213e1aSmatthias.ringwald break; 55108d213e1aSmatthias.ringwald case HCI_POWER_OFF: 55110c88d5efSMatthias Ringwald hci_power_enter_halting_state(); 55128d213e1aSmatthias.ringwald break; 55138d213e1aSmatthias.ringwald case HCI_POWER_SLEEP: 5514b546ac54Smatthias.ringwald // do nothing 55158d213e1aSmatthias.ringwald break; 55167bbeb3adSMilanka Ringwald default: 55177bbeb3adSMilanka Ringwald btstack_assert(false); 55187bbeb3adSMilanka Ringwald break; 55198d213e1aSmatthias.ringwald } 552042bd3d77SMatthias Ringwald return ERROR_CODE_SUCCESS; 552142bd3d77SMatthias Ringwald } 55228d213e1aSmatthias.ringwald 552342bd3d77SMatthias Ringwald static int hci_power_control_state_sleeping(HCI_POWER_MODE power_mode) { 552442bd3d77SMatthias Ringwald int err; 55258d213e1aSmatthias.ringwald switch (power_mode){ 55268d213e1aSmatthias.ringwald case HCI_POWER_ON: 55273144bce4Smatthias.ringwald err = hci_power_control_wake(); 55283144bce4Smatthias.ringwald if (err) return err; 55290c88d5efSMatthias Ringwald hci_power_enter_initializing_state(); 55308d213e1aSmatthias.ringwald break; 55318d213e1aSmatthias.ringwald case HCI_POWER_OFF: 55320c88d5efSMatthias Ringwald hci_power_enter_halting_state(); 55338d213e1aSmatthias.ringwald break; 55348d213e1aSmatthias.ringwald case HCI_POWER_SLEEP: 5535b546ac54Smatthias.ringwald // do nothing 55368d213e1aSmatthias.ringwald break; 55377bbeb3adSMilanka Ringwald default: 55387bbeb3adSMilanka Ringwald btstack_assert(false); 55397bbeb3adSMilanka Ringwald break; 55408d213e1aSmatthias.ringwald } 554142bd3d77SMatthias Ringwald return ERROR_CODE_SUCCESS; 554242bd3d77SMatthias Ringwald } 55437bbeb3adSMilanka Ringwald 554442bd3d77SMatthias Ringwald int hci_power_control(HCI_POWER_MODE power_mode){ 554542bd3d77SMatthias Ringwald log_info("hci_power_control: %d, current mode %u", power_mode, hci_stack->state); 5546bef627f1SMatthias Ringwald btstack_run_loop_remove_timer(&hci_stack->timeout); 554724f87726SMatthias Ringwald int err = 0; 554842bd3d77SMatthias Ringwald switch (hci_stack->state){ 554942bd3d77SMatthias Ringwald case HCI_STATE_OFF: 555042bd3d77SMatthias Ringwald err = hci_power_control_state_off(power_mode); 555142bd3d77SMatthias Ringwald break; 555242bd3d77SMatthias Ringwald case HCI_STATE_INITIALIZING: 555342bd3d77SMatthias Ringwald err = hci_power_control_state_initializing(power_mode); 555442bd3d77SMatthias Ringwald break; 555542bd3d77SMatthias Ringwald case HCI_STATE_WORKING: 555642bd3d77SMatthias Ringwald err = hci_power_control_state_working(power_mode); 555742bd3d77SMatthias Ringwald break; 555842bd3d77SMatthias Ringwald case HCI_STATE_HALTING: 555942bd3d77SMatthias Ringwald err = hci_power_control_state_halting(power_mode); 556042bd3d77SMatthias Ringwald break; 556142bd3d77SMatthias Ringwald case HCI_STATE_FALLING_ASLEEP: 556242bd3d77SMatthias Ringwald err = hci_power_control_state_falling_asleep(power_mode); 556342bd3d77SMatthias Ringwald break; 556442bd3d77SMatthias Ringwald case HCI_STATE_SLEEPING: 556542bd3d77SMatthias Ringwald err = hci_power_control_state_sleeping(power_mode); 556642bd3d77SMatthias Ringwald break; 55677bbeb3adSMilanka Ringwald default: 55687bbeb3adSMilanka Ringwald btstack_assert(false); 55697bbeb3adSMilanka Ringwald break; 557011e23e5fSmatthias.ringwald } 557124f87726SMatthias Ringwald if (err != 0){ 557242bd3d77SMatthias Ringwald return err; 557342bd3d77SMatthias Ringwald } 557468d92d03Smatthias.ringwald 5575038bc64cSmatthias.ringwald // create internal event 5576ee8bf225Smatthias.ringwald hci_emit_state(); 5577ee8bf225Smatthias.ringwald 557868d92d03Smatthias.ringwald // trigger next/first action 557968d92d03Smatthias.ringwald hci_run(); 558068d92d03Smatthias.ringwald 5581475c8125Smatthias.ringwald return 0; 5582475c8125Smatthias.ringwald } 5583475c8125Smatthias.ringwald 558435454696SMatthias Ringwald 5585091e35e3SMatthias Ringwald static void hci_halting_run(void) { 5586091e35e3SMatthias Ringwald 5587091e35e3SMatthias Ringwald log_info("HCI_STATE_HALTING, substate %x\n", hci_stack->substate); 5588091e35e3SMatthias Ringwald 5589091e35e3SMatthias Ringwald hci_connection_t *connection; 5590d5f71a7eSMatthias Ringwald #ifdef ENABLE_BLE 5591d5f71a7eSMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 5592a086dc35SMatthias Ringwald bool stop_advertisements; 5593d5f71a7eSMatthias Ringwald #endif 5594d5f71a7eSMatthias Ringwald #endif 5595091e35e3SMatthias Ringwald 5596091e35e3SMatthias Ringwald switch (hci_stack->substate) { 55970c88d5efSMatthias Ringwald case HCI_HALTING_CLASSIC_STOP: 55980c88d5efSMatthias Ringwald #ifdef ENABLE_CLASSIC 5599911801caSMatthias Ringwald if (!hci_can_send_command_packet_now()) return; 5600911801caSMatthias Ringwald 56010c88d5efSMatthias Ringwald if (hci_stack->connectable || hci_stack->discoverable){ 56020c88d5efSMatthias Ringwald hci_stack->substate = HCI_HALTING_LE_ADV_STOP; 56030c88d5efSMatthias Ringwald hci_send_cmd(&hci_write_scan_enable, 0); 56040c88d5efSMatthias Ringwald return; 56050c88d5efSMatthias Ringwald } 56060c88d5efSMatthias Ringwald #endif 56070c88d5efSMatthias Ringwald /* fall through */ 56080c88d5efSMatthias Ringwald 56090c88d5efSMatthias Ringwald case HCI_HALTING_LE_ADV_STOP: 56100c88d5efSMatthias Ringwald hci_stack->substate = HCI_HALTING_LE_ADV_STOP; 56110c88d5efSMatthias Ringwald 56120c88d5efSMatthias Ringwald #ifdef ENABLE_BLE 56130c88d5efSMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 5614911801caSMatthias Ringwald if (!hci_can_send_command_packet_now()) return; 5615911801caSMatthias Ringwald 5616a086dc35SMatthias Ringwald stop_advertisements = (hci_stack->le_advertisements_state & LE_ADVERTISEMENT_STATE_ACTIVE) != 0; 5617911801caSMatthias Ringwald 5618911801caSMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 561922f987e4SMatthias Ringwald if (hci_le_extended_advertising_supported()){ 5620c814a904SMatthias Ringwald #ifdef ENABLE_LE_PERIODIC_ADVERTISING 5621911801caSMatthias Ringwald btstack_linked_list_iterator_t it; 5622911801caSMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->le_advertising_sets); 5623911801caSMatthias Ringwald // stop all periodic advertisements and check if an extended set is active 5624911801caSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 5625911801caSMatthias Ringwald le_advertising_set_t * advertising_set = (le_advertising_set_t*) btstack_linked_list_iterator_next(&it); 5626911801caSMatthias Ringwald if ((advertising_set->state & LE_ADVERTISEMENT_STATE_PERIODIC_ACTIVE) != 0) { 5627911801caSMatthias Ringwald advertising_set->state &= ~LE_ADVERTISEMENT_STATE_PERIODIC_ACTIVE; 5628911801caSMatthias Ringwald hci_send_cmd(&hci_le_set_periodic_advertising_enable, 0, advertising_set->advertising_handle); 56290c88d5efSMatthias Ringwald return; 56300c88d5efSMatthias Ringwald } 5631911801caSMatthias Ringwald if ((advertising_set->state & LE_ADVERTISEMENT_STATE_ACTIVE) != 0) { 56320aeb0b24SMatthias Ringwald stop_advertisements = true; 5633911801caSMatthias Ringwald advertising_set->state &= ~LE_ADVERTISEMENT_STATE_ACTIVE; 5634911801caSMatthias Ringwald } 5635911801caSMatthias Ringwald } 5636c814a904SMatthias Ringwald #endif /* ENABLE_LE_PERIODIC_ADVERTISING */ 56370aeb0b24SMatthias Ringwald if (stop_advertisements){ 5638911801caSMatthias Ringwald hci_stack->le_advertisements_state &= ~LE_ADVERTISEMENT_STATE_ACTIVE; 5639911801caSMatthias Ringwald hci_send_cmd(&hci_le_set_extended_advertising_enable, 0, 0, NULL, NULL, NULL); 5640911801caSMatthias Ringwald return; 5641911801caSMatthias Ringwald } 5642d935373dSMatthias Ringwald } else 5643a2c9d908SMatthias Ringwald #else /* ENABLE_LE_PERIPHERAL */ 5644911801caSMatthias Ringwald { 5645a086dc35SMatthias Ringwald if (stop_advertisements) { 5646911801caSMatthias Ringwald hci_stack->le_advertisements_state &= ~LE_ADVERTISEMENT_STATE_ACTIVE; 5647911801caSMatthias Ringwald hci_send_cmd(&hci_le_set_advertise_enable, 0); 5648911801caSMatthias Ringwald return; 5649911801caSMatthias Ringwald } 5650911801caSMatthias Ringwald } 5651911801caSMatthias Ringwald #endif /* ENABLE_LE_EXTENDED_ADVERTISING*/ 5652911801caSMatthias Ringwald #endif /* ENABLE_LE_PERIPHERAL */ 5653911801caSMatthias Ringwald #endif /* ENABLE_BLE */ 5654911801caSMatthias Ringwald 56550c88d5efSMatthias Ringwald /* fall through */ 56560c88d5efSMatthias Ringwald 56570c88d5efSMatthias Ringwald case HCI_HALTING_LE_SCAN_STOP: 56580c88d5efSMatthias Ringwald hci_stack->substate = HCI_HALTING_LE_SCAN_STOP; 5659911801caSMatthias Ringwald if (!hci_can_send_command_packet_now()) return; 5660091e35e3SMatthias Ringwald 5661091e35e3SMatthias Ringwald #ifdef ENABLE_BLE 5662091e35e3SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 56630c88d5efSMatthias Ringwald if (hci_stack->le_scanning_active){ 5664c42da3bcSMatthias Ringwald hci_le_scan_stop(); 56650c88d5efSMatthias Ringwald hci_stack->substate = HCI_HALTING_DISCONNECT_ALL; 56660c88d5efSMatthias Ringwald return; 56670c88d5efSMatthias Ringwald } 5668091e35e3SMatthias Ringwald #endif 5669091e35e3SMatthias Ringwald #endif 56700c88d5efSMatthias Ringwald 56710c88d5efSMatthias Ringwald /* fall through */ 56720c88d5efSMatthias Ringwald 56730c88d5efSMatthias Ringwald case HCI_HALTING_DISCONNECT_ALL: 56740c88d5efSMatthias Ringwald hci_stack->substate = HCI_HALTING_DISCONNECT_ALL; 5675911801caSMatthias Ringwald if (!hci_can_send_command_packet_now()) return; 56760c88d5efSMatthias Ringwald 5677091e35e3SMatthias Ringwald // close all open connections 5678091e35e3SMatthias Ringwald connection = (hci_connection_t *) hci_stack->connections; 5679091e35e3SMatthias Ringwald if (connection) { 5680091e35e3SMatthias Ringwald hci_con_handle_t con_handle = (uint16_t) connection->con_handle; 5681091e35e3SMatthias Ringwald 568247bf68a7SDirk Helbig log_info("HCI_STATE_HALTING, connection %p, handle %u, state %u", (void*)connection, con_handle, connection->state); 5683091e35e3SMatthias Ringwald 568403270f05SMatthias Ringwald // check state 568503270f05SMatthias Ringwald switch(connection->state) { 568603270f05SMatthias Ringwald case SENT_DISCONNECT: 568703270f05SMatthias Ringwald case RECEIVED_DISCONNECTION_COMPLETE: 568803270f05SMatthias Ringwald // wait until connection is gone 568903270f05SMatthias Ringwald return; 569003270f05SMatthias Ringwald default: 569103270f05SMatthias Ringwald break; 569203270f05SMatthias Ringwald } 5693091e35e3SMatthias Ringwald 5694091e35e3SMatthias Ringwald // finally, send the disconnect command 569503270f05SMatthias Ringwald connection->state = SENT_DISCONNECT; 5696091e35e3SMatthias Ringwald hci_send_cmd(&hci_disconnect, con_handle, ERROR_CODE_REMOTE_USER_TERMINATED_CONNECTION); 5697091e35e3SMatthias Ringwald return; 5698091e35e3SMatthias Ringwald } 5699091e35e3SMatthias Ringwald 5700346f8c2cSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS 5701346f8c2cSMatthias Ringwald // stop BIGs and BIG Syncs 5702346f8c2cSMatthias Ringwald if (hci_stack->le_audio_bigs != NULL){ 5703346f8c2cSMatthias Ringwald le_audio_big_t * big = (le_audio_big_t*) hci_stack->le_audio_bigs; 5704346f8c2cSMatthias Ringwald if (big->state == LE_AUDIO_BIG_STATE_W4_TERMINATED) return; 5705346f8c2cSMatthias Ringwald big->state = LE_AUDIO_BIG_STATE_W4_TERMINATED; 5706346f8c2cSMatthias Ringwald hci_send_cmd(&hci_le_terminate_big, big->big_handle); 5707346f8c2cSMatthias Ringwald return; 5708346f8c2cSMatthias Ringwald } 5709346f8c2cSMatthias Ringwald if (hci_stack->le_audio_big_syncs != NULL){ 5710346f8c2cSMatthias Ringwald le_audio_big_sync_t * big_sync = (le_audio_big_sync_t*) hci_stack->le_audio_big_syncs; 5711346f8c2cSMatthias Ringwald if (big_sync->state == LE_AUDIO_BIG_STATE_W4_TERMINATED) return; 5712346f8c2cSMatthias Ringwald big_sync->state = LE_AUDIO_BIG_STATE_W4_TERMINATED; 5713346f8c2cSMatthias Ringwald hci_send_cmd(&hci_le_big_terminate_sync, big_sync->big_handle); 5714346f8c2cSMatthias Ringwald return; 5715346f8c2cSMatthias Ringwald } 5716346f8c2cSMatthias Ringwald #endif 5717346f8c2cSMatthias Ringwald 5718091e35e3SMatthias Ringwald btstack_run_loop_remove_timer(&hci_stack->timeout); 5719091e35e3SMatthias Ringwald 5720a086dc35SMatthias Ringwald // no connections left, wait a bit to assert that btstack_crypto isn't waiting for an HCI event 5721091e35e3SMatthias Ringwald log_info("HCI_STATE_HALTING: wait 50 ms"); 57220c88d5efSMatthias Ringwald hci_stack->substate = HCI_HALTING_W4_CLOSE_TIMER; 5723091e35e3SMatthias Ringwald btstack_run_loop_set_timer(&hci_stack->timeout, 50); 5724091e35e3SMatthias Ringwald btstack_run_loop_set_timer_handler(&hci_stack->timeout, hci_halting_timeout_handler); 5725091e35e3SMatthias Ringwald btstack_run_loop_add_timer(&hci_stack->timeout); 5726091e35e3SMatthias Ringwald break; 5727091e35e3SMatthias Ringwald 5728b188b5fcSMatthias Ringwald case HCI_HALTING_W4_CLOSE_TIMER: 5729b188b5fcSMatthias Ringwald // keep waiting 5730b188b5fcSMatthias Ringwald break; 5731b188b5fcSMatthias Ringwald 5732091e35e3SMatthias Ringwald case HCI_HALTING_CLOSE: 5733091e35e3SMatthias Ringwald // close left over connections (that had not been properly closed before) 5734b188b5fcSMatthias Ringwald hci_stack->substate = HCI_HALTING_CLOSE_DISCARDING_CONNECTIONS; 5735091e35e3SMatthias Ringwald hci_discard_connections(); 5736091e35e3SMatthias Ringwald 5737091e35e3SMatthias Ringwald log_info("HCI_STATE_HALTING, calling off"); 5738091e35e3SMatthias Ringwald 5739091e35e3SMatthias Ringwald // switch mode 5740091e35e3SMatthias Ringwald hci_power_control_off(); 5741091e35e3SMatthias Ringwald 5742091e35e3SMatthias Ringwald log_info("HCI_STATE_HALTING, emitting state"); 5743091e35e3SMatthias Ringwald hci_emit_state(); 5744091e35e3SMatthias Ringwald log_info("HCI_STATE_HALTING, done"); 5745091e35e3SMatthias Ringwald break; 5746091e35e3SMatthias Ringwald 5747091e35e3SMatthias Ringwald default: 5748091e35e3SMatthias Ringwald break; 5749091e35e3SMatthias Ringwald } 575036916f81SDirk Helbig } 5751091e35e3SMatthias Ringwald 5752091e35e3SMatthias Ringwald static void hci_falling_asleep_run(void){ 5753091e35e3SMatthias Ringwald hci_connection_t * connection; 5754091e35e3SMatthias Ringwald switch(hci_stack->substate) { 5755091e35e3SMatthias Ringwald case HCI_FALLING_ASLEEP_DISCONNECT: 5756091e35e3SMatthias Ringwald log_info("HCI_STATE_FALLING_ASLEEP"); 5757091e35e3SMatthias Ringwald // close all open connections 5758091e35e3SMatthias Ringwald connection = (hci_connection_t *) hci_stack->connections; 5759091e35e3SMatthias Ringwald if (connection){ 5760091e35e3SMatthias Ringwald 5761091e35e3SMatthias Ringwald // send disconnect 5762091e35e3SMatthias Ringwald if (!hci_can_send_command_packet_now()) return; 5763091e35e3SMatthias Ringwald 576447bf68a7SDirk Helbig log_info("HCI_STATE_FALLING_ASLEEP, connection %p, handle %u", (void*)connection, (uint16_t)connection->con_handle); 5765091e35e3SMatthias Ringwald hci_send_cmd(&hci_disconnect, connection->con_handle, ERROR_CODE_REMOTE_USER_TERMINATED_CONNECTION); 5766091e35e3SMatthias Ringwald 5767091e35e3SMatthias Ringwald // send disconnected event right away - causes higher layer connections to get closed, too. 5768091e35e3SMatthias Ringwald hci_shutdown_connection(connection); 5769091e35e3SMatthias Ringwald return; 5770091e35e3SMatthias Ringwald } 5771091e35e3SMatthias Ringwald 5772091e35e3SMatthias Ringwald if (hci_classic_supported()){ 5773091e35e3SMatthias Ringwald // disable page and inquiry scan 5774091e35e3SMatthias Ringwald if (!hci_can_send_command_packet_now()) return; 5775091e35e3SMatthias Ringwald 5776091e35e3SMatthias Ringwald log_info("HCI_STATE_HALTING, disabling inq scans"); 5777091e35e3SMatthias Ringwald hci_send_cmd(&hci_write_scan_enable, hci_stack->connectable << 1); // drop inquiry scan but keep page scan 5778091e35e3SMatthias Ringwald 5779091e35e3SMatthias Ringwald // continue in next substate 5780091e35e3SMatthias Ringwald hci_stack->substate = HCI_FALLING_ASLEEP_W4_WRITE_SCAN_ENABLE; 5781091e35e3SMatthias Ringwald break; 5782091e35e3SMatthias Ringwald } 5783091e35e3SMatthias Ringwald 5784091e35e3SMatthias Ringwald /* fall through */ 5785091e35e3SMatthias Ringwald 5786091e35e3SMatthias Ringwald case HCI_FALLING_ASLEEP_COMPLETE: 5787091e35e3SMatthias Ringwald log_info("HCI_STATE_HALTING, calling sleep"); 5788091e35e3SMatthias Ringwald // switch mode 5789091e35e3SMatthias Ringwald hci_power_control_sleep(); // changes hci_stack->state to SLEEP 5790091e35e3SMatthias Ringwald hci_emit_state(); 5791091e35e3SMatthias Ringwald break; 5792091e35e3SMatthias Ringwald 5793091e35e3SMatthias Ringwald default: 5794091e35e3SMatthias Ringwald break; 5795091e35e3SMatthias Ringwald } 5796091e35e3SMatthias Ringwald } 5797091e35e3SMatthias Ringwald 579835454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 579935454696SMatthias Ringwald 5800758b46ceSmatthias.ringwald static void hci_update_scan_enable(void){ 5801758b46ceSmatthias.ringwald // 2 = page scan, 1 = inq scan 5802a1df452eSMatthias Ringwald hci_stack->new_scan_enable_value = (hci_stack->connectable << 1) | hci_stack->discoverable; 5803baa4881eSMatthias Ringwald hci_stack->gap_tasks_classic |= GAP_TASK_WRITE_SCAN_ENABLE; 5804758b46ceSmatthias.ringwald hci_run(); 5805758b46ceSmatthias.ringwald } 5806758b46ceSmatthias.ringwald 580715a95bd5SMatthias Ringwald void gap_discoverable_control(uint8_t enable){ 5808381fbed8Smatthias.ringwald if (enable) enable = 1; // normalize argument 5809381fbed8Smatthias.ringwald 58103a9fb326S[email protected] if (hci_stack->discoverable == enable){ 581171fd255dSMatthias Ringwald hci_emit_scan_mode_changed(hci_stack->discoverable, hci_stack->connectable); 5812381fbed8Smatthias.ringwald return; 5813381fbed8Smatthias.ringwald } 5814381fbed8Smatthias.ringwald 58153a9fb326S[email protected] hci_stack->discoverable = enable; 5816758b46ceSmatthias.ringwald hci_update_scan_enable(); 5817758b46ceSmatthias.ringwald } 5818b031bebbSmatthias.ringwald 581915a95bd5SMatthias Ringwald void gap_connectable_control(uint8_t enable){ 5820758b46ceSmatthias.ringwald if (enable) enable = 1; // normalize argument 5821758b46ceSmatthias.ringwald 5822758b46ceSmatthias.ringwald // don't emit event 58233a9fb326S[email protected] if (hci_stack->connectable == enable) return; 5824758b46ceSmatthias.ringwald 58253a9fb326S[email protected] hci_stack->connectable = enable; 5826758b46ceSmatthias.ringwald hci_update_scan_enable(); 5827381fbed8Smatthias.ringwald } 582835454696SMatthias Ringwald #endif 5829381fbed8Smatthias.ringwald 583015a95bd5SMatthias Ringwald void gap_local_bd_addr(bd_addr_t address_buffer){ 58316535961aSMatthias Ringwald (void)memcpy(address_buffer, hci_stack->local_bd_addr, 6); 58325061f3afS[email protected] } 58335061f3afS[email protected] 58342b838201SMatthias Ringwald #ifdef ENABLE_HCI_CONTROLLER_TO_HOST_FLOW_CONTROL 58352b838201SMatthias Ringwald static void hci_host_num_completed_packets(void){ 58362b838201SMatthias Ringwald 58372b838201SMatthias Ringwald // create packet manually as arrays are not supported and num_commands should not get reduced 58382b838201SMatthias Ringwald hci_reserve_packet_buffer(); 58392b838201SMatthias Ringwald uint8_t * packet = hci_get_outgoing_packet_buffer(); 58402b838201SMatthias Ringwald 58412b838201SMatthias Ringwald uint16_t size = 0; 58422b838201SMatthias Ringwald uint16_t num_handles = 0; 58432b838201SMatthias Ringwald packet[size++] = 0x35; 58442b838201SMatthias Ringwald packet[size++] = 0x0c; 58452b838201SMatthias Ringwald size++; // skip param len 58462b838201SMatthias Ringwald size++; // skip num handles 58472b838201SMatthias Ringwald 58482b838201SMatthias Ringwald // add { handle, packets } entries 58492b838201SMatthias Ringwald btstack_linked_item_t * it; 58502b838201SMatthias Ringwald for (it = (btstack_linked_item_t *) hci_stack->connections; it ; it = it->next){ 58512b838201SMatthias Ringwald hci_connection_t * connection = (hci_connection_t *) it; 58522b838201SMatthias Ringwald if (connection->num_packets_completed){ 58532b838201SMatthias Ringwald little_endian_store_16(packet, size, connection->con_handle); 58542b838201SMatthias Ringwald size += 2; 58552b838201SMatthias Ringwald little_endian_store_16(packet, size, connection->num_packets_completed); 58562b838201SMatthias Ringwald size += 2; 58572b838201SMatthias Ringwald // 58582b838201SMatthias Ringwald num_handles++; 58592b838201SMatthias Ringwald connection->num_packets_completed = 0; 58602b838201SMatthias Ringwald } 58612b838201SMatthias Ringwald } 58622b838201SMatthias Ringwald 58632b838201SMatthias Ringwald packet[2] = size - 3; 58642b838201SMatthias Ringwald packet[3] = num_handles; 58652b838201SMatthias Ringwald 58662b838201SMatthias Ringwald hci_stack->host_completed_packets = 0; 58672b838201SMatthias Ringwald 58682b838201SMatthias Ringwald hci_dump_packet(HCI_COMMAND_DATA_PACKET, 0, packet, size); 58692b838201SMatthias Ringwald hci_stack->hci_transport->send_packet(HCI_COMMAND_DATA_PACKET, packet, size); 58702b838201SMatthias Ringwald 58712b838201SMatthias Ringwald // release packet buffer for synchronous transport implementations 58722b838201SMatthias Ringwald if (hci_transport_synchronous()){ 5873e2d22487SMatthias Ringwald hci_release_packet_buffer(); 5874068b8592SMatthias Ringwald hci_emit_transport_packet_sent(); 58752b838201SMatthias Ringwald } 58762b838201SMatthias Ringwald } 58772b838201SMatthias Ringwald #endif 58782b838201SMatthias Ringwald 587926fe9592SMatthias Ringwald static void hci_halting_timeout_handler(btstack_timer_source_t * ds){ 588026fe9592SMatthias Ringwald UNUSED(ds); 588126fe9592SMatthias Ringwald hci_stack->substate = HCI_HALTING_CLOSE; 5882f021201aSMatthias Ringwald hci_halting_run(); 588326fe9592SMatthias Ringwald } 588426fe9592SMatthias Ringwald 5885f30077b7SMatthias Ringwald static bool hci_run_acl_fragments(void){ 58864ea43905SMatthias Ringwald if (hci_stack->acl_fragmentation_total_size > 0u) { 5887b5d8b22bS[email protected] hci_con_handle_t con_handle = READ_ACL_CONNECTION_HANDLE(hci_stack->hci_packet_buffer); 5888b5d8b22bS[email protected] hci_connection_t *connection = hci_connection_for_handle(con_handle); 5889b5d8b22bS[email protected] if (connection) { 589028a0332dSMatthias Ringwald if (hci_can_send_prepared_acl_packet_now(con_handle)){ 5891b5d8b22bS[email protected] hci_send_acl_packet_fragments(connection); 5892f30077b7SMatthias Ringwald return true; 5893b5d8b22bS[email protected] } 589428a0332dSMatthias Ringwald } else { 5895b5d8b22bS[email protected] // connection gone -> discard further fragments 589628a0332dSMatthias Ringwald log_info("hci_run: fragmented ACL packet no connection -> discard fragment"); 5897b5d8b22bS[email protected] hci_stack->acl_fragmentation_total_size = 0; 5898b5d8b22bS[email protected] hci_stack->acl_fragmentation_pos = 0; 5899b5d8b22bS[email protected] } 5900b5d8b22bS[email protected] } 5901f30077b7SMatthias Ringwald return false; 59022b838201SMatthias Ringwald } 5903b031bebbSmatthias.ringwald 590468ab6207SMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS 590568ab6207SMatthias Ringwald static bool hci_run_iso_fragments(void){ 590668ab6207SMatthias Ringwald if (hci_stack->iso_fragmentation_total_size > 0u) { 590768ab6207SMatthias Ringwald // TODO: flow control 590868ab6207SMatthias Ringwald if (hci_transport_can_send_prepared_packet_now(HCI_ISO_DATA_PACKET)){ 590968ab6207SMatthias Ringwald hci_send_iso_packet_fragments(); 591068ab6207SMatthias Ringwald return true; 591168ab6207SMatthias Ringwald } 591268ab6207SMatthias Ringwald } 591368ab6207SMatthias Ringwald return false; 591468ab6207SMatthias Ringwald } 591568ab6207SMatthias Ringwald #endif 591668ab6207SMatthias Ringwald 591735454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 59186c0d5426SMatthias Ringwald 59196c0d5426SMatthias Ringwald #ifdef ENABLE_HCI_SERIALIZED_CONTROLLER_OPERATIONS 59206c0d5426SMatthias Ringwald static bool hci_classic_operation_active(void) { 59216c0d5426SMatthias Ringwald if (hci_stack->inquiry_state >= GAP_INQUIRY_STATE_W4_ACTIVE){ 59226c0d5426SMatthias Ringwald return true; 59236c0d5426SMatthias Ringwald } 59246c0d5426SMatthias Ringwald if (hci_stack->remote_name_state == GAP_REMOTE_NAME_STATE_W4_COMPLETE){ 59256c0d5426SMatthias Ringwald return true; 59266c0d5426SMatthias Ringwald } 59276c0d5426SMatthias Ringwald btstack_linked_item_t * it; 59286c0d5426SMatthias Ringwald for (it = (btstack_linked_item_t *) hci_stack->connections; it != NULL; it = it->next) { 59296c0d5426SMatthias Ringwald hci_connection_t *connection = (hci_connection_t *) it; 59306c0d5426SMatthias Ringwald switch (connection->state) { 59316c0d5426SMatthias Ringwald case SENT_CREATE_CONNECTION: 59326c0d5426SMatthias Ringwald case SENT_CANCEL_CONNECTION: 59336c0d5426SMatthias Ringwald case SENT_DISCONNECT: 59346c0d5426SMatthias Ringwald return true; 59356c0d5426SMatthias Ringwald default: 59366c0d5426SMatthias Ringwald break; 59376c0d5426SMatthias Ringwald } 59386c0d5426SMatthias Ringwald } 59396c0d5426SMatthias Ringwald return false; 59406c0d5426SMatthias Ringwald } 59416c0d5426SMatthias Ringwald #endif 59426c0d5426SMatthias Ringwald 5943f30077b7SMatthias Ringwald static bool hci_run_general_gap_classic(void){ 5944f30077b7SMatthias Ringwald 594559d59ecfSMatthias Ringwald // assert stack is working and classic is active 594659d59ecfSMatthias Ringwald if (hci_classic_supported() == false) return false; 594759d59ecfSMatthias Ringwald if (hci_stack->state != HCI_STATE_WORKING) return false; 594859d59ecfSMatthias Ringwald 5949b031bebbSmatthias.ringwald // decline incoming connections 59503a9fb326S[email protected] if (hci_stack->decline_reason){ 59513a9fb326S[email protected] uint8_t reason = hci_stack->decline_reason; 59523a9fb326S[email protected] hci_stack->decline_reason = 0; 59533a9fb326S[email protected] hci_send_cmd(&hci_reject_connection_request, hci_stack->decline_addr, reason); 5954f30077b7SMatthias Ringwald return true; 5955ce4c8fabSmatthias.ringwald } 595659d59ecfSMatthias Ringwald 5957baa4881eSMatthias Ringwald if (hci_stack->gap_tasks_classic != 0){ 5958ab4831a3SMatthias Ringwald hci_run_gap_tasks_classic(); 5959f30077b7SMatthias Ringwald return true; 5960b031bebbSmatthias.ringwald } 596127741fe7SMatthias Ringwald 5962f5875de5SMatthias Ringwald // start/stop inquiry 5963a1df452eSMatthias Ringwald if ((hci_stack->inquiry_state >= GAP_INQUIRY_DURATION_MIN) && (hci_stack->inquiry_state <= GAP_INQUIRY_DURATION_MAX)){ 59646c0d5426SMatthias Ringwald #ifdef ENABLE_HCI_SERIALIZED_CONTROLLER_OPERATIONS 59656c0d5426SMatthias Ringwald if (hci_classic_operation_active() == false) 59666c0d5426SMatthias Ringwald #endif 59676c0d5426SMatthias Ringwald { 5968f5875de5SMatthias Ringwald uint8_t duration = hci_stack->inquiry_state; 5969beb3c81dSMatthias Ringwald hci_stack->inquiry_state = GAP_INQUIRY_STATE_W4_ACTIVE; 597030199e24SMatthias Ringwald if (hci_stack->inquiry_max_period_length != 0){ 597130199e24SMatthias 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); 597230199e24SMatthias Ringwald } else { 5973496bb884SMatthias Ringwald hci_send_cmd(&hci_inquiry, hci_stack->inquiry_lap, duration, 0); 597430199e24SMatthias Ringwald } 5975f30077b7SMatthias Ringwald return true; 5976f5875de5SMatthias Ringwald } 59776c0d5426SMatthias Ringwald } 5978f5875de5SMatthias Ringwald if (hci_stack->inquiry_state == GAP_INQUIRY_STATE_W2_CANCEL){ 5979f5875de5SMatthias Ringwald hci_stack->inquiry_state = GAP_INQUIRY_STATE_W4_CANCELLED; 5980f5875de5SMatthias Ringwald hci_send_cmd(&hci_inquiry_cancel); 5981f30077b7SMatthias Ringwald return true; 5982f5875de5SMatthias Ringwald } 598330199e24SMatthias Ringwald 598430199e24SMatthias Ringwald if (hci_stack->inquiry_state == GAP_INQUIRY_STATE_W2_EXIT_PERIODIC){ 5985bc06f564SMatthias Ringwald hci_stack->inquiry_state = GAP_INQUIRY_STATE_W4_CANCELLED; 598630199e24SMatthias Ringwald hci_send_cmd(&hci_exit_periodic_inquiry_mode); 598730199e24SMatthias Ringwald return true; 598830199e24SMatthias Ringwald } 598930199e24SMatthias Ringwald 5990b7f1ee76SMatthias Ringwald // remote name request 5991b7f1ee76SMatthias Ringwald if (hci_stack->remote_name_state == GAP_REMOTE_NAME_STATE_W2_SEND){ 59926c0d5426SMatthias Ringwald #ifdef ENABLE_HCI_SERIALIZED_CONTROLLER_OPERATIONS 59936c0d5426SMatthias Ringwald if (hci_classic_operation_active() == false) 59946c0d5426SMatthias Ringwald #endif 59956c0d5426SMatthias Ringwald { 5996b7f1ee76SMatthias Ringwald hci_stack->remote_name_state = GAP_REMOTE_NAME_STATE_W4_COMPLETE; 5997b7f1ee76SMatthias Ringwald hci_send_cmd(&hci_remote_name_request, hci_stack->remote_name_addr, 5998ee8a36c8SMatthias Ringwald hci_stack->remote_name_page_scan_repetition_mode, 0, hci_stack->remote_name_clock_offset); 5999f30077b7SMatthias Ringwald return true; 6000b7f1ee76SMatthias Ringwald } 60016c0d5426SMatthias Ringwald } 6002cf01e888SMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB 6003cf01e888SMatthias Ringwald // Local OOB data 600459d59ecfSMatthias Ringwald if (hci_stack->classic_read_local_oob_data){ 6005cf01e888SMatthias Ringwald hci_stack->classic_read_local_oob_data = false; 60061e83575aSMatthias Ringwald if (hci_command_supported(SUPPORTED_HCI_COMMAND_READ_LOCAL_OOB_EXTENDED_DATA_COMMAND)){ 6007cf01e888SMatthias Ringwald hci_send_cmd(&hci_read_local_extended_oob_data); 6008cf01e888SMatthias Ringwald } else { 6009cf01e888SMatthias Ringwald hci_send_cmd(&hci_read_local_oob_data); 6010cf01e888SMatthias Ringwald } 6011cf01e888SMatthias Ringwald } 6012cf01e888SMatthias Ringwald #endif 60130a51f88bSMatthias Ringwald // pairing 60140a51f88bSMatthias Ringwald if (hci_stack->gap_pairing_state != GAP_PAIRING_STATE_IDLE){ 60150a51f88bSMatthias Ringwald uint8_t state = hci_stack->gap_pairing_state; 6016c26f2c7bSMatthias Ringwald uint8_t pin_code[PIN_CODE_LEN]; 60170a51f88bSMatthias Ringwald switch (state){ 60180a51f88bSMatthias Ringwald case GAP_PAIRING_STATE_SEND_PIN: 6019cc15bb2cSMatthias Ringwald hci_stack->gap_pairing_state = GAP_PAIRING_STATE_IDLE; 60203f659ee4SMilanka Ringwald memset(pin_code, 0, 16); 60213f659ee4SMilanka Ringwald memcpy(pin_code, hci_stack->gap_pairing_input.gap_pairing_pin, hci_stack->gap_pairing_pin_len); 60223f659ee4SMilanka Ringwald hci_send_cmd(&hci_pin_code_request_reply, hci_stack->gap_pairing_addr, hci_stack->gap_pairing_pin_len, pin_code); 60230a51f88bSMatthias Ringwald break; 60240a51f88bSMatthias Ringwald case GAP_PAIRING_STATE_SEND_PIN_NEGATIVE: 6025cc15bb2cSMatthias Ringwald hci_stack->gap_pairing_state = GAP_PAIRING_STATE_WAIT_FOR_COMMAND_COMPLETE; 60260a51f88bSMatthias Ringwald hci_send_cmd(&hci_pin_code_request_negative_reply, hci_stack->gap_pairing_addr); 60270a51f88bSMatthias Ringwald break; 60280a51f88bSMatthias Ringwald case GAP_PAIRING_STATE_SEND_PASSKEY: 6029cc15bb2cSMatthias Ringwald hci_stack->gap_pairing_state = GAP_PAIRING_STATE_IDLE; 6030d504181aSMatthias Ringwald hci_send_cmd(&hci_user_passkey_request_reply, hci_stack->gap_pairing_addr, hci_stack->gap_pairing_input.gap_pairing_passkey); 60310a51f88bSMatthias Ringwald break; 60320a51f88bSMatthias Ringwald case GAP_PAIRING_STATE_SEND_PASSKEY_NEGATIVE: 6033cc15bb2cSMatthias Ringwald hci_stack->gap_pairing_state = GAP_PAIRING_STATE_WAIT_FOR_COMMAND_COMPLETE; 60340a51f88bSMatthias Ringwald hci_send_cmd(&hci_user_passkey_request_negative_reply, hci_stack->gap_pairing_addr); 60350a51f88bSMatthias Ringwald break; 60360a51f88bSMatthias Ringwald case GAP_PAIRING_STATE_SEND_CONFIRMATION: 6037cc15bb2cSMatthias Ringwald hci_stack->gap_pairing_state = GAP_PAIRING_STATE_IDLE; 60380a51f88bSMatthias Ringwald hci_send_cmd(&hci_user_confirmation_request_reply, hci_stack->gap_pairing_addr); 60390a51f88bSMatthias Ringwald break; 60400a51f88bSMatthias Ringwald case GAP_PAIRING_STATE_SEND_CONFIRMATION_NEGATIVE: 6041cc15bb2cSMatthias Ringwald hci_stack->gap_pairing_state = GAP_PAIRING_STATE_WAIT_FOR_COMMAND_COMPLETE; 60420a51f88bSMatthias Ringwald hci_send_cmd(&hci_user_confirmation_request_negative_reply, hci_stack->gap_pairing_addr); 60430a51f88bSMatthias Ringwald break; 60440a51f88bSMatthias Ringwald default: 60450a51f88bSMatthias Ringwald break; 60460a51f88bSMatthias Ringwald } 6047f30077b7SMatthias Ringwald return true; 6048f30077b7SMatthias Ringwald } 6049f30077b7SMatthias Ringwald return false; 60500a51f88bSMatthias Ringwald } 605135454696SMatthias Ringwald #endif 6052b031bebbSmatthias.ringwald 6053a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE 6054be7ef9d8SMatthias Ringwald 60557eb5b27eSMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 60567eb5b27eSMatthias Ringwald static uint8_t hci_le_num_phys(uint8_t phys){ 60577eb5b27eSMatthias Ringwald const uint8_t num_bits_set[] = { 0, 1, 1, 2, 1, 2, 2, 3 }; 60587eb5b27eSMatthias Ringwald btstack_assert(phys); 60597eb5b27eSMatthias Ringwald return num_bits_set[phys]; 60607eb5b27eSMatthias Ringwald } 60617eb5b27eSMatthias Ringwald #endif 60627eb5b27eSMatthias Ringwald 6063c42da3bcSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 6064c42da3bcSMatthias Ringwald static void hci_le_scan_stop(void){ 6065c42da3bcSMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 606622f987e4SMatthias Ringwald if (hci_le_extended_advertising_supported()) { 6067c42da3bcSMatthias Ringwald hci_send_cmd(&hci_le_set_extended_scan_enable, 0, 0, 0, 0); 6068c42da3bcSMatthias Ringwald } else 6069c42da3bcSMatthias Ringwald #endif 6070c42da3bcSMatthias Ringwald { 6071c42da3bcSMatthias Ringwald hci_send_cmd(&hci_le_set_scan_enable, 0, 0); 6072c42da3bcSMatthias Ringwald } 6073c42da3bcSMatthias Ringwald } 6074327f7f07SMatthias Ringwald 6075f346015eSMatthias Ringwald static void 6076f346015eSMatthias Ringwald hci_send_le_create_connection(uint8_t initiator_filter_policy, bd_addr_type_t address_type, uint8_t *address) { 6077327f7f07SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 607822f987e4SMatthias Ringwald if (hci_le_extended_advertising_supported()) { 60797eb5b27eSMatthias Ringwald // prepare arrays for all phys (LE Coded, LE 1M, LE 2M PHY) 60807eb5b27eSMatthias Ringwald uint16_t le_connection_scan_interval[3]; 60817eb5b27eSMatthias Ringwald uint16_t le_connection_scan_window[3]; 60827eb5b27eSMatthias Ringwald uint16_t le_connection_interval_min[3]; 60837eb5b27eSMatthias Ringwald uint16_t le_connection_interval_max[3]; 60847eb5b27eSMatthias Ringwald uint16_t le_connection_latency[3]; 60857eb5b27eSMatthias Ringwald uint16_t le_supervision_timeout[3]; 60867eb5b27eSMatthias Ringwald uint16_t le_minimum_ce_length[3]; 60877eb5b27eSMatthias Ringwald uint16_t le_maximum_ce_length[3]; 60887eb5b27eSMatthias Ringwald 60897eb5b27eSMatthias Ringwald uint8_t i; 60907eb5b27eSMatthias Ringwald uint8_t num_phys = hci_le_num_phys(hci_stack->le_connection_phys); 60917eb5b27eSMatthias Ringwald for (i=0;i<num_phys;i++){ 60927eb5b27eSMatthias Ringwald le_connection_scan_interval[i] = hci_stack->le_connection_scan_interval; 60937eb5b27eSMatthias Ringwald le_connection_scan_window[i] = hci_stack->le_connection_scan_window; 60947eb5b27eSMatthias Ringwald le_connection_interval_min[i] = hci_stack->le_connection_interval_min; 60957eb5b27eSMatthias Ringwald le_connection_interval_max[i] = hci_stack->le_connection_interval_max; 60967eb5b27eSMatthias Ringwald le_connection_latency[i] = hci_stack->le_connection_latency; 60977eb5b27eSMatthias Ringwald le_supervision_timeout[i] = hci_stack->le_supervision_timeout; 60987eb5b27eSMatthias Ringwald le_minimum_ce_length[i] = hci_stack->le_minimum_ce_length; 60997eb5b27eSMatthias Ringwald le_maximum_ce_length[i] = hci_stack->le_maximum_ce_length; 61007eb5b27eSMatthias Ringwald } 6101327f7f07SMatthias Ringwald hci_send_cmd(&hci_le_extended_create_connection, 6102f346015eSMatthias Ringwald initiator_filter_policy, 6103327f7f07SMatthias Ringwald hci_stack->le_connection_own_addr_type, // our addr type: 6104f346015eSMatthias Ringwald address_type, // peer address type 6105f346015eSMatthias Ringwald address, // peer bd addr 61067eb5b27eSMatthias Ringwald hci_stack->le_connection_phys, // initiating PHY 6107327f7f07SMatthias Ringwald le_connection_scan_interval, // conn scan interval 6108327f7f07SMatthias Ringwald le_connection_scan_window, // conn scan windows 6109327f7f07SMatthias Ringwald le_connection_interval_min, // conn interval min 6110327f7f07SMatthias Ringwald le_connection_interval_max, // conn interval max 6111327f7f07SMatthias Ringwald le_connection_latency, // conn latency 6112327f7f07SMatthias Ringwald le_supervision_timeout, // conn latency 6113327f7f07SMatthias Ringwald le_minimum_ce_length, // min ce length 6114327f7f07SMatthias Ringwald le_maximum_ce_length // max ce length 6115327f7f07SMatthias Ringwald ); 6116d935373dSMatthias Ringwald } else 6117327f7f07SMatthias Ringwald #endif 6118327f7f07SMatthias Ringwald { 6119327f7f07SMatthias Ringwald hci_send_cmd(&hci_le_create_connection, 6120327f7f07SMatthias Ringwald hci_stack->le_connection_scan_interval, // conn scan interval 6121327f7f07SMatthias Ringwald hci_stack->le_connection_scan_window, // conn scan windows 6122f346015eSMatthias Ringwald initiator_filter_policy, // don't use whitelist 6123f346015eSMatthias Ringwald address_type, // peer address type 6124f346015eSMatthias Ringwald address, // peer bd addr 6125327f7f07SMatthias Ringwald hci_stack->le_connection_own_addr_type, // our addr type: 6126327f7f07SMatthias Ringwald hci_stack->le_connection_interval_min, // conn interval min 6127327f7f07SMatthias Ringwald hci_stack->le_connection_interval_max, // conn interval max 6128327f7f07SMatthias Ringwald hci_stack->le_connection_latency, // conn latency 6129327f7f07SMatthias Ringwald hci_stack->le_supervision_timeout, // conn latency 6130327f7f07SMatthias Ringwald hci_stack->le_minimum_ce_length, // min ce length 6131327f7f07SMatthias Ringwald hci_stack->le_maximum_ce_length // max ce length 6132327f7f07SMatthias Ringwald ); 6133327f7f07SMatthias Ringwald } 6134327f7f07SMatthias Ringwald } 6135c42da3bcSMatthias Ringwald #endif 6136c42da3bcSMatthias Ringwald 6137be7ef9d8SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 6138be7ef9d8SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 6139033393eeSBob Abeles static uint8_t hci_le_extended_advertising_operation_for_chunk(uint16_t pos, uint16_t len){ 6140be7ef9d8SMatthias Ringwald uint8_t operation = 0; 6141be7ef9d8SMatthias Ringwald if (pos == 0){ 6142be7ef9d8SMatthias Ringwald // first fragment or complete data 6143be7ef9d8SMatthias Ringwald operation |= 1; 6144be7ef9d8SMatthias Ringwald } 6145be7ef9d8SMatthias Ringwald if (pos + LE_EXTENDED_ADVERTISING_MAX_CHUNK_LEN >= len){ 6146be7ef9d8SMatthias Ringwald // last fragment or complete data 6147be7ef9d8SMatthias Ringwald operation |= 2; 6148be7ef9d8SMatthias Ringwald } 6149be7ef9d8SMatthias Ringwald return operation; 6150be7ef9d8SMatthias Ringwald } 6151be7ef9d8SMatthias Ringwald #endif 6152be7ef9d8SMatthias Ringwald #endif 6153be7ef9d8SMatthias Ringwald 61542c052b15SMatthias Ringwald static bool hci_whitelist_modification_pending(void) { 615581ae6c3bSMatthias Ringwald btstack_linked_list_iterator_t it; 615681ae6c3bSMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->le_whitelist); 615781ae6c3bSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 615881ae6c3bSMatthias Ringwald whitelist_entry_t * entry = (whitelist_entry_t*) btstack_linked_list_iterator_next(&it); 615981ae6c3bSMatthias Ringwald if (entry->state & (LE_WHITELIST_REMOVE_FROM_CONTROLLER | LE_WHITELIST_ADD_TO_CONTROLLER)){ 616081ae6c3bSMatthias Ringwald return true; 616181ae6c3bSMatthias Ringwald } 616281ae6c3bSMatthias Ringwald } 616381ae6c3bSMatthias Ringwald return false; 616481ae6c3bSMatthias Ringwald } 616581ae6c3bSMatthias Ringwald 61662c052b15SMatthias Ringwald static bool hci_whitelist_modification_process(void){ 61672c052b15SMatthias Ringwald // add/remove entries 61682c052b15SMatthias Ringwald btstack_linked_list_iterator_t it; 61692c052b15SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->le_whitelist); 61702c052b15SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 61712c052b15SMatthias Ringwald whitelist_entry_t * entry = (whitelist_entry_t*) btstack_linked_list_iterator_next(&it); 61722c052b15SMatthias Ringwald if (entry->state & LE_WHITELIST_REMOVE_FROM_CONTROLLER){ 61732c052b15SMatthias Ringwald entry->state &= ~LE_WHITELIST_REMOVE_FROM_CONTROLLER; 61742c052b15SMatthias Ringwald entry->state &= ~LE_WHITELIST_ON_CONTROLLER; 61752c052b15SMatthias Ringwald bd_addr_type_t address_type = entry->address_type; 61762c052b15SMatthias Ringwald bd_addr_t address; 61772c052b15SMatthias Ringwald memcpy(address, entry->address, 6); 61782c052b15SMatthias Ringwald if ((entry->state & LE_WHITELIST_ADD_TO_CONTROLLER) == 0){ 61792c052b15SMatthias Ringwald // remove from whitelist if not scheduled for re-addition 61802c052b15SMatthias Ringwald btstack_linked_list_remove(&hci_stack->le_whitelist, (btstack_linked_item_t *) entry); 61812c052b15SMatthias Ringwald btstack_memory_whitelist_entry_free(entry); 61822c052b15SMatthias Ringwald } 61832c052b15SMatthias Ringwald hci_send_cmd(&hci_le_remove_device_from_white_list, address_type, address); 61842c052b15SMatthias Ringwald return true; 61852c052b15SMatthias Ringwald } 61862c052b15SMatthias Ringwald if (entry->state & LE_WHITELIST_ADD_TO_CONTROLLER){ 61872c052b15SMatthias Ringwald entry->state &= ~LE_WHITELIST_ADD_TO_CONTROLLER; 61882c052b15SMatthias Ringwald entry->state |= LE_WHITELIST_ON_CONTROLLER; 61892c052b15SMatthias Ringwald hci_send_cmd(&hci_le_add_device_to_white_list, entry->address_type, entry->address); 61902c052b15SMatthias Ringwald return true; 61912c052b15SMatthias Ringwald } 61922c052b15SMatthias Ringwald } 61932c052b15SMatthias Ringwald return false; 61942c052b15SMatthias Ringwald } 61952c052b15SMatthias Ringwald 6196f30077b7SMatthias Ringwald static bool hci_run_general_gap_le(void){ 6197f30077b7SMatthias Ringwald 6198f40c73b4SMatthias Ringwald btstack_linked_list_iterator_t lit; 6199f9aa0bbcSMatthias Ringwald UNUSED(lit); 6200f40c73b4SMatthias Ringwald 62012052d96cSMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 62022052d96cSMatthias Ringwald if (hci_stack->le_resolvable_private_address_update_s > 0){ 62032052d96cSMatthias Ringwald uint16_t update_s = hci_stack->le_resolvable_private_address_update_s; 62042052d96cSMatthias Ringwald hci_stack->le_resolvable_private_address_update_s = 0; 62052052d96cSMatthias Ringwald hci_send_cmd(&hci_le_set_resolvable_private_address_timeout, update_s); 62062052d96cSMatthias Ringwald return true; 62072052d96cSMatthias Ringwald } 62082052d96cSMatthias Ringwald #endif 62092052d96cSMatthias Ringwald 6210a41310b7SMatthias Ringwald // Phase 1: collect what to stop 6211a41310b7SMatthias Ringwald 621249a6c69cSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 6213a41310b7SMatthias Ringwald bool scanning_stop = false; 6214a41310b7SMatthias Ringwald bool connecting_stop = false; 6215be7ef9d8SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 6216c814a904SMatthias Ringwald #ifdef ENABLE_LE_PERIODIC_ADVERTISING 62174bafedd5SMatthias Ringwald bool periodic_sync_stop = false; 62184bafedd5SMatthias Ringwald #endif 6219be7ef9d8SMatthias Ringwald #endif 6220c814a904SMatthias Ringwald #endif 6221be7ef9d8SMatthias Ringwald 622249a6c69cSMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 622349a6c69cSMatthias Ringwald bool advertising_stop = false; 622449a6c69cSMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 622549a6c69cSMatthias Ringwald le_advertising_set_t * advertising_stop_set = NULL; 622649a6c69cSMatthias Ringwald #ifdef ENABLE_LE_PERIODIC_ADVERTISING 622749a6c69cSMatthias Ringwald bool periodic_advertising_stop = false; 6228a41310b7SMatthias Ringwald #endif 622949a6c69cSMatthias Ringwald #endif 6230a41310b7SMatthias Ringwald #endif 6231a41310b7SMatthias Ringwald 62329136bde8SMatthias Ringwald // check if own address changes 62339ce6dfa1SMatthias Ringwald uint8_t address_change_mask = LE_ADVERTISEMENT_TASKS_SET_ADDRESS | LE_ADVERTISEMENT_TASKS_SET_ADDRESS_SET_0; 62349ce6dfa1SMatthias Ringwald bool random_address_change = (hci_stack->le_advertisements_todo & address_change_mask) != 0; 62359136bde8SMatthias Ringwald 623629c24bebSMatthias Ringwald // check if whitelist needs modification 623781ae6c3bSMatthias Ringwald bool whitelist_modification_pending = hci_whitelist_modification_pending(); 6238f40c73b4SMatthias Ringwald 623921debf25SMatthias Ringwald // check if resolving list needs modification 624021debf25SMatthias Ringwald bool resolving_list_modification_pending = false; 624121debf25SMatthias Ringwald #ifdef ENABLE_LE_PRIVACY_ADDRESS_RESOLUTION 62421ffa425cSMatthias Ringwald bool resolving_list_supported = hci_command_supported(SUPPORTED_HCI_COMMAND_LE_SET_ADDRESS_RESOLUTION_ENABLE); 6243ea151974SMatthias Ringwald if (resolving_list_supported && hci_stack->le_resolving_list_state != LE_RESOLVING_LIST_DONE){ 624421debf25SMatthias Ringwald resolving_list_modification_pending = true; 624521debf25SMatthias Ringwald } 624621debf25SMatthias Ringwald #endif 624729c24bebSMatthias Ringwald 6248f40c73b4SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 624949a6c69cSMatthias Ringwald 6250f40c73b4SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 625149a6c69cSMatthias Ringwald // check if periodic advertiser list needs modification 6252f40c73b4SMatthias Ringwald bool periodic_list_modification_pending = false; 6253f40c73b4SMatthias Ringwald btstack_linked_list_iterator_init(&lit, &hci_stack->le_periodic_advertiser_list); 6254f40c73b4SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&lit)){ 6255f40c73b4SMatthias Ringwald periodic_advertiser_list_entry_t * entry = (periodic_advertiser_list_entry_t*) btstack_linked_list_iterator_next(&lit); 6256f40c73b4SMatthias Ringwald if (entry->state & (LE_PERIODIC_ADVERTISER_LIST_ENTRY_ADD_TO_CONTROLLER | LE_PERIODIC_ADVERTISER_LIST_ENTRY_REMOVE_FROM_CONTROLLER)){ 6257f40c73b4SMatthias Ringwald periodic_list_modification_pending = true; 6258f40c73b4SMatthias Ringwald break; 6259f40c73b4SMatthias Ringwald } 6260f40c73b4SMatthias Ringwald } 6261f40c73b4SMatthias Ringwald #endif 6262f40c73b4SMatthias Ringwald 6263fde725feSMatthias Ringwald // scanning control 62643251a108SMatthias Ringwald if (hci_stack->le_scanning_active) { 626529c24bebSMatthias Ringwald // stop if: 626629c24bebSMatthias Ringwald // - parameter change required 626729c24bebSMatthias Ringwald // - it's disabled 626829c24bebSMatthias Ringwald // - whitelist change required but used for scanning 626921debf25SMatthias Ringwald // - resolving list modified 627051e51a58SMatthias Ringwald // - own address changes 627129c24bebSMatthias Ringwald bool scanning_uses_whitelist = (hci_stack->le_scan_filter_policy & 1) == 1; 627221debf25SMatthias Ringwald if ((hci_stack->le_scanning_param_update) || 627321debf25SMatthias Ringwald !hci_stack->le_scanning_enabled || 6274d54b2c94SMatthias Ringwald (scanning_uses_whitelist && whitelist_modification_pending) || 627551e51a58SMatthias Ringwald resolving_list_modification_pending || 627651e51a58SMatthias Ringwald random_address_change){ 627721debf25SMatthias Ringwald 62782d5c2a27SMatthias Ringwald scanning_stop = true; 6279fde725feSMatthias Ringwald } 6280fde725feSMatthias Ringwald } 6281fde725feSMatthias Ringwald 628229c24bebSMatthias Ringwald // connecting control 6283f496d06eSMatthias Ringwald bool connecting_with_whitelist; 6284f496d06eSMatthias Ringwald switch (hci_stack->le_connecting_state){ 6285f496d06eSMatthias Ringwald case LE_CONNECTING_DIRECT: 6286f496d06eSMatthias Ringwald case LE_CONNECTING_WHITELIST: 6287af64f147SMatthias Ringwald // stop connecting if: 6288af64f147SMatthias Ringwald // - connecting uses white and whitelist modification pending 6289af64f147SMatthias Ringwald // - if it got disabled 629021debf25SMatthias Ringwald // - resolving list modified 629151e51a58SMatthias Ringwald // - own address changes 6292f496d06eSMatthias Ringwald connecting_with_whitelist = hci_stack->le_connecting_state == LE_CONNECTING_WHITELIST; 6293f496d06eSMatthias Ringwald if ((connecting_with_whitelist && whitelist_modification_pending) || 629421debf25SMatthias Ringwald (hci_stack->le_connecting_request == LE_CONNECTING_IDLE) || 629551e51a58SMatthias Ringwald resolving_list_modification_pending || 629651e51a58SMatthias Ringwald random_address_change) { 629721debf25SMatthias Ringwald 629829c24bebSMatthias Ringwald connecting_stop = true; 629929c24bebSMatthias Ringwald } 6300f496d06eSMatthias Ringwald break; 6301f496d06eSMatthias Ringwald default: 6302f496d06eSMatthias Ringwald break; 630329c24bebSMatthias Ringwald } 630449a6c69cSMatthias Ringwald 63054bafedd5SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 630649a6c69cSMatthias Ringwald #ifdef ENABLE_LE_PERIODIC_ADVERTISING 63074bafedd5SMatthias Ringwald // periodic sync control 63084bafedd5SMatthias Ringwald bool sync_with_advertiser_list; 63094bafedd5SMatthias Ringwald switch(hci_stack->le_periodic_sync_state){ 63104bafedd5SMatthias Ringwald case LE_CONNECTING_DIRECT: 63114bafedd5SMatthias Ringwald case LE_CONNECTING_WHITELIST: 631249a6c69cSMatthias Ringwald // stop sync if: 63134bafedd5SMatthias Ringwald // - sync with advertiser list and advertiser list modification pending 631449a6c69cSMatthias Ringwald // - if it got disabled 63154bafedd5SMatthias Ringwald sync_with_advertiser_list = hci_stack->le_periodic_sync_state == LE_CONNECTING_WHITELIST; 63164bafedd5SMatthias Ringwald if ((sync_with_advertiser_list && periodic_list_modification_pending) || 63174bafedd5SMatthias Ringwald (hci_stack->le_periodic_sync_request == LE_CONNECTING_IDLE)){ 63184bafedd5SMatthias Ringwald periodic_sync_stop = true; 63194bafedd5SMatthias Ringwald } 63204bafedd5SMatthias Ringwald break; 63214bafedd5SMatthias Ringwald default: 63224bafedd5SMatthias Ringwald break; 63234bafedd5SMatthias Ringwald } 63244bafedd5SMatthias Ringwald #endif 6325d70217a2SMatthias Ringwald #endif 632629c24bebSMatthias Ringwald 632749a6c69cSMatthias Ringwald #endif /* ENABLE_LE_CENTRAL */ 632849a6c69cSMatthias Ringwald 6329d70217a2SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 633045c102fdSMatthias Ringwald // le advertisement control 6331935aa76eSMatthias Ringwald if ((hci_stack->le_advertisements_state & LE_ADVERTISEMENT_STATE_ACTIVE) != 0){ 633229c24bebSMatthias Ringwald // stop if: 633329c24bebSMatthias Ringwald // - parameter change required 63349136bde8SMatthias Ringwald // - random address used in advertising and changes 633529c24bebSMatthias Ringwald // - it's disabled 6336ba44ad41SMatthias Ringwald // - whitelist change required but used for advertisement filter policy 633721debf25SMatthias Ringwald // - resolving list modified 633851e51a58SMatthias Ringwald // - own address changes 6339a61834b6SMatthias Ringwald bool advertising_uses_whitelist = hci_stack->le_advertisements_filter_policy != 0; 63409136bde8SMatthias Ringwald bool advertising_uses_random_address = hci_stack->le_own_addr_type != BD_ADDR_TYPE_LE_PUBLIC; 63414e5d21eaSMatthias Ringwald bool advertising_change = (hci_stack->le_advertisements_todo & LE_ADVERTISEMENT_TASKS_SET_PARAMS) != 0; 6342a61834b6SMatthias Ringwald if (advertising_change || 63439136bde8SMatthias Ringwald (advertising_uses_random_address && random_address_change) || 6344a61834b6SMatthias Ringwald (hci_stack->le_advertisements_enabled_for_current_roles == 0) || 63459136bde8SMatthias Ringwald (advertising_uses_whitelist && whitelist_modification_pending) || 634651e51a58SMatthias Ringwald resolving_list_modification_pending || 634751e51a58SMatthias Ringwald random_address_change) { 634821debf25SMatthias Ringwald 6349fde725feSMatthias Ringwald advertising_stop = true; 6350fde725feSMatthias Ringwald } 6351fde725feSMatthias Ringwald } 6352be7ef9d8SMatthias Ringwald 6353be7ef9d8SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 635422f987e4SMatthias Ringwald if (hci_le_extended_advertising_supported() && (advertising_stop == false)){ 6355be7ef9d8SMatthias Ringwald btstack_linked_list_iterator_t it; 6356be7ef9d8SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->le_advertising_sets); 6357be7ef9d8SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 6358be7ef9d8SMatthias Ringwald le_advertising_set_t * advertising_set = (le_advertising_set_t*) btstack_linked_list_iterator_next(&it); 635953f240c0SMatthias Ringwald if ((advertising_set->state & LE_ADVERTISEMENT_STATE_ACTIVE) != 0) { 6360be7ef9d8SMatthias Ringwald // stop if: 6361be7ef9d8SMatthias Ringwald // - parameter change required 6362be7ef9d8SMatthias Ringwald // - random address used in connectable advertising and changes 6363be7ef9d8SMatthias Ringwald // - it's disabled 6364be7ef9d8SMatthias Ringwald // - whitelist change required but used for advertisement filter policy 6365be7ef9d8SMatthias Ringwald // - resolving list modified 6366be7ef9d8SMatthias Ringwald // - own address changes 6367be7ef9d8SMatthias Ringwald // - advertisement set will be removed 636857a04237SMatthias Ringwald bool advertising_uses_whitelist = advertising_set->extended_params.advertising_filter_policy != 0; 636957a04237SMatthias Ringwald bool advertising_connectable = (advertising_set->extended_params.advertising_event_properties & 1) != 0; 637053f240c0SMatthias Ringwald bool advertising_uses_random_address = 637153f240c0SMatthias Ringwald (advertising_set->extended_params.own_address_type != BD_ADDR_TYPE_LE_PUBLIC) && 637253f240c0SMatthias Ringwald advertising_connectable; 6373be7ef9d8SMatthias Ringwald bool advertising_parameter_change = (advertising_set->tasks & LE_ADVERTISEMENT_TASKS_SET_PARAMS) != 0; 6374be7ef9d8SMatthias Ringwald bool advertising_enabled = (advertising_set->state & LE_ADVERTISEMENT_STATE_ENABLED) != 0; 637553f240c0SMatthias Ringwald bool advertising_set_random_address_change = 637653f240c0SMatthias Ringwald (advertising_set->tasks & LE_ADVERTISEMENT_TASKS_SET_ADDRESS) != 0; 637753f240c0SMatthias Ringwald bool advertising_set_will_be_removed = 637853f240c0SMatthias Ringwald (advertising_set->state & LE_ADVERTISEMENT_TASKS_REMOVE_SET) != 0; 6379be7ef9d8SMatthias Ringwald if (advertising_parameter_change || 6380be7ef9d8SMatthias Ringwald (advertising_uses_random_address && advertising_set_random_address_change) || 6381be7ef9d8SMatthias Ringwald (advertising_enabled == false) || 6382be7ef9d8SMatthias Ringwald (advertising_uses_whitelist && whitelist_modification_pending) || 6383be7ef9d8SMatthias Ringwald resolving_list_modification_pending || 6384be7ef9d8SMatthias Ringwald advertising_set_will_be_removed) { 6385be7ef9d8SMatthias Ringwald 6386be7ef9d8SMatthias Ringwald advertising_stop = true; 6387be7ef9d8SMatthias Ringwald advertising_stop_set = advertising_set; 6388be7ef9d8SMatthias Ringwald break; 6389be7ef9d8SMatthias Ringwald } 6390be7ef9d8SMatthias Ringwald } 6391c814a904SMatthias Ringwald #ifdef ENABLE_LE_PERIODIC_ADVERTISING 639253f240c0SMatthias Ringwald if ((advertising_set->state & LE_ADVERTISEMENT_STATE_PERIODIC_ACTIVE) != 0) { 639353f240c0SMatthias Ringwald // stop if: 639453f240c0SMatthias Ringwald // - it's disabled 639553f240c0SMatthias Ringwald // - parameter change required 639653f240c0SMatthias Ringwald bool periodic_enabled = (advertising_set->state & LE_ADVERTISEMENT_STATE_PERIODIC_ENABLED) != 0; 639753f240c0SMatthias Ringwald bool periodic_parameter_change = (advertising_set->tasks & LE_ADVERTISEMENT_TASKS_SET_PERIODIC_PARAMS) != 0; 639853f240c0SMatthias Ringwald if ((periodic_enabled == false) || periodic_parameter_change){ 639949a6c69cSMatthias Ringwald periodic_advertising_stop = true; 640053f240c0SMatthias Ringwald advertising_stop_set = advertising_set; 640153f240c0SMatthias Ringwald } 640253f240c0SMatthias Ringwald } 640349a6c69cSMatthias Ringwald #endif /* ENABLE_LE_PERIODIC_ADVERTISING */ 640453f240c0SMatthias Ringwald } 6405be7ef9d8SMatthias Ringwald } 6406be7ef9d8SMatthias Ringwald #endif 6407be7ef9d8SMatthias Ringwald 6408a41310b7SMatthias Ringwald #endif 6409fde725feSMatthias Ringwald 6410a41310b7SMatthias Ringwald 6411a41310b7SMatthias Ringwald // Phase 2: stop everything that should be off during modifications 6412a41310b7SMatthias Ringwald 6413131d4778SMatthias Ringwald 6414131d4778SMatthias Ringwald // 2.1 Outgoing connection 6415131d4778SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 6416131d4778SMatthias Ringwald if (connecting_stop){ 6417131d4778SMatthias Ringwald hci_send_cmd(&hci_le_create_connection_cancel); 6418131d4778SMatthias Ringwald return true; 6419131d4778SMatthias Ringwald } 6420131d4778SMatthias Ringwald #endif 6421131d4778SMatthias Ringwald 6422131d4778SMatthias Ringwald // 2.2 Scanning 6423a41310b7SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 6424a41310b7SMatthias Ringwald if (scanning_stop){ 64255226d7f2SMatthias Ringwald hci_stack->le_scanning_active = false; 6426c42da3bcSMatthias Ringwald hci_le_scan_stop(); 6427a41310b7SMatthias Ringwald return true; 6428a41310b7SMatthias Ringwald } 6429a41310b7SMatthias Ringwald 6430131d4778SMatthias Ringwald // 2.3 Periodic Sync 64314bafedd5SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 643249a6c69cSMatthias Ringwald if (hci_stack->le_periodic_terminate_sync_handle != HCI_CON_HANDLE_INVALID){ 643349a6c69cSMatthias Ringwald uint16_t sync_handle = hci_stack->le_periodic_terminate_sync_handle; 643449a6c69cSMatthias Ringwald hci_stack->le_periodic_terminate_sync_handle = HCI_CON_HANDLE_INVALID; 643549a6c69cSMatthias Ringwald hci_send_cmd(&hci_le_periodic_advertising_terminate_sync, sync_handle); 643649a6c69cSMatthias Ringwald return true; 643749a6c69cSMatthias Ringwald } 643849a6c69cSMatthias Ringwald #ifdef ENABLE_LE_PERIODIC_ADVERTISING 64394bafedd5SMatthias Ringwald if (periodic_sync_stop){ 64404bafedd5SMatthias Ringwald hci_stack->le_periodic_sync_state = LE_CONNECTING_CANCEL; 64414bafedd5SMatthias Ringwald hci_send_cmd(&hci_le_periodic_advertising_create_sync_cancel); 64424bafedd5SMatthias Ringwald return true; 64434bafedd5SMatthias Ringwald } 644449a6c69cSMatthias Ringwald #endif /* ENABLE_LE_PERIODIC_ADVERTISING */ 6445a8016f96SMatthias Ringwald #endif /* ENABLE_LE_EXTENDED_ADVERTISING */ 6446a8016f96SMatthias Ringwald #endif /* ENABLE_LE_CENTRAL */ 6447a41310b7SMatthias Ringwald 6448131d4778SMatthias Ringwald // 2.4 Advertising: legacy, extended, periodic 6449a41310b7SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 6450fde725feSMatthias Ringwald if (advertising_stop){ 6451e464cd48SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 645222f987e4SMatthias Ringwald if (hci_le_extended_advertising_supported()) { 6453be7ef9d8SMatthias Ringwald uint8_t advertising_stop_handle; 6454be7ef9d8SMatthias Ringwald if (advertising_stop_set != NULL){ 6455be7ef9d8SMatthias Ringwald advertising_stop_handle = advertising_stop_set->advertising_handle; 6456be7ef9d8SMatthias Ringwald advertising_stop_set->state &= ~LE_ADVERTISEMENT_STATE_ACTIVE; 6457be7ef9d8SMatthias Ringwald } else { 6458be7ef9d8SMatthias Ringwald advertising_stop_handle = 0; 6459be7ef9d8SMatthias Ringwald hci_stack->le_advertisements_state &= ~LE_ADVERTISEMENT_STATE_ACTIVE; 6460be7ef9d8SMatthias Ringwald } 6461be7ef9d8SMatthias Ringwald const uint8_t advertising_handles[] = { advertising_stop_handle }; 6462e464cd48SMatthias Ringwald const uint16_t durations[] = { 0 }; 6463e464cd48SMatthias Ringwald const uint16_t max_events[] = { 0 }; 6464e464cd48SMatthias Ringwald hci_send_cmd(&hci_le_set_extended_advertising_enable, 0, 1, advertising_handles, durations, max_events); 6465e464cd48SMatthias Ringwald } else 6466e464cd48SMatthias Ringwald #endif 6467e464cd48SMatthias Ringwald { 6468be7ef9d8SMatthias Ringwald hci_stack->le_advertisements_state &= ~LE_ADVERTISEMENT_STATE_ACTIVE; 646945c102fdSMatthias Ringwald hci_send_cmd(&hci_le_set_advertise_enable, 0); 6470e464cd48SMatthias Ringwald } 6471f30077b7SMatthias Ringwald return true; 647245c102fdSMatthias Ringwald } 647353f240c0SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 6474c814a904SMatthias Ringwald #ifdef ENABLE_LE_PERIODIC_ADVERTISING 647549a6c69cSMatthias Ringwald if (periodic_advertising_stop){ 647653f240c0SMatthias Ringwald advertising_stop_set->state &= ~LE_ADVERTISEMENT_STATE_PERIODIC_ACTIVE; 647753f240c0SMatthias Ringwald hci_send_cmd(&hci_le_set_periodic_advertising_enable, 0, advertising_stop_set->advertising_handle); 647853f240c0SMatthias Ringwald return true; 647953f240c0SMatthias Ringwald } 6480c814a904SMatthias Ringwald #endif /* ENABLE_LE_PERIODIC_ADVERTISING */ 6481c814a904SMatthias Ringwald #endif /* ENABLE_LE_EXTENDED_ADVERTISING */ 6482a8016f96SMatthias Ringwald #endif /* ENABLE_LE_PERIPHERAL */ 6483fde725feSMatthias Ringwald 6484131d4778SMatthias Ringwald 6485a41310b7SMatthias Ringwald // Phase 3: modify 6486a41310b7SMatthias Ringwald 6487137a570aSMatthias Ringwald if (hci_stack->le_advertisements_todo & LE_ADVERTISEMENT_TASKS_PRIVACY_NOTIFY) { 6488137a570aSMatthias Ringwald hci_stack->le_advertisements_todo &= ~LE_ADVERTISEMENT_TASKS_PRIVACY_NOTIFY; 6489137a570aSMatthias Ringwald // GAP Privacy, notify clients upon upcoming random address change 6490137a570aSMatthias Ringwald hci_stack->le_advertisements_state |= LE_ADVERTISEMENT_STATE_PRIVACY_PENDING; 64911fa7a4bbSMatthias Ringwald // notify might cause hci_run to get executed, check if we still can send 6492137a570aSMatthias Ringwald gap_privacy_clients_notify(hci_stack->le_random_address); 64931fa7a4bbSMatthias Ringwald if (!hci_can_send_command_packet_now()) { 64941fa7a4bbSMatthias Ringwald return true; 64951fa7a4bbSMatthias Ringwald } 6496137a570aSMatthias Ringwald } 6497137a570aSMatthias Ringwald 6498137a570aSMatthias Ringwald // - wait until privacy update completed 6499137a570aSMatthias Ringwald if ((hci_stack->le_advertisements_state & LE_ADVERTISEMENT_STATE_PRIVACY_PENDING) != 0){ 6500137a570aSMatthias Ringwald return false; 6501137a570aSMatthias Ringwald } 6502137a570aSMatthias Ringwald 650364f9dabaSMatthias Ringwald if (hci_stack->le_advertisements_todo & LE_ADVERTISEMENT_TASKS_SET_ADDRESS){ 65049136bde8SMatthias Ringwald hci_stack->le_advertisements_todo &= ~LE_ADVERTISEMENT_TASKS_SET_ADDRESS; 65059136bde8SMatthias Ringwald hci_send_cmd(&hci_le_set_random_address, hci_stack->le_random_address); 6506ae35a99cSMatthias Ringwald #ifdef ENABLE_LE_SET_ADV_PARAMS_ON_RANDOM_ADDRESS_CHANGE 6507ae35a99cSMatthias Ringwald // workaround: on some Controllers, address in advertisements is updated only after next dv params set 6508ae35a99cSMatthias Ringwald hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_SET_PARAMS; 6509ae35a99cSMatthias Ringwald #endif 65109136bde8SMatthias Ringwald return true; 65119136bde8SMatthias Ringwald } 65129136bde8SMatthias Ringwald 6513a41310b7SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 6514a41310b7SMatthias Ringwald if (hci_stack->le_scanning_param_update){ 6515a41310b7SMatthias Ringwald hci_stack->le_scanning_param_update = false; 651663671e69SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 651722f987e4SMatthias Ringwald if (hci_le_extended_advertising_supported()){ 65187eb5b27eSMatthias Ringwald // prepare arrays for all phys (LE Coded and LE 1M PHY) 65197eb5b27eSMatthias Ringwald uint8_t scan_types[2]; 65207eb5b27eSMatthias Ringwald uint16_t scan_intervals[2]; 65217eb5b27eSMatthias Ringwald uint16_t scan_windows[2]; 65227eb5b27eSMatthias Ringwald 65237eb5b27eSMatthias Ringwald uint8_t i; 65247eb5b27eSMatthias Ringwald uint8_t num_phys = hci_le_num_phys(hci_stack->le_scan_phys); 65257eb5b27eSMatthias Ringwald for (i=0;i<num_phys;i++){ 65267eb5b27eSMatthias Ringwald scan_types[i] = hci_stack->le_scan_type; 65277eb5b27eSMatthias Ringwald scan_intervals[i] = hci_stack->le_scan_interval; 65287eb5b27eSMatthias Ringwald scan_windows[i] = hci_stack->le_scan_window; 65297eb5b27eSMatthias Ringwald } 653063671e69SMatthias Ringwald hci_send_cmd(&hci_le_set_extended_scan_parameters, hci_stack->le_own_addr_type, 65317eb5b27eSMatthias Ringwald hci_stack->le_scan_filter_policy, hci_stack->le_scan_phys, scan_types, scan_intervals, scan_windows); 653263671e69SMatthias Ringwald } else 653363671e69SMatthias Ringwald #endif 653463671e69SMatthias Ringwald { 6535a41310b7SMatthias Ringwald hci_send_cmd(&hci_le_set_scan_parameters, hci_stack->le_scan_type, hci_stack->le_scan_interval, hci_stack->le_scan_window, 6536a41310b7SMatthias Ringwald hci_stack->le_own_addr_type, hci_stack->le_scan_filter_policy); 653763671e69SMatthias Ringwald } 6538a41310b7SMatthias Ringwald return true; 6539a41310b7SMatthias Ringwald } 6540a41310b7SMatthias Ringwald #endif 6541a41310b7SMatthias Ringwald 6542a41310b7SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 654345c102fdSMatthias Ringwald if (hci_stack->le_advertisements_todo & LE_ADVERTISEMENT_TASKS_SET_PARAMS){ 654445c102fdSMatthias Ringwald hci_stack->le_advertisements_todo &= ~LE_ADVERTISEMENT_TASKS_SET_PARAMS; 65456bcfa632SMatthias Ringwald hci_stack->le_advertisements_own_addr_type = hci_stack->le_own_addr_type; 6546e464cd48SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 654722f987e4SMatthias Ringwald if (hci_le_extended_advertising_supported()){ 6548e464cd48SMatthias Ringwald // map advertisment type to advertising event properties 6549e464cd48SMatthias Ringwald uint16_t adv_event_properties = 0; 655036916f81SDirk Helbig // 0b00010011, 0b00010101, 0b00011101, 0b00010010, 0b00010000 655136916f81SDirk Helbig const uint16_t mapping[] = { 0x13, 0x15, 0x1D, 0x12, 0x10 }; 6552e464cd48SMatthias Ringwald if (hci_stack->le_advertisements_type < (sizeof(mapping)/sizeof(uint16_t))){ 6553e464cd48SMatthias Ringwald adv_event_properties = mapping[hci_stack->le_advertisements_type]; 6554e464cd48SMatthias Ringwald } 6555174b4d21SMatthias Ringwald hci_stack->le_advertising_set_in_current_command = 0; 6556e464cd48SMatthias Ringwald hci_send_cmd(&hci_le_set_extended_advertising_parameters, 6557e464cd48SMatthias Ringwald 0, 6558e464cd48SMatthias Ringwald adv_event_properties, 6559e464cd48SMatthias Ringwald hci_stack->le_advertisements_interval_min, 6560e464cd48SMatthias Ringwald hci_stack->le_advertisements_interval_max, 6561e464cd48SMatthias Ringwald hci_stack->le_advertisements_channel_map, 6562e464cd48SMatthias Ringwald hci_stack->le_advertisements_own_addr_type, 6563e464cd48SMatthias Ringwald hci_stack->le_advertisements_direct_address_type, 6564e464cd48SMatthias Ringwald hci_stack->le_advertisements_direct_address, 6565e464cd48SMatthias Ringwald hci_stack->le_advertisements_filter_policy, 6566e464cd48SMatthias Ringwald 0x7f, // tx power: no preference 6567e464cd48SMatthias Ringwald 0x01, // primary adv phy: LE 1M 6568e464cd48SMatthias Ringwald 0, // secondary adv max skip 65695375ad13SMatthias Ringwald 0x01, // secondary adv phy 6570e464cd48SMatthias Ringwald 0, // adv sid 6571e464cd48SMatthias Ringwald 0 // scan request notification 6572e464cd48SMatthias Ringwald ); 6573d935373dSMatthias Ringwald } else 6574e464cd48SMatthias Ringwald #endif 6575e464cd48SMatthias Ringwald { 657645c102fdSMatthias Ringwald hci_send_cmd(&hci_le_set_advertising_parameters, 657745c102fdSMatthias Ringwald hci_stack->le_advertisements_interval_min, 657845c102fdSMatthias Ringwald hci_stack->le_advertisements_interval_max, 657945c102fdSMatthias Ringwald hci_stack->le_advertisements_type, 65806bcfa632SMatthias Ringwald hci_stack->le_advertisements_own_addr_type, 658145c102fdSMatthias Ringwald hci_stack->le_advertisements_direct_address_type, 658245c102fdSMatthias Ringwald hci_stack->le_advertisements_direct_address, 658345c102fdSMatthias Ringwald hci_stack->le_advertisements_channel_map, 658445c102fdSMatthias Ringwald hci_stack->le_advertisements_filter_policy); 6585e464cd48SMatthias Ringwald } 6586f30077b7SMatthias Ringwald return true; 658745c102fdSMatthias Ringwald } 6588be7ef9d8SMatthias Ringwald 65899ce6dfa1SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 65909ce6dfa1SMatthias Ringwald // assumption: only set if extended advertising is supported 65919ce6dfa1SMatthias Ringwald if ((hci_stack->le_advertisements_todo & LE_ADVERTISEMENT_TASKS_SET_ADDRESS_SET_0) != 0){ 65929ce6dfa1SMatthias Ringwald hci_stack->le_advertisements_todo &= ~LE_ADVERTISEMENT_TASKS_SET_ADDRESS_SET_0; 65939ce6dfa1SMatthias Ringwald hci_send_cmd(&hci_le_set_advertising_set_random_address, 0, hci_stack->le_random_address); 65949ce6dfa1SMatthias Ringwald return true; 65959ce6dfa1SMatthias Ringwald } 65969ce6dfa1SMatthias Ringwald #endif 65979ce6dfa1SMatthias Ringwald 6598501f56b3SMatthias Ringwald if (hci_stack->le_advertisements_todo & LE_ADVERTISEMENT_TASKS_SET_ADV_DATA){ 6599501f56b3SMatthias Ringwald hci_stack->le_advertisements_todo &= ~LE_ADVERTISEMENT_TASKS_SET_ADV_DATA; 66007a85e4f5SMatthias Ringwald uint8_t adv_data_clean[31]; 66017a85e4f5SMatthias Ringwald memset(adv_data_clean, 0, sizeof(adv_data_clean)); 66026535961aSMatthias Ringwald (void)memcpy(adv_data_clean, hci_stack->le_advertisements_data, 66036535961aSMatthias Ringwald hci_stack->le_advertisements_data_len); 66043c9da642SMatthias Ringwald btstack_replace_bd_addr_placeholder(adv_data_clean, hci_stack->le_advertisements_data_len, hci_stack->local_bd_addr); 6605e464cd48SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 660622f987e4SMatthias Ringwald if (hci_le_extended_advertising_supported()){ 6607174b4d21SMatthias Ringwald hci_stack->le_advertising_set_in_current_command = 0; 6608e464cd48SMatthias Ringwald hci_send_cmd(&hci_le_set_extended_advertising_data, 0, 0x03, 0x01, hci_stack->le_advertisements_data_len, adv_data_clean); 6609e464cd48SMatthias Ringwald } else 6610e464cd48SMatthias Ringwald #endif 6611e464cd48SMatthias Ringwald { 66127a85e4f5SMatthias Ringwald hci_send_cmd(&hci_le_set_advertising_data, hci_stack->le_advertisements_data_len, adv_data_clean); 6613e464cd48SMatthias Ringwald } 6614f30077b7SMatthias Ringwald return true; 661545c102fdSMatthias Ringwald } 6616be7ef9d8SMatthias Ringwald 6617501f56b3SMatthias Ringwald if (hci_stack->le_advertisements_todo & LE_ADVERTISEMENT_TASKS_SET_SCAN_DATA){ 6618501f56b3SMatthias Ringwald hci_stack->le_advertisements_todo &= ~LE_ADVERTISEMENT_TASKS_SET_SCAN_DATA; 6619f868b059SMatthias Ringwald uint8_t scan_data_clean[31]; 6620f868b059SMatthias Ringwald memset(scan_data_clean, 0, sizeof(scan_data_clean)); 66216535961aSMatthias Ringwald (void)memcpy(scan_data_clean, hci_stack->le_scan_response_data, 66226535961aSMatthias Ringwald hci_stack->le_scan_response_data_len); 66233c9da642SMatthias Ringwald btstack_replace_bd_addr_placeholder(scan_data_clean, hci_stack->le_scan_response_data_len, hci_stack->local_bd_addr); 6624e464cd48SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 662522f987e4SMatthias Ringwald if (hci_le_extended_advertising_supported()){ 6626174b4d21SMatthias Ringwald hci_stack->le_advertising_set_in_current_command = 0; 6627e464cd48SMatthias Ringwald hci_send_cmd(&hci_le_set_extended_scan_response_data, 0, 0x03, 0x01, hci_stack->le_scan_response_data_len, scan_data_clean); 6628e464cd48SMatthias Ringwald } else 6629e464cd48SMatthias Ringwald #endif 6630e464cd48SMatthias Ringwald { 6631214bfd60SMatthias Ringwald hci_send_cmd(&hci_le_set_scan_response_data, hci_stack->le_scan_response_data_len, scan_data_clean); 6632e464cd48SMatthias Ringwald } 6633f30077b7SMatthias Ringwald return true; 6634501f56b3SMatthias Ringwald } 6635be7ef9d8SMatthias Ringwald 6636be7ef9d8SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 663722f987e4SMatthias Ringwald if (hci_le_extended_advertising_supported()) { 6638be7ef9d8SMatthias Ringwald btstack_linked_list_iterator_t it; 6639be7ef9d8SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->le_advertising_sets); 6640be7ef9d8SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 6641be7ef9d8SMatthias Ringwald le_advertising_set_t * advertising_set = (le_advertising_set_t*) btstack_linked_list_iterator_next(&it); 6642be7ef9d8SMatthias Ringwald if ((advertising_set->tasks & LE_ADVERTISEMENT_TASKS_REMOVE_SET) != 0) { 6643be7ef9d8SMatthias Ringwald advertising_set->tasks &= ~LE_ADVERTISEMENT_TASKS_REMOVE_SET; 6644174b4d21SMatthias Ringwald hci_stack->le_advertising_set_in_current_command = advertising_set->advertising_handle; 6645be7ef9d8SMatthias Ringwald hci_send_cmd(&hci_le_remove_advertising_set, advertising_set->advertising_handle); 6646be7ef9d8SMatthias Ringwald return true; 6647be7ef9d8SMatthias Ringwald } 6648be7ef9d8SMatthias Ringwald if ((advertising_set->tasks & LE_ADVERTISEMENT_TASKS_SET_PARAMS) != 0){ 6649be7ef9d8SMatthias Ringwald advertising_set->tasks &= ~LE_ADVERTISEMENT_TASKS_SET_PARAMS; 6650174b4d21SMatthias Ringwald hci_stack->le_advertising_set_in_current_command = advertising_set->advertising_handle; 6651be7ef9d8SMatthias Ringwald hci_send_cmd(&hci_le_set_extended_advertising_parameters, 6652be7ef9d8SMatthias Ringwald advertising_set->advertising_handle, 665357a04237SMatthias Ringwald advertising_set->extended_params.advertising_event_properties, 665457a04237SMatthias Ringwald advertising_set->extended_params.primary_advertising_interval_min, 665557a04237SMatthias Ringwald advertising_set->extended_params.primary_advertising_interval_max, 665657a04237SMatthias Ringwald advertising_set->extended_params.primary_advertising_channel_map, 665757a04237SMatthias Ringwald advertising_set->extended_params.own_address_type, 665857a04237SMatthias Ringwald advertising_set->extended_params.peer_address_type, 665957a04237SMatthias Ringwald advertising_set->extended_params.peer_address, 666057a04237SMatthias Ringwald advertising_set->extended_params.advertising_filter_policy, 666157a04237SMatthias Ringwald advertising_set->extended_params.advertising_tx_power, 666257a04237SMatthias Ringwald advertising_set->extended_params.primary_advertising_phy, 666357a04237SMatthias Ringwald advertising_set->extended_params.secondary_advertising_max_skip, 666457a04237SMatthias Ringwald advertising_set->extended_params.secondary_advertising_phy, 666557a04237SMatthias Ringwald advertising_set->extended_params.advertising_sid, 666657a04237SMatthias Ringwald advertising_set->extended_params.scan_request_notification_enable 6667be7ef9d8SMatthias Ringwald ); 6668be7ef9d8SMatthias Ringwald return true; 6669be7ef9d8SMatthias Ringwald } 66700f54aa8dSMatthias Ringwald if ((advertising_set->tasks & LE_ADVERTISEMENT_TASKS_SET_ADDRESS) != 0){ 66710f54aa8dSMatthias Ringwald advertising_set->tasks &= ~LE_ADVERTISEMENT_TASKS_SET_ADDRESS; 66720f54aa8dSMatthias Ringwald hci_send_cmd(&hci_le_set_advertising_set_random_address, advertising_set->advertising_handle, advertising_set->random_address); 66730f54aa8dSMatthias Ringwald return true; 66740f54aa8dSMatthias Ringwald } 6675be7ef9d8SMatthias Ringwald if ((advertising_set->tasks & LE_ADVERTISEMENT_TASKS_SET_ADV_DATA) != 0) { 6676be7ef9d8SMatthias Ringwald uint16_t pos = advertising_set->adv_data_pos; 6677be7ef9d8SMatthias Ringwald uint8_t operation = hci_le_extended_advertising_operation_for_chunk(pos, advertising_set->adv_data_len); 6678be7ef9d8SMatthias Ringwald uint16_t data_to_upload = btstack_min(advertising_set->adv_data_len - pos, LE_EXTENDED_ADVERTISING_MAX_CHUNK_LEN); 6679be7ef9d8SMatthias Ringwald if ((operation & 0x02) != 0){ 6680be7ef9d8SMatthias Ringwald // last fragment or complete data 6681be7ef9d8SMatthias Ringwald operation |= 2; 6682be7ef9d8SMatthias Ringwald advertising_set->adv_data_pos = 0; 6683be7ef9d8SMatthias Ringwald advertising_set->tasks &= ~LE_ADVERTISEMENT_TASKS_SET_ADV_DATA; 6684be7ef9d8SMatthias Ringwald } else { 6685be7ef9d8SMatthias Ringwald advertising_set->adv_data_pos += data_to_upload; 6686be7ef9d8SMatthias Ringwald } 6687174b4d21SMatthias Ringwald hci_stack->le_advertising_set_in_current_command = advertising_set->advertising_handle; 66880cbe4690SMatthias Ringwald hci_send_cmd(&hci_le_set_extended_advertising_data, advertising_set->advertising_handle, operation, 0x01, data_to_upload, &advertising_set->adv_data[pos]); 6689be7ef9d8SMatthias Ringwald return true; 6690be7ef9d8SMatthias Ringwald } 6691be7ef9d8SMatthias Ringwald if ((advertising_set->tasks & LE_ADVERTISEMENT_TASKS_SET_SCAN_DATA) != 0) { 6692be7ef9d8SMatthias Ringwald uint16_t pos = advertising_set->scan_data_pos; 6693be7ef9d8SMatthias Ringwald uint8_t operation = hci_le_extended_advertising_operation_for_chunk(pos, advertising_set->scan_data_len); 6694be7ef9d8SMatthias Ringwald uint16_t data_to_upload = btstack_min(advertising_set->scan_data_len - pos, LE_EXTENDED_ADVERTISING_MAX_CHUNK_LEN); 6695be7ef9d8SMatthias Ringwald if ((operation & 0x02) != 0){ 6696be7ef9d8SMatthias Ringwald advertising_set->scan_data_pos = 0; 6697be7ef9d8SMatthias Ringwald advertising_set->tasks &= ~LE_ADVERTISEMENT_TASKS_SET_SCAN_DATA; 6698be7ef9d8SMatthias Ringwald } else { 6699be7ef9d8SMatthias Ringwald advertising_set->scan_data_pos += data_to_upload; 6700be7ef9d8SMatthias Ringwald } 6701174b4d21SMatthias Ringwald hci_stack->le_advertising_set_in_current_command = advertising_set->advertising_handle; 67028ef6d15fSMatthias 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]); 6703be7ef9d8SMatthias Ringwald return true; 6704be7ef9d8SMatthias Ringwald } 6705c814a904SMatthias Ringwald #ifdef ENABLE_LE_PERIODIC_ADVERTISING 670653f240c0SMatthias Ringwald if ((advertising_set->tasks & LE_ADVERTISEMENT_TASKS_SET_PERIODIC_PARAMS) != 0){ 670753f240c0SMatthias Ringwald advertising_set->tasks &= ~LE_ADVERTISEMENT_TASKS_SET_PERIODIC_PARAMS; 670853f240c0SMatthias Ringwald hci_stack->le_advertising_set_in_current_command = advertising_set->advertising_handle; 670953f240c0SMatthias Ringwald hci_send_cmd(&hci_le_set_periodic_advertising_parameters, 671053f240c0SMatthias Ringwald advertising_set->advertising_handle, 671153f240c0SMatthias Ringwald advertising_set->periodic_params.periodic_advertising_interval_min, 671253f240c0SMatthias Ringwald advertising_set->periodic_params.periodic_advertising_interval_max, 671353f240c0SMatthias Ringwald advertising_set->periodic_params.periodic_advertising_properties); 671453f240c0SMatthias Ringwald return true; 671553f240c0SMatthias Ringwald } 671653f240c0SMatthias Ringwald if ((advertising_set->tasks & LE_ADVERTISEMENT_TASKS_SET_PERIODIC_DATA) != 0) { 67170cbe4690SMatthias Ringwald uint16_t pos = advertising_set->periodic_data_pos; 671853f240c0SMatthias Ringwald uint8_t operation = hci_le_extended_advertising_operation_for_chunk(pos, advertising_set->periodic_data_len); 671953f240c0SMatthias Ringwald uint16_t data_to_upload = btstack_min(advertising_set->periodic_data_len - pos, LE_EXTENDED_ADVERTISING_MAX_CHUNK_LEN); 672053f240c0SMatthias Ringwald if ((operation & 0x02) != 0){ 672153f240c0SMatthias Ringwald // last fragment or complete data 672253f240c0SMatthias Ringwald operation |= 2; 67230cbe4690SMatthias Ringwald advertising_set->periodic_data_pos = 0; 672453f240c0SMatthias Ringwald advertising_set->tasks &= ~LE_ADVERTISEMENT_TASKS_SET_PERIODIC_DATA; 672553f240c0SMatthias Ringwald } else { 67260cbe4690SMatthias Ringwald advertising_set->periodic_data_pos += data_to_upload; 672753f240c0SMatthias Ringwald } 672853f240c0SMatthias Ringwald hci_stack->le_advertising_set_in_current_command = advertising_set->advertising_handle; 67290cbe4690SMatthias Ringwald hci_send_cmd(&hci_le_set_periodic_advertising_data, advertising_set->advertising_handle, operation, data_to_upload, &advertising_set->periodic_data[pos]); 673053f240c0SMatthias Ringwald return true; 673153f240c0SMatthias Ringwald } 6732c814a904SMatthias Ringwald #endif /* ENABLE_LE_PERIODIC_ADVERTISING */ 6733be7ef9d8SMatthias Ringwald } 6734be7ef9d8SMatthias Ringwald } 6735be7ef9d8SMatthias Ringwald #endif 6736be7ef9d8SMatthias Ringwald 6737d70217a2SMatthias Ringwald #endif 67389956955bSMatthias Ringwald 6739057ab60cSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 6740a41310b7SMatthias Ringwald // if connect with whitelist was active and is not cancelled yet, wait until next time 6741a41310b7SMatthias Ringwald if (hci_stack->le_connecting_state == LE_CONNECTING_CANCEL) return false; 67424bafedd5SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 67434bafedd5SMatthias Ringwald // if periodic sync with advertiser list was active and is not cancelled yet, wait until next time 67444bafedd5SMatthias Ringwald if (hci_stack->le_periodic_sync_state == LE_CONNECTING_CANCEL) return false; 67454bafedd5SMatthias Ringwald #endif 6746057ab60cSMatthias Ringwald #endif 6747057ab60cSMatthias Ringwald 6748a41310b7SMatthias Ringwald // LE Whitelist Management 6749a41310b7SMatthias Ringwald if (whitelist_modification_pending){ 67502c052b15SMatthias Ringwald bool done = hci_whitelist_modification_process(); 67512c052b15SMatthias Ringwald if (done) return true; 675291915b0bSMatthias Ringwald } 67539956955bSMatthias Ringwald 675421debf25SMatthias Ringwald #ifdef ENABLE_LE_PRIVACY_ADDRESS_RESOLUTION 675521debf25SMatthias Ringwald // LE Resolving List Management 67562fbf0ed0SMatthias Ringwald if (resolving_list_modification_pending) { 675721debf25SMatthias Ringwald uint16_t i; 67588dc1b1d0SMatthias Ringwald uint8_t null_16[16]; 67598dc1b1d0SMatthias Ringwald uint8_t local_irk_flipped[16]; 67608dc1b1d0SMatthias Ringwald const uint8_t *local_irk; 676121debf25SMatthias Ringwald switch (hci_stack->le_resolving_list_state) { 676221debf25SMatthias Ringwald case LE_RESOLVING_LIST_SEND_ENABLE_ADDRESS_RESOLUTION: 676321debf25SMatthias Ringwald hci_stack->le_resolving_list_state = LE_RESOLVING_LIST_READ_SIZE; 676421debf25SMatthias Ringwald hci_send_cmd(&hci_le_set_address_resolution_enabled, 1); 676521debf25SMatthias Ringwald return true; 676621debf25SMatthias Ringwald case LE_RESOLVING_LIST_READ_SIZE: 676721debf25SMatthias Ringwald hci_stack->le_resolving_list_state = LE_RESOLVING_LIST_SEND_CLEAR; 676821debf25SMatthias Ringwald hci_send_cmd(&hci_le_read_resolving_list_size); 676921debf25SMatthias Ringwald return true; 677021debf25SMatthias Ringwald case LE_RESOLVING_LIST_SEND_CLEAR: 67718dc1b1d0SMatthias Ringwald hci_stack->le_resolving_list_state = LE_RESOLVING_LIST_SET_IRK; 6772ea151974SMatthias Ringwald (void) memset(hci_stack->le_resolving_list_add_entries, 0xff, 6773ea151974SMatthias Ringwald sizeof(hci_stack->le_resolving_list_add_entries)); 6774e8ca66c6SMatthias Ringwald (void) memset(hci_stack->le_resolving_list_set_privacy_mode, 0xff, 6775e8ca66c6SMatthias Ringwald sizeof(hci_stack->le_resolving_list_set_privacy_mode)); 6776ea151974SMatthias Ringwald (void) memset(hci_stack->le_resolving_list_remove_entries, 0, 6777ea151974SMatthias Ringwald sizeof(hci_stack->le_resolving_list_remove_entries)); 677821debf25SMatthias Ringwald hci_send_cmd(&hci_le_clear_resolving_list); 677921debf25SMatthias Ringwald return true; 67808dc1b1d0SMatthias Ringwald case LE_RESOLVING_LIST_SET_IRK: 67818dc1b1d0SMatthias Ringwald // set IRK used by RPA for undirected advertising 67828dc1b1d0SMatthias Ringwald hci_stack->le_resolving_list_state = LE_RESOLVING_LIST_UPDATES_ENTRIES; 67838dc1b1d0SMatthias Ringwald local_irk = gap_get_persistent_irk(); 67848dc1b1d0SMatthias Ringwald reverse_128(local_irk, local_irk_flipped); 67858dc1b1d0SMatthias Ringwald memset(null_16, 0, sizeof(null_16)); 67868dc1b1d0SMatthias Ringwald hci_send_cmd(&hci_le_add_device_to_resolving_list, BD_ADDR_TYPE_LE_PUBLIC, null_16, 67878dc1b1d0SMatthias Ringwald null_16, local_irk_flipped); 67888dc1b1d0SMatthias Ringwald return true; 67895f3ccd83SMatthias Ringwald case LE_RESOLVING_LIST_UPDATES_ENTRIES: 67905f3ccd83SMatthias Ringwald // first remove old entries 679102b02cffSMatthias Ringwald for (i = 0; i < MAX_NUM_RESOLVING_LIST_ENTRIES && i < le_device_db_max_count(); i++) { 679202b02cffSMatthias Ringwald uint8_t offset = i >> 3; 679302b02cffSMatthias Ringwald uint8_t mask = 1 << (i & 7); 679402b02cffSMatthias Ringwald if ((hci_stack->le_resolving_list_remove_entries[offset] & mask) == 0) continue; 679502b02cffSMatthias Ringwald hci_stack->le_resolving_list_remove_entries[offset] &= ~mask; 679602b02cffSMatthias Ringwald bd_addr_t peer_identity_addreses; 679702b02cffSMatthias Ringwald int peer_identity_addr_type = (int) BD_ADDR_TYPE_UNKNOWN; 679802b02cffSMatthias Ringwald sm_key_t peer_irk; 679902b02cffSMatthias Ringwald le_device_db_info(i, &peer_identity_addr_type, peer_identity_addreses, peer_irk); 680002b02cffSMatthias Ringwald if (peer_identity_addr_type == BD_ADDR_TYPE_UNKNOWN) continue; 6801f5228c62SMatthias Ringwald 6802f5228c62SMatthias Ringwald #ifdef ENABLE_LE_WHITELIST_TOUCH_AFTER_RESOLVING_LIST_UPDATE 6803f5228c62SMatthias Ringwald // trigger whitelist entry 'update' (work around for controller bug) 6804f5228c62SMatthias Ringwald btstack_linked_list_iterator_init(&lit, &hci_stack->le_whitelist); 6805f5228c62SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&lit)) { 6806f5228c62SMatthias Ringwald whitelist_entry_t *entry = (whitelist_entry_t *) btstack_linked_list_iterator_next(&lit); 6807f5228c62SMatthias Ringwald if (entry->address_type != peer_identity_addr_type) continue; 6808f5228c62SMatthias Ringwald if (memcmp(entry->address, peer_identity_addreses, 6) != 0) continue; 6809f5228c62SMatthias Ringwald log_info("trigger whitelist update %s", bd_addr_to_str(peer_identity_addreses)); 6810f5228c62SMatthias Ringwald entry->state |= LE_WHITELIST_REMOVE_FROM_CONTROLLER | LE_WHITELIST_ADD_TO_CONTROLLER; 6811f5228c62SMatthias Ringwald } 6812f5228c62SMatthias Ringwald #endif 6813f5228c62SMatthias Ringwald 6814ea151974SMatthias Ringwald hci_send_cmd(&hci_le_remove_device_from_resolving_list, peer_identity_addr_type, 6815ea151974SMatthias Ringwald peer_identity_addreses); 681602b02cffSMatthias Ringwald return true; 681702b02cffSMatthias Ringwald } 681802b02cffSMatthias Ringwald 68195f3ccd83SMatthias Ringwald // then add new entries 682021debf25SMatthias Ringwald for (i = 0; i < MAX_NUM_RESOLVING_LIST_ENTRIES && i < le_device_db_max_count(); i++) { 682121debf25SMatthias Ringwald uint8_t offset = i >> 3; 682221debf25SMatthias Ringwald uint8_t mask = 1 << (i & 7); 682302b02cffSMatthias Ringwald if ((hci_stack->le_resolving_list_add_entries[offset] & mask) == 0) continue; 682402b02cffSMatthias Ringwald hci_stack->le_resolving_list_add_entries[offset] &= ~mask; 682521debf25SMatthias Ringwald bd_addr_t peer_identity_addreses; 682621debf25SMatthias Ringwald int peer_identity_addr_type = (int) BD_ADDR_TYPE_UNKNOWN; 682721debf25SMatthias Ringwald sm_key_t peer_irk; 682821debf25SMatthias Ringwald le_device_db_info(i, &peer_identity_addr_type, peer_identity_addreses, peer_irk); 682921debf25SMatthias Ringwald if (peer_identity_addr_type == BD_ADDR_TYPE_UNKNOWN) continue; 6830e938c062SMatthias Ringwald if (btstack_is_null(peer_irk, 16)) continue; 68312b6efc4dSMatthias Ringwald local_irk = gap_get_persistent_irk(); 683221debf25SMatthias Ringwald // command uses format specifier 'P' that stores 16-byte value without flip 683321debf25SMatthias Ringwald uint8_t peer_irk_flipped[16]; 683421debf25SMatthias Ringwald reverse_128(local_irk, local_irk_flipped); 683521debf25SMatthias Ringwald reverse_128(peer_irk, peer_irk_flipped); 6836ea151974SMatthias Ringwald hci_send_cmd(&hci_le_add_device_to_resolving_list, peer_identity_addr_type, peer_identity_addreses, 6837ea151974SMatthias Ringwald peer_irk_flipped, local_irk_flipped); 683821debf25SMatthias Ringwald return true; 683921debf25SMatthias Ringwald } 6840e8ca66c6SMatthias Ringwald 6841e8ca66c6SMatthias Ringwald // finally, set privacy mode 6842e8ca66c6SMatthias Ringwald for (i = 0; i < MAX_NUM_RESOLVING_LIST_ENTRIES && i < le_device_db_max_count(); i++) { 6843e8ca66c6SMatthias Ringwald uint8_t offset = i >> 3; 6844e8ca66c6SMatthias Ringwald uint8_t mask = 1 << (i & 7); 6845e8ca66c6SMatthias Ringwald if ((hci_stack->le_resolving_list_set_privacy_mode[offset] & mask) == 0) continue; 6846e8ca66c6SMatthias Ringwald hci_stack->le_resolving_list_set_privacy_mode[offset] &= ~mask; 6847e8ca66c6SMatthias Ringwald if (hci_stack->le_privacy_mode == LE_PRIVACY_MODE_NETWORK) { 6848e8ca66c6SMatthias Ringwald // Network Privacy Mode is default 6849e8ca66c6SMatthias Ringwald continue; 6850e8ca66c6SMatthias Ringwald } 6851e8ca66c6SMatthias Ringwald bd_addr_t peer_identity_address; 6852e8ca66c6SMatthias Ringwald int peer_identity_addr_type = (int) BD_ADDR_TYPE_UNKNOWN; 6853e8ca66c6SMatthias Ringwald sm_key_t peer_irk; 6854e8ca66c6SMatthias Ringwald le_device_db_info(i, &peer_identity_addr_type, peer_identity_address, peer_irk); 6855e8ca66c6SMatthias Ringwald if (peer_identity_addr_type == BD_ADDR_TYPE_UNKNOWN) continue; 6856e8ca66c6SMatthias Ringwald if (btstack_is_null(peer_irk, 16)) continue; 6857e8ca66c6SMatthias Ringwald // command uses format specifier 'P' that stores 16-byte value without flip 6858e8ca66c6SMatthias Ringwald uint8_t peer_irk_flipped[16]; 6859e8ca66c6SMatthias Ringwald reverse_128(peer_irk, peer_irk_flipped); 6860e8ca66c6SMatthias Ringwald hci_send_cmd(&hci_le_set_privacy_mode, peer_identity_addr_type, peer_identity_address, hci_stack->le_privacy_mode); 6861e8ca66c6SMatthias Ringwald return true; 6862e8ca66c6SMatthias Ringwald } 686321debf25SMatthias Ringwald break; 686402b02cffSMatthias Ringwald 686521debf25SMatthias Ringwald default: 686621debf25SMatthias Ringwald break; 686721debf25SMatthias Ringwald } 686821debf25SMatthias Ringwald hci_stack->le_resolving_list_state = LE_RESOLVING_LIST_DONE; 68692fbf0ed0SMatthias Ringwald } 687021debf25SMatthias Ringwald #endif 6871a41310b7SMatthias Ringwald 6872f40c73b4SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 6873f40c73b4SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 6874f40c73b4SMatthias Ringwald // LE Whitelist Management 6875f40c73b4SMatthias Ringwald if (periodic_list_modification_pending){ 6876f40c73b4SMatthias Ringwald // add/remove entries 6877f40c73b4SMatthias Ringwald btstack_linked_list_iterator_init(&lit, &hci_stack->le_periodic_advertiser_list); 6878f40c73b4SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&lit)){ 6879f40c73b4SMatthias Ringwald periodic_advertiser_list_entry_t * entry = (periodic_advertiser_list_entry_t*) btstack_linked_list_iterator_next(&lit); 6880f40c73b4SMatthias Ringwald if (entry->state & LE_PERIODIC_ADVERTISER_LIST_ENTRY_REMOVE_FROM_CONTROLLER){ 6881f40c73b4SMatthias Ringwald entry->state &= ~LE_PERIODIC_ADVERTISER_LIST_ENTRY_REMOVE_FROM_CONTROLLER; 6882d946a741SMatthias Ringwald hci_send_cmd(&hci_le_remove_device_from_periodic_advertiser_list, entry->address_type, entry->address, entry->sid); 6883f40c73b4SMatthias Ringwald return true; 6884f40c73b4SMatthias Ringwald } 6885f40c73b4SMatthias Ringwald if (entry->state & LE_PERIODIC_ADVERTISER_LIST_ENTRY_ADD_TO_CONTROLLER){ 6886f40c73b4SMatthias Ringwald entry->state &= ~LE_PERIODIC_ADVERTISER_LIST_ENTRY_ADD_TO_CONTROLLER; 6887f40c73b4SMatthias Ringwald entry->state |= LE_PERIODIC_ADVERTISER_LIST_ENTRY_ON_CONTROLLER; 68889e88556bSMatthias Ringwald hci_send_cmd(&hci_le_add_device_to_periodic_advertiser_list, entry->address_type, entry->address, entry->sid); 6889f40c73b4SMatthias Ringwald return true; 6890f40c73b4SMatthias Ringwald } 6891f40c73b4SMatthias Ringwald if ((entry->state & LE_PERIODIC_ADVERTISER_LIST_ENTRY_ON_CONTROLLER) == 0){ 6892f40c73b4SMatthias Ringwald btstack_linked_list_remove(&hci_stack->le_periodic_advertiser_list, (btstack_linked_item_t *) entry); 6893f40c73b4SMatthias Ringwald btstack_memory_periodic_advertiser_list_entry_free(entry); 6894f40c73b4SMatthias Ringwald } 6895f40c73b4SMatthias Ringwald } 6896f40c73b4SMatthias Ringwald } 6897f40c73b4SMatthias Ringwald #endif 6898f40c73b4SMatthias Ringwald #endif 6899f40c73b4SMatthias Ringwald 690098aa715fSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 690198aa715fSMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 690298aa715fSMatthias Ringwald #ifdef ENABLE_LE_PERIODIC_ADVERTISING 690398aa715fSMatthias Ringwald if (hci_stack->le_past_set_default_params){ 690498aa715fSMatthias Ringwald hci_stack->le_past_set_default_params = false; 690598aa715fSMatthias Ringwald hci_send_cmd(&hci_le_set_default_periodic_advertising_sync_transfer_parameters, 690698aa715fSMatthias Ringwald hci_stack->le_past_mode, 690798aa715fSMatthias Ringwald hci_stack->le_past_skip, 690898aa715fSMatthias Ringwald hci_stack->le_past_sync_timeout, 690998aa715fSMatthias Ringwald hci_stack->le_past_cte_type); 691098aa715fSMatthias Ringwald return true; 691198aa715fSMatthias Ringwald } 691298aa715fSMatthias Ringwald #endif 691398aa715fSMatthias Ringwald #endif 691498aa715fSMatthias Ringwald #endif 691598aa715fSMatthias Ringwald 6916a086dc35SMatthias Ringwald // postpone all actions until stack is fully working 691773799937SMatthias Ringwald if (hci_stack->state != HCI_STATE_WORKING) return false; 691873799937SMatthias Ringwald 691973799937SMatthias Ringwald // advertisements, active scanning, and creating connections requires random address to be set if using private address 692073799937SMatthias Ringwald if ( (hci_stack->le_own_addr_type != BD_ADDR_TYPE_LE_PUBLIC) && (hci_stack->le_random_address_set == 0u) ) return false; 692173799937SMatthias Ringwald 6922a41310b7SMatthias Ringwald // Phase 4: restore state 692329c24bebSMatthias Ringwald 692429c24bebSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 6925af64f147SMatthias Ringwald // re-start scanning 692629c24bebSMatthias Ringwald if ((hci_stack->le_scanning_enabled && !hci_stack->le_scanning_active)){ 692729c24bebSMatthias Ringwald hci_stack->le_scanning_active = true; 692863671e69SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 692922f987e4SMatthias Ringwald if (hci_le_extended_advertising_supported()){ 69304856283bSMatthias Ringwald hci_send_cmd(&hci_le_set_extended_scan_enable, 1, hci_stack->le_scan_filter_duplicates, 0, 0); 693163671e69SMatthias Ringwald } else 693263671e69SMatthias Ringwald #endif 693363671e69SMatthias Ringwald { 69344856283bSMatthias Ringwald hci_send_cmd(&hci_le_set_scan_enable, 1, hci_stack->le_scan_filter_duplicates); 693563671e69SMatthias Ringwald } 693629c24bebSMatthias Ringwald return true; 693729c24bebSMatthias Ringwald } 693829c24bebSMatthias Ringwald #endif 693929c24bebSMatthias Ringwald 694013eb2a2eSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 6941af64f147SMatthias Ringwald // re-start connecting 6942af64f147SMatthias Ringwald if ( (hci_stack->le_connecting_state == LE_CONNECTING_IDLE) && (hci_stack->le_connecting_request == LE_CONNECTING_WHITELIST)){ 69439956955bSMatthias Ringwald bd_addr_t null_addr; 69449956955bSMatthias Ringwald memset(null_addr, 0, 6); 69456bcfa632SMatthias Ringwald hci_stack->le_connection_own_addr_type = hci_stack->le_own_addr_type; 69466bcfa632SMatthias Ringwald hci_get_own_address_for_addr_type(hci_stack->le_connection_own_addr_type, hci_stack->le_connection_own_address); 69476f34e9d6SMatthias Ringwald hci_send_le_create_connection(1, 0, null_addr); 6948f30077b7SMatthias Ringwald return true; 69499956955bSMatthias Ringwald } 69504bafedd5SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 69514bafedd5SMatthias Ringwald if (hci_stack->le_periodic_sync_state == LE_CONNECTING_IDLE){ 69524bafedd5SMatthias Ringwald switch(hci_stack->le_periodic_sync_request){ 69534bafedd5SMatthias Ringwald case LE_CONNECTING_DIRECT: 69544bafedd5SMatthias Ringwald case LE_CONNECTING_WHITELIST: 69554bafedd5SMatthias Ringwald hci_stack->le_periodic_sync_state = ((hci_stack->le_periodic_sync_options & 1) != 0) ? LE_CONNECTING_WHITELIST : LE_CONNECTING_DIRECT; 69564bafedd5SMatthias Ringwald hci_send_cmd(&hci_le_periodic_advertising_create_sync, 69574bafedd5SMatthias Ringwald hci_stack->le_periodic_sync_options, 69584bafedd5SMatthias Ringwald hci_stack->le_periodic_sync_advertising_sid, 69594bafedd5SMatthias Ringwald hci_stack->le_periodic_sync_advertiser_address_type, 69604bafedd5SMatthias Ringwald hci_stack->le_periodic_sync_advertiser_address, 69614bafedd5SMatthias Ringwald hci_stack->le_periodic_sync_skip, 69624bafedd5SMatthias Ringwald hci_stack->le_periodic_sync_timeout, 69634bafedd5SMatthias Ringwald hci_stack->le_periodic_sync_cte_type); 69644bafedd5SMatthias Ringwald return true; 69654bafedd5SMatthias Ringwald default: 69664bafedd5SMatthias Ringwald break; 69674bafedd5SMatthias Ringwald } 69684bafedd5SMatthias Ringwald } 69694bafedd5SMatthias Ringwald #endif 6970d70217a2SMatthias Ringwald #endif 6971a41310b7SMatthias Ringwald 6972a41310b7SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 6973a41310b7SMatthias Ringwald // re-start advertising 6974935aa76eSMatthias Ringwald if (hci_stack->le_advertisements_enabled_for_current_roles && ((hci_stack->le_advertisements_state & LE_ADVERTISEMENT_STATE_ACTIVE) == 0)){ 6975a41310b7SMatthias Ringwald // check if advertisements should be enabled given 6976935aa76eSMatthias Ringwald hci_stack->le_advertisements_state |= LE_ADVERTISEMENT_STATE_ACTIVE; 6977b892db1cSMatthias Ringwald hci_get_own_address_for_addr_type(hci_stack->le_advertisements_own_addr_type, hci_stack->le_advertisements_own_address); 6978e464cd48SMatthias Ringwald 6979e464cd48SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 698022f987e4SMatthias Ringwald if (hci_le_extended_advertising_supported()){ 6981e464cd48SMatthias Ringwald const uint8_t advertising_handles[] = { 0 }; 6982e464cd48SMatthias Ringwald const uint16_t durations[] = { 0 }; 6983e464cd48SMatthias Ringwald const uint16_t max_events[] = { 0 }; 6984e464cd48SMatthias Ringwald hci_send_cmd(&hci_le_set_extended_advertising_enable, 1, 1, advertising_handles, durations, max_events); 6985e464cd48SMatthias Ringwald } else 6986e464cd48SMatthias Ringwald #endif 6987e464cd48SMatthias Ringwald { 6988a41310b7SMatthias Ringwald hci_send_cmd(&hci_le_set_advertise_enable, 1); 6989e464cd48SMatthias Ringwald } 6990a41310b7SMatthias Ringwald return true; 6991a41310b7SMatthias Ringwald } 6992be7ef9d8SMatthias Ringwald 6993be7ef9d8SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 699422f987e4SMatthias Ringwald if (hci_le_extended_advertising_supported()) { 6995be7ef9d8SMatthias Ringwald btstack_linked_list_iterator_t it; 6996be7ef9d8SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->le_advertising_sets); 6997be7ef9d8SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)) { 6998be7ef9d8SMatthias Ringwald le_advertising_set_t *advertising_set = (le_advertising_set_t *) btstack_linked_list_iterator_next(&it); 6999be7ef9d8SMatthias Ringwald if (((advertising_set->state & LE_ADVERTISEMENT_STATE_ENABLED) != 0) && ((advertising_set->state & LE_ADVERTISEMENT_STATE_ACTIVE) == 0)){ 70008caa405cSMatthias Ringwald advertising_set->state |= LE_ADVERTISEMENT_STATE_ACTIVE; 7001be7ef9d8SMatthias Ringwald const uint8_t advertising_handles[] = { advertising_set->advertising_handle }; 7002be7ef9d8SMatthias Ringwald const uint16_t durations[] = { advertising_set->enable_timeout }; 7003be7ef9d8SMatthias Ringwald const uint16_t max_events[] = { advertising_set->enable_max_scan_events }; 7004be7ef9d8SMatthias Ringwald hci_send_cmd(&hci_le_set_extended_advertising_enable, 1, 1, advertising_handles, durations, max_events); 7005be7ef9d8SMatthias Ringwald return true; 7006be7ef9d8SMatthias Ringwald } 7007c814a904SMatthias Ringwald #ifdef ENABLE_LE_PERIODIC_ADVERTISING 700853f240c0SMatthias Ringwald if (((advertising_set->state & LE_ADVERTISEMENT_STATE_PERIODIC_ENABLED) != 0) && ((advertising_set->state & LE_ADVERTISEMENT_STATE_PERIODIC_ACTIVE) == 0)){ 700953f240c0SMatthias Ringwald advertising_set->state |= LE_ADVERTISEMENT_STATE_PERIODIC_ACTIVE; 701053f240c0SMatthias Ringwald uint8_t enable = 1; 701153f240c0SMatthias Ringwald if (advertising_set->periodic_include_adi){ 701253f240c0SMatthias Ringwald enable |= 2; 701353f240c0SMatthias Ringwald } 701453f240c0SMatthias Ringwald hci_send_cmd(&hci_le_set_periodic_advertising_enable, enable, advertising_set->advertising_handle); 701553f240c0SMatthias Ringwald return true; 701653f240c0SMatthias Ringwald } 7017c814a904SMatthias Ringwald #endif /* ENABLE_LE_PERIODIC_ADVERTISING */ 7018be7ef9d8SMatthias Ringwald } 7019be7ef9d8SMatthias Ringwald } 7020be7ef9d8SMatthias Ringwald #endif 7021a41310b7SMatthias Ringwald #endif 7022a41310b7SMatthias Ringwald 7023f30077b7SMatthias Ringwald return false; 70247bdc6798S[email protected] } 70257aa35f6aSMatthias Ringwald 70267aa35f6aSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS 70277aa35f6aSMatthias Ringwald static bool hci_run_iso_tasks(void){ 70287aa35f6aSMatthias Ringwald btstack_linked_list_iterator_t it; 70292a6c0f82SMatthias Ringwald 703026b93350SMatthias Ringwald if (hci_stack->iso_active_operation_type != HCI_ISO_TYPE_INVALID) { 703140f86dfdSMatthias Ringwald return false; 703240f86dfdSMatthias Ringwald } 703340f86dfdSMatthias Ringwald 70342a6c0f82SMatthias Ringwald // BIG 70357aa35f6aSMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->le_audio_bigs); 70367aa35f6aSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 70377aa35f6aSMatthias Ringwald le_audio_big_t * big = (le_audio_big_t *) btstack_linked_list_iterator_next(&it); 70387aa35f6aSMatthias Ringwald switch (big->state){ 70397aa35f6aSMatthias Ringwald case LE_AUDIO_BIG_STATE_CREATE: 704040f86dfdSMatthias Ringwald hci_stack->iso_active_operation_group_id = big->params->big_handle; 704140f86dfdSMatthias Ringwald hci_stack->iso_active_operation_type = HCI_ISO_TYPE_BIS; 70427aa35f6aSMatthias Ringwald big->state = LE_AUDIO_BIG_STATE_W4_ESTABLISHED; 70437aa35f6aSMatthias Ringwald hci_send_cmd(&hci_le_create_big, 70447aa35f6aSMatthias Ringwald big->params->big_handle, 70457aa35f6aSMatthias Ringwald big->params->advertising_handle, 70467aa35f6aSMatthias Ringwald big->params->num_bis, 70477aa35f6aSMatthias Ringwald big->params->sdu_interval_us, 70487aa35f6aSMatthias Ringwald big->params->max_sdu, 70497aa35f6aSMatthias Ringwald big->params->max_transport_latency_ms, 70507aa35f6aSMatthias Ringwald big->params->rtn, 70517aa35f6aSMatthias Ringwald big->params->phy, 70527aa35f6aSMatthias Ringwald big->params->packing, 70537aa35f6aSMatthias Ringwald big->params->framing, 70547aa35f6aSMatthias Ringwald big->params->encryption, 70557aa35f6aSMatthias Ringwald big->params->broadcast_code); 70567aa35f6aSMatthias Ringwald return true; 70577aa35f6aSMatthias Ringwald case LE_AUDIO_BIG_STATE_SETUP_ISO_PATH: 70587aa35f6aSMatthias Ringwald big->state = LE_AUDIO_BIG_STATE_W4_SETUP_ISO_PATH; 705985dc435bSDirk 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); 70607aa35f6aSMatthias Ringwald return true; 70617aa35f6aSMatthias Ringwald case LE_AUDIO_BIG_STATE_SETUP_ISO_PATHS_FAILED: 70627aa35f6aSMatthias Ringwald big->state = LE_AUDIO_BIG_STATE_W4_TERMINATED_AFTER_SETUP_FAILED; 70632a6c0f82SMatthias Ringwald hci_send_cmd(&hci_le_terminate_big, big->big_handle, big->state_vars.status); 7064c1f83111SMatthias Ringwald return true; 70657aa35f6aSMatthias Ringwald case LE_AUDIO_BIG_STATE_TERMINATE: 70667aa35f6aSMatthias Ringwald big->state = LE_AUDIO_BIG_STATE_W4_TERMINATED; 7067d1620e55SMatthias Ringwald hci_send_cmd(&hci_le_terminate_big, big->big_handle, ERROR_CODE_REMOTE_USER_TERMINATED_CONNECTION); 70687aa35f6aSMatthias Ringwald return true; 70697aa35f6aSMatthias Ringwald default: 70707aa35f6aSMatthias Ringwald break; 70717aa35f6aSMatthias Ringwald } 70727aa35f6aSMatthias Ringwald } 70732a6c0f82SMatthias Ringwald 70742a6c0f82SMatthias Ringwald // BIG Sync 70752a6c0f82SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->le_audio_big_syncs); 70762a6c0f82SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 70772a6c0f82SMatthias Ringwald le_audio_big_sync_t * big_sync = (le_audio_big_sync_t *) btstack_linked_list_iterator_next(&it); 70782a6c0f82SMatthias Ringwald switch (big_sync->state){ 70792a6c0f82SMatthias Ringwald case LE_AUDIO_BIG_STATE_CREATE: 708040f86dfdSMatthias Ringwald hci_stack->iso_active_operation_group_id = big_sync->params->big_handle; 708140f86dfdSMatthias Ringwald hci_stack->iso_active_operation_type = HCI_ISO_TYPE_BIS; 70822a6c0f82SMatthias Ringwald big_sync->state = LE_AUDIO_BIG_STATE_W4_ESTABLISHED; 70832a6c0f82SMatthias Ringwald hci_send_cmd(&hci_le_big_create_sync, 70842a6c0f82SMatthias Ringwald big_sync->params->big_handle, 70852a6c0f82SMatthias Ringwald big_sync->params->sync_handle, 70862a6c0f82SMatthias Ringwald big_sync->params->encryption, 70872a6c0f82SMatthias Ringwald big_sync->params->broadcast_code, 70882a6c0f82SMatthias Ringwald big_sync->params->mse, 70892a6c0f82SMatthias Ringwald big_sync->params->big_sync_timeout_10ms, 70902a6c0f82SMatthias Ringwald big_sync->params->num_bis, 70912a6c0f82SMatthias Ringwald big_sync->params->bis_indices); 70922a6c0f82SMatthias Ringwald return true; 70932a6c0f82SMatthias Ringwald case LE_AUDIO_BIG_STATE_SETUP_ISO_PATH: 70942a6c0f82SMatthias Ringwald big_sync->state = LE_AUDIO_BIG_STATE_W4_SETUP_ISO_PATH; 709585dc435bSDirk 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); 70962a6c0f82SMatthias Ringwald return true; 70972a6c0f82SMatthias Ringwald case LE_AUDIO_BIG_STATE_SETUP_ISO_PATHS_FAILED: 70982a6c0f82SMatthias Ringwald big_sync->state = LE_AUDIO_BIG_STATE_W4_TERMINATED_AFTER_SETUP_FAILED; 70992a6c0f82SMatthias Ringwald hci_send_cmd(&hci_le_big_terminate_sync, big_sync->big_handle); 7100c1f83111SMatthias Ringwald return true; 71012a6c0f82SMatthias Ringwald case LE_AUDIO_BIG_STATE_TERMINATE: 71022a6c0f82SMatthias Ringwald big_sync->state = LE_AUDIO_BIG_STATE_W4_TERMINATED; 71032a6c0f82SMatthias Ringwald hci_send_cmd(&hci_le_big_terminate_sync, big_sync->big_handle); 71042a6c0f82SMatthias Ringwald return true; 71052a6c0f82SMatthias Ringwald default: 71062a6c0f82SMatthias Ringwald break; 71072a6c0f82SMatthias Ringwald } 71082a6c0f82SMatthias Ringwald } 71092a6c0f82SMatthias Ringwald 7110d3a89d91SMatthias Ringwald // CIG 7111d90722d4SMatthias Ringwald bool cig_active; 7112d3a89d91SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->le_audio_cigs); 7113d3a89d91SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)) { 7114d3a89d91SMatthias Ringwald le_audio_cig_t *cig = (le_audio_cig_t *) btstack_linked_list_iterator_next(&it); 7115d3a89d91SMatthias Ringwald uint8_t i; 7116444e371eSMatthias Ringwald // Set CIG Parameters 7117d3a89d91SMatthias Ringwald uint8_t cis_id[MAX_NR_CIS]; 7118d3a89d91SMatthias Ringwald uint16_t max_sdu_c_to_p[MAX_NR_CIS]; 7119d3a89d91SMatthias Ringwald uint16_t max_sdu_p_to_c[MAX_NR_CIS]; 7120d3a89d91SMatthias Ringwald uint8_t phy_c_to_p[MAX_NR_CIS]; 7121d3a89d91SMatthias Ringwald uint8_t phy_p_to_c[MAX_NR_CIS]; 7122d3a89d91SMatthias Ringwald uint8_t rtn_c_to_p[MAX_NR_CIS]; 7123d3a89d91SMatthias Ringwald uint8_t rtn_p_to_c[MAX_NR_CIS]; 7124d3a89d91SMatthias Ringwald switch (cig->state) { 7125d3a89d91SMatthias Ringwald case LE_AUDIO_CIG_STATE_CREATE: 7126d3a89d91SMatthias Ringwald hci_stack->iso_active_operation_group_id = cig->params->cig_id; 7127d3a89d91SMatthias Ringwald hci_stack->iso_active_operation_type = HCI_ISO_TYPE_CIS; 7128d3a89d91SMatthias Ringwald cig->state = LE_AUDIO_CIG_STATE_W4_ESTABLISHED; 7129d3a89d91SMatthias Ringwald le_audio_cig_params_t * params = cig->params; 7130d3a89d91SMatthias Ringwald for (i = 0; i < params->num_cis; i++) { 7131d3a89d91SMatthias Ringwald le_audio_cis_params_t * cis_params = &cig->params->cis_params[i]; 7132d3a89d91SMatthias Ringwald cis_id[i] = cis_params->cis_id; 7133d3a89d91SMatthias Ringwald max_sdu_c_to_p[i] = cis_params->max_sdu_c_to_p; 7134d3a89d91SMatthias Ringwald max_sdu_p_to_c[i] = cis_params->max_sdu_p_to_c; 7135d3a89d91SMatthias Ringwald phy_c_to_p[i] = cis_params->phy_c_to_p; 7136d3a89d91SMatthias Ringwald phy_p_to_c[i] = cis_params->phy_p_to_c; 7137d3a89d91SMatthias Ringwald rtn_c_to_p[i] = cis_params->rtn_c_to_p; 7138d3a89d91SMatthias Ringwald rtn_p_to_c[i] = cis_params->rtn_p_to_c; 7139d3a89d91SMatthias Ringwald } 7140d3a89d91SMatthias Ringwald hci_send_cmd(&hci_le_set_cig_parameters, 7141d3a89d91SMatthias Ringwald cig->cig_id, 7142d3a89d91SMatthias Ringwald params->sdu_interval_c_to_p, 7143d3a89d91SMatthias Ringwald params->sdu_interval_p_to_c, 7144d3a89d91SMatthias Ringwald params->worst_case_sca, 7145d3a89d91SMatthias Ringwald params->packing, 7146d3a89d91SMatthias Ringwald params->framing, 7147d3a89d91SMatthias Ringwald params->max_transport_latency_c_to_p, 7148d3a89d91SMatthias Ringwald params->max_transport_latency_p_to_c, 7149d3a89d91SMatthias Ringwald params->num_cis, 7150d3a89d91SMatthias Ringwald cis_id, 7151d3a89d91SMatthias Ringwald max_sdu_c_to_p, 7152d3a89d91SMatthias Ringwald max_sdu_p_to_c, 7153d3a89d91SMatthias Ringwald phy_c_to_p, 7154d3a89d91SMatthias Ringwald phy_p_to_c, 7155d3a89d91SMatthias Ringwald rtn_c_to_p, 7156d3a89d91SMatthias Ringwald rtn_p_to_c 7157d3a89d91SMatthias Ringwald ); 7158bb42b5c0SMatthias Ringwald return true; 7159444e371eSMatthias Ringwald case LE_AUDIO_CIG_STATE_CREATE_CIS: 7160bb42b5c0SMatthias Ringwald hci_stack->iso_active_operation_group_id = cig->params->cig_id; 7161bb42b5c0SMatthias Ringwald hci_stack->iso_active_operation_type = HCI_ISO_TYPE_CIS; 7162444e371eSMatthias Ringwald cig->state = LE_AUDIO_CIG_STATE_W4_CREATE_CIS; 71633abcd16cSMatthias Ringwald for (i=0;i<cig->num_cis;i++){ 71643abcd16cSMatthias Ringwald cig->cis_setup_active[i] = true; 71653abcd16cSMatthias Ringwald } 7166444e371eSMatthias Ringwald hci_send_cmd(&hci_le_create_cis, cig->num_cis, cig->cis_con_handles, cig->acl_con_handles); 7167bb42b5c0SMatthias Ringwald return true; 7168f9306a1aSMatthias Ringwald case LE_AUDIO_CIG_STATE_SETUP_ISO_PATH: 7169c5f5d706SMatthias Ringwald for ( ; cig->state_vars.next_cis < (cig->num_cis * 2) ; cig->state_vars.next_cis++ ){ 7170f9306a1aSMatthias Ringwald // find next path to setup 7171f9306a1aSMatthias Ringwald uint8_t cis_index = cig->state_vars.next_cis >> 1; 7172f9306a1aSMatthias Ringwald if (cig->cis_established[cis_index] == false) { 7173f9306a1aSMatthias Ringwald continue; 7174f9306a1aSMatthias Ringwald } 7175f9306a1aSMatthias Ringwald uint8_t cis_direction = cig->state_vars.next_cis & 1; 7176f9306a1aSMatthias Ringwald bool setup = true; 71778e58e4f7SMatthias Ringwald if (cis_direction == 0){ 7178f9306a1aSMatthias Ringwald // 0 - input - host to controller 7179f9306a1aSMatthias Ringwald // we are central => central to peripheral 7180f9306a1aSMatthias Ringwald setup &= cig->params->cis_params[cis_index].max_sdu_c_to_p > 0; 7181f9306a1aSMatthias Ringwald } else { 7182f9306a1aSMatthias Ringwald // 1 - output - controller to host 7183f9306a1aSMatthias Ringwald // we are central => peripheral to central 7184f9306a1aSMatthias Ringwald setup &= cig->params->cis_params[cis_index].max_sdu_p_to_c > 0; 7185f9306a1aSMatthias Ringwald } 7186f9306a1aSMatthias Ringwald if (setup){ 7187f9306a1aSMatthias Ringwald hci_stack->iso_active_operation_group_id = cig->params->cig_id; 7188f9306a1aSMatthias Ringwald hci_stack->iso_active_operation_type = HCI_ISO_TYPE_CIS; 7189f9306a1aSMatthias Ringwald cig->state = LE_AUDIO_CIG_STATE_W4_SETUP_ISO_PATH; 719085dc435bSDirk 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); 7191f9306a1aSMatthias Ringwald return true; 7192f9306a1aSMatthias Ringwald } 7193f9306a1aSMatthias Ringwald } 7194f9306a1aSMatthias Ringwald cig->state = LE_AUDIO_CIG_STATE_ACTIVE; 7195d90722d4SMatthias Ringwald break; 7196d90722d4SMatthias Ringwald case LE_AUDIO_CIG_STATE_REMOVE: 7197d90722d4SMatthias Ringwald // check if CIG Active 7198d90722d4SMatthias Ringwald cig_active = false; 7199d90722d4SMatthias Ringwald for (i = 0; i < cig->num_cis; i++) { 7200d90722d4SMatthias Ringwald if (cig->cis_con_handles[i] != HCI_CON_HANDLE_INVALID){ 7201d90722d4SMatthias Ringwald hci_iso_stream_t * stream = hci_iso_stream_for_con_handle(cig->cis_con_handles[i]); 7202d90722d4SMatthias Ringwald if (stream != NULL){ 7203d90722d4SMatthias Ringwald cig_active = true; 7204d90722d4SMatthias Ringwald break; 7205d90722d4SMatthias Ringwald } 7206d90722d4SMatthias Ringwald } 7207d90722d4SMatthias Ringwald } 7208d90722d4SMatthias Ringwald if (cig_active == false){ 7209d90722d4SMatthias Ringwald btstack_linked_list_iterator_remove(&it); 7210d90722d4SMatthias Ringwald hci_send_cmd(&hci_le_remove_cig, cig->cig_id); 7211d90722d4SMatthias Ringwald return true; 7212d90722d4SMatthias Ringwald } 7213d3a89d91SMatthias Ringwald default: 7214d3a89d91SMatthias Ringwald break; 7215d3a89d91SMatthias Ringwald } 7216d3a89d91SMatthias Ringwald } 7217d3a89d91SMatthias Ringwald 7218d90722d4SMatthias Ringwald // CIS Accept/Reject/Setup ISO Path/Close 721926b93350SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->iso_streams); 722026b93350SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)) { 722126b93350SMatthias Ringwald hci_iso_stream_t *iso_stream = (hci_iso_stream_t *) btstack_linked_list_iterator_next(&it); 722226b93350SMatthias Ringwald hci_con_handle_t con_handle; 722326b93350SMatthias Ringwald switch (iso_stream->state){ 722426b93350SMatthias Ringwald case HCI_ISO_STREAM_W2_ACCEPT: 722526b93350SMatthias Ringwald iso_stream->state = HCI_ISO_STREAM_STATE_W4_ESTABLISHED; 722626b93350SMatthias Ringwald hci_stack->iso_active_operation_type = HCI_ISO_TYPE_CIS; 722726b93350SMatthias Ringwald hci_stack->iso_active_operation_group_id = HCI_ISO_GROUP_ID_SINGLE_CIS; 7228969d876aSMatthias Ringwald hci_send_cmd(&hci_le_accept_cis_request, iso_stream->cis_handle); 722926b93350SMatthias Ringwald return true; 723026b93350SMatthias Ringwald case HCI_ISO_STREAM_W2_REJECT: 7231969d876aSMatthias Ringwald con_handle = iso_stream->cis_handle; 723226b93350SMatthias Ringwald hci_stack->iso_active_operation_type = HCI_ISO_TYPE_CIS; 723326b93350SMatthias Ringwald hci_stack->iso_active_operation_group_id = HCI_ISO_GROUP_ID_SINGLE_CIS; 723426b93350SMatthias Ringwald hci_iso_stream_finalize(iso_stream); 723526b93350SMatthias Ringwald hci_send_cmd(&hci_le_reject_cis_request, con_handle, ERROR_CODE_REMOTE_DEVICE_TERMINATED_CONNECTION_DUE_TO_LOW_RESOURCES); 723626b93350SMatthias Ringwald return true; 723726b93350SMatthias Ringwald case HCI_ISO_STREAM_STATE_W2_SETUP_ISO_INPUT: 723826b93350SMatthias Ringwald hci_stack->iso_active_operation_group_id = HCI_ISO_GROUP_ID_SINGLE_CIS; 723926b93350SMatthias Ringwald hci_stack->iso_active_operation_type = HCI_ISO_TYPE_CIS; 724026b93350SMatthias Ringwald iso_stream->state = HCI_ISO_STREAM_STATE_W4_ISO_SETUP_INPUT; 724185dc435bSDirk 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); 724207e32b36SMatthias Ringwald return true; 724326b93350SMatthias Ringwald case HCI_ISO_STREAM_STATE_W2_SETUP_ISO_OUTPUT: 724426b93350SMatthias Ringwald hci_stack->iso_active_operation_group_id = HCI_ISO_GROUP_ID_SINGLE_CIS; 724526b93350SMatthias Ringwald hci_stack->iso_active_operation_type = HCI_ISO_TYPE_CIS; 724626b93350SMatthias Ringwald iso_stream->state = HCI_ISO_STREAM_STATE_W4_ISO_SETUP_OUTPUT; 724785dc435bSDirk 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); 724807e32b36SMatthias Ringwald return true; 7249d90722d4SMatthias Ringwald case HCI_ISO_STREAM_STATE_W2_CLOSE: 7250d90722d4SMatthias Ringwald iso_stream->state = HCI_ISO_STREAM_STATE_W4_DISCONNECTED; 725107e32b36SMatthias Ringwald hci_send_cmd(&hci_disconnect, iso_stream->cis_handle, ERROR_CODE_REMOTE_USER_TERMINATED_CONNECTION); 725207e32b36SMatthias Ringwald return true; 725326b93350SMatthias Ringwald default: 725426b93350SMatthias Ringwald break; 725526b93350SMatthias Ringwald } 725626b93350SMatthias Ringwald } 725726b93350SMatthias Ringwald 72587aa35f6aSMatthias Ringwald return false; 72597aa35f6aSMatthias Ringwald } 72607aa35f6aSMatthias Ringwald #endif /* ENABLE_LE_ISOCHRONOUS_STREAMS */ 7261b2f949feS[email protected] #endif 72627bdc6798S[email protected] 726388a03c8dSMatthias Ringwald static bool hci_run_general_pending_commands(void){ 7264f30077b7SMatthias Ringwald btstack_linked_item_t * it; 7265a0da043fSMatthias Ringwald for (it = (btstack_linked_item_t *) hci_stack->connections; it != NULL; it = it->next){ 726605ae8de3SMatthias Ringwald hci_connection_t * connection = (hci_connection_t *) it; 726732ab9390Smatthias.ringwald 72680bf6344aS[email protected] switch(connection->state){ 72690bf6344aS[email protected] case SEND_CREATE_CONNECTION: 72704f3229d8S[email protected] switch(connection->address_type){ 727135454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 7272f16129ceSMatthias Ringwald case BD_ADDR_TYPE_ACL: 72739da54300S[email protected] log_info("sending hci_create_connection"); 7274b4eb4420SMatthias Ringwald hci_send_cmd(&hci_create_connection, connection->address, hci_usable_acl_packet_types(), 0, 0, 0, hci_stack->allow_role_switch); 72754f3229d8S[email protected] break; 727635454696SMatthias Ringwald #endif 72774f3229d8S[email protected] default: 7278a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE 7279d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 72809da54300S[email protected] log_info("sending hci_le_create_connection"); 72816bcfa632SMatthias Ringwald hci_stack->le_connection_own_addr_type = hci_stack->le_own_addr_type; 72826bcfa632SMatthias Ringwald hci_get_own_address_for_addr_type(hci_stack->le_connection_own_addr_type, hci_stack->le_connection_own_address); 7283f346015eSMatthias Ringwald hci_send_le_create_connection(0, connection->address_type, connection->address); 72844f3229d8S[email protected] connection->state = SENT_CREATE_CONNECTION; 7285b2f949feS[email protected] #endif 7286d70217a2SMatthias Ringwald #endif 72874f3229d8S[email protected] break; 72884f3229d8S[email protected] } 7289f30077b7SMatthias Ringwald return true; 7290ad83dc6aS[email protected] 729135454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 72920bf6344aS[email protected] case RECEIVED_CONNECTION_REQUEST: 7293f16129ceSMatthias Ringwald if (connection->address_type == BD_ADDR_TYPE_ACL){ 729476ccfb2aSMatthias Ringwald log_info("sending hci_accept_connection_request"); 7295895f6685SMilanka Ringwald connection->state = ACCEPTED_CONNECTION_REQUEST; 7296c4c88f1bSJakob Krantz hci_send_cmd(&hci_accept_connection_request, connection->address, hci_stack->master_slave_policy); 7297f30077b7SMatthias Ringwald return true; 7298ee025741SMatthias Ringwald } 7299ee025741SMatthias Ringwald break; 730035454696SMatthias Ringwald #endif 73010bf6344aS[email protected] case SEND_DISCONNECT: 73020bf6344aS[email protected] connection->state = SENT_DISCONNECT; 73036ef3696aSMatthias Ringwald hci_send_cmd(&hci_disconnect, connection->con_handle, ERROR_CODE_REMOTE_USER_TERMINATED_CONNECTION); 7304f30077b7SMatthias Ringwald return true; 73050bf6344aS[email protected] 73060bf6344aS[email protected] default: 73070bf6344aS[email protected] break; 7308c7e0c5f6Smatthias.ringwald } 7309c7e0c5f6Smatthias.ringwald 7310cabf004eSMatthias Ringwald // no further commands if connection is about to get shut down 7311cabf004eSMatthias Ringwald if (connection->state == SENT_DISCONNECT) continue; 7312cabf004eSMatthias Ringwald 731394418890SMatthias Ringwald #ifdef ENABLE_CLASSIC 731494418890SMatthias Ringwald 7315ad20f0c8SMatthias Ringwald // Handling link key request requires remote supported features 731650f49832SMatthias Ringwald if (((connection->authentication_flags & AUTH_FLAG_HANDLE_LINK_KEY_REQUEST) != 0)){ 7317608f51bbSMatthias Ringwald log_info("responding to link key request, have link key db: %u", hci_stack->link_key_db != NULL); 73188daf94bcSMatthias Ringwald connectionClearAuthenticationFlags(connection, AUTH_FLAG_HANDLE_LINK_KEY_REQUEST); 731930e72d78SMatthias Ringwald 7320e9f98c4aSMatthias Ringwald bool have_link_key = connection->link_key_type != INVALID_LINK_KEY; 7321e9f98c4aSMatthias Ringwald bool security_level_sufficient = have_link_key && (gap_security_level_for_link_key_type(connection->link_key_type) >= connection->requested_security_level); 732230e72d78SMatthias Ringwald if (have_link_key && security_level_sufficient){ 7323e9f98c4aSMatthias Ringwald hci_send_cmd(&hci_link_key_request_reply, connection->address, &connection->link_key); 732432ab9390Smatthias.ringwald } else { 732532ab9390Smatthias.ringwald hci_send_cmd(&hci_link_key_request_negative_reply, connection->address); 732632ab9390Smatthias.ringwald } 7327f30077b7SMatthias Ringwald return true; 732832ab9390Smatthias.ringwald } 73291d6b20aeS[email protected] 73308daf94bcSMatthias Ringwald if (connection->authentication_flags & AUTH_FLAG_DENY_PIN_CODE_REQUEST){ 73319da54300S[email protected] log_info("denying to pin request"); 73328daf94bcSMatthias Ringwald connectionClearAuthenticationFlags(connection, AUTH_FLAG_DENY_PIN_CODE_REQUEST); 733334d2123cS[email protected] hci_send_cmd(&hci_pin_code_request_negative_reply, connection->address); 7334f30077b7SMatthias Ringwald return true; 73354c57c146S[email protected] } 73364c57c146S[email protected] 7337c950c316SMatthias Ringwald // security assessment requires remote features 73382dd8985bSMatthias Ringwald if ((connection->authentication_flags & AUTH_FLAG_RECV_IO_CAPABILITIES_REQUEST) != 0){ 7339c950c316SMatthias Ringwald connectionClearAuthenticationFlags(connection, AUTH_FLAG_RECV_IO_CAPABILITIES_REQUEST); 7340c950c316SMatthias Ringwald hci_ssp_assess_security_on_io_cap_request(connection); 7341c950c316SMatthias 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 7342c950c316SMatthias Ringwald } 7343c950c316SMatthias Ringwald 73448daf94bcSMatthias Ringwald if (connection->authentication_flags & AUTH_FLAG_SEND_IO_CAPABILITIES_REPLY){ 73458daf94bcSMatthias Ringwald connectionClearAuthenticationFlags(connection, AUTH_FLAG_SEND_IO_CAPABILITIES_REPLY); 7346a8d20135SMatthias Ringwald // set authentication requirements: 7347a8d20135SMatthias Ringwald // - MITM = ssp_authentication_requirement (USER) | requested_security_level (dynamic) 7348532454f9SMatthias Ringwald // - BONDING MODE: dedicated if requested, bondable otherwise. Drop bondable if not set for remote 7349cb912b12SMatthias Ringwald connection->io_cap_request_auth_req = hci_stack->ssp_authentication_requirement & 1; 73509faad3abS[email protected] if (gap_mitm_protection_required_for_security_level(connection->requested_security_level)){ 7351cb912b12SMatthias Ringwald connection->io_cap_request_auth_req |= 1; 7352106d6d11S[email protected] } 7353532454f9SMatthias Ringwald bool bonding = hci_stack->bondable; 73548daf94bcSMatthias Ringwald if (connection->authentication_flags & AUTH_FLAG_RECV_IO_CAPABILITIES_RESPONSE){ 7355532454f9SMatthias Ringwald // if we have received IO Cap Response, we're in responder role 7356532454f9SMatthias Ringwald bool remote_bonding = connection->io_cap_response_auth_req >= SSP_IO_AUTHREQ_MITM_PROTECTION_NOT_REQUIRED_DEDICATED_BONDING; 7357532454f9SMatthias Ringwald if (bonding && !remote_bonding){ 7358532454f9SMatthias Ringwald log_info("Remote not bonding, dropping local flag"); 7359532454f9SMatthias Ringwald bonding = false; 7360532454f9SMatthias Ringwald } 7361532454f9SMatthias Ringwald } 7362532454f9SMatthias Ringwald if (bonding){ 7363a8d20135SMatthias Ringwald if (connection->bonding_flags & BONDING_DEDICATED){ 7364cb912b12SMatthias Ringwald connection->io_cap_request_auth_req |= SSP_IO_AUTHREQ_MITM_PROTECTION_NOT_REQUIRED_DEDICATED_BONDING; 7365532454f9SMatthias Ringwald } else { 7366cb912b12SMatthias Ringwald connection->io_cap_request_auth_req |= SSP_IO_AUTHREQ_MITM_PROTECTION_NOT_REQUIRED_GENERAL_BONDING; 7367a8d20135SMatthias Ringwald } 7368532454f9SMatthias Ringwald } 73691849becdSMatthias Ringwald uint8_t have_oob_data = 0; 73701849becdSMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB 73711849becdSMatthias Ringwald if (connection->classic_oob_c_192 != NULL){ 73721849becdSMatthias Ringwald have_oob_data |= 1; 73731849becdSMatthias Ringwald } 73741849becdSMatthias Ringwald if (connection->classic_oob_c_256 != NULL){ 73751849becdSMatthias Ringwald have_oob_data |= 2; 73761849becdSMatthias Ringwald } 73771849becdSMatthias Ringwald #endif 7378cb912b12SMatthias Ringwald hci_send_cmd(&hci_io_capability_request_reply, &connection->address, hci_stack->ssp_io_capability, have_oob_data, connection->io_cap_request_auth_req); 737911b03efaSMatthias Ringwald return true; 7380f8fb5f6eS[email protected] } 738111b03efaSMatthias Ringwald 73828daf94bcSMatthias Ringwald if (connection->authentication_flags & AUTH_FLAG_SEND_IO_CAPABILITIES_NEGATIVE_REPLY) { 73838daf94bcSMatthias Ringwald connectionClearAuthenticationFlags(connection, AUTH_FLAG_SEND_IO_CAPABILITIES_NEGATIVE_REPLY); 738411b03efaSMatthias Ringwald hci_send_cmd(&hci_io_capability_request_negative_reply, &connection->address, ERROR_CODE_PAIRING_NOT_ALLOWED); 7385f30077b7SMatthias Ringwald return true; 738632ab9390Smatthias.ringwald } 738732ab9390Smatthias.ringwald 73881849becdSMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB 73897ca4a7edSMatthias Ringwald if (connection->authentication_flags & AUTH_FLAG_SEND_REMOTE_OOB_DATA_REPLY){ 73907ca4a7edSMatthias Ringwald connectionClearAuthenticationFlags(connection, AUTH_FLAG_SEND_REMOTE_OOB_DATA_REPLY); 73911849becdSMatthias Ringwald const uint8_t zero[16] = { 0 }; 73921849becdSMatthias Ringwald const uint8_t * r_192 = zero; 73931849becdSMatthias Ringwald const uint8_t * c_192 = zero; 73941849becdSMatthias Ringwald const uint8_t * r_256 = zero; 73951849becdSMatthias Ringwald const uint8_t * c_256 = zero; 73961849becdSMatthias Ringwald // verify P-256 OOB 73971e83575aSMatthias Ringwald if ((connection->classic_oob_c_256 != NULL) && hci_command_supported(SUPPORTED_HCI_COMMAND_REMOTE_OOB_EXTENDED_DATA_REQUEST_REPLY)) { 73981849becdSMatthias Ringwald c_256 = connection->classic_oob_c_256; 73991849becdSMatthias Ringwald if (connection->classic_oob_r_256 != NULL) { 74001849becdSMatthias Ringwald r_256 = connection->classic_oob_r_256; 74011849becdSMatthias Ringwald } 74021849becdSMatthias Ringwald } 74031849becdSMatthias Ringwald // verify P-192 OOB 74041849becdSMatthias Ringwald if ((connection->classic_oob_c_192 != NULL)) { 74051849becdSMatthias Ringwald c_192 = connection->classic_oob_c_192; 74061849becdSMatthias Ringwald if (connection->classic_oob_r_192 != NULL) { 74071849becdSMatthias Ringwald r_192 = connection->classic_oob_r_192; 74081849becdSMatthias Ringwald } 74091849becdSMatthias Ringwald } 74107ca4a7edSMatthias Ringwald 74117ca4a7edSMatthias Ringwald // assess security 74127ca4a7edSMatthias Ringwald bool need_level_4 = hci_stack->gap_secure_connections_only_mode || (connection->requested_security_level == LEVEL_4); 74137ca4a7edSMatthias Ringwald bool can_reach_level_4 = hci_remote_sc_enabled(connection) && (c_256 != NULL); 74147ca4a7edSMatthias Ringwald if (need_level_4 && !can_reach_level_4){ 74157ca4a7edSMatthias Ringwald log_info("Level 4 required, but not possible -> abort"); 74167ca4a7edSMatthias Ringwald hci_pairing_complete(connection, ERROR_CODE_INSUFFICIENT_SECURITY); 74177ca4a7edSMatthias Ringwald // send oob negative reply 74187ca4a7edSMatthias Ringwald c_256 = NULL; 74197ca4a7edSMatthias Ringwald c_192 = NULL; 74207ca4a7edSMatthias Ringwald } 74217ca4a7edSMatthias Ringwald 74221849becdSMatthias Ringwald // Reply 74231849becdSMatthias Ringwald if (c_256 != zero) { 74241849becdSMatthias Ringwald hci_send_cmd(&hci_remote_oob_extended_data_request_reply, &connection->address, c_192, r_192, c_256, r_256); 74251849becdSMatthias Ringwald } else if (c_192 != zero){ 74261849becdSMatthias Ringwald hci_send_cmd(&hci_remote_oob_data_request_reply, &connection->address, c_192, r_192); 74271849becdSMatthias Ringwald } else { 74281ae74bf3SMatthias Ringwald hci_stack->classic_oob_con_handle = connection->con_handle; 74291849becdSMatthias Ringwald hci_send_cmd(&hci_remote_oob_data_request_negative_reply, &connection->address); 74301849becdSMatthias Ringwald } 74311849becdSMatthias Ringwald return true; 74321849becdSMatthias Ringwald } 74331849becdSMatthias Ringwald #endif 74341849becdSMatthias Ringwald 74358daf94bcSMatthias Ringwald if (connection->authentication_flags & AUTH_FLAG_SEND_USER_CONFIRM_REPLY){ 74368daf94bcSMatthias Ringwald connectionClearAuthenticationFlags(connection, AUTH_FLAG_SEND_USER_CONFIRM_REPLY); 743734d2123cS[email protected] hci_send_cmd(&hci_user_confirmation_request_reply, &connection->address); 7438f30077b7SMatthias Ringwald return true; 7439dbe1a790S[email protected] } 7440dbe1a790S[email protected] 7441367aedc0SMatthias Ringwald if (connection->authentication_flags & AUTH_FLAG_SEND_USER_CONFIRM_NEGATIVE_REPLY){ 7442367aedc0SMatthias Ringwald connectionClearAuthenticationFlags(connection, AUTH_FLAG_SEND_USER_CONFIRM_NEGATIVE_REPLY); 7443367aedc0SMatthias Ringwald hci_send_cmd(&hci_user_confirmation_request_negative_reply, &connection->address); 7444367aedc0SMatthias Ringwald return true; 7445367aedc0SMatthias Ringwald } 7446367aedc0SMatthias Ringwald 74478daf94bcSMatthias Ringwald if (connection->authentication_flags & AUTH_FLAG_SEND_USER_PASSKEY_REPLY){ 74488daf94bcSMatthias Ringwald connectionClearAuthenticationFlags(connection, AUTH_FLAG_SEND_USER_PASSKEY_REPLY); 744934d2123cS[email protected] hci_send_cmd(&hci_user_passkey_request_reply, &connection->address, 000000); 7450f30077b7SMatthias Ringwald return true; 7451dbe1a790S[email protected] } 7452afd4e962S[email protected] 7453ab0c69a9SMatthias Ringwald if ((connection->bonding_flags & (BONDING_DISCONNECT_DEDICATED_DONE | BONDING_DEDICATED_DEFER_DISCONNECT)) == BONDING_DISCONNECT_DEDICATED_DONE){ 7454ad83dc6aS[email protected] connection->bonding_flags &= ~BONDING_DISCONNECT_DEDICATED_DONE; 74551bd5283dS[email protected] connection->bonding_flags |= BONDING_EMIT_COMPLETE_ON_DISCONNECT; 74566ef3696aSMatthias Ringwald connection->state = SENT_DISCONNECT; 74576ef3696aSMatthias Ringwald hci_send_cmd(&hci_disconnect, connection->con_handle, ERROR_CODE_REMOTE_USER_TERMINATED_CONNECTION); 7458f30077b7SMatthias Ringwald return true; 7459ad83dc6aS[email protected] } 746076f27cffSMatthias Ringwald 74612a75353aSMatthias Ringwald if ((connection->bonding_flags & BONDING_SEND_AUTHENTICATE_REQUEST) && ((connection->bonding_flags & BONDING_RECEIVED_REMOTE_FEATURES) != 0)){ 746234d2123cS[email protected] connection->bonding_flags &= ~BONDING_SEND_AUTHENTICATE_REQUEST; 7463abdad579SMatthias Ringwald connection->bonding_flags |= BONDING_SENT_AUTHENTICATE_REQUEST; 746434d2123cS[email protected] hci_send_cmd(&hci_authentication_requested, connection->con_handle); 7465f30077b7SMatthias Ringwald return true; 7466afd4e962S[email protected] } 746776f27cffSMatthias Ringwald 7468dce78009S[email protected] if (connection->bonding_flags & BONDING_SEND_ENCRYPTION_REQUEST){ 7469dce78009S[email protected] connection->bonding_flags &= ~BONDING_SEND_ENCRYPTION_REQUEST; 7470dce78009S[email protected] hci_send_cmd(&hci_set_connection_encryption, connection->con_handle, 1); 7471f30077b7SMatthias Ringwald return true; 7472dce78009S[email protected] } 7473447016ffSMatthias Ringwald 7474573897a0SMatthias Ringwald if (connection->bonding_flags & BONDING_SEND_READ_ENCRYPTION_KEY_SIZE){ 7475573897a0SMatthias Ringwald connection->bonding_flags &= ~BONDING_SEND_READ_ENCRYPTION_KEY_SIZE; 7476573897a0SMatthias Ringwald hci_send_cmd(&hci_read_encryption_key_size, connection->con_handle, 1); 7477f30077b7SMatthias Ringwald return true; 7478573897a0SMatthias Ringwald } 7479447016ffSMatthias Ringwald 7480447016ffSMatthias Ringwald if (connection->bonding_flags & BONDING_REQUEST_REMOTE_FEATURES_PAGE_0){ 7481447016ffSMatthias Ringwald connection->bonding_flags &= ~BONDING_REQUEST_REMOTE_FEATURES_PAGE_0; 7482447016ffSMatthias Ringwald hci_send_cmd(&hci_read_remote_supported_features_command, connection->con_handle); 7483447016ffSMatthias Ringwald return true; 7484447016ffSMatthias Ringwald } 7485447016ffSMatthias Ringwald 7486447016ffSMatthias Ringwald if (connection->bonding_flags & BONDING_REQUEST_REMOTE_FEATURES_PAGE_1){ 7487447016ffSMatthias Ringwald connection->bonding_flags &= ~BONDING_REQUEST_REMOTE_FEATURES_PAGE_1; 7488447016ffSMatthias Ringwald hci_send_cmd(&hci_read_remote_extended_features_command, connection->con_handle, 1); 7489447016ffSMatthias Ringwald return true; 7490447016ffSMatthias Ringwald } 7491447016ffSMatthias Ringwald 7492447016ffSMatthias Ringwald if (connection->bonding_flags & BONDING_REQUEST_REMOTE_FEATURES_PAGE_2){ 7493447016ffSMatthias Ringwald connection->bonding_flags &= ~BONDING_REQUEST_REMOTE_FEATURES_PAGE_2; 7494447016ffSMatthias Ringwald hci_send_cmd(&hci_read_remote_extended_features_command, connection->con_handle, 2); 7495447016ffSMatthias Ringwald return true; 7496447016ffSMatthias Ringwald } 749776f27cffSMatthias Ringwald #endif 749876f27cffSMatthias Ringwald 749976f27cffSMatthias Ringwald if (connection->bonding_flags & BONDING_DISCONNECT_SECURITY_BLOCK){ 750076f27cffSMatthias Ringwald connection->bonding_flags &= ~BONDING_DISCONNECT_SECURITY_BLOCK; 75011714cbbdSMatthias Ringwald #ifdef ENABLE_CLASSIC 75021714cbbdSMatthias Ringwald hci_pairing_complete(connection, ERROR_CODE_CONNECTION_REJECTED_DUE_TO_SECURITY_REASONS); 75031714cbbdSMatthias Ringwald #endif 75046ef3696aSMatthias Ringwald if (connection->state != SENT_DISCONNECT){ 75056ef3696aSMatthias Ringwald connection->state = SENT_DISCONNECT; 75066ef3696aSMatthias Ringwald hci_send_cmd(&hci_disconnect, connection->con_handle, ERROR_CODE_AUTHENTICATION_FAILURE); 7507f30077b7SMatthias Ringwald return true; 750876f27cffSMatthias Ringwald } 75096ef3696aSMatthias Ringwald } 7510da886c03S[email protected] 75116cdc2862SMatthias Ringwald #ifdef ENABLE_CLASSIC 7512f8ee3071SMatthias Ringwald uint16_t sniff_min_interval; 7513f8ee3071SMatthias Ringwald switch (connection->sniff_min_interval){ 7514f8ee3071SMatthias Ringwald case 0: 7515f8ee3071SMatthias Ringwald break; 7516f8ee3071SMatthias Ringwald case 0xffff: 7517f8ee3071SMatthias Ringwald connection->sniff_min_interval = 0; 7518f8ee3071SMatthias Ringwald hci_send_cmd(&hci_exit_sniff_mode, connection->con_handle); 7519f30077b7SMatthias Ringwald return true; 7520f8ee3071SMatthias Ringwald default: 7521f8ee3071SMatthias Ringwald sniff_min_interval = connection->sniff_min_interval; 7522f8ee3071SMatthias Ringwald connection->sniff_min_interval = 0; 7523f8ee3071SMatthias Ringwald hci_send_cmd(&hci_sniff_mode, connection->con_handle, connection->sniff_max_interval, sniff_min_interval, connection->sniff_attempt, connection->sniff_timeout); 7524f30077b7SMatthias Ringwald return true; 7525f8ee3071SMatthias Ringwald } 752688a03c8dSMatthias Ringwald 7527140c0557SMatthias Ringwald if (connection->sniff_subrating_max_latency != 0xffff){ 7528140c0557SMatthias Ringwald uint16_t max_latency = connection->sniff_subrating_max_latency; 7529140c0557SMatthias Ringwald connection->sniff_subrating_max_latency = 0; 7530140c0557SMatthias Ringwald hci_send_cmd(&hci_sniff_subrating, connection->con_handle, max_latency, connection->sniff_subrating_min_remote_timeout, connection->sniff_subrating_min_local_timeout); 7531140c0557SMatthias Ringwald return true; 7532140c0557SMatthias Ringwald } 7533140c0557SMatthias Ringwald 7534965a4ccfSMatthias Ringwald if (connection->qos_service_type != HCI_SERVICE_TYPE_INVALID){ 7535278ff8a9SMatthias Ringwald uint8_t service_type = (uint8_t) connection->qos_service_type; 7536965a4ccfSMatthias Ringwald connection->qos_service_type = HCI_SERVICE_TYPE_INVALID; 7537278ff8a9SMatthias 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); 7538278ff8a9SMatthias Ringwald return true; 7539278ff8a9SMatthias Ringwald } 7540278ff8a9SMatthias Ringwald 754188a03c8dSMatthias Ringwald if (connection->request_role != HCI_ROLE_INVALID){ 754288a03c8dSMatthias Ringwald hci_role_t role = connection->request_role; 754388a03c8dSMatthias Ringwald connection->request_role = HCI_ROLE_INVALID; 754488a03c8dSMatthias Ringwald hci_send_cmd(&hci_switch_role_command, connection->address, role); 754588a03c8dSMatthias Ringwald return true; 754688a03c8dSMatthias Ringwald } 754722df2fe2SMatthias Ringwald #endif 75489afaa4d4SMatthias Ringwald 75499afaa4d4SMatthias Ringwald if (connection->gap_connection_tasks != 0){ 755022df2fe2SMatthias Ringwald #ifdef ENABLE_CLASSIC 75519afaa4d4SMatthias Ringwald if ((connection->gap_connection_tasks & GAP_CONNECTION_TASK_WRITE_AUTOMATIC_FLUSH_TIMEOUT) != 0){ 75529afaa4d4SMatthias Ringwald connection->gap_connection_tasks &= ~GAP_CONNECTION_TASK_WRITE_AUTOMATIC_FLUSH_TIMEOUT; 75539afaa4d4SMatthias Ringwald hci_send_cmd(&hci_write_automatic_flush_timeout, connection->con_handle, hci_stack->automatic_flush_timeout); 75549afaa4d4SMatthias Ringwald return true; 75559afaa4d4SMatthias Ringwald } 755622df2fe2SMatthias Ringwald if (connection->gap_connection_tasks & GAP_CONNECTION_TASK_WRITE_SUPERVISION_TIMEOUT){ 755722df2fe2SMatthias Ringwald connection->gap_connection_tasks &= ~GAP_CONNECTION_TASK_WRITE_SUPERVISION_TIMEOUT; 755822df2fe2SMatthias Ringwald hci_send_cmd(&hci_write_link_supervision_timeout, connection->con_handle, hci_stack->link_supervision_timeout); 755922df2fe2SMatthias Ringwald return true; 75609afaa4d4SMatthias Ringwald } 75616cdc2862SMatthias Ringwald #endif 756222df2fe2SMatthias Ringwald if (connection->gap_connection_tasks & GAP_CONNECTION_TASK_READ_RSSI){ 756322df2fe2SMatthias Ringwald connection->gap_connection_tasks &= ~GAP_CONNECTION_TASK_READ_RSSI; 756422df2fe2SMatthias Ringwald hci_send_cmd(&hci_read_rssi, connection->con_handle); 756522df2fe2SMatthias Ringwald return true; 756622df2fe2SMatthias Ringwald } 7567ac0f6b83SMatthias Ringwald #ifdef ENABLE_BLE 7568ac0f6b83SMatthias Ringwald if (connection->gap_connection_tasks & GAP_CONNECTION_TASK_LE_READ_REMOTE_FEATURES){ 7569ac0f6b83SMatthias Ringwald connection->gap_connection_tasks &= ~GAP_CONNECTION_TASK_LE_READ_REMOTE_FEATURES; 7570ac0f6b83SMatthias Ringwald hci_send_cmd(&hci_le_read_remote_used_features, connection->con_handle); 7571ac0f6b83SMatthias Ringwald return true; 7572ac0f6b83SMatthias Ringwald } 7573ac0f6b83SMatthias Ringwald #endif 757422df2fe2SMatthias Ringwald } 7575f8ee3071SMatthias Ringwald 7576a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE 757773cd8a2aSMatthias Ringwald switch (connection->le_con_parameter_update_state){ 757873cd8a2aSMatthias Ringwald // response to L2CAP CON PARAMETER UPDATE REQUEST 757973cd8a2aSMatthias Ringwald case CON_PARAMETER_UPDATE_CHANGE_HCI_CON_PARAMETERS: 7580da886c03S[email protected] connection->le_con_parameter_update_state = CON_PARAMETER_UPDATE_NONE; 758173cd8a2aSMatthias Ringwald hci_send_cmd(&hci_le_connection_update, connection->con_handle, connection->le_conn_interval_min, 7582c37a3166S[email protected] connection->le_conn_interval_max, connection->le_conn_latency, connection->le_supervision_timeout, 7583d4876126SMatthias Ringwald hci_stack->le_minimum_ce_length, hci_stack->le_maximum_ce_length); 7584f30077b7SMatthias Ringwald return true; 758573cd8a2aSMatthias Ringwald case CON_PARAMETER_UPDATE_REPLY: 758673cd8a2aSMatthias Ringwald connection->le_con_parameter_update_state = CON_PARAMETER_UPDATE_NONE; 758773cd8a2aSMatthias Ringwald hci_send_cmd(&hci_le_remote_connection_parameter_request_reply, connection->con_handle, connection->le_conn_interval_min, 758873cd8a2aSMatthias Ringwald connection->le_conn_interval_max, connection->le_conn_latency, connection->le_supervision_timeout, 7589d4876126SMatthias Ringwald hci_stack->le_minimum_ce_length, hci_stack->le_maximum_ce_length); 7590f30077b7SMatthias Ringwald return true; 759173cd8a2aSMatthias Ringwald case CON_PARAMETER_UPDATE_NEGATIVE_REPLY: 759273cd8a2aSMatthias Ringwald connection->le_con_parameter_update_state = CON_PARAMETER_UPDATE_NONE; 75931e0338ebSMatthias Ringwald hci_send_cmd(&hci_le_remote_connection_parameter_request_negative_reply, connection->con_handle, 75941e0338ebSMatthias Ringwald ERROR_CODE_UNACCEPTABLE_CONNECTION_PARAMETERS); 7595f30077b7SMatthias Ringwald return true; 759673cd8a2aSMatthias Ringwald default: 759773cd8a2aSMatthias Ringwald break; 7598c37a3166S[email protected] } 75994ea43905SMatthias Ringwald if (connection->le_phy_update_all_phys != 0xffu){ 7600b90f6e0aSMatthias Ringwald uint8_t all_phys = connection->le_phy_update_all_phys; 7601b90f6e0aSMatthias Ringwald connection->le_phy_update_all_phys = 0xff; 7602b90f6e0aSMatthias 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); 7603f30077b7SMatthias Ringwald return true; 7604b90f6e0aSMatthias Ringwald } 76059007c891SMatthias Ringwald if (connection->le_subrate_min > 0){ 76069007c891SMatthias Ringwald uint16_t subrate_min = connection->le_subrate_min; 76079007c891SMatthias Ringwald connection->le_subrate_min = 0; 76089007c891SMatthias Ringwald hci_send_cmd(&hci_le_subrate_request, connection->con_handle, subrate_min, connection->le_subrate_max, connection->le_subrate_max_latency, 76099007c891SMatthias Ringwald connection->le_subrate_continuation_number, connection->le_supervision_timeout); 76109007c891SMatthias Ringwald return true; 76119007c891SMatthias Ringwald } 76123bd96807SMatthias Ringwald #ifdef ENABLE_LE_PERIODIC_ADVERTISING 76133bd96807SMatthias Ringwald if (connection->le_past_sync_handle != HCI_CON_HANDLE_INVALID){ 76143bd96807SMatthias Ringwald hci_con_handle_t sync_handle = connection->le_past_sync_handle; 76153bd96807SMatthias Ringwald connection->le_past_sync_handle = HCI_CON_HANDLE_INVALID; 76163bd96807SMatthias Ringwald hci_send_cmd(&hci_le_periodic_advertising_sync_transfer, connection->con_handle, connection->le_past_service_data, sync_handle); 76173bd96807SMatthias Ringwald return true; 76183bd96807SMatthias Ringwald } 7619027f4677SMatthias Ringwald if (connection->le_past_advertising_handle != 0xff){ 7620027f4677SMatthias Ringwald uint8_t advertising_handle = connection->le_past_advertising_handle; 7621027f4677SMatthias Ringwald connection->le_past_advertising_handle = 0xff; 7622027f4677SMatthias Ringwald hci_send_cmd(&hci_le_periodic_advertising_set_info_transfer, connection->con_handle, connection->le_past_service_data, advertising_handle); 7623027f4677SMatthias Ringwald return true; 7624027f4677SMatthias Ringwald } 76253bd96807SMatthias Ringwald #endif 7626c37a3166S[email protected] #endif 7627dbe1a790S[email protected] } 7628f30077b7SMatthias Ringwald return false; 7629f30077b7SMatthias Ringwald } 7630c7e0c5f6Smatthias.ringwald 7631f30077b7SMatthias Ringwald static void hci_run(void){ 7632f30077b7SMatthias Ringwald 7633df9e2780SMatthias Ringwald // stack state sub statemachines 7634df9e2780SMatthias Ringwald switch (hci_stack->state) { 7635df9e2780SMatthias Ringwald case HCI_STATE_INITIALIZING: 7636df9e2780SMatthias Ringwald hci_initializing_run(); 7637d0dea5fbSMatthias Ringwald break; 7638df9e2780SMatthias Ringwald case HCI_STATE_HALTING: 7639df9e2780SMatthias Ringwald hci_halting_run(); 7640d0dea5fbSMatthias Ringwald break; 7641df9e2780SMatthias Ringwald case HCI_STATE_FALLING_ASLEEP: 7642df9e2780SMatthias Ringwald hci_falling_asleep_run(); 7643d0dea5fbSMatthias Ringwald break; 7644df9e2780SMatthias Ringwald default: 7645df9e2780SMatthias Ringwald break; 7646df9e2780SMatthias Ringwald } 7647df9e2780SMatthias Ringwald 7648d0dea5fbSMatthias Ringwald // allow to run after initialization to working transition 7649d0dea5fbSMatthias Ringwald if (hci_stack->state != HCI_STATE_WORKING){ 7650d0dea5fbSMatthias Ringwald return; 7651d0dea5fbSMatthias Ringwald } 7652d0dea5fbSMatthias Ringwald 7653f30077b7SMatthias Ringwald bool done; 7654f30077b7SMatthias Ringwald 7655f30077b7SMatthias Ringwald // send continuation fragments first, as they block the prepared packet buffer 7656f30077b7SMatthias Ringwald done = hci_run_acl_fragments(); 7657f30077b7SMatthias Ringwald if (done) return; 7658f30077b7SMatthias Ringwald 765968ab6207SMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS 766068ab6207SMatthias Ringwald done = hci_run_iso_fragments(); 766168ab6207SMatthias Ringwald if (done) return; 766268ab6207SMatthias Ringwald #endif 766368ab6207SMatthias Ringwald 7664f30077b7SMatthias Ringwald #ifdef ENABLE_HCI_CONTROLLER_TO_HOST_FLOW_CONTROL 7665f30077b7SMatthias Ringwald // send host num completed packets next as they don't require num_cmd_packets > 0 7666c69be560SMatthias Ringwald if (!hci_can_send_command_packet_transport()) return; 7667f30077b7SMatthias Ringwald if (hci_stack->host_completed_packets){ 7668f30077b7SMatthias Ringwald hci_host_num_completed_packets(); 7669f30077b7SMatthias Ringwald return; 7670f30077b7SMatthias Ringwald } 7671f30077b7SMatthias Ringwald #endif 7672f30077b7SMatthias Ringwald 7673f30077b7SMatthias Ringwald if (!hci_can_send_command_packet_now()) return; 7674f30077b7SMatthias Ringwald 7675f30077b7SMatthias Ringwald // global/non-connection oriented commands 7676f30077b7SMatthias Ringwald 7677f30077b7SMatthias Ringwald 7678f30077b7SMatthias Ringwald #ifdef ENABLE_CLASSIC 7679f30077b7SMatthias Ringwald // general gap classic 7680f30077b7SMatthias Ringwald done = hci_run_general_gap_classic(); 7681f30077b7SMatthias Ringwald if (done) return; 7682f30077b7SMatthias Ringwald #endif 7683f30077b7SMatthias Ringwald 7684f30077b7SMatthias Ringwald #ifdef ENABLE_BLE 7685f30077b7SMatthias Ringwald // general gap le 7686f30077b7SMatthias Ringwald done = hci_run_general_gap_le(); 7687f30077b7SMatthias Ringwald if (done) return; 76887aa35f6aSMatthias Ringwald 76897aa35f6aSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS 76907aa35f6aSMatthias Ringwald // ISO related tasks, e.g. BIG create/terminate/sync 76917aa35f6aSMatthias Ringwald done = hci_run_iso_tasks(); 76927aa35f6aSMatthias Ringwald if (done) return; 76937aa35f6aSMatthias Ringwald #endif 7694f30077b7SMatthias Ringwald #endif 7695f30077b7SMatthias Ringwald 7696f30077b7SMatthias Ringwald // send pending HCI commands 7697df9e2780SMatthias Ringwald hci_run_general_pending_commands(); 76983429f56bSmatthias.ringwald } 769916833f0aSmatthias.ringwald 77000f076adeSMatthias Ringwald #ifdef ENABLE_CLASSIC 7701d7891039SMatthias Ringwald static void hci_set_sco_payload_length_for_flipped_packet_types(hci_connection_t * hci_connection, uint16_t flipped_packet_types){ 7702d7891039SMatthias Ringwald // bits 6-9 are 'don't use' 7703d7891039SMatthias Ringwald uint16_t packet_types = flipped_packet_types ^ 0x03c0; 7704d7891039SMatthias Ringwald 7705d7891039SMatthias Ringwald // restrict packet types to local and remote supported 7706d7891039SMatthias Ringwald packet_types &= hci_connection->remote_supported_sco_packets & hci_stack->usable_packet_types_sco; 7707d7891039SMatthias Ringwald hci_connection->sco_payload_length = hci_sco_payload_length_for_packet_types(packet_types); 7708d7891039SMatthias Ringwald log_info("Possible SCO packet types 0x%04x => payload length %u", packet_types, hci_connection->sco_payload_length); 7709d7891039SMatthias Ringwald } 77100f076adeSMatthias Ringwald #endif 7711d7891039SMatthias Ringwald 7712ca6804fdSMatthias Ringwald // funnel for sending cmd packet using single outgoing buffer 7713ed208344SMatthias Ringwald static uint8_t hci_send_prepared_cmd_packet(void) { 7714ca6804fdSMatthias Ringwald btstack_assert(hci_stack->hci_packet_buffer_reserved); 7715f91accd3SMatthias Ringwald // cache opcode 7716f91accd3SMatthias Ringwald hci_stack->last_cmd_opcode = little_endian_read_16(hci_stack->hci_packet_buffer, 0); 7717f91accd3SMatthias Ringwald // get size 7718ca6804fdSMatthias Ringwald uint16_t size = 3u + hci_stack->hci_packet_buffer[2u]; 7719f91accd3SMatthias Ringwald // send packet 7720ca6804fdSMatthias Ringwald uint8_t status = hci_send_cmd_packet(hci_stack->hci_packet_buffer, size); 7721ca6804fdSMatthias Ringwald // release packet buffer on error or for synchronous transport implementations 7722ca6804fdSMatthias Ringwald if ((status != ERROR_CODE_SUCCESS) || hci_transport_synchronous()){ 7723ca6804fdSMatthias Ringwald hci_release_packet_buffer(); 7724ca6804fdSMatthias Ringwald } 7725ca6804fdSMatthias Ringwald return status; 7726ca6804fdSMatthias Ringwald } 7727ca6804fdSMatthias Ringwald 77283e2050f7SMatthias Ringwald uint8_t hci_send_cmd_packet(uint8_t *packet, int size){ 772935454696SMatthias Ringwald // house-keeping 773035454696SMatthias Ringwald 773135454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 7732c8e4258aSmatthias.ringwald bd_addr_t addr; 7733c8e4258aSmatthias.ringwald hci_connection_t * conn; 7734c123d999SMatthias Ringwald #endif 7735c123d999SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 77366f35bb46SMatthias Ringwald uint8_t initiator_filter_policy; 77379cbd2215SMatthias Ringwald #endif 7738c8e4258aSmatthias.ringwald 77396f35bb46SMatthias Ringwald uint16_t opcode = little_endian_read_16(packet, 0); 77406f35bb46SMatthias Ringwald switch (opcode) { 77419cbd2215SMatthias Ringwald case HCI_OPCODE_HCI_WRITE_LOOPBACK_MODE: 77429cbd2215SMatthias Ringwald hci_stack->loopback_mode = packet[3]; 77439cbd2215SMatthias Ringwald break; 77449cbd2215SMatthias Ringwald 77459cbd2215SMatthias Ringwald #ifdef ENABLE_CLASSIC 77466f35bb46SMatthias Ringwald case HCI_OPCODE_HCI_CREATE_CONNECTION: 7747724d70a2SMatthias Ringwald reverse_bd_addr(&packet[3], addr); 77489da54300S[email protected] log_info("Create_connection to %s", bd_addr_to_str(addr)); 7749c8e4258aSmatthias.ringwald 775072cf8859SMatthias Ringwald // CVE-2020-26555: reject outgoing connection to device with same BD ADDR 775172cf8859SMatthias Ringwald if (memcmp(hci_stack->local_bd_addr, addr, 6) == 0) { 775279e0fa07SMatthias Ringwald hci_emit_connection_complete(addr, 0, ERROR_CODE_CONNECTION_REJECTED_DUE_TO_UNACCEPTABLE_BD_ADDR); 77533e2050f7SMatthias Ringwald return ERROR_CODE_CONNECTION_REJECTED_DUE_TO_UNACCEPTABLE_BD_ADDR; 775472cf8859SMatthias Ringwald } 775572cf8859SMatthias Ringwald 7756f16129ceSMatthias Ringwald conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL); 7757ad83dc6aS[email protected] if (!conn) { 775888f925b1SMatthias Ringwald conn = create_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL, HCI_ROLE_MASTER); 775917f1ba2aSmatthias.ringwald if (!conn) { 776017f1ba2aSmatthias.ringwald // notify client that alloc failed 77612deddeceSMatthias Ringwald hci_emit_connection_complete(addr, 0, BTSTACK_MEMORY_ALLOC_FAILED); 77623e2050f7SMatthias Ringwald return BTSTACK_MEMORY_ALLOC_FAILED; // packet not sent to controller 776317f1ba2aSmatthias.ringwald } 7764ad83dc6aS[email protected] conn->state = SEND_CREATE_CONNECTION; 7765ad83dc6aS[email protected] } 7766aee5d5c1SMatthias Ringwald 7767ad83dc6aS[email protected] log_info("conn state %u", conn->state); 77683e2050f7SMatthias Ringwald // TODO: L2CAP should not send create connection command, instead a (new) gap function should be used 7769ad83dc6aS[email protected] switch (conn->state) { 7770ad83dc6aS[email protected] // if connection active exists 7771ad83dc6aS[email protected] case OPEN: 7772f5e5741dSMatthias Ringwald // and OPEN, emit connection complete command 777372cf8859SMatthias Ringwald hci_emit_connection_complete(addr, conn->con_handle, ERROR_CODE_SUCCESS); 77743e2050f7SMatthias Ringwald // packet not sent to controller 77753e2050f7SMatthias Ringwald return ERROR_CODE_ACL_CONNECTION_ALREADY_EXISTS; 7776672e36abSMatthias Ringwald case RECEIVED_DISCONNECTION_COMPLETE: 7777672e36abSMatthias Ringwald // create connection triggered in disconnect complete event, let's do it now 7778672e36abSMatthias Ringwald break; 7779ad83dc6aS[email protected] case SEND_CREATE_CONNECTION: 77806c0d5426SMatthias Ringwald #ifdef ENABLE_HCI_SERIALIZED_CONTROLLER_OPERATIONS 77816c0d5426SMatthias Ringwald if (hci_classic_operation_active()){ 77826c0d5426SMatthias Ringwald return ERROR_CODE_SUCCESS; 77836c0d5426SMatthias Ringwald } 77846c0d5426SMatthias Ringwald #endif 7785532f91a5SMatthias Ringwald // connection created by hci, e.g. dedicated bonding, but not executed yet, let's do it now 7786532f91a5SMatthias Ringwald break; 7787ad83dc6aS[email protected] default: 7788ad83dc6aS[email protected] // otherwise, just ignore as it is already in the open process 77893e2050f7SMatthias Ringwald // packet not sent to controller 77903e2050f7SMatthias Ringwald return ERROR_CODE_ACL_CONNECTION_ALREADY_EXISTS; 7791ad83dc6aS[email protected] } 7792c8e4258aSmatthias.ringwald conn->state = SENT_CREATE_CONNECTION; 7793229331c6SMatthias Ringwald 7794229331c6SMatthias Ringwald // track outgoing connection 7795f16129ceSMatthias Ringwald hci_stack->outgoing_addr_type = BD_ADDR_TYPE_ACL; 77966535961aSMatthias Ringwald (void) memcpy(hci_stack->outgoing_addr, addr, 6); 77976f35bb46SMatthias Ringwald break; 7798ee752bb8SMatthias Ringwald 77996f35bb46SMatthias Ringwald case HCI_OPCODE_HCI_SETUP_SYNCHRONOUS_CONNECTION: 78009071873aSMatthias Ringwald conn = hci_connection_for_handle(little_endian_read_16(packet, 3)); 78019071873aSMatthias Ringwald if (conn == NULL) { 78029071873aSMatthias Ringwald // neither SCO nor ACL connection for con handle 78039071873aSMatthias Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 78049071873aSMatthias Ringwald } else { 7805d7891039SMatthias Ringwald uint16_t remote_supported_sco_packets; 78069071873aSMatthias Ringwald switch (conn->address_type){ 78079071873aSMatthias Ringwald case BD_ADDR_TYPE_ACL: 78089071873aSMatthias Ringwald // assert SCO connection does not exit 7809d9290e95SMatthias Ringwald if (hci_connection_for_bd_addr_and_type(conn->address, BD_ADDR_TYPE_SCO) != NULL){ 78109071873aSMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 78119071873aSMatthias Ringwald } 7812d7891039SMatthias Ringwald // cache remote sco packet types 7813d7891039SMatthias Ringwald remote_supported_sco_packets = conn->remote_supported_sco_packets; 7814d7891039SMatthias Ringwald 78159071873aSMatthias Ringwald // allocate connection struct 781688f925b1SMatthias Ringwald conn = create_connection_for_bd_addr_and_type(conn->address, BD_ADDR_TYPE_SCO, 781788f925b1SMatthias Ringwald HCI_ROLE_MASTER); 78189071873aSMatthias Ringwald if (!conn) { 78199071873aSMatthias Ringwald return ERROR_CODE_MEMORY_CAPACITY_EXCEEDED; 78209071873aSMatthias Ringwald } 7821d7891039SMatthias Ringwald conn->remote_supported_sco_packets = remote_supported_sco_packets; 78229071873aSMatthias Ringwald break; 78239071873aSMatthias Ringwald case BD_ADDR_TYPE_SCO: 78249071873aSMatthias Ringwald // update of existing SCO connection 78259071873aSMatthias Ringwald break; 78269071873aSMatthias Ringwald default: 78279071873aSMatthias Ringwald return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS; 78289071873aSMatthias Ringwald } 78299071873aSMatthias Ringwald } 7830d9290e95SMatthias Ringwald 7831d9290e95SMatthias Ringwald // conn refers to hci connection of type sco now 7832d9290e95SMatthias Ringwald 78339071873aSMatthias Ringwald conn->state = SENT_CREATE_CONNECTION; 78349071873aSMatthias Ringwald 78359071873aSMatthias Ringwald // track outgoing connection to handle command status with error 78369071873aSMatthias Ringwald hci_stack->outgoing_addr_type = BD_ADDR_TYPE_SCO; 7837f728a932SMatthias Ringwald (void) memcpy(hci_stack->outgoing_addr, conn->address, 6); 78389071873aSMatthias Ringwald 7839ee752bb8SMatthias Ringwald // setup_synchronous_connection? Voice setting at offset 22 7840ee752bb8SMatthias Ringwald // TODO: compare to current setting if sco connection already active 7841ee752bb8SMatthias Ringwald hci_stack->sco_voice_setting_active = little_endian_read_16(packet, 15); 7842d7891039SMatthias Ringwald 7843d7891039SMatthias Ringwald // derive sco payload length from packet types 7844d7891039SMatthias Ringwald hci_set_sco_payload_length_for_flipped_packet_types(conn, little_endian_read_16(packet, 18)); 78456f35bb46SMatthias Ringwald break; 78469071873aSMatthias Ringwald 78476f35bb46SMatthias Ringwald case HCI_OPCODE_HCI_ACCEPT_SYNCHRONOUS_CONNECTION: 78489071873aSMatthias Ringwald // get SCO connection 78499071873aSMatthias Ringwald reverse_bd_addr(&packet[3], addr); 78509071873aSMatthias Ringwald conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_SCO); 78519071873aSMatthias Ringwald if (conn == NULL){ 78529071873aSMatthias Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 78539071873aSMatthias Ringwald } 78549071873aSMatthias Ringwald 78559071873aSMatthias Ringwald conn->state = ACCEPTED_CONNECTION_REQUEST; 78569071873aSMatthias Ringwald 78579071873aSMatthias Ringwald // track outgoing connection to handle command status with error 78589071873aSMatthias Ringwald hci_stack->outgoing_addr_type = BD_ADDR_TYPE_SCO; 78599071873aSMatthias Ringwald (void) memcpy(hci_stack->outgoing_addr, addr, 6); 78609071873aSMatthias Ringwald 7861c91e6e4fSMatthias Ringwald // accept_synchronous_connection? Voice setting at offset 18 7862ee752bb8SMatthias Ringwald // TODO: compare to current setting if sco connection already active 7863ee752bb8SMatthias Ringwald hci_stack->sco_voice_setting_active = little_endian_read_16(packet, 19); 7864d7891039SMatthias Ringwald 7865d7891039SMatthias Ringwald // derive sco payload length from packet types 7866d7891039SMatthias Ringwald hci_set_sco_payload_length_for_flipped_packet_types(conn, little_endian_read_16(packet, 22)); 78676f35bb46SMatthias Ringwald break; 7868ee752bb8SMatthias Ringwald #endif 78694b3e1e19SMatthias Ringwald 7870a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE 7871d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 78726f35bb46SMatthias Ringwald case HCI_OPCODE_HCI_LE_CREATE_CONNECTION: 7873b04dfa37SMatthias Ringwald // white list used? 78746f35bb46SMatthias Ringwald initiator_filter_policy = packet[7]; 7875b04dfa37SMatthias Ringwald switch (initiator_filter_policy) { 7876b04dfa37SMatthias Ringwald case 0: 7877b04dfa37SMatthias Ringwald // whitelist not used 7878b04dfa37SMatthias Ringwald hci_stack->le_connecting_state = LE_CONNECTING_DIRECT; 7879b04dfa37SMatthias Ringwald break; 7880b04dfa37SMatthias Ringwald case 1: 7881b04dfa37SMatthias Ringwald hci_stack->le_connecting_state = LE_CONNECTING_WHITELIST; 7882b04dfa37SMatthias Ringwald break; 7883b04dfa37SMatthias Ringwald default: 7884b04dfa37SMatthias Ringwald log_error("Invalid initiator_filter_policy in LE Create Connection %u", initiator_filter_policy); 7885b04dfa37SMatthias Ringwald break; 7886b04dfa37SMatthias Ringwald } 7887c163146eSMatthias Ringwald // track outgoing connection 78888f7da641SMatthias Ringwald hci_stack->outgoing_addr_type = (bd_addr_type_t) packet[8]; // peer address type 7889c163146eSMatthias Ringwald reverse_bd_addr( &packet[9], hci_stack->outgoing_addr); // peer address 78906f35bb46SMatthias Ringwald break; 78918f7da641SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 78928f7da641SMatthias Ringwald case HCI_OPCODE_HCI_LE_EXTENDED_CREATE_CONNECTION: 78938f7da641SMatthias Ringwald // white list used? 78948f7da641SMatthias Ringwald initiator_filter_policy = packet[3]; 78958f7da641SMatthias Ringwald switch (initiator_filter_policy) { 78968f7da641SMatthias Ringwald case 0: 78978f7da641SMatthias Ringwald // whitelist not used 78988f7da641SMatthias Ringwald hci_stack->le_connecting_state = LE_CONNECTING_DIRECT; 78998f7da641SMatthias Ringwald break; 79008f7da641SMatthias Ringwald case 1: 79018f7da641SMatthias Ringwald hci_stack->le_connecting_state = LE_CONNECTING_WHITELIST; 79028f7da641SMatthias Ringwald break; 79038f7da641SMatthias Ringwald default: 79048f7da641SMatthias Ringwald log_error("Invalid initiator_filter_policy in LE Create Connection %u", initiator_filter_policy); 79058f7da641SMatthias Ringwald break; 79068f7da641SMatthias Ringwald } 79078f7da641SMatthias Ringwald // track outgoing connection 79088f7da641SMatthias Ringwald hci_stack->outgoing_addr_type = (bd_addr_type_t) packet[5]; // peer address type 79098f7da641SMatthias Ringwald reverse_bd_addr( &packet[6], hci_stack->outgoing_addr); // peer address 79108f7da641SMatthias Ringwald break; 79118f7da641SMatthias Ringwald #endif 79126f35bb46SMatthias Ringwald case HCI_OPCODE_HCI_LE_CREATE_CONNECTION_CANCEL: 79136ea9315cSMatthias Ringwald hci_stack->le_connecting_state = LE_CONNECTING_CANCEL; 79146f35bb46SMatthias Ringwald break; 79159cbd2215SMatthias Ringwald #endif 791691036612SMatthias Ringwald #ifdef ENABLE_HCI_COMMAND_STATUS_DISCARDED_FOR_FAILED_CONNECTIONS_WORKAROUND 7917f48a5586SMatthias Ringwald case HCI_OPCODE_HCI_LE_CONNECTION_UPDATE: 7918f48a5586SMatthias Ringwald case HCI_OPCODE_HCI_LE_READ_REMOTE_USED_FEATURES: 7919f48a5586SMatthias Ringwald case HCI_OPCODE_HCI_LE_START_ENCRYPTION: 7920f48a5586SMatthias Ringwald case HCI_OPCODE_HCI_LE_LONG_TERM_KEY_REQUEST_REPLY: 7921f48a5586SMatthias Ringwald case HCI_OPCODE_HCI_LE_LONG_TERM_KEY_NEGATIVE_REPLY: 7922f48a5586SMatthias Ringwald case HCI_OPCODE_HCI_LE_REMOTE_CONNECTION_PARAMETER_REQUEST_REPLY: 7923f48a5586SMatthias Ringwald case HCI_OPCODE_HCI_LE_REMOTE_CONNECTION_PARAMETER_REQUEST_NEGATIVE_REPLY: 7924f48a5586SMatthias Ringwald case HCI_OPCODE_HCI_LE_SET_DATA_LENGTH: 7925f48a5586SMatthias Ringwald case HCI_OPCODE_HCI_LE_READ_PHY: 7926f48a5586SMatthias Ringwald case HCI_OPCODE_HCI_LE_SET_PHY: 7927f48a5586SMatthias Ringwald // conection handle is first command parameter 7928f48a5586SMatthias Ringwald hci_stack->hci_command_con_handle = little_endian_read_16(packet, 3); 7929f48a5586SMatthias Ringwald break; 7930f48a5586SMatthias Ringwald #endif 79314ae8623eSMatthias Ringwald #endif /* ENABLE_BLE */ 79326f35bb46SMatthias Ringwald default: 79336f35bb46SMatthias Ringwald break; 7934b04dfa37SMatthias Ringwald } 793569a97523S[email protected] 79363a9fb326S[email protected] hci_stack->num_cmd_packets--; 79375bb5bc3eS[email protected] 79385bb5bc3eS[email protected] hci_dump_packet(HCI_COMMAND_DATA_PACKET, 0, packet, size); 79393e2050f7SMatthias Ringwald int err = hci_stack->hci_transport->send_packet(HCI_COMMAND_DATA_PACKET, packet, size); 7940a84946b2SMatthias Ringwald uint8_t status; 7941a84946b2SMatthias Ringwald if (err == 0){ 7942a84946b2SMatthias Ringwald status = ERROR_CODE_SUCCESS; 7943a84946b2SMatthias Ringwald } else { 7944a84946b2SMatthias Ringwald status = ERROR_CODE_HARDWARE_FAILURE; 79453e2050f7SMatthias Ringwald } 7946a84946b2SMatthias Ringwald return status; 794731452debSmatthias.ringwald } 79488adf0ddaSmatthias.ringwald 79492bd8b7e7S[email protected] // disconnect because of security block 79502bd8b7e7S[email protected] void hci_disconnect_security_block(hci_con_handle_t con_handle){ 79512bd8b7e7S[email protected] hci_connection_t * connection = hci_connection_for_handle(con_handle); 79522bd8b7e7S[email protected] if (!connection) return; 79532bd8b7e7S[email protected] connection->bonding_flags |= BONDING_DISCONNECT_SECURITY_BLOCK; 79542bd8b7e7S[email protected] } 79552bd8b7e7S[email protected] 79562bd8b7e7S[email protected] 7957dbe1a790S[email protected] // Configure Secure Simple Pairing 7958dbe1a790S[email protected] 795935454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 796035454696SMatthias Ringwald 7961dbe1a790S[email protected] // enable will enable SSP during init 796215a95bd5SMatthias Ringwald void gap_ssp_set_enable(int enable){ 79633a9fb326S[email protected] hci_stack->ssp_enable = enable; 7964dbe1a790S[email protected] } 7965dbe1a790S[email protected] 796695d71764SMatthias Ringwald static int hci_local_ssp_activated(void){ 796715a95bd5SMatthias Ringwald return gap_ssp_supported() && hci_stack->ssp_enable; 79682bd8b7e7S[email protected] } 79692bd8b7e7S[email protected] 7970dbe1a790S[email protected] // if set, BTstack will respond to io capability request using authentication requirement 797115a95bd5SMatthias Ringwald void gap_ssp_set_io_capability(int io_capability){ 79723a9fb326S[email protected] hci_stack->ssp_io_capability = io_capability; 7973dbe1a790S[email protected] } 797415a95bd5SMatthias Ringwald void gap_ssp_set_authentication_requirement(int authentication_requirement){ 79753a9fb326S[email protected] hci_stack->ssp_authentication_requirement = authentication_requirement; 7976dbe1a790S[email protected] } 7977dbe1a790S[email protected] 7978a086dc35SMatthias Ringwald // if set, BTstack will confirm a numeric comparison and enter '000000' if requested 797915a95bd5SMatthias Ringwald void gap_ssp_set_auto_accept(int auto_accept){ 79803a9fb326S[email protected] hci_stack->ssp_auto_accept = auto_accept; 7981dbe1a790S[email protected] } 79825d23aae8SMatthias Ringwald 79835d23aae8SMatthias Ringwald void gap_secure_connections_enable(bool enable){ 79845d23aae8SMatthias Ringwald hci_stack->secure_connections_enable = enable; 79855d23aae8SMatthias Ringwald } 798622d445d8SMatthias Ringwald bool gap_secure_connections_active(void){ 7987eaf85bc8SMatthias Ringwald return hci_stack->secure_connections_active; 798822d445d8SMatthias Ringwald } 79895d23aae8SMatthias Ringwald 799035454696SMatthias Ringwald #endif 7991dbe1a790S[email protected] 799294be1a66SMatthias Ringwald // va_list part of hci_send_cmd 79933e2050f7SMatthias Ringwald uint8_t hci_send_cmd_va_arg(const hci_cmd_t * cmd, va_list argptr){ 7994d94d3cafS[email protected] if (!hci_can_send_command_packet_now()){ 79959d14b626S[email protected] log_error("hci_send_cmd called but cannot send packet now"); 79963e2050f7SMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 79979d14b626S[email protected] } 79989d14b626S[email protected] 79999d14b626S[email protected] hci_reserve_packet_buffer(); 8000f91accd3SMatthias Ringwald hci_cmd_create_from_template(hci_stack->hci_packet_buffer, cmd, argptr); 8001ca6804fdSMatthias Ringwald return hci_send_prepared_cmd_packet(); 800294be1a66SMatthias Ringwald } 80039d14b626S[email protected] 800494be1a66SMatthias Ringwald /** 8005a086dc35SMatthias Ringwald * pre: num_commands >= 0 - it's allowed to send a command to the controller 800694be1a66SMatthias Ringwald */ 80073e2050f7SMatthias Ringwald uint8_t hci_send_cmd(const hci_cmd_t * cmd, ...){ 80081cd208adSmatthias.ringwald va_list argptr; 80091cd208adSmatthias.ringwald va_start(argptr, cmd); 80103e2050f7SMatthias Ringwald uint8_t status = hci_send_cmd_va_arg(cmd, argptr); 80111cd208adSmatthias.ringwald va_end(argptr); 80123e2050f7SMatthias Ringwald return status; 801393b8dc03Smatthias.ringwald } 8014c8e4258aSmatthias.ringwald 80159da9850bSMatthias Ringwald // Forward HCI events and create non-HCI events 8016ee091cf1Smatthias.ringwald 8017d6b06661SMatthias Ringwald static void hci_emit_event(uint8_t * event, uint16_t size, int dump){ 8018fb37a842SMatthias Ringwald // dump packet 8019d6b06661SMatthias Ringwald if (dump) { 802092da54c4SMatthias Ringwald hci_dump_packet( HCI_EVENT_PACKET, 1, event, size); 8021d6b06661SMatthias Ringwald } 80221ef6bb52SMatthias Ringwald 8023fb37a842SMatthias Ringwald // dispatch to all event handlers 80241ef6bb52SMatthias Ringwald btstack_linked_list_iterator_t it; 80251ef6bb52SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->event_handlers); 80261ef6bb52SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 80271ef6bb52SMatthias Ringwald btstack_packet_callback_registration_t * entry = (btstack_packet_callback_registration_t*) btstack_linked_list_iterator_next(&it); 8028d9a7306aSMatthias Ringwald entry->callback(HCI_EVENT_PACKET, 0, event, size); 80291ef6bb52SMatthias Ringwald } 8030d6b06661SMatthias Ringwald } 8031d6b06661SMatthias Ringwald 80329da9850bSMatthias Ringwald static void hci_emit_btstack_event(uint8_t * event, uint16_t size, int dump){ 80339da9850bSMatthias Ringwald #ifndef ENABLE_LOG_BTSTACK_EVENTS 80349da9850bSMatthias Ringwald dump = 0; 80359da9850bSMatthias Ringwald #endif 80369da9850bSMatthias Ringwald hci_emit_event(event, size, dump); 80379da9850bSMatthias Ringwald } 80389da9850bSMatthias Ringwald 8039d6b06661SMatthias Ringwald static void hci_emit_acl_packet(uint8_t * packet, uint16_t size){ 8040fb37a842SMatthias Ringwald if (!hci_stack->acl_packet_handler) return; 80413d50b4baSMatthias Ringwald hci_stack->acl_packet_handler(HCI_ACL_DATA_PACKET, 0, packet, size); 8042d6b06661SMatthias Ringwald } 8043d6b06661SMatthias Ringwald 804435454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 8045701e3307SMatthias Ringwald static void hci_notify_if_sco_can_send_now(void){ 80463bc639ceSMatthias Ringwald // notify SCO sender if waiting 8047701e3307SMatthias Ringwald if (!hci_stack->sco_waiting_for_can_send_now) return; 8048701e3307SMatthias Ringwald if (hci_can_send_sco_packet_now()){ 80493bc639ceSMatthias Ringwald hci_stack->sco_waiting_for_can_send_now = 0; 8050701e3307SMatthias Ringwald uint8_t event[2] = { HCI_EVENT_SCO_CAN_SEND_NOW, 0 }; 80519da9850bSMatthias Ringwald hci_dump_btstack_event(event, sizeof(event)); 80523d50b4baSMatthias Ringwald hci_stack->sco_packet_handler(HCI_EVENT_PACKET, 0, event, sizeof(event)); 80533bc639ceSMatthias Ringwald } 80543bc639ceSMatthias Ringwald } 80551cfb383eSMatthias Ringwald 80561cfb383eSMatthias Ringwald // parsing end emitting has been merged to reduce code size 80579784dac1SMatthias Ringwald static void gap_inquiry_explode(uint8_t *packet, uint16_t size) { 8058ac9136ccSMatthias Ringwald uint8_t event[28+GAP_INQUIRY_MAX_NAME_LEN]; 80591cfb383eSMatthias Ringwald 80601cfb383eSMatthias Ringwald uint8_t * eir_data; 80611cfb383eSMatthias Ringwald ad_context_t context; 80621cfb383eSMatthias Ringwald const uint8_t * name; 80631cfb383eSMatthias Ringwald uint8_t name_len; 80641cfb383eSMatthias Ringwald 80659784dac1SMatthias Ringwald if (size < 3) return; 80669784dac1SMatthias Ringwald 80671cfb383eSMatthias Ringwald int event_type = hci_event_packet_get_type(packet); 8068a1df452eSMatthias Ringwald int num_reserved_fields = (event_type == HCI_EVENT_INQUIRY_RESULT) ? 2 : 1; // 2 for old event, 1 otherwise 80691cfb383eSMatthias Ringwald int num_responses = hci_event_inquiry_result_get_num_responses(packet); 80701cfb383eSMatthias Ringwald 80719784dac1SMatthias Ringwald switch (event_type){ 80729784dac1SMatthias Ringwald case HCI_EVENT_INQUIRY_RESULT: 80739784dac1SMatthias Ringwald case HCI_EVENT_INQUIRY_RESULT_WITH_RSSI: 80749784dac1SMatthias Ringwald if (size != (3 + (num_responses * 14))) return; 80759784dac1SMatthias Ringwald break; 80769784dac1SMatthias Ringwald case HCI_EVENT_EXTENDED_INQUIRY_RESPONSE: 80779784dac1SMatthias Ringwald if (size != 257) return; 80789784dac1SMatthias Ringwald if (num_responses != 1) return; 80799784dac1SMatthias Ringwald break; 80809784dac1SMatthias Ringwald default: 80819784dac1SMatthias Ringwald return; 80829784dac1SMatthias Ringwald } 80839784dac1SMatthias Ringwald 80841cfb383eSMatthias Ringwald // event[1] is set at the end 80851cfb383eSMatthias Ringwald int i; 80861cfb383eSMatthias Ringwald for (i=0; i<num_responses;i++){ 80871cfb383eSMatthias Ringwald memset(event, 0, sizeof(event)); 80881cfb383eSMatthias Ringwald event[0] = GAP_EVENT_INQUIRY_RESULT; 8089ac973fd6SMatthias Ringwald uint8_t event_size = 27; // if name is not set by EIR 80901cfb383eSMatthias Ringwald 80916535961aSMatthias Ringwald (void)memcpy(&event[2], &packet[3 + (i * 6)], 6); // bd_addr 80920e588213SMatthias Ringwald event[8] = packet[3 + (num_responses*(6)) + (i*1)]; // page_scan_repetition_mode 80936535961aSMatthias Ringwald (void)memcpy(&event[9], 80946535961aSMatthias Ringwald &packet[3 + (num_responses * (6 + 1 + num_reserved_fields)) + (i * 3)], 80956535961aSMatthias Ringwald 3); // class of device 80966535961aSMatthias Ringwald (void)memcpy(&event[12], 80976535961aSMatthias Ringwald &packet[3 + (num_responses * (6 + 1 + num_reserved_fields + 3)) + (i * 2)], 80986535961aSMatthias Ringwald 2); // clock offset 80991cfb383eSMatthias Ringwald 81001cfb383eSMatthias Ringwald switch (event_type){ 81011cfb383eSMatthias Ringwald case HCI_EVENT_INQUIRY_RESULT: 81021cfb383eSMatthias Ringwald // 14,15,16,17 = 0, size 18 81031cfb383eSMatthias Ringwald break; 81041cfb383eSMatthias Ringwald case HCI_EVENT_INQUIRY_RESULT_WITH_RSSI: 81051cfb383eSMatthias Ringwald event[14] = 1; 8106a1df452eSMatthias Ringwald event[15] = packet [3 + (num_responses*(6+1+num_reserved_fields+3+2)) + (i*1)]; // rssi 81071cfb383eSMatthias Ringwald // 16,17 = 0, size 18 81081cfb383eSMatthias Ringwald break; 81091cfb383eSMatthias Ringwald case HCI_EVENT_EXTENDED_INQUIRY_RESPONSE: 81101cfb383eSMatthias Ringwald event[14] = 1; 8111a1df452eSMatthias Ringwald event[15] = packet [3 + (num_responses*(6+1+num_reserved_fields+3+2)) + (i*1)]; // rssi 811279186815SMatthias Ringwald // EIR packets only contain a single inquiry response 81131cfb383eSMatthias Ringwald eir_data = &packet[3 + (6+1+num_reserved_fields+3+2+1)]; 81141cfb383eSMatthias Ringwald name = NULL; 8115a8c4e5adSMatthias Ringwald // Iterate over EIR data 8116a8c4e5adSMatthias Ringwald for (ad_iterator_init(&context, EXTENDED_INQUIRY_RESPONSE_DATA_LEN, eir_data) ; ad_iterator_has_more(&context) ; ad_iterator_next(&context)){ 81171cfb383eSMatthias Ringwald uint8_t data_type = ad_iterator_get_data_type(&context); 81181cfb383eSMatthias Ringwald uint8_t data_size = ad_iterator_get_data_len(&context); 81191cfb383eSMatthias Ringwald const uint8_t * data = ad_iterator_get_data(&context); 8120ac9136ccSMatthias Ringwald // Prefer Complete Local Name over Shortened Local Name 81211cfb383eSMatthias Ringwald switch (data_type){ 81221cfb383eSMatthias Ringwald case BLUETOOTH_DATA_TYPE_SHORTENED_LOCAL_NAME: 81231cfb383eSMatthias Ringwald if (name) continue; 8124cf373d3aSMatthias Ringwald /* fall through */ 81251cfb383eSMatthias Ringwald case BLUETOOTH_DATA_TYPE_COMPLETE_LOCAL_NAME: 81261cfb383eSMatthias Ringwald name = data; 81271cfb383eSMatthias Ringwald name_len = data_size; 81281cfb383eSMatthias Ringwald break; 8129ac9136ccSMatthias Ringwald case BLUETOOTH_DATA_TYPE_DEVICE_ID: 8130ac9136ccSMatthias Ringwald if (data_size != 8) break; 8131ac9136ccSMatthias Ringwald event[16] = 1; 81323c0c7fefSMatthias Ringwald memcpy(&event[17], data, 8); 8133ac9136ccSMatthias Ringwald break; 81341cfb383eSMatthias Ringwald default: 81351cfb383eSMatthias Ringwald break; 81361cfb383eSMatthias Ringwald } 81371cfb383eSMatthias Ringwald } 81381cfb383eSMatthias Ringwald if (name){ 8139ac9136ccSMatthias Ringwald event[25] = 1; 81401cfb383eSMatthias Ringwald // truncate name if needed 81411cfb383eSMatthias Ringwald int len = btstack_min(name_len, GAP_INQUIRY_MAX_NAME_LEN); 8142ac9136ccSMatthias Ringwald event[26] = len; 8143ac9136ccSMatthias Ringwald (void)memcpy(&event[27], name, len); 81441cfb383eSMatthias Ringwald event_size += len; 81451cfb383eSMatthias Ringwald } 81461cfb383eSMatthias Ringwald break; 81477bbeb3adSMilanka Ringwald default: 81487bbeb3adSMilanka Ringwald return; 81491cfb383eSMatthias Ringwald } 81501cfb383eSMatthias Ringwald event[1] = event_size - 2; 81519da9850bSMatthias Ringwald hci_emit_btstack_event(event, event_size, 1); 81521cfb383eSMatthias Ringwald } 81531cfb383eSMatthias Ringwald } 815435454696SMatthias Ringwald #endif 81553bc639ceSMatthias Ringwald 815671de195eSMatthias Ringwald void hci_emit_state(void){ 81573a9fb326S[email protected] log_info("BTSTACK_EVENT_STATE %u", hci_stack->state); 8158425d1371Smatthias.ringwald uint8_t event[3]; 815980d52d6bSmatthias.ringwald event[0] = BTSTACK_EVENT_STATE; 81604ea43905SMatthias Ringwald event[1] = sizeof(event) - 2u; 81613a9fb326S[email protected] event[2] = hci_stack->state; 81629da9850bSMatthias Ringwald hci_emit_btstack_event(event, sizeof(event), 1); 8163c8e4258aSmatthias.ringwald } 8164c8e4258aSmatthias.ringwald 816535454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 81662deddeceSMatthias Ringwald static void hci_emit_connection_complete(bd_addr_t address, hci_con_handle_t con_handle, uint8_t status){ 8167425d1371Smatthias.ringwald uint8_t event[13]; 8168c8e4258aSmatthias.ringwald event[0] = HCI_EVENT_CONNECTION_COMPLETE; 8169425d1371Smatthias.ringwald event[1] = sizeof(event) - 2; 817017f1ba2aSmatthias.ringwald event[2] = status; 81712deddeceSMatthias Ringwald little_endian_store_16(event, 3, con_handle); 81722deddeceSMatthias Ringwald reverse_bd_addr(address, &event[5]); 8173c8e4258aSmatthias.ringwald event[11] = 1; // ACL connection 8174c8e4258aSmatthias.ringwald event[12] = 0; // encryption disabled 81759da9850bSMatthias Ringwald hci_emit_btstack_event(event, sizeof(event), 1); 8176c8e4258aSmatthias.ringwald } 817752db98b2SMatthias Ringwald static void hci_emit_l2cap_check_timeout(hci_connection_t *conn){ 817852db98b2SMatthias Ringwald if (disable_l2cap_timeouts) return; 817952db98b2SMatthias Ringwald log_info("L2CAP_EVENT_TIMEOUT_CHECK"); 818052db98b2SMatthias Ringwald uint8_t event[4]; 818152db98b2SMatthias Ringwald event[0] = L2CAP_EVENT_TIMEOUT_CHECK; 818252db98b2SMatthias Ringwald event[1] = sizeof(event) - 2; 818352db98b2SMatthias Ringwald little_endian_store_16(event, 2, conn->con_handle); 81849da9850bSMatthias Ringwald hci_emit_btstack_event(event, sizeof(event), 1); 818552db98b2SMatthias Ringwald } 818635454696SMatthias Ringwald #endif 8187c8e4258aSmatthias.ringwald 818835454696SMatthias Ringwald #ifdef ENABLE_BLE 8189d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 8190667ba9d1SMatthias 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){ 8191ebd1b979SMatthias Ringwald uint8_t hci_event[21]; 8192ebd1b979SMatthias Ringwald hci_event[0] = HCI_EVENT_LE_META; 8193ebd1b979SMatthias Ringwald hci_event[1] = sizeof(hci_event) - 2u; 8194ebd1b979SMatthias Ringwald hci_event[2] = HCI_SUBEVENT_LE_CONNECTION_COMPLETE; 8195ebd1b979SMatthias Ringwald hci_event[3] = status; 8196ebd1b979SMatthias Ringwald little_endian_store_16(hci_event, 4, con_handle); 8197ebd1b979SMatthias Ringwald hci_event[6] = 0; // TODO: role 8198ebd1b979SMatthias Ringwald hci_event[7] = address_type; 8199ebd1b979SMatthias Ringwald reverse_bd_addr(address, &hci_event[8]); 8200ebd1b979SMatthias Ringwald little_endian_store_16(hci_event, 14, 0); // interval 8201ebd1b979SMatthias Ringwald little_endian_store_16(hci_event, 16, 0); // latency 8202ebd1b979SMatthias Ringwald little_endian_store_16(hci_event, 18, 0); // supervision timeout 8203ebd1b979SMatthias Ringwald hci_event[20] = 0; // master clock accuracy 82049da9850bSMatthias Ringwald hci_emit_btstack_event(hci_event, sizeof(hci_event), 1); 8205ebd1b979SMatthias Ringwald // emit GAP event, too 8206ebd1b979SMatthias Ringwald uint8_t gap_event[36]; 8207ebd1b979SMatthias Ringwald hci_create_gap_connection_complete_event(hci_event, gap_event); 82089da9850bSMatthias Ringwald hci_emit_btstack_event(gap_event, sizeof(gap_event), 1); 82094f3229d8S[email protected] } 821035454696SMatthias Ringwald #endif 8211d70217a2SMatthias Ringwald #endif 82124f3229d8S[email protected] 8213fd43c0e0SMatthias Ringwald static void hci_emit_transport_packet_sent(void){ 8214fd43c0e0SMatthias Ringwald // notify upper stack that it might be possible to send again 8215fd43c0e0SMatthias Ringwald uint8_t event[] = { HCI_EVENT_TRANSPORT_PACKET_SENT, 0}; 82169da9850bSMatthias Ringwald hci_emit_btstack_event(&event[0], sizeof(event), 0); // don't dump 8217fd43c0e0SMatthias Ringwald } 8218fd43c0e0SMatthias Ringwald 8219fc64f94aSMatthias Ringwald static void hci_emit_disconnection_complete(hci_con_handle_t con_handle, uint8_t reason){ 8220425d1371Smatthias.ringwald uint8_t event[6]; 82213c4d4b90Smatthias.ringwald event[0] = HCI_EVENT_DISCONNECTION_COMPLETE; 82224ea43905SMatthias Ringwald event[1] = sizeof(event) - 2u; 82233c4d4b90Smatthias.ringwald event[2] = 0; // status = OK 8224fc64f94aSMatthias Ringwald little_endian_store_16(event, 3, con_handle); 82253c4d4b90Smatthias.ringwald event[5] = reason; 82269da9850bSMatthias Ringwald hci_emit_btstack_event(event, sizeof(event), 1); 82273c4d4b90Smatthias.ringwald } 82283c4d4b90Smatthias.ringwald 8229b83d5eabSMatthias Ringwald static void hci_emit_nr_connections_changed(void){ 8230e0abb8e7S[email protected] log_info("BTSTACK_EVENT_NR_CONNECTIONS_CHANGED %u", nr_hci_connections()); 8231425d1371Smatthias.ringwald uint8_t event[3]; 823280d52d6bSmatthias.ringwald event[0] = BTSTACK_EVENT_NR_CONNECTIONS_CHANGED; 82334ea43905SMatthias Ringwald event[1] = sizeof(event) - 2u; 823443bfb1bdSmatthias.ringwald event[2] = nr_hci_connections(); 82359da9850bSMatthias Ringwald hci_emit_btstack_event(event, sizeof(event), 1); 823643bfb1bdSmatthias.ringwald } 8237038bc64cSmatthias.ringwald 8238b83d5eabSMatthias Ringwald static void hci_emit_hci_open_failed(void){ 8239e0abb8e7S[email protected] log_info("BTSTACK_EVENT_POWERON_FAILED"); 8240425d1371Smatthias.ringwald uint8_t event[2]; 824180d52d6bSmatthias.ringwald event[0] = BTSTACK_EVENT_POWERON_FAILED; 82424ea43905SMatthias Ringwald event[1] = sizeof(event) - 2u; 82439da9850bSMatthias Ringwald hci_emit_btstack_event(event, sizeof(event), 1); 8244038bc64cSmatthias.ringwald } 82451b0e3922Smatthias.ringwald 824635454696SMatthias Ringwald static void hci_emit_dedicated_bonding_result(bd_addr_t address, uint8_t status){ 824735454696SMatthias Ringwald log_info("hci_emit_dedicated_bonding_result %u ", status); 824835454696SMatthias Ringwald uint8_t event[9]; 824935454696SMatthias Ringwald int pos = 0; 825035454696SMatthias Ringwald event[pos++] = GAP_EVENT_DEDICATED_BONDING_COMPLETED; 82514ea43905SMatthias Ringwald event[pos++] = sizeof(event) - 2u; 825235454696SMatthias Ringwald event[pos++] = status; 825335454696SMatthias Ringwald reverse_bd_addr(address, &event[pos]); 82549da9850bSMatthias Ringwald hci_emit_btstack_event(event, sizeof(event), 1); 8255381fbed8Smatthias.ringwald } 8256458bf4e8S[email protected] 825735454696SMatthias Ringwald 825835454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 825935454696SMatthias Ringwald 8260b83d5eabSMatthias Ringwald static void hci_emit_security_level(hci_con_handle_t con_handle, gap_security_level_t level){ 8261df3354fcS[email protected] log_info("hci_emit_security_level %u for handle %x", level, con_handle); 8262a00031e2S[email protected] uint8_t event[5]; 8263e00caf9cS[email protected] int pos = 0; 82645611a760SMatthias Ringwald event[pos++] = GAP_EVENT_SECURITY_LEVEL; 8265e00caf9cS[email protected] event[pos++] = sizeof(event) - 2; 8266f8fbdce0SMatthias Ringwald little_endian_store_16(event, 2, con_handle); 8267e00caf9cS[email protected] pos += 2; 8268e00caf9cS[email protected] event[pos++] = level; 82699da9850bSMatthias Ringwald hci_emit_btstack_event(event, sizeof(event), 1); 8270e00caf9cS[email protected] } 8271e00caf9cS[email protected] 827235454696SMatthias Ringwald static gap_security_level_t gap_security_level_for_connection(hci_connection_t * connection){ 827335454696SMatthias Ringwald if (!connection) return LEVEL_0; 82748daf94bcSMatthias Ringwald if ((connection->authentication_flags & AUTH_FLAG_CONNECTION_ENCRYPTED) == 0) return LEVEL_0; 8275fcaf38b9SMatthias Ringwald // BIAS: we only consider Authenticated if the connection is already encrypted, which requires that both sides have link key 82768daf94bcSMatthias Ringwald if ((connection->authentication_flags & AUTH_FLAG_CONNECTION_AUTHENTICATED) == 0) return LEVEL_0; 8277170fafaeSMatthias Ringwald if (connection->encryption_key_size < hci_stack->gap_required_encyrption_key_size) return LEVEL_0; 82784051b7ffSMatthias Ringwald gap_security_level_t security_level = gap_security_level_for_link_key_type(connection->link_key_type); 8279a086dc35SMatthias Ringwald // LEVEL 4 always requires 128 bit encryption key size 82800e588213SMatthias Ringwald if ((security_level == LEVEL_4) && (connection->encryption_key_size < 16)){ 8281170fafaeSMatthias Ringwald security_level = LEVEL_3; 8282170fafaeSMatthias Ringwald } 8283170fafaeSMatthias Ringwald return security_level; 828435454696SMatthias Ringwald } 828535454696SMatthias Ringwald 828671fd255dSMatthias Ringwald static void hci_emit_scan_mode_changed(uint8_t discoverable, uint8_t connectable){ 828771fd255dSMatthias Ringwald uint8_t event[4]; 828871fd255dSMatthias Ringwald event[0] = BTSTACK_EVENT_SCAN_MODE_CHANGED; 828935454696SMatthias Ringwald event[1] = sizeof(event) - 2; 829071fd255dSMatthias Ringwald event[2] = discoverable; 829171fd255dSMatthias Ringwald event[3] = connectable; 82929da9850bSMatthias Ringwald hci_emit_btstack_event(event, sizeof(event), 1); 8293ad83dc6aS[email protected] } 8294ad83dc6aS[email protected] 829598a2fd1cSMatthias Ringwald // query if remote side supports eSCO 829620dcdd22SMatthias Ringwald bool hci_remote_esco_supported(hci_con_handle_t con_handle){ 829798a2fd1cSMatthias Ringwald hci_connection_t * connection = hci_connection_for_handle(con_handle); 829820dcdd22SMatthias Ringwald if (!connection) return false; 829976ccfb2aSMatthias Ringwald return (connection->remote_supported_features[0] & 1) != 0; 830098a2fd1cSMatthias Ringwald } 830198a2fd1cSMatthias Ringwald 83020b78a447SMatthias Ringwald uint16_t hci_remote_sco_packet_types(hci_con_handle_t con_handle){ 83030b78a447SMatthias Ringwald hci_connection_t * connection = hci_connection_for_handle(con_handle); 83040b78a447SMatthias Ringwald if (!connection) return 0; 83050b78a447SMatthias Ringwald return connection->remote_supported_sco_packets; 83060b78a447SMatthias Ringwald } 83070b78a447SMatthias Ringwald 830867aae551SMatthias Ringwald static bool hci_ssp_supported(hci_connection_t * connection){ 830967aae551SMatthias Ringwald const uint8_t mask = BONDING_REMOTE_SUPPORTS_SSP_CONTROLLER | BONDING_REMOTE_SUPPORTS_SSP_HOST; 831067aae551SMatthias Ringwald return (connection->bonding_flags & mask) == mask; 831167aae551SMatthias Ringwald } 831267aae551SMatthias Ringwald 83132bd8b7e7S[email protected] // query if remote side supports SSP 831420dcdd22SMatthias Ringwald bool hci_remote_ssp_supported(hci_con_handle_t con_handle){ 83152bd8b7e7S[email protected] hci_connection_t * connection = hci_connection_for_handle(con_handle); 831620dcdd22SMatthias Ringwald if (!connection) return false; 831767aae551SMatthias Ringwald return hci_ssp_supported(connection) ? 1 : 0; 83182bd8b7e7S[email protected] } 83192bd8b7e7S[email protected] 832020dcdd22SMatthias Ringwald bool gap_ssp_supported_on_both_sides(hci_con_handle_t handle){ 8321df3354fcS[email protected] return hci_local_ssp_activated() && hci_remote_ssp_supported(handle); 8322df3354fcS[email protected] } 8323df3354fcS[email protected] 83246ffc78ceSMatthias Ringwald /** 83256ffc78ceSMatthias Ringwald * Check if remote supported features query has completed 83266ffc78ceSMatthias Ringwald */ 83276ffc78ceSMatthias Ringwald bool hci_remote_features_available(hci_con_handle_t handle){ 83286ffc78ceSMatthias Ringwald hci_connection_t * connection = hci_connection_for_handle(handle); 83296ffc78ceSMatthias Ringwald if (!connection) return false; 83306ffc78ceSMatthias Ringwald return (connection->bonding_flags & BONDING_RECEIVED_REMOTE_FEATURES) != 0; 83316ffc78ceSMatthias Ringwald } 83326ffc78ceSMatthias Ringwald 8333d6596031SMatthias Ringwald /** 8334d6596031SMatthias Ringwald * Trigger remote supported features query 8335d6596031SMatthias Ringwald */ 8336c9742cd1SMatthias Ringwald 8337c9742cd1SMatthias Ringwald static void hci_trigger_remote_features_for_connection(hci_connection_t * connection){ 8338c9742cd1SMatthias Ringwald if ((connection->bonding_flags & (BONDING_REMOTE_FEATURES_QUERY_ACTIVE | BONDING_RECEIVED_REMOTE_FEATURES)) == 0){ 8339c9742cd1SMatthias Ringwald connection->bonding_flags |= BONDING_REMOTE_FEATURES_QUERY_ACTIVE | BONDING_REQUEST_REMOTE_FEATURES_PAGE_0; 8340c9742cd1SMatthias Ringwald } 8341c9742cd1SMatthias Ringwald } 8342c9742cd1SMatthias Ringwald 8343d6596031SMatthias Ringwald void hci_remote_features_query(hci_con_handle_t con_handle){ 8344d6596031SMatthias Ringwald hci_connection_t * connection = hci_connection_for_handle(con_handle); 8345d6596031SMatthias Ringwald if (!connection) return; 8346c9742cd1SMatthias Ringwald hci_trigger_remote_features_for_connection(connection); 8347d6596031SMatthias Ringwald hci_run(); 8348d6596031SMatthias Ringwald } 8349d6596031SMatthias Ringwald 8350458bf4e8S[email protected] // GAP API 8351458bf4e8S[email protected] /** 8352458bf4e8S[email protected] * @bbrief enable/disable bonding. default is enabled 8353458bf4e8S[email protected] * @praram enabled 8354458bf4e8S[email protected] */ 83554c57c146S[email protected] void gap_set_bondable_mode(int enable){ 83563a9fb326S[email protected] hci_stack->bondable = enable ? 1 : 0; 8357458bf4e8S[email protected] } 83584ef6443cSMatthias Ringwald /** 83594ef6443cSMatthias Ringwald * @brief Get bondable mode. 83604ef6443cSMatthias Ringwald * @return 1 if bondable 83614ef6443cSMatthias Ringwald */ 83624ef6443cSMatthias Ringwald int gap_get_bondable_mode(void){ 83634ef6443cSMatthias Ringwald return hci_stack->bondable; 83644ef6443cSMatthias Ringwald } 8365cb230b9dS[email protected] 8366cb230b9dS[email protected] /** 836734d2123cS[email protected] * @brief map link keys to security levels 8368cb230b9dS[email protected] */ 836934d2123cS[email protected] gap_security_level_t gap_security_level_for_link_key_type(link_key_type_t link_key_type){ 837034d2123cS[email protected] switch (link_key_type){ 83713c68dfa9S[email protected] case AUTHENTICATED_COMBINATION_KEY_GENERATED_FROM_P256: 83723c68dfa9S[email protected] return LEVEL_4; 83733c68dfa9S[email protected] case COMBINATION_KEY: 83743c68dfa9S[email protected] case AUTHENTICATED_COMBINATION_KEY_GENERATED_FROM_P192: 83753c68dfa9S[email protected] return LEVEL_3; 83763c68dfa9S[email protected] default: 83773c68dfa9S[email protected] return LEVEL_2; 83783c68dfa9S[email protected] } 8379cb230b9dS[email protected] } 8380cb230b9dS[email protected] 83818b35e16aSMatthias Ringwald /** 83828b35e16aSMatthias Ringwald * @brief map link keys to secure connection yes/no 83838b35e16aSMatthias Ringwald */ 838436c3546bSMatthias Ringwald bool gap_secure_connection_for_link_key_type(link_key_type_t link_key_type){ 83858b35e16aSMatthias Ringwald switch (link_key_type){ 83868b35e16aSMatthias Ringwald case AUTHENTICATED_COMBINATION_KEY_GENERATED_FROM_P256: 83878b35e16aSMatthias Ringwald case UNAUTHENTICATED_COMBINATION_KEY_GENERATED_FROM_P256: 838836c3546bSMatthias Ringwald return true; 83898b35e16aSMatthias Ringwald default: 839036c3546bSMatthias Ringwald return false; 83918b35e16aSMatthias Ringwald } 83928b35e16aSMatthias Ringwald } 83938b35e16aSMatthias Ringwald 83948b35e16aSMatthias Ringwald /** 83958b35e16aSMatthias Ringwald * @brief map link keys to authenticated 83968b35e16aSMatthias Ringwald */ 83977040ba26SMatthias Ringwald bool gap_authenticated_for_link_key_type(link_key_type_t link_key_type){ 83988b35e16aSMatthias Ringwald switch (link_key_type){ 83998b35e16aSMatthias Ringwald case AUTHENTICATED_COMBINATION_KEY_GENERATED_FROM_P256: 84008b35e16aSMatthias Ringwald case AUTHENTICATED_COMBINATION_KEY_GENERATED_FROM_P192: 84017040ba26SMatthias Ringwald return true; 84028b35e16aSMatthias Ringwald default: 84037040ba26SMatthias Ringwald return false; 84048b35e16aSMatthias Ringwald } 84058b35e16aSMatthias Ringwald } 84068b35e16aSMatthias Ringwald 8407552b9260SMatthias Ringwald bool gap_mitm_protection_required_for_security_level(gap_security_level_t level){ 84085127cc62S[email protected] log_info("gap_mitm_protection_required_for_security_level %u", level); 8409106d6d11S[email protected] return level > LEVEL_2; 8410106d6d11S[email protected] } 8411106d6d11S[email protected] 841234d2123cS[email protected] /** 841334d2123cS[email protected] * @brief get current security level 841434d2123cS[email protected] */ 841534d2123cS[email protected] gap_security_level_t gap_security_level(hci_con_handle_t con_handle){ 841634d2123cS[email protected] hci_connection_t * connection = hci_connection_for_handle(con_handle); 841734d2123cS[email protected] if (!connection) return LEVEL_0; 841834d2123cS[email protected] return gap_security_level_for_connection(connection); 841934d2123cS[email protected] } 842034d2123cS[email protected] 8421cb230b9dS[email protected] /** 8422cb230b9dS[email protected] * @brief request connection to device to 8423cb230b9dS[email protected] * @result GAP_AUTHENTICATION_RESULT 8424cb230b9dS[email protected] */ 842534d2123cS[email protected] void gap_request_security_level(hci_con_handle_t con_handle, gap_security_level_t requested_level){ 842634d2123cS[email protected] hci_connection_t * connection = hci_connection_for_handle(con_handle); 842734d2123cS[email protected] if (!connection){ 8428a00031e2S[email protected] hci_emit_security_level(con_handle, LEVEL_0); 842934d2123cS[email protected] return; 843034d2123cS[email protected] } 8431defbf200SMatthias Ringwald 8432defbf200SMatthias Ringwald btstack_assert(hci_is_le_connection(connection) == false); 8433defbf200SMatthias Ringwald 8434bc00e12cSMatthias 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) 8435bc00e12cSMatthias Ringwald // available on the BR/EDR physical transport require Security Mode 4, Level 4 " 8436bc00e12cSMatthias Ringwald if (hci_stack->gap_secure_connections_only_mode && (requested_level != LEVEL_0)){ 8437bc00e12cSMatthias Ringwald requested_level = LEVEL_4; 8438bc00e12cSMatthias Ringwald } 8439bc00e12cSMatthias Ringwald 844034d2123cS[email protected] gap_security_level_t current_level = gap_security_level(con_handle); 844183d08d7cSMatthias Ringwald log_info("gap_request_security_level requested level %u, planned level %u, current level %u", 844283d08d7cSMatthias Ringwald requested_level, connection->requested_security_level, current_level); 844383d08d7cSMatthias Ringwald 8444dbd5dcc3SMatthias Ringwald // authentication active if authentication request was sent or planned level > 0 8445dbd5dcc3SMatthias Ringwald bool authentication_active = ((connection->bonding_flags & BONDING_SENT_AUTHENTICATE_REQUEST) != 0) || (connection->requested_security_level > LEVEL_0); 8446dbd5dcc3SMatthias Ringwald if (authentication_active){ 84471cf0a6c8SMatthias Ringwald // authentication already active 844883d08d7cSMatthias Ringwald if (connection->requested_security_level < requested_level){ 844983d08d7cSMatthias Ringwald // increase requested level as new level is higher 845083d08d7cSMatthias Ringwald // TODO: handle re-authentication when done 845183d08d7cSMatthias Ringwald connection->requested_security_level = requested_level; 845283d08d7cSMatthias Ringwald } 84531cf0a6c8SMatthias Ringwald } else { 845483d08d7cSMatthias Ringwald // no request active, notify if security sufficient 845583d08d7cSMatthias Ringwald if (requested_level <= current_level){ 8456a00031e2S[email protected] hci_emit_security_level(con_handle, current_level); 845734d2123cS[email protected] return; 845834d2123cS[email protected] } 8459a00031e2S[email protected] 8460e060c07dSMatthias Ringwald // store request 846134d2123cS[email protected] connection->requested_security_level = requested_level; 8462a00031e2S[email protected] 84631cf0a6c8SMatthias Ringwald // start to authenticate connection 84641eb2563eS[email protected] connection->bonding_flags |= BONDING_SEND_AUTHENTICATE_REQUEST; 84657fdbaf79SMatthias Ringwald 84667fdbaf79SMatthias Ringwald // request remote features if not already active, also trigger hci_run 84677fdbaf79SMatthias Ringwald hci_remote_features_query(con_handle); 8468e00caf9cS[email protected] } 84691cf0a6c8SMatthias Ringwald } 8470ad83dc6aS[email protected] 8471ad83dc6aS[email protected] /** 8472ad83dc6aS[email protected] * @brief start dedicated bonding with device. disconnect after bonding 8473ad83dc6aS[email protected] * @param device 8474ad83dc6aS[email protected] * @param request MITM protection 8475ad83dc6aS[email protected] * @result GAP_DEDICATED_BONDING_COMPLETE 8476ad83dc6aS[email protected] */ 8477ad83dc6aS[email protected] int gap_dedicated_bonding(bd_addr_t device, int mitm_protection_required){ 8478ad83dc6aS[email protected] 8479ad83dc6aS[email protected] // create connection state machine 848088f925b1SMatthias Ringwald hci_connection_t * connection = create_connection_for_bd_addr_and_type(device, BD_ADDR_TYPE_ACL, HCI_ROLE_MASTER); 8481ad83dc6aS[email protected] 8482ad83dc6aS[email protected] if (!connection){ 8483ad83dc6aS[email protected] return BTSTACK_MEMORY_ALLOC_FAILED; 8484ad83dc6aS[email protected] } 8485ad83dc6aS[email protected] 84864cd03f8aSMatthias Ringwald // delete link key 848715a95bd5SMatthias Ringwald gap_drop_link_key_for_bd_addr(device); 8488ad83dc6aS[email protected] 8489ad83dc6aS[email protected] // configure LEVEL_2/3, dedicated bonding 8490ad83dc6aS[email protected] connection->state = SEND_CREATE_CONNECTION; 8491ad83dc6aS[email protected] connection->requested_security_level = mitm_protection_required ? LEVEL_3 : LEVEL_2; 8492f04a0c31SMatthias Ringwald log_info("gap_dedicated_bonding, mitm %d -> level %u", mitm_protection_required, connection->requested_security_level); 8493ad83dc6aS[email protected] connection->bonding_flags = BONDING_DEDICATED; 8494ad83dc6aS[email protected] 8495ad83dc6aS[email protected] hci_run(); 8496ad83dc6aS[email protected] 8497ad83dc6aS[email protected] return 0; 8498ad83dc6aS[email protected] } 84998e618f72S[email protected] 8500f82b8f4bSMatthias Ringwald uint8_t hci_dedicated_bonding_defer_disconnect(hci_con_handle_t con_handle, bool defer){ 8501ab0c69a9SMatthias Ringwald hci_connection_t * connection = hci_connection_for_handle(con_handle); 8502ab0c69a9SMatthias Ringwald if (connection == NULL){ 8503ab0c69a9SMatthias Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 8504ab0c69a9SMatthias Ringwald } 8505ab0c69a9SMatthias Ringwald if (defer){ 8506ab0c69a9SMatthias Ringwald connection->bonding_flags |= BONDING_DEDICATED_DEFER_DISCONNECT; 8507ab0c69a9SMatthias Ringwald } else { 8508ab0c69a9SMatthias Ringwald connection->bonding_flags &= ~BONDING_DEDICATED_DEFER_DISCONNECT; 8509ab0c69a9SMatthias Ringwald // trigger disconnect 8510ab0c69a9SMatthias Ringwald hci_run(); 8511ab0c69a9SMatthias Ringwald } 8512ab0c69a9SMatthias Ringwald return ERROR_CODE_SUCCESS; 8513ab0c69a9SMatthias Ringwald } 8514ab0c69a9SMatthias Ringwald 85158e618f72S[email protected] void gap_set_local_name(const char * local_name){ 85168e618f72S[email protected] hci_stack->local_name = local_name; 8517baa4881eSMatthias Ringwald hci_stack->gap_tasks_classic |= GAP_TASK_SET_LOCAL_NAME; 851859d59ecfSMatthias Ringwald // also update EIR if not set by user 851959d59ecfSMatthias Ringwald if (hci_stack->eir_data == NULL){ 8520baa4881eSMatthias Ringwald hci_stack->gap_tasks_classic |= GAP_TASK_SET_EIR_DATA; 852159d59ecfSMatthias Ringwald } 852259d59ecfSMatthias Ringwald hci_run(); 85238e618f72S[email protected] } 85241aeec2ebSMatthias Ringwald #endif 85258e618f72S[email protected] 852635454696SMatthias Ringwald 852735454696SMatthias Ringwald #ifdef ENABLE_BLE 852835454696SMatthias Ringwald 8529d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 8530d8e8f12aSMatthias Ringwald void gap_start_scan(void){ 8531fde725feSMatthias Ringwald hci_stack->le_scanning_enabled = true; 85327bdc6798S[email protected] hci_run(); 85337bdc6798S[email protected] } 85348e618f72S[email protected] 8535d8e8f12aSMatthias Ringwald void gap_stop_scan(void){ 8536fde725feSMatthias Ringwald hci_stack->le_scanning_enabled = false; 85377bdc6798S[email protected] hci_run(); 85387bdc6798S[email protected] } 85394f3229d8S[email protected] 8540a7a719e9SMatthias Ringwald void gap_set_scan_params(uint8_t scan_type, uint16_t scan_interval, uint16_t scan_window, uint8_t scanning_filter_policy){ 8541ef11999fSmatthias.ringwald hci_stack->le_scan_type = scan_type; 8542a7a719e9SMatthias Ringwald hci_stack->le_scan_filter_policy = scanning_filter_policy; 8543ef11999fSmatthias.ringwald hci_stack->le_scan_interval = scan_interval; 8544ef11999fSmatthias.ringwald hci_stack->le_scan_window = scan_window; 85458b69e4c7SMatthias Ringwald hci_stack->le_scanning_param_update = true; 8546ef11999fSmatthias.ringwald hci_run(); 8547ef11999fSmatthias.ringwald } 85484f3229d8S[email protected] 8549a7a719e9SMatthias Ringwald void gap_set_scan_parameters(uint8_t scan_type, uint16_t scan_interval, uint16_t scan_window){ 8550a7a719e9SMatthias Ringwald gap_set_scan_params(scan_type, scan_interval, scan_window, 0); 8551a7a719e9SMatthias Ringwald } 8552a7a719e9SMatthias Ringwald 85534856283bSMatthias Ringwald void gap_set_scan_duplicate_filter(bool enabled){ 85544856283bSMatthias Ringwald hci_stack->le_scan_filter_duplicates = enabled ? 1 : 0; 85554856283bSMatthias Ringwald } 85564856283bSMatthias Ringwald 85577eb5b27eSMatthias Ringwald void gap_set_scan_phys(uint8_t phys){ 85587eb5b27eSMatthias Ringwald // LE Coded and LE 1M PHY 85597eb5b27eSMatthias Ringwald hci_stack->le_scan_phys = phys & 0x05; 85607eb5b27eSMatthias Ringwald } 85617eb5b27eSMatthias Ringwald 8562667ba9d1SMatthias Ringwald uint8_t gap_connect(const bd_addr_t addr, bd_addr_type_t addr_type) { 85639cb52963SMatthias Ringwald // disallow le connection if outgoing already active 8564d32b3f05SMatthias Ringwald if (hci_is_le_connection_type(addr_type) && hci_stack->le_connecting_request != LE_CONNECTING_IDLE){ 85659cb52963SMatthias Ringwald log_error("le connect already active"); 8566d32b3f05SMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 8567d32b3f05SMatthias Ringwald } 8568d32b3f05SMatthias Ringwald 85699cb52963SMatthias Ringwald hci_connection_t * conn = hci_connection_for_bd_addr_and_type(addr, addr_type); 85709cb52963SMatthias Ringwald if (conn == NULL) { 857188f925b1SMatthias Ringwald conn = create_connection_for_bd_addr_and_type(addr, addr_type, HCI_ROLE_MASTER); 8572f29c1023SMatthias Ringwald if (conn == NULL){ 85739cb52963SMatthias Ringwald // alloc failed 8574d8e8f12aSMatthias Ringwald log_info("gap_connect: failed to alloc hci_connection_t"); 85759cb52963SMatthias Ringwald return BTSTACK_MEMORY_ALLOC_FAILED; 85769cb52963SMatthias Ringwald } 85779cb52963SMatthias Ringwald } else { 85789cb52963SMatthias Ringwald switch (conn->state) { 85799cb52963SMatthias Ringwald case RECEIVED_DISCONNECTION_COMPLETE: 85809cb52963SMatthias Ringwald // connection was just disconnected, reset state and allow re-connect 85819cb52963SMatthias Ringwald conn->role = HCI_ROLE_MASTER; 85829cb52963SMatthias Ringwald break; 85839cb52963SMatthias Ringwald default: 85849cb52963SMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 85859cb52963SMatthias Ringwald } 85864f3229d8S[email protected] } 8587d5b1a89eSMatthias Ringwald 8588d5b1a89eSMatthias Ringwald // set le connecting state 8589d5b1a89eSMatthias Ringwald if (hci_is_le_connection_type(addr_type)){ 8590d5b1a89eSMatthias Ringwald hci_stack->le_connecting_request = LE_CONNECTING_DIRECT; 8591d5b1a89eSMatthias Ringwald } 8592d5b1a89eSMatthias Ringwald 85939cb52963SMatthias Ringwald // trigger connect 8594d8e8f12aSMatthias Ringwald log_info("gap_connect: send create connection next"); 8595b0136355SMatthias Ringwald conn->state = SEND_CREATE_CONNECTION; 8596b0136355SMatthias Ringwald hci_run(); 8597b0136355SMatthias Ringwald return ERROR_CODE_SUCCESS; 8598b0136355SMatthias Ringwald } 8599b0136355SMatthias Ringwald 86007851196eSmatthias.ringwald // @assumption: only a single outgoing LE Connection exists 8601ca0d6e5aSMatthias Ringwald static hci_connection_t * gap_get_outgoing_le_connection(void){ 8602665d90f2SMatthias Ringwald btstack_linked_item_t *it; 8603a0da043fSMatthias Ringwald for (it = (btstack_linked_item_t *) hci_stack->connections; it != NULL; it = it->next){ 86040bf6344aS[email protected] hci_connection_t * conn = (hci_connection_t *) it; 8605ca0d6e5aSMatthias Ringwald if (hci_is_le_connection(conn)){ 86060bf6344aS[email protected] switch (conn->state){ 8607a6725849S[email protected] case SEND_CREATE_CONNECTION: 86087851196eSmatthias.ringwald case SENT_CREATE_CONNECTION: 86097851196eSmatthias.ringwald return conn; 86107851196eSmatthias.ringwald default: 86117851196eSmatthias.ringwald break; 86127851196eSmatthias.ringwald }; 86137851196eSmatthias.ringwald } 8614ca0d6e5aSMatthias Ringwald } 86157851196eSmatthias.ringwald return NULL; 86167851196eSmatthias.ringwald } 86177851196eSmatthias.ringwald 8618d8e8f12aSMatthias Ringwald uint8_t gap_connect_cancel(void){ 861914f2d8f0SMatthias Ringwald hci_connection_t * conn; 862014f2d8f0SMatthias Ringwald switch (hci_stack->le_connecting_request){ 862114f2d8f0SMatthias Ringwald case LE_CONNECTING_IDLE: 862214f2d8f0SMatthias Ringwald break; 862314f2d8f0SMatthias Ringwald case LE_CONNECTING_WHITELIST: 862414f2d8f0SMatthias Ringwald hci_stack->le_connecting_request = LE_CONNECTING_IDLE; 862514f2d8f0SMatthias Ringwald hci_run(); 862614f2d8f0SMatthias Ringwald break; 862714f2d8f0SMatthias Ringwald case LE_CONNECTING_DIRECT: 862814f2d8f0SMatthias Ringwald hci_stack->le_connecting_request = LE_CONNECTING_IDLE; 8629ca0d6e5aSMatthias Ringwald conn = gap_get_outgoing_le_connection(); 863014f2d8f0SMatthias Ringwald if (conn == NULL){ 863114f2d8f0SMatthias Ringwald hci_run(); 863214f2d8f0SMatthias Ringwald } else { 86337851196eSmatthias.ringwald switch (conn->state){ 86347851196eSmatthias.ringwald case SEND_CREATE_CONNECTION: 86357851196eSmatthias.ringwald // skip sending create connection and emit event instead 86362e77e513S[email protected] hci_emit_le_connection_complete(conn->address_type, conn->address, 0, ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER); 8637665d90f2SMatthias Ringwald btstack_linked_list_remove(&hci_stack->connections, (btstack_linked_item_t *) conn); 86387851196eSmatthias.ringwald btstack_memory_hci_connection_free( conn ); 86390bf6344aS[email protected] break; 8640a6725849S[email protected] case SENT_CREATE_CONNECTION: 8641ea04fbd8SMatthias Ringwald // let hci_run_general_gap_le cancel outgoing connection 86420bf6344aS[email protected] hci_run(); 86430bf6344aS[email protected] break; 86440bf6344aS[email protected] default: 86450bf6344aS[email protected] break; 86460bf6344aS[email protected] } 864714f2d8f0SMatthias Ringwald } 864814f2d8f0SMatthias Ringwald break; 864943dfd98aSMatthias Ringwald default: 865014f2d8f0SMatthias Ringwald btstack_unreachable(); 865114f2d8f0SMatthias Ringwald break; 865214f2d8f0SMatthias Ringwald } 865314f2d8f0SMatthias Ringwald return ERROR_CODE_SUCCESS; 8654e31f89a7S[email protected] } 86554f3229d8S[email protected] 8656c37a3166S[email protected] /** 86576012052bSMatthias Ringwald * @brief Set connection parameters for outgoing connections 8658cbe54ab2SJakob Krantz * @param conn_scan_interval (unit: 0.625 msec), default: 60 ms 8659cbe54ab2SJakob Krantz * @param conn_scan_window (unit: 0.625 msec), default: 30 ms 86606012052bSMatthias Ringwald * @param conn_interval_min (unit: 1.25ms), default: 10 ms 86616012052bSMatthias Ringwald * @param conn_interval_max (unit: 1.25ms), default: 30 ms 86626012052bSMatthias Ringwald * @param conn_latency, default: 4 86636012052bSMatthias Ringwald * @param supervision_timeout (unit: 10ms), default: 720 ms 86646012052bSMatthias Ringwald * @param min_ce_length (unit: 0.625ms), default: 10 ms 86656012052bSMatthias Ringwald * @param max_ce_length (unit: 0.625ms), default: 30 ms 86666012052bSMatthias Ringwald */ 86676012052bSMatthias Ringwald 86680c2c5f79SMatthias Ringwald void gap_set_connection_phys(uint8_t phys){ 86690c2c5f79SMatthias Ringwald // LE Coded, LE 1M, LE 2M PHY 86700c2c5f79SMatthias Ringwald hci_stack->le_connection_phys = phys & 7; 86710c2c5f79SMatthias Ringwald } 86720c2c5f79SMatthias Ringwald 86730c2c5f79SMatthias Ringwald #endif 86740c2c5f79SMatthias Ringwald 8675cbe54ab2SJakob Krantz void gap_set_connection_parameters(uint16_t conn_scan_interval, uint16_t conn_scan_window, 8676cbe54ab2SJakob Krantz uint16_t conn_interval_min, uint16_t conn_interval_max, uint16_t conn_latency, 8677cbe54ab2SJakob Krantz uint16_t supervision_timeout, uint16_t min_ce_length, uint16_t max_ce_length){ 8678cbe54ab2SJakob Krantz hci_stack->le_connection_scan_interval = conn_scan_interval; 8679cbe54ab2SJakob Krantz hci_stack->le_connection_scan_window = conn_scan_window; 86806012052bSMatthias Ringwald hci_stack->le_connection_interval_min = conn_interval_min; 86816012052bSMatthias Ringwald hci_stack->le_connection_interval_max = conn_interval_max; 86826012052bSMatthias Ringwald hci_stack->le_connection_latency = conn_latency; 86836012052bSMatthias Ringwald hci_stack->le_supervision_timeout = supervision_timeout; 86846012052bSMatthias Ringwald hci_stack->le_minimum_ce_length = min_ce_length; 86856012052bSMatthias Ringwald hci_stack->le_maximum_ce_length = max_ce_length; 86866012052bSMatthias Ringwald } 86877eb5b27eSMatthias Ringwald 86886012052bSMatthias Ringwald /** 8689c37a3166S[email protected] * @brief Updates the connection parameters for a given LE connection 8690c37a3166S[email protected] * @param handle 8691c37a3166S[email protected] * @param conn_interval_min (unit: 1.25ms) 8692c37a3166S[email protected] * @param conn_interval_max (unit: 1.25ms) 8693c37a3166S[email protected] * @param conn_latency 8694c37a3166S[email protected] * @param supervision_timeout (unit: 10ms) 86956b65794dSMilanka Ringwald * @return 0 if ok 8696c37a3166S[email protected] */ 8697c37a3166S[email protected] int gap_update_connection_parameters(hci_con_handle_t con_handle, uint16_t conn_interval_min, 8698c37a3166S[email protected] uint16_t conn_interval_max, uint16_t conn_latency, uint16_t supervision_timeout){ 8699c37a3166S[email protected] hci_connection_t * connection = hci_connection_for_handle(con_handle); 8700c37a3166S[email protected] if (!connection) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 8701c37a3166S[email protected] connection->le_conn_interval_min = conn_interval_min; 8702c37a3166S[email protected] connection->le_conn_interval_max = conn_interval_max; 8703c37a3166S[email protected] connection->le_conn_latency = conn_latency; 8704c37a3166S[email protected] connection->le_supervision_timeout = supervision_timeout; 870584cf6d83SMatthias Ringwald connection->le_con_parameter_update_state = CON_PARAMETER_UPDATE_CHANGE_HCI_CON_PARAMETERS; 8706cfc59f1bSMatthias Ringwald hci_run(); 8707c37a3166S[email protected] return 0; 8708c37a3166S[email protected] } 8709c37a3166S[email protected] 871045c102fdSMatthias Ringwald /** 8711b68d7bc3SMatthias Ringwald * @brief Request an update of the connection parameter for a given LE connection 8712b68d7bc3SMatthias Ringwald * @param handle 8713b68d7bc3SMatthias Ringwald * @param conn_interval_min (unit: 1.25ms) 8714b68d7bc3SMatthias Ringwald * @param conn_interval_max (unit: 1.25ms) 8715b68d7bc3SMatthias Ringwald * @param conn_latency 8716b68d7bc3SMatthias Ringwald * @param supervision_timeout (unit: 10ms) 87176b65794dSMilanka Ringwald * @return 0 if ok 8718b68d7bc3SMatthias Ringwald */ 8719b68d7bc3SMatthias Ringwald int gap_request_connection_parameter_update(hci_con_handle_t con_handle, uint16_t conn_interval_min, 8720b68d7bc3SMatthias Ringwald uint16_t conn_interval_max, uint16_t conn_latency, uint16_t supervision_timeout){ 8721b68d7bc3SMatthias Ringwald hci_connection_t * connection = hci_connection_for_handle(con_handle); 8722b68d7bc3SMatthias Ringwald if (!connection) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 8723b68d7bc3SMatthias Ringwald connection->le_conn_interval_min = conn_interval_min; 8724b68d7bc3SMatthias Ringwald connection->le_conn_interval_max = conn_interval_max; 8725b68d7bc3SMatthias Ringwald connection->le_conn_latency = conn_latency; 8726b68d7bc3SMatthias Ringwald connection->le_supervision_timeout = supervision_timeout; 8727b68d7bc3SMatthias Ringwald connection->le_con_parameter_update_state = CON_PARAMETER_UPDATE_SEND_REQUEST; 872809c9c963SMatthias Ringwald uint8_t l2cap_trigger_run_event[2] = { L2CAP_EVENT_TRIGGER_RUN, 0}; 87299da9850bSMatthias Ringwald hci_emit_btstack_event(l2cap_trigger_run_event, sizeof(l2cap_trigger_run_event), 0); 8730b68d7bc3SMatthias Ringwald return 0; 8731b68d7bc3SMatthias Ringwald } 8732b68d7bc3SMatthias Ringwald 87339007c891SMatthias Ringwald uint8_t gap_request_connection_subrating(hci_con_handle_t con_handle, uint16_t subrate_min, uint16_t subrate_max, 87349007c891SMatthias Ringwald uint16_t max_latency, uint16_t continuation_number, uint16_t supervision_timeout){ 87359007c891SMatthias Ringwald hci_connection_t * connection = hci_connection_for_handle(con_handle); 87369007c891SMatthias Ringwald if (!connection) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 87379007c891SMatthias Ringwald 87389007c891SMatthias Ringwald connection->le_subrate_min = subrate_min; 87399007c891SMatthias Ringwald connection->le_subrate_max = subrate_max; 87409007c891SMatthias Ringwald connection->le_subrate_max_latency = max_latency; 87419007c891SMatthias Ringwald connection->le_subrate_continuation_number = continuation_number; 87429007c891SMatthias Ringwald connection->le_supervision_timeout = supervision_timeout; 87439007c891SMatthias Ringwald hci_run(); 87449007c891SMatthias Ringwald return ERROR_CODE_SUCCESS; 87459007c891SMatthias Ringwald } 87469007c891SMatthias Ringwald 8747d70217a2SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 8748d70217a2SMatthias Ringwald 87495e05c0afSMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 87505e05c0afSMatthias Ringwald static void hci_assert_advertisement_set_0_ready(void){ 87515e05c0afSMatthias Ringwald // force advertising set creation for legacy LE Advertising 87525e05c0afSMatthias Ringwald if ((hci_stack->le_advertisements_state & LE_ADVERTISEMENT_STATE_PARAMS_SET) == 0){ 87535e05c0afSMatthias Ringwald hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_SET_PARAMS; 87545e05c0afSMatthias Ringwald } 87555e05c0afSMatthias Ringwald } 87565e05c0afSMatthias Ringwald #endif 87575e05c0afSMatthias Ringwald 8758b68d7bc3SMatthias Ringwald /** 875945c102fdSMatthias Ringwald * @brief Set Advertisement Data 876045c102fdSMatthias Ringwald * @param advertising_data_length 876145c102fdSMatthias Ringwald * @param advertising_data (max 31 octets) 876245c102fdSMatthias Ringwald * @note data is not copied, pointer has to stay valid 876345c102fdSMatthias Ringwald */ 876445c102fdSMatthias Ringwald void gap_advertisements_set_data(uint8_t advertising_data_length, uint8_t * advertising_data){ 876545c102fdSMatthias Ringwald hci_stack->le_advertisements_data_len = advertising_data_length; 876645c102fdSMatthias Ringwald hci_stack->le_advertisements_data = advertising_data; 8767501f56b3SMatthias Ringwald hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_SET_ADV_DATA; 87685e05c0afSMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 87695e05c0afSMatthias Ringwald hci_assert_advertisement_set_0_ready(); 87705e05c0afSMatthias Ringwald #endif 8771bbc366e6SMatthias Ringwald hci_run(); 877245c102fdSMatthias Ringwald } 8773501f56b3SMatthias Ringwald 8774501f56b3SMatthias Ringwald /** 8775501f56b3SMatthias Ringwald * @brief Set Scan Response Data 8776501f56b3SMatthias Ringwald * @param advertising_data_length 8777501f56b3SMatthias Ringwald * @param advertising_data (max 31 octets) 8778501f56b3SMatthias Ringwald * @note data is not copied, pointer has to stay valid 8779501f56b3SMatthias Ringwald */ 8780501f56b3SMatthias Ringwald void gap_scan_response_set_data(uint8_t scan_response_data_length, uint8_t * scan_response_data){ 8781501f56b3SMatthias Ringwald hci_stack->le_scan_response_data_len = scan_response_data_length; 8782501f56b3SMatthias Ringwald hci_stack->le_scan_response_data = scan_response_data; 8783501f56b3SMatthias Ringwald hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_SET_SCAN_DATA; 87845e05c0afSMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 87855e05c0afSMatthias Ringwald hci_assert_advertisement_set_0_ready(); 87865e05c0afSMatthias Ringwald #endif 8787bbc366e6SMatthias Ringwald hci_run(); 878845c102fdSMatthias Ringwald } 878945c102fdSMatthias Ringwald 879045c102fdSMatthias Ringwald /** 879145c102fdSMatthias Ringwald * @brief Set Advertisement Parameters 879245c102fdSMatthias Ringwald * @param adv_int_min 879345c102fdSMatthias Ringwald * @param adv_int_max 879445c102fdSMatthias Ringwald * @param adv_type 879545c102fdSMatthias Ringwald * @param direct_address_type 879645c102fdSMatthias Ringwald * @param direct_address 879745c102fdSMatthias Ringwald * @param channel_map 879845c102fdSMatthias Ringwald * @param filter_policy 879945c102fdSMatthias Ringwald * 880045c102fdSMatthias Ringwald * @note internal use. use gap_advertisements_set_params from gap_le.h instead. 880145c102fdSMatthias Ringwald */ 880245c102fdSMatthias Ringwald void hci_le_advertisements_set_params(uint16_t adv_int_min, uint16_t adv_int_max, uint8_t adv_type, 8803b95a5a35SMatthias Ringwald uint8_t direct_address_typ, bd_addr_t direct_address, 880445c102fdSMatthias Ringwald uint8_t channel_map, uint8_t filter_policy) { 880545c102fdSMatthias Ringwald 880645c102fdSMatthias Ringwald hci_stack->le_advertisements_interval_min = adv_int_min; 880745c102fdSMatthias Ringwald hci_stack->le_advertisements_interval_max = adv_int_max; 880845c102fdSMatthias Ringwald hci_stack->le_advertisements_type = adv_type; 880945c102fdSMatthias Ringwald hci_stack->le_advertisements_direct_address_type = direct_address_typ; 881045c102fdSMatthias Ringwald hci_stack->le_advertisements_channel_map = channel_map; 881145c102fdSMatthias Ringwald hci_stack->le_advertisements_filter_policy = filter_policy; 88126535961aSMatthias Ringwald (void)memcpy(hci_stack->le_advertisements_direct_address, direct_address, 88136535961aSMatthias Ringwald 6); 881445c102fdSMatthias Ringwald 88156bf435a6SMatthias Ringwald hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_SET_PARAMS; 88166bf435a6SMatthias Ringwald hci_stack->le_advertisements_state |= LE_ADVERTISEMENT_STATE_PARAMS_SET; 8817bbc366e6SMatthias Ringwald hci_run(); 881845c102fdSMatthias Ringwald } 881945c102fdSMatthias Ringwald 882045c102fdSMatthias Ringwald /** 882145c102fdSMatthias Ringwald * @brief Enable/Disable Advertisements 882245c102fdSMatthias Ringwald * @param enabled 882345c102fdSMatthias Ringwald */ 882445c102fdSMatthias Ringwald void gap_advertisements_enable(int enabled){ 8825a408e724SMatthias Ringwald if (enabled == 0){ 8826a408e724SMatthias Ringwald hci_stack->le_advertisements_state &= ~LE_ADVERTISEMENT_STATE_ENABLED; 8827a408e724SMatthias Ringwald } else { 8828a408e724SMatthias Ringwald hci_stack->le_advertisements_state |= LE_ADVERTISEMENT_STATE_ENABLED; 8829a408e724SMatthias Ringwald } 8830bbc366e6SMatthias Ringwald hci_update_advertisements_enabled_for_current_roles(); 8831cfc59f1bSMatthias Ringwald hci_run(); 883245c102fdSMatthias Ringwald } 883345c102fdSMatthias Ringwald 8834a5770ecbSMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 8835a5770ecbSMatthias Ringwald static le_advertising_set_t * hci_advertising_set_for_handle(uint8_t advertising_handle){ 8836a5770ecbSMatthias Ringwald btstack_linked_list_iterator_t it; 8837a5770ecbSMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->le_advertising_sets); 8838a5770ecbSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 8839a5770ecbSMatthias Ringwald le_advertising_set_t * item = (le_advertising_set_t *) btstack_linked_list_iterator_next(&it); 8840a5770ecbSMatthias Ringwald if ( item->advertising_handle == advertising_handle ) { 8841a5770ecbSMatthias Ringwald return item; 8842a5770ecbSMatthias Ringwald } 8843a5770ecbSMatthias Ringwald } 8844a5770ecbSMatthias Ringwald return NULL; 8845a5770ecbSMatthias Ringwald } 8846a5770ecbSMatthias Ringwald 88472052d96cSMatthias Ringwald uint8_t gap_extended_advertising_set_resolvable_private_address_update(uint16_t update_s){ 88482052d96cSMatthias Ringwald hci_stack->le_resolvable_private_address_update_s = update_s; 88492052d96cSMatthias Ringwald hci_run(); 88502052d96cSMatthias Ringwald return ERROR_CODE_SUCCESS; 88512052d96cSMatthias Ringwald } 88522052d96cSMatthias Ringwald 8853a5770ecbSMatthias 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){ 88542d0c7965SMatthias Ringwald // find free advertisement handle. we use LE_EXTENDED_ADVERTISING_LEGACY_HANDLE for non-extended advertising 8855a5770ecbSMatthias Ringwald uint8_t advertisement_handle; 88562d0c7965SMatthias Ringwald for (advertisement_handle = LE_EXTENDED_ADVERTISING_LEGACY_HANDLE + 1; advertisement_handle <= LE_EXTENDED_ADVERTISING_MAX_HANDLE; advertisement_handle++){ 8857a5770ecbSMatthias Ringwald if (hci_advertising_set_for_handle(advertisement_handle) == NULL) break; 8858a5770ecbSMatthias Ringwald } 8859a5770ecbSMatthias Ringwald if (advertisement_handle > LE_EXTENDED_ADVERTISING_MAX_HANDLE) return ERROR_CODE_MEMORY_CAPACITY_EXCEEDED; 8860a5770ecbSMatthias Ringwald // clear 8861a5770ecbSMatthias Ringwald memset(storage, 0, sizeof(le_advertising_set_t)); 8862a5770ecbSMatthias Ringwald // copy params 88630cbe4690SMatthias Ringwald storage->advertising_handle = advertisement_handle; 886457a04237SMatthias Ringwald memcpy(&storage->extended_params, advertising_parameters, sizeof(le_extended_advertising_parameters_t)); 8865a5770ecbSMatthias Ringwald // add to list 8866a5770ecbSMatthias Ringwald bool add_ok = btstack_linked_list_add(&hci_stack->le_advertising_sets, (btstack_linked_item_t *) storage); 8867a5770ecbSMatthias Ringwald if (!add_ok) return ERROR_CODE_ACL_CONNECTION_ALREADY_EXISTS; 88680cbe4690SMatthias Ringwald *out_advertising_handle = advertisement_handle; 8869a5770ecbSMatthias Ringwald // set tasks and start 8870a5770ecbSMatthias Ringwald storage->tasks = LE_ADVERTISEMENT_TASKS_SET_PARAMS; 8871a5770ecbSMatthias Ringwald hci_run(); 8872a5770ecbSMatthias Ringwald return ERROR_CODE_SUCCESS; 8873a5770ecbSMatthias Ringwald } 8874a5770ecbSMatthias Ringwald 8875a5770ecbSMatthias Ringwald uint8_t gap_extended_advertising_set_params(uint8_t advertising_handle, const le_extended_advertising_parameters_t * advertising_parameters){ 8876a5770ecbSMatthias Ringwald le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(advertising_handle); 8877a5770ecbSMatthias Ringwald if (advertising_set == NULL) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 887857a04237SMatthias Ringwald memcpy(&advertising_set->extended_params, advertising_parameters, sizeof(le_extended_advertising_parameters_t)); 8879a5770ecbSMatthias Ringwald // set tasks and start 8880a5770ecbSMatthias Ringwald advertising_set->tasks |= LE_ADVERTISEMENT_TASKS_SET_PARAMS; 8881a5770ecbSMatthias Ringwald hci_run(); 8882a5770ecbSMatthias Ringwald return ERROR_CODE_SUCCESS; 8883a5770ecbSMatthias Ringwald } 8884a5770ecbSMatthias Ringwald 8885a5770ecbSMatthias Ringwald uint8_t gap_extended_advertising_get_params(uint8_t advertising_handle, le_extended_advertising_parameters_t * advertising_parameters){ 8886a5770ecbSMatthias Ringwald le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(advertising_handle); 8887a5770ecbSMatthias Ringwald if (advertising_set == NULL) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 888857a04237SMatthias Ringwald memcpy(advertising_parameters, &advertising_set->extended_params, sizeof(le_extended_advertising_parameters_t)); 8889a5770ecbSMatthias Ringwald return ERROR_CODE_SUCCESS; 8890a5770ecbSMatthias Ringwald } 8891a5770ecbSMatthias Ringwald 8892a5770ecbSMatthias Ringwald uint8_t gap_extended_advertising_set_random_address(uint8_t advertising_handle, bd_addr_t random_address){ 8893a5770ecbSMatthias Ringwald le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(advertising_handle); 8894a5770ecbSMatthias Ringwald if (advertising_set == NULL) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 8895a5770ecbSMatthias Ringwald memcpy(advertising_set->random_address, random_address, 6); 8896a5770ecbSMatthias Ringwald // set tasks and start 8897a5770ecbSMatthias Ringwald advertising_set->tasks |= LE_ADVERTISEMENT_TASKS_SET_ADDRESS; 8898a5770ecbSMatthias Ringwald hci_run(); 8899a5770ecbSMatthias Ringwald return ERROR_CODE_SUCCESS; 8900a5770ecbSMatthias Ringwald } 8901a5770ecbSMatthias Ringwald 89022e4aaf70SMatthias Ringwald uint8_t gap_extended_advertising_set_adv_data(uint8_t advertising_handle, uint16_t advertising_data_length, const uint8_t * advertising_data){ 8903a5770ecbSMatthias Ringwald le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(advertising_handle); 8904a5770ecbSMatthias Ringwald if (advertising_set == NULL) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 8905a5770ecbSMatthias Ringwald advertising_set->adv_data = advertising_data; 8906a5770ecbSMatthias Ringwald advertising_set->adv_data_len = advertising_data_length; 8907a5770ecbSMatthias Ringwald // set tasks and start 8908a5770ecbSMatthias Ringwald advertising_set->tasks |= LE_ADVERTISEMENT_TASKS_SET_ADV_DATA; 8909a5770ecbSMatthias Ringwald hci_run(); 8910a5770ecbSMatthias Ringwald return ERROR_CODE_SUCCESS; 8911a5770ecbSMatthias Ringwald } 8912a5770ecbSMatthias Ringwald 89132e4aaf70SMatthias 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){ 8914a5770ecbSMatthias Ringwald le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(advertising_handle); 8915a5770ecbSMatthias Ringwald if (advertising_set == NULL) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 8916a5770ecbSMatthias Ringwald advertising_set->scan_data = scan_response_data; 8917a5770ecbSMatthias Ringwald advertising_set->scan_data_len = scan_response_data_length; 8918a5770ecbSMatthias Ringwald // set tasks and start 8919a5770ecbSMatthias Ringwald advertising_set->tasks |= LE_ADVERTISEMENT_TASKS_SET_SCAN_DATA; 8920a5770ecbSMatthias Ringwald hci_run(); 8921a5770ecbSMatthias Ringwald return ERROR_CODE_SUCCESS; 8922a5770ecbSMatthias Ringwald } 8923a5770ecbSMatthias Ringwald 8924a5770ecbSMatthias Ringwald uint8_t gap_extended_advertising_start(uint8_t advertising_handle, uint16_t timeout, uint8_t num_extended_advertising_events){ 8925a5770ecbSMatthias Ringwald le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(advertising_handle); 8926a5770ecbSMatthias Ringwald if (advertising_set == NULL) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 8927a5770ecbSMatthias Ringwald advertising_set->enable_timeout = timeout; 8928a5770ecbSMatthias Ringwald advertising_set->enable_max_scan_events = num_extended_advertising_events; 8929a5770ecbSMatthias Ringwald // set tasks and start 8930a5770ecbSMatthias Ringwald advertising_set->state |= LE_ADVERTISEMENT_STATE_ENABLED; 8931a5770ecbSMatthias Ringwald hci_run(); 8932a5770ecbSMatthias Ringwald return ERROR_CODE_SUCCESS; 8933a5770ecbSMatthias Ringwald } 8934a5770ecbSMatthias Ringwald 8935a5770ecbSMatthias Ringwald uint8_t gap_extended_advertising_stop(uint8_t advertising_handle){ 8936a5770ecbSMatthias Ringwald le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(advertising_handle); 8937a5770ecbSMatthias Ringwald if (advertising_set == NULL) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 8938a5770ecbSMatthias Ringwald // set tasks and start 8939a5770ecbSMatthias Ringwald advertising_set->state &= ~LE_ADVERTISEMENT_STATE_ENABLED; 8940a5770ecbSMatthias Ringwald hci_run(); 8941a5770ecbSMatthias Ringwald return ERROR_CODE_SUCCESS; 8942a5770ecbSMatthias Ringwald } 8943a5770ecbSMatthias Ringwald 8944c814a904SMatthias Ringwald uint8_t gap_extended_advertising_remove(uint8_t advertising_handle){ 8945c814a904SMatthias Ringwald le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(advertising_handle); 8946c814a904SMatthias Ringwald if (advertising_set == NULL) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 8947c814a904SMatthias Ringwald // set tasks and start 8948c814a904SMatthias Ringwald advertising_set->tasks |= LE_ADVERTISEMENT_TASKS_REMOVE_SET; 8949c814a904SMatthias Ringwald hci_run(); 8950c814a904SMatthias Ringwald return ERROR_CODE_SUCCESS; 8951c814a904SMatthias Ringwald } 8952c814a904SMatthias Ringwald 8953c814a904SMatthias Ringwald #ifdef ENABLE_LE_PERIODIC_ADVERTISING 8954c814a904SMatthias Ringwald uint8_t gap_periodic_advertising_set_params(uint8_t advertising_handle, const le_periodic_advertising_parameters_t * advertising_parameters){ 8955c814a904SMatthias Ringwald le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(advertising_handle); 8956c814a904SMatthias Ringwald if (advertising_set == NULL) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 8957c814a904SMatthias Ringwald // periodic advertising requires neither connectable, scannable, legacy or anonymous 8958c814a904SMatthias Ringwald if ((advertising_set->extended_params.advertising_event_properties & 0x1f) != 0) return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS; 8959c814a904SMatthias Ringwald memcpy(&advertising_set->periodic_params, advertising_parameters, sizeof(le_periodic_advertising_parameters_t)); 8960c814a904SMatthias Ringwald // set tasks and start 8961c814a904SMatthias Ringwald advertising_set->tasks |= LE_ADVERTISEMENT_TASKS_SET_PERIODIC_PARAMS; 8962c814a904SMatthias Ringwald hci_run(); 8963c814a904SMatthias Ringwald return ERROR_CODE_SUCCESS; 8964c814a904SMatthias Ringwald } 8965c814a904SMatthias Ringwald 8966c814a904SMatthias Ringwald uint8_t gap_periodic_advertising_get_params(uint8_t advertising_handle, le_periodic_advertising_parameters_t * advertising_parameters){ 8967c814a904SMatthias Ringwald le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(advertising_handle); 8968c814a904SMatthias Ringwald if (advertising_set == NULL) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 8969c814a904SMatthias Ringwald memcpy(advertising_parameters, &advertising_set->extended_params, sizeof(le_periodic_advertising_parameters_t)); 8970c814a904SMatthias Ringwald return ERROR_CODE_SUCCESS; 8971c814a904SMatthias Ringwald } 8972c814a904SMatthias Ringwald 8973c814a904SMatthias Ringwald uint8_t gap_periodic_advertising_set_data(uint8_t advertising_handle, uint16_t periodic_data_length, const uint8_t * periodic_data){ 8974c814a904SMatthias Ringwald le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(advertising_handle); 8975c814a904SMatthias Ringwald if (advertising_set == NULL) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 8976c814a904SMatthias Ringwald advertising_set->periodic_data = periodic_data; 8977c814a904SMatthias Ringwald advertising_set->periodic_data_len = periodic_data_length; 8978c814a904SMatthias Ringwald // set tasks and start 8979c814a904SMatthias Ringwald advertising_set->tasks |= LE_ADVERTISEMENT_TASKS_SET_PERIODIC_DATA; 8980c814a904SMatthias Ringwald hci_run(); 8981c814a904SMatthias Ringwald return ERROR_CODE_SUCCESS; 8982c814a904SMatthias Ringwald } 8983c814a904SMatthias Ringwald 898453f240c0SMatthias Ringwald uint8_t gap_periodic_advertising_start(uint8_t advertising_handle, bool include_adi){ 898553f240c0SMatthias Ringwald le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(advertising_handle); 898653f240c0SMatthias Ringwald if (advertising_set == NULL) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 898753f240c0SMatthias Ringwald // set tasks and start 898853f240c0SMatthias Ringwald advertising_set->periodic_include_adi = include_adi; 898953f240c0SMatthias Ringwald advertising_set->state |= LE_ADVERTISEMENT_STATE_PERIODIC_ENABLED; 899053f240c0SMatthias Ringwald hci_run(); 899153f240c0SMatthias Ringwald return ERROR_CODE_SUCCESS; 899253f240c0SMatthias Ringwald } 899353f240c0SMatthias Ringwald 899453f240c0SMatthias Ringwald uint8_t gap_periodic_advertising_stop(uint8_t advertising_handle){ 899553f240c0SMatthias Ringwald le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(advertising_handle); 899653f240c0SMatthias Ringwald if (advertising_set == NULL) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 899753f240c0SMatthias Ringwald // set tasks and start 899853f240c0SMatthias Ringwald advertising_set->state &= ~LE_ADVERTISEMENT_STATE_PERIODIC_ENABLED; 899953f240c0SMatthias Ringwald hci_run(); 900053f240c0SMatthias Ringwald return ERROR_CODE_SUCCESS; 900153f240c0SMatthias Ringwald } 900298aa715fSMatthias Ringwald 90034718c38dSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 900498aa715fSMatthias 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){ 900598aa715fSMatthias Ringwald hci_stack->le_past_mode = mode; 900698aa715fSMatthias Ringwald hci_stack->le_past_skip = skip; 900798aa715fSMatthias Ringwald hci_stack->le_past_sync_timeout = sync_timeout; 900898aa715fSMatthias Ringwald hci_stack->le_past_cte_type = cte_type; 900998aa715fSMatthias Ringwald hci_stack->le_past_set_default_params = true; 901098aa715fSMatthias Ringwald hci_run(); 901198aa715fSMatthias Ringwald return ERROR_CODE_SUCCESS; 901298aa715fSMatthias Ringwald } 901398aa715fSMatthias Ringwald 90143bd96807SMatthias 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){ 90153bd96807SMatthias Ringwald hci_connection_t * hci_connection = hci_connection_for_handle(con_handle); 90163bd96807SMatthias Ringwald if (hci_connection == NULL){ 90173bd96807SMatthias Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 90183bd96807SMatthias Ringwald } 90193bd96807SMatthias Ringwald hci_connection->le_past_sync_handle = sync_handle; 90203bd96807SMatthias Ringwald hci_connection->le_past_service_data = service_data; 90213bd96807SMatthias Ringwald hci_run(); 90223bd96807SMatthias Ringwald return ERROR_CODE_SUCCESS; 90233bd96807SMatthias Ringwald } 90244718c38dSMatthias Ringwald #endif 90253bd96807SMatthias Ringwald 9026027f4677SMatthias Ringwald uint8_t gap_periodic_advertising_set_info_transfer_send(hci_con_handle_t con_handle, uint16_t service_data, uint8_t advertising_handle){ 9027027f4677SMatthias Ringwald hci_connection_t * hci_connection = hci_connection_for_handle(con_handle); 9028027f4677SMatthias Ringwald if (hci_connection == NULL){ 9029027f4677SMatthias Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 9030027f4677SMatthias Ringwald } 9031027f4677SMatthias Ringwald hci_connection->le_past_advertising_handle = advertising_handle; 9032027f4677SMatthias Ringwald hci_connection->le_past_service_data = service_data; 9033027f4677SMatthias Ringwald hci_run(); 9034027f4677SMatthias Ringwald return ERROR_CODE_SUCCESS; 9035027f4677SMatthias Ringwald } 9036027f4677SMatthias Ringwald 9037c814a904SMatthias Ringwald #endif /* ENABLE_LE_PERIODIC_ADVERTISING */ 903853f240c0SMatthias Ringwald 9039a5770ecbSMatthias Ringwald #endif 9040a5770ecbSMatthias Ringwald 904135454696SMatthias Ringwald #endif 904206e5cf96SMatthias Ringwald 904306e5cf96SMatthias Ringwald void hci_le_set_own_address_type(uint8_t own_address_type){ 904406e5cf96SMatthias Ringwald log_info("hci_le_set_own_address_type: old %u, new %u", hci_stack->le_own_addr_type, own_address_type); 904506e5cf96SMatthias Ringwald if (own_address_type == hci_stack->le_own_addr_type) return; 904606e5cf96SMatthias Ringwald hci_stack->le_own_addr_type = own_address_type; 904706e5cf96SMatthias Ringwald 904864068776SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 904906e5cf96SMatthias Ringwald // update advertisement parameters, too 905006e5cf96SMatthias Ringwald hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_SET_PARAMS; 9051bbc366e6SMatthias Ringwald hci_run(); 905264068776SMatthias Ringwald #endif 905364068776SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 905406e5cf96SMatthias Ringwald // note: we don't update scan parameters or modify ongoing connection attempts 905564068776SMatthias Ringwald #endif 905606e5cf96SMatthias Ringwald } 905706e5cf96SMatthias Ringwald 90589136bde8SMatthias Ringwald void hci_le_random_address_set(const bd_addr_t random_address){ 9059137a570aSMatthias Ringwald log_info("gap_privacy: hci_le_random_address_set %s", bd_addr_to_str(random_address)); 90609136bde8SMatthias Ringwald memcpy(hci_stack->le_random_address, random_address, 6); 90619136bde8SMatthias Ringwald hci_stack->le_random_address_set = true; 9062137a570aSMatthias Ringwald hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_SET_ADDRESS | LE_ADVERTISEMENT_TASKS_PRIVACY_NOTIFY; 90639ce6dfa1SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 906422f987e4SMatthias Ringwald if (hci_le_extended_advertising_supported()){ 90655e05c0afSMatthias Ringwald hci_assert_advertisement_set_0_ready(); 90669ce6dfa1SMatthias Ringwald hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_SET_ADDRESS_SET_0; 90679ce6dfa1SMatthias Ringwald } 90689ce6dfa1SMatthias Ringwald #endif 90699136bde8SMatthias Ringwald hci_run(); 90709136bde8SMatthias Ringwald } 90719136bde8SMatthias Ringwald 9072d70217a2SMatthias Ringwald #endif 907345c102fdSMatthias Ringwald 9074616edd56SMatthias Ringwald uint8_t gap_disconnect(hci_con_handle_t handle){ 90755917a5c5S[email protected] hci_connection_t * conn = hci_connection_for_handle(handle); 90765917a5c5S[email protected] if (!conn){ 90777851196eSmatthias.ringwald hci_emit_disconnection_complete(handle, 0); 9078616edd56SMatthias Ringwald return 0; 90795917a5c5S[email protected] } 908061972f0aSMatthias Ringwald uint8_t status = ERROR_CODE_SUCCESS; 908161972f0aSMatthias Ringwald switch (conn->state){ 908261972f0aSMatthias Ringwald case RECEIVED_DISCONNECTION_COMPLETE: 908361972f0aSMatthias Ringwald // ignore if remote just disconnected 908461972f0aSMatthias Ringwald break; 908561972f0aSMatthias Ringwald case SEND_DISCONNECT: 908661972f0aSMatthias Ringwald case SENT_DISCONNECT: 908761972f0aSMatthias Ringwald // disconnect already requested or sent 908861972f0aSMatthias Ringwald status = ERROR_CODE_COMMAND_DISALLOWED; 908961972f0aSMatthias Ringwald break; 909061972f0aSMatthias Ringwald default: 909161972f0aSMatthias Ringwald // trigger hci_disconnect 90925917a5c5S[email protected] conn->state = SEND_DISCONNECT; 90935917a5c5S[email protected] hci_run(); 909461972f0aSMatthias Ringwald break; 909561972f0aSMatthias Ringwald } 909661972f0aSMatthias Ringwald return status; 90974f3229d8S[email protected] } 909804a6ef8cSmatthias.ringwald 9099228e430cSMatthias Ringwald int gap_read_rssi(hci_con_handle_t con_handle){ 9100228e430cSMatthias Ringwald hci_connection_t * hci_connection = hci_connection_for_handle(con_handle); 9101228e430cSMatthias Ringwald if (hci_connection == NULL) return 0; 910222df2fe2SMatthias Ringwald hci_connection->gap_connection_tasks |= GAP_CONNECTION_TASK_READ_RSSI; 9103228e430cSMatthias Ringwald hci_run(); 9104228e430cSMatthias Ringwald return 1; 9105228e430cSMatthias Ringwald } 9106228e430cSMatthias Ringwald 9107a1bf5ae7SMatthias Ringwald /** 9108a1bf5ae7SMatthias Ringwald * @brief Get connection type 9109a1bf5ae7SMatthias Ringwald * @param con_handle 9110a1bf5ae7SMatthias Ringwald * @result connection_type 9111a1bf5ae7SMatthias Ringwald */ 9112a1bf5ae7SMatthias Ringwald gap_connection_type_t gap_get_connection_type(hci_con_handle_t connection_handle){ 9113a1bf5ae7SMatthias Ringwald hci_connection_t * conn = hci_connection_for_handle(connection_handle); 9114a1bf5ae7SMatthias Ringwald if (!conn) return GAP_CONNECTION_INVALID; 9115a1bf5ae7SMatthias Ringwald switch (conn->address_type){ 9116a1bf5ae7SMatthias Ringwald case BD_ADDR_TYPE_LE_PUBLIC: 9117a1bf5ae7SMatthias Ringwald case BD_ADDR_TYPE_LE_RANDOM: 9118ad9f3530SMatthias Ringwald case BD_ADDR_TYPE_LE_PUBLIC_IDENTITY: 9119ad9f3530SMatthias Ringwald case BD_ADDR_TYPE_LE_RANDOM_IDENTITY: 9120a1bf5ae7SMatthias Ringwald return GAP_CONNECTION_LE; 9121a1bf5ae7SMatthias Ringwald case BD_ADDR_TYPE_SCO: 9122a1bf5ae7SMatthias Ringwald return GAP_CONNECTION_SCO; 9123f16129ceSMatthias Ringwald case BD_ADDR_TYPE_ACL: 9124a1bf5ae7SMatthias Ringwald return GAP_CONNECTION_ACL; 9125a1bf5ae7SMatthias Ringwald default: 9126a1bf5ae7SMatthias Ringwald return GAP_CONNECTION_INVALID; 9127a1bf5ae7SMatthias Ringwald } 9128a1bf5ae7SMatthias Ringwald } 9129a1bf5ae7SMatthias Ringwald 91302dceb1d6SMatthias Ringwald hci_role_t gap_get_role(hci_con_handle_t connection_handle){ 91312dceb1d6SMatthias Ringwald hci_connection_t * conn = hci_connection_for_handle(connection_handle); 91322dceb1d6SMatthias Ringwald if (!conn) return HCI_ROLE_INVALID; 91332dceb1d6SMatthias Ringwald return (hci_role_t) conn->role; 91342dceb1d6SMatthias Ringwald } 91352dceb1d6SMatthias Ringwald 91362dceb1d6SMatthias Ringwald 913744f858f3SMatthias Ringwald #ifdef ENABLE_CLASSIC 9138667ba9d1SMatthias Ringwald uint8_t gap_request_role(const bd_addr_t addr, hci_role_t role){ 913988a03c8dSMatthias Ringwald hci_connection_t * conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL); 914088a03c8dSMatthias Ringwald if (!conn) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 914188a03c8dSMatthias Ringwald conn->request_role = role; 914288a03c8dSMatthias Ringwald hci_run(); 9143d04a455eSMatthias Ringwald return ERROR_CODE_SUCCESS; 914488a03c8dSMatthias Ringwald } 914544f858f3SMatthias Ringwald #endif 914688a03c8dSMatthias Ringwald 9147a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE 91484f551432SMatthias Ringwald 91499d8be771SMatthias 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){ 9150b45b7749SMilanka Ringwald hci_connection_t * conn = hci_connection_for_handle(con_handle); 9151b90f6e0aSMatthias Ringwald if (!conn) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 9152b90f6e0aSMatthias Ringwald 9153b90f6e0aSMatthias Ringwald conn->le_phy_update_all_phys = all_phys; 9154b90f6e0aSMatthias Ringwald conn->le_phy_update_tx_phys = tx_phys; 9155b90f6e0aSMatthias Ringwald conn->le_phy_update_rx_phys = rx_phys; 91569d8be771SMatthias Ringwald conn->le_phy_update_phy_options = (uint8_t) phy_options; 9157b90f6e0aSMatthias Ringwald 9158b90f6e0aSMatthias Ringwald hci_run(); 9159b90f6e0aSMatthias Ringwald 9160b90f6e0aSMatthias Ringwald return 0; 9161b90f6e0aSMatthias Ringwald } 9162b90f6e0aSMatthias Ringwald 9163667ba9d1SMatthias Ringwald static uint8_t hci_whitelist_add(bd_addr_type_t address_type, const bd_addr_t address){ 9164100da355SMatthias Ringwald 9165100da355SMatthias Ringwald #if !defined(HAVE_MALLOC) && (!defined(MAX_NR_WHITELIST_ENTRIES) || (MAX_NR_WHITELIST_ENTRIES == 0)) 9166100da355SMatthias Ringwald // incorrect configuration: 9167100da355SMatthias Ringwald // - as MAX_NR_WHITELIST_ENTRIES is not defined or zero this function always fails 9168100da355SMatthias Ringwald // - please set MAX_NR_WHITELIST_ENTRIES in btstack_config.h 9169100da355SMatthias Ringwald btstack_assert(false); 9170100da355SMatthias Ringwald #endif 9171100da355SMatthias Ringwald 91727a92a9dbSMatthias Ringwald // check if already in list 91737a92a9dbSMatthias Ringwald btstack_linked_list_iterator_t it; 91747a92a9dbSMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->le_whitelist); 91757a92a9dbSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)) { 91767a92a9dbSMatthias Ringwald whitelist_entry_t *entry = (whitelist_entry_t *) btstack_linked_list_iterator_next(&it); 91777a92a9dbSMatthias Ringwald if (entry->address_type != address_type) { 91787a92a9dbSMatthias Ringwald continue; 91797a92a9dbSMatthias Ringwald } 91807a92a9dbSMatthias Ringwald if (memcmp(entry->address, address, 6) != 0) { 91817a92a9dbSMatthias Ringwald continue; 91827a92a9dbSMatthias Ringwald } 9183caaf5151SMilanka Ringwald 9184caaf5151SMilanka Ringwald // if already on controller: 9185caaf5151SMilanka Ringwald if ((entry->state & LE_WHITELIST_ON_CONTROLLER) != 0){ 9186caaf5151SMilanka Ringwald if ((entry->state & LE_WHITELIST_REMOVE_FROM_CONTROLLER) != 0){ 9187caaf5151SMilanka Ringwald // drop remove request 9188caaf5151SMilanka Ringwald entry->state = LE_WHITELIST_ON_CONTROLLER; 9189caaf5151SMilanka Ringwald return ERROR_CODE_SUCCESS; 9190caaf5151SMilanka Ringwald } else { 9191caaf5151SMilanka Ringwald // disallow as already on controller 91927a92a9dbSMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 91937a92a9dbSMatthias Ringwald } 9194287379ccSMatthias Ringwald } 9195caaf5151SMilanka Ringwald 9196caaf5151SMilanka Ringwald // assume scheduled to add 9197caaf5151SMilanka Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 9198caaf5151SMilanka Ringwald } 9199caaf5151SMilanka Ringwald 92007a92a9dbSMatthias Ringwald // alloc and add to list 9201e83201bcSMatthias Ringwald whitelist_entry_t * entry = btstack_memory_whitelist_entry_get(); 9202e83201bcSMatthias Ringwald if (!entry) return BTSTACK_MEMORY_ALLOC_FAILED; 9203e83201bcSMatthias Ringwald entry->address_type = address_type; 92046535961aSMatthias Ringwald (void)memcpy(entry->address, address, 6); 9205e83201bcSMatthias Ringwald entry->state = LE_WHITELIST_ADD_TO_CONTROLLER; 9206665d90f2SMatthias Ringwald btstack_linked_list_add(&hci_stack->le_whitelist, (btstack_linked_item_t*) entry); 9207226db5efSMatthias Ringwald return ERROR_CODE_SUCCESS; 9208ac9c45e0SMatthias Ringwald } 9209ac9c45e0SMatthias Ringwald 9210667ba9d1SMatthias Ringwald static uint8_t hci_whitelist_remove(bd_addr_type_t address_type, const bd_addr_t address){ 9211665d90f2SMatthias Ringwald btstack_linked_list_iterator_t it; 9212665d90f2SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->le_whitelist); 9213665d90f2SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 9214665d90f2SMatthias Ringwald whitelist_entry_t * entry = (whitelist_entry_t*) btstack_linked_list_iterator_next(&it); 92157a92a9dbSMatthias Ringwald if (entry->address_type != address_type) { 92167a92a9dbSMatthias Ringwald continue; 92177a92a9dbSMatthias Ringwald } 92187a92a9dbSMatthias Ringwald if (memcmp(entry->address, address, 6) != 0) { 92197a92a9dbSMatthias Ringwald continue; 92207a92a9dbSMatthias Ringwald } 9221e83201bcSMatthias Ringwald if (entry->state & LE_WHITELIST_ON_CONTROLLER){ 9222e83201bcSMatthias Ringwald // remove from controller if already present 9223e83201bcSMatthias Ringwald entry->state |= LE_WHITELIST_REMOVE_FROM_CONTROLLER; 9224a3b69fdeSMatthias Ringwald } else { 9225226db5efSMatthias Ringwald // directly remove entry from whitelist 9226665d90f2SMatthias Ringwald btstack_linked_list_iterator_remove(&it); 9227e83201bcSMatthias Ringwald btstack_memory_whitelist_entry_free(entry); 9228e83201bcSMatthias Ringwald } 9229a3b69fdeSMatthias Ringwald return ERROR_CODE_SUCCESS; 9230a3b69fdeSMatthias Ringwald } 9231a3b69fdeSMatthias Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 923242ff5ba1SMatthias Ringwald } 923342ff5ba1SMatthias Ringwald 9234226db5efSMatthias Ringwald static void hci_whitelist_clear(void){ 9235665d90f2SMatthias Ringwald btstack_linked_list_iterator_t it; 9236665d90f2SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->le_whitelist); 9237665d90f2SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 9238665d90f2SMatthias Ringwald whitelist_entry_t * entry = (whitelist_entry_t*) btstack_linked_list_iterator_next(&it); 9239e83201bcSMatthias Ringwald if (entry->state & LE_WHITELIST_ON_CONTROLLER){ 9240e83201bcSMatthias Ringwald // remove from controller if already present 9241e83201bcSMatthias Ringwald entry->state |= LE_WHITELIST_REMOVE_FROM_CONTROLLER; 9242e83201bcSMatthias Ringwald continue; 9243e83201bcSMatthias Ringwald } 924491915b0bSMatthias Ringwald // directly remove entry from whitelist 9245665d90f2SMatthias Ringwald btstack_linked_list_iterator_remove(&it); 9246e83201bcSMatthias Ringwald btstack_memory_whitelist_entry_free(entry); 9247e83201bcSMatthias Ringwald } 9248226db5efSMatthias Ringwald } 9249226db5efSMatthias Ringwald 9250a3b69fdeSMatthias Ringwald /** 9251a3b69fdeSMatthias Ringwald * @brief Clear Whitelist 92526b65794dSMilanka Ringwald * @return 0 if ok 9253a3b69fdeSMatthias Ringwald */ 9254a3b69fdeSMatthias Ringwald uint8_t gap_whitelist_clear(void){ 9255a3b69fdeSMatthias Ringwald hci_whitelist_clear(); 9256a3b69fdeSMatthias Ringwald hci_run(); 9257a3b69fdeSMatthias Ringwald return ERROR_CODE_SUCCESS; 9258a3b69fdeSMatthias Ringwald } 9259a3b69fdeSMatthias Ringwald 9260a3b69fdeSMatthias Ringwald /** 9261a3b69fdeSMatthias Ringwald * @brief Add Device to Whitelist 9262a3b69fdeSMatthias Ringwald * @param address_typ 9263a3b69fdeSMatthias Ringwald * @param address 92646b65794dSMilanka Ringwald * @return 0 if ok 9265a3b69fdeSMatthias Ringwald */ 9266667ba9d1SMatthias Ringwald uint8_t gap_whitelist_add(bd_addr_type_t address_type, const bd_addr_t address){ 9267a3b69fdeSMatthias Ringwald uint8_t status = hci_whitelist_add(address_type, address); 9268a3b69fdeSMatthias Ringwald if (status){ 9269a3b69fdeSMatthias Ringwald return status; 9270a3b69fdeSMatthias Ringwald } 9271a3b69fdeSMatthias Ringwald hci_run(); 9272a3b69fdeSMatthias Ringwald return ERROR_CODE_SUCCESS; 9273a3b69fdeSMatthias Ringwald } 9274a3b69fdeSMatthias Ringwald 9275a3b69fdeSMatthias Ringwald /** 9276a3b69fdeSMatthias Ringwald * @brief Remove Device from Whitelist 9277a3b69fdeSMatthias Ringwald * @param address_typ 9278a3b69fdeSMatthias Ringwald * @param address 92796b65794dSMilanka Ringwald * @return 0 if ok 9280a3b69fdeSMatthias Ringwald */ 9281667ba9d1SMatthias Ringwald uint8_t gap_whitelist_remove(bd_addr_type_t address_type, const bd_addr_t address){ 9282a3b69fdeSMatthias Ringwald uint8_t status = hci_whitelist_remove(address_type, address); 9283a3b69fdeSMatthias Ringwald if (status){ 9284a3b69fdeSMatthias Ringwald return status; 9285a3b69fdeSMatthias Ringwald } 9286a3b69fdeSMatthias Ringwald hci_run(); 9287a3b69fdeSMatthias Ringwald return ERROR_CODE_SUCCESS; 9288a3b69fdeSMatthias Ringwald } 9289a3b69fdeSMatthias Ringwald 9290226db5efSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 9291226db5efSMatthias Ringwald /** 929295e257d9SMatthias Ringwald * @brief Connect with Whitelist 929395e257d9SMatthias Ringwald * @note Explicit whitelist management and this connect with whitelist replace deprecated gap_auto_connection_* functions 92946b65794dSMilanka Ringwald * @return - if ok 929595e257d9SMatthias Ringwald */ 929695e257d9SMatthias Ringwald uint8_t gap_connect_with_whitelist(void){ 929795e257d9SMatthias Ringwald if (hci_stack->le_connecting_request != LE_CONNECTING_IDLE){ 929895e257d9SMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 929995e257d9SMatthias Ringwald } 930095e257d9SMatthias Ringwald hci_stack->le_connecting_request = LE_CONNECTING_WHITELIST; 930195e257d9SMatthias Ringwald hci_run(); 930295e257d9SMatthias Ringwald return ERROR_CODE_SUCCESS; 930395e257d9SMatthias Ringwald } 930495e257d9SMatthias Ringwald 930595e257d9SMatthias Ringwald /** 9306226db5efSMatthias Ringwald * @brief Auto Connection Establishment - Start Connecting to device 9307226db5efSMatthias Ringwald * @param address_typ 9308226db5efSMatthias Ringwald * @param address 93096b65794dSMilanka Ringwald * @return 0 if ok 9310226db5efSMatthias Ringwald */ 9311667ba9d1SMatthias Ringwald uint8_t gap_auto_connection_start(bd_addr_type_t address_type, const bd_addr_t address){ 931295e257d9SMatthias Ringwald if (hci_stack->le_connecting_request == LE_CONNECTING_DIRECT){ 9313226db5efSMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 9314226db5efSMatthias Ringwald } 9315226db5efSMatthias Ringwald 9316226db5efSMatthias Ringwald uint8_t status = hci_whitelist_add(address_type, address); 931763f2efc9SMatthias Ringwald if (status == BTSTACK_MEMORY_ALLOC_FAILED) { 9318226db5efSMatthias Ringwald return status; 9319226db5efSMatthias Ringwald } 9320226db5efSMatthias Ringwald 9321226db5efSMatthias Ringwald hci_stack->le_connecting_request = LE_CONNECTING_WHITELIST; 9322226db5efSMatthias Ringwald 9323226db5efSMatthias Ringwald hci_run(); 932495e257d9SMatthias Ringwald return ERROR_CODE_SUCCESS; 9325226db5efSMatthias Ringwald } 9326226db5efSMatthias Ringwald 9327226db5efSMatthias Ringwald /** 9328226db5efSMatthias Ringwald * @brief Auto Connection Establishment - Stop Connecting to device 9329226db5efSMatthias Ringwald * @param address_typ 9330226db5efSMatthias Ringwald * @param address 93316b65794dSMilanka Ringwald * @return 0 if ok 9332226db5efSMatthias Ringwald */ 9333667ba9d1SMatthias Ringwald uint8_t gap_auto_connection_stop(bd_addr_type_t address_type, const bd_addr_t address){ 933495e257d9SMatthias Ringwald if (hci_stack->le_connecting_request == LE_CONNECTING_DIRECT){ 933595e257d9SMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 933695e257d9SMatthias Ringwald } 933795e257d9SMatthias Ringwald 9338226db5efSMatthias Ringwald hci_whitelist_remove(address_type, address); 933995e257d9SMatthias Ringwald if (btstack_linked_list_empty(&hci_stack->le_whitelist)){ 934095e257d9SMatthias Ringwald hci_stack->le_connecting_request = LE_CONNECTING_IDLE; 934195e257d9SMatthias Ringwald } 9342226db5efSMatthias Ringwald hci_run(); 9343226db5efSMatthias Ringwald return 0; 9344226db5efSMatthias Ringwald } 9345226db5efSMatthias Ringwald 9346226db5efSMatthias Ringwald /** 9347226db5efSMatthias Ringwald * @brief Auto Connection Establishment - Stop everything 9348226db5efSMatthias Ringwald * @note Convenience function to stop all active auto connection attempts 9349226db5efSMatthias Ringwald */ 935095e257d9SMatthias Ringwald uint8_t gap_auto_connection_stop_all(void){ 935195e257d9SMatthias Ringwald if (hci_stack->le_connecting_request == LE_CONNECTING_DIRECT) { 935295e257d9SMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 935395e257d9SMatthias Ringwald } 9354226db5efSMatthias Ringwald hci_whitelist_clear(); 9355226db5efSMatthias Ringwald hci_stack->le_connecting_request = LE_CONNECTING_IDLE; 9356e83201bcSMatthias Ringwald hci_run(); 935795e257d9SMatthias Ringwald return ERROR_CODE_SUCCESS; 9358ac9c45e0SMatthias Ringwald } 9359c9db5c21SMilanka Ringwald 9360b45b7749SMilanka Ringwald uint16_t gap_le_connection_interval(hci_con_handle_t con_handle){ 9361b45b7749SMilanka Ringwald hci_connection_t * conn = hci_connection_for_handle(con_handle); 9362c9db5c21SMilanka Ringwald if (!conn) return 0; 9363c9db5c21SMilanka Ringwald return conn->le_connection_interval; 9364c9db5c21SMilanka Ringwald } 9365d70217a2SMatthias Ringwald #endif 93664f551432SMatthias Ringwald #endif 93674f551432SMatthias Ringwald 936835454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 9369ac9c45e0SMatthias Ringwald /** 9370ff00ed1cSMatthias Ringwald * @brief Set Extended Inquiry Response data 9371a8c4e5adSMatthias Ringwald * @param eir_data size HCI_EXTENDED_INQUIRY_RESPONSE_DATA_LEN (240) bytes, is not copied make sure memory is accessible during stack startup 9372ff00ed1cSMatthias Ringwald * @note has to be done before stack starts up 9373ff00ed1cSMatthias Ringwald */ 9374ff00ed1cSMatthias Ringwald void gap_set_extended_inquiry_response(const uint8_t * data){ 9375ff00ed1cSMatthias Ringwald hci_stack->eir_data = data; 9376baa4881eSMatthias Ringwald hci_stack->gap_tasks_classic |= GAP_TASK_SET_EIR_DATA; 937759d59ecfSMatthias Ringwald hci_run(); 9378ff00ed1cSMatthias Ringwald } 9379ff00ed1cSMatthias Ringwald 9380ff00ed1cSMatthias Ringwald /** 9381f5875de5SMatthias Ringwald * @brief Start GAP Classic Inquiry 9382f5875de5SMatthias Ringwald * @param duration in 1.28s units 9383f5875de5SMatthias Ringwald * @return 0 if ok 9384f5875de5SMatthias Ringwald * @events: GAP_EVENT_INQUIRY_RESULT, GAP_EVENT_INQUIRY_COMPLETE 9385f5875de5SMatthias Ringwald */ 9386f5875de5SMatthias Ringwald int gap_inquiry_start(uint8_t duration_in_1280ms_units){ 938799449554SMatthias Ringwald if (hci_stack->state != HCI_STATE_WORKING) return ERROR_CODE_COMMAND_DISALLOWED; 9388f5875de5SMatthias Ringwald if (hci_stack->inquiry_state != GAP_INQUIRY_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED; 9389a1df452eSMatthias Ringwald if ((duration_in_1280ms_units < GAP_INQUIRY_DURATION_MIN) || (duration_in_1280ms_units > GAP_INQUIRY_DURATION_MAX)){ 9390f5875de5SMatthias Ringwald return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS; 9391f5875de5SMatthias Ringwald } 9392f5875de5SMatthias Ringwald hci_stack->inquiry_state = duration_in_1280ms_units; 939330199e24SMatthias Ringwald hci_stack->inquiry_max_period_length = 0; 939430199e24SMatthias Ringwald hci_stack->inquiry_min_period_length = 0; 939530199e24SMatthias Ringwald hci_run(); 939630199e24SMatthias Ringwald return 0; 939730199e24SMatthias Ringwald } 939830199e24SMatthias Ringwald 939930199e24SMatthias Ringwald uint8_t gap_inquiry_periodic_start(uint8_t duration, uint16_t max_period_length, uint16_t min_period_length){ 940030199e24SMatthias Ringwald if (hci_stack->state != HCI_STATE_WORKING) return ERROR_CODE_COMMAND_DISALLOWED; 940130199e24SMatthias Ringwald if (hci_stack->inquiry_state != GAP_INQUIRY_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED; 940230199e24SMatthias Ringwald if (duration < GAP_INQUIRY_DURATION_MIN) return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS; 940330199e24SMatthias Ringwald if (duration > GAP_INQUIRY_DURATION_MAX) return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS; 940430199e24SMatthias Ringwald if (max_period_length < GAP_INQUIRY_MAX_PERIODIC_LEN_MIN) return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS;; 940530199e24SMatthias Ringwald if (min_period_length < GAP_INQUIRY_MIN_PERIODIC_LEN_MIN) return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS;; 940630199e24SMatthias Ringwald 940730199e24SMatthias Ringwald hci_stack->inquiry_state = duration; 940830199e24SMatthias Ringwald hci_stack->inquiry_max_period_length = max_period_length; 940930199e24SMatthias Ringwald hci_stack->inquiry_min_period_length = min_period_length; 9410f5875de5SMatthias Ringwald hci_run(); 9411f5875de5SMatthias Ringwald return 0; 9412f5875de5SMatthias Ringwald } 9413f5875de5SMatthias Ringwald 9414f5875de5SMatthias Ringwald /** 9415f5875de5SMatthias Ringwald * @brief Stop GAP Classic Inquiry 94166b65794dSMilanka Ringwald * @return 0 if ok 9417f5875de5SMatthias Ringwald */ 9418f5875de5SMatthias Ringwald int gap_inquiry_stop(void){ 9419a1df452eSMatthias Ringwald if ((hci_stack->inquiry_state >= GAP_INQUIRY_DURATION_MIN) && (hci_stack->inquiry_state <= GAP_INQUIRY_DURATION_MAX)) { 9420f5875de5SMatthias Ringwald // emit inquiry complete event, before it even started 9421f5875de5SMatthias Ringwald uint8_t event[] = { GAP_EVENT_INQUIRY_COMPLETE, 1, 0}; 94229da9850bSMatthias Ringwald hci_emit_btstack_event(event, sizeof(event), 1); 9423f5875de5SMatthias Ringwald return 0; 9424f5875de5SMatthias Ringwald } 942530199e24SMatthias Ringwald switch (hci_stack->inquiry_state){ 942630199e24SMatthias Ringwald case GAP_INQUIRY_STATE_ACTIVE: 9427f5875de5SMatthias Ringwald hci_stack->inquiry_state = GAP_INQUIRY_STATE_W2_CANCEL; 9428f5875de5SMatthias Ringwald hci_run(); 942930199e24SMatthias Ringwald return ERROR_CODE_SUCCESS; 943030199e24SMatthias Ringwald case GAP_INQUIRY_STATE_PERIODIC: 943130199e24SMatthias Ringwald hci_stack->inquiry_state = GAP_INQUIRY_STATE_W2_EXIT_PERIODIC; 943230199e24SMatthias Ringwald hci_run(); 943330199e24SMatthias Ringwald return ERROR_CODE_SUCCESS; 943430199e24SMatthias Ringwald default: 943530199e24SMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 943630199e24SMatthias Ringwald } 9437f5875de5SMatthias Ringwald } 9438f5875de5SMatthias Ringwald 9439496bb884SMatthias Ringwald void gap_inquiry_set_lap(uint32_t lap){ 9440496bb884SMatthias Ringwald hci_stack->inquiry_lap = lap; 9441496bb884SMatthias Ringwald } 9442496bb884SMatthias Ringwald 94431dc973e7SMatthias Ringwald void gap_inquiry_set_scan_activity(uint16_t inquiry_scan_interval, uint16_t inquiry_scan_window){ 9444c0c8a829SMatthias Ringwald hci_stack->inquiry_scan_interval = inquiry_scan_interval; 9445c0c8a829SMatthias Ringwald hci_stack->inquiry_scan_window = inquiry_scan_window; 9446baa4881eSMatthias Ringwald hci_stack->gap_tasks_classic |= GAP_TASK_WRITE_INQUIRY_SCAN_ACTIVITY; 9447c0c8a829SMatthias Ringwald hci_run(); 9448c0c8a829SMatthias Ringwald } 9449c0c8a829SMatthias Ringwald 9450f50ed5acSAndrey Fominykh void gap_inquiry_set_transmit_power_level(int8_t tx_power) 9451f50ed5acSAndrey Fominykh { 9452f50ed5acSAndrey Fominykh hci_stack->inquiry_tx_power_level = tx_power; 9453f50ed5acSAndrey Fominykh hci_stack->gap_tasks_classic |= GAP_TASK_WRITE_INQUIRY_TX_POWER_LEVEL; 9454f50ed5acSAndrey Fominykh hci_run(); 9455f50ed5acSAndrey Fominykh } 9456f50ed5acSAndrey Fominykh 9457b7f1ee76SMatthias Ringwald 9458b7f1ee76SMatthias Ringwald /** 9459b7f1ee76SMatthias Ringwald * @brief Remote Name Request 9460b7f1ee76SMatthias Ringwald * @param addr 9461b7f1ee76SMatthias Ringwald * @param page_scan_repetition_mode 9462b7f1ee76SMatthias Ringwald * @param clock_offset only used when bit 15 is set 9463b7f1ee76SMatthias Ringwald * @events: HCI_EVENT_REMOTE_NAME_REQUEST_COMPLETE 9464b7f1ee76SMatthias Ringwald */ 9465667ba9d1SMatthias Ringwald int gap_remote_name_request(const bd_addr_t addr, uint8_t page_scan_repetition_mode, uint16_t clock_offset){ 9466b7f1ee76SMatthias Ringwald if (hci_stack->remote_name_state != GAP_REMOTE_NAME_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED; 94676535961aSMatthias Ringwald (void)memcpy(hci_stack->remote_name_addr, addr, 6); 9468b7f1ee76SMatthias Ringwald hci_stack->remote_name_page_scan_repetition_mode = page_scan_repetition_mode; 9469b7f1ee76SMatthias Ringwald hci_stack->remote_name_clock_offset = clock_offset; 9470b7f1ee76SMatthias Ringwald hci_stack->remote_name_state = GAP_REMOTE_NAME_STATE_W2_SEND; 9471b7f1ee76SMatthias Ringwald hci_run(); 9472b7f1ee76SMatthias Ringwald return 0; 9473b7f1ee76SMatthias Ringwald } 9474b7f1ee76SMatthias Ringwald 9475667ba9d1SMatthias Ringwald static int gap_pairing_set_state_and_run(const bd_addr_t addr, uint8_t state){ 94760a51f88bSMatthias Ringwald hci_stack->gap_pairing_state = state; 94776535961aSMatthias Ringwald (void)memcpy(hci_stack->gap_pairing_addr, addr, 6); 94780a51f88bSMatthias Ringwald hci_run(); 94790a51f88bSMatthias Ringwald return 0; 94800a51f88bSMatthias Ringwald } 94810a51f88bSMatthias Ringwald 94820a51f88bSMatthias Ringwald /** 9483aad97216SMatthias Ringwald * @brief Legacy Pairing Pin Code Response for binary data / non-strings 9484aad97216SMatthias Ringwald * @param addr 9485aad97216SMatthias Ringwald * @param pin_data 9486aad97216SMatthias Ringwald * @param pin_len 9487aad97216SMatthias Ringwald * @return 0 if ok 9488aad97216SMatthias Ringwald */ 9489667ba9d1SMatthias Ringwald int gap_pin_code_response_binary(const bd_addr_t addr, const uint8_t * pin_data, uint8_t pin_len){ 9490aad97216SMatthias Ringwald if (hci_stack->gap_pairing_state != GAP_PAIRING_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED; 9491c26f2c7bSMatthias Ringwald if (pin_len > PIN_CODE_LEN) return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS; 9492aad97216SMatthias Ringwald hci_stack->gap_pairing_input.gap_pairing_pin = pin_data; 9493aad97216SMatthias Ringwald hci_stack->gap_pairing_pin_len = pin_len; 9494aad97216SMatthias Ringwald return gap_pairing_set_state_and_run(addr, GAP_PAIRING_STATE_SEND_PIN); 9495aad97216SMatthias Ringwald } 9496aad97216SMatthias Ringwald 9497aad97216SMatthias Ringwald /** 94980a51f88bSMatthias Ringwald * @brief Legacy Pairing Pin Code Response 94990a51f88bSMatthias Ringwald * @param addr 95000a51f88bSMatthias Ringwald * @param pin 95010a51f88bSMatthias Ringwald * @return 0 if ok 95020a51f88bSMatthias Ringwald */ 9503667ba9d1SMatthias Ringwald int gap_pin_code_response(const bd_addr_t addr, const char * pin){ 95049d78a7ecSMatthias Ringwald return gap_pin_code_response_binary(addr, (const uint8_t*) pin, (uint8_t) strlen(pin)); 95050a51f88bSMatthias Ringwald } 95060a51f88bSMatthias Ringwald 95070a51f88bSMatthias Ringwald /** 95080a51f88bSMatthias Ringwald * @brief Abort Legacy Pairing 95090a51f88bSMatthias Ringwald * @param addr 95100a51f88bSMatthias Ringwald * @param pin 95110a51f88bSMatthias Ringwald * @return 0 if ok 95120a51f88bSMatthias Ringwald */ 95130a51f88bSMatthias Ringwald int gap_pin_code_negative(bd_addr_t addr){ 9514cd74063aSMatthias Ringwald if (hci_stack->gap_pairing_state != GAP_PAIRING_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED; 95150a51f88bSMatthias Ringwald return gap_pairing_set_state_and_run(addr, GAP_PAIRING_STATE_SEND_PIN_NEGATIVE); 95160a51f88bSMatthias Ringwald } 95170a51f88bSMatthias Ringwald 95180a51f88bSMatthias Ringwald /** 95190a51f88bSMatthias Ringwald * @brief SSP Passkey Response 95200a51f88bSMatthias Ringwald * @param addr 95210a51f88bSMatthias Ringwald * @param passkey 95220a51f88bSMatthias Ringwald * @return 0 if ok 95230a51f88bSMatthias Ringwald */ 9524667ba9d1SMatthias Ringwald int gap_ssp_passkey_response(const bd_addr_t addr, uint32_t passkey){ 9525cd74063aSMatthias Ringwald if (hci_stack->gap_pairing_state != GAP_PAIRING_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED; 9526d504181aSMatthias Ringwald hci_stack->gap_pairing_input.gap_pairing_passkey = passkey; 95270a51f88bSMatthias Ringwald return gap_pairing_set_state_and_run(addr, GAP_PAIRING_STATE_SEND_PASSKEY); 95280a51f88bSMatthias Ringwald } 95290a51f88bSMatthias Ringwald 95300a51f88bSMatthias Ringwald /** 95310a51f88bSMatthias Ringwald * @brief Abort SSP Passkey Entry/Pairing 95320a51f88bSMatthias Ringwald * @param addr 95330a51f88bSMatthias Ringwald * @param pin 95340a51f88bSMatthias Ringwald * @return 0 if ok 95350a51f88bSMatthias Ringwald */ 9536667ba9d1SMatthias Ringwald int gap_ssp_passkey_negative(const bd_addr_t addr){ 9537cd74063aSMatthias Ringwald if (hci_stack->gap_pairing_state != GAP_PAIRING_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED; 95380a51f88bSMatthias Ringwald return gap_pairing_set_state_and_run(addr, GAP_PAIRING_STATE_SEND_PASSKEY_NEGATIVE); 95390a51f88bSMatthias Ringwald } 95400a51f88bSMatthias Ringwald 95410a51f88bSMatthias Ringwald /** 95420a51f88bSMatthias Ringwald * @brief Accept SSP Numeric Comparison 95430a51f88bSMatthias Ringwald * @param addr 95440a51f88bSMatthias Ringwald * @param passkey 95450a51f88bSMatthias Ringwald * @return 0 if ok 95460a51f88bSMatthias Ringwald */ 9547667ba9d1SMatthias Ringwald int gap_ssp_confirmation_response(const bd_addr_t addr){ 9548cd74063aSMatthias Ringwald if (hci_stack->gap_pairing_state != GAP_PAIRING_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED; 95490a51f88bSMatthias Ringwald return gap_pairing_set_state_and_run(addr, GAP_PAIRING_STATE_SEND_CONFIRMATION); 95500a51f88bSMatthias Ringwald } 95510a51f88bSMatthias Ringwald 95520a51f88bSMatthias Ringwald /** 95530a51f88bSMatthias Ringwald * @brief Abort SSP Numeric Comparison/Pairing 95540a51f88bSMatthias Ringwald * @param addr 95550a51f88bSMatthias Ringwald * @param pin 95560a51f88bSMatthias Ringwald * @return 0 if ok 95570a51f88bSMatthias Ringwald */ 9558667ba9d1SMatthias Ringwald int gap_ssp_confirmation_negative(const bd_addr_t addr){ 9559cd74063aSMatthias Ringwald if (hci_stack->gap_pairing_state != GAP_PAIRING_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED; 95600a51f88bSMatthias Ringwald return gap_pairing_set_state_and_run(addr, GAP_PAIRING_STATE_SEND_CONFIRMATION_NEGATIVE); 95610a51f88bSMatthias Ringwald } 95620a51f88bSMatthias Ringwald 9563308eeaffSMatthias Ringwald #if defined(ENABLE_EXPLICIT_IO_CAPABILITIES_REPLY) || defined(ENABLE_EXPLICIT_LINK_KEY_REPLY) 956444565b0cSMatthias Ringwald static uint8_t gap_set_auth_flag_and_run(const bd_addr_t addr, hci_authentication_flags_t flag){ 956544565b0cSMatthias Ringwald hci_connection_t * conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL); 956644565b0cSMatthias Ringwald if (!conn) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 956744565b0cSMatthias Ringwald connectionSetAuthenticationFlags(conn, flag); 956844565b0cSMatthias Ringwald hci_run(); 956944565b0cSMatthias Ringwald return ERROR_CODE_SUCCESS; 957044565b0cSMatthias Ringwald } 9571308eeaffSMatthias Ringwald #endif 957244565b0cSMatthias Ringwald 9573308eeaffSMatthias Ringwald #ifdef ENABLE_EXPLICIT_IO_CAPABILITIES_REPLY 957444565b0cSMatthias Ringwald uint8_t gap_ssp_io_capabilities_response(const bd_addr_t addr){ 95757ca4a7edSMatthias Ringwald return gap_set_auth_flag_and_run(addr, AUTH_FLAG_SEND_IO_CAPABILITIES_REPLY); 957644565b0cSMatthias Ringwald } 957744565b0cSMatthias Ringwald 957844565b0cSMatthias Ringwald uint8_t gap_ssp_io_capabilities_negative(const bd_addr_t addr){ 95797ca4a7edSMatthias Ringwald return gap_set_auth_flag_and_run(addr, AUTH_FLAG_SEND_IO_CAPABILITIES_NEGATIVE_REPLY); 958044565b0cSMatthias Ringwald } 958144565b0cSMatthias Ringwald #endif 958244565b0cSMatthias Ringwald 95831849becdSMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB 95841849becdSMatthias Ringwald /** 95851849becdSMatthias Ringwald * @brief Report Remote OOB Data 95861849becdSMatthias Ringwald * @param bd_addr 95871849becdSMatthias Ringwald * @param c_192 Simple Pairing Hash C derived from P-192 public key 95881849becdSMatthias Ringwald * @param r_192 Simple Pairing Randomizer derived from P-192 public key 95891849becdSMatthias Ringwald * @param c_256 Simple Pairing Hash C derived from P-256 public key 95901849becdSMatthias Ringwald * @param r_256 Simple Pairing Randomizer derived from P-256 public key 95911849becdSMatthias Ringwald */ 95921849becdSMatthias 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){ 95931849becdSMatthias Ringwald hci_connection_t * connection = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL); 95941849becdSMatthias Ringwald if (connection == NULL) { 95951849becdSMatthias Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 95961849becdSMatthias Ringwald } 95971849becdSMatthias Ringwald connection->classic_oob_c_192 = c_192; 95981849becdSMatthias Ringwald connection->classic_oob_r_192 = r_192; 9599204e8f1dSMatthias Ringwald 9600204e8f1dSMatthias Ringwald // ignore P-256 if not supported by us 9601204e8f1dSMatthias Ringwald if (hci_stack->secure_connections_active){ 96021849becdSMatthias Ringwald connection->classic_oob_c_256 = c_256; 96031849becdSMatthias Ringwald connection->classic_oob_r_256 = r_256; 9604204e8f1dSMatthias Ringwald } 9605204e8f1dSMatthias Ringwald 96061849becdSMatthias Ringwald return ERROR_CODE_SUCCESS; 96071849becdSMatthias Ringwald } 9608cf01e888SMatthias Ringwald /** 9609cf01e888SMatthias Ringwald * @brief Generate new OOB data 9610cf01e888SMatthias Ringwald * @note OOB data will be provided in GAP_EVENT_LOCAL_OOB_DATA and be used in future pairing procedures 9611cf01e888SMatthias Ringwald */ 9612cf01e888SMatthias Ringwald void gap_ssp_generate_oob_data(void){ 9613cf01e888SMatthias Ringwald hci_stack->classic_read_local_oob_data = true; 9614cf01e888SMatthias Ringwald hci_run(); 9615cf01e888SMatthias Ringwald } 9616cf01e888SMatthias Ringwald 96171849becdSMatthias Ringwald #endif 96181849becdSMatthias Ringwald 9619308eeaffSMatthias Ringwald #ifdef ENABLE_EXPLICIT_LINK_KEY_REPLY 9620308eeaffSMatthias Ringwald uint8_t gap_send_link_key_response(const bd_addr_t addr, link_key_t link_key, link_key_type_t type){ 9621308eeaffSMatthias Ringwald hci_connection_t * connection = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL); 9622308eeaffSMatthias Ringwald if (connection == NULL) { 9623308eeaffSMatthias Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 9624308eeaffSMatthias Ringwald } 9625308eeaffSMatthias Ringwald 9626308eeaffSMatthias Ringwald memcpy(connection->link_key, link_key, sizeof(link_key_t)); 9627308eeaffSMatthias Ringwald connection->link_key_type = type; 9628308eeaffSMatthias Ringwald 9629308eeaffSMatthias Ringwald return gap_set_auth_flag_and_run(addr, AUTH_FLAG_HANDLE_LINK_KEY_REQUEST); 9630308eeaffSMatthias Ringwald } 9631308eeaffSMatthias Ringwald 9632308eeaffSMatthias Ringwald #endif // ENABLE_EXPLICIT_LINK_KEY_REPLY 9633f5875de5SMatthias Ringwald /** 9634f6858d14SMatthias Ringwald * @brief Set inquiry mode: standard, with RSSI, with RSSI + Extended Inquiry Results. Has to be called before power on. 9635f5875de5SMatthias Ringwald * @param inquiry_mode see bluetooth_defines.h 9636f6858d14SMatthias Ringwald */ 9637b45b7749SMilanka Ringwald void hci_set_inquiry_mode(inquiry_mode_t inquiry_mode){ 9638b45b7749SMilanka Ringwald hci_stack->inquiry_mode = inquiry_mode; 9639f6858d14SMatthias Ringwald } 9640f6858d14SMatthias Ringwald 9641f6858d14SMatthias Ringwald /** 9642d950d659SMatthias Ringwald * @brief Configure Voice Setting for use with SCO data in HSP/HFP 9643d950d659SMatthias Ringwald */ 9644d950d659SMatthias Ringwald void hci_set_sco_voice_setting(uint16_t voice_setting){ 9645d950d659SMatthias Ringwald hci_stack->sco_voice_setting = voice_setting; 9646d950d659SMatthias Ringwald } 9647d950d659SMatthias Ringwald 9648d950d659SMatthias Ringwald /** 9649d950d659SMatthias Ringwald * @brief Get SCO Voice Setting 9650d950d659SMatthias Ringwald * @return current voice setting 9651d950d659SMatthias Ringwald */ 96520cb5b971SMatthias Ringwald uint16_t hci_get_sco_voice_setting(void){ 9653d950d659SMatthias Ringwald return hci_stack->sco_voice_setting; 9654d950d659SMatthias Ringwald } 9655d950d659SMatthias Ringwald 9656400ff5abSMatthias Ringwald static int hci_have_usb_transport(void){ 9657400ff5abSMatthias Ringwald if (!hci_stack->hci_transport) return 0; 9658400ff5abSMatthias Ringwald const char * transport_name = hci_stack->hci_transport->name; 9659400ff5abSMatthias Ringwald if (!transport_name) return 0; 9660400ff5abSMatthias Ringwald return (transport_name[0] == 'H') && (transport_name[1] == '2'); 9661400ff5abSMatthias Ringwald } 9662400ff5abSMatthias Ringwald 96639427aeb5SMatthias Ringwald static uint16_t hci_sco_packet_length_for_payload_length(uint16_t payload_size){ 966420dcdd22SMatthias Ringwald uint16_t sco_packet_length = 0; 9665cf119f3bSMatthias Ringwald 966691dfed7eSMatthias Ringwald #if defined(ENABLE_SCO_OVER_HCI) || defined (HAVE_SCO_TRANSPORT) 9667a086dc35SMatthias Ringwald // Transparent = mSBC => 1, CVSD with 16-bit samples requires twice as many bytes 966873f498e7SMatthias Ringwald int multiplier; 966973f498e7SMatthias Ringwald if (((hci_stack->sco_voice_setting_active & 0x03) != 0x03) && 967073f498e7SMatthias Ringwald ((hci_stack->sco_voice_setting_active & 0x20) == 0x20)) { 967173f498e7SMatthias Ringwald multiplier = 2; 967273f498e7SMatthias Ringwald } else { 967373f498e7SMatthias Ringwald multiplier = 1; 967473f498e7SMatthias Ringwald } 967591dfed7eSMatthias Ringwald #endif 967691dfed7eSMatthias Ringwald 96779427aeb5SMatthias Ringwald #ifdef ENABLE_SCO_OVER_HCI 9678400ff5abSMatthias Ringwald if (hci_have_usb_transport()){ 9679400ff5abSMatthias Ringwald // see Core Spec for H2 USB Transfer. 9680cf119f3bSMatthias Ringwald // 3 byte SCO header + 24 bytes per connection 96819427aeb5SMatthias Ringwald // @note multiple sco connections not supported currently 96829427aeb5SMatthias Ringwald sco_packet_length = 3 + 24 * multiplier; 9683400ff5abSMatthias Ringwald } else { 96849427aeb5SMatthias Ringwald // 3 byte SCO header + SCO packet length over the air 96859427aeb5SMatthias Ringwald sco_packet_length = 3 + payload_size * multiplier; 9686d966a453SMatthias Ringwald // assert that it still fits inside an SCO buffer 9687ad915196SMatthias Ringwald if (sco_packet_length > (hci_stack->sco_data_packet_length + 3)){ 96889427aeb5SMatthias Ringwald sco_packet_length = 3 + hci_stack->sco_data_packet_length; 9689d966a453SMatthias Ringwald } 9690400ff5abSMatthias Ringwald } 9691a3069afeSMatthias Ringwald #endif 96925b7087c7SMatthias Ringwald #ifdef HAVE_SCO_TRANSPORT 96939427aeb5SMatthias Ringwald // 3 byte SCO header + SCO packet length over the air 96949427aeb5SMatthias Ringwald sco_packet_length = 3 + payload_size * multiplier; 96959427aeb5SMatthias Ringwald // assert that it still fits inside an SCO buffer 96969427aeb5SMatthias Ringwald if (sco_packet_length > (hci_stack->sco_data_packet_length + 3)){ 96979427aeb5SMatthias Ringwald sco_packet_length = 3 + hci_stack->sco_data_packet_length; 96989427aeb5SMatthias Ringwald } 96995b7087c7SMatthias Ringwald #endif 9700a3069afeSMatthias Ringwald return sco_packet_length; 9701b3aad8daSMatthias Ringwald } 9702b3aad8daSMatthias Ringwald 97039427aeb5SMatthias Ringwald uint16_t hci_get_sco_packet_length_for_connection(hci_con_handle_t sco_con_handle){ 97049427aeb5SMatthias Ringwald hci_connection_t * connection = hci_connection_for_handle(sco_con_handle); 97059427aeb5SMatthias Ringwald if (connection != NULL){ 97069427aeb5SMatthias Ringwald return hci_sco_packet_length_for_payload_length(connection->sco_payload_length); 97079427aeb5SMatthias Ringwald } 97089427aeb5SMatthias Ringwald return 0; 97099427aeb5SMatthias Ringwald } 97109427aeb5SMatthias Ringwald 97119427aeb5SMatthias Ringwald uint16_t hci_get_sco_packet_length(void){ 97129427aeb5SMatthias Ringwald btstack_linked_list_iterator_t it; 97139427aeb5SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->connections); 97149427aeb5SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 97159427aeb5SMatthias Ringwald hci_connection_t * connection = (hci_connection_t *) btstack_linked_list_iterator_next(&it); 97169427aeb5SMatthias Ringwald if ( connection->address_type == BD_ADDR_TYPE_SCO ) { 97179427aeb5SMatthias Ringwald return hci_sco_packet_length_for_payload_length(connection->sco_payload_length);; 97189427aeb5SMatthias Ringwald } 97199427aeb5SMatthias Ringwald } 97209427aeb5SMatthias Ringwald return 0; 97219427aeb5SMatthias Ringwald } 97229427aeb5SMatthias Ringwald 9723c4c88f1bSJakob Krantz /** 9724c4c88f1bSJakob Krantz * @brief Sets the master/slave policy 9725c4c88f1bSJakob Krantz * @param policy (0: attempt to become master, 1: let connecting device decide) 9726c4c88f1bSJakob Krantz */ 9727c4c88f1bSJakob Krantz void hci_set_master_slave_policy(uint8_t policy){ 9728c4c88f1bSJakob Krantz hci_stack->master_slave_policy = policy; 9729c4c88f1bSJakob Krantz } 9730c4c88f1bSJakob Krantz 9731c4c88f1bSJakob Krantz #endif 9732ec111c8bSMatthias Ringwald 9733ec111c8bSMatthias Ringwald HCI_STATE hci_get_state(void){ 9734ec111c8bSMatthias Ringwald return hci_stack->state; 9735ec111c8bSMatthias Ringwald } 9736ec111c8bSMatthias Ringwald 973707e010b6SMilanka Ringwald #ifdef ENABLE_CLASSIC 97385e91d96cSMatthias Ringwald void gap_register_classic_connection_filter(int (*accept_callback)(bd_addr_t addr, hci_link_type_t link_type)){ 973907e010b6SMilanka Ringwald hci_stack->gap_classic_accept_callback = accept_callback; 974007e010b6SMilanka Ringwald } 974107e010b6SMilanka Ringwald #endif 9742ec111c8bSMatthias Ringwald 9743d950d659SMatthias Ringwald /** 9744d23838ecSMatthias Ringwald * @brief Set callback for Bluetooth Hardware Error 9745d23838ecSMatthias Ringwald */ 9746c2e1fa60SMatthias Ringwald void hci_set_hardware_error_callback(void (*fn)(uint8_t error)){ 9747d23838ecSMatthias Ringwald hci_stack->hardware_error_callback = fn; 9748d23838ecSMatthias Ringwald } 9749d23838ecSMatthias Ringwald 975071de195eSMatthias Ringwald void hci_disconnect_all(void){ 9751665d90f2SMatthias Ringwald btstack_linked_list_iterator_t it; 9752665d90f2SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->connections); 9753665d90f2SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 9754665d90f2SMatthias Ringwald hci_connection_t * con = (hci_connection_t*) btstack_linked_list_iterator_next(&it); 975504a6ef8cSmatthias.ringwald if (con->state == SENT_DISCONNECT) continue; 975604a6ef8cSmatthias.ringwald con->state = SEND_DISCONNECT; 975704a6ef8cSmatthias.ringwald } 9758d31fba26S[email protected] hci_run(); 975904a6ef8cSmatthias.ringwald } 976033373e40SMatthias Ringwald 976133373e40SMatthias Ringwald uint16_t hci_get_manufacturer(void){ 976233373e40SMatthias Ringwald return hci_stack->manufacturer; 976333373e40SMatthias Ringwald } 97649c6e867eSMatthias Ringwald 97653e329ddfSandryblack #ifdef ENABLE_BLE 97669c6e867eSMatthias Ringwald static sm_connection_t * sm_get_connection_for_handle(hci_con_handle_t con_handle){ 97679c6e867eSMatthias Ringwald hci_connection_t * hci_con = hci_connection_for_handle(con_handle); 97689c6e867eSMatthias Ringwald if (!hci_con) return NULL; 97699c6e867eSMatthias Ringwald return &hci_con->sm_connection; 97709c6e867eSMatthias Ringwald } 97719c6e867eSMatthias Ringwald 97729c6e867eSMatthias Ringwald // extracted from sm.c to allow enabling of l2cap le data channels without adding sm.c to the build 9773a086dc35SMatthias Ringwald // without sm.c default values from create_connection_for_bd_addr_and_type() result in non-encrypted, not-authenticated 97746a79f6baSMatthias Ringwald #endif 97759c6e867eSMatthias Ringwald 97766d105c71SMatthias Ringwald uint8_t gap_encryption_key_size(hci_con_handle_t con_handle){ 9777c5fb5ca4SMatthias Ringwald hci_connection_t * hci_connection = hci_connection_for_handle(con_handle); 9778c5fb5ca4SMatthias Ringwald if (hci_connection == NULL) return 0; 9779c5fb5ca4SMatthias Ringwald if (hci_is_le_connection(hci_connection)){ 97806a79f6baSMatthias Ringwald #ifdef ENABLE_BLE 9781c5fb5ca4SMatthias Ringwald sm_connection_t * sm_conn = &hci_connection->sm_connection; 9782c7bead46SMatthias Ringwald if (sm_conn->sm_connection_encrypted != 0u) { 97839c6e867eSMatthias Ringwald return sm_conn->sm_actual_encryption_key_size; 97849c6e867eSMatthias Ringwald } 97856a79f6baSMatthias Ringwald #endif 97866a79f6baSMatthias Ringwald } else { 9787c5fb5ca4SMatthias Ringwald #ifdef ENABLE_CLASSIC 97888daf94bcSMatthias Ringwald if ((hci_connection->authentication_flags & AUTH_FLAG_CONNECTION_ENCRYPTED)){ 9789c5fb5ca4SMatthias Ringwald return hci_connection->encryption_key_size; 9790c5fb5ca4SMatthias Ringwald } 9791c5fb5ca4SMatthias Ringwald #endif 97926a79f6baSMatthias Ringwald } 9793c5fb5ca4SMatthias Ringwald return 0; 9794c5fb5ca4SMatthias Ringwald } 97959c6e867eSMatthias Ringwald 9796ff3f1026SMatthias Ringwald bool gap_authenticated(hci_con_handle_t con_handle){ 9797c5fb5ca4SMatthias Ringwald hci_connection_t * hci_connection = hci_connection_for_handle(con_handle); 9798ff3f1026SMatthias Ringwald if (hci_connection == NULL) return false; 97995f3981bfSMatthias Ringwald 9800c5fb5ca4SMatthias Ringwald switch (hci_connection->address_type){ 98016a79f6baSMatthias Ringwald #ifdef ENABLE_BLE 98025f3981bfSMatthias Ringwald case BD_ADDR_TYPE_LE_PUBLIC: 98035f3981bfSMatthias Ringwald case BD_ADDR_TYPE_LE_RANDOM: 9804d9e1bf33SMatthias Ringwald case BD_ADDR_TYPE_LE_PUBLIC_IDENTITY: 9805d9e1bf33SMatthias Ringwald case BD_ADDR_TYPE_LE_RANDOM_IDENTITY: 9806c5fb5ca4SMatthias Ringwald if (hci_connection->sm_connection.sm_connection_encrypted == 0) return 0; // unencrypted connection cannot be authenticated 9807ff3f1026SMatthias Ringwald return hci_connection->sm_connection.sm_connection_authenticated != 0; 98086a79f6baSMatthias Ringwald #endif 980959a1a47aSMatthias Ringwald #ifdef ENABLE_CLASSIC 98105f3981bfSMatthias Ringwald case BD_ADDR_TYPE_SCO: 9811f16129ceSMatthias Ringwald case BD_ADDR_TYPE_ACL: 9812ff3f1026SMatthias Ringwald return gap_authenticated_for_link_key_type(hci_connection->link_key_type); 981359a1a47aSMatthias Ringwald #endif 98145f3981bfSMatthias Ringwald default: 9815ff3f1026SMatthias Ringwald return false; 98165f3981bfSMatthias Ringwald } 98179c6e867eSMatthias Ringwald } 98189c6e867eSMatthias Ringwald 9819f461b3dfSMatthias Ringwald bool gap_secure_connection(hci_con_handle_t con_handle){ 9820c5fb5ca4SMatthias Ringwald hci_connection_t * hci_connection = hci_connection_for_handle(con_handle); 9821c5fb5ca4SMatthias Ringwald if (hci_connection == NULL) return 0; 98228b35e16aSMatthias Ringwald 9823c5fb5ca4SMatthias Ringwald switch (hci_connection->address_type){ 98246a79f6baSMatthias Ringwald #ifdef ENABLE_BLE 98258b35e16aSMatthias Ringwald case BD_ADDR_TYPE_LE_PUBLIC: 98268b35e16aSMatthias Ringwald case BD_ADDR_TYPE_LE_RANDOM: 9827d9e1bf33SMatthias Ringwald case BD_ADDR_TYPE_LE_PUBLIC_IDENTITY: 9828d9e1bf33SMatthias Ringwald case BD_ADDR_TYPE_LE_RANDOM_IDENTITY: 9829f461b3dfSMatthias Ringwald if (hci_connection->sm_connection.sm_connection_encrypted == 0) return false; // unencrypted connection cannot be authenticated 9830d7dbf891SMatthias Ringwald return hci_connection->sm_connection.sm_connection_sc; 98316a79f6baSMatthias Ringwald #endif 983259a1a47aSMatthias Ringwald #ifdef ENABLE_CLASSIC 98338b35e16aSMatthias Ringwald case BD_ADDR_TYPE_SCO: 9834f16129ceSMatthias Ringwald case BD_ADDR_TYPE_ACL: 9835f461b3dfSMatthias Ringwald return gap_secure_connection_for_link_key_type(hci_connection->link_key_type); 983659a1a47aSMatthias Ringwald #endif 98378b35e16aSMatthias Ringwald default: 9838f461b3dfSMatthias Ringwald return false; 98398b35e16aSMatthias Ringwald } 9840f1dfbe18SMatthias Ringwald } 9841f1dfbe18SMatthias Ringwald 98421e122704SMatthias Ringwald bool gap_bonded(hci_con_handle_t con_handle){ 98431e122704SMatthias Ringwald hci_connection_t * hci_connection = hci_connection_for_handle(con_handle); 98441e122704SMatthias Ringwald if (hci_connection == NULL) return 0; 98451e122704SMatthias Ringwald 984648f33f37SMatthias Ringwald #ifdef ENABLE_CLASSIC 98471e122704SMatthias Ringwald link_key_t link_key; 98481e122704SMatthias Ringwald link_key_type_t link_key_type; 984948f33f37SMatthias Ringwald #endif 98501e122704SMatthias Ringwald switch (hci_connection->address_type){ 98516a79f6baSMatthias Ringwald #ifdef ENABLE_BLE 98521e122704SMatthias Ringwald case BD_ADDR_TYPE_LE_PUBLIC: 98531e122704SMatthias Ringwald case BD_ADDR_TYPE_LE_RANDOM: 9854d9e1bf33SMatthias Ringwald case BD_ADDR_TYPE_LE_PUBLIC_IDENTITY: 9855d9e1bf33SMatthias Ringwald case BD_ADDR_TYPE_LE_RANDOM_IDENTITY: 98561e122704SMatthias Ringwald return hci_connection->sm_connection.sm_le_db_index >= 0; 98576a79f6baSMatthias Ringwald #endif 98581e122704SMatthias Ringwald #ifdef ENABLE_CLASSIC 98591e122704SMatthias Ringwald case BD_ADDR_TYPE_SCO: 98601e122704SMatthias Ringwald case BD_ADDR_TYPE_ACL: 98611e122704SMatthias Ringwald return hci_stack->link_key_db && hci_stack->link_key_db->get_link_key(hci_connection->address, link_key, &link_key_type); 98621e122704SMatthias Ringwald #endif 98631e122704SMatthias Ringwald default: 98641e122704SMatthias Ringwald return false; 98651e122704SMatthias Ringwald } 98661e122704SMatthias Ringwald } 98671e122704SMatthias Ringwald 98686a79f6baSMatthias Ringwald #ifdef ENABLE_BLE 98699c6e867eSMatthias Ringwald authorization_state_t gap_authorization_state(hci_con_handle_t con_handle){ 98709c6e867eSMatthias Ringwald sm_connection_t * sm_conn = sm_get_connection_for_handle(con_handle); 9871c7bead46SMatthias Ringwald if (sm_conn == NULL) return AUTHORIZATION_UNKNOWN; // wrong connection 9872c7bead46SMatthias Ringwald if (sm_conn->sm_connection_encrypted == 0u) return AUTHORIZATION_UNKNOWN; // unencrypted connection cannot be authorized 9873a086dc35SMatthias Ringwald if (sm_conn->sm_connection_authenticated == 0u) return AUTHORIZATION_UNKNOWN; // unauthenticated connection cannot be authorized 98749c6e867eSMatthias Ringwald return sm_conn->sm_connection_authorization_state; 98759c6e867eSMatthias Ringwald } 98769c6e867eSMatthias Ringwald #endif 9877f8ee3071SMatthias Ringwald 9878f8ee3071SMatthias Ringwald #ifdef ENABLE_CLASSIC 9879f8ee3071SMatthias 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){ 9880f8ee3071SMatthias Ringwald hci_connection_t * conn = hci_connection_for_handle(con_handle); 98817f839e2cSMatthias Ringwald if (!conn) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 9882f8ee3071SMatthias Ringwald conn->sniff_min_interval = sniff_min_interval; 9883f8ee3071SMatthias Ringwald conn->sniff_max_interval = sniff_max_interval; 9884f8ee3071SMatthias Ringwald conn->sniff_attempt = sniff_attempt; 9885f8ee3071SMatthias Ringwald conn->sniff_timeout = sniff_timeout; 9886f8ee3071SMatthias Ringwald hci_run(); 9887f8ee3071SMatthias Ringwald return 0; 9888f8ee3071SMatthias Ringwald } 9889f8ee3071SMatthias Ringwald 9890f8ee3071SMatthias Ringwald /** 9891f8ee3071SMatthias Ringwald * @brief Exit Sniff mode 9892f8ee3071SMatthias Ringwald * @param con_handle 9893f8ee3071SMatthias Ringwald @ @return 0 if ok 9894f8ee3071SMatthias Ringwald */ 9895f8ee3071SMatthias Ringwald uint8_t gap_sniff_mode_exit(hci_con_handle_t con_handle){ 9896f8ee3071SMatthias Ringwald hci_connection_t * conn = hci_connection_for_handle(con_handle); 98977f839e2cSMatthias Ringwald if (!conn) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 9898f8ee3071SMatthias Ringwald conn->sniff_min_interval = 0xffff; 9899f8ee3071SMatthias Ringwald hci_run(); 9900f8ee3071SMatthias Ringwald return 0; 9901f8ee3071SMatthias Ringwald } 9902bea424a5SMatthias Ringwald 9903140c0557SMatthias 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){ 9904140c0557SMatthias Ringwald hci_connection_t * conn = hci_connection_for_handle(con_handle); 99057f839e2cSMatthias Ringwald if (!conn) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 9906140c0557SMatthias Ringwald conn->sniff_subrating_max_latency = max_latency; 9907140c0557SMatthias Ringwald conn->sniff_subrating_min_remote_timeout = min_remote_timeout; 9908140c0557SMatthias Ringwald conn->sniff_subrating_min_local_timeout = min_local_timeout; 9909140c0557SMatthias Ringwald hci_run(); 9910dc8d5bd3SMatthias Ringwald return ERROR_CODE_SUCCESS; 9911140c0557SMatthias Ringwald } 9912140c0557SMatthias Ringwald 9913278ff8a9SMatthias 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){ 9914278ff8a9SMatthias Ringwald hci_connection_t * conn = hci_connection_for_handle(con_handle); 99157f839e2cSMatthias Ringwald if (!conn) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 9916278ff8a9SMatthias Ringwald conn->qos_service_type = service_type; 9917278ff8a9SMatthias Ringwald conn->qos_token_rate = token_rate; 9918278ff8a9SMatthias Ringwald conn->qos_peak_bandwidth = peak_bandwidth; 9919278ff8a9SMatthias Ringwald conn->qos_latency = latency; 9920278ff8a9SMatthias Ringwald conn->qos_delay_variation = delay_variation; 9921278ff8a9SMatthias Ringwald hci_run(); 9922278ff8a9SMatthias Ringwald return ERROR_CODE_SUCCESS; 9923278ff8a9SMatthias Ringwald } 9924278ff8a9SMatthias Ringwald 9925bea424a5SMatthias Ringwald void gap_set_page_scan_activity(uint16_t page_scan_interval, uint16_t page_scan_window){ 9926bea424a5SMatthias Ringwald hci_stack->new_page_scan_interval = page_scan_interval; 9927bea424a5SMatthias Ringwald hci_stack->new_page_scan_window = page_scan_window; 9928baa4881eSMatthias Ringwald hci_stack->gap_tasks_classic |= GAP_TASK_WRITE_PAGE_SCAN_ACTIVITY; 9929bea424a5SMatthias Ringwald hci_run(); 9930bea424a5SMatthias Ringwald } 9931bea424a5SMatthias Ringwald 9932bea424a5SMatthias Ringwald void gap_set_page_scan_type(page_scan_type_t page_scan_type){ 9933bea424a5SMatthias Ringwald hci_stack->new_page_scan_type = (uint8_t) page_scan_type; 9934baa4881eSMatthias Ringwald hci_stack->gap_tasks_classic |= GAP_TASK_WRITE_PAGE_SCAN_TYPE; 9935bea424a5SMatthias Ringwald hci_run(); 9936bea424a5SMatthias Ringwald } 9937bea424a5SMatthias Ringwald 993832a12730SMatthias Ringwald void gap_set_page_timeout(uint16_t page_timeout){ 993932a12730SMatthias Ringwald hci_stack->page_timeout = page_timeout; 9940baa4881eSMatthias Ringwald hci_stack->gap_tasks_classic |= GAP_TASK_WRITE_PAGE_TIMEOUT; 994132a12730SMatthias Ringwald hci_run(); 994232a12730SMatthias Ringwald } 994332a12730SMatthias Ringwald 9944f8ee3071SMatthias Ringwald #endif 9945beceeddeSMatthias Ringwald 994621debf25SMatthias Ringwald #ifdef ENABLE_LE_PRIVACY_ADDRESS_RESOLUTION 994721debf25SMatthias Ringwald void hci_load_le_device_db_entry_into_resolving_list(uint16_t le_device_db_index){ 994821debf25SMatthias Ringwald if (le_device_db_index >= MAX_NUM_RESOLVING_LIST_ENTRIES) return; 994921debf25SMatthias Ringwald if (le_device_db_index >= le_device_db_max_count()) return; 995021debf25SMatthias Ringwald uint8_t offset = le_device_db_index >> 3; 995121debf25SMatthias Ringwald uint8_t mask = 1 << (le_device_db_index & 7); 995202b02cffSMatthias Ringwald hci_stack->le_resolving_list_add_entries[offset] |= mask; 9953e8ca66c6SMatthias Ringwald hci_stack->le_resolving_list_set_privacy_mode[offset] |= mask; 995421debf25SMatthias Ringwald if (hci_stack->le_resolving_list_state == LE_RESOLVING_LIST_DONE){ 995502b02cffSMatthias Ringwald // note: go back to remove entries, otherwise, a remove + add will skip the add 99565f3ccd83SMatthias Ringwald hci_stack->le_resolving_list_state = LE_RESOLVING_LIST_UPDATES_ENTRIES; 995702b02cffSMatthias Ringwald } 995802b02cffSMatthias Ringwald } 995902b02cffSMatthias Ringwald 996002b02cffSMatthias Ringwald void hci_remove_le_device_db_entry_from_resolving_list(uint16_t le_device_db_index){ 996102b02cffSMatthias Ringwald if (le_device_db_index >= MAX_NUM_RESOLVING_LIST_ENTRIES) return; 996202b02cffSMatthias Ringwald if (le_device_db_index >= le_device_db_max_count()) return; 996302b02cffSMatthias Ringwald uint8_t offset = le_device_db_index >> 3; 996402b02cffSMatthias Ringwald uint8_t mask = 1 << (le_device_db_index & 7); 996502b02cffSMatthias Ringwald hci_stack->le_resolving_list_remove_entries[offset] |= mask; 996602b02cffSMatthias Ringwald if (hci_stack->le_resolving_list_state == LE_RESOLVING_LIST_DONE){ 99675f3ccd83SMatthias Ringwald hci_stack->le_resolving_list_state = LE_RESOLVING_LIST_UPDATES_ENTRIES; 996821debf25SMatthias Ringwald } 996921debf25SMatthias Ringwald } 9970cf38a091SMatthias Ringwald 9971cf38a091SMatthias Ringwald uint8_t gap_load_resolving_list_from_le_device_db(void){ 99721ffa425cSMatthias Ringwald if (hci_command_supported(SUPPORTED_HCI_COMMAND_LE_SET_ADDRESS_RESOLUTION_ENABLE) == false){ 9973cf38a091SMatthias Ringwald return ERROR_CODE_UNSUPPORTED_FEATURE_OR_PARAMETER_VALUE; 9974cf38a091SMatthias Ringwald } 9975cf38a091SMatthias Ringwald if (hci_stack->le_resolving_list_state != LE_RESOLVING_LIST_SEND_ENABLE_ADDRESS_RESOLUTION){ 9976cf38a091SMatthias Ringwald // restart le resolving list update 9977cf38a091SMatthias Ringwald hci_stack->le_resolving_list_state = LE_RESOLVING_LIST_READ_SIZE; 9978cf38a091SMatthias Ringwald } 9979cf38a091SMatthias Ringwald return ERROR_CODE_SUCCESS; 9980cf38a091SMatthias Ringwald } 9981c3d19a30SMatthias Ringwald 9982c3d19a30SMatthias Ringwald void gap_set_peer_privacy_mode(le_privacy_mode_t privacy_mode ){ 9983c3d19a30SMatthias Ringwald hci_stack->le_privacy_mode = privacy_mode; 9984c3d19a30SMatthias Ringwald } 998521debf25SMatthias Ringwald #endif 998621debf25SMatthias Ringwald 9987f40c73b4SMatthias Ringwald #ifdef ENABLE_BLE 9988f40c73b4SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 9989f40c73b4SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING 9990f40c73b4SMatthias Ringwald 9991f40c73b4SMatthias Ringwald static uint8_t hci_periodic_advertiser_list_add(bd_addr_type_t address_type, const bd_addr_t address, uint8_t advertising_sid){ 9992100da355SMatthias Ringwald 9993100da355SMatthias Ringwald #if !defined(HAVE_MALLOC) && (!defined(MAX_NR_PERIODIC_ADVERTISER_LIST_ENTRIES) || (MAX_NR_PERIODIC_ADVERTISER_LIST_ENTRIES == 0)) 9994100da355SMatthias Ringwald // incorrect configuration: 9995100da355SMatthias Ringwald // - as MAX_NR_PERIODIC_ADVERTISER_LIST_ENTRIES is not defined or zero this function always fails 9996100da355SMatthias Ringwald // - please set MAX_NR_PERIODIC_ADVERTISER_LIST_ENTRIES in btstack_config.h 9997100da355SMatthias Ringwald btstack_assert(false); 9998100da355SMatthias Ringwald #endif 9999100da355SMatthias Ringwald 10000f40c73b4SMatthias Ringwald // check if already in list 10001f40c73b4SMatthias Ringwald btstack_linked_list_iterator_t it; 10002f40c73b4SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->le_periodic_advertiser_list); 10003f40c73b4SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)) { 10004f40c73b4SMatthias Ringwald periodic_advertiser_list_entry_t *entry = (periodic_advertiser_list_entry_t *) btstack_linked_list_iterator_next(&it); 10005f40c73b4SMatthias Ringwald if (entry->sid != advertising_sid) { 10006f40c73b4SMatthias Ringwald continue; 10007f40c73b4SMatthias Ringwald } 10008f40c73b4SMatthias Ringwald if (entry->address_type != address_type) { 10009f40c73b4SMatthias Ringwald continue; 10010f40c73b4SMatthias Ringwald } 10011f40c73b4SMatthias Ringwald if (memcmp(entry->address, address, 6) != 0) { 10012f40c73b4SMatthias Ringwald continue; 10013f40c73b4SMatthias Ringwald } 10014f40c73b4SMatthias Ringwald // disallow if already scheduled to add 10015f40c73b4SMatthias Ringwald if ((entry->state & LE_PERIODIC_ADVERTISER_LIST_ENTRY_ADD_TO_CONTROLLER) != 0){ 10016f40c73b4SMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 10017f40c73b4SMatthias Ringwald } 10018f40c73b4SMatthias Ringwald // still on controller, but scheduled to remove -> re-add 10019f40c73b4SMatthias Ringwald entry->state |= LE_PERIODIC_ADVERTISER_LIST_ENTRY_ADD_TO_CONTROLLER; 10020f40c73b4SMatthias Ringwald return ERROR_CODE_SUCCESS; 10021f40c73b4SMatthias Ringwald } 10022f40c73b4SMatthias Ringwald // alloc and add to list 10023f40c73b4SMatthias Ringwald periodic_advertiser_list_entry_t * entry = btstack_memory_periodic_advertiser_list_entry_get(); 10024f40c73b4SMatthias Ringwald if (!entry) return BTSTACK_MEMORY_ALLOC_FAILED; 10025f40c73b4SMatthias Ringwald entry->sid = advertising_sid; 10026f40c73b4SMatthias Ringwald entry->address_type = address_type; 10027f40c73b4SMatthias Ringwald (void)memcpy(entry->address, address, 6); 10028f40c73b4SMatthias Ringwald entry->state = LE_PERIODIC_ADVERTISER_LIST_ENTRY_ADD_TO_CONTROLLER; 10029f40c73b4SMatthias Ringwald btstack_linked_list_add(&hci_stack->le_periodic_advertiser_list, (btstack_linked_item_t*) entry); 10030f40c73b4SMatthias Ringwald return ERROR_CODE_SUCCESS; 10031f40c73b4SMatthias Ringwald } 10032f40c73b4SMatthias Ringwald 10033f40c73b4SMatthias Ringwald static uint8_t hci_periodic_advertiser_list_remove(bd_addr_type_t address_type, const bd_addr_t address, uint8_t advertising_sid){ 10034f40c73b4SMatthias Ringwald btstack_linked_list_iterator_t it; 10035f40c73b4SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->le_periodic_advertiser_list); 10036f40c73b4SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 10037f40c73b4SMatthias Ringwald periodic_advertiser_list_entry_t * entry = (periodic_advertiser_list_entry_t*) btstack_linked_list_iterator_next(&it); 10038f40c73b4SMatthias Ringwald if (entry->sid != advertising_sid) { 10039f40c73b4SMatthias Ringwald continue; 10040f40c73b4SMatthias Ringwald } 10041f40c73b4SMatthias Ringwald if (entry->address_type != address_type) { 10042f40c73b4SMatthias Ringwald continue; 10043f40c73b4SMatthias Ringwald } 10044f40c73b4SMatthias Ringwald if (memcmp(entry->address, address, 6) != 0) { 10045f40c73b4SMatthias Ringwald continue; 10046f40c73b4SMatthias Ringwald } 10047f40c73b4SMatthias Ringwald if (entry->state & LE_PERIODIC_ADVERTISER_LIST_ENTRY_ON_CONTROLLER){ 10048f40c73b4SMatthias Ringwald // remove from controller if already present 10049f40c73b4SMatthias Ringwald entry->state |= LE_PERIODIC_ADVERTISER_LIST_ENTRY_REMOVE_FROM_CONTROLLER; 10050f40c73b4SMatthias Ringwald } else { 10051f40c73b4SMatthias Ringwald // directly remove entry from whitelist 10052f40c73b4SMatthias Ringwald btstack_linked_list_iterator_remove(&it); 10053f40c73b4SMatthias Ringwald btstack_memory_periodic_advertiser_list_entry_free(entry); 10054f40c73b4SMatthias Ringwald } 10055f40c73b4SMatthias Ringwald return ERROR_CODE_SUCCESS; 10056f40c73b4SMatthias Ringwald } 10057f40c73b4SMatthias Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 10058f40c73b4SMatthias Ringwald } 10059f40c73b4SMatthias Ringwald 10060f40c73b4SMatthias Ringwald static void hci_periodic_advertiser_list_clear(void){ 10061f40c73b4SMatthias Ringwald btstack_linked_list_iterator_t it; 10062f40c73b4SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->le_periodic_advertiser_list); 10063f40c73b4SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 10064f40c73b4SMatthias Ringwald periodic_advertiser_list_entry_t * entry = (periodic_advertiser_list_entry_t*) btstack_linked_list_iterator_next(&it); 10065f40c73b4SMatthias Ringwald if (entry->state & LE_PERIODIC_ADVERTISER_LIST_ENTRY_ON_CONTROLLER){ 10066f40c73b4SMatthias Ringwald // remove from controller if already present 10067f40c73b4SMatthias Ringwald entry->state |= LE_PERIODIC_ADVERTISER_LIST_ENTRY_REMOVE_FROM_CONTROLLER; 10068f40c73b4SMatthias Ringwald continue; 10069f40c73b4SMatthias Ringwald } 10070f40c73b4SMatthias Ringwald // directly remove entry from whitelist 10071f40c73b4SMatthias Ringwald btstack_linked_list_iterator_remove(&it); 10072f40c73b4SMatthias Ringwald btstack_memory_periodic_advertiser_list_entry_free(entry); 10073f40c73b4SMatthias Ringwald } 10074f40c73b4SMatthias Ringwald } 10075f40c73b4SMatthias Ringwald 10076f40c73b4SMatthias Ringwald uint8_t gap_periodic_advertiser_list_clear(void){ 10077f40c73b4SMatthias Ringwald hci_periodic_advertiser_list_clear(); 10078f40c73b4SMatthias Ringwald hci_run(); 10079f40c73b4SMatthias Ringwald return ERROR_CODE_SUCCESS; 10080f40c73b4SMatthias Ringwald } 10081f40c73b4SMatthias Ringwald 10082f40c73b4SMatthias Ringwald uint8_t gap_periodic_advertiser_list_add(bd_addr_type_t address_type, const bd_addr_t address, uint8_t advertising_sid){ 10083f40c73b4SMatthias Ringwald uint8_t status = hci_periodic_advertiser_list_add(address_type, address, advertising_sid); 10084f40c73b4SMatthias Ringwald if (status){ 10085f40c73b4SMatthias Ringwald return status; 10086f40c73b4SMatthias Ringwald } 10087f40c73b4SMatthias Ringwald hci_run(); 10088f40c73b4SMatthias Ringwald return ERROR_CODE_SUCCESS; 10089f40c73b4SMatthias Ringwald } 10090f40c73b4SMatthias Ringwald 10091f40c73b4SMatthias Ringwald uint8_t gap_periodic_advertiser_list_remove(bd_addr_type_t address_type, const bd_addr_t address, uint8_t advertising_sid){ 10092f40c73b4SMatthias Ringwald uint8_t status = hci_periodic_advertiser_list_remove(address_type, address, advertising_sid); 10093f40c73b4SMatthias Ringwald if (status){ 10094f40c73b4SMatthias Ringwald return status; 10095f40c73b4SMatthias Ringwald } 10096f40c73b4SMatthias Ringwald hci_run(); 10097f40c73b4SMatthias Ringwald return ERROR_CODE_SUCCESS; 10098f40c73b4SMatthias Ringwald } 100994bafedd5SMatthias Ringwald 101004bafedd5SMatthias Ringwald uint8_t gap_periodic_advertising_create_sync(uint8_t options, uint8_t advertising_sid, bd_addr_type_t advertiser_address_type, 101014bafedd5SMatthias Ringwald bd_addr_t advertiser_address, uint16_t skip, uint16_t sync_timeout, uint8_t sync_cte_type){ 101024bafedd5SMatthias Ringwald // abort if already active 101034bafedd5SMatthias Ringwald if (hci_stack->le_periodic_sync_request != LE_CONNECTING_IDLE) { 101044bafedd5SMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 101054bafedd5SMatthias Ringwald } 101064bafedd5SMatthias Ringwald // store request 101074bafedd5SMatthias Ringwald hci_stack->le_periodic_sync_request = ((options & 0) != 0) ? LE_CONNECTING_WHITELIST : LE_CONNECTING_DIRECT; 101084bafedd5SMatthias Ringwald hci_stack->le_periodic_sync_options = options; 101094bafedd5SMatthias Ringwald hci_stack->le_periodic_sync_advertising_sid = advertising_sid; 101104bafedd5SMatthias Ringwald hci_stack->le_periodic_sync_advertiser_address_type = advertiser_address_type; 101114bafedd5SMatthias Ringwald memcpy(hci_stack->le_periodic_sync_advertiser_address, advertiser_address, 6); 101124bafedd5SMatthias Ringwald hci_stack->le_periodic_sync_skip = skip; 101134bafedd5SMatthias Ringwald hci_stack->le_periodic_sync_timeout = sync_timeout; 101144bafedd5SMatthias Ringwald hci_stack->le_periodic_sync_cte_type = sync_cte_type; 101154bafedd5SMatthias Ringwald 101164bafedd5SMatthias Ringwald hci_run(); 101174bafedd5SMatthias Ringwald return ERROR_CODE_SUCCESS; 101184bafedd5SMatthias Ringwald } 101194bafedd5SMatthias Ringwald 101204bafedd5SMatthias Ringwald uint8_t gap_periodic_advertising_create_sync_cancel(void){ 101214bafedd5SMatthias Ringwald // abort if not requested 101224bafedd5SMatthias Ringwald if (hci_stack->le_periodic_sync_request == LE_CONNECTING_IDLE) { 101234bafedd5SMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 101244bafedd5SMatthias Ringwald } 101254bafedd5SMatthias Ringwald hci_stack->le_periodic_sync_request = LE_CONNECTING_IDLE; 101264bafedd5SMatthias Ringwald hci_run(); 101274bafedd5SMatthias Ringwald return ERROR_CODE_SUCCESS; 101284bafedd5SMatthias Ringwald } 101294bafedd5SMatthias Ringwald 101304bafedd5SMatthias Ringwald uint8_t gap_periodic_advertising_terminate_sync(uint16_t sync_handle){ 1013149a6c69cSMatthias Ringwald if (hci_stack->le_periodic_terminate_sync_handle != HCI_CON_HANDLE_INVALID){ 1013249a6c69cSMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 1013349a6c69cSMatthias Ringwald } 1013449a6c69cSMatthias Ringwald hci_stack->le_periodic_terminate_sync_handle = sync_handle; 1013549a6c69cSMatthias Ringwald hci_run(); 1013649a6c69cSMatthias Ringwald return ERROR_CODE_SUCCESS; 101374bafedd5SMatthias Ringwald } 101384bafedd5SMatthias Ringwald 10139f40c73b4SMatthias Ringwald #endif 10140f40c73b4SMatthias Ringwald #endif 101414ae8623eSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS 10142969d876aSMatthias Ringwald static hci_iso_stream_t * 10143969d876aSMatthias 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) { 101444ae8623eSMatthias Ringwald hci_iso_stream_t * iso_stream = btstack_memory_hci_iso_stream_get(); 10145969d876aSMatthias Ringwald if (iso_stream != NULL){ 101468d72db10SMatthias Ringwald iso_stream->iso_type = iso_type; 1014726b93350SMatthias Ringwald iso_stream->state = state; 101488d72db10SMatthias Ringwald iso_stream->group_id = group_id; 10149969d876aSMatthias Ringwald iso_stream->stream_id = stream_id; 10150969d876aSMatthias Ringwald iso_stream->cis_handle = HCI_CON_HANDLE_INVALID; 10151969d876aSMatthias Ringwald iso_stream->acl_handle = HCI_CON_HANDLE_INVALID; 101524ae8623eSMatthias Ringwald btstack_linked_list_add(&hci_stack->iso_streams, (btstack_linked_item_t*) iso_stream); 101534ae8623eSMatthias Ringwald } 10154969d876aSMatthias Ringwald return iso_stream; 101554ae8623eSMatthias Ringwald } 101564ae8623eSMatthias Ringwald 1015715a15be3SMatthias Ringwald static hci_iso_stream_t * hci_iso_stream_for_con_handle(hci_con_handle_t con_handle){ 101584ae8623eSMatthias Ringwald btstack_linked_list_iterator_t it; 101594ae8623eSMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->iso_streams); 101604ae8623eSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 101614ae8623eSMatthias Ringwald hci_iso_stream_t * iso_stream = (hci_iso_stream_t *) btstack_linked_list_iterator_next(&it); 10162969d876aSMatthias Ringwald if (iso_stream->cis_handle == con_handle ) { 101634ae8623eSMatthias Ringwald return iso_stream; 101644ae8623eSMatthias Ringwald } 101654ae8623eSMatthias Ringwald } 101664ae8623eSMatthias Ringwald return NULL; 101674ae8623eSMatthias Ringwald } 101684ae8623eSMatthias Ringwald 101694ae8623eSMatthias Ringwald static void hci_iso_stream_finalize(hci_iso_stream_t * iso_stream){ 10170969d876aSMatthias Ringwald log_info("hci_iso_stream_finalize con_handle 0x%04x, group_id 0x%02x", iso_stream->cis_handle, iso_stream->group_id); 101714ae8623eSMatthias Ringwald btstack_linked_list_remove(&hci_stack->iso_streams, (btstack_linked_item_t*) iso_stream); 101724ae8623eSMatthias Ringwald btstack_memory_hci_iso_stream_free(iso_stream); 101734ae8623eSMatthias Ringwald } 101744ae8623eSMatthias Ringwald 10175778463d0SMatthias Ringwald static void hci_iso_stream_finalize_by_type_and_group_id(hci_iso_type_t iso_type, uint8_t group_id) { 10176778463d0SMatthias Ringwald btstack_linked_list_iterator_t it; 10177778463d0SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->iso_streams); 10178778463d0SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 10179778463d0SMatthias Ringwald hci_iso_stream_t * iso_stream = (hci_iso_stream_t *) btstack_linked_list_iterator_next(&it); 10180778463d0SMatthias Ringwald if ((iso_stream->group_id == group_id) && 10181778463d0SMatthias Ringwald (iso_stream->iso_type == iso_type)){ 10182778463d0SMatthias Ringwald btstack_linked_list_iterator_remove(&it); 10183778463d0SMatthias Ringwald btstack_memory_hci_iso_stream_free(iso_stream); 10184778463d0SMatthias Ringwald } 10185778463d0SMatthias Ringwald } 10186778463d0SMatthias Ringwald } 10187778463d0SMatthias Ringwald 101888d72db10SMatthias Ringwald static void hci_iso_stream_requested_finalize(uint8_t group_id) { 101894ae8623eSMatthias Ringwald btstack_linked_list_iterator_t it; 101904ae8623eSMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->iso_streams); 101914ae8623eSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 101924ae8623eSMatthias Ringwald hci_iso_stream_t * iso_stream = (hci_iso_stream_t *) btstack_linked_list_iterator_next(&it); 10193a90016deSMatthias Ringwald if ((iso_stream->state == HCI_ISO_STREAM_STATE_REQUESTED ) && 101948d72db10SMatthias Ringwald (iso_stream->group_id == group_id)){ 101954ae8623eSMatthias Ringwald btstack_linked_list_iterator_remove(&it); 101964ae8623eSMatthias Ringwald btstack_memory_hci_iso_stream_free(iso_stream); 101974ae8623eSMatthias Ringwald } 101984ae8623eSMatthias Ringwald } 101994ae8623eSMatthias Ringwald } 1020036916f81SDirk Helbig 10201a90016deSMatthias Ringwald static void hci_iso_stream_requested_confirm(uint8_t big_handle){ 1020236916f81SDirk Helbig UNUSED(big_handle); 1020336916f81SDirk Helbig 102044ae8623eSMatthias Ringwald btstack_linked_list_iterator_t it; 102054ae8623eSMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->iso_streams); 102064ae8623eSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 102074ae8623eSMatthias Ringwald hci_iso_stream_t * iso_stream = (hci_iso_stream_t *) btstack_linked_list_iterator_next(&it); 102084ae8623eSMatthias Ringwald if ( iso_stream->state == HCI_ISO_STREAM_STATE_REQUESTED ) { 102094ae8623eSMatthias Ringwald iso_stream->state = HCI_ISO_STREAM_STATE_W4_ESTABLISHED; 102104ae8623eSMatthias Ringwald } 102114ae8623eSMatthias Ringwald } 102124ae8623eSMatthias Ringwald } 10213d39e4f95SMatthias Ringwald 10214d39e4f95SMatthias Ringwald static bool hci_iso_sdu_complete(uint8_t * packet, uint16_t size){ 10215d39e4f95SMatthias Ringwald uint8_t sdu_ts_flag = (packet[1] >> 6) & 1; 10216d39e4f95SMatthias Ringwald uint16_t sdu_len_offset = 6 + (sdu_ts_flag * 4); 10217d39e4f95SMatthias Ringwald uint16_t sdu_len = little_endian_read_16(packet, sdu_len_offset) & 0x0fff; 10218d39e4f95SMatthias Ringwald return (sdu_len_offset + 2 + sdu_len) == size; 10219d39e4f95SMatthias Ringwald } 10220d39e4f95SMatthias Ringwald 10221750818acSMatthias Ringwald static void hci_iso_packet_handler(hci_iso_stream_t *iso_stream, uint8_t *packet, uint16_t size) { 10222750818acSMatthias Ringwald if (iso_stream == NULL){ 10223750818acSMatthias Ringwald log_error("acl_handler called with non-registered handle %u!" , READ_ISO_CONNECTION_HANDLE(packet)); 10224d39e4f95SMatthias Ringwald return; 10225d39e4f95SMatthias Ringwald } 10226750818acSMatthias Ringwald 10227750818acSMatthias Ringwald if (hci_stack->iso_packet_handler == NULL) { 10228d39e4f95SMatthias Ringwald return; 10229d39e4f95SMatthias Ringwald } 10230d39e4f95SMatthias Ringwald 10231d39e4f95SMatthias Ringwald // parse header 10232a14c18deSMatthias Ringwald uint16_t con_handle_and_flags = little_endian_read_16(packet, 0); 10233a14c18deSMatthias Ringwald uint16_t data_total_length = little_endian_read_16(packet, 2); 10234a14c18deSMatthias Ringwald uint8_t pb_flag = (con_handle_and_flags >> 12) & 3; 10235d39e4f95SMatthias Ringwald 10236d39e4f95SMatthias Ringwald // assert packet is complete 10237a14c18deSMatthias Ringwald if ((data_total_length + 4u) != size){ 10238d39e4f95SMatthias Ringwald return; 10239d39e4f95SMatthias Ringwald } 10240d39e4f95SMatthias Ringwald 10241d39e4f95SMatthias Ringwald if ((pb_flag & 0x01) == 0){ 10242d39e4f95SMatthias Ringwald if (pb_flag == 0x02){ 10243a14c18deSMatthias Ringwald // The ISO_SDU_Fragment field contains a header and a complete SDU. 10244d39e4f95SMatthias Ringwald if (hci_iso_sdu_complete(packet, size)) { 10245d39e4f95SMatthias Ringwald (hci_stack->iso_packet_handler)(HCI_ISO_DATA_PACKET, 0, packet, size); 10246d39e4f95SMatthias Ringwald } 10247d39e4f95SMatthias Ringwald } else { 10248d39e4f95SMatthias Ringwald // The ISO_Data_Load field contains a header and the first fragment of a fragmented SDU. 1024960468fb4SMatthias Ringwald if (size > sizeof(iso_stream->reassembly_buffer)){ 10250d39e4f95SMatthias Ringwald return; 10251d39e4f95SMatthias Ringwald } 10252d39e4f95SMatthias Ringwald memcpy(iso_stream->reassembly_buffer, packet, size); 10253d39e4f95SMatthias Ringwald // fix pb_flag 10254d39e4f95SMatthias Ringwald iso_stream->reassembly_buffer[1] = (iso_stream->reassembly_buffer[1] & 0xcf) | 0x20; 10255d39e4f95SMatthias Ringwald iso_stream->reassembly_pos = size; 10256d39e4f95SMatthias Ringwald } 10257d39e4f95SMatthias Ringwald } else { 10258a14c18deSMatthias Ringwald // ISO_SDU_Fragment contains continuation or last fragment of an SDU 10259a14c18deSMatthias Ringwald uint8_t ts_flag = (con_handle_and_flags >> 14) & 1; 10260d39e4f95SMatthias Ringwald if (ts_flag != 0){ 10261d39e4f95SMatthias Ringwald return; 10262d39e4f95SMatthias Ringwald } 10263d39e4f95SMatthias Ringwald // append fragment 10264d39e4f95SMatthias Ringwald if (iso_stream->reassembly_pos == 0){ 10265d39e4f95SMatthias Ringwald return; 10266d39e4f95SMatthias Ringwald } 1026760468fb4SMatthias Ringwald 10268a14c18deSMatthias Ringwald if ((iso_stream->reassembly_pos + data_total_length) > sizeof(iso_stream->reassembly_buffer)){ 10269d39e4f95SMatthias Ringwald // reset reassembly buffer 10270d39e4f95SMatthias Ringwald iso_stream->reassembly_pos = 0; 10271d39e4f95SMatthias Ringwald return; 10272d39e4f95SMatthias Ringwald } 10273a14c18deSMatthias Ringwald memcpy(&iso_stream->reassembly_buffer[iso_stream->reassembly_pos], &packet[4], data_total_length); 10274a14c18deSMatthias Ringwald iso_stream->reassembly_pos += data_total_length; 10275d39e4f95SMatthias Ringwald 10276d39e4f95SMatthias Ringwald // deliver if last fragment and SDU complete 10277d39e4f95SMatthias Ringwald if (pb_flag == 0x03){ 10278d39e4f95SMatthias Ringwald if (hci_iso_sdu_complete(iso_stream->reassembly_buffer, iso_stream->reassembly_pos)){ 10279a14c18deSMatthias Ringwald // fix data_total_length 1028060468fb4SMatthias Ringwald little_endian_store_16(iso_stream->reassembly_buffer, 2, iso_stream->reassembly_pos - HCI_ISO_HEADER_SIZE); 10281d39e4f95SMatthias Ringwald (hci_stack->iso_packet_handler)(HCI_ISO_DATA_PACKET, 0, iso_stream->reassembly_buffer, iso_stream->reassembly_pos); 10282d39e4f95SMatthias Ringwald } 10283a14c18deSMatthias Ringwald // reset reassembly buffer 10284d39e4f95SMatthias Ringwald iso_stream->reassembly_pos = 0; 10285d39e4f95SMatthias Ringwald } 10286d39e4f95SMatthias Ringwald } 10287d39e4f95SMatthias Ringwald } 10288d39e4f95SMatthias Ringwald 102897aa35f6aSMatthias Ringwald static void hci_emit_big_created(const le_audio_big_t * big, uint8_t status){ 102907aa35f6aSMatthias Ringwald uint8_t event [6 + (MAX_NR_BIS * 2)]; 102917aa35f6aSMatthias Ringwald uint16_t pos = 0; 102927aa35f6aSMatthias Ringwald event[pos++] = HCI_EVENT_META_GAP; 102937aa35f6aSMatthias Ringwald event[pos++] = 4 + (2 * big->num_bis); 102947aa35f6aSMatthias Ringwald event[pos++] = GAP_SUBEVENT_BIG_CREATED; 102957aa35f6aSMatthias Ringwald event[pos++] = status; 102967aa35f6aSMatthias Ringwald event[pos++] = big->big_handle; 102977aa35f6aSMatthias Ringwald event[pos++] = big->num_bis; 102987aa35f6aSMatthias Ringwald uint8_t i; 102997aa35f6aSMatthias Ringwald for (i=0;i<big->num_bis;i++){ 103007aa35f6aSMatthias Ringwald little_endian_store_16(event, pos, big->bis_con_handles[i]); 103017aa35f6aSMatthias Ringwald pos += 2; 103027aa35f6aSMatthias Ringwald } 103039da9850bSMatthias Ringwald hci_emit_btstack_event(event, pos, 0); 103047aa35f6aSMatthias Ringwald } 103057aa35f6aSMatthias Ringwald 10306d3a89d91SMatthias Ringwald static void hci_emit_cig_created(const le_audio_cig_t * cig, uint8_t status){ 10307d3a89d91SMatthias Ringwald uint8_t event [6 + (MAX_NR_CIS * 2)]; 10308d3a89d91SMatthias Ringwald uint16_t pos = 0; 10309d3a89d91SMatthias Ringwald event[pos++] = HCI_EVENT_META_GAP; 10310d3a89d91SMatthias Ringwald event[pos++] = 4 + (2 * cig->num_cis); 10311d3a89d91SMatthias Ringwald event[pos++] = GAP_SUBEVENT_CIG_CREATED; 10312d3a89d91SMatthias Ringwald event[pos++] = status; 10313d3a89d91SMatthias Ringwald event[pos++] = cig->cig_id; 10314d3a89d91SMatthias Ringwald event[pos++] = cig->num_cis; 10315d3a89d91SMatthias Ringwald uint8_t i; 10316d3a89d91SMatthias Ringwald for (i=0;i<cig->num_cis;i++){ 10317d3a89d91SMatthias Ringwald little_endian_store_16(event, pos, cig->cis_con_handles[i]); 10318d3a89d91SMatthias Ringwald pos += 2; 10319d3a89d91SMatthias Ringwald } 103209da9850bSMatthias Ringwald hci_emit_btstack_event(event, pos, 0); 10321d3a89d91SMatthias Ringwald } 10322f06bb90fSMatthias Ringwald 10323620553bdSMatthias Ringwald static uint16_t hci_setup_cis_created(uint8_t * event, hci_iso_stream_t * iso_stream, uint8_t status) { 10324f06bb90fSMatthias Ringwald uint16_t pos = 0; 10325f06bb90fSMatthias Ringwald event[pos++] = HCI_EVENT_META_GAP; 10326cf439c63SMatthias Ringwald event[pos++] = 8; 10327f06bb90fSMatthias Ringwald event[pos++] = GAP_SUBEVENT_CIS_CREATED; 10328f06bb90fSMatthias Ringwald event[pos++] = status; 10329620553bdSMatthias Ringwald event[pos++] = iso_stream->group_id; 10330620553bdSMatthias Ringwald event[pos++] = iso_stream->stream_id; 10331620553bdSMatthias Ringwald little_endian_store_16(event, pos, iso_stream->cis_handle); 10332f06bb90fSMatthias Ringwald pos += 2; 10333620553bdSMatthias Ringwald little_endian_store_16(event, pos, iso_stream->acl_handle); 10334cf439c63SMatthias Ringwald pos += 2; 103357dd97f73SMatthias Ringwald little_endian_store_16(event, pos, iso_stream->iso_interval_1250us); 103367dd97f73SMatthias Ringwald pos += 2; 103377dd97f73SMatthias Ringwald event[pos++] = iso_stream->number_of_subevents; 103387dd97f73SMatthias Ringwald event[pos++] = iso_stream->burst_number_c_to_p; 103397dd97f73SMatthias Ringwald event[pos++] = iso_stream->burst_number_p_to_c; 103407dd97f73SMatthias Ringwald event[pos++] = iso_stream->flush_timeout_c_to_p; 103417dd97f73SMatthias Ringwald event[pos++] = iso_stream->flush_timeout_p_to_c; 10342620553bdSMatthias Ringwald return pos; 10343f06bb90fSMatthias Ringwald } 10344f06bb90fSMatthias Ringwald 1034514045fdbSMatthias Ringwald // emits GAP_SUBEVENT_CIS_CREATED after calling hci_iso_finalize 1034614045fdbSMatthias Ringwald static void hci_cis_handle_created(hci_iso_stream_t * iso_stream, uint8_t status){ 1034714045fdbSMatthias Ringwald // cache data before finalizing struct 103487dd97f73SMatthias Ringwald uint8_t event [17]; 10349620553bdSMatthias Ringwald uint16_t pos = hci_setup_cis_created(event, iso_stream, status); 10350620553bdSMatthias Ringwald btstack_assert(pos <= sizeof(event)); 1035114045fdbSMatthias Ringwald if (status != ERROR_CODE_SUCCESS){ 1035214045fdbSMatthias Ringwald hci_iso_stream_finalize(iso_stream); 1035314045fdbSMatthias Ringwald } 103549da9850bSMatthias Ringwald hci_emit_btstack_event(event, pos, 0); 1035514045fdbSMatthias Ringwald } 1035614045fdbSMatthias Ringwald 103577aa35f6aSMatthias Ringwald static void hci_emit_big_terminated(const le_audio_big_t * big){ 103587aa35f6aSMatthias Ringwald uint8_t event [4]; 103597aa35f6aSMatthias Ringwald uint16_t pos = 0; 103607aa35f6aSMatthias Ringwald event[pos++] = HCI_EVENT_META_GAP; 103617aa35f6aSMatthias Ringwald event[pos++] = 2; 103627aa35f6aSMatthias Ringwald event[pos++] = GAP_SUBEVENT_BIG_TERMINATED; 103637aa35f6aSMatthias Ringwald event[pos++] = big->big_handle; 103649da9850bSMatthias Ringwald hci_emit_btstack_event(event, pos, 0); 103657aa35f6aSMatthias Ringwald } 103667aa35f6aSMatthias Ringwald 103672a6c0f82SMatthias Ringwald static void hci_emit_big_sync_created(const le_audio_big_sync_t * big_sync, uint8_t status){ 103682a6c0f82SMatthias Ringwald uint8_t event [6 + (MAX_NR_BIS * 2)]; 103692a6c0f82SMatthias Ringwald uint16_t pos = 0; 103702a6c0f82SMatthias Ringwald event[pos++] = HCI_EVENT_META_GAP; 103712a6c0f82SMatthias Ringwald event[pos++] = 4; 103722a6c0f82SMatthias Ringwald event[pos++] = GAP_SUBEVENT_BIG_SYNC_CREATED; 103732a6c0f82SMatthias Ringwald event[pos++] = status; 103742a6c0f82SMatthias Ringwald event[pos++] = big_sync->big_handle; 103752a6c0f82SMatthias Ringwald event[pos++] = big_sync->num_bis; 103762a6c0f82SMatthias Ringwald uint8_t i; 103772a6c0f82SMatthias Ringwald for (i=0;i<big_sync->num_bis;i++){ 103782a6c0f82SMatthias Ringwald little_endian_store_16(event, pos, big_sync->bis_con_handles[i]); 103792a6c0f82SMatthias Ringwald pos += 2; 103802a6c0f82SMatthias Ringwald } 103819da9850bSMatthias Ringwald hci_emit_btstack_event(event, pos, 0); 103822a6c0f82SMatthias Ringwald } 103832a6c0f82SMatthias Ringwald 10384d04a9afcSMatthias Ringwald static void hci_emit_big_sync_stopped(uint8_t big_handle){ 103852a6c0f82SMatthias Ringwald uint8_t event [4]; 103862a6c0f82SMatthias Ringwald uint16_t pos = 0; 103872a6c0f82SMatthias Ringwald event[pos++] = HCI_EVENT_META_GAP; 103882a6c0f82SMatthias Ringwald event[pos++] = 2; 103892a6c0f82SMatthias Ringwald event[pos++] = GAP_SUBEVENT_BIG_SYNC_STOPPED; 10390d04a9afcSMatthias Ringwald event[pos++] = big_handle; 103919da9850bSMatthias Ringwald hci_emit_btstack_event(event, pos, 0); 103922a6c0f82SMatthias Ringwald } 103932a6c0f82SMatthias Ringwald 103945ade6657SMatthias Ringwald static void hci_emit_bis_can_send_now(const le_audio_big_t *big, uint8_t bis_index) { 103955ade6657SMatthias Ringwald uint8_t event[6]; 103965ade6657SMatthias Ringwald uint16_t pos = 0; 103975ade6657SMatthias Ringwald event[pos++] = HCI_EVENT_BIS_CAN_SEND_NOW; 103985ade6657SMatthias Ringwald event[pos++] = sizeof(event) - 2; 103995ade6657SMatthias Ringwald event[pos++] = big->big_handle; 104005ade6657SMatthias Ringwald event[pos++] = bis_index; 104015ade6657SMatthias Ringwald little_endian_store_16(event, pos, big->bis_con_handles[bis_index]); 104029da9850bSMatthias Ringwald hci_emit_btstack_event(&event[0], sizeof(event), 0); // don't dump 104035ade6657SMatthias Ringwald } 104045ade6657SMatthias Ringwald 104052c077771SMatthias Ringwald static void hci_emit_cis_can_send_now(hci_con_handle_t cis_con_handle) { 104062c077771SMatthias Ringwald uint8_t event[4]; 104072c077771SMatthias Ringwald uint16_t pos = 0; 104082c077771SMatthias Ringwald event[pos++] = HCI_EVENT_CIS_CAN_SEND_NOW; 104092c077771SMatthias Ringwald event[pos++] = sizeof(event) - 2; 104102c077771SMatthias Ringwald little_endian_store_16(event, pos, cis_con_handle); 104119da9850bSMatthias Ringwald hci_emit_btstack_event(&event[0], sizeof(event), 0); // don't dump 104122c077771SMatthias Ringwald } 104132c077771SMatthias Ringwald 104147aa35f6aSMatthias Ringwald static le_audio_big_t * hci_big_for_handle(uint8_t big_handle){ 104157aa35f6aSMatthias Ringwald btstack_linked_list_iterator_t it; 104167aa35f6aSMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->le_audio_bigs); 104177aa35f6aSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 104187aa35f6aSMatthias Ringwald le_audio_big_t * big = (le_audio_big_t *) btstack_linked_list_iterator_next(&it); 104197aa35f6aSMatthias Ringwald if ( big->big_handle == big_handle ) { 104207aa35f6aSMatthias Ringwald return big; 104217aa35f6aSMatthias Ringwald } 104227aa35f6aSMatthias Ringwald } 104237aa35f6aSMatthias Ringwald return NULL; 104247aa35f6aSMatthias Ringwald } 104257aa35f6aSMatthias Ringwald 104262a6c0f82SMatthias Ringwald static le_audio_big_sync_t * hci_big_sync_for_handle(uint8_t big_handle){ 104272a6c0f82SMatthias Ringwald btstack_linked_list_iterator_t it; 104282a6c0f82SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->le_audio_big_syncs); 104292a6c0f82SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 104302a6c0f82SMatthias Ringwald le_audio_big_sync_t * big_sync = (le_audio_big_sync_t *) btstack_linked_list_iterator_next(&it); 104312a6c0f82SMatthias Ringwald if ( big_sync->big_handle == big_handle ) { 104322a6c0f82SMatthias Ringwald return big_sync; 104332a6c0f82SMatthias Ringwald } 104342a6c0f82SMatthias Ringwald } 104352a6c0f82SMatthias Ringwald return NULL; 104362a6c0f82SMatthias Ringwald } 104372a6c0f82SMatthias Ringwald 1043801d4f05fSMatthias Ringwald void hci_set_num_iso_packets_to_queue(uint8_t num_packets){ 1043901d4f05fSMatthias Ringwald hci_stack->iso_packets_to_queue = num_packets; 1044001d4f05fSMatthias Ringwald } 1044101d4f05fSMatthias Ringwald 10442d3a89d91SMatthias Ringwald static le_audio_cig_t * hci_cig_for_id(uint8_t cig_id){ 10443d3a89d91SMatthias Ringwald btstack_linked_list_iterator_t it; 10444d3a89d91SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->le_audio_cigs); 10445d3a89d91SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 10446d3a89d91SMatthias Ringwald le_audio_cig_t * cig = (le_audio_cig_t *) btstack_linked_list_iterator_next(&it); 10447d3a89d91SMatthias Ringwald if ( cig->cig_id == cig_id ) { 10448d3a89d91SMatthias Ringwald return cig; 10449d3a89d91SMatthias Ringwald } 10450d3a89d91SMatthias Ringwald } 10451d3a89d91SMatthias Ringwald return NULL; 10452d3a89d91SMatthias Ringwald } 10453d3a89d91SMatthias Ringwald 104545ade6657SMatthias Ringwald static void hci_iso_notify_can_send_now(void){ 104552c077771SMatthias Ringwald 104562c077771SMatthias Ringwald // BIG 104572c077771SMatthias Ringwald 104585ade6657SMatthias Ringwald btstack_linked_list_iterator_t it; 104595ade6657SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->le_audio_bigs); 104605ade6657SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 104615ade6657SMatthias Ringwald le_audio_big_t * big = (le_audio_big_t *) btstack_linked_list_iterator_next(&it); 10462aacb1081SMatthias Ringwald // track number completed packet timestamps 10463aacb1081SMatthias Ringwald if (big->num_completed_timestamp_current_valid){ 10464aacb1081SMatthias Ringwald big->num_completed_timestamp_current_valid = false; 10465aacb1081SMatthias Ringwald if (big->num_completed_timestamp_previous_valid){ 10466aacb1081SMatthias Ringwald // detect delayed sending of all BIS: tolerate up to 50% delayed event handling 1046736916f81SDirk Helbig int32_t iso_interval_missed_threshold_ms = big->params->sdu_interval_us * 3 / 2000; 10468aacb1081SMatthias Ringwald int32_t num_completed_timestamp_delta_ms = btstack_time_delta(big->num_completed_timestamp_current_ms, 10469aacb1081SMatthias Ringwald big->num_completed_timestamp_previous_ms); 10470aacb1081SMatthias Ringwald if (num_completed_timestamp_delta_ms > iso_interval_missed_threshold_ms){ 10471aacb1081SMatthias Ringwald // to catch up, skip packet on all BIS 10472aacb1081SMatthias Ringwald uint8_t i; 10473aacb1081SMatthias Ringwald for (i=0;i<big->num_bis;i++){ 10474aacb1081SMatthias Ringwald hci_iso_stream_t * iso_stream = hci_iso_stream_for_con_handle(big->bis_con_handles[i]); 10475aacb1081SMatthias Ringwald if (iso_stream){ 10476aacb1081SMatthias Ringwald iso_stream->num_packets_to_skip++; 10477aacb1081SMatthias Ringwald } 10478aacb1081SMatthias Ringwald } 10479aacb1081SMatthias Ringwald } 10480aacb1081SMatthias Ringwald } 10481aacb1081SMatthias Ringwald big->num_completed_timestamp_previous_valid = true; 10482aacb1081SMatthias Ringwald big->num_completed_timestamp_previous_ms = big->num_completed_timestamp_current_ms; 10483aacb1081SMatthias Ringwald } 10484aacb1081SMatthias Ringwald 104855ade6657SMatthias Ringwald if (big->can_send_now_requested){ 10486d4e5d4faSMatthias Ringwald // check if no outgoing iso packets pending and no can send now have to be emitted 104875ade6657SMatthias Ringwald uint8_t i; 104885ade6657SMatthias Ringwald bool can_send = true; 10489aacb1081SMatthias Ringwald uint8_t num_iso_queued_minimum = 0; 104905ade6657SMatthias Ringwald for (i=0;i<big->num_bis;i++){ 104915ade6657SMatthias Ringwald hci_iso_stream_t * iso_stream = hci_iso_stream_for_con_handle(big->bis_con_handles[i]); 10492aacb1081SMatthias Ringwald if (iso_stream == NULL) continue; 10493aacb1081SMatthias Ringwald // handle case where individual ISO packet was sent too late: 10494aacb1081SMatthias Ringwald // for each additionally queued packet, a new one needs to get skipped 10495aacb1081SMatthias Ringwald if (i==0){ 10496aacb1081SMatthias Ringwald num_iso_queued_minimum = iso_stream->num_packets_sent; 10497aacb1081SMatthias Ringwald } else if (iso_stream->num_packets_sent > num_iso_queued_minimum){ 10498aacb1081SMatthias Ringwald uint8_t num_packets_to_skip = iso_stream->num_packets_sent - num_iso_queued_minimum; 10499aacb1081SMatthias Ringwald iso_stream->num_packets_to_skip += num_packets_to_skip; 10500aacb1081SMatthias Ringwald iso_stream->num_packets_sent -= num_packets_to_skip; 10501aacb1081SMatthias Ringwald } 10502aacb1081SMatthias Ringwald // check if we can send now 10503aacb1081SMatthias Ringwald if ((iso_stream->num_packets_sent >= hci_stack->iso_packets_to_queue) || (iso_stream->emit_ready_to_send)){ 105045ade6657SMatthias Ringwald can_send = false; 105055ade6657SMatthias Ringwald break; 105065ade6657SMatthias Ringwald } 105075ade6657SMatthias Ringwald } 105085ade6657SMatthias Ringwald if (can_send){ 105095ade6657SMatthias Ringwald // propagate can send now to individual streams 105105ade6657SMatthias Ringwald big->can_send_now_requested = false; 105115ade6657SMatthias Ringwald for (i=0;i<big->num_bis;i++){ 105125ade6657SMatthias Ringwald hci_iso_stream_t * iso_stream = hci_iso_stream_for_con_handle(big->bis_con_handles[i]); 105135ade6657SMatthias Ringwald iso_stream->emit_ready_to_send = true; 105145ade6657SMatthias Ringwald } 105155ade6657SMatthias Ringwald } 105165ade6657SMatthias Ringwald } 105175ade6657SMatthias Ringwald } 105185ade6657SMatthias Ringwald 105195ade6657SMatthias Ringwald if (hci_stack->hci_packet_buffer_reserved) return; 105205ade6657SMatthias Ringwald 105215ade6657SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->le_audio_bigs); 105225ade6657SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 105235ade6657SMatthias Ringwald le_audio_big_t * big = (le_audio_big_t *) btstack_linked_list_iterator_next(&it); 105245ade6657SMatthias Ringwald // report bis ready 105255ade6657SMatthias Ringwald uint8_t i; 105265ade6657SMatthias Ringwald for (i=0;i<big->num_bis;i++){ 105275ade6657SMatthias Ringwald hci_iso_stream_t * iso_stream = hci_iso_stream_for_con_handle(big->bis_con_handles[i]); 105285ade6657SMatthias Ringwald if ((iso_stream != NULL) && iso_stream->emit_ready_to_send){ 105295ade6657SMatthias Ringwald iso_stream->emit_ready_to_send = false; 105305ade6657SMatthias Ringwald hci_emit_bis_can_send_now(big, i); 105310fc451bcSMatthias Ringwald if (hci_stack->hci_packet_buffer_reserved) return; 105325ade6657SMatthias Ringwald } 105335ade6657SMatthias Ringwald } 105345ade6657SMatthias Ringwald } 105352c077771SMatthias Ringwald 105360fc451bcSMatthias Ringwald 105372c077771SMatthias Ringwald // CIS 105382c077771SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->iso_streams); 105392c077771SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)) { 105402c077771SMatthias Ringwald hci_iso_stream_t *iso_stream = (hci_iso_stream_t *) btstack_linked_list_iterator_next(&it); 105412c077771SMatthias Ringwald if ((iso_stream->can_send_now_requested) && 105422c077771SMatthias Ringwald (iso_stream->num_packets_sent < hci_stack->iso_packets_to_queue)){ 105432c077771SMatthias Ringwald iso_stream->can_send_now_requested = false; 10544969d876aSMatthias Ringwald hci_emit_cis_can_send_now(iso_stream->cis_handle); 105450fc451bcSMatthias Ringwald if (hci_stack->hci_packet_buffer_reserved) return; 105462c077771SMatthias Ringwald } 105472c077771SMatthias Ringwald } 105485ade6657SMatthias Ringwald } 105495ade6657SMatthias Ringwald 10550c7308688SMatthias Ringwald static uint8_t gap_big_setup_iso_streams(uint8_t num_bis, uint8_t big_handle){ 10551d034696aSMatthias Ringwald // make big handle unique and usuable for big and big sync 10552c7308688SMatthias Ringwald if (hci_big_for_handle(big_handle) != NULL){ 105537aa35f6aSMatthias Ringwald return ERROR_CODE_ACL_CONNECTION_ALREADY_EXISTS; 105547aa35f6aSMatthias Ringwald } 10555c7308688SMatthias Ringwald if (hci_big_sync_for_handle(big_handle) != NULL){ 10556d034696aSMatthias Ringwald return ERROR_CODE_ACL_CONNECTION_ALREADY_EXISTS; 10557d034696aSMatthias Ringwald } 10558c7308688SMatthias Ringwald if (num_bis == 0){ 105597aa35f6aSMatthias Ringwald return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS; 105607aa35f6aSMatthias Ringwald } 10561c7308688SMatthias Ringwald if (num_bis > MAX_NR_BIS){ 105627aa35f6aSMatthias Ringwald return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS; 105637aa35f6aSMatthias Ringwald } 105647aa35f6aSMatthias Ringwald 10565fb16346aSMatthias Ringwald // reserve ISO Streams 10566fb16346aSMatthias Ringwald uint8_t i; 10567fb16346aSMatthias Ringwald uint8_t status = ERROR_CODE_SUCCESS; 10568c7308688SMatthias Ringwald for (i=0;i<num_bis;i++){ 10569c7308688SMatthias Ringwald hci_iso_stream_t * iso_stream = hci_iso_stream_create(HCI_ISO_TYPE_BIS, HCI_ISO_STREAM_STATE_REQUESTED, big_handle, i); 10570969d876aSMatthias Ringwald if (iso_stream == NULL) { 10571969d876aSMatthias Ringwald status = ERROR_CODE_MEMORY_CAPACITY_EXCEEDED; 10572fb16346aSMatthias Ringwald break; 10573fb16346aSMatthias Ringwald } 10574fb16346aSMatthias Ringwald } 10575fb16346aSMatthias Ringwald 10576fb16346aSMatthias Ringwald // free structs on error 10577fb16346aSMatthias Ringwald if (status != ERROR_CODE_SUCCESS){ 10578c7308688SMatthias Ringwald hci_iso_stream_finalize_by_type_and_group_id(HCI_ISO_TYPE_BIS, big_handle); 10579c7308688SMatthias Ringwald } 10580c7308688SMatthias Ringwald 10581c7308688SMatthias Ringwald return status; 10582c7308688SMatthias Ringwald } 10583c7308688SMatthias Ringwald 10584c7308688SMatthias Ringwald uint8_t gap_big_create(le_audio_big_t * storage, le_audio_big_params_t * big_params){ 10585c7308688SMatthias Ringwald uint8_t status = gap_big_setup_iso_streams(big_params->num_bis, big_params->big_handle); 10586c7308688SMatthias Ringwald if (status != ERROR_CODE_SUCCESS){ 10587fb16346aSMatthias Ringwald return status; 10588fb16346aSMatthias Ringwald } 10589fb16346aSMatthias Ringwald 105907aa35f6aSMatthias Ringwald le_audio_big_t * big = storage; 105917aa35f6aSMatthias Ringwald big->big_handle = big_params->big_handle; 105927aa35f6aSMatthias Ringwald big->params = big_params; 105937aa35f6aSMatthias Ringwald big->state = LE_AUDIO_BIG_STATE_CREATE; 105947aa35f6aSMatthias Ringwald big->num_bis = big_params->num_bis; 105957aa35f6aSMatthias Ringwald btstack_linked_list_add(&hci_stack->le_audio_bigs, (btstack_linked_item_t *) big); 105967aa35f6aSMatthias Ringwald 105977aa35f6aSMatthias Ringwald hci_run(); 105987aa35f6aSMatthias Ringwald 105997aa35f6aSMatthias Ringwald return ERROR_CODE_SUCCESS; 106007aa35f6aSMatthias Ringwald } 106017aa35f6aSMatthias Ringwald 106022a6c0f82SMatthias Ringwald uint8_t gap_big_sync_create(le_audio_big_sync_t * storage, le_audio_big_sync_params_t * big_sync_params){ 10603c7308688SMatthias Ringwald uint8_t status = gap_big_setup_iso_streams(big_sync_params->num_bis, big_sync_params->big_handle); 1060402e19895SMatthias Ringwald if (status != ERROR_CODE_SUCCESS){ 1060502e19895SMatthias Ringwald return status; 1060602e19895SMatthias Ringwald } 1060702e19895SMatthias Ringwald 106082a6c0f82SMatthias Ringwald le_audio_big_sync_t * big_sync = storage; 106092a6c0f82SMatthias Ringwald big_sync->big_handle = big_sync_params->big_handle; 106102a6c0f82SMatthias Ringwald big_sync->params = big_sync_params; 106112a6c0f82SMatthias Ringwald big_sync->state = LE_AUDIO_BIG_STATE_CREATE; 106122a6c0f82SMatthias Ringwald big_sync->num_bis = big_sync_params->num_bis; 106132a6c0f82SMatthias Ringwald btstack_linked_list_add(&hci_stack->le_audio_big_syncs, (btstack_linked_item_t *) big_sync); 106142a6c0f82SMatthias Ringwald 106152a6c0f82SMatthias Ringwald hci_run(); 106162a6c0f82SMatthias Ringwald 106172a6c0f82SMatthias Ringwald return ERROR_CODE_SUCCESS; 106182a6c0f82SMatthias Ringwald } 106192a6c0f82SMatthias Ringwald 106207aa35f6aSMatthias Ringwald uint8_t gap_big_terminate(uint8_t big_handle){ 106217aa35f6aSMatthias Ringwald le_audio_big_t * big = hci_big_for_handle(big_handle); 106227aa35f6aSMatthias Ringwald if (big == NULL){ 106237aa35f6aSMatthias Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 106247aa35f6aSMatthias Ringwald } 106257aa35f6aSMatthias Ringwald switch (big->state){ 106267aa35f6aSMatthias Ringwald case LE_AUDIO_BIG_STATE_CREATE: 106277aa35f6aSMatthias Ringwald btstack_linked_list_remove(&hci_stack->le_audio_bigs, (btstack_linked_item_t *) big); 106282a6c0f82SMatthias Ringwald hci_emit_big_terminated(big); 106292a6c0f82SMatthias Ringwald break; 106302a6c0f82SMatthias Ringwald case LE_AUDIO_BIG_STATE_W4_SETUP_ISO_PATH: 106312a6c0f82SMatthias Ringwald big->state = LE_AUDIO_BIG_STATE_W4_SETUP_ISO_PATH_THEN_TERMINATE; 106327aa35f6aSMatthias Ringwald break; 106337aa35f6aSMatthias Ringwald case LE_AUDIO_BIG_STATE_W4_ESTABLISHED: 106347aa35f6aSMatthias Ringwald case LE_AUDIO_BIG_STATE_SETUP_ISO_PATH: 106357aa35f6aSMatthias Ringwald case LE_AUDIO_BIG_STATE_ACTIVE: 106367aa35f6aSMatthias Ringwald big->state = LE_AUDIO_BIG_STATE_TERMINATE; 106377aa35f6aSMatthias Ringwald hci_run(); 106387aa35f6aSMatthias Ringwald break; 106392a6c0f82SMatthias Ringwald default: 106402a6c0f82SMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 106412a6c0f82SMatthias Ringwald } 106422a6c0f82SMatthias Ringwald return ERROR_CODE_SUCCESS; 106432a6c0f82SMatthias Ringwald } 106442a6c0f82SMatthias Ringwald 106452a6c0f82SMatthias Ringwald uint8_t gap_big_sync_terminate(uint8_t big_handle){ 106462a6c0f82SMatthias Ringwald le_audio_big_sync_t * big_sync = hci_big_sync_for_handle(big_handle); 106472a6c0f82SMatthias Ringwald if (big_sync == NULL){ 106482a6c0f82SMatthias Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 106492a6c0f82SMatthias Ringwald } 106502a6c0f82SMatthias Ringwald switch (big_sync->state){ 106512a6c0f82SMatthias Ringwald case LE_AUDIO_BIG_STATE_CREATE: 106522a6c0f82SMatthias Ringwald btstack_linked_list_remove(&hci_stack->le_audio_big_syncs, (btstack_linked_item_t *) big_sync); 10653d04a9afcSMatthias Ringwald hci_emit_big_sync_stopped(big_handle); 106542a6c0f82SMatthias Ringwald break; 106557aa35f6aSMatthias Ringwald case LE_AUDIO_BIG_STATE_W4_SETUP_ISO_PATH: 106562a6c0f82SMatthias Ringwald big_sync->state = LE_AUDIO_BIG_STATE_W4_SETUP_ISO_PATH_THEN_TERMINATE; 106572a6c0f82SMatthias Ringwald break; 106582a6c0f82SMatthias Ringwald case LE_AUDIO_BIG_STATE_W4_ESTABLISHED: 106592a6c0f82SMatthias Ringwald case LE_AUDIO_BIG_STATE_SETUP_ISO_PATH: 106602a6c0f82SMatthias Ringwald case LE_AUDIO_BIG_STATE_ACTIVE: 106612a6c0f82SMatthias Ringwald big_sync->state = LE_AUDIO_BIG_STATE_TERMINATE; 106622a6c0f82SMatthias Ringwald hci_run(); 106637aa35f6aSMatthias Ringwald break; 106647aa35f6aSMatthias Ringwald default: 106657aa35f6aSMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 106667aa35f6aSMatthias Ringwald } 106677aa35f6aSMatthias Ringwald return ERROR_CODE_SUCCESS; 106687aa35f6aSMatthias Ringwald } 10669d39e4f95SMatthias Ringwald 106705ade6657SMatthias Ringwald uint8_t hci_request_bis_can_send_now_events(uint8_t big_handle){ 106715ade6657SMatthias Ringwald le_audio_big_t * big = hci_big_for_handle(big_handle); 106725ade6657SMatthias Ringwald if (big == NULL){ 106735ade6657SMatthias Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 106745ade6657SMatthias Ringwald } 106755ade6657SMatthias Ringwald if (big->state != LE_AUDIO_BIG_STATE_ACTIVE){ 106765ade6657SMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 106775ade6657SMatthias Ringwald } 106785ade6657SMatthias Ringwald big->can_send_now_requested = true; 106795ade6657SMatthias Ringwald hci_iso_notify_can_send_now(); 106805ade6657SMatthias Ringwald return ERROR_CODE_SUCCESS; 106815ade6657SMatthias Ringwald } 10682d3a89d91SMatthias Ringwald 106832c077771SMatthias Ringwald uint8_t hci_request_cis_can_send_now_events(hci_con_handle_t cis_con_handle){ 106842c077771SMatthias Ringwald hci_iso_stream_t * iso_stream = hci_iso_stream_for_con_handle(cis_con_handle); 106852c077771SMatthias Ringwald if (iso_stream == NULL){ 106862c077771SMatthias Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 106872c077771SMatthias Ringwald } 106882c077771SMatthias Ringwald if ((iso_stream->iso_type != HCI_ISO_TYPE_CIS) && (iso_stream->state != HCI_ISO_STREAM_STATE_ESTABLISHED)) { 106892c077771SMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 106902c077771SMatthias Ringwald } 106912c077771SMatthias Ringwald iso_stream->can_send_now_requested = true; 106922c077771SMatthias Ringwald hci_iso_notify_can_send_now(); 106932c077771SMatthias Ringwald return ERROR_CODE_SUCCESS; 106942c077771SMatthias Ringwald } 106952c077771SMatthias Ringwald 10696d3a89d91SMatthias Ringwald uint8_t gap_cig_create(le_audio_cig_t * storage, le_audio_cig_params_t * cig_params){ 10697d3a89d91SMatthias Ringwald if (hci_cig_for_id(cig_params->cig_id) != NULL){ 10698d3a89d91SMatthias Ringwald return ERROR_CODE_ACL_CONNECTION_ALREADY_EXISTS; 10699d3a89d91SMatthias Ringwald } 10700d3a89d91SMatthias Ringwald if (cig_params->num_cis == 0){ 10701d3a89d91SMatthias Ringwald return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS; 10702d3a89d91SMatthias Ringwald } 107033e377057SMatthias Ringwald if (cig_params->num_cis > MAX_NR_CIS){ 10704d3a89d91SMatthias Ringwald return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS; 10705d3a89d91SMatthias Ringwald } 10706d3a89d91SMatthias Ringwald 10707d3a89d91SMatthias Ringwald // reserve ISO Streams 10708d3a89d91SMatthias Ringwald uint8_t i; 10709d3a89d91SMatthias Ringwald uint8_t status = ERROR_CODE_SUCCESS; 10710d3a89d91SMatthias Ringwald for (i=0;i<cig_params->num_cis;i++){ 10711969d876aSMatthias 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); 1071236468e6fSMatthias Ringwald if (iso_stream == NULL) { 10713969d876aSMatthias Ringwald status = ERROR_CODE_MEMORY_CAPACITY_EXCEEDED; 10714d3a89d91SMatthias Ringwald break; 10715d3a89d91SMatthias Ringwald } 10716d3a89d91SMatthias Ringwald } 10717d3a89d91SMatthias Ringwald 10718d3a89d91SMatthias Ringwald // free structs on error 10719d3a89d91SMatthias Ringwald if (status != ERROR_CODE_SUCCESS){ 10720d3a89d91SMatthias Ringwald hci_iso_stream_finalize_by_type_and_group_id(HCI_ISO_TYPE_CIS, cig_params->cig_id); 10721d3a89d91SMatthias Ringwald return status; 10722d3a89d91SMatthias Ringwald } 10723d3a89d91SMatthias Ringwald 10724d3a89d91SMatthias Ringwald le_audio_cig_t * cig = storage; 10725d3a89d91SMatthias Ringwald cig->cig_id = cig_params->cig_id; 10726d3a89d91SMatthias Ringwald cig->num_cis = cig_params->num_cis; 10727d3a89d91SMatthias Ringwald cig->params = cig_params; 10728d3a89d91SMatthias Ringwald cig->state = LE_AUDIO_CIG_STATE_CREATE; 10729444e371eSMatthias Ringwald for (i=0;i<cig->num_cis;i++){ 10730444e371eSMatthias Ringwald cig->cis_con_handles[i] = HCI_CON_HANDLE_INVALID; 10731444e371eSMatthias Ringwald cig->acl_con_handles[i] = HCI_CON_HANDLE_INVALID; 107320f0ba168SMatthias Ringwald cig->cis_setup_active[i] = false; 107330f0ba168SMatthias Ringwald cig->cis_established[i] = false; 10734444e371eSMatthias Ringwald } 10735d3a89d91SMatthias Ringwald btstack_linked_list_add(&hci_stack->le_audio_cigs, (btstack_linked_item_t *) cig); 10736d3a89d91SMatthias Ringwald 10737d3a89d91SMatthias Ringwald hci_run(); 10738d3a89d91SMatthias Ringwald 10739d3a89d91SMatthias Ringwald return ERROR_CODE_SUCCESS; 10740d3a89d91SMatthias Ringwald } 10741d3a89d91SMatthias Ringwald 10742d90722d4SMatthias Ringwald uint8_t gap_cig_remove(uint8_t cig_id){ 10743d90722d4SMatthias Ringwald le_audio_cig_t * cig = hci_cig_for_id(cig_id); 10744d90722d4SMatthias Ringwald if (cig == NULL){ 10745d90722d4SMatthias Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 10746d90722d4SMatthias Ringwald } 10747d90722d4SMatthias Ringwald 10748d90722d4SMatthias Ringwald // close active CIS 10749d90722d4SMatthias Ringwald uint8_t i; 10750d90722d4SMatthias Ringwald for (i=0;i<cig->num_cis;i++){ 10751d90722d4SMatthias Ringwald hci_iso_stream_t * stream = hci_iso_stream_for_con_handle(cig->cis_con_handles[i]); 10752d90722d4SMatthias Ringwald if (stream != NULL){ 10753d90722d4SMatthias Ringwald stream->state = HCI_ISO_STREAM_STATE_W2_CLOSE; 10754d90722d4SMatthias Ringwald } 10755d90722d4SMatthias Ringwald } 10756d90722d4SMatthias Ringwald cig->state = LE_AUDIO_CIG_STATE_REMOVE; 10757d90722d4SMatthias Ringwald 10758d90722d4SMatthias Ringwald hci_run(); 10759d90722d4SMatthias Ringwald 10760d90722d4SMatthias Ringwald return ERROR_CODE_SUCCESS; 10761d90722d4SMatthias Ringwald } 10762d90722d4SMatthias Ringwald 10763f2e409f3SMatthias Ringwald uint8_t gap_cis_create(uint8_t cig_id, hci_con_handle_t cis_con_handles [], hci_con_handle_t acl_con_handles []){ 10764f2e409f3SMatthias Ringwald le_audio_cig_t * cig = hci_cig_for_id(cig_id); 10765444e371eSMatthias Ringwald if (cig == NULL){ 10766444e371eSMatthias Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 10767444e371eSMatthias Ringwald } 10768444e371eSMatthias Ringwald 10769444e371eSMatthias Ringwald if (cig->state != LE_AUDIO_CIG_STATE_W4_CIS_REQUEST){ 10770444e371eSMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 10771444e371eSMatthias Ringwald } 10772444e371eSMatthias Ringwald 10773444e371eSMatthias Ringwald // store ACL Connection Handles 10774444e371eSMatthias Ringwald uint8_t i; 10775444e371eSMatthias Ringwald for (i=0;i<cig->num_cis;i++){ 1077656bd2ec0SMatthias Ringwald // check that all con handles exist and store 10777444e371eSMatthias Ringwald hci_con_handle_t cis_handle = cis_con_handles[i]; 1077836468e6fSMatthias Ringwald if (cis_handle == HCI_CON_HANDLE_INVALID){ 1077936468e6fSMatthias Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 1078036468e6fSMatthias Ringwald } 10781444e371eSMatthias Ringwald uint8_t j; 10782444e371eSMatthias Ringwald bool found = false; 10783444e371eSMatthias Ringwald for (j=0;j<cig->num_cis;j++){ 10784444e371eSMatthias Ringwald if (cig->cis_con_handles[j] == cis_handle){ 10785444e371eSMatthias Ringwald cig->acl_con_handles[j] = acl_con_handles[j]; 1078656bd2ec0SMatthias Ringwald hci_iso_stream_t * iso_stream = hci_iso_stream_for_con_handle(cis_handle); 1078756bd2ec0SMatthias Ringwald btstack_assert(iso_stream != NULL); 1078856bd2ec0SMatthias Ringwald iso_stream->acl_handle = acl_con_handles[j]; 1078936468e6fSMatthias Ringwald found = true; 10790444e371eSMatthias Ringwald break; 10791444e371eSMatthias Ringwald } 10792444e371eSMatthias Ringwald } 10793444e371eSMatthias Ringwald if (!found){ 10794444e371eSMatthias Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 10795444e371eSMatthias Ringwald } 10796444e371eSMatthias Ringwald } 10797444e371eSMatthias Ringwald 10798444e371eSMatthias Ringwald cig->state = LE_AUDIO_CIG_STATE_CREATE_CIS; 10799444e371eSMatthias Ringwald hci_run(); 10800444e371eSMatthias Ringwald 10801444e371eSMatthias Ringwald return ERROR_CODE_SUCCESS; 10802444e371eSMatthias Ringwald } 10803444e371eSMatthias Ringwald 10804969d876aSMatthias Ringwald static uint8_t hci_cis_accept_or_reject(hci_con_handle_t cis_handle, hci_iso_stream_state_t state){ 10805969d876aSMatthias Ringwald hci_iso_stream_t * iso_stream = hci_iso_stream_for_con_handle(cis_handle); 108066fd1d2c8SMatthias Ringwald if (iso_stream == NULL){ 108076fd1d2c8SMatthias Ringwald // if we got a CIS Request but fail to allocate a hci_iso_stream_t object, we won't find it here 10808969d876aSMatthias Ringwald return ERROR_CODE_MEMORY_CAPACITY_EXCEEDED; 1080926b93350SMatthias Ringwald } 1081026b93350SMatthias Ringwald 108116fd1d2c8SMatthias Ringwald // set next state and continue 108126fd1d2c8SMatthias Ringwald iso_stream->state = state; 1081326b93350SMatthias Ringwald hci_run(); 1081426b93350SMatthias Ringwald return ERROR_CODE_SUCCESS; 1081526b93350SMatthias Ringwald } 1081626b93350SMatthias Ringwald 1081726b93350SMatthias Ringwald uint8_t gap_cis_accept(hci_con_handle_t cis_con_handle){ 1081826b93350SMatthias Ringwald return hci_cis_accept_or_reject(cis_con_handle, HCI_ISO_STREAM_W2_ACCEPT); 1081926b93350SMatthias Ringwald } 1082026b93350SMatthias Ringwald 1082126b93350SMatthias Ringwald uint8_t gap_cis_reject(hci_con_handle_t cis_con_handle){ 1082226b93350SMatthias Ringwald return hci_cis_accept_or_reject(cis_con_handle, HCI_ISO_STREAM_W2_REJECT); 1082326b93350SMatthias Ringwald } 1082426b93350SMatthias Ringwald 10825137a570aSMatthias Ringwald #endif /* ENABLE_LE_ISOCHRONOUS_STREAMS */ 1082626b93350SMatthias Ringwald 10827137a570aSMatthias Ringwald // GAP Privacy - notify clients before random address update 10828137a570aSMatthias Ringwald 10829137a570aSMatthias Ringwald static bool gap_privacy_client_all_ready(void){ 10830137a570aSMatthias Ringwald // check if all ready 10831137a570aSMatthias Ringwald btstack_linked_list_iterator_t it; 10832137a570aSMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->gap_privacy_clients); 10833137a570aSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)) { 10834137a570aSMatthias Ringwald gap_privacy_client_t *client = (gap_privacy_client_t *) btstack_linked_list_iterator_next(&it); 10835137a570aSMatthias Ringwald if (client->state != GAP_PRIVACY_CLIENT_STATE_READY){ 10836137a570aSMatthias Ringwald return false; 10837137a570aSMatthias Ringwald } 10838137a570aSMatthias Ringwald } 10839137a570aSMatthias Ringwald return true; 10840137a570aSMatthias Ringwald } 10841137a570aSMatthias Ringwald 10842137a570aSMatthias Ringwald static void gap_privacy_clients_handle_ready(void){ 10843137a570aSMatthias Ringwald // clear 'ready' 10844137a570aSMatthias Ringwald btstack_linked_list_iterator_t it; 10845137a570aSMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->gap_privacy_clients); 10846137a570aSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)) { 10847137a570aSMatthias Ringwald gap_privacy_client_t *client = (gap_privacy_client_t *) btstack_linked_list_iterator_next(&it); 10848137a570aSMatthias Ringwald client->state = GAP_PRIVACY_CLIENT_STATE_IDLE; 10849137a570aSMatthias Ringwald } 10850137a570aSMatthias Ringwald hci_stack->le_advertisements_state &= ~LE_ADVERTISEMENT_STATE_PRIVACY_PENDING; 10851137a570aSMatthias Ringwald hci_run(); 10852137a570aSMatthias Ringwald } 10853137a570aSMatthias Ringwald 10854137a570aSMatthias Ringwald static void gap_privacy_clients_notify(bd_addr_t new_random_address){ 10855137a570aSMatthias Ringwald btstack_linked_list_iterator_t it; 10856137a570aSMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->gap_privacy_clients); 10857137a570aSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)) { 10858137a570aSMatthias Ringwald gap_privacy_client_t *client = (gap_privacy_client_t *) btstack_linked_list_iterator_next(&it); 10859137a570aSMatthias Ringwald if (client->state == GAP_PRIVACY_CLIENT_STATE_IDLE){ 10860137a570aSMatthias Ringwald client->state = GAP_PRIVACY_CLIENT_STATE_PENDING; 10861137a570aSMatthias Ringwald (*client->callback)(client, new_random_address); 10862137a570aSMatthias Ringwald } 10863137a570aSMatthias Ringwald } 10864137a570aSMatthias Ringwald if (gap_privacy_client_all_ready()){ 10865137a570aSMatthias Ringwald gap_privacy_clients_handle_ready(); 10866137a570aSMatthias Ringwald } 10867137a570aSMatthias Ringwald } 10868137a570aSMatthias Ringwald 10869137a570aSMatthias Ringwald void gap_privacy_client_register(gap_privacy_client_t * client){ 10870137a570aSMatthias Ringwald client->state = GAP_PRIVACY_CLIENT_STATE_IDLE; 10871137a570aSMatthias Ringwald btstack_linked_list_add(&hci_stack->gap_privacy_clients, (btstack_linked_item_t *) client); 10872137a570aSMatthias Ringwald } 10873137a570aSMatthias Ringwald 10874137a570aSMatthias Ringwald void gap_privacy_client_ready(gap_privacy_client_t * client){ 10875137a570aSMatthias Ringwald client->state = GAP_PRIVACY_CLIENT_STATE_READY; 10876137a570aSMatthias Ringwald if (gap_privacy_client_all_ready()){ 10877137a570aSMatthias Ringwald gap_privacy_clients_handle_ready(); 10878137a570aSMatthias Ringwald } 10879137a570aSMatthias Ringwald } 10880137a570aSMatthias Ringwald 10881137a570aSMatthias Ringwald void gap_privacy_client_unregister(gap_privacy_client_t * client){ 10882137a570aSMatthias Ringwald btstack_linked_list_remove(&hci_stack->gap_privacy_clients, (btstack_linked_item_t *) client); 10883137a570aSMatthias Ringwald } 10884137a570aSMatthias Ringwald 108854ae8623eSMatthias Ringwald #endif /* ENABLE_BLE */ 10886f40c73b4SMatthias Ringwald 10887eddac615SMatthias Ringwald #ifdef FUZZING_BUILD_MODE_UNSAFE_FOR_PRODUCTION 1088818976c74SMatthias Ringwald void hci_setup_test_connections_fuzz(void){ 1088918976c74SMatthias Ringwald hci_connection_t * conn; 1089018976c74SMatthias Ringwald 1089118976c74SMatthias Ringwald // default address: 66:55:44:33:00:01 1089218976c74SMatthias Ringwald bd_addr_t addr = { 0x66, 0x55, 0x44, 0x33, 0x00, 0x00}; 1089318976c74SMatthias Ringwald 108947d33cb26SMilanka Ringwald // setup Controller info 108957d33cb26SMilanka Ringwald hci_stack->num_cmd_packets = 255; 108967d33cb26SMilanka Ringwald hci_stack->acl_packets_total_num = 255; 108977d33cb26SMilanka Ringwald 1089818976c74SMatthias Ringwald // setup incoming Classic ACL connection with con handle 0x0001, 66:55:44:33:22:01 1089918976c74SMatthias Ringwald addr[5] = 0x01; 1090017ab8643SMatthias Ringwald conn = create_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL, HCI_ROLE_SLAVE); 1090118976c74SMatthias Ringwald conn->con_handle = addr[5]; 1090218976c74SMatthias Ringwald conn->state = RECEIVED_CONNECTION_REQUEST; 109037d33cb26SMilanka Ringwald conn->sm_connection.sm_role = HCI_ROLE_SLAVE; 1090418976c74SMatthias Ringwald 1090518976c74SMatthias Ringwald // setup incoming Classic SCO connection with con handle 0x0002 1090618976c74SMatthias Ringwald addr[5] = 0x02; 1090717ab8643SMatthias Ringwald conn = create_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_SCO, HCI_ROLE_SLAVE); 1090818976c74SMatthias Ringwald conn->con_handle = addr[5]; 1090918976c74SMatthias Ringwald conn->state = RECEIVED_CONNECTION_REQUEST; 109107d33cb26SMilanka Ringwald conn->sm_connection.sm_role = HCI_ROLE_SLAVE; 1091118976c74SMatthias Ringwald 1091218976c74SMatthias Ringwald // setup ready Classic ACL connection with con handle 0x0003 1091318976c74SMatthias Ringwald addr[5] = 0x03; 1091417ab8643SMatthias Ringwald conn = create_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL, HCI_ROLE_SLAVE); 1091518976c74SMatthias Ringwald conn->con_handle = addr[5]; 1091618976c74SMatthias Ringwald conn->state = OPEN; 109177d33cb26SMilanka Ringwald conn->sm_connection.sm_role = HCI_ROLE_SLAVE; 1091818976c74SMatthias Ringwald 1091918976c74SMatthias Ringwald // setup ready Classic SCO connection with con handle 0x0004 1092018976c74SMatthias Ringwald addr[5] = 0x04; 1092117ab8643SMatthias Ringwald conn = create_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_SCO, HCI_ROLE_SLAVE); 1092218976c74SMatthias Ringwald conn->con_handle = addr[5]; 1092318976c74SMatthias Ringwald conn->state = OPEN; 109247d33cb26SMilanka Ringwald conn->sm_connection.sm_role = HCI_ROLE_SLAVE; 1092518976c74SMatthias Ringwald 1092618976c74SMatthias Ringwald // setup ready LE ACL connection with con handle 0x005 and public address 1092718976c74SMatthias Ringwald addr[5] = 0x05; 1092817ab8643SMatthias Ringwald conn = create_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_LE_PUBLIC, HCI_ROLE_SLAVE); 1092918976c74SMatthias Ringwald conn->con_handle = addr[5]; 1093018976c74SMatthias Ringwald conn->state = OPEN; 109317d33cb26SMilanka Ringwald conn->sm_connection.sm_role = HCI_ROLE_SLAVE; 109328046a24aSMatthias Ringwald conn->sm_connection.sm_connection_encrypted = 1; 1093318976c74SMatthias Ringwald } 1093418976c74SMatthias Ringwald 10935eddac615SMatthias Ringwald void hci_free_connections_fuzz(void){ 10936eddac615SMatthias Ringwald btstack_linked_list_iterator_t it; 10937eddac615SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->connections); 10938eddac615SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 10939eddac615SMatthias Ringwald hci_connection_t * con = (hci_connection_t*) btstack_linked_list_iterator_next(&it); 10940eddac615SMatthias Ringwald btstack_linked_list_iterator_remove(&it); 10941eddac615SMatthias Ringwald btstack_memory_hci_connection_free(con); 10942eddac615SMatthias Ringwald } 10943eddac615SMatthias Ringwald } 109441470db0cSMatthias Ringwald void hci_simulate_working_fuzz(void){ 10945b6ffb67fSMatthias Ringwald hci_stack->le_scanning_param_update = false; 109461470db0cSMatthias Ringwald hci_init_done(); 109471470db0cSMatthias Ringwald hci_stack->num_cmd_packets = 255; 109481470db0cSMatthias Ringwald } 10949eddac615SMatthias Ringwald #endif 10950