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 231713bceaSmatthias.ringwald * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL MATTHIAS 241713bceaSmatthias.ringwald * RINGWALD 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 564a3574a1SMatthias Ringwald #ifdef HAVE_PLATFORM_IPHONE_OS 57d0b87befSMatthias Ringwald #include "../port/ios/src/btstack_control_iphone.h" 584a3574a1SMatthias Ringwald #endif 594a3574a1SMatthias Ringwald 60a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE 61472a5742SMatthias Ringwald #include "gap.h" 6221debf25SMatthias Ringwald #include "ble/le_device_db.h" 6345c102fdSMatthias Ringwald #endif 6445c102fdSMatthias Ringwald 6593b8dc03Smatthias.ringwald #include <stdarg.h> 6693b8dc03Smatthias.ringwald #include <string.h> 675838a2edSMatthias Ringwald #include <inttypes.h> 687f2435e6Smatthias.ringwald 6916ece135SMatthias Ringwald #include "btstack_debug.h" 700e2df43fSMatthias Ringwald #include "btstack_event.h" 714a3574a1SMatthias Ringwald #include "btstack_linked_list.h" 724a3574a1SMatthias Ringwald #include "btstack_memory.h" 7361f37892SMatthias Ringwald #include "bluetooth_company_id.h" 741cfb383eSMatthias Ringwald #include "bluetooth_data_types.h" 754a3574a1SMatthias Ringwald #include "gap.h" 764a3574a1SMatthias Ringwald #include "hci.h" 774a3574a1SMatthias Ringwald #include "hci_cmd.h" 78d8905019Smatthias.ringwald #include "hci_dump.h" 791cfb383eSMatthias Ringwald #include "ad_parser.h" 8093b8dc03Smatthias.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 96aa81e641SMatthias Ringwald #if defined(ENABLE_SCO_OVER_HCI) && defined(ENABLE_SCO_OVER_PCM) 97aa81e641SMatthias 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." 98aa81e641SMatthias Ringwald #endif 99aa81e641SMatthias Ringwald 1001e20a53eSMatthias Ringwald #if defined(ENABLE_SCO_OVER_HCI) && defined(HAVE_SCO_TRANSPORT) 1011e20a53eSMatthias 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." 1021e20a53eSMatthias Ringwald #endif 1031e20a53eSMatthias Ringwald 104169f8b28Smatthias.ringwald #define HCI_CONNECTION_TIMEOUT_MS 10000 10562473419SMatthias Ringwald 10662473419SMatthias Ringwald #ifndef HCI_RESET_RESEND_TIMEOUT_MS 107659d758cSMatthias Ringwald #define HCI_RESET_RESEND_TIMEOUT_MS 200 10862473419SMatthias Ringwald #endif 109ee091cf1Smatthias.ringwald 1101cfb383eSMatthias Ringwald // Names are arbitrarily shortened to 32 bytes if not requested otherwise 1111cfb383eSMatthias Ringwald #ifndef GAP_INQUIRY_MAX_NAME_LEN 1121cfb383eSMatthias Ringwald #define GAP_INQUIRY_MAX_NAME_LEN 32 1131cfb383eSMatthias Ringwald #endif 1141cfb383eSMatthias Ringwald 115f5875de5SMatthias Ringwald // GAP inquiry state: 0 = off, 0x01 - 0x30 = requested duration, 0xfe = active, 0xff = stop requested 116f5875de5SMatthias Ringwald #define GAP_INQUIRY_DURATION_MIN 0x01 117f5875de5SMatthias Ringwald #define GAP_INQUIRY_DURATION_MAX 0x30 118beb3c81dSMatthias Ringwald #define GAP_INQUIRY_STATE_IDLE 0x00 119beb3c81dSMatthias Ringwald #define GAP_INQUIRY_STATE_W4_ACTIVE 0x80 120beb3c81dSMatthias Ringwald #define GAP_INQUIRY_STATE_ACTIVE 0x81 121beb3c81dSMatthias Ringwald #define GAP_INQUIRY_STATE_W2_CANCEL 0x82 122beb3c81dSMatthias Ringwald #define GAP_INQUIRY_STATE_W4_CANCELLED 0x83 123f5875de5SMatthias Ringwald 124b7f1ee76SMatthias Ringwald // GAP Remote Name Request 125b7f1ee76SMatthias Ringwald #define GAP_REMOTE_NAME_STATE_IDLE 0 126b7f1ee76SMatthias Ringwald #define GAP_REMOTE_NAME_STATE_W2_SEND 1 127b7f1ee76SMatthias Ringwald #define GAP_REMOTE_NAME_STATE_W4_COMPLETE 2 128b7f1ee76SMatthias Ringwald 1290a51f88bSMatthias Ringwald // GAP Pairing 1300a51f88bSMatthias Ringwald #define GAP_PAIRING_STATE_IDLE 0 1310a51f88bSMatthias Ringwald #define GAP_PAIRING_STATE_SEND_PIN 1 1320a51f88bSMatthias Ringwald #define GAP_PAIRING_STATE_SEND_PIN_NEGATIVE 2 1330a51f88bSMatthias Ringwald #define GAP_PAIRING_STATE_SEND_PASSKEY 3 1340a51f88bSMatthias Ringwald #define GAP_PAIRING_STATE_SEND_PASSKEY_NEGATIVE 4 1350a51f88bSMatthias Ringwald #define GAP_PAIRING_STATE_SEND_CONFIRMATION 5 1360a51f88bSMatthias Ringwald #define GAP_PAIRING_STATE_SEND_CONFIRMATION_NEGATIVE 6 1370a51f88bSMatthias Ringwald 1380a51f88bSMatthias Ringwald 139b83d5eabSMatthias Ringwald // prototypes 14035454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 141758b46ceSmatthias.ringwald static void hci_update_scan_enable(void); 14235454696SMatthias Ringwald static void hci_emit_discoverable_enabled(uint8_t enabled); 14335454696SMatthias Ringwald static int hci_local_ssp_activated(void); 14435454696SMatthias Ringwald static int hci_remote_ssp_supported(hci_con_handle_t con_handle); 14567aae551SMatthias Ringwald static bool hci_ssp_supported(hci_connection_t * connection); 14635454696SMatthias Ringwald static void hci_notify_if_sco_can_send_now(void); 14735454696SMatthias Ringwald static void hci_emit_connection_complete(bd_addr_t address, hci_con_handle_t con_handle, uint8_t status); 148a00031e2S[email protected] static gap_security_level_t gap_security_level_for_connection(hci_connection_t * connection); 14935454696SMatthias Ringwald static void hci_emit_security_level(hci_con_handle_t con_handle, gap_security_level_t level); 150ec820d77SMatthias Ringwald static void hci_connection_timeout_handler(btstack_timer_source_t *timer); 15196a45072S[email protected] static void hci_connection_timestamp(hci_connection_t *connection); 15252db98b2SMatthias Ringwald static void hci_emit_l2cap_check_timeout(hci_connection_t *conn); 1539784dac1SMatthias Ringwald static void gap_inquiry_explode(uint8_t *packet, uint16_t size); 15452db98b2SMatthias Ringwald #endif 1551cfb383eSMatthias Ringwald 1567586ee35S[email protected] static int hci_power_control_on(void); 1577586ee35S[email protected] static void hci_power_control_off(void); 1586da48142SSean Wilson static void hci_state_reset(void); 159fd43c0e0SMatthias Ringwald static void hci_emit_transport_packet_sent(void); 160fc64f94aSMatthias Ringwald static void hci_emit_disconnection_complete(hci_con_handle_t con_handle, uint8_t reason); 161b83d5eabSMatthias Ringwald static void hci_emit_nr_connections_changed(void); 162b83d5eabSMatthias Ringwald static void hci_emit_hci_open_failed(void); 163b83d5eabSMatthias Ringwald static void hci_emit_dedicated_bonding_result(bd_addr_t address, uint8_t status); 164b83d5eabSMatthias Ringwald static void hci_emit_event(uint8_t * event, uint16_t size, int dump); 165b83d5eabSMatthias Ringwald static void hci_emit_acl_packet(uint8_t * packet, uint16_t size); 16695d71764SMatthias Ringwald static void hci_run(void); 16795d71764SMatthias Ringwald static int hci_is_le_connection(hci_connection_t * connection); 16895d71764SMatthias Ringwald static int hci_number_free_acl_slots_for_connection_type( bd_addr_type_t address_type); 1696a5ffed8SMatthias Ringwald 1706a5ffed8SMatthias Ringwald #ifdef ENABLE_CLASSIC 171f234b250SMatthias Ringwald static int hci_have_usb_transport(void); 1726a5ffed8SMatthias Ringwald #endif 1735d509858SMatthias Ringwald 174a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE 175e8c8828eSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 17639677e66SMatthias Ringwald // called from test/ble_client/advertising_data_parser.c 177384b59deSMatthias Ringwald void le_handle_advertisement_report(uint8_t *packet, uint16_t size); 178667ba9d1SMatthias Ringwald static uint8_t hci_whitelist_remove(bd_addr_type_t address_type, const bd_addr_t address); 1799c77c9dbSMatthias Ringwald static hci_connection_t * gap_get_outgoing_connection(void); 1805d509858SMatthias Ringwald #endif 181d70217a2SMatthias Ringwald #endif 182758b46ceSmatthias.ringwald 18306b35ec0Smatthias.ringwald // the STACK is here 1843a9fb326S[email protected] #ifndef HAVE_MALLOC 1853a9fb326S[email protected] static hci_stack_t hci_stack_static; 1863a9fb326S[email protected] #endif 1873a9fb326S[email protected] static hci_stack_t * hci_stack = NULL; 18816833f0aSmatthias.ringwald 1891c9e5e9dSMatthias Ringwald #ifdef ENABLE_CLASSIC 19063168530SMatthias Ringwald // default name 19163168530SMatthias Ringwald static const char * default_classic_name = "BTstack 00:00:00:00:00:00"; 19263168530SMatthias Ringwald 19366fb9560S[email protected] // test helper 19466fb9560S[email protected] static uint8_t disable_l2cap_timeouts = 0; 1951c9e5e9dSMatthias Ringwald #endif 19666fb9560S[email protected] 19796a45072S[email protected] /** 19896a45072S[email protected] * create connection for given address 19996a45072S[email protected] * 20096a45072S[email protected] * @return connection OR NULL, if no memory left 20196a45072S[email protected] */ 202667ba9d1SMatthias Ringwald static hci_connection_t * create_connection_for_bd_addr_and_type(const bd_addr_t addr, bd_addr_type_t addr_type){ 2031a06f663S[email protected] log_info("create_connection_for_addr %s, type %x", bd_addr_to_str(addr), addr_type); 204bb69aaaeS[email protected] hci_connection_t * conn = btstack_memory_hci_connection_get(); 20596a45072S[email protected] if (!conn) return NULL; 206058e3d6bSMatthias Ringwald bd_addr_copy(conn->address, addr); 2072dceb1d6SMatthias Ringwald conn->role = HCI_ROLE_INVALID; 20896a45072S[email protected] conn->address_type = addr_type; 20996a45072S[email protected] conn->con_handle = 0xffff; 21096a45072S[email protected] conn->authentication_flags = AUTH_FLAGS_NONE; 21196a45072S[email protected] conn->bonding_flags = 0; 21296a45072S[email protected] conn->requested_security_level = LEVEL_0; 21352db98b2SMatthias Ringwald #ifdef ENABLE_CLASSIC 21488a03c8dSMatthias Ringwald conn->request_role = HCI_ROLE_INVALID; 21591a977e8SMatthias Ringwald btstack_run_loop_set_timer_handler(&conn->timeout, hci_connection_timeout_handler); 21691a977e8SMatthias Ringwald btstack_run_loop_set_timer_context(&conn->timeout, conn); 21796a45072S[email protected] hci_connection_timestamp(conn); 21852db98b2SMatthias Ringwald #endif 21996a45072S[email protected] conn->acl_recombination_length = 0; 22096a45072S[email protected] conn->acl_recombination_pos = 0; 221ce41473eSMatthias Ringwald conn->num_packets_sent = 0; 222760b20efSMatthias Ringwald 223da886c03S[email protected] conn->le_con_parameter_update_state = CON_PARAMETER_UPDATE_NONE; 224b90f6e0aSMatthias Ringwald #ifdef ENABLE_BLE 225b90f6e0aSMatthias Ringwald conn->le_phy_update_all_phys = 0xff; 226b90f6e0aSMatthias Ringwald #endif 2270f3b27c5SMatthias Ringwald #ifdef ENABLE_LE_LIMIT_ACL_FRAGMENT_BY_MAX_OCTETS 2280f3b27c5SMatthias Ringwald conn->le_max_tx_octets = 27; 2290f3b27c5SMatthias Ringwald #endif 230665d90f2SMatthias Ringwald btstack_linked_list_add(&hci_stack->connections, (btstack_linked_item_t *) conn); 23196a45072S[email protected] return conn; 23296a45072S[email protected] } 23366fb9560S[email protected] 234da886c03S[email protected] 235da886c03S[email protected] /** 236da886c03S[email protected] * get le connection parameter range 237da886c03S[email protected] * 238da886c03S[email protected] * @return le connection parameter range struct 239da886c03S[email protected] */ 2404ced4e8cSMatthias Ringwald void gap_get_connection_parameter_range(le_connection_parameter_range_t * range){ 2414ced4e8cSMatthias Ringwald *range = hci_stack->le_connection_parameter_range; 242da886c03S[email protected] } 243da886c03S[email protected] 244da886c03S[email protected] /** 245da886c03S[email protected] * set le connection parameter range 246da886c03S[email protected] * 247da886c03S[email protected] */ 248da886c03S[email protected] 2494ced4e8cSMatthias Ringwald void gap_set_connection_parameter_range(le_connection_parameter_range_t *range){ 2504ced4e8cSMatthias Ringwald hci_stack->le_connection_parameter_range = *range; 251da886c03S[email protected] } 252da886c03S[email protected] 253da886c03S[email protected] /** 25473cd8a2aSMatthias Ringwald * @brief Test if connection parameters are inside in existing rage 25573cd8a2aSMatthias Ringwald * @param conn_interval_min (unit: 1.25ms) 25673cd8a2aSMatthias Ringwald * @param conn_interval_max (unit: 1.25ms) 25773cd8a2aSMatthias Ringwald * @param conn_latency 25873cd8a2aSMatthias Ringwald * @param supervision_timeout (unit: 10ms) 25973cd8a2aSMatthias Ringwald * @returns 1 if included 26073cd8a2aSMatthias Ringwald */ 26173cd8a2aSMatthias 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){ 26273cd8a2aSMatthias Ringwald if (le_conn_interval_min < existing_range->le_conn_interval_min) return 0; 26373cd8a2aSMatthias Ringwald if (le_conn_interval_max > existing_range->le_conn_interval_max) return 0; 26473cd8a2aSMatthias Ringwald 26573cd8a2aSMatthias Ringwald if (le_conn_latency < existing_range->le_conn_latency_min) return 0; 26673cd8a2aSMatthias Ringwald if (le_conn_latency > existing_range->le_conn_latency_max) return 0; 26773cd8a2aSMatthias Ringwald 26873cd8a2aSMatthias Ringwald if (le_supervision_timeout < existing_range->le_supervision_timeout_min) return 0; 26973cd8a2aSMatthias Ringwald if (le_supervision_timeout > existing_range->le_supervision_timeout_max) return 0; 27073cd8a2aSMatthias Ringwald 27173cd8a2aSMatthias Ringwald return 1; 27273cd8a2aSMatthias Ringwald } 27373cd8a2aSMatthias Ringwald 27473cd8a2aSMatthias Ringwald /** 2752b6ab3e6SMatthias Ringwald * @brief Set max number of connections in LE Peripheral role (if Bluetooth Controller supports it) 2762b6ab3e6SMatthias Ringwald * @note: default: 1 2772b6ab3e6SMatthias Ringwald * @param max_peripheral_connections 2782b6ab3e6SMatthias Ringwald */ 279d4e4907bSMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 2802b6ab3e6SMatthias Ringwald void gap_set_max_number_peripheral_connections(int max_peripheral_connections){ 2812b6ab3e6SMatthias Ringwald hci_stack->le_max_number_peripheral_connections = max_peripheral_connections; 2822b6ab3e6SMatthias Ringwald } 283d4e4907bSMatthias Ringwald #endif 2842b6ab3e6SMatthias Ringwald 2852b6ab3e6SMatthias Ringwald /** 286da886c03S[email protected] * get hci connections iterator 287da886c03S[email protected] * 288da886c03S[email protected] * @return hci connections iterator 289da886c03S[email protected] */ 290da886c03S[email protected] 291665d90f2SMatthias Ringwald void hci_connections_get_iterator(btstack_linked_list_iterator_t *it){ 292665d90f2SMatthias Ringwald btstack_linked_list_iterator_init(it, &hci_stack->connections); 293da886c03S[email protected] } 294da886c03S[email protected] 29597addcc5Smatthias.ringwald /** 296ee091cf1Smatthias.ringwald * get connection for a given handle 297ee091cf1Smatthias.ringwald * 298ee091cf1Smatthias.ringwald * @return connection OR NULL, if not found 299ee091cf1Smatthias.ringwald */ 3005061f3afS[email protected] hci_connection_t * hci_connection_for_handle(hci_con_handle_t con_handle){ 301665d90f2SMatthias Ringwald btstack_linked_list_iterator_t it; 302665d90f2SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->connections); 303665d90f2SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 304665d90f2SMatthias Ringwald hci_connection_t * item = (hci_connection_t *) btstack_linked_list_iterator_next(&it); 3053ac2fe56S[email protected] if ( item->con_handle == con_handle ) { 306da886c03S[email protected] return item; 307ee091cf1Smatthias.ringwald } 308ee091cf1Smatthias.ringwald } 309ee091cf1Smatthias.ringwald return NULL; 310ee091cf1Smatthias.ringwald } 311ee091cf1Smatthias.ringwald 31296a45072S[email protected] /** 31396a45072S[email protected] * get connection for given address 31496a45072S[email protected] * 31596a45072S[email protected] * @return connection OR NULL, if not found 31696a45072S[email protected] */ 317667ba9d1SMatthias Ringwald hci_connection_t * hci_connection_for_bd_addr_and_type(const bd_addr_t addr, bd_addr_type_t addr_type){ 318665d90f2SMatthias Ringwald btstack_linked_list_iterator_t it; 319665d90f2SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->connections); 320665d90f2SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 321665d90f2SMatthias Ringwald hci_connection_t * connection = (hci_connection_t *) btstack_linked_list_iterator_next(&it); 32296a45072S[email protected] if (connection->address_type != addr_type) continue; 32396a45072S[email protected] if (memcmp(addr, connection->address, 6) != 0) continue; 32462bda3fbS[email protected] return connection; 32562bda3fbS[email protected] } 32662bda3fbS[email protected] return NULL; 32762bda3fbS[email protected] } 32862bda3fbS[email protected] 3293e5e0926SMatthias Ringwald inline static void connectionClearAuthenticationFlags(hci_connection_t * conn, hci_authentication_flags_t flags){ 3303e5e0926SMatthias Ringwald conn->authentication_flags = (hci_authentication_flags_t)(conn->authentication_flags & ~flags); 3313e5e0926SMatthias Ringwald } 33252db98b2SMatthias Ringwald 333228e430cSMatthias Ringwald inline static void connectionSetAuthenticationFlags(hci_connection_t * conn, hci_authentication_flags_t flags){ 334228e430cSMatthias Ringwald conn->authentication_flags = (hci_authentication_flags_t)(conn->authentication_flags | flags); 335228e430cSMatthias Ringwald } 336228e430cSMatthias Ringwald 33752db98b2SMatthias Ringwald #ifdef ENABLE_CLASSIC 33852db98b2SMatthias Ringwald 339ee752bb8SMatthias Ringwald #ifdef ENABLE_SCO_OVER_HCI 340ee752bb8SMatthias Ringwald static int hci_number_sco_connections(void){ 341ee752bb8SMatthias Ringwald int connections = 0; 342ee752bb8SMatthias Ringwald btstack_linked_list_iterator_t it; 343ee752bb8SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->connections); 344ee752bb8SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 345ee752bb8SMatthias Ringwald hci_connection_t * connection = (hci_connection_t *) btstack_linked_list_iterator_next(&it); 346ee752bb8SMatthias Ringwald if (connection->address_type != BD_ADDR_TYPE_SCO) continue; 347ee752bb8SMatthias Ringwald connections++; 348ee752bb8SMatthias Ringwald } 349ee752bb8SMatthias Ringwald return connections; 350ee752bb8SMatthias Ringwald } 351ee752bb8SMatthias Ringwald #endif 352ee752bb8SMatthias Ringwald 353ec820d77SMatthias Ringwald static void hci_connection_timeout_handler(btstack_timer_source_t *timer){ 35491a977e8SMatthias Ringwald hci_connection_t * connection = (hci_connection_t *) btstack_run_loop_get_timer_context(timer); 355aec7654dSMatthias Ringwald #ifdef HAVE_EMBEDDED_TICK 356528a4a3bSMatthias Ringwald if (btstack_run_loop_embedded_get_ticks() > connection->timestamp + btstack_run_loop_embedded_ticks_for_ms(HCI_CONNECTION_TIMEOUT_MS)){ 357c785ef68Smatthias.ringwald // connections might be timed out 358c785ef68Smatthias.ringwald hci_emit_l2cap_check_timeout(connection); 359c785ef68Smatthias.ringwald } 360f316a845SMatthias Ringwald #else 361c1ab6cc1SMatthias Ringwald if (btstack_run_loop_get_time_ms() > (connection->timestamp + HCI_CONNECTION_TIMEOUT_MS)){ 3625f26aadcSMatthias Ringwald // connections might be timed out 3635f26aadcSMatthias Ringwald hci_emit_l2cap_check_timeout(connection); 3645f26aadcSMatthias Ringwald } 3655f26aadcSMatthias Ringwald #endif 366c785ef68Smatthias.ringwald } 367ee091cf1Smatthias.ringwald 368ee091cf1Smatthias.ringwald static void hci_connection_timestamp(hci_connection_t *connection){ 369aec7654dSMatthias Ringwald #ifdef HAVE_EMBEDDED_TICK 370528a4a3bSMatthias Ringwald connection->timestamp = btstack_run_loop_embedded_get_ticks(); 371f316a845SMatthias Ringwald #else 372528a4a3bSMatthias Ringwald connection->timestamp = btstack_run_loop_get_time_ms(); 3735f26aadcSMatthias Ringwald #endif 374ee091cf1Smatthias.ringwald } 375ee091cf1Smatthias.ringwald 37643bfb1bdSmatthias.ringwald /** 37780ca58a0Smatthias.ringwald * add authentication flags and reset timer 37896a45072S[email protected] * @note: assumes classic connection 3792e77e513S[email protected] * @note: bd_addr is passed in as litle endian uint8_t * as it is called from parsing packets 3807fde4af9Smatthias.ringwald */ 3817fde4af9Smatthias.ringwald static void hci_add_connection_flags_for_flipped_bd_addr(uint8_t *bd_addr, hci_authentication_flags_t flags){ 3827fde4af9Smatthias.ringwald bd_addr_t addr; 383724d70a2SMatthias Ringwald reverse_bd_addr(bd_addr, addr); 384f16129ceSMatthias Ringwald hci_connection_t * conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL); 3857fde4af9Smatthias.ringwald if (conn) { 38628ca2b46S[email protected] connectionSetAuthenticationFlags(conn, flags); 38780ca58a0Smatthias.ringwald hci_connection_timestamp(conn); 3887fde4af9Smatthias.ringwald } 3897fde4af9Smatthias.ringwald } 3907fde4af9Smatthias.ringwald 39180ca58a0Smatthias.ringwald int hci_authentication_active_for_handle(hci_con_handle_t handle){ 3925061f3afS[email protected] hci_connection_t * conn = hci_connection_for_handle(handle); 39380ca58a0Smatthias.ringwald if (!conn) return 0; 3946724cd9eS[email protected] if (conn->authentication_flags & LEGACY_PAIRING_ACTIVE) return 1; 3956724cd9eS[email protected] if (conn->authentication_flags & SSP_PAIRING_ACTIVE) return 1; 3966724cd9eS[email protected] return 0; 39780ca58a0Smatthias.ringwald } 39880ca58a0Smatthias.ringwald 39915a95bd5SMatthias Ringwald void gap_drop_link_key_for_bd_addr(bd_addr_t addr){ 40055597469SMatthias Ringwald if (!hci_stack->link_key_db) return; 4012bacf595SMatthias Ringwald log_info("gap_drop_link_key_for_bd_addr: %s", bd_addr_to_str(addr)); 402a98592bcSMatthias Ringwald hci_stack->link_key_db->delete_link_key(addr); 403c12e46e7Smatthias.ringwald } 40455597469SMatthias Ringwald 40555597469SMatthias Ringwald void gap_store_link_key_for_bd_addr(bd_addr_t addr, link_key_t link_key, link_key_type_t type){ 40655597469SMatthias Ringwald if (!hci_stack->link_key_db) return; 4072bacf595SMatthias Ringwald log_info("gap_store_link_key_for_bd_addr: %s, type %u", bd_addr_to_str(addr), type); 40855597469SMatthias Ringwald hci_stack->link_key_db->put_link_key(addr, link_key, type); 409c12e46e7Smatthias.ringwald } 4101b6fb31bSMatthias Ringwald 411e8ad470fSMatthias Ringwald bool gap_get_link_key_for_bd_addr(bd_addr_t addr, link_key_t link_key, link_key_type_t * type){ 412e8ad470fSMatthias Ringwald if (!hci_stack->link_key_db) return false; 41376b0318eSMatthias Ringwald int result = hci_stack->link_key_db->get_link_key(addr, link_key, type) != 0; 41476b0318eSMatthias Ringwald log_info("link key for %s available %u, type %u", bd_addr_to_str(addr), result, (int) *type); 41576b0318eSMatthias Ringwald return result; 416e8ad470fSMatthias Ringwald } 417e8ad470fSMatthias Ringwald 418ceecb9d9SMatthias Ringwald void gap_delete_all_link_keys(void){ 419ceecb9d9SMatthias Ringwald bd_addr_t addr; 420ceecb9d9SMatthias Ringwald link_key_t link_key; 421ceecb9d9SMatthias Ringwald link_key_type_t type; 422ceecb9d9SMatthias Ringwald btstack_link_key_iterator_t it; 423ceecb9d9SMatthias Ringwald int ok = gap_link_key_iterator_init(&it); 424ceecb9d9SMatthias Ringwald if (!ok) { 425ceecb9d9SMatthias Ringwald log_error("could not initialize iterator"); 426ceecb9d9SMatthias Ringwald return; 427ceecb9d9SMatthias Ringwald } 428ceecb9d9SMatthias Ringwald while (gap_link_key_iterator_get_next(&it, addr, link_key, &type)){ 429ceecb9d9SMatthias Ringwald gap_drop_link_key_for_bd_addr(addr); 430ceecb9d9SMatthias Ringwald } 431ceecb9d9SMatthias Ringwald gap_link_key_iterator_done(&it); 432ceecb9d9SMatthias Ringwald } 433ceecb9d9SMatthias Ringwald 4341b6fb31bSMatthias Ringwald int gap_link_key_iterator_init(btstack_link_key_iterator_t * it){ 4351b6fb31bSMatthias Ringwald if (!hci_stack->link_key_db) return 0; 4361b6fb31bSMatthias Ringwald if (!hci_stack->link_key_db->iterator_init) return 0; 4371b6fb31bSMatthias Ringwald return hci_stack->link_key_db->iterator_init(it); 4381b6fb31bSMatthias Ringwald } 4391b6fb31bSMatthias 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){ 4401b6fb31bSMatthias Ringwald if (!hci_stack->link_key_db) return 0; 4411b6fb31bSMatthias Ringwald return hci_stack->link_key_db->iterator_get_next(it, bd_addr, link_key, type); 4421b6fb31bSMatthias Ringwald } 4431b6fb31bSMatthias Ringwald void gap_link_key_iterator_done(btstack_link_key_iterator_t * it){ 4441b6fb31bSMatthias Ringwald if (!hci_stack->link_key_db) return; 4451b6fb31bSMatthias Ringwald hci_stack->link_key_db->iterator_done(it); 4461b6fb31bSMatthias Ringwald } 44735454696SMatthias Ringwald #endif 448c12e46e7Smatthias.ringwald 449eb8076ddSMatthias Ringwald static bool hci_is_le_connection_type(bd_addr_type_t address_type){ 450eb8076ddSMatthias Ringwald switch (address_type){ 451ce41473eSMatthias Ringwald case BD_ADDR_TYPE_LE_PUBLIC: 452ce41473eSMatthias Ringwald case BD_ADDR_TYPE_LE_RANDOM: 453ce41473eSMatthias Ringwald case BD_ADDR_TYPE_LE_PRIVAT_FALLBACK_PUBLIC: 454ce41473eSMatthias Ringwald case BD_ADDR_TYPE_LE_PRIVAT_FALLBACK_RANDOM: 455eb8076ddSMatthias Ringwald return true; 456ce41473eSMatthias Ringwald default: 457eb8076ddSMatthias Ringwald return false; 458ce41473eSMatthias Ringwald } 4590bf6344aS[email protected] } 4600bf6344aS[email protected] 461eb8076ddSMatthias Ringwald static int hci_is_le_connection(hci_connection_t * connection){ 462eb8076ddSMatthias Ringwald return hci_is_le_connection_type(connection->address_type); 463eb8076ddSMatthias Ringwald } 464eb8076ddSMatthias Ringwald 4657fde4af9Smatthias.ringwald /** 46643bfb1bdSmatthias.ringwald * count connections 46743bfb1bdSmatthias.ringwald */ 46840d1c7a4Smatthias.ringwald static int nr_hci_connections(void){ 46956c253c9Smatthias.ringwald int count = 0; 470665d90f2SMatthias Ringwald btstack_linked_item_t *it; 471a0da043fSMatthias Ringwald for (it = (btstack_linked_item_t *) hci_stack->connections; it != NULL ; it = it->next){ 47215a27967SMatthias Ringwald count++; 47315a27967SMatthias Ringwald } 47443bfb1bdSmatthias.ringwald return count; 47543bfb1bdSmatthias.ringwald } 476c8e4258aSmatthias.ringwald 47795d71764SMatthias Ringwald static int hci_number_free_acl_slots_for_connection_type(bd_addr_type_t address_type){ 478ee303eddS[email protected] 479f04a0c31SMatthias Ringwald unsigned int num_packets_sent_classic = 0; 480f04a0c31SMatthias Ringwald unsigned int num_packets_sent_le = 0; 481ee303eddS[email protected] 482665d90f2SMatthias Ringwald btstack_linked_item_t *it; 483a0da043fSMatthias Ringwald for (it = (btstack_linked_item_t *) hci_stack->connections; it != NULL; it = it->next){ 484998906cdSmatthias.ringwald hci_connection_t * connection = (hci_connection_t *) it; 485ce41473eSMatthias Ringwald if (hci_is_le_connection(connection)){ 486ce41473eSMatthias Ringwald num_packets_sent_le += connection->num_packets_sent; 487ce41473eSMatthias Ringwald } 488f16129ceSMatthias Ringwald if (connection->address_type == BD_ADDR_TYPE_ACL){ 489ce41473eSMatthias Ringwald num_packets_sent_classic += connection->num_packets_sent; 490ee303eddS[email protected] } 491ee303eddS[email protected] } 492d999b54eSMatthias Ringwald log_debug("ACL classic buffers: %u used of %u", num_packets_sent_classic, hci_stack->acl_packets_total_num); 493ee303eddS[email protected] int free_slots_classic = hci_stack->acl_packets_total_num - num_packets_sent_classic; 494ee303eddS[email protected] int free_slots_le = 0; 495ee303eddS[email protected] 496ee303eddS[email protected] if (free_slots_classic < 0){ 4979da54300S[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); 498998906cdSmatthias.ringwald return 0; 499998906cdSmatthias.ringwald } 500ee303eddS[email protected] 501ee303eddS[email protected] if (hci_stack->le_acl_packets_total_num){ 502ee303eddS[email protected] // if we have LE slots, they are used 503ee303eddS[email protected] free_slots_le = hci_stack->le_acl_packets_total_num - num_packets_sent_le; 504ee303eddS[email protected] if (free_slots_le < 0){ 5059da54300S[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); 506ee303eddS[email protected] return 0; 507998906cdSmatthias.ringwald } 508ee303eddS[email protected] } else { 509ee303eddS[email protected] // otherwise, classic slots are used for LE, too 510ee303eddS[email protected] free_slots_classic -= num_packets_sent_le; 511ee303eddS[email protected] if (free_slots_classic < 0){ 5129da54300S[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); 513ee303eddS[email protected] return 0; 514ee303eddS[email protected] } 515ee303eddS[email protected] } 516ee303eddS[email protected] 517ee303eddS[email protected] switch (address_type){ 518ee303eddS[email protected] case BD_ADDR_TYPE_UNKNOWN: 5192125de09SMatthias Ringwald log_error("hci_number_free_acl_slots: unknown address type"); 520ee303eddS[email protected] return 0; 521ee303eddS[email protected] 522f16129ceSMatthias Ringwald case BD_ADDR_TYPE_ACL: 523ee303eddS[email protected] return free_slots_classic; 524ee303eddS[email protected] 525ee303eddS[email protected] default: 526cb00d3aaS[email protected] if (hci_stack->le_acl_packets_total_num){ 527ee303eddS[email protected] return free_slots_le; 528ee303eddS[email protected] } 529cb00d3aaS[email protected] return free_slots_classic; 530cb00d3aaS[email protected] } 531998906cdSmatthias.ringwald } 532998906cdSmatthias.ringwald 5332125de09SMatthias Ringwald int hci_number_free_acl_slots_for_handle(hci_con_handle_t con_handle){ 5342125de09SMatthias Ringwald // get connection type 5352125de09SMatthias Ringwald hci_connection_t * connection = hci_connection_for_handle(con_handle); 5362125de09SMatthias Ringwald if (!connection){ 5372125de09SMatthias Ringwald log_error("hci_number_free_acl_slots: handle 0x%04x not in connection list", con_handle); 5382125de09SMatthias Ringwald return 0; 5392125de09SMatthias Ringwald } 5402125de09SMatthias Ringwald return hci_number_free_acl_slots_for_connection_type(connection->address_type); 5412125de09SMatthias Ringwald } 5422125de09SMatthias Ringwald 54335454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 544701e3307SMatthias Ringwald static int hci_number_free_sco_slots(void){ 545f04a0c31SMatthias Ringwald unsigned int num_sco_packets_sent = 0; 546665d90f2SMatthias Ringwald btstack_linked_item_t *it; 547760b20efSMatthias Ringwald if (hci_stack->synchronous_flow_control_enabled){ 548760b20efSMatthias Ringwald // explicit flow control 549665d90f2SMatthias Ringwald for (it = (btstack_linked_item_t *) hci_stack->connections; it ; it = it->next){ 550e35edcc1S[email protected] hci_connection_t * connection = (hci_connection_t *) it; 551ce41473eSMatthias Ringwald if (connection->address_type != BD_ADDR_TYPE_SCO) continue; 552ce41473eSMatthias Ringwald num_sco_packets_sent += connection->num_packets_sent; 553e35edcc1S[email protected] } 554e35edcc1S[email protected] if (num_sco_packets_sent > hci_stack->sco_packets_total_num){ 555701e3307SMatthias Ringwald log_info("hci_number_free_sco_slots:packets (%u) > total packets (%u)", num_sco_packets_sent, hci_stack->sco_packets_total_num); 55644d0e3d5S[email protected] return 0; 55744d0e3d5S[email protected] } 558e35edcc1S[email protected] return hci_stack->sco_packets_total_num - num_sco_packets_sent; 55949205f5dSMatthias Ringwald } else { 56049205f5dSMatthias Ringwald // implicit flow control -- TODO 5616f28d2eeSMatthias Ringwald int num_ready = 0; 5626f28d2eeSMatthias Ringwald for (it = (btstack_linked_item_t *) hci_stack->connections; it ; it = it->next){ 5636f28d2eeSMatthias Ringwald hci_connection_t * connection = (hci_connection_t *) it; 5646f28d2eeSMatthias Ringwald if (connection->address_type != BD_ADDR_TYPE_SCO) continue; 5656f28d2eeSMatthias Ringwald if (connection->sco_tx_ready == 0) continue; 5666f28d2eeSMatthias Ringwald num_ready++; 56749205f5dSMatthias Ringwald } 5686f28d2eeSMatthias Ringwald return num_ready; 5696f28d2eeSMatthias Ringwald } 570e35edcc1S[email protected] } 57135454696SMatthias Ringwald #endif 57244d0e3d5S[email protected] 5732b838201SMatthias Ringwald // only used to send HCI Host Number Completed Packets 5742b838201SMatthias Ringwald static int hci_can_send_comand_packet_transport(void){ 575ac928cc2S[email protected] if (hci_stack->hci_packet_buffer_reserved) return 0; 576ac928cc2S[email protected] 577ac928cc2S[email protected] // check for async hci transport implementations 578ac928cc2S[email protected] if (hci_stack->hci_transport->can_send_packet_now){ 579ac928cc2S[email protected] if (!hci_stack->hci_transport->can_send_packet_now(HCI_COMMAND_DATA_PACKET)){ 580ac928cc2S[email protected] return 0; 581ac928cc2S[email protected] } 582ac928cc2S[email protected] } 5832b838201SMatthias Ringwald return 1; 5842b838201SMatthias Ringwald } 585ac928cc2S[email protected] 5862b838201SMatthias Ringwald // new functions replacing hci_can_send_packet_now[_using_packet_buffer] 5872b838201SMatthias Ringwald int hci_can_send_command_packet_now(void){ 5882b838201SMatthias Ringwald if (hci_can_send_comand_packet_transport() == 0) return 0; 5894ea43905SMatthias Ringwald return hci_stack->num_cmd_packets > 0u; 590ac928cc2S[email protected] } 591ac928cc2S[email protected] 5929d04d3a7SMatthias Ringwald static int hci_transport_can_send_prepared_packet_now(uint8_t packet_type){ 593ac928cc2S[email protected] // check for async hci transport implementations 5949d04d3a7SMatthias Ringwald if (!hci_stack->hci_transport->can_send_packet_now) return 1; 5959d04d3a7SMatthias Ringwald return hci_stack->hci_transport->can_send_packet_now(packet_type); 596ac928cc2S[email protected] } 5979d04d3a7SMatthias Ringwald 5989d04d3a7SMatthias Ringwald static int hci_can_send_prepared_acl_packet_for_address_type(bd_addr_type_t address_type){ 5999d04d3a7SMatthias Ringwald if (!hci_transport_can_send_prepared_packet_now(HCI_ACL_DATA_PACKET)) return 0; 6009d04d3a7SMatthias Ringwald return hci_number_free_acl_slots_for_connection_type(address_type) > 0; 601ac928cc2S[email protected] } 6029d04d3a7SMatthias Ringwald 6039d04d3a7SMatthias Ringwald int hci_can_send_acl_le_packet_now(void){ 6049d04d3a7SMatthias Ringwald if (hci_stack->hci_packet_buffer_reserved) return 0; 6059d04d3a7SMatthias Ringwald return hci_can_send_prepared_acl_packet_for_address_type(BD_ADDR_TYPE_LE_PUBLIC); 6069d04d3a7SMatthias Ringwald } 6079d04d3a7SMatthias Ringwald 6089d04d3a7SMatthias Ringwald int hci_can_send_prepared_acl_packet_now(hci_con_handle_t con_handle) { 6099d04d3a7SMatthias Ringwald if (!hci_transport_can_send_prepared_packet_now(HCI_ACL_DATA_PACKET)) return 0; 610e79abdd6S[email protected] return hci_number_free_acl_slots_for_handle(con_handle) > 0; 611ac928cc2S[email protected] } 612ac928cc2S[email protected] 613ac928cc2S[email protected] int hci_can_send_acl_packet_now(hci_con_handle_t con_handle){ 614ac928cc2S[email protected] if (hci_stack->hci_packet_buffer_reserved) return 0; 615ac928cc2S[email protected] return hci_can_send_prepared_acl_packet_now(con_handle); 6166b4af23dS[email protected] } 6176b4af23dS[email protected] 61835454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 61935454696SMatthias Ringwald int hci_can_send_acl_classic_packet_now(void){ 62035454696SMatthias Ringwald if (hci_stack->hci_packet_buffer_reserved) return 0; 621f16129ceSMatthias Ringwald return hci_can_send_prepared_acl_packet_for_address_type(BD_ADDR_TYPE_ACL); 62235454696SMatthias Ringwald } 62335454696SMatthias Ringwald 624701e3307SMatthias Ringwald int hci_can_send_prepared_sco_packet_now(void){ 625d057580eSMatthias Ringwald if (!hci_transport_can_send_prepared_packet_now(HCI_SCO_DATA_PACKET)) return 0; 626f234b250SMatthias Ringwald if (hci_have_usb_transport()){ 627f234b250SMatthias Ringwald return hci_stack->sco_can_send_now; 628f234b250SMatthias Ringwald } else { 629701e3307SMatthias Ringwald return hci_number_free_sco_slots() > 0; 63044d0e3d5S[email protected] } 631f234b250SMatthias Ringwald } 63244d0e3d5S[email protected] 633701e3307SMatthias Ringwald int hci_can_send_sco_packet_now(void){ 634d057580eSMatthias Ringwald if (hci_stack->hci_packet_buffer_reserved) return 0; 635701e3307SMatthias Ringwald return hci_can_send_prepared_sco_packet_now(); 63644d0e3d5S[email protected] } 63744d0e3d5S[email protected] 638d057580eSMatthias Ringwald void hci_request_sco_can_send_now_event(void){ 639d057580eSMatthias Ringwald hci_stack->sco_waiting_for_can_send_now = 1; 640d057580eSMatthias Ringwald hci_notify_if_sco_can_send_now(); 641d057580eSMatthias Ringwald } 64235454696SMatthias Ringwald #endif 643d057580eSMatthias Ringwald 64495d71764SMatthias Ringwald // used for internal checks in l2cap.c 645c8b9416aS[email protected] int hci_is_packet_buffer_reserved(void){ 646c8b9416aS[email protected] return hci_stack->hci_packet_buffer_reserved; 647c8b9416aS[email protected] } 648c8b9416aS[email protected] 6496b4af23dS[email protected] // reserves outgoing packet buffer. @returns 1 if successful 6506b4af23dS[email protected] int hci_reserve_packet_buffer(void){ 6519d14b626S[email protected] if (hci_stack->hci_packet_buffer_reserved) { 6529d14b626S[email protected] log_error("hci_reserve_packet_buffer called but buffer already reserved"); 6539d14b626S[email protected] return 0; 6549d14b626S[email protected] } 6556b4af23dS[email protected] hci_stack->hci_packet_buffer_reserved = 1; 6566b4af23dS[email protected] return 1; 6576b4af23dS[email protected] } 6586b4af23dS[email protected] 65968a0fcf7S[email protected] void hci_release_packet_buffer(void){ 66068a0fcf7S[email protected] hci_stack->hci_packet_buffer_reserved = 0; 66168a0fcf7S[email protected] } 66268a0fcf7S[email protected] 6636b4af23dS[email protected] // assumption: synchronous implementations don't provide can_send_packet_now as they don't keep the buffer after the call 6647f02f414SMatthias Ringwald static int hci_transport_synchronous(void){ 6656b4af23dS[email protected] return hci_stack->hci_transport->can_send_packet_now == NULL; 6666b4af23dS[email protected] } 6676b4af23dS[email protected] 668452cf3bbS[email protected] static int hci_send_acl_packet_fragments(hci_connection_t *connection){ 669452cf3bbS[email protected] 670452cf3bbS[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); 671452cf3bbS[email protected] 672452cf3bbS[email protected] // max ACL data packet length depends on connection type (LE vs. Classic) and available buffers 673452cf3bbS[email protected] uint16_t max_acl_data_packet_length = hci_stack->acl_data_packet_length; 6744ea43905SMatthias Ringwald if (hci_is_le_connection(connection) && (hci_stack->le_data_packets_length > 0u)){ 675452cf3bbS[email protected] max_acl_data_packet_length = hci_stack->le_data_packets_length; 676452cf3bbS[email protected] } 677452cf3bbS[email protected] 6780f3b27c5SMatthias Ringwald #ifdef ENABLE_LE_LIMIT_ACL_FRAGMENT_BY_MAX_OCTETS 679*fcf88f47SMatthias Ringwald if (hci_is_le_connection(connection) && (connection->le_max_tx_octets < max_acl_data_packet_length)){ 6800f3b27c5SMatthias Ringwald max_acl_data_packet_length = connection->le_max_tx_octets; 6810f3b27c5SMatthias Ringwald } 6820f3b27c5SMatthias Ringwald #endif 683452cf3bbS[email protected] 684d999b54eSMatthias Ringwald log_debug("hci_send_acl_packet_fragments entered"); 685d999b54eSMatthias Ringwald 686452cf3bbS[email protected] int err; 687452cf3bbS[email protected] // multiple packets could be send on a synchronous HCI transport 688ff3cc4a5SMatthias Ringwald while (true){ 689452cf3bbS[email protected] 690d999b54eSMatthias Ringwald log_debug("hci_send_acl_packet_fragments loop entered"); 691d999b54eSMatthias Ringwald 692452cf3bbS[email protected] // get current data 6934ea43905SMatthias Ringwald const uint16_t acl_header_pos = hci_stack->acl_fragmentation_pos - 4u; 694452cf3bbS[email protected] int current_acl_data_packet_length = hci_stack->acl_fragmentation_total_size - hci_stack->acl_fragmentation_pos; 6951979f09cSMatthias Ringwald bool more_fragments = false; 696452cf3bbS[email protected] 697452cf3bbS[email protected] // if ACL packet is larger than Bluetooth packet buffer, only send max_acl_data_packet_length 698452cf3bbS[email protected] if (current_acl_data_packet_length > max_acl_data_packet_length){ 6991979f09cSMatthias Ringwald more_fragments = true; 700452cf3bbS[email protected] current_acl_data_packet_length = max_acl_data_packet_length; 701452cf3bbS[email protected] } 702452cf3bbS[email protected] 703452cf3bbS[email protected] // copy handle_and_flags if not first fragment and update packet boundary flags to be 01 (continuing fragmnent) 7044ea43905SMatthias Ringwald if (acl_header_pos > 0u){ 705f8fbdce0SMatthias Ringwald uint16_t handle_and_flags = little_endian_read_16(hci_stack->hci_packet_buffer, 0); 7064ea43905SMatthias Ringwald handle_and_flags = (handle_and_flags & 0xcfffu) | (1u << 12u); 707f8fbdce0SMatthias Ringwald little_endian_store_16(hci_stack->hci_packet_buffer, acl_header_pos, handle_and_flags); 708452cf3bbS[email protected] } 709452cf3bbS[email protected] 710452cf3bbS[email protected] // update header len 7114ea43905SMatthias Ringwald little_endian_store_16(hci_stack->hci_packet_buffer, acl_header_pos + 2u, current_acl_data_packet_length); 712452cf3bbS[email protected] 713452cf3bbS[email protected] // count packet 714ce41473eSMatthias Ringwald connection->num_packets_sent++; 7151979f09cSMatthias Ringwald log_debug("hci_send_acl_packet_fragments loop before send (more fragments %d)", (int) more_fragments); 716d999b54eSMatthias Ringwald 717d999b54eSMatthias Ringwald // update state for next fragment (if any) as "transport done" might be sent during send_packet already 718d999b54eSMatthias Ringwald if (more_fragments){ 719d999b54eSMatthias Ringwald // update start of next fragment to send 720d999b54eSMatthias Ringwald hci_stack->acl_fragmentation_pos += current_acl_data_packet_length; 721d999b54eSMatthias Ringwald } else { 722d999b54eSMatthias Ringwald // done 723d999b54eSMatthias Ringwald hci_stack->acl_fragmentation_pos = 0; 724d999b54eSMatthias Ringwald hci_stack->acl_fragmentation_total_size = 0; 725d999b54eSMatthias Ringwald } 726452cf3bbS[email protected] 727452cf3bbS[email protected] // send packet 728452cf3bbS[email protected] uint8_t * packet = &hci_stack->hci_packet_buffer[acl_header_pos]; 729452cf3bbS[email protected] const int size = current_acl_data_packet_length + 4; 7305bb5bc3eS[email protected] hci_dump_packet(HCI_ACL_DATA_PACKET, 0, packet, size); 73181d2bdb2SMatthias Ringwald hci_stack->acl_fragmentation_tx_active = 1; 732452cf3bbS[email protected] err = hci_stack->hci_transport->send_packet(HCI_ACL_DATA_PACKET, packet, size); 733452cf3bbS[email protected] 7341979f09cSMatthias Ringwald log_debug("hci_send_acl_packet_fragments loop after send (more fragments %d)", (int) more_fragments); 735d999b54eSMatthias Ringwald 736452cf3bbS[email protected] // done yet? 737452cf3bbS[email protected] if (!more_fragments) break; 738452cf3bbS[email protected] 739452cf3bbS[email protected] // can send more? 740452cf3bbS[email protected] if (!hci_can_send_prepared_acl_packet_now(connection->con_handle)) return err; 741452cf3bbS[email protected] } 742452cf3bbS[email protected] 743d999b54eSMatthias Ringwald log_debug("hci_send_acl_packet_fragments loop over"); 744452cf3bbS[email protected] 745d051460cS[email protected] // release buffer now for synchronous transport 746203bace6S[email protected] if (hci_transport_synchronous()){ 74781d2bdb2SMatthias Ringwald hci_stack->acl_fragmentation_tx_active = 0; 748452cf3bbS[email protected] hci_release_packet_buffer(); 749fd43c0e0SMatthias Ringwald hci_emit_transport_packet_sent(); 750452cf3bbS[email protected] } 751452cf3bbS[email protected] 752452cf3bbS[email protected] return err; 753452cf3bbS[email protected] } 754452cf3bbS[email protected] 755826f7347S[email protected] // pre: caller has reserved the packet buffer 756826f7347S[email protected] int hci_send_acl_packet_buffer(int size){ 7577856c818Smatthias.ringwald 758452cf3bbS[email protected] // log_info("hci_send_acl_packet_buffer size %u", size); 759452cf3bbS[email protected] 760826f7347S[email protected] if (!hci_stack->hci_packet_buffer_reserved) { 761826f7347S[email protected] log_error("hci_send_acl_packet_buffer called without reserving packet buffer"); 762826f7347S[email protected] return 0; 763826f7347S[email protected] } 764826f7347S[email protected] 765d713a683S[email protected] uint8_t * packet = hci_stack->hci_packet_buffer; 766d713a683S[email protected] hci_con_handle_t con_handle = READ_ACL_CONNECTION_HANDLE(packet); 767d713a683S[email protected] 768826f7347S[email protected] // check for free places on Bluetooth module 769d713a683S[email protected] if (!hci_can_send_prepared_acl_packet_now(con_handle)) { 770826f7347S[email protected] log_error("hci_send_acl_packet_buffer called but no free ACL buffers on controller"); 77197b61c7bS[email protected] hci_release_packet_buffer(); 772068b8592SMatthias Ringwald hci_emit_transport_packet_sent(); 77397b61c7bS[email protected] return BTSTACK_ACL_BUFFERS_FULL; 77497b61c7bS[email protected] } 7756218e6f1Smatthias.ringwald 7765061f3afS[email protected] hci_connection_t *connection = hci_connection_for_handle( con_handle); 77797b61c7bS[email protected] if (!connection) { 7785fa0b7cfS[email protected] log_error("hci_send_acl_packet_buffer called but no connection for handle 0x%04x", con_handle); 77997b61c7bS[email protected] hci_release_packet_buffer(); 780068b8592SMatthias Ringwald hci_emit_transport_packet_sent(); 78197b61c7bS[email protected] return 0; 78297b61c7bS[email protected] } 78352db98b2SMatthias Ringwald 78452db98b2SMatthias Ringwald #ifdef ENABLE_CLASSIC 78556cf178bSmatthias.ringwald hci_connection_timestamp(connection); 78652db98b2SMatthias Ringwald #endif 78756cf178bSmatthias.ringwald 788452cf3bbS[email protected] // hci_dump_packet( HCI_ACL_DATA_PACKET, 0, packet, size); 7897856c818Smatthias.ringwald 790452cf3bbS[email protected] // setup data 791452cf3bbS[email protected] hci_stack->acl_fragmentation_total_size = size; 792452cf3bbS[email protected] hci_stack->acl_fragmentation_pos = 4; // start of L2CAP packet 7936218e6f1Smatthias.ringwald 794452cf3bbS[email protected] return hci_send_acl_packet_fragments(connection); 795ee091cf1Smatthias.ringwald } 796ee091cf1Smatthias.ringwald 79735454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 79844d0e3d5S[email protected] // pre: caller has reserved the packet buffer 79944d0e3d5S[email protected] int hci_send_sco_packet_buffer(int size){ 80044d0e3d5S[email protected] 80144d0e3d5S[email protected] // log_info("hci_send_acl_packet_buffer size %u", size); 80244d0e3d5S[email protected] 80344d0e3d5S[email protected] if (!hci_stack->hci_packet_buffer_reserved) { 80444d0e3d5S[email protected] log_error("hci_send_acl_packet_buffer called without reserving packet buffer"); 80544d0e3d5S[email protected] return 0; 80644d0e3d5S[email protected] } 80744d0e3d5S[email protected] 80844d0e3d5S[email protected] uint8_t * packet = hci_stack->hci_packet_buffer; 8094b3e1e19SMatthias Ringwald 8104b3e1e19SMatthias Ringwald // skip checks in loopback mode 8114b3e1e19SMatthias Ringwald if (!hci_stack->loopback_mode){ 81244d0e3d5S[email protected] hci_con_handle_t con_handle = READ_ACL_CONNECTION_HANDLE(packet); // same for ACL and SCO 81344d0e3d5S[email protected] 81444d0e3d5S[email protected] // check for free places on Bluetooth module 815701e3307SMatthias Ringwald if (!hci_can_send_prepared_sco_packet_now()) { 816cbf638a9SMatthias Ringwald log_error("hci_send_sco_packet_buffer called but no free SCO buffers on controller"); 81744d0e3d5S[email protected] hci_release_packet_buffer(); 818068b8592SMatthias Ringwald hci_emit_transport_packet_sent(); 81944d0e3d5S[email protected] return BTSTACK_ACL_BUFFERS_FULL; 82044d0e3d5S[email protected] } 82144d0e3d5S[email protected] 822e35edcc1S[email protected] // track send packet in connection struct 823e35edcc1S[email protected] hci_connection_t *connection = hci_connection_for_handle( con_handle); 824e35edcc1S[email protected] if (!connection) { 825e35edcc1S[email protected] log_error("hci_send_sco_packet_buffer called but no connection for handle 0x%04x", con_handle); 826e35edcc1S[email protected] hci_release_packet_buffer(); 827068b8592SMatthias Ringwald hci_emit_transport_packet_sent(); 828e35edcc1S[email protected] return 0; 829e35edcc1S[email protected] } 830f234b250SMatthias Ringwald 831f234b250SMatthias Ringwald if (hci_have_usb_transport()){ 832f234b250SMatthias Ringwald // token used 833f234b250SMatthias Ringwald hci_stack->sco_can_send_now = 0; 834f234b250SMatthias Ringwald } else { 835760b20efSMatthias Ringwald if (hci_stack->synchronous_flow_control_enabled){ 836ce41473eSMatthias Ringwald connection->num_packets_sent++; 8376f28d2eeSMatthias Ringwald } else { 838e4157653SMatthias Ringwald connection->sco_tx_ready--; 839760b20efSMatthias Ringwald } 8404b3e1e19SMatthias Ringwald } 841f234b250SMatthias Ringwald } 84244d0e3d5S[email protected] 84344d0e3d5S[email protected] hci_dump_packet( HCI_SCO_DATA_PACKET, 0, packet, size); 844543e835cSMatthias Ringwald 84543149fc9SMatthias Ringwald #ifdef HAVE_SCO_TRANSPORT 84643149fc9SMatthias Ringwald hci_stack->sco_transport->send_packet(packet, size); 84743149fc9SMatthias Ringwald hci_release_packet_buffer(); 84843149fc9SMatthias Ringwald hci_emit_transport_packet_sent(); 84943149fc9SMatthias Ringwald 85043149fc9SMatthias Ringwald return 0; 85143149fc9SMatthias Ringwald #else 85243149fc9SMatthias Ringwald int err = hci_stack->hci_transport->send_packet(HCI_SCO_DATA_PACKET, packet, size); 853543e835cSMatthias Ringwald if (hci_transport_synchronous()){ 854543e835cSMatthias Ringwald hci_release_packet_buffer(); 855fd43c0e0SMatthias Ringwald hci_emit_transport_packet_sent(); 856543e835cSMatthias Ringwald } 857543e835cSMatthias Ringwald 858543e835cSMatthias Ringwald return err; 85943149fc9SMatthias Ringwald #endif 86044d0e3d5S[email protected] } 86135454696SMatthias Ringwald #endif 86244d0e3d5S[email protected] 863c3b46f5aSMatthias Ringwald static void acl_handler(uint8_t *packet, uint16_t size){ 864e76a89eeS[email protected] 8657856c818Smatthias.ringwald // get info 8667856c818Smatthias.ringwald hci_con_handle_t con_handle = READ_ACL_CONNECTION_HANDLE(packet); 8675061f3afS[email protected] hci_connection_t *conn = hci_connection_for_handle(con_handle); 8687856c818Smatthias.ringwald uint8_t acl_flags = READ_ACL_FLAGS(packet); 8697856c818Smatthias.ringwald uint16_t acl_length = READ_ACL_LENGTH(packet); 8707856c818Smatthias.ringwald 8717856c818Smatthias.ringwald // ignore non-registered handle 8727856c818Smatthias.ringwald if (!conn){ 873c3b46f5aSMatthias Ringwald log_error("acl_handler called with non-registered handle %u!" , con_handle); 8747856c818Smatthias.ringwald return; 8757856c818Smatthias.ringwald } 8767856c818Smatthias.ringwald 877e76a89eeS[email protected] // assert packet is complete 8784ea43905SMatthias Ringwald if ((acl_length + 4u) != size){ 879c3b46f5aSMatthias Ringwald log_error("acl_handler called with ACL packet of wrong size %d, expected %u => dropping packet", size, acl_length + 4); 880e76a89eeS[email protected] return; 881e76a89eeS[email protected] } 882e76a89eeS[email protected] 88352db98b2SMatthias Ringwald #ifdef ENABLE_CLASSIC 8847856c818Smatthias.ringwald // update idle timestamp 8857856c818Smatthias.ringwald hci_connection_timestamp(conn); 88652db98b2SMatthias Ringwald #endif 8877856c818Smatthias.ringwald 8882b838201SMatthias Ringwald #ifdef ENABLE_HCI_CONTROLLER_TO_HOST_FLOW_CONTROL 8892b838201SMatthias Ringwald hci_stack->host_completed_packets = 1; 8902b838201SMatthias Ringwald conn->num_packets_completed++; 8912b838201SMatthias Ringwald #endif 8922b838201SMatthias Ringwald 8937856c818Smatthias.ringwald // handle different packet types 8944ea43905SMatthias Ringwald switch (acl_flags & 0x03u) { 8957856c818Smatthias.ringwald 8967856c818Smatthias.ringwald case 0x01: // continuation fragment 8977856c818Smatthias.ringwald 8980ca847afS[email protected] // sanity checks 8994ea43905SMatthias Ringwald if (conn->acl_recombination_pos == 0u) { 9009da54300S[email protected] log_error( "ACL Cont Fragment but no first fragment for handle 0x%02x", con_handle); 9017856c818Smatthias.ringwald return; 9027856c818Smatthias.ringwald } 9034ea43905SMatthias Ringwald if ((conn->acl_recombination_pos + acl_length) > (4u + HCI_ACL_BUFFER_SIZE)){ 9040ca847afS[email protected] log_error( "ACL Cont Fragment to large: combined packet %u > buffer size %u for handle 0x%02x", 9050ca847afS[email protected] conn->acl_recombination_pos + acl_length, 4 + HCI_ACL_BUFFER_SIZE, con_handle); 9060ca847afS[email protected] conn->acl_recombination_pos = 0; 9070ca847afS[email protected] return; 9080ca847afS[email protected] } 9097856c818Smatthias.ringwald 9107856c818Smatthias.ringwald // append fragment payload (header already stored) 9116535961aSMatthias Ringwald (void)memcpy(&conn->acl_recombination_buffer[HCI_INCOMING_PRE_BUFFER_SIZE + conn->acl_recombination_pos], 9126535961aSMatthias Ringwald &packet[4], acl_length); 9137856c818Smatthias.ringwald conn->acl_recombination_pos += acl_length; 9147856c818Smatthias.ringwald 9157856c818Smatthias.ringwald // forward complete L2CAP packet if complete. 9164ea43905SMatthias Ringwald if (conn->acl_recombination_pos >= (conn->acl_recombination_length + 4u + 4u)){ // pos already incl. ACL header 917d6b06661SMatthias Ringwald hci_emit_acl_packet(&conn->acl_recombination_buffer[HCI_INCOMING_PRE_BUFFER_SIZE], conn->acl_recombination_pos); 9187856c818Smatthias.ringwald // reset recombination buffer 9197856c818Smatthias.ringwald conn->acl_recombination_length = 0; 9207856c818Smatthias.ringwald conn->acl_recombination_pos = 0; 9217856c818Smatthias.ringwald } 9227856c818Smatthias.ringwald break; 9237856c818Smatthias.ringwald 9247856c818Smatthias.ringwald case 0x02: { // first fragment 9257856c818Smatthias.ringwald 92623a77e1aS[email protected] // sanity check 92723a77e1aS[email protected] if (conn->acl_recombination_pos) { 92823a77e1aS[email protected] log_error( "ACL First Fragment but data in buffer for handle 0x%02x, dropping stale fragments", con_handle); 92923a77e1aS[email protected] conn->acl_recombination_pos = 0; 93023a77e1aS[email protected] } 93123a77e1aS[email protected] 9327856c818Smatthias.ringwald // peek into L2CAP packet! 9337856c818Smatthias.ringwald uint16_t l2cap_length = READ_L2CAP_LENGTH( packet ); 9347856c818Smatthias.ringwald 9357856c818Smatthias.ringwald // compare fragment size to L2CAP packet size 9364ea43905SMatthias Ringwald if (acl_length >= (l2cap_length + 4u)){ 9377856c818Smatthias.ringwald // forward fragment as L2CAP packet 9384ea43905SMatthias Ringwald hci_emit_acl_packet(packet, acl_length + 4u); 9397856c818Smatthias.ringwald } else { 9400ca847afS[email protected] 9410ca847afS[email protected] if (acl_length > HCI_ACL_BUFFER_SIZE){ 9420ca847afS[email protected] log_error( "ACL First Fragment to large: fragment %u > buffer size %u for handle 0x%02x", 9430ca847afS[email protected] 4 + acl_length, 4 + HCI_ACL_BUFFER_SIZE, con_handle); 9440ca847afS[email protected] return; 9450ca847afS[email protected] } 9460ca847afS[email protected] 9477856c818Smatthias.ringwald // store first fragment and tweak acl length for complete package 9486535961aSMatthias Ringwald (void)memcpy(&conn->acl_recombination_buffer[HCI_INCOMING_PRE_BUFFER_SIZE], 9494ea43905SMatthias Ringwald packet, acl_length + 4u); 9504ea43905SMatthias Ringwald conn->acl_recombination_pos = acl_length + 4u; 9517856c818Smatthias.ringwald conn->acl_recombination_length = l2cap_length; 9524ea43905SMatthias Ringwald little_endian_store_16(conn->acl_recombination_buffer, HCI_INCOMING_PRE_BUFFER_SIZE + 2u, l2cap_length +4u); 9537856c818Smatthias.ringwald } 9547856c818Smatthias.ringwald break; 9557856c818Smatthias.ringwald 9567856c818Smatthias.ringwald } 9577856c818Smatthias.ringwald default: 958c3b46f5aSMatthias Ringwald log_error( "acl_handler called with invalid packet boundary flags %u", acl_flags & 0x03); 9597856c818Smatthias.ringwald return; 9607856c818Smatthias.ringwald } 96194ab26f8Smatthias.ringwald 96294ab26f8Smatthias.ringwald // execute main loop 96394ab26f8Smatthias.ringwald hci_run(); 96416833f0aSmatthias.ringwald } 96522909952Smatthias.ringwald 96667a3e8ecSmatthias.ringwald static void hci_shutdown_connection(hci_connection_t *conn){ 9679da54300S[email protected] log_info("Connection closed: handle 0x%x, %s", conn->con_handle, bd_addr_to_str(conn->address)); 9683c4d4b90Smatthias.ringwald 969b3264428SMatthias Ringwald #ifdef ENABLE_CLASSIC 970cb70c5abSMatthias Ringwald #if defined(ENABLE_SCO_OVER_HCI) || defined(HAVE_SCO_TRANSPORT) 971cb70c5abSMatthias Ringwald bd_addr_type_t addr_type = conn->address_type; 972cb70c5abSMatthias Ringwald #endif 973cb70c5abSMatthias Ringwald #ifdef HAVE_SCO_TRANSPORT 974cb70c5abSMatthias Ringwald hci_con_handle_t con_handle = conn->con_handle; 975ee752bb8SMatthias Ringwald #endif 976b3264428SMatthias Ringwald #endif 977ee752bb8SMatthias Ringwald 978528a4a3bSMatthias Ringwald btstack_run_loop_remove_timer(&conn->timeout); 979c785ef68Smatthias.ringwald 980665d90f2SMatthias Ringwald btstack_linked_list_remove(&hci_stack->connections, (btstack_linked_item_t *) conn); 981a3b02b71Smatthias.ringwald btstack_memory_hci_connection_free( conn ); 9823c4d4b90Smatthias.ringwald 9833c4d4b90Smatthias.ringwald // now it's gone 984c7e0c5f6Smatthias.ringwald hci_emit_nr_connections_changed(); 985ee752bb8SMatthias Ringwald 986b3264428SMatthias Ringwald #ifdef ENABLE_CLASSIC 987034e9b53SMatthias Ringwald #ifdef ENABLE_SCO_OVER_HCI 988ee752bb8SMatthias Ringwald // update SCO 989cb70c5abSMatthias Ringwald if ((addr_type == BD_ADDR_TYPE_SCO) && (hci_stack->hci_transport != NULL) && (hci_stack->hci_transport->set_sco_config != NULL)){ 990ee752bb8SMatthias Ringwald hci_stack->hci_transport->set_sco_config(hci_stack->sco_voice_setting_active, hci_number_sco_connections()); 991ee752bb8SMatthias Ringwald } 992034e9b53SMatthias Ringwald #endif 993cb70c5abSMatthias Ringwald #ifdef HAVE_SCO_TRANSPORT 994cb70c5abSMatthias Ringwald if ((addr_type == BD_ADDR_TYPE_SCO) && (hci_stack->sco_transport != NULL)){ 995cb70c5abSMatthias Ringwald hci_stack->sco_transport->close(con_handle); 996cb70c5abSMatthias Ringwald } 997cb70c5abSMatthias Ringwald #endif 998b3264428SMatthias Ringwald #endif 999c7e0c5f6Smatthias.ringwald } 1000c7e0c5f6Smatthias.ringwald 100135454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 100235454696SMatthias Ringwald 10030c042179S[email protected] static const uint16_t packet_type_sizes[] = { 10048f8108aaSmatthias.ringwald 0, HCI_ACL_2DH1_SIZE, HCI_ACL_3DH1_SIZE, HCI_ACL_DM1_SIZE, 10058f8108aaSmatthias.ringwald HCI_ACL_DH1_SIZE, 0, 0, 0, 10068f8108aaSmatthias.ringwald HCI_ACL_2DH3_SIZE, HCI_ACL_3DH3_SIZE, HCI_ACL_DM3_SIZE, HCI_ACL_DH3_SIZE, 10078f8108aaSmatthias.ringwald HCI_ACL_2DH5_SIZE, HCI_ACL_3DH5_SIZE, HCI_ACL_DM5_SIZE, HCI_ACL_DH5_SIZE 10088f8108aaSmatthias.ringwald }; 100965389bfcS[email protected] static const uint8_t packet_type_feature_requirement_bit[] = { 101065389bfcS[email protected] 0, // 3 slot packets 101165389bfcS[email protected] 1, // 5 slot packets 101265389bfcS[email protected] 25, // EDR 2 mpbs 101365389bfcS[email protected] 26, // EDR 3 mbps 101465389bfcS[email protected] 39, // 3 slot EDR packts 101565389bfcS[email protected] 40, // 5 slot EDR packet 101665389bfcS[email protected] }; 101765389bfcS[email protected] static const uint16_t packet_type_feature_packet_mask[] = { 101865389bfcS[email protected] 0x0f00, // 3 slot packets 101965389bfcS[email protected] 0xf000, // 5 slot packets 102065389bfcS[email protected] 0x1102, // EDR 2 mpbs 102165389bfcS[email protected] 0x2204, // EDR 3 mbps 102265389bfcS[email protected] 0x0300, // 3 slot EDR packts 102365389bfcS[email protected] 0x3000, // 5 slot EDR packet 102465389bfcS[email protected] }; 10258f8108aaSmatthias.ringwald 102665389bfcS[email protected] static uint16_t hci_acl_packet_types_for_buffer_size_and_local_features(uint16_t buffer_size, uint8_t * local_supported_features){ 102765389bfcS[email protected] // enable packet types based on size 10288f8108aaSmatthias.ringwald uint16_t packet_types = 0; 1029f16a69bbS[email protected] unsigned int i; 10308f8108aaSmatthias.ringwald for (i=0;i<16;i++){ 10318f8108aaSmatthias.ringwald if (packet_type_sizes[i] == 0) continue; 10328f8108aaSmatthias.ringwald if (packet_type_sizes[i] <= buffer_size){ 10338f8108aaSmatthias.ringwald packet_types |= 1 << i; 10348f8108aaSmatthias.ringwald } 10358f8108aaSmatthias.ringwald } 103665389bfcS[email protected] // disable packet types due to missing local supported features 103765389bfcS[email protected] for (i=0;i<sizeof(packet_type_feature_requirement_bit);i++){ 1038f04a0c31SMatthias Ringwald unsigned int bit_idx = packet_type_feature_requirement_bit[i]; 103965389bfcS[email protected] int feature_set = (local_supported_features[bit_idx >> 3] & (1<<(bit_idx & 7))) != 0; 104065389bfcS[email protected] if (feature_set) continue; 104165389bfcS[email protected] log_info("Features bit %02u is not set, removing packet types 0x%04x", bit_idx, packet_type_feature_packet_mask[i]); 104265389bfcS[email protected] packet_types &= ~packet_type_feature_packet_mask[i]; 104365389bfcS[email protected] } 10448f8108aaSmatthias.ringwald // flip bits for "may not be used" 10458f8108aaSmatthias.ringwald packet_types ^= 0x3306; 10468f8108aaSmatthias.ringwald return packet_types; 10478f8108aaSmatthias.ringwald } 10488f8108aaSmatthias.ringwald 10498f8108aaSmatthias.ringwald uint16_t hci_usable_acl_packet_types(void){ 10503a9fb326S[email protected] return hci_stack->packet_types; 10518f8108aaSmatthias.ringwald } 105235454696SMatthias Ringwald #endif 10538f8108aaSmatthias.ringwald 1054facf93fdS[email protected] uint8_t* hci_get_outgoing_packet_buffer(void){ 10557dc17943Smatthias.ringwald // hci packet buffer is >= acl data packet length 10563a9fb326S[email protected] return hci_stack->hci_packet_buffer; 10577dc17943Smatthias.ringwald } 10587dc17943Smatthias.ringwald 1059f5d8d141S[email protected] uint16_t hci_max_acl_data_packet_length(void){ 10603a9fb326S[email protected] return hci_stack->acl_data_packet_length; 10617dc17943Smatthias.ringwald } 10627dc17943Smatthias.ringwald 106306b9e820SMatthias Ringwald #ifdef ENABLE_CLASSIC 10643e68d23dSMatthias Ringwald int hci_extended_sco_link_supported(void){ 10653e68d23dSMatthias Ringwald // No. 31, byte 3, bit 7 10663e68d23dSMatthias Ringwald return (hci_stack->local_supported_features[3] & (1 << 7)) != 0; 10673e68d23dSMatthias Ringwald } 106806b9e820SMatthias Ringwald #endif 10693e68d23dSMatthias Ringwald 10706ac9a97eS[email protected] int hci_non_flushable_packet_boundary_flag_supported(void){ 10716ac9a97eS[email protected] // No. 54, byte 6, bit 6 10724ea43905SMatthias Ringwald return (hci_stack->local_supported_features[6u] & (1u << 6u)) != 0u; 10736ac9a97eS[email protected] } 10746ac9a97eS[email protected] 107515a95bd5SMatthias Ringwald static int gap_ssp_supported(void){ 10766ac9a97eS[email protected] // No. 51, byte 6, bit 3 10774ea43905SMatthias Ringwald return (hci_stack->local_supported_features[6u] & (1u << 3u)) != 0u; 1078f5d8d141S[email protected] } 1079f5d8d141S[email protected] 10807f02f414SMatthias Ringwald static int hci_classic_supported(void){ 108135454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 10826ac9a97eS[email protected] // No. 37, byte 4, bit 5, = No BR/EDR Support 10833a9fb326S[email protected] return (hci_stack->local_supported_features[4] & (1 << 5)) == 0; 108435454696SMatthias Ringwald #else 108535454696SMatthias Ringwald return 0; 108635454696SMatthias Ringwald #endif 1087f5d8d141S[email protected] } 1088f5d8d141S[email protected] 10897f02f414SMatthias Ringwald static int hci_le_supported(void){ 1090a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE 10916ac9a97eS[email protected] // No. 37, byte 4, bit 6 = LE Supported (Controller) 10924ea43905SMatthias Ringwald return (hci_stack->local_supported_features[4u] & (1u << 6u)) != 0u; 1093f5d8d141S[email protected] #else 1094f5d8d141S[email protected] return 0; 1095f5d8d141S[email protected] #endif 1096f5d8d141S[email protected] } 1097f5d8d141S[email protected] 1098b95a5a35SMatthias Ringwald #ifdef ENABLE_BLE 1099b95a5a35SMatthias Ringwald 1100b95a5a35SMatthias Ringwald /** 1101b95a5a35SMatthias Ringwald * @brief Get addr type and address used for LE in Advertisements, Scan Responses, 1102b95a5a35SMatthias Ringwald */ 1103b95a5a35SMatthias Ringwald void gap_le_get_own_address(uint8_t * addr_type, bd_addr_t addr){ 1104b95a5a35SMatthias Ringwald *addr_type = hci_stack->le_own_addr_type; 1105b95a5a35SMatthias Ringwald if (hci_stack->le_own_addr_type){ 11066535961aSMatthias Ringwald (void)memcpy(addr, hci_stack->le_random_address, 6); 110769a97523S[email protected] } else { 11086535961aSMatthias Ringwald (void)memcpy(addr, hci_stack->local_bd_addr, 6); 110969a97523S[email protected] } 111069a97523S[email protected] } 111169a97523S[email protected] 1112e8c8828eSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 1113384b59deSMatthias Ringwald void le_handle_advertisement_report(uint8_t *packet, uint16_t size){ 11149ec2630cSMatthias Ringwald 1115d1dc057bS[email protected] int offset = 3; 1116d1dc057bS[email protected] int num_reports = packet[offset]; 1117d1dc057bS[email protected] offset += 1; 1118d1dc057bS[email protected] 111957c9da5bS[email protected] int i; 11204f4e0224SMatthias Ringwald // log_info("HCI: handle adv report with num reports: %d", num_reports); 112103fbe9c6S[email protected] uint8_t event[12 + LE_ADVERTISING_DATA_SIZE]; // use upper bound to avoid var size automatic var 1122a1df452eSMatthias Ringwald for (i=0; (i<num_reports) && (offset < size);i++){ 112333e6948bSMatthias Ringwald // sanity checks on data_length: 112433e6948bSMatthias Ringwald uint8_t data_length = packet[offset + 8]; 112533e6948bSMatthias Ringwald if (data_length > LE_ADVERTISING_DATA_SIZE) return; 11264ea43905SMatthias Ringwald if ((offset + 9u + data_length + 1u) > size) return; 112733e6948bSMatthias Ringwald // setup event 11284ea43905SMatthias Ringwald uint8_t event_size = 10u + data_length; 1129d1dc057bS[email protected] int pos = 0; 1130045013feSMatthias Ringwald event[pos++] = GAP_EVENT_ADVERTISING_REPORT; 113157c9da5bS[email protected] event[pos++] = event_size; 11326535961aSMatthias Ringwald (void)memcpy(&event[pos], &packet[offset], 1 + 1 + 6); // event type + address type + address 1133d1dc057bS[email protected] offset += 8; 1134d1dc057bS[email protected] pos += 8; 1135d1dc057bS[email protected] event[pos++] = packet[offset + 1 + data_length]; // rssi 113633e6948bSMatthias Ringwald event[pos++] = data_length; 113733e6948bSMatthias Ringwald offset++; 11386535961aSMatthias Ringwald (void)memcpy(&event[pos], &packet[offset], data_length); 113957c9da5bS[email protected] pos += data_length; 11404ea43905SMatthias Ringwald offset += data_length + 1u; // rssi 1141d6b06661SMatthias Ringwald hci_emit_event(event, pos, 1); 114257c9da5bS[email protected] } 114357c9da5bS[email protected] } 1144b2f949feS[email protected] #endif 1145e8c8828eSMatthias Ringwald #endif 114657c9da5bS[email protected] 11472b6ab3e6SMatthias Ringwald #ifdef ENABLE_BLE 11482b6ab3e6SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 1149bbc366e6SMatthias Ringwald static void hci_update_advertisements_enabled_for_current_roles(void){ 1150bbc366e6SMatthias Ringwald if (hci_stack->le_advertisements_enabled){ 11512b6ab3e6SMatthias Ringwald // get number of active le slave connections 11522b6ab3e6SMatthias Ringwald int num_slave_connections = 0; 11532b6ab3e6SMatthias Ringwald btstack_linked_list_iterator_t it; 11542b6ab3e6SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->connections); 11552b6ab3e6SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 11562b6ab3e6SMatthias Ringwald hci_connection_t * con = (hci_connection_t*) btstack_linked_list_iterator_next(&it); 11572b6ab3e6SMatthias Ringwald log_info("state %u, role %u, le_con %u", con->state, con->role, hci_is_le_connection(con)); 11582b6ab3e6SMatthias Ringwald if (con->state != OPEN) continue; 11592b6ab3e6SMatthias Ringwald if (con->role != HCI_ROLE_SLAVE) continue; 11602b6ab3e6SMatthias Ringwald if (!hci_is_le_connection(con)) continue; 11612b6ab3e6SMatthias Ringwald num_slave_connections++; 11622b6ab3e6SMatthias Ringwald } 11632b6ab3e6SMatthias Ringwald log_info("Num LE Peripheral roles: %u of %u", num_slave_connections, hci_stack->le_max_number_peripheral_connections); 1164bbc366e6SMatthias Ringwald hci_stack->le_advertisements_enabled_for_current_roles = num_slave_connections < hci_stack->le_max_number_peripheral_connections; 1165bbc366e6SMatthias Ringwald } else { 1166bbc366e6SMatthias Ringwald hci_stack->le_advertisements_enabled_for_current_roles = false; 11672b6ab3e6SMatthias Ringwald } 11682b6ab3e6SMatthias Ringwald } 11692b6ab3e6SMatthias Ringwald #endif 11702b6ab3e6SMatthias Ringwald #endif 11712b6ab3e6SMatthias Ringwald 1172cd77dd38SMatthias Ringwald #if !defined(HAVE_PLATFORM_IPHONE_OS) && !defined (HAVE_HOST_CONTROLLER_API) 117306b9e820SMatthias Ringwald 117496b53536SMatthias Ringwald static uint32_t hci_transport_uart_get_main_baud_rate(void){ 117596b53536SMatthias Ringwald if (!hci_stack->config) return 0; 11769796ebeaSMatthias Ringwald uint32_t baud_rate = ((hci_transport_config_uart_t *)hci_stack->config)->baudrate_main; 117796b53536SMatthias Ringwald // Limit baud rate for Broadcom chipsets to 3 mbps 1178a1df452eSMatthias Ringwald if ((hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_BROADCOM_CORPORATION) && (baud_rate > 3000000)){ 117996b53536SMatthias Ringwald baud_rate = 3000000; 118096b53536SMatthias Ringwald } 118196b53536SMatthias Ringwald return baud_rate; 118296b53536SMatthias Ringwald } 118396b53536SMatthias Ringwald 1184ec820d77SMatthias Ringwald static void hci_initialization_timeout_handler(btstack_timer_source_t * ds){ 11859ec2630cSMatthias Ringwald UNUSED(ds); 11869ec2630cSMatthias Ringwald 11870305bdeaSMatthias Ringwald switch (hci_stack->substate){ 11880305bdeaSMatthias Ringwald case HCI_INIT_W4_SEND_RESET: 11897b0d7667SMatthias Ringwald log_info("Resend HCI Reset"); 11900305bdeaSMatthias Ringwald hci_stack->substate = HCI_INIT_SEND_RESET; 11917b0d7667SMatthias Ringwald hci_stack->num_cmd_packets = 1; 11920305bdeaSMatthias Ringwald hci_run(); 11930305bdeaSMatthias Ringwald break; 11949f007422SMatthias Ringwald case HCI_INIT_W4_CUSTOM_INIT_CSR_WARM_BOOT_LINK_RESET: 11959f007422SMatthias Ringwald log_info("Resend HCI Reset - CSR Warm Boot with Link Reset"); 11969f007422SMatthias Ringwald if (hci_stack->hci_transport->reset_link){ 11979f007422SMatthias Ringwald hci_stack->hci_transport->reset_link(); 11989f007422SMatthias Ringwald } 1199cf373d3aSMatthias Ringwald 1200cf373d3aSMatthias Ringwald /* fall through */ 1201cf373d3aSMatthias Ringwald 1202e47e68c7SMatthias Ringwald case HCI_INIT_W4_CUSTOM_INIT_CSR_WARM_BOOT: 1203e47e68c7SMatthias Ringwald log_info("Resend HCI Reset - CSR Warm Boot"); 1204e47e68c7SMatthias Ringwald hci_stack->substate = HCI_INIT_SEND_RESET_CSR_WARM_BOOT; 1205e47e68c7SMatthias Ringwald hci_stack->num_cmd_packets = 1; 1206e47e68c7SMatthias Ringwald hci_run(); 1207688c2635SMatthias Ringwald break; 12087224be7eSMatthias Ringwald case HCI_INIT_W4_SEND_BAUD_CHANGE: 12097224be7eSMatthias Ringwald if (hci_stack->hci_transport->set_baudrate){ 121096b53536SMatthias Ringwald uint32_t baud_rate = hci_transport_uart_get_main_baud_rate(); 1211cd724cb7SMatthias Ringwald log_info("Local baud rate change to %" PRIu32 "(timeout handler)", baud_rate); 12127dd9d0ecSMatthias Ringwald hci_stack->hci_transport->set_baudrate(baud_rate); 12137224be7eSMatthias Ringwald } 1214834bce8cSMatthias Ringwald // For CSR, HCI Reset is sent on new baud rate. Don't forget to reset link for H5/BCSP 121561f37892SMatthias Ringwald if (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_CAMBRIDGE_SILICON_RADIO){ 1216834bce8cSMatthias Ringwald if (hci_stack->hci_transport->reset_link){ 1217834bce8cSMatthias Ringwald log_info("Link Reset"); 1218834bce8cSMatthias Ringwald hci_stack->hci_transport->reset_link(); 1219834bce8cSMatthias Ringwald } 1220772a36d3SMatthias Ringwald hci_stack->substate = HCI_INIT_SEND_RESET_CSR_WARM_BOOT; 1221772a36d3SMatthias Ringwald hci_run(); 1222772a36d3SMatthias Ringwald } 12234696bddbSMatthias Ringwald break; 1224559961d0SMatthias Ringwald case HCI_INIT_W4_CUSTOM_INIT_BCM_DELAY: 1225559961d0SMatthias Ringwald // otherwise continue 1226559961d0SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_READ_LOCAL_SUPPORTED_COMMANDS; 1227559961d0SMatthias Ringwald hci_send_cmd(&hci_read_local_supported_commands); 1228559961d0SMatthias Ringwald break; 12290305bdeaSMatthias Ringwald default: 12300305bdeaSMatthias Ringwald break; 12310305bdeaSMatthias Ringwald } 12320305bdeaSMatthias Ringwald } 123306b9e820SMatthias Ringwald #endif 12340305bdeaSMatthias Ringwald 123571de195eSMatthias Ringwald static void hci_initializing_next_state(void){ 123674b323a9SMatthias Ringwald hci_stack->substate = (hci_substate_t )( ((int) hci_stack->substate) + 1); 123774b323a9SMatthias Ringwald } 123874b323a9SMatthias Ringwald 123974b323a9SMatthias Ringwald // assumption: hci_can_send_command_packet_now() == true 124071de195eSMatthias Ringwald static void hci_initializing_run(void){ 1241148ca237SMatthias Ringwald log_debug("hci_initializing_run: substate %u, can send %u", hci_stack->substate, hci_can_send_command_packet_now()); 124274b323a9SMatthias Ringwald switch (hci_stack->substate){ 124374b323a9SMatthias Ringwald case HCI_INIT_SEND_RESET: 124474b323a9SMatthias Ringwald hci_state_reset(); 1245a0cf2f3fSMatthias Ringwald 124606b9e820SMatthias Ringwald #if !defined(HAVE_PLATFORM_IPHONE_OS) && !defined (HAVE_HOST_CONTROLLER_API) 12470305bdeaSMatthias Ringwald // prepare reset if command complete not received in 100ms 1248659d758cSMatthias Ringwald btstack_run_loop_set_timer(&hci_stack->timeout, HCI_RESET_RESEND_TIMEOUT_MS); 1249528a4a3bSMatthias Ringwald btstack_run_loop_set_timer_handler(&hci_stack->timeout, hci_initialization_timeout_handler); 1250528a4a3bSMatthias Ringwald btstack_run_loop_add_timer(&hci_stack->timeout); 1251a0cf2f3fSMatthias Ringwald #endif 12520305bdeaSMatthias Ringwald // send command 125374b323a9SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_SEND_RESET; 12540305bdeaSMatthias Ringwald hci_send_cmd(&hci_reset); 125574b323a9SMatthias Ringwald break; 125676fcb19bSMatthias Ringwald case HCI_INIT_SEND_READ_LOCAL_VERSION_INFORMATION: 125776fcb19bSMatthias Ringwald hci_send_cmd(&hci_read_local_version_information); 125876fcb19bSMatthias Ringwald hci_stack->substate = HCI_INIT_W4_SEND_READ_LOCAL_VERSION_INFORMATION; 125976fcb19bSMatthias Ringwald break; 1260e90bae01SMatthias Ringwald case HCI_INIT_SEND_READ_LOCAL_NAME: 1261e90bae01SMatthias Ringwald hci_send_cmd(&hci_read_local_name); 1262e90bae01SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_SEND_READ_LOCAL_NAME; 1263e90bae01SMatthias Ringwald break; 126406b9e820SMatthias Ringwald 126506b9e820SMatthias Ringwald #if !defined(HAVE_PLATFORM_IPHONE_OS) && !defined (HAVE_HOST_CONTROLLER_API) 1266e47e68c7SMatthias Ringwald case HCI_INIT_SEND_RESET_CSR_WARM_BOOT: 1267e47e68c7SMatthias Ringwald hci_state_reset(); 1268e47e68c7SMatthias Ringwald // prepare reset if command complete not received in 100ms 1269659d758cSMatthias Ringwald btstack_run_loop_set_timer(&hci_stack->timeout, HCI_RESET_RESEND_TIMEOUT_MS); 1270528a4a3bSMatthias Ringwald btstack_run_loop_set_timer_handler(&hci_stack->timeout, hci_initialization_timeout_handler); 1271528a4a3bSMatthias Ringwald btstack_run_loop_add_timer(&hci_stack->timeout); 1272e47e68c7SMatthias Ringwald // send command 1273e47e68c7SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_CUSTOM_INIT_CSR_WARM_BOOT; 1274e47e68c7SMatthias Ringwald hci_send_cmd(&hci_reset); 1275e47e68c7SMatthias Ringwald break; 12768d29070eSMatthias Ringwald case HCI_INIT_SEND_RESET_ST_WARM_BOOT: 12778d29070eSMatthias Ringwald hci_state_reset(); 12788d29070eSMatthias Ringwald hci_stack->substate = HCI_INIT_W4_SEND_RESET_ST_WARM_BOOT; 12798d29070eSMatthias Ringwald hci_send_cmd(&hci_reset); 12808d29070eSMatthias Ringwald break; 1281fab26ab3SMatthias Ringwald case HCI_INIT_SEND_BAUD_CHANGE: { 128296b53536SMatthias Ringwald uint32_t baud_rate = hci_transport_uart_get_main_baud_rate(); 12833fb36a29SMatthias Ringwald hci_stack->chipset->set_baudrate_command(baud_rate, hci_stack->hci_packet_buffer); 1284f8fbdce0SMatthias Ringwald hci_stack->last_cmd_opcode = little_endian_read_16(hci_stack->hci_packet_buffer, 0); 128574b323a9SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_SEND_BAUD_CHANGE; 12864ea43905SMatthias Ringwald hci_send_cmd_packet(hci_stack->hci_packet_buffer, 3u + hci_stack->hci_packet_buffer[2u]); 12874696bddbSMatthias Ringwald // STLC25000D: baudrate change happens within 0.5 s after command was send, 12884696bddbSMatthias Ringwald // use timer to update baud rate after 100 ms (knowing exactly, when command was sent is non-trivial) 128961f37892SMatthias Ringwald if (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_ST_MICROELECTRONICS){ 1290659d758cSMatthias Ringwald btstack_run_loop_set_timer(&hci_stack->timeout, HCI_RESET_RESEND_TIMEOUT_MS); 1291528a4a3bSMatthias Ringwald btstack_run_loop_add_timer(&hci_stack->timeout); 12924696bddbSMatthias Ringwald } 129374b323a9SMatthias Ringwald break; 1294fab26ab3SMatthias Ringwald } 1295fab26ab3SMatthias Ringwald case HCI_INIT_SEND_BAUD_CHANGE_BCM: { 129696b53536SMatthias Ringwald uint32_t baud_rate = hci_transport_uart_get_main_baud_rate(); 12973fb36a29SMatthias Ringwald hci_stack->chipset->set_baudrate_command(baud_rate, hci_stack->hci_packet_buffer); 1298f8fbdce0SMatthias Ringwald hci_stack->last_cmd_opcode = little_endian_read_16(hci_stack->hci_packet_buffer, 0); 1299eb3a5314SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_SEND_BAUD_CHANGE_BCM; 13004ea43905SMatthias Ringwald hci_send_cmd_packet(hci_stack->hci_packet_buffer, 3u + hci_stack->hci_packet_buffer[2u]); 1301eb3a5314SMatthias Ringwald break; 1302fab26ab3SMatthias Ringwald } 130374b323a9SMatthias Ringwald case HCI_INIT_CUSTOM_INIT: 130474b323a9SMatthias Ringwald // Custom initialization 13053fb36a29SMatthias Ringwald if (hci_stack->chipset && hci_stack->chipset->next_command){ 1306ae334e9eSMatthias Ringwald hci_stack->chipset_result = (*hci_stack->chipset->next_command)(hci_stack->hci_packet_buffer); 13071979f09cSMatthias Ringwald bool send_cmd = false; 1308ae334e9eSMatthias Ringwald switch (hci_stack->chipset_result){ 1309f41911edSMatthias Ringwald case BTSTACK_CHIPSET_VALID_COMMAND: 13101979f09cSMatthias Ringwald send_cmd = true; 1311e47e68c7SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_CUSTOM_INIT; 1312e47e68c7SMatthias Ringwald break; 1313f41911edSMatthias Ringwald case BTSTACK_CHIPSET_WARMSTART_REQUIRED: 13141979f09cSMatthias Ringwald send_cmd = true; 1315f41911edSMatthias Ringwald // CSR Warm Boot: Wait a bit, then send HCI Reset until HCI Command Complete 1316e47e68c7SMatthias Ringwald log_info("CSR Warm Boot"); 1317659d758cSMatthias Ringwald btstack_run_loop_set_timer(&hci_stack->timeout, HCI_RESET_RESEND_TIMEOUT_MS); 1318528a4a3bSMatthias Ringwald btstack_run_loop_set_timer_handler(&hci_stack->timeout, hci_initialization_timeout_handler); 1319528a4a3bSMatthias Ringwald btstack_run_loop_add_timer(&hci_stack->timeout); 1320a1df452eSMatthias Ringwald if ((hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_CAMBRIDGE_SILICON_RADIO) 1321772a36d3SMatthias Ringwald && hci_stack->config 13223fb36a29SMatthias Ringwald && hci_stack->chipset 13233fb36a29SMatthias Ringwald // && hci_stack->chipset->set_baudrate_command -- there's no such command 1324772a36d3SMatthias Ringwald && hci_stack->hci_transport->set_baudrate 13252caefae9SMatthias Ringwald && hci_transport_uart_get_main_baud_rate()){ 1326772a36d3SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_SEND_BAUD_CHANGE; 1327772a36d3SMatthias Ringwald } else { 13289f007422SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_CUSTOM_INIT_CSR_WARM_BOOT_LINK_RESET; 1329772a36d3SMatthias Ringwald } 1330e47e68c7SMatthias Ringwald break; 1331f41911edSMatthias Ringwald default: 1332f41911edSMatthias Ringwald break; 1333e47e68c7SMatthias Ringwald } 1334ee720f3aSMatthias Ringwald 1335ee720f3aSMatthias Ringwald if (send_cmd){ 13364ea43905SMatthias Ringwald int size = 3u + hci_stack->hci_packet_buffer[2u]; 1337ee720f3aSMatthias Ringwald hci_stack->last_cmd_opcode = little_endian_read_16(hci_stack->hci_packet_buffer, 0); 1338ee720f3aSMatthias Ringwald hci_dump_packet(HCI_COMMAND_DATA_PACKET, 0, hci_stack->hci_packet_buffer, size); 13390305bdeaSMatthias Ringwald hci_stack->hci_transport->send_packet(HCI_COMMAND_DATA_PACKET, hci_stack->hci_packet_buffer, size); 134074b323a9SMatthias Ringwald break; 134174b323a9SMatthias Ringwald } 1342148ca237SMatthias Ringwald log_info("Init script done"); 134392a0d36dSMatthias Ringwald 1344559961d0SMatthias Ringwald // Init script download on Broadcom chipsets causes: 1345ae334e9eSMatthias Ringwald if ( (hci_stack->chipset_result != BTSTACK_CHIPSET_NO_INIT_SCRIPT) && 1346a1df452eSMatthias Ringwald ( (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_BROADCOM_CORPORATION) 1347a1df452eSMatthias Ringwald || (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_EM_MICROELECTRONIC_MARIN_SA)) ){ 1348e021ff1eSMatthias Ringwald 1349559961d0SMatthias Ringwald // - baud rate to reset, restore UART baud rate if needed 135092a0d36dSMatthias Ringwald int need_baud_change = hci_stack->config 13513fb36a29SMatthias Ringwald && hci_stack->chipset 13523fb36a29SMatthias Ringwald && hci_stack->chipset->set_baudrate_command 135392a0d36dSMatthias Ringwald && hci_stack->hci_transport->set_baudrate 13549796ebeaSMatthias Ringwald && ((hci_transport_config_uart_t *)hci_stack->config)->baudrate_main; 135592a0d36dSMatthias Ringwald if (need_baud_change) { 13569796ebeaSMatthias Ringwald uint32_t baud_rate = ((hci_transport_config_uart_t *)hci_stack->config)->baudrate_init; 1357cd724cb7SMatthias Ringwald log_info("Local baud rate change to %" PRIu32 " after init script (bcm)", baud_rate); 135892a0d36dSMatthias Ringwald hci_stack->hci_transport->set_baudrate(baud_rate); 135992a0d36dSMatthias Ringwald } 1360559961d0SMatthias Ringwald 1361f19b3c9eSMatthias Ringwald uint16_t bcm_delay_ms = 300; 1362f19b3c9eSMatthias Ringwald // - UART may or may not be disabled during update and Controller RTS may or may not be high during this time 1363f19b3c9eSMatthias Ringwald // -> Work around: wait here. 1364f19b3c9eSMatthias Ringwald log_info("BCM delay (%u ms) after init script", bcm_delay_ms); 1365559961d0SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_CUSTOM_INIT_BCM_DELAY; 1366f19b3c9eSMatthias Ringwald btstack_run_loop_set_timer(&hci_stack->timeout, bcm_delay_ms); 1367559961d0SMatthias Ringwald btstack_run_loop_set_timer_handler(&hci_stack->timeout, hci_initialization_timeout_handler); 1368559961d0SMatthias Ringwald btstack_run_loop_add_timer(&hci_stack->timeout); 1369559961d0SMatthias Ringwald break; 137092a0d36dSMatthias Ringwald } 137174b323a9SMatthias Ringwald } 137274b323a9SMatthias Ringwald // otherwise continue 1373a828a756SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_READ_LOCAL_SUPPORTED_COMMANDS; 1374a828a756SMatthias Ringwald hci_send_cmd(&hci_read_local_supported_commands); 1375a828a756SMatthias Ringwald break; 137653860077SMatthias Ringwald case HCI_INIT_SET_BD_ADDR: 137753860077SMatthias Ringwald log_info("Set Public BD ADDR to %s", bd_addr_to_str(hci_stack->custom_bd_addr)); 13783fb36a29SMatthias Ringwald hci_stack->chipset->set_bd_addr_command(hci_stack->custom_bd_addr, hci_stack->hci_packet_buffer); 1379f8fbdce0SMatthias Ringwald hci_stack->last_cmd_opcode = little_endian_read_16(hci_stack->hci_packet_buffer, 0); 138053860077SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_SET_BD_ADDR; 13814ea43905SMatthias Ringwald hci_send_cmd_packet(hci_stack->hci_packet_buffer, 3u + hci_stack->hci_packet_buffer[2u]); 138253860077SMatthias Ringwald break; 138306b9e820SMatthias Ringwald #endif 138406b9e820SMatthias Ringwald 138506b9e820SMatthias Ringwald case HCI_INIT_READ_LOCAL_SUPPORTED_COMMANDS: 138606b9e820SMatthias Ringwald log_info("Resend hci_read_local_supported_commands after CSR Warm Boot double reset"); 138706b9e820SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_READ_LOCAL_SUPPORTED_COMMANDS; 138806b9e820SMatthias Ringwald hci_send_cmd(&hci_read_local_supported_commands); 138906b9e820SMatthias Ringwald break; 139053860077SMatthias Ringwald case HCI_INIT_READ_BD_ADDR: 139153860077SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_READ_BD_ADDR; 139253860077SMatthias Ringwald hci_send_cmd(&hci_read_bd_addr); 139353860077SMatthias Ringwald break; 139474b323a9SMatthias Ringwald case HCI_INIT_READ_BUFFER_SIZE: 139574b323a9SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_READ_BUFFER_SIZE; 13960305bdeaSMatthias Ringwald hci_send_cmd(&hci_read_buffer_size); 139774b323a9SMatthias Ringwald break; 139853860077SMatthias Ringwald case HCI_INIT_READ_LOCAL_SUPPORTED_FEATURES: 139953860077SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_READ_LOCAL_SUPPORTED_FEATURES; 14000305bdeaSMatthias Ringwald hci_send_cmd(&hci_read_local_supported_features); 140174b323a9SMatthias Ringwald break; 14022b838201SMatthias Ringwald 14032b838201SMatthias Ringwald #ifdef ENABLE_HCI_CONTROLLER_TO_HOST_FLOW_CONTROL 14042b838201SMatthias Ringwald case HCI_INIT_SET_CONTROLLER_TO_HOST_FLOW_CONTROL: 14052b838201SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_SET_CONTROLLER_TO_HOST_FLOW_CONTROL; 14062b838201SMatthias Ringwald hci_send_cmd(&hci_set_controller_to_host_flow_control, 3); // ACL + SCO Flow Control 14072b838201SMatthias Ringwald break; 14082b838201SMatthias Ringwald case HCI_INIT_HOST_BUFFER_SIZE: 14092b838201SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_HOST_BUFFER_SIZE; 14102b838201SMatthias Ringwald hci_send_cmd(&hci_host_buffer_size, HCI_HOST_ACL_PACKET_LEN, HCI_HOST_SCO_PACKET_LEN, 14112b838201SMatthias Ringwald HCI_HOST_ACL_PACKET_NUM, HCI_HOST_SCO_PACKET_NUM); 14122b838201SMatthias Ringwald break; 14132b838201SMatthias Ringwald #endif 14142b838201SMatthias Ringwald 141574b323a9SMatthias Ringwald case HCI_INIT_SET_EVENT_MASK: 14160305bdeaSMatthias Ringwald hci_stack->substate = HCI_INIT_W4_SET_EVENT_MASK; 141774b323a9SMatthias Ringwald if (hci_le_supported()){ 141874b323a9SMatthias Ringwald hci_send_cmd(&hci_set_event_mask,0xffffffff, 0x3FFFFFFF); 141974b323a9SMatthias Ringwald } else { 142074b323a9SMatthias Ringwald // Kensington Bluetooth 2.1 USB Dongle (CSR Chipset) returns an error for 0xffff... 142174b323a9SMatthias Ringwald hci_send_cmd(&hci_set_event_mask,0xffffffff, 0x1FFFFFFF); 142274b323a9SMatthias Ringwald } 142374b323a9SMatthias Ringwald break; 14242b838201SMatthias Ringwald 142535454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 142674b323a9SMatthias Ringwald case HCI_INIT_WRITE_SIMPLE_PAIRING_MODE: 142774b323a9SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_WRITE_SIMPLE_PAIRING_MODE; 14280305bdeaSMatthias Ringwald hci_send_cmd(&hci_write_simple_pairing_mode, hci_stack->ssp_enable); 142974b323a9SMatthias Ringwald break; 143074b323a9SMatthias Ringwald case HCI_INIT_WRITE_PAGE_TIMEOUT: 143174b323a9SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_WRITE_PAGE_TIMEOUT; 14320305bdeaSMatthias Ringwald hci_send_cmd(&hci_write_page_timeout, 0x6000); // ca. 15 sec 143374b323a9SMatthias Ringwald break; 1434c33e56d3SMatthias Ringwald case HCI_INIT_WRITE_DEFAULT_LINK_POLICY_SETTING: 1435c33e56d3SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_WRITE_DEFAULT_LINK_POLICY_SETTING; 1436c33e56d3SMatthias Ringwald hci_send_cmd(&hci_write_default_link_policy_setting, hci_stack->default_link_policy_settings); 1437c33e56d3SMatthias Ringwald break; 143874b323a9SMatthias Ringwald case HCI_INIT_WRITE_CLASS_OF_DEVICE: 143974b323a9SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_WRITE_CLASS_OF_DEVICE; 14400305bdeaSMatthias Ringwald hci_send_cmd(&hci_write_class_of_device, hci_stack->class_of_device); 144174b323a9SMatthias Ringwald break; 14421c2a62f5SMatthias Ringwald case HCI_INIT_WRITE_LOCAL_NAME: { 14430305bdeaSMatthias Ringwald hci_stack->substate = HCI_INIT_W4_WRITE_LOCAL_NAME; 14441c2a62f5SMatthias Ringwald hci_reserve_packet_buffer(); 14451c2a62f5SMatthias Ringwald uint8_t * packet = hci_stack->hci_packet_buffer; 14461c2a62f5SMatthias Ringwald // construct HCI Command and send 14471c2a62f5SMatthias Ringwald uint16_t opcode = hci_write_local_name.opcode; 14481c2a62f5SMatthias Ringwald hci_stack->last_cmd_opcode = opcode; 14491c2a62f5SMatthias Ringwald packet[0] = opcode & 0xff; 14501c2a62f5SMatthias Ringwald packet[1] = opcode >> 8; 14511c2a62f5SMatthias Ringwald packet[2] = DEVICE_NAME_LEN; 14521c2a62f5SMatthias Ringwald memset(&packet[3], 0, DEVICE_NAME_LEN); 145379186815SMatthias Ringwald uint16_t name_len = (uint16_t) strlen(hci_stack->local_name); 145479186815SMatthias Ringwald uint16_t bytes_to_copy = btstack_min(name_len, DEVICE_NAME_LEN); 145579186815SMatthias Ringwald // if shorter than DEVICE_NAME_LEN, it's implicitly NULL-terminated by memset call 145679186815SMatthias Ringwald (void)memcpy(&packet[3], hci_stack->local_name, bytes_to_copy); 14571c2a62f5SMatthias Ringwald // expand '00:00:00:00:00:00' in name with bd_addr 14583c9da642SMatthias Ringwald btstack_replace_bd_addr_placeholder(&packet[3], bytes_to_copy, hci_stack->local_bd_addr); 14591c2a62f5SMatthias Ringwald hci_send_cmd_packet(packet, HCI_CMD_HEADER_SIZE + DEVICE_NAME_LEN); 146074b323a9SMatthias Ringwald break; 14611c2a62f5SMatthias Ringwald } 146229af07f3SMatthias Ringwald case HCI_INIT_WRITE_EIR_DATA: { 14638a114470SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_WRITE_EIR_DATA; 146429af07f3SMatthias Ringwald hci_reserve_packet_buffer(); 146529af07f3SMatthias Ringwald uint8_t * packet = hci_stack->hci_packet_buffer; 146663873210SMatthias Ringwald // construct HCI Command in-place and send 146729af07f3SMatthias Ringwald uint16_t opcode = hci_write_extended_inquiry_response.opcode; 146829af07f3SMatthias Ringwald hci_stack->last_cmd_opcode = opcode; 146963873210SMatthias Ringwald uint16_t offset = 0; 147063873210SMatthias Ringwald packet[offset++] = opcode & 0xff; 147163873210SMatthias Ringwald packet[offset++] = opcode >> 8; 147263873210SMatthias Ringwald packet[offset++] = 1 + EXTENDED_INQUIRY_RESPONSE_DATA_LEN; 147363873210SMatthias Ringwald packet[offset++] = 0; // FEC not required 147463873210SMatthias Ringwald memset(&packet[offset], 0, EXTENDED_INQUIRY_RESPONSE_DATA_LEN); 1475ad0d1108SMatthias Ringwald if (hci_stack->eir_data){ 147663873210SMatthias Ringwald // copy items and expand '00:00:00:00:00:00' in name with bd_addr 147763873210SMatthias Ringwald ad_context_t context; 147863873210SMatthias Ringwald for (ad_iterator_init(&context, EXTENDED_INQUIRY_RESPONSE_DATA_LEN, hci_stack->eir_data) ; ad_iterator_has_more(&context) ; ad_iterator_next(&context)) { 147963873210SMatthias Ringwald uint8_t data_type = ad_iterator_get_data_type(&context); 148063873210SMatthias Ringwald uint8_t size = ad_iterator_get_data_len(&context); 148163873210SMatthias Ringwald const uint8_t *data = ad_iterator_get_data(&context); 148263873210SMatthias Ringwald // copy item 148363873210SMatthias Ringwald packet[offset++] = size + 1; 148463873210SMatthias Ringwald packet[offset++] = data_type; 148563873210SMatthias Ringwald memcpy(&packet[offset], data, size); 148663873210SMatthias Ringwald // update name item 148763873210SMatthias Ringwald if ((data_type == BLUETOOTH_DATA_TYPE_SHORTENED_LOCAL_NAME) || (data_type == BLUETOOTH_DATA_TYPE_COMPLETE_LOCAL_NAME)){ 14883c9da642SMatthias Ringwald btstack_replace_bd_addr_placeholder(&packet[offset], size, hci_stack->local_bd_addr); 148963873210SMatthias Ringwald } 149063873210SMatthias Ringwald offset += size; 149163873210SMatthias Ringwald } 1492ad0d1108SMatthias Ringwald } else { 149379186815SMatthias Ringwald uint16_t name_len = (uint16_t) strlen(hci_stack->local_name); 149479186815SMatthias Ringwald uint16_t bytes_to_copy = btstack_min(name_len, EXTENDED_INQUIRY_RESPONSE_DATA_LEN - 2); 149563873210SMatthias Ringwald packet[offset++] = bytes_to_copy + 1; 149663873210SMatthias Ringwald packet[offset++] = BLUETOOTH_DATA_TYPE_COMPLETE_LOCAL_NAME; 149779186815SMatthias Ringwald (void)memcpy(&packet[6], hci_stack->local_name, bytes_to_copy); 149829af07f3SMatthias Ringwald // expand '00:00:00:00:00:00' in name with bd_addr 14993c9da642SMatthias Ringwald btstack_replace_bd_addr_placeholder(&packet[offset], bytes_to_copy, hci_stack->local_bd_addr); 150063873210SMatthias Ringwald } 1501a8c4e5adSMatthias Ringwald hci_send_cmd_packet(packet, HCI_CMD_HEADER_SIZE + 1 + EXTENDED_INQUIRY_RESPONSE_DATA_LEN); 1502ff00ed1cSMatthias Ringwald break; 150329af07f3SMatthias Ringwald } 1504f6858d14SMatthias Ringwald case HCI_INIT_WRITE_INQUIRY_MODE: 1505f6858d14SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_WRITE_INQUIRY_MODE; 15068a114470SMatthias Ringwald hci_send_cmd(&hci_write_inquiry_mode, (int) hci_stack->inquiry_mode); 1507f6858d14SMatthias Ringwald break; 15085d23aae8SMatthias Ringwald case HCI_INIT_WRITE_SECURE_CONNECTIONS_HOST_ENABLE: 15095d23aae8SMatthias Ringwald hci_send_cmd(&hci_write_secure_connections_host_support, 1); 1510c214d65bSMatthias Ringwald hci_stack->secure_connections_active = true; 15115d23aae8SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_WRITE_SECURE_CONNECTIONS_HOST_ENABLE; 15125d23aae8SMatthias Ringwald break; 151374b323a9SMatthias Ringwald case HCI_INIT_WRITE_SCAN_ENABLE: 151474b323a9SMatthias Ringwald hci_send_cmd(&hci_write_scan_enable, (hci_stack->connectable << 1) | hci_stack->discoverable); // page scan 151574b323a9SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_WRITE_SCAN_ENABLE; 151674b323a9SMatthias Ringwald break; 1517483c5078SMatthias Ringwald // only sent if ENABLE_SCO_OVER_HCI is defined 1518729ed62eSMatthias Ringwald case HCI_INIT_WRITE_SYNCHRONOUS_FLOW_CONTROL_ENABLE: 1519729ed62eSMatthias Ringwald hci_stack->substate = HCI_INIT_W4_WRITE_SYNCHRONOUS_FLOW_CONTROL_ENABLE; 1520729ed62eSMatthias Ringwald hci_send_cmd(&hci_write_synchronous_flow_control_enable, 1); // SCO tracking enabled 1521729ed62eSMatthias Ringwald break; 1522483c5078SMatthias Ringwald case HCI_INIT_WRITE_DEFAULT_ERRONEOUS_DATA_REPORTING: 1523483c5078SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_WRITE_DEFAULT_ERRONEOUS_DATA_REPORTING; 1524483c5078SMatthias Ringwald hci_send_cmd(&hci_write_default_erroneous_data_reporting, 1); 1525483c5078SMatthias Ringwald break; 15268051253fSMatthias Ringwald // only sent if manufacturer is Broadcom and ENABLE_SCO_OVER_HCI or ENABLE_SCO_OVER_PCM is defined 1527a42798c3SMatthias Ringwald case HCI_INIT_BCM_WRITE_SCO_PCM_INT: 1528a42798c3SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_BCM_WRITE_SCO_PCM_INT; 15298051253fSMatthias Ringwald #ifdef ENABLE_SCO_OVER_HCI 1530a42798c3SMatthias Ringwald log_info("BCM: Route SCO data via HCI transport"); 1531a42798c3SMatthias Ringwald hci_send_cmd(&hci_bcm_write_sco_pcm_int, 1, 0, 0, 0, 0); 15328051253fSMatthias Ringwald #endif 15338051253fSMatthias Ringwald #ifdef ENABLE_SCO_OVER_PCM 15348051253fSMatthias Ringwald log_info("BCM: Route SCO data via PCM interface"); 15351d2bbd54SMatthias Ringwald #ifdef ENABLE_BCM_PCM_WBS 15361d2bbd54SMatthias Ringwald // 512 kHz bit clock for 2 channels x 16 bit x 8 kHz 15371d2bbd54SMatthias Ringwald hci_send_cmd(&hci_bcm_write_sco_pcm_int, 0, 2, 0, 1, 1); 15381d2bbd54SMatthias Ringwald #else 15391d2bbd54SMatthias Ringwald // 256 kHz bit clock for 2 channels x 16 bit x 8 kHz 15401d2bbd54SMatthias Ringwald hci_send_cmd(&hci_bcm_write_sco_pcm_int, 0, 1, 0, 1, 1); 15411d2bbd54SMatthias Ringwald #endif 15428051253fSMatthias Ringwald #endif 1543a42798c3SMatthias Ringwald break; 15444e821764SMatthias Ringwald #ifdef ENABLE_SCO_OVER_PCM 15454e821764SMatthias Ringwald case HCI_INIT_BCM_WRITE_I2SPCM_INTERFACE_PARAM: 15464e821764SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_BCM_WRITE_I2SPCM_INTERFACE_PARAM; 15474e821764SMatthias Ringwald log_info("BCM: Config PCM interface for I2S"); 15481d2bbd54SMatthias Ringwald #ifdef ENABLE_BCM_PCM_WBS 15491d2bbd54SMatthias Ringwald // 512 kHz bit clock for 2 channels x 16 bit x 8 kHz 15501d2bbd54SMatthias Ringwald hci_send_cmd(&hci_bcm_write_i2spcm_interface_param, 1, 1, 0, 2); 15511d2bbd54SMatthias Ringwald #else 15521d2bbd54SMatthias Ringwald // 256 kHz bit clock for 2 channels x 16 bit x 8 kHz 15531d2bbd54SMatthias Ringwald hci_send_cmd(&hci_bcm_write_i2spcm_interface_param, 1, 1, 0, 1); 15541d2bbd54SMatthias Ringwald #endif 15554e821764SMatthias Ringwald break; 155635454696SMatthias Ringwald #endif 15574e821764SMatthias Ringwald #endif 15584e821764SMatthias Ringwald 1559a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE 156074b323a9SMatthias Ringwald // LE INIT 156174b323a9SMatthias Ringwald case HCI_INIT_LE_READ_BUFFER_SIZE: 156274b323a9SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_LE_READ_BUFFER_SIZE; 15630305bdeaSMatthias Ringwald hci_send_cmd(&hci_le_read_buffer_size); 156474b323a9SMatthias Ringwald break; 1565daabb8b8SMatthias Ringwald case HCI_INIT_LE_SET_EVENT_MASK: 1566daabb8b8SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_LE_SET_EVENT_MASK; 1567729710c0SMatthias Ringwald hci_send_cmd(&hci_le_set_event_mask, 0x809FF, 0x0); // bits 0-8, 11, 19 1568daabb8b8SMatthias Ringwald break; 156974b323a9SMatthias Ringwald case HCI_INIT_WRITE_LE_HOST_SUPPORTED: 157074b323a9SMatthias Ringwald // LE Supported Host = 1, Simultaneous Host = 0 157174b323a9SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_WRITE_LE_HOST_SUPPORTED; 15720305bdeaSMatthias Ringwald hci_send_cmd(&hci_write_le_host_supported, 1, 0); 157374b323a9SMatthias Ringwald break; 1574b435e062SMatthias Ringwald #endif 1575b435e062SMatthias Ringwald 1576b435e062SMatthias Ringwald #ifdef ENABLE_LE_DATA_LENGTH_EXTENSION 1577dcd678baSMatthias Ringwald case HCI_INIT_LE_READ_MAX_DATA_LENGTH: 1578dcd678baSMatthias Ringwald hci_stack->substate = HCI_INIT_W4_LE_READ_MAX_DATA_LENGTH; 1579dcd678baSMatthias Ringwald hci_send_cmd(&hci_le_read_maximum_data_length); 1580dcd678baSMatthias Ringwald break; 1581dcd678baSMatthias Ringwald case HCI_INIT_LE_WRITE_SUGGESTED_DATA_LENGTH: 1582dcd678baSMatthias Ringwald hci_stack->substate = HCI_INIT_W4_LE_WRITE_SUGGESTED_DATA_LENGTH; 1583b435e062SMatthias 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); 1584dcd678baSMatthias Ringwald break; 1585b435e062SMatthias Ringwald #endif 1586b435e062SMatthias Ringwald 1587b95a5a35SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 15883b6d4121SMatthias Ringwald case HCI_INIT_READ_WHITE_LIST_SIZE: 15893b6d4121SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_READ_WHITE_LIST_SIZE; 15903b6d4121SMatthias Ringwald hci_send_cmd(&hci_le_read_white_list_size); 15913b6d4121SMatthias Ringwald break; 159274b323a9SMatthias Ringwald case HCI_INIT_LE_SET_SCAN_PARAMETERS: 159374b323a9SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_LE_SET_SCAN_PARAMETERS; 15948b69e4c7SMatthias Ringwald hci_send_cmd(&hci_le_set_scan_parameters, hci_stack->le_scan_type, hci_stack->le_scan_interval, hci_stack->le_scan_window, hci_stack->le_own_addr_type, hci_stack->le_scan_filter_policy); 159574b323a9SMatthias Ringwald break; 159674b323a9SMatthias Ringwald #endif 159774b323a9SMatthias Ringwald default: 159874b323a9SMatthias Ringwald return; 159974b323a9SMatthias Ringwald } 160055975f88SMatthias Ringwald } 160155975f88SMatthias Ringwald 1602a650ba4dSMatthias Ringwald static void hci_init_done(void){ 1603a650ba4dSMatthias Ringwald // done. tell the app 1604a650ba4dSMatthias Ringwald log_info("hci_init_done -> HCI_STATE_WORKING"); 1605a650ba4dSMatthias Ringwald hci_stack->state = HCI_STATE_WORKING; 1606a650ba4dSMatthias Ringwald hci_emit_state(); 1607a650ba4dSMatthias Ringwald hci_run(); 1608a650ba4dSMatthias Ringwald } 1609a650ba4dSMatthias Ringwald 161007fd2f31SMatthias Ringwald static bool hci_initializing_event_handler_command_completed(const uint8_t * packet){ 161107fd2f31SMatthias Ringwald bool command_completed = false; 16120e2df43fSMatthias Ringwald if (hci_event_packet_get_type(packet) == HCI_EVENT_COMMAND_COMPLETE){ 1613f8fbdce0SMatthias Ringwald uint16_t opcode = little_endian_read_16(packet,3); 16146155b3d3S[email protected] if (opcode == hci_stack->last_cmd_opcode){ 161507fd2f31SMatthias Ringwald command_completed = true; 1616148ca237SMatthias Ringwald log_debug("Command complete for expected opcode %04x at substate %u", opcode, hci_stack->substate); 16176155b3d3S[email protected] } else { 1618d58dd308SMatthias Ringwald log_info("Command complete for different opcode %04x, expected %04x, at substate %u", opcode, hci_stack->last_cmd_opcode, hci_stack->substate); 16196155b3d3S[email protected] } 16206155b3d3S[email protected] } 16210f97eae7SMatthias Ringwald 16220e2df43fSMatthias Ringwald if (hci_event_packet_get_type(packet) == HCI_EVENT_COMMAND_STATUS){ 16236155b3d3S[email protected] uint8_t status = packet[2]; 1624f8fbdce0SMatthias Ringwald uint16_t opcode = little_endian_read_16(packet,4); 16256155b3d3S[email protected] if (opcode == hci_stack->last_cmd_opcode){ 16266155b3d3S[email protected] if (status){ 162707fd2f31SMatthias Ringwald command_completed = true; 1628148ca237SMatthias Ringwald log_debug("Command status error 0x%02x for expected opcode %04x at substate %u", status, opcode, hci_stack->substate); 16296155b3d3S[email protected] } else { 16306155b3d3S[email protected] log_info("Command status OK for expected opcode %04x, waiting for command complete", opcode); 16316155b3d3S[email protected] } 16326155b3d3S[email protected] } else { 1633148ca237SMatthias Ringwald log_debug("Command status for opcode %04x, expected %04x", opcode, hci_stack->last_cmd_opcode); 16346155b3d3S[email protected] } 16356155b3d3S[email protected] } 163606b9e820SMatthias Ringwald #if !defined(HAVE_PLATFORM_IPHONE_OS) && !defined (HAVE_HOST_CONTROLLER_API) 1637e47e68c7SMatthias Ringwald // Vendor == CSR 16380e588213SMatthias Ringwald if ((hci_stack->substate == HCI_INIT_W4_CUSTOM_INIT) && (hci_event_packet_get_type(packet) == HCI_EVENT_VENDOR_SPECIFIC)){ 1639e47e68c7SMatthias Ringwald // TODO: track actual command 164007fd2f31SMatthias Ringwald command_completed = true; 1641e47e68c7SMatthias Ringwald } 1642a2481739S[email protected] 16434e9daa6fSMatthias Ringwald // Vendor == Toshiba 16440e588213SMatthias Ringwald if ((hci_stack->substate == HCI_INIT_W4_SEND_BAUD_CHANGE) && (hci_event_packet_get_type(packet) == HCI_EVENT_VENDOR_SPECIFIC)){ 16454e9daa6fSMatthias Ringwald // TODO: track actual command 164607fd2f31SMatthias Ringwald command_completed = true; 1647004902f1SMatthias Ringwald // Fix: no HCI Command Complete received, so num_cmd_packets not reset 1648004902f1SMatthias Ringwald hci_stack->num_cmd_packets = 1; 16494e9daa6fSMatthias Ringwald } 165007fd2f31SMatthias Ringwald #endif 165107fd2f31SMatthias Ringwald 165207fd2f31SMatthias Ringwald return command_completed; 165307fd2f31SMatthias Ringwald } 165407fd2f31SMatthias Ringwald 165507fd2f31SMatthias Ringwald static void hci_initializing_event_handler(const uint8_t * packet, uint16_t size){ 165607fd2f31SMatthias Ringwald 165707fd2f31SMatthias Ringwald UNUSED(size); // ok: less than 6 bytes are read from our buffer 165807fd2f31SMatthias Ringwald 165907fd2f31SMatthias Ringwald bool command_completed = hci_initializing_event_handler_command_completed(packet); 166007fd2f31SMatthias Ringwald 166107fd2f31SMatthias Ringwald #if !defined(HAVE_PLATFORM_IPHONE_OS) && !defined (HAVE_HOST_CONTROLLER_API) 16624e9daa6fSMatthias Ringwald 16630f97eae7SMatthias Ringwald // Late response (> 100 ms) for HCI Reset e.g. on Toshiba TC35661: 16640f97eae7SMatthias Ringwald // Command complete for HCI Reset arrives after we've resent the HCI Reset command 16650f97eae7SMatthias Ringwald // 16660f97eae7SMatthias Ringwald // HCI Reset 16670f97eae7SMatthias Ringwald // Timeout 100 ms 16680f97eae7SMatthias Ringwald // HCI Reset 16690f97eae7SMatthias Ringwald // Command Complete Reset 16700f97eae7SMatthias Ringwald // HCI Read Local Version Information 16710f97eae7SMatthias Ringwald // Command Complete Reset - but we expected Command Complete Read Local Version Information 16720f97eae7SMatthias Ringwald // hang... 16730f97eae7SMatthias Ringwald // 16740f97eae7SMatthias Ringwald // Fix: Command Complete for HCI Reset in HCI_INIT_W4_SEND_READ_LOCAL_VERSION_INFORMATION trigger resend 16750f97eae7SMatthias Ringwald if (!command_completed 1676a1df452eSMatthias Ringwald && (hci_event_packet_get_type(packet) == HCI_EVENT_COMMAND_COMPLETE) 16770e588213SMatthias Ringwald && (hci_stack->substate == HCI_INIT_W4_SEND_READ_LOCAL_VERSION_INFORMATION)){ 16780f97eae7SMatthias Ringwald 1679f8fbdce0SMatthias Ringwald uint16_t opcode = little_endian_read_16(packet,3); 16800f97eae7SMatthias Ringwald if (opcode == hci_reset.opcode){ 16810f97eae7SMatthias Ringwald hci_stack->substate = HCI_INIT_SEND_READ_LOCAL_VERSION_INFORMATION; 16820f97eae7SMatthias Ringwald return; 16830f97eae7SMatthias Ringwald } 16840f97eae7SMatthias Ringwald } 16850f97eae7SMatthias Ringwald 16869f007422SMatthias Ringwald // CSR & H5 16879f007422SMatthias Ringwald // Fix: Command Complete for HCI Reset in HCI_INIT_W4_SEND_READ_LOCAL_VERSION_INFORMATION trigger resend 16889f007422SMatthias Ringwald if (!command_completed 1689a1df452eSMatthias Ringwald && (hci_event_packet_get_type(packet) == HCI_EVENT_COMMAND_COMPLETE) 16900e588213SMatthias Ringwald && (hci_stack->substate == HCI_INIT_W4_READ_LOCAL_SUPPORTED_COMMANDS)){ 16919f007422SMatthias Ringwald 16929f007422SMatthias Ringwald uint16_t opcode = little_endian_read_16(packet,3); 16939f007422SMatthias Ringwald if (opcode == hci_reset.opcode){ 16949f007422SMatthias Ringwald hci_stack->substate = HCI_INIT_READ_LOCAL_SUPPORTED_COMMANDS; 16959f007422SMatthias Ringwald return; 16969f007422SMatthias Ringwald } 16979f007422SMatthias Ringwald } 16989f007422SMatthias Ringwald 16999f007422SMatthias 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 17009f007422SMatthias Ringwald // fix: Correct substate and behave as command below 17019f007422SMatthias Ringwald if (command_completed){ 17029f007422SMatthias Ringwald switch (hci_stack->substate){ 17039f007422SMatthias Ringwald case HCI_INIT_SEND_RESET: 17049f007422SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_SEND_RESET; 17059f007422SMatthias Ringwald break; 17069f007422SMatthias Ringwald case HCI_INIT_SEND_RESET_CSR_WARM_BOOT: 17079f007422SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_CUSTOM_INIT_CSR_WARM_BOOT; 17089f007422SMatthias Ringwald break; 17099f007422SMatthias Ringwald default: 17109f007422SMatthias Ringwald break; 17119f007422SMatthias Ringwald } 17129f007422SMatthias Ringwald } 17130f97eae7SMatthias Ringwald 171406b9e820SMatthias Ringwald #endif 17150f97eae7SMatthias Ringwald 1716a2481739S[email protected] if (!command_completed) return; 1717a2481739S[email protected] 171807fd2f31SMatthias Ringwald bool need_baud_change = false; 171907fd2f31SMatthias Ringwald bool need_addr_change = false; 172006b9e820SMatthias Ringwald 172106b9e820SMatthias Ringwald #if !defined(HAVE_PLATFORM_IPHONE_OS) && !defined (HAVE_HOST_CONTROLLER_API) 172206b9e820SMatthias Ringwald need_baud_change = hci_stack->config 17233fb36a29SMatthias Ringwald && hci_stack->chipset 17243fb36a29SMatthias Ringwald && hci_stack->chipset->set_baudrate_command 1725db8bc6ffSMatthias Ringwald && hci_stack->hci_transport->set_baudrate 17269796ebeaSMatthias Ringwald && ((hci_transport_config_uart_t *)hci_stack->config)->baudrate_main; 1727db8bc6ffSMatthias Ringwald 172806b9e820SMatthias Ringwald need_addr_change = hci_stack->custom_bd_addr_set 17293fb36a29SMatthias Ringwald && hci_stack->chipset 17303fb36a29SMatthias Ringwald && hci_stack->chipset->set_bd_addr_command; 173106b9e820SMatthias Ringwald #endif 1732a80162e9SMatthias Ringwald 17335c363727SMatthias Ringwald switch(hci_stack->substate){ 173406b9e820SMatthias Ringwald 173506b9e820SMatthias Ringwald #if !defined(HAVE_PLATFORM_IPHONE_OS) && !defined (HAVE_HOST_CONTROLLER_API) 17369f007422SMatthias Ringwald case HCI_INIT_SEND_RESET: 1737d58dd308SMatthias Ringwald // on CSR with BCSP/H5, resend triggers resend of HCI Reset and leads to substate == HCI_INIT_SEND_RESET 17389f007422SMatthias Ringwald // fix: just correct substate and behave as command below 17399f007422SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_SEND_RESET; 17409f007422SMatthias Ringwald btstack_run_loop_remove_timer(&hci_stack->timeout); 17419f007422SMatthias Ringwald break; 174274b323a9SMatthias Ringwald case HCI_INIT_W4_SEND_RESET: 1743528a4a3bSMatthias Ringwald btstack_run_loop_remove_timer(&hci_stack->timeout); 174476fcb19bSMatthias Ringwald break; 1745e90bae01SMatthias Ringwald case HCI_INIT_W4_SEND_READ_LOCAL_NAME: 174607fd2f31SMatthias Ringwald log_info("Received local name, need baud change %d", (int) need_baud_change); 17472f48d920SMatthias Ringwald if (need_baud_change){ 17482f48d920SMatthias Ringwald hci_stack->substate = HCI_INIT_SEND_BAUD_CHANGE; 17492f48d920SMatthias Ringwald return; 17502f48d920SMatthias Ringwald } 175153860077SMatthias Ringwald // skip baud change 175274b323a9SMatthias Ringwald hci_stack->substate = HCI_INIT_CUSTOM_INIT; 175374b323a9SMatthias Ringwald return; 1754a80162e9SMatthias Ringwald case HCI_INIT_W4_SEND_BAUD_CHANGE: 17554696bddbSMatthias Ringwald // for STLC2500D, baud rate change already happened. 1756fab26ab3SMatthias Ringwald // for others, baud rate gets changed now 175761f37892SMatthias Ringwald if ((hci_stack->manufacturer != BLUETOOTH_COMPANY_ID_ST_MICROELECTRONICS) && need_baud_change){ 175896b53536SMatthias Ringwald uint32_t baud_rate = hci_transport_uart_get_main_baud_rate(); 1759cd724cb7SMatthias Ringwald log_info("Local baud rate change to %" PRIu32 "(w4_send_baud_change)", baud_rate); 1760fab26ab3SMatthias Ringwald hci_stack->hci_transport->set_baudrate(baud_rate); 17614696bddbSMatthias Ringwald } 176274b323a9SMatthias Ringwald hci_stack->substate = HCI_INIT_CUSTOM_INIT; 176374b323a9SMatthias Ringwald return; 1764a80162e9SMatthias Ringwald case HCI_INIT_W4_CUSTOM_INIT_CSR_WARM_BOOT: 1765528a4a3bSMatthias Ringwald btstack_run_loop_remove_timer(&hci_stack->timeout); 1766a80162e9SMatthias Ringwald hci_stack->substate = HCI_INIT_CUSTOM_INIT; 1767a80162e9SMatthias Ringwald return; 176874b323a9SMatthias Ringwald case HCI_INIT_W4_CUSTOM_INIT: 176974b323a9SMatthias Ringwald // repeat custom init 177074b323a9SMatthias Ringwald hci_stack->substate = HCI_INIT_CUSTOM_INIT; 177174b323a9SMatthias Ringwald return; 177206b9e820SMatthias Ringwald #else 177306b9e820SMatthias Ringwald case HCI_INIT_W4_SEND_RESET: 177406b9e820SMatthias Ringwald hci_stack->substate = HCI_INIT_READ_LOCAL_SUPPORTED_COMMANDS; 177506b9e820SMatthias Ringwald return ; 177606b9e820SMatthias Ringwald #endif 177706b9e820SMatthias Ringwald 1778a828a756SMatthias Ringwald case HCI_INIT_W4_READ_LOCAL_SUPPORTED_COMMANDS: 17790e588213SMatthias Ringwald if (need_baud_change && (hci_stack->chipset_result != BTSTACK_CHIPSET_NO_INIT_SCRIPT) && 1780efd3b327SMatthias Ringwald ((hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_BROADCOM_CORPORATION) || 1781efd3b327SMatthias Ringwald (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_EM_MICROELECTRONIC_MARIN_SA))) { 1782eb3a5314SMatthias Ringwald hci_stack->substate = HCI_INIT_SEND_BAUD_CHANGE_BCM; 1783eb3a5314SMatthias Ringwald return; 1784eb3a5314SMatthias Ringwald } 178553860077SMatthias Ringwald if (need_addr_change){ 178653860077SMatthias Ringwald hci_stack->substate = HCI_INIT_SET_BD_ADDR; 178753860077SMatthias Ringwald return; 178853860077SMatthias Ringwald } 178953860077SMatthias Ringwald hci_stack->substate = HCI_INIT_READ_BD_ADDR; 179053860077SMatthias Ringwald return; 179106b9e820SMatthias Ringwald #if !defined(HAVE_PLATFORM_IPHONE_OS) && !defined (HAVE_HOST_CONTROLLER_API) 17927224be7eSMatthias Ringwald case HCI_INIT_W4_SEND_BAUD_CHANGE_BCM: 17937224be7eSMatthias Ringwald if (need_baud_change){ 179496b53536SMatthias Ringwald uint32_t baud_rate = hci_transport_uart_get_main_baud_rate(); 1795cd724cb7SMatthias Ringwald log_info("Local baud rate change to %" PRIu32 "(w4_send_baud_change_bcm))", baud_rate); 1796fab26ab3SMatthias Ringwald hci_stack->hci_transport->set_baudrate(baud_rate); 17977224be7eSMatthias Ringwald } 1798eb3a5314SMatthias Ringwald if (need_addr_change){ 1799eb3a5314SMatthias Ringwald hci_stack->substate = HCI_INIT_SET_BD_ADDR; 1800eb3a5314SMatthias Ringwald return; 1801eb3a5314SMatthias Ringwald } 1802eb3a5314SMatthias Ringwald hci_stack->substate = HCI_INIT_READ_BD_ADDR; 1803eb3a5314SMatthias Ringwald return; 180453860077SMatthias Ringwald case HCI_INIT_W4_SET_BD_ADDR: 18056ca9a99aSMatthias Ringwald // for STLC2500D + ATWILC3000, bd addr change only gets active after sending reset command 18066ca9a99aSMatthias Ringwald if ((hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_ST_MICROELECTRONICS) 18076ca9a99aSMatthias Ringwald || (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_ATMEL_CORPORATION)){ 180853860077SMatthias Ringwald hci_stack->substate = HCI_INIT_SEND_RESET_ST_WARM_BOOT; 180953860077SMatthias Ringwald return; 181053860077SMatthias Ringwald } 181153860077SMatthias Ringwald // skipping st warm boot 181253860077SMatthias Ringwald hci_stack->substate = HCI_INIT_READ_BD_ADDR; 181353860077SMatthias Ringwald return; 181453860077SMatthias Ringwald case HCI_INIT_W4_SEND_RESET_ST_WARM_BOOT: 181553860077SMatthias Ringwald hci_stack->substate = HCI_INIT_READ_BD_ADDR; 181653860077SMatthias Ringwald return; 181706b9e820SMatthias Ringwald #endif 181853860077SMatthias Ringwald case HCI_INIT_W4_READ_BD_ADDR: 181953860077SMatthias Ringwald // only read buffer size if supported 18204ea43905SMatthias Ringwald if (hci_stack->local_supported_commands[0u] & 0x01u) { 182153860077SMatthias Ringwald hci_stack->substate = HCI_INIT_READ_BUFFER_SIZE; 182253860077SMatthias Ringwald return; 182353860077SMatthias Ringwald } 182453860077SMatthias Ringwald // skipping read buffer size 182553860077SMatthias Ringwald hci_stack->substate = HCI_INIT_READ_LOCAL_SUPPORTED_FEATURES; 1826a828a756SMatthias Ringwald return; 182774b323a9SMatthias Ringwald case HCI_INIT_W4_SET_EVENT_MASK: 18286155b3d3S[email protected] // skip Classic init commands for LE only chipsets 18296155b3d3S[email protected] if (!hci_classic_supported()){ 18302c68f164SMatthias Ringwald #ifdef ENABLE_BLE 18316155b3d3S[email protected] if (hci_le_supported()){ 183274b323a9SMatthias Ringwald hci_stack->substate = HCI_INIT_LE_READ_BUFFER_SIZE; // skip all classic command 183374b323a9SMatthias Ringwald return; 18342c68f164SMatthias Ringwald } 18352c68f164SMatthias Ringwald #endif 18366155b3d3S[email protected] log_error("Neither BR/EDR nor LE supported"); 1837a650ba4dSMatthias Ringwald hci_init_done(); 183874b323a9SMatthias Ringwald return; 18396155b3d3S[email protected] } 184015a95bd5SMatthias Ringwald if (!gap_ssp_supported()){ 18415c363727SMatthias Ringwald hci_stack->substate = HCI_INIT_WRITE_PAGE_TIMEOUT; 184274b323a9SMatthias Ringwald return; 18436155b3d3S[email protected] } 18446155b3d3S[email protected] break; 1845903ea03aSMatthias Ringwald #ifdef ENABLE_BLE 1846a828a756SMatthias Ringwald case HCI_INIT_W4_LE_READ_BUFFER_SIZE: 1847a828a756SMatthias Ringwald // skip write le host if not supported (e.g. on LE only EM9301) 18484ea43905SMatthias Ringwald if (hci_stack->local_supported_commands[0u] & 0x02u) break; 1849daabb8b8SMatthias Ringwald hci_stack->substate = HCI_INIT_LE_SET_EVENT_MASK; 1850daabb8b8SMatthias Ringwald return; 1851daabb8b8SMatthias Ringwald 1852b435e062SMatthias Ringwald #ifdef ENABLE_LE_DATA_LENGTH_EXTENSION 1853b435e062SMatthias Ringwald case HCI_INIT_W4_WRITE_LE_HOST_SUPPORTED: 18546fab74dbSMatthias Ringwald log_info("Supported commands %x", hci_stack->local_supported_commands[0] & 0x30); 18554ea43905SMatthias Ringwald if ((hci_stack->local_supported_commands[0u] & 0x30u) == 0x30u){ 185680d7d618SMatthias Ringwald hci_stack->substate = HCI_INIT_LE_SET_EVENT_MASK; 1857b435e062SMatthias Ringwald return; 1858b435e062SMatthias Ringwald } 1859b435e062SMatthias Ringwald // explicit fall through to reduce repetitions 1860b435e062SMatthias Ringwald 1861b435e062SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 1862b435e062SMatthias Ringwald hci_stack->substate = HCI_INIT_READ_WHITE_LIST_SIZE; 1863903ea03aSMatthias Ringwald #else 1864903ea03aSMatthias Ringwald hci_init_done(); 1865903ea03aSMatthias Ringwald #endif 1866a828a756SMatthias Ringwald return; 186706337f4fSMatthias Ringwald #endif /* ENABLE_LE_DATA_LENGTH_EXTENSION */ 186806337f4fSMatthias Ringwald 186906337f4fSMatthias Ringwald #endif /* ENABLE_BLE */ 1870b435e062SMatthias Ringwald 18715d23aae8SMatthias Ringwald case HCI_INIT_W4_WRITE_INQUIRY_MODE: 18725d23aae8SMatthias Ringwald // skip write secure connections host support if not supported or disabled 18734ea43905SMatthias Ringwald if (!hci_stack->secure_connections_enable || (hci_stack->local_supported_commands[1u] & 0x02u) == 0u) { 18745d23aae8SMatthias Ringwald hci_stack->substate = HCI_INIT_WRITE_SCAN_ENABLE; 18755d23aae8SMatthias Ringwald return; 18765d23aae8SMatthias Ringwald } 18775d23aae8SMatthias Ringwald break; 18785d23aae8SMatthias Ringwald 187947bc3ebbSMatthias Ringwald #ifdef ENABLE_SCO_OVER_HCI 18803b65523cSMatthias Ringwald case HCI_INIT_W4_WRITE_SCAN_ENABLE: 18813905afbfSMatthias Ringwald // skip write synchronous flow control if not supported 18823905afbfSMatthias Ringwald if (hci_stack->local_supported_commands[0] & 0x04) break; 18833905afbfSMatthias Ringwald hci_stack->substate = HCI_INIT_W4_WRITE_SYNCHRONOUS_FLOW_CONTROL_ENABLE; 1884cf373d3aSMatthias Ringwald 1885cf373d3aSMatthias Ringwald /* fall through */ 18863905afbfSMatthias Ringwald 1887729ed62eSMatthias Ringwald case HCI_INIT_W4_WRITE_SYNCHRONOUS_FLOW_CONTROL_ENABLE: 18883905afbfSMatthias Ringwald // skip write default erroneous data reporting if not supported 18893905afbfSMatthias Ringwald if (hci_stack->local_supported_commands[0] & 0x08) break; 18903905afbfSMatthias Ringwald hci_stack->substate = HCI_INIT_W4_WRITE_DEFAULT_ERRONEOUS_DATA_REPORTING; 1891cf373d3aSMatthias Ringwald 1892cf373d3aSMatthias Ringwald /* fall through */ 18933905afbfSMatthias Ringwald 1894f064e0bbSMatthias Ringwald case HCI_INIT_W4_WRITE_DEFAULT_ERRONEOUS_DATA_REPORTING: 1895a42798c3SMatthias Ringwald // skip bcm set sco pcm config on non-Broadcom chipsets 189661f37892SMatthias Ringwald if (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_BROADCOM_CORPORATION) break; 18970168d82eSMatthias Ringwald hci_stack->substate = HCI_INIT_W4_BCM_WRITE_I2SPCM_INTERFACE_PARAM; 1898cf373d3aSMatthias Ringwald 1899cf373d3aSMatthias Ringwald /* fall through */ 1900a42798c3SMatthias Ringwald 1901a42798c3SMatthias Ringwald case HCI_INIT_W4_BCM_WRITE_SCO_PCM_INT: 1902729ed62eSMatthias Ringwald if (!hci_le_supported()){ 1903729ed62eSMatthias Ringwald // SKIP LE init for Classic only configuration 1904a650ba4dSMatthias Ringwald hci_init_done(); 1905729ed62eSMatthias Ringwald return; 1906729ed62eSMatthias Ringwald } 1907afe9bf34SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_BCM_WRITE_I2SPCM_INTERFACE_PARAM; 1908729ed62eSMatthias Ringwald break; 1909f3b012f9SMatthias Ringwald 1910f3b012f9SMatthias Ringwald #else /* !ENABLE_SCO_OVER_HCI */ 1911f3b012f9SMatthias Ringwald 191274b323a9SMatthias Ringwald case HCI_INIT_W4_WRITE_SCAN_ENABLE: 19138051253fSMatthias Ringwald #ifdef ENABLE_SCO_OVER_PCM 19148051253fSMatthias Ringwald if (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_BROADCOM_CORPORATION) { 19158051253fSMatthias Ringwald hci_stack->substate = HCI_INIT_BCM_WRITE_SCO_PCM_INT; 19168051253fSMatthias Ringwald return; 19178051253fSMatthias Ringwald } 19188051253fSMatthias Ringwald #endif 19198051253fSMatthias Ringwald /* fall through */ 19208051253fSMatthias Ringwald 19214e821764SMatthias Ringwald case HCI_INIT_W4_BCM_WRITE_I2SPCM_INTERFACE_PARAM: 1922f3b012f9SMatthias Ringwald #ifdef ENABLE_BLE 1923f3b012f9SMatthias Ringwald if (hci_le_supported()){ 1924f3b012f9SMatthias Ringwald hci_stack->substate = HCI_INIT_LE_READ_BUFFER_SIZE; 192574b323a9SMatthias Ringwald return; 19266155b3d3S[email protected] } 1927729ed62eSMatthias Ringwald #endif 1928f3b012f9SMatthias Ringwald // SKIP LE init for Classic only configuration 1929f3b012f9SMatthias Ringwald hci_init_done(); 1930f3b012f9SMatthias Ringwald return; 1931f3b012f9SMatthias Ringwald #endif /* ENABLE_SCO_OVER_HCI */ 1932f3b012f9SMatthias Ringwald 1933a4e96e78SMatthias Ringwald // avoid compile error due to duplicate cases: HCI_INIT_W4_BCM_WRITE_SCO_PCM_INT == HCI_INIT_DONE-1 1934a4e96e78SMatthias Ringwald #if defined(ENABLE_BLE) || defined(ENABLE_LE_DATA_LENGTH_EXTENSION) || defined(ENABLE_LE_CENTRAL) 1935a650ba4dSMatthias Ringwald // Response to command before init done state -> init done 1936a650ba4dSMatthias Ringwald case (HCI_INIT_DONE-1): 1937a650ba4dSMatthias Ringwald hci_init_done(); 1938a650ba4dSMatthias Ringwald return; 1939a4e96e78SMatthias Ringwald #endif 1940a650ba4dSMatthias Ringwald 19416155b3d3S[email protected] default: 194274b323a9SMatthias Ringwald break; 19436155b3d3S[email protected] } 194455975f88SMatthias Ringwald hci_initializing_next_state(); 19456155b3d3S[email protected] } 19466155b3d3S[email protected] 19470bbba85bSMatthias Ringwald static void hci_handle_connection_failed(hci_connection_t * conn, uint8_t status){ 1948229331c6SMatthias Ringwald log_info("Outgoing connection to %s failed", bd_addr_to_str(conn->address)); 19490bbba85bSMatthias Ringwald bd_addr_t bd_address; 19506535961aSMatthias Ringwald (void)memcpy(&bd_address, conn->address, 6); 19510bbba85bSMatthias Ringwald 19526bc9fa5eSMatthias Ringwald #ifdef ENABLE_CLASSIC 19536bc9fa5eSMatthias Ringwald // cache needed data 19546bc9fa5eSMatthias Ringwald int notify_dedicated_bonding_failed = conn->bonding_flags & BONDING_DEDICATED; 19556bc9fa5eSMatthias Ringwald #endif 19566bc9fa5eSMatthias Ringwald 19570bbba85bSMatthias Ringwald // connection failed, remove entry 19580bbba85bSMatthias Ringwald btstack_linked_list_remove(&hci_stack->connections, (btstack_linked_item_t *) conn); 19590bbba85bSMatthias Ringwald btstack_memory_hci_connection_free( conn ); 19600bbba85bSMatthias Ringwald 19616bc9fa5eSMatthias Ringwald #ifdef ENABLE_CLASSIC 19620bbba85bSMatthias Ringwald // notify client if dedicated bonding 19630bbba85bSMatthias Ringwald if (notify_dedicated_bonding_failed){ 19640bbba85bSMatthias Ringwald log_info("hci notify_dedicated_bonding_failed"); 19650bbba85bSMatthias Ringwald hci_emit_dedicated_bonding_result(bd_address, status); 19660bbba85bSMatthias Ringwald } 19670bbba85bSMatthias Ringwald 19680bbba85bSMatthias Ringwald // if authentication error, also delete link key 19690bbba85bSMatthias Ringwald if (status == ERROR_CODE_AUTHENTICATION_FAILURE) { 19700bbba85bSMatthias Ringwald gap_drop_link_key_for_bd_addr(bd_address); 19710bbba85bSMatthias Ringwald } 19721c79b5e3SMatthias Ringwald #else 19731c79b5e3SMatthias Ringwald UNUSED(status); 19746bc9fa5eSMatthias Ringwald #endif 19750bbba85bSMatthias Ringwald } 19760bbba85bSMatthias Ringwald 1977be500194SMatthias Ringwald #ifdef ENABLE_CLASSIC 19782f5c44baSMatthias Ringwald static void hci_handle_remote_features_page_0(hci_connection_t * conn, const uint8_t * features){ 19792f5c44baSMatthias Ringwald // SSP Controller 19802f5c44baSMatthias Ringwald if (features[6] & (1 << 3)){ 19812f5c44baSMatthias Ringwald conn->bonding_flags |= BONDING_REMOTE_SUPPORTS_SSP_CONTROLLER; 19822f5c44baSMatthias Ringwald } 19832f5c44baSMatthias Ringwald // eSCO 19842f5c44baSMatthias Ringwald if (features[3] & (1<<7)){ 19852f5c44baSMatthias Ringwald conn->remote_supported_features[0] |= 1; 19862f5c44baSMatthias Ringwald } 19872f5c44baSMatthias Ringwald // Extended features 19882f5c44baSMatthias Ringwald if (features[7] & (1<<7)){ 19892f5c44baSMatthias Ringwald conn->remote_supported_features[0] |= 2; 19902f5c44baSMatthias Ringwald } 19912f5c44baSMatthias Ringwald } 19922f5c44baSMatthias Ringwald 19932f5c44baSMatthias Ringwald static void hci_handle_remote_features_page_1(hci_connection_t * conn, const uint8_t * features){ 19942f5c44baSMatthias Ringwald // SSP Host 19952f5c44baSMatthias Ringwald if (features[0] & (1 << 0)){ 19962f5c44baSMatthias Ringwald conn->bonding_flags |= BONDING_REMOTE_SUPPORTS_SSP_HOST; 19972f5c44baSMatthias Ringwald } 199850c51a77SMatthias Ringwald // SC Host 199950c51a77SMatthias Ringwald if (features[0] & (1 << 3)){ 200050c51a77SMatthias Ringwald conn->bonding_flags |= BONDING_REMOTE_SUPPORTS_SC_HOST; 200150c51a77SMatthias Ringwald } 200250c51a77SMatthias Ringwald } 200350c51a77SMatthias Ringwald 200450c51a77SMatthias Ringwald static void hci_handle_remote_features_page_2(hci_connection_t * conn, const uint8_t * features){ 200550c51a77SMatthias Ringwald // SC Controller 200650c51a77SMatthias Ringwald if (features[1] & (1 << 0)){ 200750c51a77SMatthias Ringwald conn->bonding_flags |= BONDING_REMOTE_SUPPORTS_SC_CONTROLLER; 200850c51a77SMatthias Ringwald } 20092f5c44baSMatthias Ringwald } 20102f5c44baSMatthias Ringwald 2011de0df013SMatthias Ringwald static void hci_handle_remote_features_received(hci_connection_t * conn){ 2012de0df013SMatthias Ringwald conn->bonding_flags |= BONDING_RECEIVED_REMOTE_FEATURES; 201349bafb5eSMatthias Ringwald log_info("Remote features %02x, bonding flags %x", conn->remote_supported_features[0], conn->bonding_flags); 2014de0df013SMatthias Ringwald if (conn->bonding_flags & BONDING_DEDICATED){ 2015de0df013SMatthias Ringwald conn->bonding_flags |= BONDING_SEND_AUTHENTICATE_REQUEST; 2016de0df013SMatthias Ringwald } 2017de0df013SMatthias Ringwald } 2018be500194SMatthias Ringwald #endif 2019de0df013SMatthias Ringwald 202067c6c9dcSMatthias Ringwald static void handle_event_for_current_stack_state(const uint8_t * packet, uint16_t size) { 202167c6c9dcSMatthias Ringwald // handle BT initialization 202267c6c9dcSMatthias Ringwald if (hci_stack->state == HCI_STATE_INITIALIZING) { 202367c6c9dcSMatthias Ringwald hci_initializing_event_handler(packet, size); 202467c6c9dcSMatthias Ringwald } 202567c6c9dcSMatthias Ringwald 202667c6c9dcSMatthias Ringwald // help with BT sleep 202767c6c9dcSMatthias Ringwald if ((hci_stack->state == HCI_STATE_FALLING_ASLEEP) 202867c6c9dcSMatthias Ringwald && (hci_stack->substate == HCI_FALLING_ASLEEP_W4_WRITE_SCAN_ENABLE) 202967c6c9dcSMatthias Ringwald && HCI_EVENT_IS_COMMAND_COMPLETE(packet, hci_write_scan_enable)) { 203067c6c9dcSMatthias Ringwald hci_initializing_next_state(); 203167c6c9dcSMatthias Ringwald } 203267c6c9dcSMatthias Ringwald } 203367c6c9dcSMatthias Ringwald 20349866fdc7SMatthias Ringwald #ifdef ENABLE_CLASSIC 20359866fdc7SMatthias Ringwald static void hci_handle_read_encryption_key_size_complete(hci_connection_t * conn, uint8_t encryption_key_size) { 20369866fdc7SMatthias Ringwald conn->authentication_flags |= CONNECTION_ENCRYPTED; 20379866fdc7SMatthias Ringwald conn->encryption_key_size = encryption_key_size; 2038abdad579SMatthias Ringwald 2039abdad579SMatthias Ringwald if ((conn->authentication_flags & CONNECTION_AUTHENTICATED) != 0) { 20409866fdc7SMatthias Ringwald hci_emit_security_level(conn->con_handle, gap_security_level_for_connection(conn)); 2041abdad579SMatthias Ringwald return; 2042abdad579SMatthias Ringwald } 2043abdad579SMatthias Ringwald 2044abdad579SMatthias Ringwald // Request Authentication if not already done 2045abdad579SMatthias Ringwald if ((conn->bonding_flags & BONDING_SENT_AUTHENTICATE_REQUEST) != 0) return; 2046abdad579SMatthias Ringwald conn->bonding_flags |= BONDING_SEND_AUTHENTICATE_REQUEST; 20479866fdc7SMatthias Ringwald } 20489866fdc7SMatthias Ringwald #endif 20499866fdc7SMatthias Ringwald 20504f781026SMatthias Ringwald static void handle_command_complete_event(uint8_t * packet, uint16_t size){ 2051b08371a9SMilanka Ringwald UNUSED(size); 2052e76a89eeS[email protected] 20539cbd2215SMatthias Ringwald uint16_t manufacturer; 20549cbd2215SMatthias Ringwald #ifdef ENABLE_CLASSIC 2055fe1ed1b8Smatthias.ringwald hci_con_handle_t handle; 20561f7b95a1Smatthias.ringwald hci_connection_t * conn; 2057645b7c25SMatthias Ringwald uint8_t status; 20589cbd2215SMatthias Ringwald #endif 20596bef4003SMatthias Ringwald // get num cmd packets - limit to 1 to reduce complexity 20606bef4003SMatthias Ringwald hci_stack->num_cmd_packets = packet[2] ? 1 : 0; 20617ec5eeaaSmatthias.ringwald 2062645b7c25SMatthias Ringwald uint16_t opcode = hci_event_command_complete_get_command_opcode(packet); 2063645b7c25SMatthias Ringwald switch (opcode){ 2064645b7c25SMatthias Ringwald case HCI_OPCODE_HCI_READ_LOCAL_NAME: 2065645b7c25SMatthias Ringwald if (packet[5]) break; 20669e263bd7SMatthias Ringwald // terminate, name 248 chars 20679e263bd7SMatthias Ringwald packet[6+248] = 0; 20689e263bd7SMatthias Ringwald log_info("local name: %s", &packet[6]); 2069645b7c25SMatthias Ringwald break; 2070645b7c25SMatthias Ringwald case HCI_OPCODE_HCI_READ_BUFFER_SIZE: 20711d279b20Smatthias.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" 2072c3b46f5aSMatthias Ringwald if (hci_stack->state == HCI_STATE_INITIALIZING) { 2073429122ccSMatthias Ringwald uint16_t acl_len = little_endian_read_16(packet, 6); 2074429122ccSMatthias Ringwald uint16_t sco_len = packet[8]; 2075429122ccSMatthias Ringwald 2076429122ccSMatthias Ringwald // determine usable ACL/SCO payload size 2077429122ccSMatthias Ringwald hci_stack->acl_data_packet_length = btstack_min(acl_len, HCI_ACL_PAYLOAD_SIZE); 2078429122ccSMatthias Ringwald hci_stack->sco_data_packet_length = btstack_min(sco_len, HCI_ACL_PAYLOAD_SIZE); 2079429122ccSMatthias Ringwald 2080f8fbdce0SMatthias Ringwald hci_stack->acl_packets_total_num = little_endian_read_16(packet, 9); 2081f8fbdce0SMatthias Ringwald hci_stack->sco_packets_total_num = little_endian_read_16(packet, 11); 2082a8b12447S[email protected] 2083429122ccSMatthias Ringwald log_info("hci_read_buffer_size: ACL size module %u -> used %u, count %u / SCO size %u, count %u", 2084429122ccSMatthias Ringwald acl_len, hci_stack->acl_data_packet_length, hci_stack->acl_packets_total_num, 20851a06f663S[email protected] hci_stack->sco_data_packet_length, hci_stack->sco_packets_total_num); 2086c3b46f5aSMatthias Ringwald } 2087645b7c25SMatthias Ringwald break; 2088645b7c25SMatthias Ringwald case HCI_OPCODE_HCI_READ_RSSI: 2089645b7c25SMatthias Ringwald if (packet[5] == ERROR_CODE_SUCCESS){ 2090891b9fc2SMatthias Ringwald uint8_t event[5]; 2091891b9fc2SMatthias Ringwald event[0] = GAP_EVENT_RSSI_MEASUREMENT; 2092891b9fc2SMatthias Ringwald event[1] = 3; 20936535961aSMatthias Ringwald (void)memcpy(&event[2], &packet[6], 3); 2094891b9fc2SMatthias Ringwald hci_emit_event(event, sizeof(event), 1); 2095891b9fc2SMatthias Ringwald } 2096645b7c25SMatthias Ringwald break; 2097a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE 2098645b7c25SMatthias Ringwald case HCI_OPCODE_HCI_LE_READ_BUFFER_SIZE: 2099f8fbdce0SMatthias Ringwald hci_stack->le_data_packets_length = little_endian_read_16(packet, 6); 2100ee303eddS[email protected] hci_stack->le_acl_packets_total_num = packet[8]; 21016c26b087S[email protected] // determine usable ACL payload size 21026c26b087S[email protected] if (HCI_ACL_PAYLOAD_SIZE < hci_stack->le_data_packets_length){ 21036c26b087S[email protected] hci_stack->le_data_packets_length = HCI_ACL_PAYLOAD_SIZE; 21046c26b087S[email protected] } 21059da54300S[email protected] log_info("hci_le_read_buffer_size: size %u, count %u", hci_stack->le_data_packets_length, hci_stack->le_acl_packets_total_num); 2106645b7c25SMatthias Ringwald break; 2107b435e062SMatthias Ringwald #endif 2108b435e062SMatthias Ringwald #ifdef ENABLE_LE_DATA_LENGTH_EXTENSION 2109645b7c25SMatthias Ringwald case HCI_OPCODE_HCI_LE_READ_MAXIMUM_DATA_LENGTH: 2110dcd678baSMatthias Ringwald hci_stack->le_supported_max_tx_octets = little_endian_read_16(packet, 6); 2111dcd678baSMatthias Ringwald hci_stack->le_supported_max_tx_time = little_endian_read_16(packet, 8); 2112dcd678baSMatthias 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); 2113645b7c25SMatthias Ringwald break; 2114b435e062SMatthias Ringwald #endif 2115d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 2116645b7c25SMatthias Ringwald case HCI_OPCODE_HCI_LE_READ_WHITE_LIST_SIZE: 2117e691bb38SMatthias Ringwald hci_stack->le_whitelist_capacity = packet[6]; 211815d0a15bSMatthias Ringwald log_info("hci_le_read_white_list_size: size %u", hci_stack->le_whitelist_capacity); 2119645b7c25SMatthias Ringwald break; 212065a46ef3S[email protected] #endif 2121645b7c25SMatthias Ringwald case HCI_OPCODE_HCI_READ_BD_ADDR: 2122645b7c25SMatthias Ringwald reverse_bd_addr(&packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE + 1], hci_stack->local_bd_addr); 2123645b7c25SMatthias Ringwald log_info("Local Address, Status: 0x%02x: Addr: %s", packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE], bd_addr_to_str(hci_stack->local_bd_addr)); 212433373e40SMatthias Ringwald #ifdef ENABLE_CLASSIC 21251624665aSMatthias Ringwald if (hci_stack->link_key_db){ 21261624665aSMatthias Ringwald hci_stack->link_key_db->set_local_bd_addr(hci_stack->local_bd_addr); 21271624665aSMatthias Ringwald } 212833373e40SMatthias Ringwald #endif 2129645b7c25SMatthias Ringwald break; 213035454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 2131645b7c25SMatthias Ringwald case HCI_OPCODE_HCI_WRITE_SCAN_ENABLE: 21323a9fb326S[email protected] hci_emit_discoverable_enabled(hci_stack->discoverable); 2133645b7c25SMatthias Ringwald break; 2134645b7c25SMatthias Ringwald case HCI_OPCODE_HCI_INQUIRY_CANCEL: 2135f5875de5SMatthias Ringwald if (hci_stack->inquiry_state == GAP_INQUIRY_STATE_W4_CANCELLED){ 2136f5875de5SMatthias Ringwald hci_stack->inquiry_state = GAP_INQUIRY_STATE_IDLE; 2137f5875de5SMatthias Ringwald uint8_t event[] = { GAP_EVENT_INQUIRY_COMPLETE, 1, 0}; 2138f5875de5SMatthias Ringwald hci_emit_event(event, sizeof(event), 1); 2139f5875de5SMatthias Ringwald } 2140645b7c25SMatthias Ringwald break; 214135454696SMatthias Ringwald #endif 2142645b7c25SMatthias Ringwald case HCI_OPCODE_HCI_READ_LOCAL_SUPPORTED_FEATURES: 21434f781026SMatthias Ringwald (void)memcpy(hci_stack->local_supported_features, &packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE + 1], 8); 214465389bfcS[email protected] 214535454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 2146a5a23fc2S[email protected] // determine usable ACL packet types based on host buffer size and supported features 2147a5a23fc2S[email protected] hci_stack->packet_types = hci_acl_packet_types_for_buffer_size_and_local_features(HCI_ACL_PAYLOAD_SIZE, &hci_stack->local_supported_features[0]); 21488b96126aSMatthias Ringwald log_info("Packet types %04x, eSCO %u", hci_stack->packet_types, hci_extended_sco_link_supported()); 214935454696SMatthias Ringwald #endif 2150f5d8d141S[email protected] // Classic/LE 2151f5d8d141S[email protected] log_info("BR/EDR support %u, LE support %u", hci_classic_supported(), hci_le_supported()); 2152645b7c25SMatthias Ringwald break; 2153645b7c25SMatthias Ringwald case HCI_OPCODE_HCI_READ_LOCAL_VERSION_INFORMATION: 2154645b7c25SMatthias Ringwald manufacturer = little_endian_read_16(packet, 10); 2155c21d89f3SMatthias Ringwald // map Cypress to Broadcom 2156c21d89f3SMatthias Ringwald if (manufacturer == BLUETOOTH_COMPANY_ID_CYPRESS_SEMICONDUCTOR){ 2157c21d89f3SMatthias Ringwald log_info("Treat Cypress as Broadcom"); 2158c21d89f3SMatthias Ringwald manufacturer = BLUETOOTH_COMPANY_ID_BROADCOM_CORPORATION; 2159c21d89f3SMatthias Ringwald little_endian_store_16(packet, 10, manufacturer); 2160c21d89f3SMatthias Ringwald } 2161c21d89f3SMatthias Ringwald hci_stack->manufacturer = manufacturer; 21624696bddbSMatthias Ringwald log_info("Manufacturer: 0x%04x", hci_stack->manufacturer); 2163645b7c25SMatthias Ringwald break; 2164645b7c25SMatthias Ringwald case HCI_OPCODE_HCI_READ_LOCAL_SUPPORTED_COMMANDS: 2165a828a756SMatthias Ringwald hci_stack->local_supported_commands[0] = 21664ea43905SMatthias Ringwald ((packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1u+14u] & 0x80u) >> 7u) | // bit 0 = Octet 14, bit 7 / Read Buffer Size 21674ea43905SMatthias Ringwald ((packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1u+24u] & 0x40u) >> 5u) | // bit 1 = Octet 24, bit 6 / Write Le Host Supported 21684ea43905SMatthias Ringwald ((packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1u+10u] & 0x10u) >> 2u) | // bit 2 = Octet 10, bit 4 / Write Synchronous Flow Control Enable 21694ea43905SMatthias Ringwald ((packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1u+18u] & 0x08u) ) | // bit 3 = Octet 18, bit 3 / Write Default Erroneous Data Reporting 21704ea43905SMatthias Ringwald ((packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1u+34u] & 0x01u) << 4u) | // bit 4 = Octet 34, bit 0 / LE Write Suggested Default Data Length 21714ea43905SMatthias Ringwald ((packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1u+35u] & 0x08u) << 2u) | // bit 5 = Octet 35, bit 3 / LE Read Maximum Data Length 21724ea43905SMatthias Ringwald ((packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1u+35u] & 0x20u) << 1u) | // bit 6 = Octet 35, bit 5 / LE Set Default PHY 21734ea43905SMatthias Ringwald ((packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1u+20u] & 0x10u) << 3u); // bit 7 = Octet 20, bit 4 / Read Encryption Key Size 21748d2d8af1SMatthias Ringwald hci_stack->local_supported_commands[1] = 21754ea43905SMatthias Ringwald ((packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1u+ 2u] & 0x40u) >> 6u) | // bit 8 = Octet 2, bit 6 / Read Remote Extended Features 217699b14827SMatthias Ringwald ((packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1u+32u] & 0x08u) >> 2u) | // bit 9 = Octet 32, bit 3 / Write Secure Connections Host 2177f21849cbSMatthias Ringwald ((packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1u+35u] & 0x02u) << 1u) | // bit 10 = Octet 35, bit 1 / LE Set Address Resolution Enable 2178f21849cbSMatthias Ringwald ((packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1u+32u] & 0x02u) << 2u) | // bit 11 = Octet 32, bit 1 / Remote OOB Extended Data Request Reply 2179f21849cbSMatthias Ringwald ((packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1u+32u] & 0x40u) >> 2u); // bit 12 = Octet 32, bit 6 / Read Local OOB Extended Data command 21808d2d8af1SMatthias Ringwald log_info("Local supported commands summary %02x - %02x", hci_stack->local_supported_commands[0], hci_stack->local_supported_commands[1]); 2181645b7c25SMatthias Ringwald break; 2182e8c8828eSMatthias Ringwald #ifdef ENABLE_CLASSIC 2183645b7c25SMatthias Ringwald case HCI_OPCODE_HCI_WRITE_SYNCHRONOUS_FLOW_CONTROL_ENABLE: 21844f781026SMatthias Ringwald if (packet[5]) return; 21855b9b590fSMatthias Ringwald hci_stack->synchronous_flow_control_enabled = 1; 2186645b7c25SMatthias Ringwald break; 2187645b7c25SMatthias Ringwald case HCI_OPCODE_HCI_READ_ENCRYPTION_KEY_SIZE: 2188645b7c25SMatthias Ringwald status = packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE]; 2189573897a0SMatthias Ringwald handle = little_endian_read_16(packet, OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1); 2190573897a0SMatthias Ringwald conn = hci_connection_for_handle(handle); 2191c3b46f5aSMatthias Ringwald if (conn != NULL) { 21929866fdc7SMatthias Ringwald uint8_t key_size = 0; 2193573897a0SMatthias Ringwald if (status == 0){ 21949866fdc7SMatthias Ringwald key_size = packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+3]; 21954a659b0eSMatthias Ringwald log_info("Handle %04x key Size: %u", handle, key_size); 2196170fafaeSMatthias Ringwald } else { 21979866fdc7SMatthias Ringwald log_info("Read Encryption Key Size failed 0x%02x-> assuming insecure connection with key size of 1", status); 2198573897a0SMatthias Ringwald } 21999866fdc7SMatthias Ringwald hci_handle_read_encryption_key_size_complete(conn, key_size); 2200c3b46f5aSMatthias Ringwald } 2201645b7c25SMatthias Ringwald break; 220275a8e4faSMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB 220375a8e4faSMatthias Ringwald case HCI_OPCODE_HCI_READ_LOCAL_OOB_DATA: 220475a8e4faSMatthias Ringwald case HCI_OPCODE_HCI_READ_LOCAL_EXTENDED_OOB_DATA:{ 220575a8e4faSMatthias Ringwald uint8_t event[67]; 220675a8e4faSMatthias Ringwald event[0] = GAP_EVENT_LOCAL_OOB_DATA; 220775a8e4faSMatthias Ringwald event[1] = 65; 220875a8e4faSMatthias Ringwald (void)memset(&event[2], 0, 65); 220975a8e4faSMatthias Ringwald if (packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE] == ERROR_CODE_SUCCESS){ 221075a8e4faSMatthias Ringwald (void)memcpy(&event[3], &packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1], 32); 221175a8e4faSMatthias Ringwald if (opcode == HCI_OPCODE_HCI_READ_LOCAL_EXTENDED_OOB_DATA){ 221275a8e4faSMatthias Ringwald event[2] = 3; 221375a8e4faSMatthias Ringwald (void)memcpy(&event[35], &packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+33], 32); 221475a8e4faSMatthias Ringwald } else { 221575a8e4faSMatthias Ringwald event[2] = 1; 221675a8e4faSMatthias Ringwald } 221775a8e4faSMatthias Ringwald } 221875a8e4faSMatthias Ringwald hci_emit_event(event, sizeof(event), 0); 221975a8e4faSMatthias Ringwald break; 222075a8e4faSMatthias Ringwald } 2221e8c8828eSMatthias Ringwald #endif 222275a8e4faSMatthias Ringwald #endif 22236f35bb46SMatthias Ringwald default: 22246f35bb46SMatthias Ringwald break; 22254f781026SMatthias Ringwald } 2226645b7c25SMatthias Ringwald } 22274f781026SMatthias Ringwald 22280ce3f217SMatthias Ringwald #ifdef ENABLE_BLE 22290ce3f217SMatthias Ringwald static void event_handle_le_connection_complete(const uint8_t * packet){ 22300ce3f217SMatthias Ringwald bd_addr_t addr; 22310ce3f217SMatthias Ringwald bd_addr_type_t addr_type; 22320ce3f217SMatthias Ringwald hci_connection_t * conn; 22330ce3f217SMatthias Ringwald 22340ce3f217SMatthias Ringwald // Connection management 22350ce3f217SMatthias Ringwald reverse_bd_addr(&packet[8], addr); 22360ce3f217SMatthias Ringwald addr_type = (bd_addr_type_t)packet[7]; 22370ce3f217SMatthias Ringwald log_info("LE Connection_complete (status=%u) type %u, %s", packet[3], addr_type, bd_addr_to_str(addr)); 22380ce3f217SMatthias Ringwald conn = hci_connection_for_bd_addr_and_type(addr, addr_type); 22390ce3f217SMatthias Ringwald 22400ce3f217SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 22410ce3f217SMatthias Ringwald // handle error: error is reported only to the initiator -> outgoing connection 22420ce3f217SMatthias Ringwald if (packet[3]){ 22430ce3f217SMatthias Ringwald 22440ce3f217SMatthias Ringwald // handle cancelled outgoing connection 22450ce3f217SMatthias Ringwald // "If the cancellation was successful then, after the Command Complete event for the LE_Create_Connection_Cancel command, 22460ce3f217SMatthias Ringwald // either an LE Connection Complete or an LE Enhanced Connection Complete event shall be generated. 22470ce3f217SMatthias Ringwald // In either case, the event shall be sent with the error code Unknown Connection Identifier (0x02)." 22480ce3f217SMatthias Ringwald if (packet[3] == ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER){ 22490ce3f217SMatthias Ringwald // whitelist connect 22500ce3f217SMatthias Ringwald if (hci_is_le_connection_type(addr_type)){ 22510ce3f217SMatthias Ringwald hci_stack->le_connecting_state = LE_CONNECTING_IDLE; 22520ce3f217SMatthias Ringwald } 22530ce3f217SMatthias Ringwald // get outgoing connection conn struct for direct connect 22540ce3f217SMatthias Ringwald conn = gap_get_outgoing_connection(); 22550ce3f217SMatthias Ringwald } 22560ce3f217SMatthias Ringwald 22570ce3f217SMatthias Ringwald // outgoing le connection establishment is done 22580ce3f217SMatthias Ringwald if (conn){ 22590ce3f217SMatthias Ringwald // remove entry 22600ce3f217SMatthias Ringwald btstack_linked_list_remove(&hci_stack->connections, (btstack_linked_item_t *) conn); 22610ce3f217SMatthias Ringwald btstack_memory_hci_connection_free( conn ); 22620ce3f217SMatthias Ringwald } 22630ce3f217SMatthias Ringwald return; 22640ce3f217SMatthias Ringwald } 22650ce3f217SMatthias Ringwald #endif 22660ce3f217SMatthias Ringwald 22670ce3f217SMatthias Ringwald // on success, both hosts receive connection complete event 22680ce3f217SMatthias Ringwald if (packet[6] == HCI_ROLE_MASTER){ 22690ce3f217SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 22700ce3f217SMatthias Ringwald // if we're master on an le connection, it was an outgoing connection and we're done with it 22710ce3f217SMatthias Ringwald // note: no hci_connection_t object exists yet for connect with whitelist 22720ce3f217SMatthias Ringwald if (hci_is_le_connection_type(addr_type)){ 22730ce3f217SMatthias Ringwald hci_stack->le_connecting_state = LE_CONNECTING_IDLE; 22740ce3f217SMatthias Ringwald hci_stack->le_connecting_request = LE_CONNECTING_IDLE; 22750ce3f217SMatthias Ringwald } 22760ce3f217SMatthias Ringwald #endif 22770ce3f217SMatthias Ringwald } else { 22780ce3f217SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 22790ce3f217SMatthias Ringwald // if we're slave, it was an incoming connection, advertisements have stopped 22800ce3f217SMatthias Ringwald hci_stack->le_advertisements_active = false; 22810ce3f217SMatthias Ringwald #endif 22820ce3f217SMatthias Ringwald } 22830ce3f217SMatthias Ringwald 22840ce3f217SMatthias Ringwald // LE connections are auto-accepted, so just create a connection if there isn't one already 22850ce3f217SMatthias Ringwald if (!conn){ 22860ce3f217SMatthias Ringwald conn = create_connection_for_bd_addr_and_type(addr, addr_type); 22870ce3f217SMatthias Ringwald } 22880ce3f217SMatthias Ringwald 22890ce3f217SMatthias Ringwald // no memory, sorry. 22900ce3f217SMatthias Ringwald if (!conn){ 22910ce3f217SMatthias Ringwald return; 22920ce3f217SMatthias Ringwald } 22930ce3f217SMatthias Ringwald 22940ce3f217SMatthias Ringwald conn->state = OPEN; 22950ce3f217SMatthias Ringwald conn->role = packet[6]; 22960ce3f217SMatthias Ringwald conn->con_handle = hci_subevent_le_connection_complete_get_connection_handle(packet); 22970ce3f217SMatthias Ringwald conn->le_connection_interval = hci_subevent_le_connection_complete_get_conn_interval(packet); 22980ce3f217SMatthias Ringwald 22990ce3f217SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 23000ce3f217SMatthias Ringwald if (packet[6] == HCI_ROLE_SLAVE){ 23010ce3f217SMatthias Ringwald hci_update_advertisements_enabled_for_current_roles(); 23020ce3f217SMatthias Ringwald } 23030ce3f217SMatthias Ringwald #endif 23040ce3f217SMatthias Ringwald 2305dde9ff1eSMatthias Ringwald // init unenhanced att bearer mtu 2306dde9ff1eSMatthias Ringwald conn->att_connection.mtu = ATT_DEFAULT_MTU; 2307dde9ff1eSMatthias Ringwald conn->att_connection.mtu_exchanged = false; 2308dde9ff1eSMatthias Ringwald 23090ce3f217SMatthias Ringwald // TODO: store - role, peer address type, conn_interval, conn_latency, supervision timeout, master clock 23100ce3f217SMatthias Ringwald 23110ce3f217SMatthias Ringwald // restart timer 23120ce3f217SMatthias Ringwald // btstack_run_loop_set_timer(&conn->timeout, HCI_CONNECTION_TIMEOUT_MS); 23130ce3f217SMatthias Ringwald // btstack_run_loop_add_timer(&conn->timeout); 23140ce3f217SMatthias Ringwald 23150ce3f217SMatthias Ringwald log_info("New connection: handle %u, %s", conn->con_handle, bd_addr_to_str(conn->address)); 23160ce3f217SMatthias Ringwald 23170ce3f217SMatthias Ringwald hci_emit_nr_connections_changed(); 23180ce3f217SMatthias Ringwald } 23190ce3f217SMatthias Ringwald #endif 23200ce3f217SMatthias Ringwald 2321c3b46f5aSMatthias Ringwald static void event_handler(uint8_t *packet, uint16_t size){ 23224f781026SMatthias Ringwald 23234f781026SMatthias Ringwald uint16_t event_length = packet[1]; 23244f781026SMatthias Ringwald 23254f781026SMatthias Ringwald // assert packet is complete 23264ea43905SMatthias Ringwald if (size != (event_length + 2u)){ 23274f781026SMatthias Ringwald log_error("event_handler called with packet of wrong size %d, expected %u => dropping packet", size, event_length + 2); 23284f781026SMatthias Ringwald return; 23294f781026SMatthias Ringwald } 23304f781026SMatthias Ringwald 23314f781026SMatthias Ringwald bd_addr_type_t addr_type; 23324f781026SMatthias Ringwald hci_con_handle_t handle; 23334f781026SMatthias Ringwald hci_connection_t * conn; 23344f781026SMatthias Ringwald int i; 23354f781026SMatthias Ringwald int create_connection_cmd; 23364f781026SMatthias Ringwald 23374f781026SMatthias Ringwald #ifdef ENABLE_CLASSIC 23385e91d96cSMatthias Ringwald hci_link_type_t link_type; 233948f33f37SMatthias Ringwald bd_addr_t addr; 23404f781026SMatthias Ringwald #endif 23414f781026SMatthias Ringwald 23424f781026SMatthias Ringwald // log_info("HCI:EVENT:%02x", hci_event_packet_get_type(packet)); 23434f781026SMatthias Ringwald 23444f781026SMatthias Ringwald switch (hci_event_packet_get_type(packet)) { 23454f781026SMatthias Ringwald 23464f781026SMatthias Ringwald case HCI_EVENT_COMMAND_COMPLETE: 23474f781026SMatthias Ringwald handle_command_complete_event(packet, size); 234856cf178bSmatthias.ringwald break; 234956cf178bSmatthias.ringwald 23507ec5eeaaSmatthias.ringwald case HCI_EVENT_COMMAND_STATUS: 23516bef4003SMatthias Ringwald // get num cmd packets - limit to 1 to reduce complexity 23526bef4003SMatthias Ringwald hci_stack->num_cmd_packets = packet[3] ? 1 : 0; 2353229331c6SMatthias Ringwald 2354229331c6SMatthias Ringwald // check command status to detected failed outgoing connections 2355c57fa566SMatthias Ringwald create_connection_cmd = 0; 2356c57fa566SMatthias Ringwald #ifdef ENABLE_CLASSIC 2357c57fa566SMatthias Ringwald if (HCI_EVENT_IS_COMMAND_STATUS(packet, hci_create_connection)){ 2358c57fa566SMatthias Ringwald create_connection_cmd = 1; 2359c57fa566SMatthias Ringwald } 2360c57fa566SMatthias Ringwald #endif 2361c57fa566SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 2362c57fa566SMatthias Ringwald if (HCI_EVENT_IS_COMMAND_STATUS(packet, hci_le_create_connection)){ 2363c57fa566SMatthias Ringwald create_connection_cmd = 1; 2364c57fa566SMatthias Ringwald } 2365c57fa566SMatthias Ringwald #endif 2366c57fa566SMatthias Ringwald if (create_connection_cmd) { 2367229331c6SMatthias Ringwald uint8_t status = hci_event_command_status_get_status(packet); 23688da98cbeSMatthias Ringwald addr_type = hci_stack->outgoing_addr_type; 23696ea9315cSMatthias Ringwald conn = hci_connection_for_bd_addr_and_type(hci_stack->outgoing_addr, addr_type); 23706ea9315cSMatthias Ringwald log_info("command status (create connection), status %x, connection %p, addr %s, type %x", status, conn, bd_addr_to_str(hci_stack->outgoing_addr), addr_type); 2371229331c6SMatthias Ringwald 2372229331c6SMatthias Ringwald // reset outgoing address info 2373229331c6SMatthias Ringwald memset(hci_stack->outgoing_addr, 0, 6); 2374229331c6SMatthias Ringwald hci_stack->outgoing_addr_type = BD_ADDR_TYPE_UNKNOWN; 2375229331c6SMatthias Ringwald 23766ea9315cSMatthias Ringwald // on error 23776ea9315cSMatthias Ringwald if (status != ERROR_CODE_SUCCESS){ 2378f75e06adSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 23796ea9315cSMatthias Ringwald if (hci_is_le_connection_type(addr_type)){ 23806ea9315cSMatthias Ringwald hci_stack->le_connecting_state = LE_CONNECTING_IDLE; 23816ea9315cSMatthias Ringwald } 2382f75e06adSMatthias Ringwald #endif 2383229331c6SMatthias Ringwald // error => outgoing connection failed 23846ea9315cSMatthias Ringwald if (conn != NULL){ 2385229331c6SMatthias Ringwald hci_handle_connection_failed(conn, status); 2386229331c6SMatthias Ringwald } 2387229331c6SMatthias Ringwald } 23886ea9315cSMatthias Ringwald } 2389beb3c81dSMatthias Ringwald 2390beb3c81dSMatthias Ringwald #ifdef ENABLE_CLASSIC 2391beb3c81dSMatthias Ringwald if (HCI_EVENT_IS_COMMAND_STATUS(packet, hci_inquiry)) { 2392beb3c81dSMatthias Ringwald uint8_t status = hci_event_command_status_get_status(packet); 2393beb3c81dSMatthias Ringwald log_info("command status (inquiry), status %x", status); 2394beb3c81dSMatthias Ringwald if (status == ERROR_CODE_SUCCESS) { 2395beb3c81dSMatthias Ringwald hci_stack->inquiry_state = GAP_INQUIRY_STATE_ACTIVE; 2396beb3c81dSMatthias Ringwald } else { 2397beb3c81dSMatthias Ringwald hci_stack->inquiry_state = GAP_INQUIRY_STATE_IDLE; 2398beb3c81dSMatthias Ringwald } 2399beb3c81dSMatthias Ringwald } 2400beb3c81dSMatthias Ringwald #endif 24017ec5eeaaSmatthias.ringwald break; 24027ec5eeaaSmatthias.ringwald 24032e440c8aS[email protected] case HCI_EVENT_NUMBER_OF_COMPLETED_PACKETS:{ 24049784dac1SMatthias Ringwald if (size < 3) return; 24059784dac1SMatthias Ringwald uint16_t num_handles = packet[2]; 24064ea43905SMatthias Ringwald if (size != (3u + num_handles * 4u)) return; 24079784dac1SMatthias Ringwald uint16_t offset = 3; 24089784dac1SMatthias Ringwald for (i=0; i<num_handles;i++){ 24094ea43905SMatthias Ringwald handle = little_endian_read_16(packet, offset) & 0x0fffu; 24104ea43905SMatthias Ringwald offset += 2u; 2411f8fbdce0SMatthias Ringwald uint16_t num_packets = little_endian_read_16(packet, offset); 24124ea43905SMatthias Ringwald offset += 2u; 24132e440c8aS[email protected] 24145061f3afS[email protected] conn = hci_connection_for_handle(handle); 241556cf178bSmatthias.ringwald if (!conn){ 24169da54300S[email protected] log_error("hci_number_completed_packet lists unused con handle %u", handle); 241756cf178bSmatthias.ringwald continue; 241856cf178bSmatthias.ringwald } 241923bed257S[email protected] 2420ce41473eSMatthias Ringwald if (conn->num_packets_sent >= num_packets){ 2421ce41473eSMatthias Ringwald conn->num_packets_sent -= num_packets; 2422e35edcc1S[email protected] } else { 2423ce41473eSMatthias Ringwald log_error("hci_number_completed_packets, more packet slots freed then sent."); 2424ce41473eSMatthias Ringwald conn->num_packets_sent = 0; 2425e35edcc1S[email protected] } 2426ce41473eSMatthias Ringwald // log_info("hci_number_completed_packet %u processed for handle %u, outstanding %u", num_packets, handle, conn->num_packets_sent); 2427760b20efSMatthias Ringwald 2428760b20efSMatthias Ringwald #ifdef ENABLE_CLASSIC 2429760b20efSMatthias Ringwald // For SCO, we do the can_send_now_check here 2430760b20efSMatthias Ringwald hci_notify_if_sco_can_send_now(); 2431760b20efSMatthias Ringwald #endif 243256cf178bSmatthias.ringwald } 24336772a24cSmatthias.ringwald break; 24342e440c8aS[email protected] } 243535454696SMatthias Ringwald 243635454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 2437f5875de5SMatthias Ringwald case HCI_EVENT_INQUIRY_COMPLETE: 2438f5875de5SMatthias Ringwald if (hci_stack->inquiry_state == GAP_INQUIRY_STATE_ACTIVE){ 2439f5875de5SMatthias Ringwald hci_stack->inquiry_state = GAP_INQUIRY_STATE_IDLE; 2440f5875de5SMatthias Ringwald uint8_t event[] = { GAP_EVENT_INQUIRY_COMPLETE, 1, 0}; 2441f5875de5SMatthias Ringwald hci_emit_event(event, sizeof(event), 1); 2442f5875de5SMatthias Ringwald } 2443f5875de5SMatthias Ringwald break; 2444b7f1ee76SMatthias Ringwald case HCI_EVENT_REMOTE_NAME_REQUEST_COMPLETE: 2445b7f1ee76SMatthias Ringwald if (hci_stack->remote_name_state == GAP_REMOTE_NAME_STATE_W4_COMPLETE){ 2446b7f1ee76SMatthias Ringwald hci_stack->remote_name_state = GAP_REMOTE_NAME_STATE_IDLE; 2447b7f1ee76SMatthias Ringwald } 2448b7f1ee76SMatthias Ringwald break; 24491f7b95a1Smatthias.ringwald case HCI_EVENT_CONNECTION_REQUEST: 2450724d70a2SMatthias Ringwald reverse_bd_addr(&packet[2], addr); 24515e91d96cSMatthias Ringwald link_type = (hci_link_type_t) packet[11]; 245207e010b6SMilanka Ringwald if (hci_stack->gap_classic_accept_callback != NULL){ 24535e91d96cSMatthias Ringwald if ((*hci_stack->gap_classic_accept_callback)(addr, link_type) == 0){ 24544536712cSMilanka Ringwald hci_stack->decline_reason = ERROR_CODE_CONNECTION_REJECTED_DUE_TO_UNACCEPTABLE_BD_ADDR; 245507e010b6SMilanka Ringwald bd_addr_copy(hci_stack->decline_addr, addr); 245607e010b6SMilanka Ringwald break; 245707e010b6SMilanka Ringwald } 245807e010b6SMilanka Ringwald } 245907e010b6SMilanka Ringwald 246037eaa4cfSmatthias.ringwald // TODO: eval COD 8-10 24615e91d96cSMatthias Ringwald log_info("Connection_incoming: %s, type %u", bd_addr_to_str(addr), (unsigned int) link_type); 24625e91d96cSMatthias Ringwald addr_type = (link_type == HCI_LINK_TYPE_ACL) ? BD_ADDR_TYPE_ACL : BD_ADDR_TYPE_SCO; 24632e77e513S[email protected] conn = hci_connection_for_bd_addr_and_type(addr, addr_type); 24641f7b95a1Smatthias.ringwald if (!conn) { 24655293c072S[email protected] conn = create_connection_for_bd_addr_and_type(addr, addr_type); 24661f7b95a1Smatthias.ringwald } 2467ce4c8fabSmatthias.ringwald if (!conn) { 2468ce4c8fabSmatthias.ringwald // CONNECTION REJECTED DUE TO LIMITED RESOURCES (0X0D) 24694536712cSMilanka Ringwald hci_stack->decline_reason = ERROR_CODE_CONNECTION_REJECTED_DUE_TO_LIMITED_RESOURCES; 2470058e3d6bSMatthias Ringwald bd_addr_copy(hci_stack->decline_addr, addr); 2471ce4c8fabSmatthias.ringwald break; 2472ce4c8fabSmatthias.ringwald } 24735cf766e8SMatthias Ringwald conn->role = HCI_ROLE_SLAVE; 247432ab9390Smatthias.ringwald conn->state = RECEIVED_CONNECTION_REQUEST; 2475f3a16b9aSMatthias Ringwald // store info about eSCO 24765e91d96cSMatthias Ringwald if (link_type == HCI_LINK_TYPE_ESCO){ 247776ccfb2aSMatthias Ringwald conn->remote_supported_features[0] |= 1; 2478f3a16b9aSMatthias Ringwald } 247932ab9390Smatthias.ringwald hci_run(); 24801f7b95a1Smatthias.ringwald break; 24811f7b95a1Smatthias.ringwald 24826772a24cSmatthias.ringwald case HCI_EVENT_CONNECTION_COMPLETE: 2483fe1ed1b8Smatthias.ringwald // Connection management 2484724d70a2SMatthias Ringwald reverse_bd_addr(&packet[5], addr); 24859da54300S[email protected] log_info("Connection_complete (status=%u) %s", packet[2], bd_addr_to_str(addr)); 2486f16129ceSMatthias Ringwald addr_type = BD_ADDR_TYPE_ACL; 24872e77e513S[email protected] conn = hci_connection_for_bd_addr_and_type(addr, addr_type); 2488fe1ed1b8Smatthias.ringwald if (conn) { 2489b448a0e7Smatthias.ringwald if (!packet[2]){ 2490c8e4258aSmatthias.ringwald conn->state = OPEN; 2491f8fbdce0SMatthias Ringwald conn->con_handle = little_endian_read_16(packet, 3); 24926909f064SMatthias Ringwald 24936909f064SMatthias Ringwald // queue get remote feature 2494ba018746SMatthias Ringwald conn->bonding_flags |= BONDING_REQUEST_REMOTE_FEATURES_PAGE_0; 2495ee091cf1Smatthias.ringwald 2496e6c51921SMatthias Ringwald // queue set supervision timeout if we're master 2497a1df452eSMatthias Ringwald if ((hci_stack->link_supervision_timeout != 0) && (conn->role == HCI_ROLE_MASTER)){ 24986909f064SMatthias Ringwald connectionSetAuthenticationFlags(conn, WRITE_SUPERVISION_TIMEOUT); 24996909f064SMatthias Ringwald } 25006909f064SMatthias Ringwald 2501c785ef68Smatthias.ringwald // restart timer 2502528a4a3bSMatthias Ringwald btstack_run_loop_set_timer(&conn->timeout, HCI_CONNECTION_TIMEOUT_MS); 2503528a4a3bSMatthias Ringwald btstack_run_loop_add_timer(&conn->timeout); 2504c785ef68Smatthias.ringwald 25059da54300S[email protected] log_info("New connection: handle %u, %s", conn->con_handle, bd_addr_to_str(conn->address)); 250643bfb1bdSmatthias.ringwald 250743bfb1bdSmatthias.ringwald hci_emit_nr_connections_changed(); 2508b448a0e7Smatthias.ringwald } else { 25090bbba85bSMatthias Ringwald // connection failed 25100bbba85bSMatthias Ringwald hci_handle_connection_failed(conn, packet[2]); 2511fe1ed1b8Smatthias.ringwald } 2512fe1ed1b8Smatthias.ringwald } 25136772a24cSmatthias.ringwald break; 2514fe1ed1b8Smatthias.ringwald 251544d0e3d5S[email protected] case HCI_EVENT_SYNCHRONOUS_CONNECTION_COMPLETE: 2516724d70a2SMatthias Ringwald reverse_bd_addr(&packet[5], addr); 251744d0e3d5S[email protected] log_info("Synchronous Connection Complete (status=%u) %s", packet[2], bd_addr_to_str(addr)); 25181a06f663S[email protected] if (packet[2]){ 251944d0e3d5S[email protected] // connection failed 252044d0e3d5S[email protected] break; 252144d0e3d5S[email protected] } 25222e77e513S[email protected] conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_SCO); 2523e35edcc1S[email protected] if (!conn) { 2524e35edcc1S[email protected] conn = create_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_SCO); 2525e35edcc1S[email protected] } 2526e35edcc1S[email protected] if (!conn) { 2527e35edcc1S[email protected] break; 2528e35edcc1S[email protected] } 25291a06f663S[email protected] conn->state = OPEN; 2530f8fbdce0SMatthias Ringwald conn->con_handle = little_endian_read_16(packet, 3); 2531ee752bb8SMatthias Ringwald 2532ee752bb8SMatthias Ringwald #ifdef ENABLE_SCO_OVER_HCI 2533ee752bb8SMatthias Ringwald // update SCO 2534ee752bb8SMatthias Ringwald if (conn->address_type == BD_ADDR_TYPE_SCO && hci_stack->hci_transport && hci_stack->hci_transport->set_sco_config){ 2535ee752bb8SMatthias Ringwald hci_stack->hci_transport->set_sco_config(hci_stack->sco_voice_setting_active, hci_number_sco_connections()); 2536ee752bb8SMatthias Ringwald } 2537f234b250SMatthias Ringwald // trigger can send now 2538f234b250SMatthias Ringwald if (hci_have_usb_transport()){ 2539f234b250SMatthias Ringwald hci_stack->sco_can_send_now = 1; 2540f234b250SMatthias Ringwald } 2541ee752bb8SMatthias Ringwald #endif 2542cb70c5abSMatthias Ringwald #ifdef HAVE_SCO_TRANSPORT 2543cb70c5abSMatthias Ringwald // configure sco transport 2544cb70c5abSMatthias Ringwald if (hci_stack->sco_transport != NULL){ 2545cb70c5abSMatthias Ringwald sco_format_t sco_format = ((hci_stack->sco_voice_setting_active & 0x03) == 0x03) ? SCO_FORMAT_8_BIT : SCO_FORMAT_16_BIT; 2546cb70c5abSMatthias Ringwald hci_stack->sco_transport->open(conn->con_handle, sco_format); 2547cb70c5abSMatthias Ringwald } 2548cb70c5abSMatthias Ringwald #endif 254944d0e3d5S[email protected] break; 255044d0e3d5S[email protected] 2551afd4e962S[email protected] case HCI_EVENT_READ_REMOTE_SUPPORTED_FEATURES_COMPLETE: 2552f8fbdce0SMatthias Ringwald handle = little_endian_read_16(packet, 3); 2553afd4e962S[email protected] conn = hci_connection_for_handle(handle); 2554afd4e962S[email protected] if (!conn) break; 2555afd4e962S[email protected] if (!packet[2]){ 25562f5c44baSMatthias Ringwald const uint8_t * features = &packet[5]; 25572f5c44baSMatthias Ringwald hci_handle_remote_features_page_0(conn, features); 25582f5c44baSMatthias Ringwald 25595ccef624SMatthias Ringwald // read extended features if possible 25605ccef624SMatthias Ringwald if (((hci_stack->local_supported_commands[1] & 1) != 0) && ((conn->remote_supported_features[0] & 2) != 0)) { 25615ccef624SMatthias Ringwald conn->bonding_flags |= BONDING_REQUEST_REMOTE_FEATURES_PAGE_1; 25625ccef624SMatthias Ringwald break; 25635ccef624SMatthias Ringwald } 25645ccef624SMatthias Ringwald } 25655ccef624SMatthias Ringwald hci_handle_remote_features_received(conn); 25665ccef624SMatthias Ringwald break; 25675ccef624SMatthias Ringwald 25685ccef624SMatthias Ringwald case HCI_EVENT_READ_REMOTE_EXTENDED_FEATURES_COMPLETE: 25695ccef624SMatthias Ringwald handle = little_endian_read_16(packet, 3); 25705ccef624SMatthias Ringwald conn = hci_connection_for_handle(handle); 25715ccef624SMatthias Ringwald if (!conn) break; 25725ccef624SMatthias Ringwald // status = ok, page = 1 257350c51a77SMatthias Ringwald if (!packet[2]) { 257450c51a77SMatthias Ringwald uint8_t page_number = packet[5]; 257550c51a77SMatthias Ringwald uint8_t maximum_page_number = packet[6]; 25765ccef624SMatthias Ringwald const uint8_t * features = &packet[7]; 257750c51a77SMatthias Ringwald bool done = false; 257850c51a77SMatthias Ringwald switch (page_number){ 257950c51a77SMatthias Ringwald case 1: 25802f5c44baSMatthias Ringwald hci_handle_remote_features_page_1(conn, features); 258150c51a77SMatthias Ringwald if (maximum_page_number >= 2){ 258250c51a77SMatthias Ringwald // get Secure Connections (Controller) from Page 2 if available 258350c51a77SMatthias Ringwald conn->bonding_flags |= BONDING_REQUEST_REMOTE_FEATURES_PAGE_2; 258450c51a77SMatthias Ringwald } else { 258550c51a77SMatthias Ringwald // otherwise, assume SC (Controller) == SC (Host) 258650c51a77SMatthias Ringwald if ((conn->bonding_flags & BONDING_REMOTE_SUPPORTS_SC_HOST) != 0){ 258750c51a77SMatthias Ringwald conn->bonding_flags |= BONDING_REMOTE_SUPPORTS_SC_CONTROLLER; 258850c51a77SMatthias Ringwald } 258950c51a77SMatthias Ringwald done = true; 259050c51a77SMatthias Ringwald } 259150c51a77SMatthias Ringwald break; 259250c51a77SMatthias Ringwald case 2: 259350c51a77SMatthias Ringwald hci_handle_remote_features_page_2(conn, features); 259450c51a77SMatthias Ringwald done = true; 259550c51a77SMatthias Ringwald break; 259650c51a77SMatthias Ringwald default: 259750c51a77SMatthias Ringwald break; 259850c51a77SMatthias Ringwald } 259950c51a77SMatthias Ringwald if (!done) break; 2600afd4e962S[email protected] } 2601de0df013SMatthias Ringwald hci_handle_remote_features_received(conn); 2602afd4e962S[email protected] break; 2603afd4e962S[email protected] 26047fde4af9Smatthias.ringwald case HCI_EVENT_LINK_KEY_REQUEST: 26059da54300S[email protected] log_info("HCI_EVENT_LINK_KEY_REQUEST"); 26067fde4af9Smatthias.ringwald hci_add_connection_flags_for_flipped_bd_addr(&packet[2], RECV_LINK_KEY_REQUEST); 2607608f51bbSMatthias Ringwald // request handled by hci_run() 260832ab9390Smatthias.ringwald hci_add_connection_flags_for_flipped_bd_addr(&packet[2], HANDLE_LINK_KEY_REQUEST); 2609608f51bbSMatthias Ringwald break; 26107fde4af9Smatthias.ringwald 26119ab95c90S[email protected] case HCI_EVENT_LINK_KEY_NOTIFICATION: { 2612724d70a2SMatthias Ringwald reverse_bd_addr(&packet[2], addr); 2613f16129ceSMatthias Ringwald conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL); 26149ab95c90S[email protected] if (!conn) break; 26159ab95c90S[email protected] conn->authentication_flags |= RECV_LINK_KEY_NOTIFICATION; 26167bdc6798S[email protected] link_key_type_t link_key_type = (link_key_type_t)packet[24]; 26179ab95c90S[email protected] // Change Connection Encryption keeps link key type 26189ab95c90S[email protected] if (link_key_type != CHANGED_COMBINATION_KEY){ 26199ab95c90S[email protected] conn->link_key_type = link_key_type; 26209ab95c90S[email protected] } 262155597469SMatthias Ringwald gap_store_link_key_for_bd_addr(addr, &packet[8], conn->link_key_type); 262229d53098Smatthias.ringwald // still forward event to allow dismiss of pairing dialog 26237fde4af9Smatthias.ringwald break; 26249ab95c90S[email protected] } 26257fde4af9Smatthias.ringwald 26267fde4af9Smatthias.ringwald case HCI_EVENT_PIN_CODE_REQUEST: 26276724cd9eS[email protected] hci_add_connection_flags_for_flipped_bd_addr(&packet[2], LEGACY_PAIRING_ACTIVE); 26284c57c146S[email protected] // non-bondable mode: pin code negative reply will be sent 26293a9fb326S[email protected] if (!hci_stack->bondable){ 2630899283eaS[email protected] hci_add_connection_flags_for_flipped_bd_addr(&packet[2], DENY_PIN_CODE_REQUEST); 2631f8fb5f6eS[email protected] hci_run(); 2632f8fb5f6eS[email protected] return; 26334c57c146S[email protected] } 2634d9a327f9Smatthias.ringwald // PIN CODE REQUEST means the link key request didn't succee -> delete stored link key 2635a98592bcSMatthias Ringwald if (!hci_stack->link_key_db) break; 2636a6ef64baSMilanka Ringwald hci_event_pin_code_request_get_bd_addr(packet, addr); 2637a98592bcSMatthias Ringwald hci_stack->link_key_db->delete_link_key(addr); 26387fde4af9Smatthias.ringwald break; 26397fde4af9Smatthias.ringwald 26401d6b20aeS[email protected] case HCI_EVENT_IO_CAPABILITY_REQUEST: 26411d6b20aeS[email protected] hci_add_connection_flags_for_flipped_bd_addr(&packet[2], RECV_IO_CAPABILITIES_REQUEST); 264211b03efaSMatthias Ringwald log_info("IO Capability Request received, stack bondable %u, io cap %u", hci_stack->bondable, hci_stack->ssp_io_capability); 264344565b0cSMatthias Ringwald #ifndef ENABLE_EXPLICIT_IO_CAPABILITIES_REPLY 264411b03efaSMatthias Ringwald if (hci_stack->bondable && (hci_stack->ssp_io_capability != SSP_IO_CAPABILITY_UNKNOWN)){ 2645dbe1a790S[email protected] hci_add_connection_flags_for_flipped_bd_addr(&packet[2], SEND_IO_CAPABILITIES_REPLY); 264611b03efaSMatthias Ringwald } else { 264711b03efaSMatthias Ringwald hci_add_connection_flags_for_flipped_bd_addr(&packet[2], SEND_IO_CAPABILITIES_NEGATIVE_REPLY); 264811b03efaSMatthias Ringwald } 264944565b0cSMatthias Ringwald #endif 2650dbe1a790S[email protected] break; 2651dbe1a790S[email protected] 26521849becdSMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB 26531849becdSMatthias Ringwald case HCI_EVENT_REMOTE_OOB_DATA_REQUEST: 26541849becdSMatthias Ringwald hci_add_connection_flags_for_flipped_bd_addr(&packet[2], SSP_PAIRING_ACTIVE); 26551849becdSMatthias Ringwald hci_add_connection_flags_for_flipped_bd_addr(&packet[2], SEND_REMOTE_OOB_DATA_REPLY); 26561849becdSMatthias Ringwald break; 26571849becdSMatthias Ringwald #endif 26581849becdSMatthias Ringwald 2659dbe1a790S[email protected] case HCI_EVENT_USER_CONFIRMATION_REQUEST: 26606724cd9eS[email protected] hci_add_connection_flags_for_flipped_bd_addr(&packet[2], SSP_PAIRING_ACTIVE); 26613a9fb326S[email protected] if (!hci_stack->ssp_auto_accept) break; 2662dbe1a790S[email protected] hci_add_connection_flags_for_flipped_bd_addr(&packet[2], SEND_USER_CONFIRM_REPLY); 2663dbe1a790S[email protected] break; 2664dbe1a790S[email protected] 2665dbe1a790S[email protected] case HCI_EVENT_USER_PASSKEY_REQUEST: 26666724cd9eS[email protected] hci_add_connection_flags_for_flipped_bd_addr(&packet[2], SSP_PAIRING_ACTIVE); 26673a9fb326S[email protected] if (!hci_stack->ssp_auto_accept) break; 2668dbe1a790S[email protected] hci_add_connection_flags_for_flipped_bd_addr(&packet[2], SEND_USER_PASSKEY_REPLY); 26691d6b20aeS[email protected] break; 26701849becdSMatthias Ringwald 26713dce6128SMatthias Ringwald case HCI_EVENT_MODE_CHANGE: 26723dce6128SMatthias Ringwald handle = hci_event_mode_change_get_handle(packet); 26733dce6128SMatthias Ringwald conn = hci_connection_for_handle(handle); 26743dce6128SMatthias Ringwald if (!conn) break; 26753dce6128SMatthias Ringwald conn->connection_mode = hci_event_mode_change_get_mode(packet); 26763dce6128SMatthias Ringwald log_info("HCI_EVENT_MODE_CHANGE, handle 0x%04x, mode %u", handle, conn->connection_mode); 26773dce6128SMatthias Ringwald break; 267835454696SMatthias Ringwald #endif 26791d6b20aeS[email protected] 2680f0944df2S[email protected] case HCI_EVENT_ENCRYPTION_CHANGE: 2681254b78eeSMatthias Ringwald handle = hci_event_encryption_change_get_connection_handle(packet); 2682f0944df2S[email protected] conn = hci_connection_for_handle(handle); 2683f0944df2S[email protected] if (!conn) break; 26844ea43905SMatthias Ringwald if (hci_event_encryption_change_get_status(packet) == 0u) { 2685254b78eeSMatthias Ringwald uint8_t encryption_enabled = hci_event_encryption_change_get_encryption_enabled(packet); 2686254b78eeSMatthias Ringwald if (encryption_enabled){ 2687573897a0SMatthias Ringwald if (hci_is_le_connection(conn)){ 2688573897a0SMatthias Ringwald // For LE, we accept connection as encrypted 2689f0944df2S[email protected] conn->authentication_flags |= CONNECTION_ENCRYPTED; 2690573897a0SMatthias Ringwald } 2691573897a0SMatthias Ringwald #ifdef ENABLE_CLASSIC 2692573897a0SMatthias Ringwald else { 2693254b78eeSMatthias Ringwald // Detect Secure Connection -> Legacy Connection Downgrade Attack (BIAS) 2694254b78eeSMatthias Ringwald bool sc_used_during_pairing = gap_secure_connection_for_link_key_type(conn->link_key_type) != 0; 2695254b78eeSMatthias Ringwald bool connected_uses_aes_ccm = encryption_enabled == 2; 2696edc1ac20SMatthias Ringwald if (hci_stack->secure_connections_active && sc_used_during_pairing && !connected_uses_aes_ccm){ 2697254b78eeSMatthias Ringwald log_info("SC during pairing, but only E0 now -> abort"); 26989ece71c2SMatthias Ringwald conn->bonding_flags |= BONDING_DISCONNECT_SECURITY_BLOCK; 2699254b78eeSMatthias Ringwald break; 2700254b78eeSMatthias Ringwald } 2701254b78eeSMatthias Ringwald 27024a659b0eSMatthias Ringwald // if AES-CCM is used, authentication used SC -> authentication was mutual and we can skip explicit authentication 2703378d29b4SMatthias Ringwald if (connected_uses_aes_ccm){ 27044a659b0eSMatthias Ringwald conn->authentication_flags |= CONNECTION_AUTHENTICATED; 2705378d29b4SMatthias Ringwald } 27064a659b0eSMatthias Ringwald 27076e058d3fSMatthias Ringwald if ((hci_stack->local_supported_commands[0] & 0x80) != 0){ 27086e058d3fSMatthias Ringwald // For Classic, we need to validate encryption key size first, if possible (== supported by Controller) 2709573897a0SMatthias Ringwald conn->bonding_flags |= BONDING_SEND_READ_ENCRYPTION_KEY_SIZE; 27106e058d3fSMatthias Ringwald } else { 27116e058d3fSMatthias Ringwald // if not, pretend everything is perfect 27129866fdc7SMatthias Ringwald hci_handle_read_encryption_key_size_complete(conn, 16); 27136e058d3fSMatthias Ringwald } 2714573897a0SMatthias Ringwald } 2715573897a0SMatthias Ringwald #endif 2716f0944df2S[email protected] } else { 2717536f9994S[email protected] conn->authentication_flags &= ~CONNECTION_ENCRYPTED; 2718f0944df2S[email protected] } 2719ad83dc6aS[email protected] } 2720573897a0SMatthias Ringwald 2721f0944df2S[email protected] break; 2722f0944df2S[email protected] 272335454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 27241eb2563eS[email protected] case HCI_EVENT_AUTHENTICATION_COMPLETE_EVENT: 2725abdad579SMatthias Ringwald handle = hci_event_authentication_complete_get_connection_handle(packet); 27261eb2563eS[email protected] conn = hci_connection_for_handle(handle); 27271eb2563eS[email protected] if (!conn) break; 2728ad83dc6aS[email protected] 272963fc2b30SMatthias Ringwald // ignore authentication event if we didn't request it 273063fc2b30SMatthias Ringwald if ((conn->bonding_flags & BONDING_SENT_AUTHENTICATE_REQUEST) == 0) break; 273163fc2b30SMatthias Ringwald 2732ad83dc6aS[email protected] // dedicated bonding: send result and disconnect 2733ad83dc6aS[email protected] if (conn->bonding_flags & BONDING_DEDICATED){ 2734ad83dc6aS[email protected] conn->bonding_flags &= ~BONDING_DEDICATED; 2735ad83dc6aS[email protected] conn->bonding_flags |= BONDING_DISCONNECT_DEDICATED_DONE; 27361bd5283dS[email protected] conn->bonding_status = packet[2]; 2737ad83dc6aS[email protected] break; 2738ad83dc6aS[email protected] } 2739ad83dc6aS[email protected] 2740abdad579SMatthias Ringwald // authenticated only if auth status == 0 2741abdad579SMatthias Ringwald if (hci_event_authentication_complete_get_status(packet) == 0){ 2742abdad579SMatthias Ringwald // authenticated 2743abdad579SMatthias Ringwald conn->authentication_flags |= CONNECTION_AUTHENTICATED; 2744abdad579SMatthias Ringwald 2745abdad579SMatthias Ringwald // If link key sufficient for requested security and not already encrypted, start encryption 2746abdad579SMatthias Ringwald if (((gap_security_level_for_link_key_type(conn->link_key_type) >= conn->requested_security_level)) && 2747abdad579SMatthias Ringwald ((conn->authentication_flags & CONNECTION_ENCRYPTED) == 0)){ 27481eb2563eS[email protected] conn->bonding_flags |= BONDING_SEND_ENCRYPTION_REQUEST; 2749ad83dc6aS[email protected] break; 2750ad83dc6aS[email protected] } 2751abdad579SMatthias Ringwald } 2752abdad579SMatthias Ringwald 2753abdad579SMatthias Ringwald // emit updated security level 27541eb2563eS[email protected] hci_emit_security_level(handle, gap_security_level_for_connection(conn)); 27551eb2563eS[email protected] break; 275635454696SMatthias Ringwald #endif 275734d2123cS[email protected] 275886805605S[email protected] // HCI_EVENT_DISCONNECTION_COMPLETE 2759ccda6e14S[email protected] // has been split, to first notify stack before shutting connection down 2760ccda6e14S[email protected] // see end of function, too. 2761a4f30ec0S[email protected] case HCI_EVENT_DISCONNECTION_COMPLETE: 2762a4f30ec0S[email protected] if (packet[2]) break; // status != 0 2763f8fbdce0SMatthias Ringwald handle = little_endian_read_16(packet, 3); 276481d2bdb2SMatthias Ringwald // drop outgoing ACL fragments if it is for closed connection and release buffer if tx not active 27654ea43905SMatthias Ringwald if (hci_stack->acl_fragmentation_total_size > 0u) { 2766c6a37cfdSMatthias Ringwald if (handle == READ_ACL_CONNECTION_HANDLE(hci_stack->hci_packet_buffer)){ 27674ea43905SMatthias Ringwald int release_buffer = hci_stack->acl_fragmentation_tx_active == 0u; 276881d2bdb2SMatthias Ringwald log_info("drop fragmented ACL data for closed connection, release buffer %u", release_buffer); 2769c6a37cfdSMatthias Ringwald hci_stack->acl_fragmentation_total_size = 0; 2770c6a37cfdSMatthias Ringwald hci_stack->acl_fragmentation_pos = 0; 277181d2bdb2SMatthias Ringwald if (release_buffer){ 277281d2bdb2SMatthias Ringwald hci_release_packet_buffer(); 277381d2bdb2SMatthias Ringwald } 2774c6a37cfdSMatthias Ringwald } 2775c6a37cfdSMatthias Ringwald } 277635454696SMatthias Ringwald 2777c6a37cfdSMatthias Ringwald conn = hci_connection_for_handle(handle); 2778c6a37cfdSMatthias Ringwald if (!conn) break; 2779046ec007SMatthias Ringwald // mark connection for shutdown 2780a70e17d4SMatthias Ringwald conn->state = RECEIVED_DISCONNECTION_COMPLETE; 2781046ec007SMatthias Ringwald 2782046ec007SMatthias Ringwald // emit dedicatd bonding event 2783046ec007SMatthias Ringwald if (conn->bonding_flags & BONDING_EMIT_COMPLETE_ON_DISCONNECT){ 2784046ec007SMatthias Ringwald hci_emit_dedicated_bonding_result(conn->address, conn->bonding_status); 2785046ec007SMatthias Ringwald } 2786046ec007SMatthias Ringwald 278735454696SMatthias Ringwald #ifdef ENABLE_BLE 2788d70217a2SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 2789046ec007SMatthias Ringwald // re-enable advertisements for le connections if active 27902b6ab3e6SMatthias Ringwald if (hci_is_le_connection(conn)){ 2791bbc366e6SMatthias Ringwald hci_update_advertisements_enabled_for_current_roles(); 27929a2e4658SMatthias Ringwald } 279335454696SMatthias Ringwald #endif 2794d70217a2SMatthias Ringwald #endif 2795ccda6e14S[email protected] break; 27966772a24cSmatthias.ringwald 2797c68bdf90Smatthias.ringwald case HCI_EVENT_HARDWARE_ERROR: 2798313e5f9cSMatthias Ringwald log_error("Hardware Error: 0x%02x", packet[2]); 2799d23838ecSMatthias Ringwald if (hci_stack->hardware_error_callback){ 2800c2e1fa60SMatthias Ringwald (*hci_stack->hardware_error_callback)(packet[2]); 28017586ee35S[email protected] } else { 28027586ee35S[email protected] // if no special requests, just reboot stack 28037586ee35S[email protected] hci_power_control_off(); 28047586ee35S[email protected] hci_power_control_on(); 2805c68bdf90Smatthias.ringwald } 2806c68bdf90Smatthias.ringwald break; 2807c68bdf90Smatthias.ringwald 28080e6f3837SMatthias Ringwald #ifdef ENABLE_CLASSIC 28095cf766e8SMatthias Ringwald case HCI_EVENT_ROLE_CHANGE: 28105cf766e8SMatthias Ringwald if (packet[2]) break; // status != 0 2811c4c88f1bSJakob Krantz reverse_bd_addr(&packet[3], addr); 2812f16129ceSMatthias Ringwald addr_type = BD_ADDR_TYPE_ACL; 2813c4c88f1bSJakob Krantz conn = hci_connection_for_bd_addr_and_type(addr, addr_type); 2814c4c88f1bSJakob Krantz if (!conn) break; 28155cf766e8SMatthias Ringwald conn->role = packet[9]; 28165cf766e8SMatthias Ringwald break; 28170e6f3837SMatthias Ringwald #endif 28185cf766e8SMatthias Ringwald 281963fa3374SMatthias Ringwald case HCI_EVENT_TRANSPORT_PACKET_SENT: 2820d051460cS[email protected] // release packet buffer only for asynchronous transport and if there are not further fragements 28214fa24b5fS[email protected] if (hci_transport_synchronous()) { 282263fa3374SMatthias Ringwald log_error("Synchronous HCI Transport shouldn't send HCI_EVENT_TRANSPORT_PACKET_SENT"); 28234fa24b5fS[email protected] return; // instead of break: to avoid re-entering hci_run() 28244fa24b5fS[email protected] } 282581d2bdb2SMatthias Ringwald hci_stack->acl_fragmentation_tx_active = 0; 2826d051460cS[email protected] if (hci_stack->acl_fragmentation_total_size) break; 2827d051460cS[email protected] hci_release_packet_buffer(); 2828701e3307SMatthias Ringwald 282963fa3374SMatthias Ringwald // L2CAP receives this event via the hci_emit_event below 283063fa3374SMatthias Ringwald 283135454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 283263fa3374SMatthias Ringwald // For SCO, we do the can_send_now_check here 2833701e3307SMatthias Ringwald hci_notify_if_sco_can_send_now(); 283435454696SMatthias Ringwald #endif 28356b4af23dS[email protected] break; 28366b4af23dS[email protected] 283735454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 283863fa3374SMatthias Ringwald case HCI_EVENT_SCO_CAN_SEND_NOW: 283963fa3374SMatthias Ringwald // For SCO, we do the can_send_now_check here 2840f234b250SMatthias Ringwald hci_stack->sco_can_send_now = 1; 284163fa3374SMatthias Ringwald hci_notify_if_sco_can_send_now(); 284263fa3374SMatthias Ringwald return; 28431cfb383eSMatthias Ringwald 28441cfb383eSMatthias Ringwald // explode inquriy results for easier consumption 28451cfb383eSMatthias Ringwald case HCI_EVENT_INQUIRY_RESULT: 28461cfb383eSMatthias Ringwald case HCI_EVENT_INQUIRY_RESULT_WITH_RSSI: 28471cfb383eSMatthias Ringwald case HCI_EVENT_EXTENDED_INQUIRY_RESPONSE: 28489784dac1SMatthias Ringwald gap_inquiry_explode(packet, size); 28491cfb383eSMatthias Ringwald break; 285035454696SMatthias Ringwald #endif 285163fa3374SMatthias Ringwald 2852a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE 28535909f7f2Smatthias.ringwald case HCI_EVENT_LE_META: 28545909f7f2Smatthias.ringwald switch (packet[2]){ 2855d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 285657c9da5bS[email protected] case HCI_SUBEVENT_LE_ADVERTISING_REPORT: 28574f4e0224SMatthias Ringwald // log_info("advertising report received"); 28586fab74dbSMatthias Ringwald if (!hci_stack->le_scanning_enabled) break; 285957c9da5bS[email protected] le_handle_advertisement_report(packet, size); 28607bdc6798S[email protected] break; 2861d70217a2SMatthias Ringwald #endif 28625909f7f2Smatthias.ringwald case HCI_SUBEVENT_LE_CONNECTION_COMPLETE: 28630ce3f217SMatthias Ringwald event_handle_le_connection_complete(packet); 28645909f7f2Smatthias.ringwald break; 28655909f7f2Smatthias.ringwald 2866f8fbdce0SMatthias Ringwald // log_info("LE buffer size: %u, count %u", little_endian_read_16(packet,6), packet[8]); 2867c9db5c21SMilanka Ringwald case HCI_SUBEVENT_LE_CONNECTION_UPDATE_COMPLETE: 2868c9db5c21SMilanka Ringwald handle = hci_subevent_le_connection_update_complete_get_connection_handle(packet); 2869c9db5c21SMilanka Ringwald conn = hci_connection_for_handle(handle); 2870c9db5c21SMilanka Ringwald if (!conn) break; 2871c9db5c21SMilanka Ringwald conn->le_connection_interval = hci_subevent_le_connection_update_complete_get_conn_interval(packet); 2872c9db5c21SMilanka Ringwald break; 287365a46ef3S[email protected] 287473cd8a2aSMatthias Ringwald case HCI_SUBEVENT_LE_REMOTE_CONNECTION_PARAMETER_REQUEST: 287573cd8a2aSMatthias Ringwald // connection 287673cd8a2aSMatthias Ringwald handle = hci_subevent_le_remote_connection_parameter_request_get_connection_handle(packet); 287773cd8a2aSMatthias Ringwald conn = hci_connection_for_handle(handle); 287873cd8a2aSMatthias Ringwald if (conn) { 287973cd8a2aSMatthias Ringwald // read arguments 288073cd8a2aSMatthias Ringwald uint16_t le_conn_interval_min = hci_subevent_le_remote_connection_parameter_request_get_interval_min(packet); 288173cd8a2aSMatthias Ringwald uint16_t le_conn_interval_max = hci_subevent_le_remote_connection_parameter_request_get_interval_max(packet); 288273cd8a2aSMatthias Ringwald uint16_t le_conn_latency = hci_subevent_le_remote_connection_parameter_request_get_latency(packet); 288373cd8a2aSMatthias Ringwald uint16_t le_supervision_timeout = hci_subevent_le_remote_connection_parameter_request_get_timeout(packet); 288473cd8a2aSMatthias Ringwald 288573cd8a2aSMatthias Ringwald // validate against current connection parameter range 288673cd8a2aSMatthias Ringwald le_connection_parameter_range_t existing_range; 288773cd8a2aSMatthias Ringwald gap_get_connection_parameter_range(&existing_range); 288873cd8a2aSMatthias 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); 288973cd8a2aSMatthias Ringwald if (update_parameter){ 289073cd8a2aSMatthias Ringwald conn->le_con_parameter_update_state = CON_PARAMETER_UPDATE_REPLY; 289173cd8a2aSMatthias Ringwald conn->le_conn_interval_min = le_conn_interval_min; 289273cd8a2aSMatthias Ringwald conn->le_conn_interval_max = le_conn_interval_max; 289373cd8a2aSMatthias Ringwald conn->le_conn_latency = le_conn_latency; 289473cd8a2aSMatthias Ringwald conn->le_supervision_timeout = le_supervision_timeout; 289573cd8a2aSMatthias Ringwald } else { 2896c3898ca4SMatthias Ringwald conn->le_con_parameter_update_state = CON_PARAMETER_UPDATE_NEGATIVE_REPLY; 289773cd8a2aSMatthias Ringwald } 289873cd8a2aSMatthias Ringwald } 289973cd8a2aSMatthias Ringwald break; 29000f3b27c5SMatthias Ringwald #ifdef ENABLE_LE_LIMIT_ACL_FRAGMENT_BY_MAX_OCTETS 29010f3b27c5SMatthias Ringwald case HCI_SUBEVENT_LE_DATA_LENGTH_CHANGE: 29020f3b27c5SMatthias Ringwald handle = hci_subevent_le_data_length_change_get_connection_handle(packet); 29030f3b27c5SMatthias Ringwald conn = hci_connection_for_handle(handle); 29040f3b27c5SMatthias Ringwald if (conn) { 29050f3b27c5SMatthias Ringwald conn->le_max_tx_octets = hci_subevent_le_data_length_change_get_max_tx_octets(packet); 29060f3b27c5SMatthias Ringwald } 29070f3b27c5SMatthias Ringwald break; 29080f3b27c5SMatthias Ringwald #endif 29095909f7f2Smatthias.ringwald default: 29105909f7f2Smatthias.ringwald break; 29115909f7f2Smatthias.ringwald } 29125909f7f2Smatthias.ringwald break; 29135909f7f2Smatthias.ringwald #endif 29140b36101dSMatthias Ringwald case HCI_EVENT_VENDOR_SPECIFIC: 29150b36101dSMatthias Ringwald // Vendor specific commands often create vendor specific event instead of num completed packets 29160b36101dSMatthias Ringwald // To avoid getting stuck as num_cmds_packets is zero, reset it to 1 for controllers with this behaviour 29170b36101dSMatthias Ringwald switch (hci_stack->manufacturer){ 29180b36101dSMatthias Ringwald case BLUETOOTH_COMPANY_ID_CAMBRIDGE_SILICON_RADIO: 29190b36101dSMatthias Ringwald hci_stack->num_cmd_packets = 1; 29200b36101dSMatthias Ringwald break; 29210b36101dSMatthias Ringwald default: 29220b36101dSMatthias Ringwald break; 29230b36101dSMatthias Ringwald } 29240b36101dSMatthias Ringwald break; 29256772a24cSmatthias.ringwald default: 29266772a24cSmatthias.ringwald break; 2927fe1ed1b8Smatthias.ringwald } 2928fe1ed1b8Smatthias.ringwald 292967c6c9dcSMatthias Ringwald handle_event_for_current_stack_state(packet, size); 293089db417bSmatthias.ringwald 293186805605S[email protected] // notify upper stack 2932d6b06661SMatthias Ringwald hci_emit_event(packet, size, 0); // don't dump, already happened in packet handler 293394ab26f8Smatthias.ringwald 293486805605S[email protected] // moved here to give upper stack a chance to close down everything with hci_connection_t intact 2935797b2a3fSMatthias Ringwald if ((hci_event_packet_get_type(packet) == HCI_EVENT_DISCONNECTION_COMPLETE) && (packet[2] == 0)){ 2936f8fbdce0SMatthias Ringwald handle = little_endian_read_16(packet, 3); 293705ae8de3SMatthias Ringwald hci_connection_t * aConn = hci_connection_for_handle(handle); 2938046ec007SMatthias Ringwald // discard connection if app did not trigger a reconnect in the event handler 2939797b2a3fSMatthias Ringwald if (aConn && aConn->state == RECEIVED_DISCONNECTION_COMPLETE){ 294005ae8de3SMatthias Ringwald hci_shutdown_connection(aConn); 2941b0136355SMatthias Ringwald } 294286805605S[email protected] } 294386805605S[email protected] 294494ab26f8Smatthias.ringwald // execute main loop 294594ab26f8Smatthias.ringwald hci_run(); 294616833f0aSmatthias.ringwald } 294716833f0aSmatthias.ringwald 294835454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 29496f28d2eeSMatthias Ringwald 29506be3cf7fSMatthias Ringwald #ifdef ENABLE_SCO_OVER_HCI 29516f28d2eeSMatthias Ringwald static void sco_tx_timeout_handler(btstack_timer_source_t * ts); 29526f28d2eeSMatthias Ringwald static void sco_schedule_tx(hci_connection_t * conn); 29536f28d2eeSMatthias Ringwald 29546f28d2eeSMatthias Ringwald static void sco_tx_timeout_handler(btstack_timer_source_t * ts){ 295559c33575SMatthias Ringwald log_debug("SCO TX Timeout"); 29565a6b2dbdSMatthias Ringwald hci_con_handle_t con_handle = (hci_con_handle_t) (uintptr_t) btstack_run_loop_get_timer_context(ts); 29576f28d2eeSMatthias Ringwald hci_connection_t * conn = hci_connection_for_handle(con_handle); 29586f28d2eeSMatthias Ringwald if (!conn) return; 29596f28d2eeSMatthias Ringwald 2960afaddd67SMatthias Ringwald // trigger send 2961afaddd67SMatthias Ringwald conn->sco_tx_ready = 1; 2962e4157653SMatthias Ringwald // extra packet if CVSD but SCO buffer is too short 2963a1df452eSMatthias Ringwald if (((hci_stack->sco_voice_setting_active & 0x03) != 0x03) && (hci_stack->sco_data_packet_length < 123)){ 2964e4157653SMatthias Ringwald conn->sco_tx_ready++; 2965e4157653SMatthias Ringwald } 2966afaddd67SMatthias Ringwald hci_notify_if_sco_can_send_now(); 29676f28d2eeSMatthias Ringwald } 29686f28d2eeSMatthias Ringwald 296959c33575SMatthias Ringwald 297059c33575SMatthias Ringwald #define SCO_TX_AFTER_RX_MS (6) 297159c33575SMatthias Ringwald 29726f28d2eeSMatthias Ringwald static void sco_schedule_tx(hci_connection_t * conn){ 297359c33575SMatthias Ringwald 29746f28d2eeSMatthias Ringwald uint32_t now = btstack_run_loop_get_time_ms(); 297559c33575SMatthias Ringwald uint32_t sco_tx_ms = conn->sco_rx_ms + SCO_TX_AFTER_RX_MS; 297659c33575SMatthias Ringwald int time_delta_ms = sco_tx_ms - now; 297759c33575SMatthias Ringwald 297859c33575SMatthias Ringwald btstack_timer_source_t * timer = (conn->sco_rx_count & 1) ? &conn->timeout : &conn->timeout_sco; 297959c33575SMatthias Ringwald 298059c33575SMatthias Ringwald // log_error("SCO TX at %u in %u", (int) sco_tx_ms, time_delta_ms); 298159c33575SMatthias Ringwald btstack_run_loop_set_timer(timer, time_delta_ms); 298259c33575SMatthias Ringwald btstack_run_loop_set_timer_context(timer, (void *) (uintptr_t) conn->con_handle); 298359c33575SMatthias Ringwald btstack_run_loop_set_timer_handler(timer, &sco_tx_timeout_handler); 298459c33575SMatthias Ringwald btstack_run_loop_add_timer(timer); 29856f28d2eeSMatthias Ringwald } 29866be3cf7fSMatthias Ringwald #endif 29876f28d2eeSMatthias Ringwald 2988c91d150bS[email protected] static void sco_handler(uint8_t * packet, uint16_t size){ 29890b3f95dfSMatthias Ringwald // lookup connection struct 29902b838201SMatthias Ringwald hci_con_handle_t con_handle = READ_SCO_CONNECTION_HANDLE(packet); 29912b838201SMatthias Ringwald hci_connection_t * conn = hci_connection_for_handle(con_handle); 29920b3f95dfSMatthias Ringwald if (!conn) return; 29930b3f95dfSMatthias Ringwald 29946be3cf7fSMatthias Ringwald #ifdef ENABLE_SCO_OVER_HCI 2995760b20efSMatthias Ringwald // CSR 8811 prefixes 60 byte SCO packet in transparent mode with 20 zero bytes -> skip first 20 payload bytes 2996760b20efSMatthias Ringwald if (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_CAMBRIDGE_SILICON_RADIO){ 2997a1df452eSMatthias Ringwald if ((size == 83) && ((hci_stack->sco_voice_setting_active & 0x03) == 0x03)){ 2998760b20efSMatthias Ringwald packet[2] = 0x3c; 2999760b20efSMatthias Ringwald memmove(&packet[3], &packet[23], 63); 3000760b20efSMatthias Ringwald size = 63; 30010b3f95dfSMatthias Ringwald } 30020b3f95dfSMatthias Ringwald } 3003760b20efSMatthias Ringwald 3004f234b250SMatthias Ringwald if (hci_have_usb_transport()){ 3005f234b250SMatthias Ringwald // Nothing to do 3006f234b250SMatthias Ringwald } else { 300749205f5dSMatthias 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); 3008760b20efSMatthias Ringwald if (hci_stack->synchronous_flow_control_enabled == 0){ 30096f28d2eeSMatthias Ringwald uint32_t now = btstack_run_loop_get_time_ms(); 301059c33575SMatthias Ringwald 301159c33575SMatthias Ringwald if (!conn->sco_rx_valid){ 301259c33575SMatthias Ringwald // ignore first 10 packets 30136f28d2eeSMatthias Ringwald conn->sco_rx_count++; 301459c33575SMatthias Ringwald // log_debug("sco rx count %u", conn->sco_rx_count); 301559c33575SMatthias Ringwald if (conn->sco_rx_count == 10) { 301659c33575SMatthias Ringwald // use first timestamp as is and pretent it just started 30176f28d2eeSMatthias Ringwald conn->sco_rx_ms = now; 30186f28d2eeSMatthias Ringwald conn->sco_rx_valid = 1; 301959c33575SMatthias Ringwald conn->sco_rx_count = 0; 302059c33575SMatthias Ringwald sco_schedule_tx(conn); 302159c33575SMatthias Ringwald } 302259c33575SMatthias Ringwald } else { 302359c33575SMatthias Ringwald // track expected arrival timme 302459c33575SMatthias Ringwald conn->sco_rx_count++; 302559c33575SMatthias Ringwald conn->sco_rx_ms += 7; 302659c33575SMatthias Ringwald int delta = (int32_t) (now - conn->sco_rx_ms); 302759c33575SMatthias Ringwald if (delta > 0){ 302859c33575SMatthias Ringwald conn->sco_rx_ms++; 302959c33575SMatthias Ringwald } 303059c33575SMatthias Ringwald // log_debug("sco rx %u", conn->sco_rx_ms); 30316f28d2eeSMatthias Ringwald sco_schedule_tx(conn); 30326f28d2eeSMatthias Ringwald } 3033760b20efSMatthias Ringwald } 3034f234b250SMatthias Ringwald } 30356be3cf7fSMatthias Ringwald #endif 30366be3cf7fSMatthias Ringwald 30370b3f95dfSMatthias Ringwald // deliver to app 30380b3f95dfSMatthias Ringwald if (hci_stack->sco_packet_handler) { 30390b3f95dfSMatthias Ringwald hci_stack->sco_packet_handler(HCI_SCO_DATA_PACKET, 0, packet, size); 30400b3f95dfSMatthias Ringwald } 30410b3f95dfSMatthias Ringwald 3042ed325439SMatthias Ringwald #ifdef HAVE_SCO_TRANSPORT 3043ed325439SMatthias Ringwald // We can send one packet for each received packet 3044ed325439SMatthias Ringwald conn->sco_tx_ready++; 3045ed325439SMatthias Ringwald hci_notify_if_sco_can_send_now(); 3046ed325439SMatthias Ringwald #endif 3047ed325439SMatthias Ringwald 30480b3f95dfSMatthias Ringwald #ifdef ENABLE_HCI_CONTROLLER_TO_HOST_FLOW_CONTROL 30492b838201SMatthias Ringwald conn->num_packets_completed++; 30502b838201SMatthias Ringwald hci_stack->host_completed_packets = 1; 30512b838201SMatthias Ringwald hci_run(); 30522b838201SMatthias Ringwald #endif 3053c91d150bS[email protected] } 305435454696SMatthias Ringwald #endif 3055c91d150bS[email protected] 30560a57e69fSmatthias.ringwald static void packet_handler(uint8_t packet_type, uint8_t *packet, uint16_t size){ 30575bb5bc3eS[email protected] hci_dump_packet(packet_type, 1, packet, size); 305810e830c9Smatthias.ringwald switch (packet_type) { 305910e830c9Smatthias.ringwald case HCI_EVENT_PACKET: 306010e830c9Smatthias.ringwald event_handler(packet, size); 306110e830c9Smatthias.ringwald break; 306210e830c9Smatthias.ringwald case HCI_ACL_DATA_PACKET: 306310e830c9Smatthias.ringwald acl_handler(packet, size); 306410e830c9Smatthias.ringwald break; 306535454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 3066c91d150bS[email protected] case HCI_SCO_DATA_PACKET: 3067c91d150bS[email protected] sco_handler(packet, size); 3068202c8a4cSMatthias Ringwald break; 306935454696SMatthias Ringwald #endif 307010e830c9Smatthias.ringwald default: 307110e830c9Smatthias.ringwald break; 307210e830c9Smatthias.ringwald } 307310e830c9Smatthias.ringwald } 307410e830c9Smatthias.ringwald 3075d6b06661SMatthias Ringwald /** 3076d6b06661SMatthias Ringwald * @brief Add event packet handler. 3077d6b06661SMatthias Ringwald */ 3078d6b06661SMatthias Ringwald void hci_add_event_handler(btstack_packet_callback_registration_t * callback_handler){ 3079d6b06661SMatthias Ringwald btstack_linked_list_add_tail(&hci_stack->event_handlers, (btstack_linked_item_t*) callback_handler); 3080d6b06661SMatthias Ringwald } 3081d6b06661SMatthias Ringwald 3082d6b06661SMatthias Ringwald 3083fcadd0caSmatthias.ringwald /** Register HCI packet handlers */ 30843d50b4baSMatthias Ringwald void hci_register_acl_packet_handler(btstack_packet_handler_t handler){ 3085fb37a842SMatthias Ringwald hci_stack->acl_packet_handler = handler; 308616833f0aSmatthias.ringwald } 308716833f0aSmatthias.ringwald 308835454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 30898abbe8b5SMatthias Ringwald /** 30908abbe8b5SMatthias Ringwald * @brief Registers a packet handler for SCO data. Used for HSP and HFP profiles. 30918abbe8b5SMatthias Ringwald */ 30923d50b4baSMatthias Ringwald void hci_register_sco_packet_handler(btstack_packet_handler_t handler){ 30938abbe8b5SMatthias Ringwald hci_stack->sco_packet_handler = handler; 30948abbe8b5SMatthias Ringwald } 309535454696SMatthias Ringwald #endif 30968abbe8b5SMatthias Ringwald 309771de195eSMatthias Ringwald static void hci_state_reset(void){ 3098595bdbfbS[email protected] // no connections yet 3099595bdbfbS[email protected] hci_stack->connections = NULL; 310074308b23Smatthias.ringwald 310174308b23Smatthias.ringwald // keep discoverable/connectable as this has been requested by the client(s) 310274308b23Smatthias.ringwald // hci_stack->discoverable = 0; 310374308b23Smatthias.ringwald // hci_stack->connectable = 0; 310474308b23Smatthias.ringwald // hci_stack->bondable = 1; 3105b95a5a35SMatthias Ringwald // hci_stack->own_addr_type = 0; 3106595bdbfbS[email protected] 310744935e40S[email protected] // buffer is free 310844935e40S[email protected] hci_stack->hci_packet_buffer_reserved = 0; 310944935e40S[email protected] 3110595bdbfbS[email protected] // no pending cmds 3111595bdbfbS[email protected] hci_stack->decline_reason = 0; 3112595bdbfbS[email protected] hci_stack->new_scan_enable_value = 0xff; 3113595bdbfbS[email protected] 3114c214d65bSMatthias Ringwald hci_stack->secure_connections_active = false; 3115c214d65bSMatthias Ringwald 3116bea424a5SMatthias Ringwald #ifdef ENABLE_CLASSIC 3117bea424a5SMatthias Ringwald hci_stack->new_page_scan_interval = 0xffff; 3118bea424a5SMatthias Ringwald hci_stack->new_page_scan_window = 0xffff; 3119bea424a5SMatthias Ringwald hci_stack->new_page_scan_type = 0xff; 3120bea424a5SMatthias Ringwald #endif 3121bea424a5SMatthias Ringwald 3122cf01e888SMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB 3123cf01e888SMatthias Ringwald hci_stack->classic_read_local_oob_data = true; 3124cf01e888SMatthias Ringwald #endif 3125cf01e888SMatthias Ringwald 3126595bdbfbS[email protected] // LE 3127b95a5a35SMatthias Ringwald #ifdef ENABLE_BLE 3128b95a5a35SMatthias Ringwald memset(hci_stack->le_random_address, 0, 6); 3129b95a5a35SMatthias Ringwald hci_stack->le_random_address_set = 0; 3130d70217a2SMatthias Ringwald #endif 3131d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 31326fab74dbSMatthias Ringwald hci_stack->le_scanning_active = 0; 3133b04dfa37SMatthias Ringwald hci_stack->le_connecting_state = LE_CONNECTING_IDLE; 3134d5b1a89eSMatthias Ringwald hci_stack->le_connecting_request = LE_CONNECTING_IDLE; 3135e83201bcSMatthias Ringwald hci_stack->le_whitelist_capacity = 0; 3136d70217a2SMatthias Ringwald #endif 3137595bdbfbS[email protected] } 3138595bdbfbS[email protected] 313935454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 31402d5e09d6SMatthias Ringwald /** 31412d5e09d6SMatthias Ringwald * @brief Configure Bluetooth hardware control. Has to be called before power on. 31422d5e09d6SMatthias Ringwald */ 31432d5e09d6SMatthias Ringwald void hci_set_link_key_db(btstack_link_key_db_t const * link_key_db){ 31442d5e09d6SMatthias Ringwald // store and open remote device db 31452d5e09d6SMatthias Ringwald hci_stack->link_key_db = link_key_db; 31462d5e09d6SMatthias Ringwald if (hci_stack->link_key_db) { 31472d5e09d6SMatthias Ringwald hci_stack->link_key_db->open(); 31482d5e09d6SMatthias Ringwald } 31492d5e09d6SMatthias Ringwald } 315035454696SMatthias Ringwald #endif 31512d5e09d6SMatthias Ringwald 31522d5e09d6SMatthias Ringwald void hci_init(const hci_transport_t *transport, const void *config){ 3153475c8125Smatthias.ringwald 31543a9fb326S[email protected] #ifdef HAVE_MALLOC 31553a9fb326S[email protected] if (!hci_stack) { 31563a9fb326S[email protected] hci_stack = (hci_stack_t*) malloc(sizeof(hci_stack_t)); 31573a9fb326S[email protected] } 31583a9fb326S[email protected] #else 31593a9fb326S[email protected] hci_stack = &hci_stack_static; 31603a9fb326S[email protected] #endif 316166fb9560S[email protected] memset(hci_stack, 0, sizeof(hci_stack_t)); 31623a9fb326S[email protected] 3163475c8125Smatthias.ringwald // reference to use transport layer implementation 31643a9fb326S[email protected] hci_stack->hci_transport = transport; 3165475c8125Smatthias.ringwald 316611e23e5fSmatthias.ringwald // reference to used config 31673a9fb326S[email protected] hci_stack->config = config; 316811e23e5fSmatthias.ringwald 316926a9b6daSMatthias Ringwald // setup pointer for outgoing packet buffer 317026a9b6daSMatthias Ringwald hci_stack->hci_packet_buffer = &hci_stack->hci_packet_buffer_data[HCI_OUTGOING_PRE_BUFFER_SIZE]; 317126a9b6daSMatthias Ringwald 31728fcba05dSmatthias.ringwald // max acl payload size defined in config.h 31733a9fb326S[email protected] hci_stack->acl_data_packet_length = HCI_ACL_PAYLOAD_SIZE; 31748fcba05dSmatthias.ringwald 317516833f0aSmatthias.ringwald // register packet handlers with transport 317610e830c9Smatthias.ringwald transport->register_packet_handler(&packet_handler); 3177f5454fc6Smatthias.ringwald 31783a9fb326S[email protected] hci_stack->state = HCI_STATE_OFF; 3179e2386ba1S[email protected] 3180e2386ba1S[email protected] // class of device 31813a9fb326S[email protected] hci_stack->class_of_device = 0x007a020c; // Smartphone 3182a45d6b9fS[email protected] 3183f20168b8Smatthias.ringwald // bondable by default 3184f20168b8Smatthias.ringwald hci_stack->bondable = 1; 3185f20168b8Smatthias.ringwald 3186e9f343c8SMatthias Ringwald #ifdef ENABLE_CLASSIC 318763168530SMatthias Ringwald // classic name 318863168530SMatthias Ringwald hci_stack->local_name = default_classic_name; 3189c4c88f1bSJakob Krantz 3190c4c88f1bSJakob Krantz // Master slave policy 3191c4c88f1bSJakob Krantz hci_stack->master_slave_policy = 1; 3192170fafaeSMatthias Ringwald 3193b4eb4420SMatthias Ringwald // Allow Role Switch 3194b4eb4420SMatthias Ringwald hci_stack->allow_role_switch = 1; 3195b4eb4420SMatthias Ringwald 319678315a58SMatthias Ringwald // Default / minimum security level = 2 319778315a58SMatthias Ringwald hci_stack->gap_security_level = LEVEL_2; 319878315a58SMatthias Ringwald 3199cd345294SMatthias Ringwald // Errata-11838 mandates 7 bytes for GAP Security Level 1-3 3200cd345294SMatthias Ringwald hci_stack->gap_required_encyrption_key_size = 7; 3201e9f343c8SMatthias Ringwald #endif 320263168530SMatthias Ringwald 320363048403S[email protected] // Secure Simple Pairing default: enable, no I/O capabilities, general bonding, mitm not required, auto accept 32043a9fb326S[email protected] hci_stack->ssp_enable = 1; 32053a9fb326S[email protected] hci_stack->ssp_io_capability = SSP_IO_CAPABILITY_NO_INPUT_NO_OUTPUT; 32063a9fb326S[email protected] hci_stack->ssp_authentication_requirement = SSP_IO_AUTHREQ_MITM_PROTECTION_NOT_REQUIRED_GENERAL_BONDING; 32073a9fb326S[email protected] hci_stack->ssp_auto_accept = 1; 320869a97523S[email protected] 32095d23aae8SMatthias Ringwald // Secure Connections: enable (requires support from Controller) 32105d23aae8SMatthias Ringwald hci_stack->secure_connections_enable = true; 32115d23aae8SMatthias Ringwald 3212fac2e2feSMatthias Ringwald // voice setting - signed 16 bit pcm data with CVSD over the air 3213fac2e2feSMatthias Ringwald hci_stack->sco_voice_setting = 0x60; 3214d950d659SMatthias Ringwald 3215831711daSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 3216831711daSMatthias Ringwald // connection parameter to use for outgoing connections 3217cbe54ab2SJakob Krantz hci_stack->le_connection_scan_interval = 0x0060; // 60ms 3218cbe54ab2SJakob Krantz hci_stack->le_connection_scan_window = 0x0030; // 30ms 3219831711daSMatthias Ringwald hci_stack->le_connection_interval_min = 0x0008; // 10 ms 3220831711daSMatthias Ringwald hci_stack->le_connection_interval_max = 0x0018; // 30 ms 3221831711daSMatthias Ringwald hci_stack->le_connection_latency = 4; // 4 3222831711daSMatthias Ringwald hci_stack->le_supervision_timeout = 0x0048; // 720 ms 3223831711daSMatthias Ringwald hci_stack->le_minimum_ce_length = 2; // 1.25 ms 3224831711daSMatthias Ringwald hci_stack->le_maximum_ce_length = 0x0030; // 30 ms 32257261e5d8SMatthias Ringwald 32267261e5d8SMatthias Ringwald // default LE Scanning 32278b69e4c7SMatthias Ringwald hci_stack->le_scan_type = 0x1; // active 32288b69e4c7SMatthias Ringwald hci_stack->le_scan_interval = 0x1e0; // 300 ms 32298b69e4c7SMatthias Ringwald hci_stack->le_scan_window = 0x30; // 30 ms 3230831711daSMatthias Ringwald #endif 3231831711daSMatthias Ringwald 32322b6ab3e6SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 32332b6ab3e6SMatthias Ringwald hci_stack->le_max_number_peripheral_connections = 1; // only single connection as peripheral 32342b6ab3e6SMatthias Ringwald #endif 32352b6ab3e6SMatthias Ringwald 3236831711daSMatthias Ringwald // connection parameter range used to answer connection parameter update requests in l2cap 3237831711daSMatthias Ringwald hci_stack->le_connection_parameter_range.le_conn_interval_min = 6; 3238831711daSMatthias Ringwald hci_stack->le_connection_parameter_range.le_conn_interval_max = 3200; 3239831711daSMatthias Ringwald hci_stack->le_connection_parameter_range.le_conn_latency_min = 0; 3240831711daSMatthias Ringwald hci_stack->le_connection_parameter_range.le_conn_latency_max = 500; 3241831711daSMatthias Ringwald hci_stack->le_connection_parameter_range.le_supervision_timeout_min = 10; 3242831711daSMatthias Ringwald hci_stack->le_connection_parameter_range.le_supervision_timeout_max = 3200; 3243831711daSMatthias Ringwald 3244595bdbfbS[email protected] hci_state_reset(); 3245475c8125Smatthias.ringwald } 3246475c8125Smatthias.ringwald 32474688f216SMatthias Ringwald void hci_deinit(void){ 32484688f216SMatthias Ringwald #ifdef HAVE_MALLOC 32494688f216SMatthias Ringwald if (hci_stack) { 32504688f216SMatthias Ringwald free(hci_stack); 32514688f216SMatthias Ringwald } 32524688f216SMatthias Ringwald #endif 32534688f216SMatthias Ringwald hci_stack = NULL; 3254b5bbcbf4SMatthias Ringwald 3255b5bbcbf4SMatthias Ringwald #ifdef ENABLE_CLASSIC 32564688f216SMatthias Ringwald disable_l2cap_timeouts = 0; 3257b5bbcbf4SMatthias Ringwald #endif 32584688f216SMatthias Ringwald } 32594688f216SMatthias Ringwald 32603fb36a29SMatthias Ringwald /** 32613fb36a29SMatthias Ringwald * @brief Configure Bluetooth chipset driver. Has to be called before power on, or right after receiving the local version information 32623fb36a29SMatthias Ringwald */ 32633fb36a29SMatthias Ringwald void hci_set_chipset(const btstack_chipset_t *chipset_driver){ 32643fb36a29SMatthias Ringwald hci_stack->chipset = chipset_driver; 32653fb36a29SMatthias Ringwald 32663fb36a29SMatthias Ringwald // reset chipset driver - init is also called on power_up 32673fb36a29SMatthias Ringwald if (hci_stack->chipset && hci_stack->chipset->init){ 32683fb36a29SMatthias Ringwald hci_stack->chipset->init(hci_stack->config); 32693fb36a29SMatthias Ringwald } 32703fb36a29SMatthias Ringwald } 32713fb36a29SMatthias Ringwald 3272fb55bd0aSMatthias Ringwald /** 3273d0b87befSMatthias Ringwald * @brief Configure Bluetooth hardware control. Has to be called after hci_init() but before power on. 3274fb55bd0aSMatthias Ringwald */ 3275fb55bd0aSMatthias Ringwald void hci_set_control(const btstack_control_t *hardware_control){ 3276fb55bd0aSMatthias Ringwald // references to used control implementation 3277fb55bd0aSMatthias Ringwald hci_stack->control = hardware_control; 3278d0b87befSMatthias Ringwald // init with transport config 3279d0b87befSMatthias Ringwald hardware_control->init(hci_stack->config); 3280fb55bd0aSMatthias Ringwald } 3281fb55bd0aSMatthias Ringwald 328271de195eSMatthias Ringwald void hci_close(void){ 3283404843c1Smatthias.ringwald // close remote device db 3284a98592bcSMatthias Ringwald if (hci_stack->link_key_db) { 3285a98592bcSMatthias Ringwald hci_stack->link_key_db->close(); 3286404843c1Smatthias.ringwald } 32877224be7eSMatthias Ringwald 32887224be7eSMatthias Ringwald btstack_linked_list_iterator_t lit; 32897224be7eSMatthias Ringwald btstack_linked_list_iterator_init(&lit, &hci_stack->connections); 32907224be7eSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&lit)){ 32917224be7eSMatthias Ringwald // cancel all l2cap connections by emitting dicsconnection complete before shutdown (free) connection 32927224be7eSMatthias Ringwald hci_connection_t * connection = (hci_connection_t*) btstack_linked_list_iterator_next(&lit); 32937224be7eSMatthias Ringwald hci_emit_disconnection_complete(connection->con_handle, 0x16); // terminated by local host 32947224be7eSMatthias Ringwald hci_shutdown_connection(connection); 3295f5454fc6Smatthias.ringwald } 32967224be7eSMatthias Ringwald 3297f5454fc6Smatthias.ringwald hci_power_control(HCI_POWER_OFF); 32983a9fb326S[email protected] 32993a9fb326S[email protected] #ifdef HAVE_MALLOC 33003a9fb326S[email protected] free(hci_stack); 33013a9fb326S[email protected] #endif 33023a9fb326S[email protected] hci_stack = NULL; 3303404843c1Smatthias.ringwald } 3304404843c1Smatthias.ringwald 3305cb70c5abSMatthias Ringwald #ifdef HAVE_SCO_TRANSPORT 3306cb70c5abSMatthias Ringwald void hci_set_sco_transport(const btstack_sco_transport_t *sco_transport){ 3307cb70c5abSMatthias Ringwald hci_stack->sco_transport = sco_transport; 3308cb70c5abSMatthias Ringwald sco_transport->register_packet_handler(&packet_handler); 3309cb70c5abSMatthias Ringwald } 3310cb70c5abSMatthias Ringwald #endif 3311cb70c5abSMatthias Ringwald 331235454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 3313170fafaeSMatthias Ringwald void gap_set_required_encryption_key_size(uint8_t encryption_key_size){ 3314170fafaeSMatthias Ringwald // validate ranage and set 3315170fafaeSMatthias Ringwald if (encryption_key_size < 7) return; 3316170fafaeSMatthias Ringwald if (encryption_key_size > 16) return; 3317170fafaeSMatthias Ringwald hci_stack->gap_required_encyrption_key_size = encryption_key_size; 3318170fafaeSMatthias Ringwald } 331978315a58SMatthias Ringwald 332078315a58SMatthias Ringwald void gap_set_security_level(gap_security_level_t security_level){ 332178315a58SMatthias Ringwald hci_stack->gap_security_level = security_level; 332278315a58SMatthias Ringwald } 332378315a58SMatthias Ringwald 332478315a58SMatthias Ringwald gap_security_level_t gap_get_security_level(void){ 332578315a58SMatthias Ringwald return hci_stack->gap_security_level; 332678315a58SMatthias Ringwald } 3327170fafaeSMatthias Ringwald #endif 3328170fafaeSMatthias Ringwald 3329170fafaeSMatthias Ringwald #ifdef ENABLE_CLASSIC 333060b9e82fSMatthias Ringwald void gap_set_class_of_device(uint32_t class_of_device){ 33319e61646fS[email protected] hci_stack->class_of_device = class_of_device; 33329e61646fS[email protected] } 333376f27cffSMatthias Ringwald 3334c33e56d3SMatthias Ringwald void gap_set_default_link_policy_settings(uint16_t default_link_policy_settings){ 3335c33e56d3SMatthias Ringwald hci_stack->default_link_policy_settings = default_link_policy_settings; 3336c33e56d3SMatthias Ringwald } 3337c33e56d3SMatthias Ringwald 3338b4eb4420SMatthias Ringwald void gap_set_allow_role_switch(bool allow_role_switch){ 3339b4eb4420SMatthias Ringwald hci_stack->allow_role_switch = allow_role_switch ? 1 : 0; 3340b4eb4420SMatthias Ringwald } 3341b4eb4420SMatthias Ringwald 3342b4eb4420SMatthias Ringwald uint8_t hci_get_allow_role_switch(void){ 3343b4eb4420SMatthias Ringwald return hci_stack->allow_role_switch; 3344b4eb4420SMatthias Ringwald } 3345b4eb4420SMatthias Ringwald 33460c3eb48dSMatthias Ringwald void gap_set_link_supervision_timeout(uint16_t link_supervision_timeout){ 33470c3eb48dSMatthias Ringwald hci_stack->link_supervision_timeout = link_supervision_timeout; 33480c3eb48dSMatthias Ringwald } 33490c3eb48dSMatthias Ringwald 335076f27cffSMatthias Ringwald void hci_disable_l2cap_timeout_check(void){ 335176f27cffSMatthias Ringwald disable_l2cap_timeouts = 1; 335276f27cffSMatthias Ringwald } 335335454696SMatthias Ringwald #endif 33549e61646fS[email protected] 335576f27cffSMatthias Ringwald #if !defined(HAVE_PLATFORM_IPHONE_OS) && !defined (HAVE_HOST_CONTROLLER_API) 3356f456b2d0S[email protected] // Set Public BD ADDR - passed on to Bluetooth chipset if supported in bt_control_h 3357f456b2d0S[email protected] void hci_set_bd_addr(bd_addr_t addr){ 33586535961aSMatthias Ringwald (void)memcpy(hci_stack->custom_bd_addr, addr, 6); 3359f456b2d0S[email protected] hci_stack->custom_bd_addr_set = 1; 3360f456b2d0S[email protected] } 336176f27cffSMatthias Ringwald #endif 3362f456b2d0S[email protected] 33638d213e1aSmatthias.ringwald // State-Module-Driver overview 33648d213e1aSmatthias.ringwald // state module low-level 33658d213e1aSmatthias.ringwald // HCI_STATE_OFF off close 33668d213e1aSmatthias.ringwald // HCI_STATE_INITIALIZING, on open 33678d213e1aSmatthias.ringwald // HCI_STATE_WORKING, on open 33688d213e1aSmatthias.ringwald // HCI_STATE_HALTING, on open 3369d661ed19Smatthias.ringwald // HCI_STATE_SLEEPING, off/sleep close 3370d661ed19Smatthias.ringwald // HCI_STATE_FALLING_ASLEEP on open 3371c7e0c5f6Smatthias.ringwald 337240d1c7a4Smatthias.ringwald static int hci_power_control_on(void){ 33737301ad89Smatthias.ringwald 3374038bc64cSmatthias.ringwald // power on 3375f9a30166Smatthias.ringwald int err = 0; 33763a9fb326S[email protected] if (hci_stack->control && hci_stack->control->on){ 3377d0b87befSMatthias Ringwald err = (*hci_stack->control->on)(); 3378f9a30166Smatthias.ringwald } 3379038bc64cSmatthias.ringwald if (err){ 33809da54300S[email protected] log_error( "POWER_ON failed"); 3381038bc64cSmatthias.ringwald hci_emit_hci_open_failed(); 3382038bc64cSmatthias.ringwald return err; 3383038bc64cSmatthias.ringwald } 3384038bc64cSmatthias.ringwald 338524b3c629SMatthias Ringwald // int chipset driver 33863fb36a29SMatthias Ringwald if (hci_stack->chipset && hci_stack->chipset->init){ 33873fb36a29SMatthias Ringwald hci_stack->chipset->init(hci_stack->config); 33883fb36a29SMatthias Ringwald } 33893fb36a29SMatthias Ringwald 339024b3c629SMatthias Ringwald // init transport 339124b3c629SMatthias Ringwald if (hci_stack->hci_transport->init){ 339224b3c629SMatthias Ringwald hci_stack->hci_transport->init(hci_stack->config); 339324b3c629SMatthias Ringwald } 339424b3c629SMatthias Ringwald 339524b3c629SMatthias Ringwald // open transport 339624b3c629SMatthias Ringwald err = hci_stack->hci_transport->open(); 3397038bc64cSmatthias.ringwald if (err){ 33989da54300S[email protected] log_error( "HCI_INIT failed, turning Bluetooth off again"); 33993a9fb326S[email protected] if (hci_stack->control && hci_stack->control->off){ 3400d0b87befSMatthias Ringwald (*hci_stack->control->off)(); 3401f9a30166Smatthias.ringwald } 3402038bc64cSmatthias.ringwald hci_emit_hci_open_failed(); 3403038bc64cSmatthias.ringwald return err; 3404038bc64cSmatthias.ringwald } 34058d213e1aSmatthias.ringwald return 0; 34068d213e1aSmatthias.ringwald } 3407038bc64cSmatthias.ringwald 340840d1c7a4Smatthias.ringwald static void hci_power_control_off(void){ 34098d213e1aSmatthias.ringwald 34109da54300S[email protected] log_info("hci_power_control_off"); 34119418f9c9Smatthias.ringwald 34128d213e1aSmatthias.ringwald // close low-level device 341324b3c629SMatthias Ringwald hci_stack->hci_transport->close(); 34148d213e1aSmatthias.ringwald 34159da54300S[email protected] log_info("hci_power_control_off - hci_transport closed"); 34169418f9c9Smatthias.ringwald 34178d213e1aSmatthias.ringwald // power off 34183a9fb326S[email protected] if (hci_stack->control && hci_stack->control->off){ 3419d0b87befSMatthias Ringwald (*hci_stack->control->off)(); 34208d213e1aSmatthias.ringwald } 34219418f9c9Smatthias.ringwald 34229da54300S[email protected] log_info("hci_power_control_off - control closed"); 34239418f9c9Smatthias.ringwald 34243a9fb326S[email protected] hci_stack->state = HCI_STATE_OFF; 342572ea5239Smatthias.ringwald } 342672ea5239Smatthias.ringwald 342740d1c7a4Smatthias.ringwald static void hci_power_control_sleep(void){ 342872ea5239Smatthias.ringwald 34299da54300S[email protected] log_info("hci_power_control_sleep"); 34303144bce4Smatthias.ringwald 3431b429b9b7Smatthias.ringwald #if 0 3432b429b9b7Smatthias.ringwald // don't close serial port during sleep 3433b429b9b7Smatthias.ringwald 343472ea5239Smatthias.ringwald // close low-level device 34353a9fb326S[email protected] hci_stack->hci_transport->close(hci_stack->config); 3436b429b9b7Smatthias.ringwald #endif 343772ea5239Smatthias.ringwald 343872ea5239Smatthias.ringwald // sleep mode 34393a9fb326S[email protected] if (hci_stack->control && hci_stack->control->sleep){ 3440d0b87befSMatthias Ringwald (*hci_stack->control->sleep)(); 344172ea5239Smatthias.ringwald } 3442b429b9b7Smatthias.ringwald 34433a9fb326S[email protected] hci_stack->state = HCI_STATE_SLEEPING; 34448d213e1aSmatthias.ringwald } 34458d213e1aSmatthias.ringwald 344640d1c7a4Smatthias.ringwald static int hci_power_control_wake(void){ 3447b429b9b7Smatthias.ringwald 34489da54300S[email protected] log_info("hci_power_control_wake"); 3449b429b9b7Smatthias.ringwald 3450b429b9b7Smatthias.ringwald // wake on 34513a9fb326S[email protected] if (hci_stack->control && hci_stack->control->wake){ 3452d0b87befSMatthias Ringwald (*hci_stack->control->wake)(); 3453b429b9b7Smatthias.ringwald } 3454b429b9b7Smatthias.ringwald 3455b429b9b7Smatthias.ringwald #if 0 3456b429b9b7Smatthias.ringwald // open low-level device 34573a9fb326S[email protected] int err = hci_stack->hci_transport->open(hci_stack->config); 3458b429b9b7Smatthias.ringwald if (err){ 34599da54300S[email protected] log_error( "HCI_INIT failed, turning Bluetooth off again"); 34603a9fb326S[email protected] if (hci_stack->control && hci_stack->control->off){ 3461d0b87befSMatthias Ringwald (*hci_stack->control->off)(); 3462b429b9b7Smatthias.ringwald } 3463b429b9b7Smatthias.ringwald hci_emit_hci_open_failed(); 3464b429b9b7Smatthias.ringwald return err; 3465b429b9b7Smatthias.ringwald } 3466b429b9b7Smatthias.ringwald #endif 3467b429b9b7Smatthias.ringwald 3468b429b9b7Smatthias.ringwald return 0; 3469b429b9b7Smatthias.ringwald } 3470b429b9b7Smatthias.ringwald 347144935e40S[email protected] static void hci_power_transition_to_initializing(void){ 347244935e40S[email protected] // set up state machine 347344935e40S[email protected] hci_stack->num_cmd_packets = 1; // assume that one cmd can be sent 347444935e40S[email protected] hci_stack->hci_packet_buffer_reserved = 0; 347544935e40S[email protected] hci_stack->state = HCI_STATE_INITIALIZING; 34765c363727SMatthias Ringwald hci_stack->substate = HCI_INIT_SEND_RESET; 347744935e40S[email protected] } 3478b429b9b7Smatthias.ringwald 347942bd3d77SMatthias Ringwald // returns error 348042bd3d77SMatthias Ringwald static int hci_power_control_state_off(HCI_POWER_MODE power_mode){ 348142bd3d77SMatthias Ringwald int err; 34828d213e1aSmatthias.ringwald switch (power_mode){ 34838d213e1aSmatthias.ringwald case HCI_POWER_ON: 34848d213e1aSmatthias.ringwald err = hci_power_control_on(); 348542bd3d77SMatthias Ringwald if (err != 0) { 3486f04a0c31SMatthias Ringwald log_error("hci_power_control_on() error %d", err); 348797b61c7bS[email protected] return err; 348897b61c7bS[email protected] } 348944935e40S[email protected] hci_power_transition_to_initializing(); 34908d213e1aSmatthias.ringwald break; 34918d213e1aSmatthias.ringwald case HCI_POWER_OFF: 34928d213e1aSmatthias.ringwald // do nothing 34938d213e1aSmatthias.ringwald break; 34948d213e1aSmatthias.ringwald case HCI_POWER_SLEEP: 3495b546ac54Smatthias.ringwald // do nothing (with SLEEP == OFF) 34968d213e1aSmatthias.ringwald break; 34977bbeb3adSMilanka Ringwald default: 34987bbeb3adSMilanka Ringwald btstack_assert(false); 34997bbeb3adSMilanka Ringwald break; 35008d213e1aSmatthias.ringwald } 350142bd3d77SMatthias Ringwald return ERROR_CODE_SUCCESS; 350242bd3d77SMatthias Ringwald } 35037301ad89Smatthias.ringwald 350442bd3d77SMatthias Ringwald static int hci_power_control_state_initializing(HCI_POWER_MODE power_mode){ 35058d213e1aSmatthias.ringwald switch (power_mode){ 35068d213e1aSmatthias.ringwald case HCI_POWER_ON: 35078d213e1aSmatthias.ringwald // do nothing 35088d213e1aSmatthias.ringwald break; 35098d213e1aSmatthias.ringwald case HCI_POWER_OFF: 35108d213e1aSmatthias.ringwald // no connections yet, just turn it off 35118d213e1aSmatthias.ringwald hci_power_control_off(); 35128d213e1aSmatthias.ringwald break; 35138d213e1aSmatthias.ringwald case HCI_POWER_SLEEP: 3514b546ac54Smatthias.ringwald // no connections yet, just turn it off 351572ea5239Smatthias.ringwald hci_power_control_sleep(); 35168d213e1aSmatthias.ringwald break; 35177bbeb3adSMilanka Ringwald default: 35187bbeb3adSMilanka Ringwald btstack_assert(false); 35197bbeb3adSMilanka Ringwald break; 35208d213e1aSmatthias.ringwald } 352142bd3d77SMatthias Ringwald return ERROR_CODE_SUCCESS; 352242bd3d77SMatthias Ringwald } 35237301ad89Smatthias.ringwald 352442bd3d77SMatthias Ringwald static int hci_power_control_state_working(HCI_POWER_MODE power_mode) { 35258d213e1aSmatthias.ringwald switch (power_mode){ 35268d213e1aSmatthias.ringwald case HCI_POWER_ON: 35278d213e1aSmatthias.ringwald // do nothing 35288d213e1aSmatthias.ringwald break; 35298d213e1aSmatthias.ringwald case HCI_POWER_OFF: 3530c7e0c5f6Smatthias.ringwald // see hci_run 35313a9fb326S[email protected] hci_stack->state = HCI_STATE_HALTING; 3532beceeddeSMatthias Ringwald hci_stack->substate = HCI_HALTING_DISCONNECT_ALL_NO_TIMER; 35338d213e1aSmatthias.ringwald break; 35348d213e1aSmatthias.ringwald case HCI_POWER_SLEEP: 3535b546ac54Smatthias.ringwald // see hci_run 35363a9fb326S[email protected] hci_stack->state = HCI_STATE_FALLING_ASLEEP; 353774b323a9SMatthias Ringwald hci_stack->substate = HCI_FALLING_ASLEEP_DISCONNECT; 35388d213e1aSmatthias.ringwald break; 35397bbeb3adSMilanka Ringwald default: 35407bbeb3adSMilanka Ringwald btstack_assert(false); 35417bbeb3adSMilanka Ringwald break; 35428d213e1aSmatthias.ringwald } 354342bd3d77SMatthias Ringwald return ERROR_CODE_SUCCESS; 354442bd3d77SMatthias Ringwald } 35457301ad89Smatthias.ringwald 354642bd3d77SMatthias Ringwald static int hci_power_control_state_halting(HCI_POWER_MODE power_mode) { 35478d213e1aSmatthias.ringwald switch (power_mode){ 35488d213e1aSmatthias.ringwald case HCI_POWER_ON: 354944935e40S[email protected] hci_power_transition_to_initializing(); 35508d213e1aSmatthias.ringwald break; 35518d213e1aSmatthias.ringwald case HCI_POWER_OFF: 35528d213e1aSmatthias.ringwald // do nothing 35538d213e1aSmatthias.ringwald break; 35548d213e1aSmatthias.ringwald case HCI_POWER_SLEEP: 3555b546ac54Smatthias.ringwald // see hci_run 35563a9fb326S[email protected] hci_stack->state = HCI_STATE_FALLING_ASLEEP; 355774b323a9SMatthias Ringwald hci_stack->substate = HCI_FALLING_ASLEEP_DISCONNECT; 35588d213e1aSmatthias.ringwald break; 35597bbeb3adSMilanka Ringwald default: 35607bbeb3adSMilanka Ringwald btstack_assert(false); 35617bbeb3adSMilanka Ringwald break; 35628d213e1aSmatthias.ringwald } 356300278272SMatthias Ringwald return ERROR_CODE_SUCCESS; 356442bd3d77SMatthias Ringwald } 35658d213e1aSmatthias.ringwald 356642bd3d77SMatthias Ringwald static int hci_power_control_state_falling_asleep(HCI_POWER_MODE power_mode) { 35678d213e1aSmatthias.ringwald switch (power_mode){ 35688d213e1aSmatthias.ringwald case HCI_POWER_ON: 356928171530Smatthias.ringwald 3570423a3e49SMatthias Ringwald #ifdef HAVE_PLATFORM_IPHONE_OS 357128171530Smatthias.ringwald // nothing to do, if H4 supports power management 3572d0b87befSMatthias Ringwald if (btstack_control_iphone_power_management_enabled()){ 35733a9fb326S[email protected] hci_stack->state = HCI_STATE_INITIALIZING; 357474b323a9SMatthias Ringwald hci_stack->substate = HCI_INIT_WRITE_SCAN_ENABLE; // init after sleep 357528171530Smatthias.ringwald break; 357628171530Smatthias.ringwald } 357728171530Smatthias.ringwald #endif 357844935e40S[email protected] hci_power_transition_to_initializing(); 35798d213e1aSmatthias.ringwald break; 35808d213e1aSmatthias.ringwald case HCI_POWER_OFF: 3581b546ac54Smatthias.ringwald // see hci_run 35823a9fb326S[email protected] hci_stack->state = HCI_STATE_HALTING; 3583beceeddeSMatthias Ringwald hci_stack->substate = HCI_HALTING_DISCONNECT_ALL_NO_TIMER; 35848d213e1aSmatthias.ringwald break; 35858d213e1aSmatthias.ringwald case HCI_POWER_SLEEP: 3586b546ac54Smatthias.ringwald // do nothing 35878d213e1aSmatthias.ringwald break; 35887bbeb3adSMilanka Ringwald default: 35897bbeb3adSMilanka Ringwald btstack_assert(false); 35907bbeb3adSMilanka Ringwald break; 35918d213e1aSmatthias.ringwald } 359242bd3d77SMatthias Ringwald return ERROR_CODE_SUCCESS; 359342bd3d77SMatthias Ringwald } 35948d213e1aSmatthias.ringwald 359542bd3d77SMatthias Ringwald static int hci_power_control_state_sleeping(HCI_POWER_MODE power_mode) { 359642bd3d77SMatthias Ringwald int err; 35978d213e1aSmatthias.ringwald switch (power_mode){ 35988d213e1aSmatthias.ringwald case HCI_POWER_ON: 3599423a3e49SMatthias Ringwald #ifdef HAVE_PLATFORM_IPHONE_OS 360028171530Smatthias.ringwald // nothing to do, if H4 supports power management 3601d0b87befSMatthias Ringwald if (btstack_control_iphone_power_management_enabled()){ 36023a9fb326S[email protected] hci_stack->state = HCI_STATE_INITIALIZING; 36035c363727SMatthias Ringwald hci_stack->substate = HCI_INIT_AFTER_SLEEP; 3604758b46ceSmatthias.ringwald hci_update_scan_enable(); 360528171530Smatthias.ringwald break; 360628171530Smatthias.ringwald } 360728171530Smatthias.ringwald #endif 36083144bce4Smatthias.ringwald err = hci_power_control_wake(); 36093144bce4Smatthias.ringwald if (err) return err; 361044935e40S[email protected] hci_power_transition_to_initializing(); 36118d213e1aSmatthias.ringwald break; 36128d213e1aSmatthias.ringwald case HCI_POWER_OFF: 36133a9fb326S[email protected] hci_stack->state = HCI_STATE_HALTING; 3614beceeddeSMatthias Ringwald hci_stack->substate = HCI_HALTING_DISCONNECT_ALL_NO_TIMER; 36158d213e1aSmatthias.ringwald break; 36168d213e1aSmatthias.ringwald case HCI_POWER_SLEEP: 3617b546ac54Smatthias.ringwald // do nothing 36188d213e1aSmatthias.ringwald break; 36197bbeb3adSMilanka Ringwald default: 36207bbeb3adSMilanka Ringwald btstack_assert(false); 36217bbeb3adSMilanka Ringwald break; 36228d213e1aSmatthias.ringwald } 362342bd3d77SMatthias Ringwald return ERROR_CODE_SUCCESS; 362442bd3d77SMatthias Ringwald } 36257bbeb3adSMilanka Ringwald 362642bd3d77SMatthias Ringwald int hci_power_control(HCI_POWER_MODE power_mode){ 362742bd3d77SMatthias Ringwald log_info("hci_power_control: %d, current mode %u", power_mode, hci_stack->state); 362824f87726SMatthias Ringwald int err = 0; 362942bd3d77SMatthias Ringwald switch (hci_stack->state){ 363042bd3d77SMatthias Ringwald case HCI_STATE_OFF: 363142bd3d77SMatthias Ringwald err = hci_power_control_state_off(power_mode); 363242bd3d77SMatthias Ringwald break; 363342bd3d77SMatthias Ringwald case HCI_STATE_INITIALIZING: 363442bd3d77SMatthias Ringwald err = hci_power_control_state_initializing(power_mode); 363542bd3d77SMatthias Ringwald break; 363642bd3d77SMatthias Ringwald case HCI_STATE_WORKING: 363742bd3d77SMatthias Ringwald err = hci_power_control_state_working(power_mode); 363842bd3d77SMatthias Ringwald break; 363942bd3d77SMatthias Ringwald case HCI_STATE_HALTING: 364042bd3d77SMatthias Ringwald err = hci_power_control_state_halting(power_mode); 364142bd3d77SMatthias Ringwald break; 364242bd3d77SMatthias Ringwald case HCI_STATE_FALLING_ASLEEP: 364342bd3d77SMatthias Ringwald err = hci_power_control_state_falling_asleep(power_mode); 364442bd3d77SMatthias Ringwald break; 364542bd3d77SMatthias Ringwald case HCI_STATE_SLEEPING: 364642bd3d77SMatthias Ringwald err = hci_power_control_state_sleeping(power_mode); 364742bd3d77SMatthias Ringwald break; 36487bbeb3adSMilanka Ringwald default: 36497bbeb3adSMilanka Ringwald btstack_assert(false); 36507bbeb3adSMilanka Ringwald break; 365111e23e5fSmatthias.ringwald } 365224f87726SMatthias Ringwald if (err != 0){ 365342bd3d77SMatthias Ringwald return err; 365442bd3d77SMatthias Ringwald } 365568d92d03Smatthias.ringwald 3656038bc64cSmatthias.ringwald // create internal event 3657ee8bf225Smatthias.ringwald hci_emit_state(); 3658ee8bf225Smatthias.ringwald 365968d92d03Smatthias.ringwald // trigger next/first action 366068d92d03Smatthias.ringwald hci_run(); 366168d92d03Smatthias.ringwald 3662475c8125Smatthias.ringwald return 0; 3663475c8125Smatthias.ringwald } 3664475c8125Smatthias.ringwald 366535454696SMatthias Ringwald 366635454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 366735454696SMatthias Ringwald 3668758b46ceSmatthias.ringwald static void hci_update_scan_enable(void){ 3669758b46ceSmatthias.ringwald // 2 = page scan, 1 = inq scan 3670a1df452eSMatthias Ringwald hci_stack->new_scan_enable_value = (hci_stack->connectable << 1) | hci_stack->discoverable; 3671758b46ceSmatthias.ringwald hci_run(); 3672758b46ceSmatthias.ringwald } 3673758b46ceSmatthias.ringwald 367415a95bd5SMatthias Ringwald void gap_discoverable_control(uint8_t enable){ 3675381fbed8Smatthias.ringwald if (enable) enable = 1; // normalize argument 3676381fbed8Smatthias.ringwald 36773a9fb326S[email protected] if (hci_stack->discoverable == enable){ 36783a9fb326S[email protected] hci_emit_discoverable_enabled(hci_stack->discoverable); 3679381fbed8Smatthias.ringwald return; 3680381fbed8Smatthias.ringwald } 3681381fbed8Smatthias.ringwald 36823a9fb326S[email protected] hci_stack->discoverable = enable; 3683758b46ceSmatthias.ringwald hci_update_scan_enable(); 3684758b46ceSmatthias.ringwald } 3685b031bebbSmatthias.ringwald 368615a95bd5SMatthias Ringwald void gap_connectable_control(uint8_t enable){ 3687758b46ceSmatthias.ringwald if (enable) enable = 1; // normalize argument 3688758b46ceSmatthias.ringwald 3689758b46ceSmatthias.ringwald // don't emit event 36903a9fb326S[email protected] if (hci_stack->connectable == enable) return; 3691758b46ceSmatthias.ringwald 36923a9fb326S[email protected] hci_stack->connectable = enable; 3693758b46ceSmatthias.ringwald hci_update_scan_enable(); 3694381fbed8Smatthias.ringwald } 369535454696SMatthias Ringwald #endif 3696381fbed8Smatthias.ringwald 369715a95bd5SMatthias Ringwald void gap_local_bd_addr(bd_addr_t address_buffer){ 36986535961aSMatthias Ringwald (void)memcpy(address_buffer, hci_stack->local_bd_addr, 6); 36995061f3afS[email protected] } 37005061f3afS[email protected] 37012b838201SMatthias Ringwald #ifdef ENABLE_HCI_CONTROLLER_TO_HOST_FLOW_CONTROL 37022b838201SMatthias Ringwald static void hci_host_num_completed_packets(void){ 37032b838201SMatthias Ringwald 37042b838201SMatthias Ringwald // create packet manually as arrays are not supported and num_commands should not get reduced 37052b838201SMatthias Ringwald hci_reserve_packet_buffer(); 37062b838201SMatthias Ringwald uint8_t * packet = hci_get_outgoing_packet_buffer(); 37072b838201SMatthias Ringwald 37082b838201SMatthias Ringwald uint16_t size = 0; 37092b838201SMatthias Ringwald uint16_t num_handles = 0; 37102b838201SMatthias Ringwald packet[size++] = 0x35; 37112b838201SMatthias Ringwald packet[size++] = 0x0c; 37122b838201SMatthias Ringwald size++; // skip param len 37132b838201SMatthias Ringwald size++; // skip num handles 37142b838201SMatthias Ringwald 37152b838201SMatthias Ringwald // add { handle, packets } entries 37162b838201SMatthias Ringwald btstack_linked_item_t * it; 37172b838201SMatthias Ringwald for (it = (btstack_linked_item_t *) hci_stack->connections; it ; it = it->next){ 37182b838201SMatthias Ringwald hci_connection_t * connection = (hci_connection_t *) it; 37192b838201SMatthias Ringwald if (connection->num_packets_completed){ 37202b838201SMatthias Ringwald little_endian_store_16(packet, size, connection->con_handle); 37212b838201SMatthias Ringwald size += 2; 37222b838201SMatthias Ringwald little_endian_store_16(packet, size, connection->num_packets_completed); 37232b838201SMatthias Ringwald size += 2; 37242b838201SMatthias Ringwald // 37252b838201SMatthias Ringwald num_handles++; 37262b838201SMatthias Ringwald connection->num_packets_completed = 0; 37272b838201SMatthias Ringwald } 37282b838201SMatthias Ringwald } 37292b838201SMatthias Ringwald 37302b838201SMatthias Ringwald packet[2] = size - 3; 37312b838201SMatthias Ringwald packet[3] = num_handles; 37322b838201SMatthias Ringwald 37332b838201SMatthias Ringwald hci_stack->host_completed_packets = 0; 37342b838201SMatthias Ringwald 37352b838201SMatthias Ringwald hci_dump_packet(HCI_COMMAND_DATA_PACKET, 0, packet, size); 37362b838201SMatthias Ringwald hci_stack->hci_transport->send_packet(HCI_COMMAND_DATA_PACKET, packet, size); 37372b838201SMatthias Ringwald 37382b838201SMatthias Ringwald // release packet buffer for synchronous transport implementations 37392b838201SMatthias Ringwald if (hci_transport_synchronous()){ 3740e2d22487SMatthias Ringwald hci_release_packet_buffer(); 3741068b8592SMatthias Ringwald hci_emit_transport_packet_sent(); 37422b838201SMatthias Ringwald } 37432b838201SMatthias Ringwald } 37442b838201SMatthias Ringwald #endif 37452b838201SMatthias Ringwald 374626fe9592SMatthias Ringwald static void hci_halting_timeout_handler(btstack_timer_source_t * ds){ 374726fe9592SMatthias Ringwald UNUSED(ds); 374826fe9592SMatthias Ringwald hci_stack->substate = HCI_HALTING_CLOSE; 3749beceeddeSMatthias Ringwald // allow packet handlers to defer final shutdown 3750beceeddeSMatthias Ringwald hci_emit_state(); 375126fe9592SMatthias Ringwald hci_run(); 375226fe9592SMatthias Ringwald } 375326fe9592SMatthias Ringwald 3754f30077b7SMatthias Ringwald static bool hci_run_acl_fragments(void){ 37554ea43905SMatthias Ringwald if (hci_stack->acl_fragmentation_total_size > 0u) { 3756b5d8b22bS[email protected] hci_con_handle_t con_handle = READ_ACL_CONNECTION_HANDLE(hci_stack->hci_packet_buffer); 3757b5d8b22bS[email protected] hci_connection_t *connection = hci_connection_for_handle(con_handle); 3758b5d8b22bS[email protected] if (connection) { 375928a0332dSMatthias Ringwald if (hci_can_send_prepared_acl_packet_now(con_handle)){ 3760b5d8b22bS[email protected] hci_send_acl_packet_fragments(connection); 3761f30077b7SMatthias Ringwald return true; 3762b5d8b22bS[email protected] } 376328a0332dSMatthias Ringwald } else { 3764b5d8b22bS[email protected] // connection gone -> discard further fragments 376528a0332dSMatthias Ringwald log_info("hci_run: fragmented ACL packet no connection -> discard fragment"); 3766b5d8b22bS[email protected] hci_stack->acl_fragmentation_total_size = 0; 3767b5d8b22bS[email protected] hci_stack->acl_fragmentation_pos = 0; 3768b5d8b22bS[email protected] } 3769b5d8b22bS[email protected] } 3770f30077b7SMatthias Ringwald return false; 37712b838201SMatthias Ringwald } 3772b031bebbSmatthias.ringwald 377335454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 3774f30077b7SMatthias Ringwald static bool hci_run_general_gap_classic(void){ 3775f30077b7SMatthias Ringwald 3776b031bebbSmatthias.ringwald // decline incoming connections 37773a9fb326S[email protected] if (hci_stack->decline_reason){ 37783a9fb326S[email protected] uint8_t reason = hci_stack->decline_reason; 37793a9fb326S[email protected] hci_stack->decline_reason = 0; 37803a9fb326S[email protected] hci_send_cmd(&hci_reject_connection_request, hci_stack->decline_addr, reason); 3781f30077b7SMatthias Ringwald return true; 3782ce4c8fabSmatthias.ringwald } 3783bea424a5SMatthias Ringwald // write page scan activity 3784bea424a5SMatthias Ringwald if ((hci_stack->state == HCI_STATE_WORKING) && (hci_stack->new_page_scan_interval != 0xffff) && hci_classic_supported()){ 3785bea424a5SMatthias Ringwald hci_send_cmd(&hci_write_page_scan_activity, hci_stack->new_page_scan_interval, hci_stack->new_page_scan_window); 3786bea424a5SMatthias Ringwald hci_stack->new_page_scan_interval = 0xffff; 3787bea424a5SMatthias Ringwald hci_stack->new_page_scan_window = 0xffff; 3788bea424a5SMatthias Ringwald return true; 3789bea424a5SMatthias Ringwald } 3790bea424a5SMatthias Ringwald // write page scan type 3791bea424a5SMatthias Ringwald if ((hci_stack->state == HCI_STATE_WORKING) && (hci_stack->new_page_scan_type != 0xff) && hci_classic_supported()){ 3792bea424a5SMatthias Ringwald hci_send_cmd(&hci_write_page_scan_type, hci_stack->new_page_scan_type); 3793bea424a5SMatthias Ringwald hci_stack->new_page_scan_type = 0xff; 3794bea424a5SMatthias Ringwald return true; 3795bea424a5SMatthias Ringwald } 3796b031bebbSmatthias.ringwald // send scan enable 37970e588213SMatthias Ringwald if ((hci_stack->state == HCI_STATE_WORKING) && (hci_stack->new_scan_enable_value != 0xff) && hci_classic_supported()){ 37983a9fb326S[email protected] hci_send_cmd(&hci_write_scan_enable, hci_stack->new_scan_enable_value); 37993a9fb326S[email protected] hci_stack->new_scan_enable_value = 0xff; 3800f30077b7SMatthias Ringwald return true; 3801b031bebbSmatthias.ringwald } 3802f5875de5SMatthias Ringwald // start/stop inquiry 3803a1df452eSMatthias Ringwald if ((hci_stack->inquiry_state >= GAP_INQUIRY_DURATION_MIN) && (hci_stack->inquiry_state <= GAP_INQUIRY_DURATION_MAX)){ 3804f5875de5SMatthias Ringwald uint8_t duration = hci_stack->inquiry_state; 3805beb3c81dSMatthias Ringwald hci_stack->inquiry_state = GAP_INQUIRY_STATE_W4_ACTIVE; 38068aee7be2SMilanka Ringwald hci_send_cmd(&hci_inquiry, GAP_IAC_GENERAL_INQUIRY, duration, 0); 3807f30077b7SMatthias Ringwald return true; 3808f5875de5SMatthias Ringwald } 3809f5875de5SMatthias Ringwald if (hci_stack->inquiry_state == GAP_INQUIRY_STATE_W2_CANCEL){ 3810f5875de5SMatthias Ringwald hci_stack->inquiry_state = GAP_INQUIRY_STATE_W4_CANCELLED; 3811f5875de5SMatthias Ringwald hci_send_cmd(&hci_inquiry_cancel); 3812f30077b7SMatthias Ringwald return true; 3813f5875de5SMatthias Ringwald } 3814b7f1ee76SMatthias Ringwald // remote name request 3815b7f1ee76SMatthias Ringwald if (hci_stack->remote_name_state == GAP_REMOTE_NAME_STATE_W2_SEND){ 3816b7f1ee76SMatthias Ringwald hci_stack->remote_name_state = GAP_REMOTE_NAME_STATE_W4_COMPLETE; 3817b7f1ee76SMatthias Ringwald hci_send_cmd(&hci_remote_name_request, hci_stack->remote_name_addr, 3818ee8a36c8SMatthias Ringwald hci_stack->remote_name_page_scan_repetition_mode, 0, hci_stack->remote_name_clock_offset); 3819f30077b7SMatthias Ringwald return true; 3820b7f1ee76SMatthias Ringwald } 3821cf01e888SMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB 3822cf01e888SMatthias Ringwald // Local OOB data 3823cf01e888SMatthias Ringwald if ((hci_stack->state == HCI_STATE_WORKING) && hci_stack->classic_read_local_oob_data){ 3824cf01e888SMatthias Ringwald hci_stack->classic_read_local_oob_data = false; 3825cf01e888SMatthias Ringwald if (hci_stack->local_supported_commands[1] & 0x10u){ 3826cf01e888SMatthias Ringwald hci_send_cmd(&hci_read_local_extended_oob_data); 3827cf01e888SMatthias Ringwald } else { 3828cf01e888SMatthias Ringwald hci_send_cmd(&hci_read_local_oob_data); 3829cf01e888SMatthias Ringwald } 3830cf01e888SMatthias Ringwald } 3831cf01e888SMatthias Ringwald #endif 38320a51f88bSMatthias Ringwald // pairing 38330a51f88bSMatthias Ringwald if (hci_stack->gap_pairing_state != GAP_PAIRING_STATE_IDLE){ 38340a51f88bSMatthias Ringwald uint8_t state = hci_stack->gap_pairing_state; 38350a51f88bSMatthias Ringwald hci_stack->gap_pairing_state = GAP_PAIRING_STATE_IDLE; 38360a51f88bSMatthias Ringwald switch (state){ 38370a51f88bSMatthias Ringwald case GAP_PAIRING_STATE_SEND_PIN: 3838aad97216SMatthias Ringwald hci_send_cmd(&hci_pin_code_request_reply, hci_stack->gap_pairing_addr, hci_stack->gap_pairing_pin_len, hci_stack->gap_pairing_input.gap_pairing_pin); 38390a51f88bSMatthias Ringwald break; 38400a51f88bSMatthias Ringwald case GAP_PAIRING_STATE_SEND_PIN_NEGATIVE: 38410a51f88bSMatthias Ringwald hci_send_cmd(&hci_pin_code_request_negative_reply, hci_stack->gap_pairing_addr); 38420a51f88bSMatthias Ringwald break; 38430a51f88bSMatthias Ringwald case GAP_PAIRING_STATE_SEND_PASSKEY: 3844d504181aSMatthias Ringwald hci_send_cmd(&hci_user_passkey_request_reply, hci_stack->gap_pairing_addr, hci_stack->gap_pairing_input.gap_pairing_passkey); 38450a51f88bSMatthias Ringwald break; 38460a51f88bSMatthias Ringwald case GAP_PAIRING_STATE_SEND_PASSKEY_NEGATIVE: 38470a51f88bSMatthias Ringwald hci_send_cmd(&hci_user_passkey_request_negative_reply, hci_stack->gap_pairing_addr); 38480a51f88bSMatthias Ringwald break; 38490a51f88bSMatthias Ringwald case GAP_PAIRING_STATE_SEND_CONFIRMATION: 38500a51f88bSMatthias Ringwald hci_send_cmd(&hci_user_confirmation_request_reply, hci_stack->gap_pairing_addr); 38510a51f88bSMatthias Ringwald break; 38520a51f88bSMatthias Ringwald case GAP_PAIRING_STATE_SEND_CONFIRMATION_NEGATIVE: 38530a51f88bSMatthias Ringwald hci_send_cmd(&hci_user_confirmation_request_negative_reply, hci_stack->gap_pairing_addr); 38540a51f88bSMatthias Ringwald break; 38550a51f88bSMatthias Ringwald default: 38560a51f88bSMatthias Ringwald break; 38570a51f88bSMatthias Ringwald } 3858f30077b7SMatthias Ringwald return true; 3859f30077b7SMatthias Ringwald } 3860f30077b7SMatthias Ringwald return false; 38610a51f88bSMatthias Ringwald } 386235454696SMatthias Ringwald #endif 3863b031bebbSmatthias.ringwald 3864a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE 3865f30077b7SMatthias Ringwald static bool hci_run_general_gap_le(void){ 3866f30077b7SMatthias Ringwald 3867f30077b7SMatthias Ringwald // advertisements, active scanning, and creating connections requires random address to be set if using private address 3868f30077b7SMatthias Ringwald 3869f30077b7SMatthias Ringwald if (hci_stack->state != HCI_STATE_WORKING) return false; 38704ea43905SMatthias Ringwald if ( (hci_stack->le_own_addr_type != BD_ADDR_TYPE_LE_PUBLIC) && (hci_stack->le_random_address_set == 0u) ) return false; 3871d70217a2SMatthias Ringwald 3872a41310b7SMatthias Ringwald 3873a41310b7SMatthias Ringwald // Phase 1: collect what to stop 3874a41310b7SMatthias Ringwald 3875a41310b7SMatthias Ringwald bool scanning_stop = false; 3876a41310b7SMatthias Ringwald bool connecting_stop = false; 3877a41310b7SMatthias Ringwald bool advertising_stop = false; 3878a41310b7SMatthias Ringwald 3879a41310b7SMatthias Ringwald #ifndef ENABLE_LE_CENTRAL 3880a41310b7SMatthias Ringwald UNUSED(scanning_stop); 38810abd9f64SMatthias Ringwald UNUSED(connecting_stop); 3882a41310b7SMatthias Ringwald #endif 3883a41310b7SMatthias Ringwald #ifndef ENABLE_LE_PERIPHERAL 3884a41310b7SMatthias Ringwald UNUSED(advertising_stop); 3885a41310b7SMatthias Ringwald #endif 3886a41310b7SMatthias Ringwald 388729c24bebSMatthias Ringwald // check if whitelist needs modification 388829c24bebSMatthias Ringwald bool whitelist_modification_pending = false; 388929c24bebSMatthias Ringwald btstack_linked_list_iterator_t lit; 389029c24bebSMatthias Ringwald btstack_linked_list_iterator_init(&lit, &hci_stack->le_whitelist); 389129c24bebSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&lit)){ 389229c24bebSMatthias Ringwald whitelist_entry_t * entry = (whitelist_entry_t*) btstack_linked_list_iterator_next(&lit); 389329c24bebSMatthias Ringwald if (entry->state & (LE_WHITELIST_REMOVE_FROM_CONTROLLER | LE_WHITELIST_ADD_TO_CONTROLLER)){ 389429c24bebSMatthias Ringwald whitelist_modification_pending = true; 389529c24bebSMatthias Ringwald break; 389629c24bebSMatthias Ringwald } 389729c24bebSMatthias Ringwald } 389821debf25SMatthias Ringwald // check if resolving list needs modification 389921debf25SMatthias Ringwald bool resolving_list_modification_pending = false; 390021debf25SMatthias Ringwald #ifdef ENABLE_LE_PRIVACY_ADDRESS_RESOLUTION 3901ea151974SMatthias Ringwald bool resolving_list_supported = (hci_stack->local_supported_commands[1] & (1 << 2)) != 0; 3902ea151974SMatthias Ringwald if (resolving_list_supported && hci_stack->le_resolving_list_state != LE_RESOLVING_LIST_DONE){ 390321debf25SMatthias Ringwald resolving_list_modification_pending = true; 390421debf25SMatthias Ringwald } 390521debf25SMatthias Ringwald #endif 390629c24bebSMatthias Ringwald 3907d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 3908fde725feSMatthias Ringwald // scanning control 39093251a108SMatthias Ringwald if (hci_stack->le_scanning_active) { 391029c24bebSMatthias Ringwald // stop if: 391129c24bebSMatthias Ringwald // - parameter change required 391229c24bebSMatthias Ringwald // - it's disabled 391329c24bebSMatthias Ringwald // - whitelist change required but used for scanning 391421debf25SMatthias Ringwald // - resolving list modified 391529c24bebSMatthias Ringwald bool scanning_uses_whitelist = (hci_stack->le_scan_filter_policy & 1) == 1; 391621debf25SMatthias Ringwald if ((hci_stack->le_scanning_param_update) || 391721debf25SMatthias Ringwald !hci_stack->le_scanning_enabled || 391821debf25SMatthias Ringwald scanning_uses_whitelist || 391921debf25SMatthias Ringwald resolving_list_modification_pending){ 392021debf25SMatthias Ringwald 39212d5c2a27SMatthias Ringwald scanning_stop = true; 3922fde725feSMatthias Ringwald } 3923fde725feSMatthias Ringwald } 392429c24bebSMatthias Ringwald #endif 3925fde725feSMatthias Ringwald 392629c24bebSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 392729c24bebSMatthias Ringwald // connecting control 3928f496d06eSMatthias Ringwald bool connecting_with_whitelist; 3929f496d06eSMatthias Ringwald switch (hci_stack->le_connecting_state){ 3930f496d06eSMatthias Ringwald case LE_CONNECTING_DIRECT: 3931f496d06eSMatthias Ringwald case LE_CONNECTING_WHITELIST: 3932af64f147SMatthias Ringwald // stop connecting if: 3933af64f147SMatthias Ringwald // - connecting uses white and whitelist modification pending 3934af64f147SMatthias Ringwald // - if it got disabled 393521debf25SMatthias Ringwald // - resolving list modified 3936f496d06eSMatthias Ringwald connecting_with_whitelist = hci_stack->le_connecting_state == LE_CONNECTING_WHITELIST; 3937f496d06eSMatthias Ringwald if ((connecting_with_whitelist && whitelist_modification_pending) || 393821debf25SMatthias Ringwald (hci_stack->le_connecting_request == LE_CONNECTING_IDLE) || 393921debf25SMatthias Ringwald resolving_list_modification_pending) { 394021debf25SMatthias Ringwald 394129c24bebSMatthias Ringwald connecting_stop = true; 394229c24bebSMatthias Ringwald } 3943f496d06eSMatthias Ringwald break; 3944f496d06eSMatthias Ringwald default: 3945f496d06eSMatthias Ringwald break; 394629c24bebSMatthias Ringwald } 3947d70217a2SMatthias Ringwald #endif 394829c24bebSMatthias Ringwald 3949d70217a2SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 395045c102fdSMatthias Ringwald // le advertisement control 3951bbc366e6SMatthias Ringwald if (hci_stack->le_advertisements_active){ 395229c24bebSMatthias Ringwald // stop if: 395329c24bebSMatthias Ringwald // - parameter change required 395429c24bebSMatthias Ringwald // - it's disabled 3955ba44ad41SMatthias Ringwald // - whitelist change required but used for advertisement filter policy 395621debf25SMatthias Ringwald // - resolving list modified 395729c24bebSMatthias Ringwald bool advertising_uses_whitelist = hci_stack->le_advertisements_filter_policy > 0; 395821debf25SMatthias Ringwald if ((hci_stack->le_advertisements_todo != 0) || 395921debf25SMatthias Ringwald !hci_stack->le_advertisements_enabled_for_current_roles || 396021debf25SMatthias Ringwald (advertising_uses_whitelist & whitelist_modification_pending) || 396121debf25SMatthias Ringwald resolving_list_modification_pending) { 396221debf25SMatthias Ringwald 3963fde725feSMatthias Ringwald advertising_stop = true; 3964fde725feSMatthias Ringwald } 3965fde725feSMatthias Ringwald } 3966a41310b7SMatthias Ringwald #endif 3967fde725feSMatthias Ringwald 3968a41310b7SMatthias Ringwald 3969a41310b7SMatthias Ringwald // Phase 2: stop everything that should be off during modifications 3970a41310b7SMatthias Ringwald 3971a41310b7SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 3972a41310b7SMatthias Ringwald if (scanning_stop){ 39735226d7f2SMatthias Ringwald hci_stack->le_scanning_active = false; 3974a41310b7SMatthias Ringwald hci_send_cmd(&hci_le_set_scan_enable, 0, 0); 3975a41310b7SMatthias Ringwald return true; 3976a41310b7SMatthias Ringwald } 3977a41310b7SMatthias Ringwald #endif 3978a41310b7SMatthias Ringwald 3979a41310b7SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 3980a41310b7SMatthias Ringwald if (connecting_stop){ 3981a41310b7SMatthias Ringwald hci_send_cmd(&hci_le_create_connection_cancel); 3982a41310b7SMatthias Ringwald return true; 3983a41310b7SMatthias Ringwald } 3984a41310b7SMatthias Ringwald #endif 3985a41310b7SMatthias Ringwald 3986a41310b7SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 3987fde725feSMatthias Ringwald if (advertising_stop){ 39885226d7f2SMatthias Ringwald hci_stack->le_advertisements_active = false; 398945c102fdSMatthias Ringwald hci_send_cmd(&hci_le_set_advertise_enable, 0); 3990f30077b7SMatthias Ringwald return true; 399145c102fdSMatthias Ringwald } 3992a41310b7SMatthias Ringwald #endif 3993fde725feSMatthias Ringwald 3994a41310b7SMatthias Ringwald // Phase 3: modify 3995a41310b7SMatthias Ringwald 3996a41310b7SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 3997a41310b7SMatthias Ringwald if (hci_stack->le_scanning_param_update){ 3998a41310b7SMatthias Ringwald hci_stack->le_scanning_param_update = false; 3999a41310b7SMatthias Ringwald hci_send_cmd(&hci_le_set_scan_parameters, hci_stack->le_scan_type, hci_stack->le_scan_interval, hci_stack->le_scan_window, 4000a41310b7SMatthias Ringwald hci_stack->le_own_addr_type, hci_stack->le_scan_filter_policy); 4001a41310b7SMatthias Ringwald return true; 4002a41310b7SMatthias Ringwald } 4003a41310b7SMatthias Ringwald #endif 4004a41310b7SMatthias Ringwald 4005a41310b7SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 400645c102fdSMatthias Ringwald if (hci_stack->le_advertisements_todo & LE_ADVERTISEMENT_TASKS_SET_PARAMS){ 400745c102fdSMatthias Ringwald hci_stack->le_advertisements_todo &= ~LE_ADVERTISEMENT_TASKS_SET_PARAMS; 400845c102fdSMatthias Ringwald hci_send_cmd(&hci_le_set_advertising_parameters, 400945c102fdSMatthias Ringwald hci_stack->le_advertisements_interval_min, 401045c102fdSMatthias Ringwald hci_stack->le_advertisements_interval_max, 401145c102fdSMatthias Ringwald hci_stack->le_advertisements_type, 4012b95a5a35SMatthias Ringwald hci_stack->le_own_addr_type, 401345c102fdSMatthias Ringwald hci_stack->le_advertisements_direct_address_type, 401445c102fdSMatthias Ringwald hci_stack->le_advertisements_direct_address, 401545c102fdSMatthias Ringwald hci_stack->le_advertisements_channel_map, 401645c102fdSMatthias Ringwald hci_stack->le_advertisements_filter_policy); 4017f30077b7SMatthias Ringwald return true; 401845c102fdSMatthias Ringwald } 4019501f56b3SMatthias Ringwald if (hci_stack->le_advertisements_todo & LE_ADVERTISEMENT_TASKS_SET_ADV_DATA){ 4020501f56b3SMatthias Ringwald hci_stack->le_advertisements_todo &= ~LE_ADVERTISEMENT_TASKS_SET_ADV_DATA; 40217a85e4f5SMatthias Ringwald uint8_t adv_data_clean[31]; 40227a85e4f5SMatthias Ringwald memset(adv_data_clean, 0, sizeof(adv_data_clean)); 40236535961aSMatthias Ringwald (void)memcpy(adv_data_clean, hci_stack->le_advertisements_data, 40246535961aSMatthias Ringwald hci_stack->le_advertisements_data_len); 40253c9da642SMatthias Ringwald btstack_replace_bd_addr_placeholder(adv_data_clean, hci_stack->le_advertisements_data_len, hci_stack->local_bd_addr); 40267a85e4f5SMatthias Ringwald hci_send_cmd(&hci_le_set_advertising_data, hci_stack->le_advertisements_data_len, adv_data_clean); 4027f30077b7SMatthias Ringwald return true; 402845c102fdSMatthias Ringwald } 4029501f56b3SMatthias Ringwald if (hci_stack->le_advertisements_todo & LE_ADVERTISEMENT_TASKS_SET_SCAN_DATA){ 4030501f56b3SMatthias Ringwald hci_stack->le_advertisements_todo &= ~LE_ADVERTISEMENT_TASKS_SET_SCAN_DATA; 4031f868b059SMatthias Ringwald uint8_t scan_data_clean[31]; 4032f868b059SMatthias Ringwald memset(scan_data_clean, 0, sizeof(scan_data_clean)); 40336535961aSMatthias Ringwald (void)memcpy(scan_data_clean, hci_stack->le_scan_response_data, 40346535961aSMatthias Ringwald hci_stack->le_scan_response_data_len); 40353c9da642SMatthias Ringwald btstack_replace_bd_addr_placeholder(scan_data_clean, hci_stack->le_scan_response_data_len, hci_stack->local_bd_addr); 4036214bfd60SMatthias Ringwald hci_send_cmd(&hci_le_set_scan_response_data, hci_stack->le_scan_response_data_len, scan_data_clean); 4037f30077b7SMatthias Ringwald return true; 4038501f56b3SMatthias Ringwald } 4039d70217a2SMatthias Ringwald #endif 40409956955bSMatthias Ringwald 404113eb2a2eSMatthias Ringwald 4042057ab60cSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 4043a41310b7SMatthias Ringwald // if connect with whitelist was active and is not cancelled yet, wait until next time 4044a41310b7SMatthias Ringwald if (hci_stack->le_connecting_state == LE_CONNECTING_CANCEL) return false; 4045057ab60cSMatthias Ringwald #endif 4046057ab60cSMatthias Ringwald 4047a41310b7SMatthias Ringwald // LE Whitelist Management 4048a41310b7SMatthias Ringwald if (whitelist_modification_pending){ 40499956955bSMatthias Ringwald // add/remove entries 4050665d90f2SMatthias Ringwald btstack_linked_list_iterator_init(&lit, &hci_stack->le_whitelist); 4051665d90f2SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&lit)){ 4052665d90f2SMatthias Ringwald whitelist_entry_t * entry = (whitelist_entry_t*) btstack_linked_list_iterator_next(&lit); 4053453459ddSMatthias Ringwald if (entry->state & LE_WHITELIST_REMOVE_FROM_CONTROLLER){ 4054453459ddSMatthias Ringwald entry->state &= ~LE_WHITELIST_REMOVE_FROM_CONTROLLER; 4055453459ddSMatthias Ringwald hci_send_cmd(&hci_le_remove_device_from_white_list, entry->address_type, entry->address); 4056453459ddSMatthias Ringwald return true; 4057453459ddSMatthias Ringwald } 40589956955bSMatthias Ringwald if (entry->state & LE_WHITELIST_ADD_TO_CONTROLLER){ 4059453459ddSMatthias Ringwald entry->state &= ~LE_WHITELIST_ADD_TO_CONTROLLER; 4060453459ddSMatthias Ringwald entry->state |= LE_WHITELIST_ON_CONTROLLER; 40619956955bSMatthias Ringwald hci_send_cmd(&hci_le_add_device_to_white_list, entry->address_type, entry->address); 4062f30077b7SMatthias Ringwald return true; 40639956955bSMatthias Ringwald } 4064453459ddSMatthias Ringwald if ((entry->state & LE_WHITELIST_ON_CONTROLLER) == 0){ 4065665d90f2SMatthias Ringwald btstack_linked_list_remove(&hci_stack->le_whitelist, (btstack_linked_item_t *) entry); 40669956955bSMatthias Ringwald btstack_memory_whitelist_entry_free(entry); 40679956955bSMatthias Ringwald } 40689956955bSMatthias Ringwald } 406991915b0bSMatthias Ringwald } 40709956955bSMatthias Ringwald 407121debf25SMatthias Ringwald #ifdef ENABLE_LE_PRIVACY_ADDRESS_RESOLUTION 407221debf25SMatthias Ringwald // LE Resolving List Management 4073ea151974SMatthias Ringwald if (resolving_list_supported) { 407421debf25SMatthias Ringwald uint16_t i; 407521debf25SMatthias Ringwald switch (hci_stack->le_resolving_list_state) { 407621debf25SMatthias Ringwald case LE_RESOLVING_LIST_SEND_ENABLE_ADDRESS_RESOLUTION: 407721debf25SMatthias Ringwald hci_stack->le_resolving_list_state = LE_RESOLVING_LIST_READ_SIZE; 407821debf25SMatthias Ringwald hci_send_cmd(&hci_le_set_address_resolution_enabled, 1); 407921debf25SMatthias Ringwald return true; 408021debf25SMatthias Ringwald case LE_RESOLVING_LIST_READ_SIZE: 408121debf25SMatthias Ringwald hci_stack->le_resolving_list_state = LE_RESOLVING_LIST_SEND_CLEAR; 408221debf25SMatthias Ringwald hci_send_cmd(&hci_le_read_resolving_list_size); 408321debf25SMatthias Ringwald return true; 408421debf25SMatthias Ringwald case LE_RESOLVING_LIST_SEND_CLEAR: 408502b02cffSMatthias Ringwald hci_stack->le_resolving_list_state = LE_RESOLVING_LIST_REMOVE_ENTRIES; 4086ea151974SMatthias Ringwald (void) memset(hci_stack->le_resolving_list_add_entries, 0xff, 4087ea151974SMatthias Ringwald sizeof(hci_stack->le_resolving_list_add_entries)); 4088ea151974SMatthias Ringwald (void) memset(hci_stack->le_resolving_list_remove_entries, 0, 4089ea151974SMatthias Ringwald sizeof(hci_stack->le_resolving_list_remove_entries)); 409021debf25SMatthias Ringwald hci_send_cmd(&hci_le_clear_resolving_list); 409121debf25SMatthias Ringwald return true; 409202b02cffSMatthias Ringwald case LE_RESOLVING_LIST_REMOVE_ENTRIES: 409302b02cffSMatthias Ringwald for (i = 0; i < MAX_NUM_RESOLVING_LIST_ENTRIES && i < le_device_db_max_count(); i++) { 409402b02cffSMatthias Ringwald uint8_t offset = i >> 3; 409502b02cffSMatthias Ringwald uint8_t mask = 1 << (i & 7); 409602b02cffSMatthias Ringwald if ((hci_stack->le_resolving_list_remove_entries[offset] & mask) == 0) continue; 409702b02cffSMatthias Ringwald hci_stack->le_resolving_list_remove_entries[offset] &= ~mask; 409802b02cffSMatthias Ringwald bd_addr_t peer_identity_addreses; 409902b02cffSMatthias Ringwald int peer_identity_addr_type = (int) BD_ADDR_TYPE_UNKNOWN; 410002b02cffSMatthias Ringwald sm_key_t peer_irk; 410102b02cffSMatthias Ringwald le_device_db_info(i, &peer_identity_addr_type, peer_identity_addreses, peer_irk); 410202b02cffSMatthias Ringwald if (peer_identity_addr_type == BD_ADDR_TYPE_UNKNOWN) continue; 4103f5228c62SMatthias Ringwald 4104f5228c62SMatthias Ringwald #ifdef ENABLE_LE_WHITELIST_TOUCH_AFTER_RESOLVING_LIST_UPDATE 4105f5228c62SMatthias Ringwald // trigger whitelist entry 'update' (work around for controller bug) 4106f5228c62SMatthias Ringwald btstack_linked_list_iterator_init(&lit, &hci_stack->le_whitelist); 4107f5228c62SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&lit)) { 4108f5228c62SMatthias Ringwald whitelist_entry_t *entry = (whitelist_entry_t *) btstack_linked_list_iterator_next(&lit); 4109f5228c62SMatthias Ringwald if (entry->address_type != peer_identity_addr_type) continue; 4110f5228c62SMatthias Ringwald if (memcmp(entry->address, peer_identity_addreses, 6) != 0) continue; 4111f5228c62SMatthias Ringwald log_info("trigger whitelist update %s", bd_addr_to_str(peer_identity_addreses)); 4112f5228c62SMatthias Ringwald entry->state |= LE_WHITELIST_REMOVE_FROM_CONTROLLER | LE_WHITELIST_ADD_TO_CONTROLLER; 4113f5228c62SMatthias Ringwald } 4114f5228c62SMatthias Ringwald #endif 4115f5228c62SMatthias Ringwald 4116ea151974SMatthias Ringwald hci_send_cmd(&hci_le_remove_device_from_resolving_list, peer_identity_addr_type, 4117ea151974SMatthias Ringwald peer_identity_addreses); 411802b02cffSMatthias Ringwald return true; 411902b02cffSMatthias Ringwald } 412002b02cffSMatthias Ringwald 412102b02cffSMatthias Ringwald hci_stack->le_resolving_list_state = LE_RESOLVING_LIST_ADD_ENTRIES; 412202b02cffSMatthias Ringwald 412302b02cffSMatthias Ringwald /* fall through */ 412402b02cffSMatthias Ringwald 412521debf25SMatthias Ringwald case LE_RESOLVING_LIST_ADD_ENTRIES: 412621debf25SMatthias Ringwald for (i = 0; i < MAX_NUM_RESOLVING_LIST_ENTRIES && i < le_device_db_max_count(); i++) { 412721debf25SMatthias Ringwald uint8_t offset = i >> 3; 412821debf25SMatthias Ringwald uint8_t mask = 1 << (i & 7); 412902b02cffSMatthias Ringwald if ((hci_stack->le_resolving_list_add_entries[offset] & mask) == 0) continue; 413002b02cffSMatthias Ringwald hci_stack->le_resolving_list_add_entries[offset] &= ~mask; 413121debf25SMatthias Ringwald bd_addr_t peer_identity_addreses; 413221debf25SMatthias Ringwald int peer_identity_addr_type = (int) BD_ADDR_TYPE_UNKNOWN; 413321debf25SMatthias Ringwald sm_key_t peer_irk; 413421debf25SMatthias Ringwald le_device_db_info(i, &peer_identity_addr_type, peer_identity_addreses, peer_irk); 413521debf25SMatthias Ringwald if (peer_identity_addr_type == BD_ADDR_TYPE_UNKNOWN) continue; 413621debf25SMatthias Ringwald const uint8_t *local_irk = gap_get_persistent_irk(); 413721debf25SMatthias Ringwald // command uses format specifier 'P' that stores 16-byte value without flip 413821debf25SMatthias Ringwald uint8_t local_irk_flipped[16]; 413921debf25SMatthias Ringwald uint8_t peer_irk_flipped[16]; 414021debf25SMatthias Ringwald reverse_128(local_irk, local_irk_flipped); 414121debf25SMatthias Ringwald reverse_128(peer_irk, peer_irk_flipped); 4142ea151974SMatthias Ringwald hci_send_cmd(&hci_le_add_device_to_resolving_list, peer_identity_addr_type, peer_identity_addreses, 4143ea151974SMatthias Ringwald peer_irk_flipped, local_irk_flipped); 414421debf25SMatthias Ringwald return true; 414521debf25SMatthias Ringwald } 414602b02cffSMatthias Ringwald hci_stack->le_resolving_list_state = LE_RESOLVING_LIST_DONE; 414721debf25SMatthias Ringwald break; 414802b02cffSMatthias Ringwald 414921debf25SMatthias Ringwald default: 415021debf25SMatthias Ringwald break; 415121debf25SMatthias Ringwald } 4152ea151974SMatthias Ringwald } 415321debf25SMatthias Ringwald hci_stack->le_resolving_list_state = LE_RESOLVING_LIST_DONE; 415421debf25SMatthias Ringwald #endif 4155a41310b7SMatthias Ringwald 4156a41310b7SMatthias Ringwald // Phase 4: restore state 415729c24bebSMatthias Ringwald 415829c24bebSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 4159af64f147SMatthias Ringwald // re-start scanning 416029c24bebSMatthias Ringwald if ((hci_stack->le_scanning_enabled && !hci_stack->le_scanning_active)){ 416129c24bebSMatthias Ringwald hci_stack->le_scanning_active = true; 416229c24bebSMatthias Ringwald hci_send_cmd(&hci_le_set_scan_enable, 1, 0); 416329c24bebSMatthias Ringwald return true; 416429c24bebSMatthias Ringwald } 416529c24bebSMatthias Ringwald #endif 416629c24bebSMatthias Ringwald 416713eb2a2eSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 4168af64f147SMatthias Ringwald // re-start connecting 4169af64f147SMatthias Ringwald if ( (hci_stack->le_connecting_state == LE_CONNECTING_IDLE) && (hci_stack->le_connecting_request == LE_CONNECTING_WHITELIST)){ 41709956955bSMatthias Ringwald bd_addr_t null_addr; 41719956955bSMatthias Ringwald memset(null_addr, 0, 6); 41729956955bSMatthias Ringwald hci_send_cmd(&hci_le_create_connection, 4173cbe54ab2SJakob Krantz hci_stack->le_connection_scan_interval, // scan interval: 60 ms 4174cbe54ab2SJakob Krantz hci_stack->le_connection_scan_window, // scan interval: 30 ms 41759956955bSMatthias Ringwald 1, // use whitelist 41769956955bSMatthias Ringwald 0, // peer address type 41779956955bSMatthias Ringwald null_addr, // peer bd addr 4178b95a5a35SMatthias Ringwald hci_stack->le_own_addr_type, // our addr type: 417973044eb2SMatthias Ringwald hci_stack->le_connection_interval_min, // conn interval min 418073044eb2SMatthias Ringwald hci_stack->le_connection_interval_max, // conn interval max 418173044eb2SMatthias Ringwald hci_stack->le_connection_latency, // conn latency 418273044eb2SMatthias Ringwald hci_stack->le_supervision_timeout, // conn latency 418373044eb2SMatthias Ringwald hci_stack->le_minimum_ce_length, // min ce length 418473044eb2SMatthias Ringwald hci_stack->le_maximum_ce_length // max ce length 41859956955bSMatthias Ringwald ); 4186f30077b7SMatthias Ringwald return true; 41879956955bSMatthias Ringwald } 4188d70217a2SMatthias Ringwald #endif 4189a41310b7SMatthias Ringwald 4190a41310b7SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 4191a41310b7SMatthias Ringwald // re-start advertising 41928978dcf1SMatthias Ringwald if (hci_stack->le_advertisements_enabled_for_current_roles && !hci_stack->le_advertisements_active){ 4193a41310b7SMatthias Ringwald // check if advertisements should be enabled given 41945226d7f2SMatthias Ringwald hci_stack->le_advertisements_active = true; 4195a41310b7SMatthias Ringwald hci_send_cmd(&hci_le_set_advertise_enable, 1); 4196a41310b7SMatthias Ringwald return true; 4197a41310b7SMatthias Ringwald } 4198a41310b7SMatthias Ringwald #endif 4199a41310b7SMatthias Ringwald 4200f30077b7SMatthias Ringwald return false; 42017bdc6798S[email protected] } 4202b2f949feS[email protected] #endif 42037bdc6798S[email protected] 420488a03c8dSMatthias Ringwald static bool hci_run_general_pending_commands(void){ 4205f30077b7SMatthias Ringwald btstack_linked_item_t * it; 4206a0da043fSMatthias Ringwald for (it = (btstack_linked_item_t *) hci_stack->connections; it != NULL; it = it->next){ 420705ae8de3SMatthias Ringwald hci_connection_t * connection = (hci_connection_t *) it; 420832ab9390Smatthias.ringwald 42090bf6344aS[email protected] switch(connection->state){ 42100bf6344aS[email protected] case SEND_CREATE_CONNECTION: 42114f3229d8S[email protected] switch(connection->address_type){ 421235454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 4213f16129ceSMatthias Ringwald case BD_ADDR_TYPE_ACL: 42149da54300S[email protected] log_info("sending hci_create_connection"); 4215b4eb4420SMatthias Ringwald hci_send_cmd(&hci_create_connection, connection->address, hci_usable_acl_packet_types(), 0, 0, 0, hci_stack->allow_role_switch); 42164f3229d8S[email protected] break; 421735454696SMatthias Ringwald #endif 42184f3229d8S[email protected] default: 4219a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE 4220d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 42219da54300S[email protected] log_info("sending hci_le_create_connection"); 42224f3229d8S[email protected] hci_send_cmd(&hci_le_create_connection, 4223cbe54ab2SJakob Krantz hci_stack->le_connection_scan_interval, // conn scan interval 4224cbe54ab2SJakob Krantz hci_stack->le_connection_scan_window, // conn scan windows 42254f3229d8S[email protected] 0, // don't use whitelist 42264f3229d8S[email protected] connection->address_type, // peer address type 42274f3229d8S[email protected] connection->address, // peer bd addr 4228b95a5a35SMatthias Ringwald hci_stack->le_own_addr_type, // our addr type: 422973044eb2SMatthias Ringwald hci_stack->le_connection_interval_min, // conn interval min 423073044eb2SMatthias Ringwald hci_stack->le_connection_interval_max, // conn interval max 423173044eb2SMatthias Ringwald hci_stack->le_connection_latency, // conn latency 423273044eb2SMatthias Ringwald hci_stack->le_supervision_timeout, // conn latency 423373044eb2SMatthias Ringwald hci_stack->le_minimum_ce_length, // min ce length 423473044eb2SMatthias Ringwald hci_stack->le_maximum_ce_length // max ce length 42354f3229d8S[email protected] ); 42364f3229d8S[email protected] connection->state = SENT_CREATE_CONNECTION; 4237b2f949feS[email protected] #endif 4238d70217a2SMatthias Ringwald #endif 42394f3229d8S[email protected] break; 42404f3229d8S[email protected] } 4241f30077b7SMatthias Ringwald return true; 4242ad83dc6aS[email protected] 424335454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 42440bf6344aS[email protected] case RECEIVED_CONNECTION_REQUEST: 42455cf766e8SMatthias Ringwald connection->role = HCI_ROLE_SLAVE; 4246f16129ceSMatthias Ringwald if (connection->address_type == BD_ADDR_TYPE_ACL){ 424776ccfb2aSMatthias Ringwald log_info("sending hci_accept_connection_request"); 4248895f6685SMilanka Ringwald connection->state = ACCEPTED_CONNECTION_REQUEST; 4249c4c88f1bSJakob Krantz hci_send_cmd(&hci_accept_connection_request, connection->address, hci_stack->master_slave_policy); 4250e35edcc1S[email protected] } 4251f30077b7SMatthias Ringwald return true; 425235454696SMatthias Ringwald #endif 42530bf6344aS[email protected] 4254a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE 4255d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 42560bf6344aS[email protected] case SEND_CANCEL_CONNECTION: 42570bf6344aS[email protected] connection->state = SENT_CANCEL_CONNECTION; 42580bf6344aS[email protected] hci_send_cmd(&hci_le_create_connection_cancel); 4259f30077b7SMatthias Ringwald return true; 4260a6725849S[email protected] #endif 4261d70217a2SMatthias Ringwald #endif 42620bf6344aS[email protected] case SEND_DISCONNECT: 42630bf6344aS[email protected] connection->state = SENT_DISCONNECT; 42646ef3696aSMatthias Ringwald hci_send_cmd(&hci_disconnect, connection->con_handle, ERROR_CODE_REMOTE_USER_TERMINATED_CONNECTION); 4265f30077b7SMatthias Ringwald return true; 42660bf6344aS[email protected] 42670bf6344aS[email protected] default: 42680bf6344aS[email protected] break; 4269c7e0c5f6Smatthias.ringwald } 4270c7e0c5f6Smatthias.ringwald 4271cabf004eSMatthias Ringwald // no further commands if connection is about to get shut down 4272cabf004eSMatthias Ringwald if (connection->state == SENT_DISCONNECT) continue; 4273cabf004eSMatthias Ringwald 4274891b9fc2SMatthias Ringwald if (connection->authentication_flags & READ_RSSI){ 4275891b9fc2SMatthias Ringwald connectionClearAuthenticationFlags(connection, READ_RSSI); 4276891b9fc2SMatthias Ringwald hci_send_cmd(&hci_read_rssi, connection->con_handle); 4277f30077b7SMatthias Ringwald return true; 4278891b9fc2SMatthias Ringwald } 4279891b9fc2SMatthias Ringwald 428094418890SMatthias Ringwald #ifdef ENABLE_CLASSIC 428194418890SMatthias Ringwald 42826909f064SMatthias Ringwald if (connection->authentication_flags & WRITE_SUPERVISION_TIMEOUT){ 42836909f064SMatthias Ringwald connectionClearAuthenticationFlags(connection, WRITE_SUPERVISION_TIMEOUT); 42846909f064SMatthias Ringwald hci_send_cmd(&hci_write_link_supervision_timeout, connection->con_handle, hci_stack->link_supervision_timeout); 4285f30077b7SMatthias Ringwald return true; 42866909f064SMatthias Ringwald } 42876909f064SMatthias Ringwald 428832ab9390Smatthias.ringwald if (connection->authentication_flags & HANDLE_LINK_KEY_REQUEST){ 4289608f51bbSMatthias Ringwald log_info("responding to link key request, have link key db: %u", hci_stack->link_key_db != NULL); 429034d2123cS[email protected] connectionClearAuthenticationFlags(connection, HANDLE_LINK_KEY_REQUEST); 429130e72d78SMatthias Ringwald 429232ab9390Smatthias.ringwald link_key_t link_key; 4293c77e8838S[email protected] link_key_type_t link_key_type; 429430e72d78SMatthias Ringwald bool have_link_key = hci_stack->link_key_db && hci_stack->link_key_db->get_link_key(connection->address, link_key, &link_key_type); 429530e72d78SMatthias Ringwald 429630e72d78SMatthias Ringwald const uint16_t sc_enabled_mask = BONDING_REMOTE_SUPPORTS_SC_HOST | BONDING_REMOTE_SUPPORTS_SC_CONTROLLER; 429730e72d78SMatthias Ringwald bool sc_enabled_remote = (connection->bonding_flags & sc_enabled_mask) == sc_enabled_mask; 429830e72d78SMatthias Ringwald bool sc_downgrade = have_link_key && (gap_secure_connection_for_link_key_type(link_key_type) == 1) && !sc_enabled_remote; 429930e72d78SMatthias Ringwald if (sc_downgrade){ 430030e72d78SMatthias Ringwald log_info("Link key based on SC, but remote does not support SC -> disconnect"); 430130e72d78SMatthias Ringwald connection->state = SENT_DISCONNECT; 430230e72d78SMatthias Ringwald hci_send_cmd(&hci_disconnect, connection->con_handle, ERROR_CODE_AUTHENTICATION_FAILURE); 430330e72d78SMatthias Ringwald return true; 430430e72d78SMatthias Ringwald } 430530e72d78SMatthias Ringwald 430630e72d78SMatthias Ringwald bool security_level_sufficient = have_link_key && (gap_security_level_for_link_key_type(link_key_type) >= connection->requested_security_level); 430730e72d78SMatthias Ringwald if (have_link_key && security_level_sufficient){ 43089ab95c90S[email protected] connection->link_key_type = link_key_type; 430932ab9390Smatthias.ringwald hci_send_cmd(&hci_link_key_request_reply, connection->address, &link_key); 431032ab9390Smatthias.ringwald } else { 431132ab9390Smatthias.ringwald hci_send_cmd(&hci_link_key_request_negative_reply, connection->address); 431232ab9390Smatthias.ringwald } 4313f30077b7SMatthias Ringwald return true; 431432ab9390Smatthias.ringwald } 43151d6b20aeS[email protected] 4316899283eaS[email protected] if (connection->authentication_flags & DENY_PIN_CODE_REQUEST){ 43179da54300S[email protected] log_info("denying to pin request"); 4318899283eaS[email protected] connectionClearAuthenticationFlags(connection, DENY_PIN_CODE_REQUEST); 431934d2123cS[email protected] hci_send_cmd(&hci_pin_code_request_negative_reply, connection->address); 4320f30077b7SMatthias Ringwald return true; 43214c57c146S[email protected] } 43224c57c146S[email protected] 4323dbe1a790S[email protected] if (connection->authentication_flags & SEND_IO_CAPABILITIES_REPLY){ 432434d2123cS[email protected] connectionClearAuthenticationFlags(connection, SEND_IO_CAPABILITIES_REPLY); 4325106d6d11S[email protected] // tweak authentication requirements 43263a9fb326S[email protected] uint8_t authreq = hci_stack->ssp_authentication_requirement; 4327106d6d11S[email protected] if (connection->bonding_flags & BONDING_DEDICATED){ 43289faad3abS[email protected] authreq = SSP_IO_AUTHREQ_MITM_PROTECTION_NOT_REQUIRED_DEDICATED_BONDING; 43299faad3abS[email protected] } 43309faad3abS[email protected] if (gap_mitm_protection_required_for_security_level(connection->requested_security_level)){ 43319faad3abS[email protected] authreq |= 1; 4332106d6d11S[email protected] } 43331849becdSMatthias Ringwald uint8_t have_oob_data = 0; 43341849becdSMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB 43351849becdSMatthias Ringwald if (connection->classic_oob_c_192 != NULL){ 43361849becdSMatthias Ringwald have_oob_data |= 1; 43371849becdSMatthias Ringwald } 43381849becdSMatthias Ringwald if (connection->classic_oob_c_256 != NULL){ 43391849becdSMatthias Ringwald have_oob_data |= 2; 43401849becdSMatthias Ringwald } 43411849becdSMatthias Ringwald #endif 43421849becdSMatthias Ringwald hci_send_cmd(&hci_io_capability_request_reply, &connection->address, hci_stack->ssp_io_capability, have_oob_data, authreq); 434311b03efaSMatthias Ringwald return true; 4344f8fb5f6eS[email protected] } 434511b03efaSMatthias Ringwald 434611b03efaSMatthias Ringwald if (connection->authentication_flags & SEND_IO_CAPABILITIES_NEGATIVE_REPLY) { 434711b03efaSMatthias Ringwald connectionClearAuthenticationFlags(connection, SEND_IO_CAPABILITIES_NEGATIVE_REPLY); 434811b03efaSMatthias Ringwald hci_send_cmd(&hci_io_capability_request_negative_reply, &connection->address, ERROR_CODE_PAIRING_NOT_ALLOWED); 4349f30077b7SMatthias Ringwald return true; 435032ab9390Smatthias.ringwald } 435132ab9390Smatthias.ringwald 43521849becdSMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB 43531849becdSMatthias Ringwald if (connection->authentication_flags & SEND_REMOTE_OOB_DATA_REPLY){ 43541849becdSMatthias Ringwald connectionClearAuthenticationFlags(connection, SEND_REMOTE_OOB_DATA_REPLY); 43551849becdSMatthias Ringwald const uint8_t zero[16] = { 0 }; 43561849becdSMatthias Ringwald const uint8_t * r_192 = zero; 43571849becdSMatthias Ringwald const uint8_t * c_192 = zero; 43581849becdSMatthias Ringwald const uint8_t * r_256 = zero; 43591849becdSMatthias Ringwald const uint8_t * c_256 = zero; 43601849becdSMatthias Ringwald // verify P-256 OOB 43611849becdSMatthias Ringwald if ((connection->classic_oob_c_256 != NULL) && ((hci_stack->local_supported_commands[1] & 0x08u) != 0)) { 43621849becdSMatthias Ringwald c_256 = connection->classic_oob_c_256; 43631849becdSMatthias Ringwald if (connection->classic_oob_r_256 != NULL) { 43641849becdSMatthias Ringwald r_256 = connection->classic_oob_r_256; 43651849becdSMatthias Ringwald } 43661849becdSMatthias Ringwald } 43671849becdSMatthias Ringwald // verify P-192 OOB 43681849becdSMatthias Ringwald if ((connection->classic_oob_c_192 != NULL)) { 43691849becdSMatthias Ringwald c_192 = connection->classic_oob_c_192; 43701849becdSMatthias Ringwald if (connection->classic_oob_r_192 != NULL) { 43711849becdSMatthias Ringwald r_192 = connection->classic_oob_r_192; 43721849becdSMatthias Ringwald } 43731849becdSMatthias Ringwald } 43741849becdSMatthias Ringwald // Reply 43751849becdSMatthias Ringwald if (c_256 != zero) { 43761849becdSMatthias Ringwald hci_send_cmd(&hci_remote_oob_extended_data_request_reply, &connection->address, c_192, r_192, c_256, r_256); 43771849becdSMatthias Ringwald } else if (c_192 != zero){ 43781849becdSMatthias Ringwald hci_send_cmd(&hci_remote_oob_data_request_reply, &connection->address, c_192, r_192); 43791849becdSMatthias Ringwald } else { 43801849becdSMatthias Ringwald hci_send_cmd(&hci_remote_oob_data_request_negative_reply, &connection->address); 43811849becdSMatthias Ringwald } 43821849becdSMatthias Ringwald return true; 43831849becdSMatthias Ringwald } 43841849becdSMatthias Ringwald #endif 43851849becdSMatthias Ringwald 4386dbe1a790S[email protected] if (connection->authentication_flags & SEND_USER_CONFIRM_REPLY){ 4387dbe1a790S[email protected] connectionClearAuthenticationFlags(connection, SEND_USER_CONFIRM_REPLY); 438834d2123cS[email protected] hci_send_cmd(&hci_user_confirmation_request_reply, &connection->address); 4389f30077b7SMatthias Ringwald return true; 4390dbe1a790S[email protected] } 4391dbe1a790S[email protected] 4392dbe1a790S[email protected] if (connection->authentication_flags & SEND_USER_PASSKEY_REPLY){ 4393dbe1a790S[email protected] connectionClearAuthenticationFlags(connection, SEND_USER_PASSKEY_REPLY); 439434d2123cS[email protected] hci_send_cmd(&hci_user_passkey_request_reply, &connection->address, 000000); 4395f30077b7SMatthias Ringwald return true; 4396dbe1a790S[email protected] } 4397afd4e962S[email protected] 4398ba018746SMatthias Ringwald if (connection->bonding_flags & BONDING_REQUEST_REMOTE_FEATURES_PAGE_0){ 4399ba018746SMatthias Ringwald connection->bonding_flags &= ~BONDING_REQUEST_REMOTE_FEATURES_PAGE_0; 440034d2123cS[email protected] hci_send_cmd(&hci_read_remote_supported_features_command, connection->con_handle); 4401f30077b7SMatthias Ringwald return true; 44022bd8b7e7S[email protected] } 44032bd8b7e7S[email protected] 44045ccef624SMatthias Ringwald if (connection->bonding_flags & BONDING_REQUEST_REMOTE_FEATURES_PAGE_1){ 44055ccef624SMatthias Ringwald connection->bonding_flags &= ~BONDING_REQUEST_REMOTE_FEATURES_PAGE_1; 44065ccef624SMatthias Ringwald hci_send_cmd(&hci_read_remote_extended_features_command, connection->con_handle, 1); 44075ccef624SMatthias Ringwald return true; 44085ccef624SMatthias Ringwald } 44095ccef624SMatthias Ringwald 441082721f83SMatthias Ringwald if (connection->bonding_flags & BONDING_REQUEST_REMOTE_FEATURES_PAGE_2){ 441182721f83SMatthias Ringwald connection->bonding_flags &= ~BONDING_REQUEST_REMOTE_FEATURES_PAGE_2; 441282721f83SMatthias Ringwald hci_send_cmd(&hci_read_remote_extended_features_command, connection->con_handle, 2); 441382721f83SMatthias Ringwald return true; 441482721f83SMatthias Ringwald } 441582721f83SMatthias Ringwald 4416ad83dc6aS[email protected] if (connection->bonding_flags & BONDING_DISCONNECT_DEDICATED_DONE){ 4417ad83dc6aS[email protected] connection->bonding_flags &= ~BONDING_DISCONNECT_DEDICATED_DONE; 44181bd5283dS[email protected] connection->bonding_flags |= BONDING_EMIT_COMPLETE_ON_DISCONNECT; 44196ef3696aSMatthias Ringwald connection->state = SENT_DISCONNECT; 44206ef3696aSMatthias Ringwald hci_send_cmd(&hci_disconnect, connection->con_handle, ERROR_CODE_REMOTE_USER_TERMINATED_CONNECTION); 4421f30077b7SMatthias Ringwald return true; 4422ad83dc6aS[email protected] } 442376f27cffSMatthias Ringwald 442434d2123cS[email protected] if (connection->bonding_flags & BONDING_SEND_AUTHENTICATE_REQUEST){ 442534d2123cS[email protected] connection->bonding_flags &= ~BONDING_SEND_AUTHENTICATE_REQUEST; 4426abdad579SMatthias Ringwald connection->bonding_flags |= BONDING_SENT_AUTHENTICATE_REQUEST; 442734d2123cS[email protected] hci_send_cmd(&hci_authentication_requested, connection->con_handle); 4428f30077b7SMatthias Ringwald return true; 4429afd4e962S[email protected] } 443076f27cffSMatthias Ringwald 4431dce78009S[email protected] if (connection->bonding_flags & BONDING_SEND_ENCRYPTION_REQUEST){ 4432dce78009S[email protected] connection->bonding_flags &= ~BONDING_SEND_ENCRYPTION_REQUEST; 4433dce78009S[email protected] hci_send_cmd(&hci_set_connection_encryption, connection->con_handle, 1); 4434f30077b7SMatthias Ringwald return true; 4435dce78009S[email protected] } 4436573897a0SMatthias Ringwald if (connection->bonding_flags & BONDING_SEND_READ_ENCRYPTION_KEY_SIZE){ 4437573897a0SMatthias Ringwald connection->bonding_flags &= ~BONDING_SEND_READ_ENCRYPTION_KEY_SIZE; 4438573897a0SMatthias Ringwald hci_send_cmd(&hci_read_encryption_key_size, connection->con_handle, 1); 4439f30077b7SMatthias Ringwald return true; 4440573897a0SMatthias Ringwald } 444176f27cffSMatthias Ringwald #endif 444276f27cffSMatthias Ringwald 444376f27cffSMatthias Ringwald if (connection->bonding_flags & BONDING_DISCONNECT_SECURITY_BLOCK){ 444476f27cffSMatthias Ringwald connection->bonding_flags &= ~BONDING_DISCONNECT_SECURITY_BLOCK; 44456ef3696aSMatthias Ringwald if (connection->state != SENT_DISCONNECT){ 44466ef3696aSMatthias Ringwald connection->state = SENT_DISCONNECT; 44476ef3696aSMatthias Ringwald hci_send_cmd(&hci_disconnect, connection->con_handle, ERROR_CODE_AUTHENTICATION_FAILURE); 4448f30077b7SMatthias Ringwald return true; 444976f27cffSMatthias Ringwald } 44506ef3696aSMatthias Ringwald } 4451da886c03S[email protected] 44526cdc2862SMatthias Ringwald #ifdef ENABLE_CLASSIC 4453f8ee3071SMatthias Ringwald uint16_t sniff_min_interval; 4454f8ee3071SMatthias Ringwald switch (connection->sniff_min_interval){ 4455f8ee3071SMatthias Ringwald case 0: 4456f8ee3071SMatthias Ringwald break; 4457f8ee3071SMatthias Ringwald case 0xffff: 4458f8ee3071SMatthias Ringwald connection->sniff_min_interval = 0; 4459f8ee3071SMatthias Ringwald hci_send_cmd(&hci_exit_sniff_mode, connection->con_handle); 4460f30077b7SMatthias Ringwald return true; 4461f8ee3071SMatthias Ringwald default: 4462f8ee3071SMatthias Ringwald sniff_min_interval = connection->sniff_min_interval; 4463f8ee3071SMatthias Ringwald connection->sniff_min_interval = 0; 4464f8ee3071SMatthias Ringwald hci_send_cmd(&hci_sniff_mode, connection->con_handle, connection->sniff_max_interval, sniff_min_interval, connection->sniff_attempt, connection->sniff_timeout); 4465f30077b7SMatthias Ringwald return true; 4466f8ee3071SMatthias Ringwald } 446788a03c8dSMatthias Ringwald 446888a03c8dSMatthias Ringwald if (connection->request_role != HCI_ROLE_INVALID){ 446988a03c8dSMatthias Ringwald hci_role_t role = connection->request_role; 447088a03c8dSMatthias Ringwald connection->request_role = HCI_ROLE_INVALID; 447188a03c8dSMatthias Ringwald hci_send_cmd(&hci_switch_role_command, connection->address, role); 447288a03c8dSMatthias Ringwald return true; 447388a03c8dSMatthias Ringwald } 44746cdc2862SMatthias Ringwald #endif 4475f8ee3071SMatthias Ringwald 4476a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE 447773cd8a2aSMatthias Ringwald switch (connection->le_con_parameter_update_state){ 447873cd8a2aSMatthias Ringwald // response to L2CAP CON PARAMETER UPDATE REQUEST 447973cd8a2aSMatthias Ringwald case CON_PARAMETER_UPDATE_CHANGE_HCI_CON_PARAMETERS: 4480da886c03S[email protected] connection->le_con_parameter_update_state = CON_PARAMETER_UPDATE_NONE; 448173cd8a2aSMatthias Ringwald hci_send_cmd(&hci_le_connection_update, connection->con_handle, connection->le_conn_interval_min, 4482c37a3166S[email protected] connection->le_conn_interval_max, connection->le_conn_latency, connection->le_supervision_timeout, 4483c37a3166S[email protected] 0x0000, 0xffff); 4484f30077b7SMatthias Ringwald return true; 448573cd8a2aSMatthias Ringwald case CON_PARAMETER_UPDATE_REPLY: 448673cd8a2aSMatthias Ringwald connection->le_con_parameter_update_state = CON_PARAMETER_UPDATE_NONE; 448773cd8a2aSMatthias Ringwald hci_send_cmd(&hci_le_remote_connection_parameter_request_reply, connection->con_handle, connection->le_conn_interval_min, 448873cd8a2aSMatthias Ringwald connection->le_conn_interval_max, connection->le_conn_latency, connection->le_supervision_timeout, 448973cd8a2aSMatthias Ringwald 0x0000, 0xffff); 4490f30077b7SMatthias Ringwald return true; 449173cd8a2aSMatthias Ringwald case CON_PARAMETER_UPDATE_NEGATIVE_REPLY: 449273cd8a2aSMatthias Ringwald connection->le_con_parameter_update_state = CON_PARAMETER_UPDATE_NONE; 449373cd8a2aSMatthias Ringwald hci_send_cmd(&hci_le_remote_connection_parameter_request_negative_reply, ERROR_CODE_UNSUPPORTED_LMP_PARAMETER_VALUE_UNSUPPORTED_LL_PARAMETER_VALUE); 4494f30077b7SMatthias Ringwald return true; 449573cd8a2aSMatthias Ringwald default: 449673cd8a2aSMatthias Ringwald break; 4497c37a3166S[email protected] } 44984ea43905SMatthias Ringwald if (connection->le_phy_update_all_phys != 0xffu){ 4499b90f6e0aSMatthias Ringwald uint8_t all_phys = connection->le_phy_update_all_phys; 4500b90f6e0aSMatthias Ringwald connection->le_phy_update_all_phys = 0xff; 4501b90f6e0aSMatthias 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); 4502f30077b7SMatthias Ringwald return true; 4503b90f6e0aSMatthias Ringwald } 4504c37a3166S[email protected] #endif 4505dbe1a790S[email protected] } 4506f30077b7SMatthias Ringwald return false; 4507f30077b7SMatthias Ringwald } 4508c7e0c5f6Smatthias.ringwald 4509f30077b7SMatthias Ringwald static void hci_run(void){ 4510f30077b7SMatthias Ringwald 4511f30077b7SMatthias Ringwald bool done; 4512f30077b7SMatthias Ringwald 4513f30077b7SMatthias Ringwald // send continuation fragments first, as they block the prepared packet buffer 4514f30077b7SMatthias Ringwald done = hci_run_acl_fragments(); 4515f30077b7SMatthias Ringwald if (done) return; 4516f30077b7SMatthias Ringwald 4517f30077b7SMatthias Ringwald #ifdef ENABLE_HCI_CONTROLLER_TO_HOST_FLOW_CONTROL 4518f30077b7SMatthias Ringwald // send host num completed packets next as they don't require num_cmd_packets > 0 4519f30077b7SMatthias Ringwald if (!hci_can_send_comand_packet_transport()) return; 4520f30077b7SMatthias Ringwald if (hci_stack->host_completed_packets){ 4521f30077b7SMatthias Ringwald hci_host_num_completed_packets(); 4522f30077b7SMatthias Ringwald return; 4523f30077b7SMatthias Ringwald } 4524f30077b7SMatthias Ringwald #endif 4525f30077b7SMatthias Ringwald 4526f30077b7SMatthias Ringwald if (!hci_can_send_command_packet_now()) return; 4527f30077b7SMatthias Ringwald 4528f30077b7SMatthias Ringwald // global/non-connection oriented commands 4529f30077b7SMatthias Ringwald 4530f30077b7SMatthias Ringwald 4531f30077b7SMatthias Ringwald #ifdef ENABLE_CLASSIC 4532f30077b7SMatthias Ringwald // general gap classic 4533f30077b7SMatthias Ringwald done = hci_run_general_gap_classic(); 4534f30077b7SMatthias Ringwald if (done) return; 4535f30077b7SMatthias Ringwald #endif 4536f30077b7SMatthias Ringwald 4537f30077b7SMatthias Ringwald #ifdef ENABLE_BLE 4538f30077b7SMatthias Ringwald // general gap le 4539f30077b7SMatthias Ringwald done = hci_run_general_gap_le(); 4540f30077b7SMatthias Ringwald if (done) return; 4541f30077b7SMatthias Ringwald #endif 4542f30077b7SMatthias Ringwald 4543f30077b7SMatthias Ringwald // send pending HCI commands 454488a03c8dSMatthias Ringwald done = hci_run_general_pending_commands(); 4545f30077b7SMatthias Ringwald if (done) return; 4546f30077b7SMatthias Ringwald 4547f30077b7SMatthias Ringwald // stack state sub statemachines 454805ae8de3SMatthias Ringwald hci_connection_t * connection; 45493a9fb326S[email protected] switch (hci_stack->state){ 45503429f56bSmatthias.ringwald case HCI_STATE_INITIALIZING: 455174b323a9SMatthias Ringwald hci_initializing_run(); 45523429f56bSmatthias.ringwald break; 4553c7e0c5f6Smatthias.ringwald 4554c7e0c5f6Smatthias.ringwald case HCI_STATE_HALTING: 4555c7e0c5f6Smatthias.ringwald 455626fe9592SMatthias Ringwald log_info("HCI_STATE_HALTING, substate %x\n", hci_stack->substate); 455726fe9592SMatthias Ringwald switch (hci_stack->substate){ 4558beceeddeSMatthias Ringwald case HCI_HALTING_DISCONNECT_ALL_NO_TIMER: 4559beceeddeSMatthias Ringwald case HCI_HALTING_DISCONNECT_ALL_TIMER: 4560beceeddeSMatthias Ringwald 4561a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE 4562d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 4563beceeddeSMatthias Ringwald // free whitelist entries 45649956955bSMatthias Ringwald { 4565665d90f2SMatthias Ringwald btstack_linked_list_iterator_t lit; 4566665d90f2SMatthias Ringwald btstack_linked_list_iterator_init(&lit, &hci_stack->le_whitelist); 4567665d90f2SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&lit)){ 4568665d90f2SMatthias Ringwald whitelist_entry_t * entry = (whitelist_entry_t*) btstack_linked_list_iterator_next(&lit); 4569665d90f2SMatthias Ringwald btstack_linked_list_remove(&hci_stack->le_whitelist, (btstack_linked_item_t *) entry); 45709956955bSMatthias Ringwald btstack_memory_whitelist_entry_free(entry); 45719956955bSMatthias Ringwald } 45729956955bSMatthias Ringwald } 45739956955bSMatthias Ringwald #endif 4574d70217a2SMatthias Ringwald #endif 4575c7e0c5f6Smatthias.ringwald // close all open connections 45763a9fb326S[email protected] connection = (hci_connection_t *) hci_stack->connections; 4577c7e0c5f6Smatthias.ringwald if (connection){ 4578711e6c80SMatthias Ringwald hci_con_handle_t con_handle = (uint16_t) connection->con_handle; 4579d94d3cafS[email protected] if (!hci_can_send_command_packet_now()) return; 458032ab9390Smatthias.ringwald 45818fca890eSMatthias Ringwald // check state 45828fca890eSMatthias Ringwald if (connection->state == SENT_DISCONNECT) return; 45838fca890eSMatthias Ringwald connection->state = SENT_DISCONNECT; 45848fca890eSMatthias Ringwald 45858837e9efSMatthias Ringwald log_info("HCI_STATE_HALTING, connection %p, handle %u", connection, con_handle); 4586c7e0c5f6Smatthias.ringwald 45878837e9efSMatthias Ringwald // cancel all l2cap connections right away instead of waiting for disconnection complete event ... 45888837e9efSMatthias Ringwald hci_emit_disconnection_complete(con_handle, 0x16); // terminated by local host 45898837e9efSMatthias Ringwald 45908837e9efSMatthias Ringwald // ... which would be ignored anyway as we shutdown (free) the connection now 4591c7e0c5f6Smatthias.ringwald hci_shutdown_connection(connection); 45928837e9efSMatthias Ringwald 45938837e9efSMatthias Ringwald // finally, send the disconnect command 45946ef3696aSMatthias Ringwald hci_send_cmd(&hci_disconnect, con_handle, ERROR_CODE_REMOTE_USER_TERMINATED_CONNECTION); 4595c7e0c5f6Smatthias.ringwald return; 4596c7e0c5f6Smatthias.ringwald } 459726fe9592SMatthias Ringwald 4598beceeddeSMatthias Ringwald if (hci_stack->substate == HCI_HALTING_DISCONNECT_ALL_TIMER){ 4599beceeddeSMatthias Ringwald // no connections left, wait a bit to assert that btstack_cyrpto isn't waiting for an HCI event 4600beceeddeSMatthias Ringwald log_info("HCI_STATE_HALTING: wait 50 ms"); 460126fe9592SMatthias Ringwald hci_stack->substate = HCI_HALTING_W4_TIMER; 4602beceeddeSMatthias Ringwald btstack_run_loop_set_timer(&hci_stack->timeout, 50); 460326fe9592SMatthias Ringwald btstack_run_loop_set_timer_handler(&hci_stack->timeout, hci_halting_timeout_handler); 460426fe9592SMatthias Ringwald btstack_run_loop_add_timer(&hci_stack->timeout); 460526fe9592SMatthias Ringwald break; 4606beceeddeSMatthias Ringwald } 460726fe9592SMatthias Ringwald 4608cf373d3aSMatthias Ringwald /* fall through */ 460926fe9592SMatthias Ringwald 461026fe9592SMatthias Ringwald case HCI_HALTING_CLOSE: 46119da54300S[email protected] log_info("HCI_STATE_HALTING, calling off"); 4612c7e0c5f6Smatthias.ringwald 461372ea5239Smatthias.ringwald // switch mode 4614c7e0c5f6Smatthias.ringwald hci_power_control_off(); 46159418f9c9Smatthias.ringwald 46169da54300S[email protected] log_info("HCI_STATE_HALTING, emitting state"); 461772ea5239Smatthias.ringwald hci_emit_state(); 46189da54300S[email protected] log_info("HCI_STATE_HALTING, done"); 461972ea5239Smatthias.ringwald break; 4620beceeddeSMatthias Ringwald 4621beceeddeSMatthias Ringwald case HCI_HALTING_W4_TIMER: 4622beceeddeSMatthias Ringwald // keep waiting 4623beceeddeSMatthias Ringwald 4624beceeddeSMatthias Ringwald break; 462526fe9592SMatthias Ringwald default: 462626fe9592SMatthias Ringwald break; 462726fe9592SMatthias Ringwald } 462826fe9592SMatthias Ringwald 462926fe9592SMatthias Ringwald break; 4630c7e0c5f6Smatthias.ringwald 463172ea5239Smatthias.ringwald case HCI_STATE_FALLING_ASLEEP: 46323a9fb326S[email protected] switch(hci_stack->substate) { 463374b323a9SMatthias Ringwald case HCI_FALLING_ASLEEP_DISCONNECT: 46349da54300S[email protected] log_info("HCI_STATE_FALLING_ASLEEP"); 463572ea5239Smatthias.ringwald // close all open connections 46363a9fb326S[email protected] connection = (hci_connection_t *) hci_stack->connections; 463766da7044Smatthias.ringwald 4638423a3e49SMatthias Ringwald #ifdef HAVE_PLATFORM_IPHONE_OS 463966da7044Smatthias.ringwald // don't close connections, if H4 supports power management 4640d0b87befSMatthias Ringwald if (btstack_control_iphone_power_management_enabled()){ 464166da7044Smatthias.ringwald connection = NULL; 464266da7044Smatthias.ringwald } 464366da7044Smatthias.ringwald #endif 464472ea5239Smatthias.ringwald if (connection){ 464532ab9390Smatthias.ringwald 464672ea5239Smatthias.ringwald // send disconnect 4647d94d3cafS[email protected] if (!hci_can_send_command_packet_now()) return; 464832ab9390Smatthias.ringwald 46499da54300S[email protected] log_info("HCI_STATE_FALLING_ASLEEP, connection %p, handle %u", connection, (uint16_t)connection->con_handle); 46506ef3696aSMatthias Ringwald hci_send_cmd(&hci_disconnect, connection->con_handle, ERROR_CODE_REMOTE_USER_TERMINATED_CONNECTION); 465172ea5239Smatthias.ringwald 465272ea5239Smatthias.ringwald // send disconnected event right away - causes higher layer connections to get closed, too. 465372ea5239Smatthias.ringwald hci_shutdown_connection(connection); 465472ea5239Smatthias.ringwald return; 465572ea5239Smatthias.ringwald } 465672ea5239Smatthias.ringwald 465792368cd3S[email protected] if (hci_classic_supported()){ 465889db417bSmatthias.ringwald // disable page and inquiry scan 4659d94d3cafS[email protected] if (!hci_can_send_command_packet_now()) return; 466032ab9390Smatthias.ringwald 46619da54300S[email protected] log_info("HCI_STATE_HALTING, disabling inq scans"); 46623a9fb326S[email protected] hci_send_cmd(&hci_write_scan_enable, hci_stack->connectable << 1); // drop inquiry scan but keep page scan 466389db417bSmatthias.ringwald 466489db417bSmatthias.ringwald // continue in next sub state 466574b323a9SMatthias Ringwald hci_stack->substate = HCI_FALLING_ASLEEP_W4_WRITE_SCAN_ENABLE; 466689db417bSmatthias.ringwald break; 466792368cd3S[email protected] } 4668cf373d3aSMatthias Ringwald 4669cf373d3aSMatthias Ringwald /* fall through */ 467092368cd3S[email protected] 467174b323a9SMatthias Ringwald case HCI_FALLING_ASLEEP_COMPLETE: 46729da54300S[email protected] log_info("HCI_STATE_HALTING, calling sleep"); 4673423a3e49SMatthias Ringwald #ifdef HAVE_PLATFORM_IPHONE_OS 467428171530Smatthias.ringwald // don't actually go to sleep, if H4 supports power management 4675d0b87befSMatthias Ringwald if (btstack_control_iphone_power_management_enabled()){ 467628171530Smatthias.ringwald // SLEEP MODE reached 46773a9fb326S[email protected] hci_stack->state = HCI_STATE_SLEEPING; 467828171530Smatthias.ringwald hci_emit_state(); 467928171530Smatthias.ringwald break; 468028171530Smatthias.ringwald } 468128171530Smatthias.ringwald #endif 468272ea5239Smatthias.ringwald // switch mode 46833a9fb326S[email protected] hci_power_control_sleep(); // changes hci_stack->state to SLEEP 4684c7e0c5f6Smatthias.ringwald hci_emit_state(); 468528171530Smatthias.ringwald break; 468628171530Smatthias.ringwald 468789db417bSmatthias.ringwald default: 468889db417bSmatthias.ringwald break; 468989db417bSmatthias.ringwald } 4690c7e0c5f6Smatthias.ringwald break; 4691c7e0c5f6Smatthias.ringwald 46923429f56bSmatthias.ringwald default: 46933429f56bSmatthias.ringwald break; 46941f504dbdSmatthias.ringwald } 46953429f56bSmatthias.ringwald } 469616833f0aSmatthias.ringwald 469731452debSmatthias.ringwald int hci_send_cmd_packet(uint8_t *packet, int size){ 469835454696SMatthias Ringwald // house-keeping 469935454696SMatthias Ringwald 470035454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 4701c8e4258aSmatthias.ringwald bd_addr_t addr; 4702c8e4258aSmatthias.ringwald hci_connection_t * conn; 4703c123d999SMatthias Ringwald #endif 4704c123d999SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 47056f35bb46SMatthias Ringwald uint8_t initiator_filter_policy; 47069cbd2215SMatthias Ringwald #endif 4707c8e4258aSmatthias.ringwald 47086f35bb46SMatthias Ringwald uint16_t opcode = little_endian_read_16(packet, 0); 47096f35bb46SMatthias Ringwald switch (opcode) { 47109cbd2215SMatthias Ringwald case HCI_OPCODE_HCI_WRITE_LOOPBACK_MODE: 47119cbd2215SMatthias Ringwald hci_stack->loopback_mode = packet[3]; 47129cbd2215SMatthias Ringwald break; 47139cbd2215SMatthias Ringwald 47149cbd2215SMatthias Ringwald #ifdef ENABLE_CLASSIC 47156f35bb46SMatthias Ringwald case HCI_OPCODE_HCI_CREATE_CONNECTION: 4716724d70a2SMatthias Ringwald reverse_bd_addr(&packet[3], addr); 47179da54300S[email protected] log_info("Create_connection to %s", bd_addr_to_str(addr)); 4718c8e4258aSmatthias.ringwald 4719f16129ceSMatthias Ringwald conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL); 4720ad83dc6aS[email protected] if (!conn) { 4721f16129ceSMatthias Ringwald conn = create_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL); 472217f1ba2aSmatthias.ringwald if (!conn) { 472317f1ba2aSmatthias.ringwald // notify client that alloc failed 47242deddeceSMatthias Ringwald hci_emit_connection_complete(addr, 0, BTSTACK_MEMORY_ALLOC_FAILED); 4725f5e5741dSMatthias Ringwald return -1; // packet not sent to controller 472617f1ba2aSmatthias.ringwald } 4727ad83dc6aS[email protected] conn->state = SEND_CREATE_CONNECTION; 4728f3e2cd2aSMatthias Ringwald conn->role = HCI_ROLE_MASTER; 4729ad83dc6aS[email protected] } 4730ad83dc6aS[email protected] log_info("conn state %u", conn->state); 4731ad83dc6aS[email protected] switch (conn->state) { 4732ad83dc6aS[email protected] // if connection active exists 4733ad83dc6aS[email protected] case OPEN: 4734f5e5741dSMatthias Ringwald // and OPEN, emit connection complete command 4735274dad91SMatthias Ringwald hci_emit_connection_complete(addr, conn->con_handle, 0); 4736f5e5741dSMatthias Ringwald return -1; // packet not sent to controller 4737672e36abSMatthias Ringwald case RECEIVED_DISCONNECTION_COMPLETE: 4738672e36abSMatthias Ringwald // create connection triggered in disconnect complete event, let's do it now 4739672e36abSMatthias Ringwald break; 4740ad83dc6aS[email protected] case SEND_CREATE_CONNECTION: 4741532f91a5SMatthias Ringwald // connection created by hci, e.g. dedicated bonding, but not executed yet, let's do it now 4742532f91a5SMatthias Ringwald break; 4743ad83dc6aS[email protected] default: 4744ad83dc6aS[email protected] // otherwise, just ignore as it is already in the open process 4745f5e5741dSMatthias Ringwald return -1; // packet not sent to controller 4746ad83dc6aS[email protected] } 4747c8e4258aSmatthias.ringwald conn->state = SENT_CREATE_CONNECTION; 4748229331c6SMatthias Ringwald 4749229331c6SMatthias Ringwald // track outgoing connection 4750f16129ceSMatthias Ringwald hci_stack->outgoing_addr_type = BD_ADDR_TYPE_ACL; 47516535961aSMatthias Ringwald (void) memcpy(hci_stack->outgoing_addr, addr, 6); 47526f35bb46SMatthias Ringwald break; 47536f35bb46SMatthias Ringwald case HCI_OPCODE_HCI_LINK_KEY_REQUEST_REPLY: 47547fde4af9Smatthias.ringwald hci_add_connection_flags_for_flipped_bd_addr(&packet[3], SENT_LINK_KEY_REPLY); 47556f35bb46SMatthias Ringwald break; 47566f35bb46SMatthias Ringwald case HCI_OPCODE_HCI_LINK_KEY_REQUEST_NEGATIVE_REPLY: 47577fde4af9Smatthias.ringwald hci_add_connection_flags_for_flipped_bd_addr(&packet[3], SENT_LINK_KEY_NEGATIVE_REQUEST); 47586f35bb46SMatthias Ringwald break; 47596f35bb46SMatthias Ringwald case HCI_OPCODE_HCI_DELETE_STORED_LINK_KEY: 4760a98592bcSMatthias Ringwald if (hci_stack->link_key_db) { 4761724d70a2SMatthias Ringwald reverse_bd_addr(&packet[3], addr); 4762a98592bcSMatthias Ringwald hci_stack->link_key_db->delete_link_key(addr); 47638ef73945Smatthias.ringwald } 47646f35bb46SMatthias Ringwald break; 47656f35bb46SMatthias Ringwald case HCI_OPCODE_HCI_PIN_CODE_REQUEST_NEGATIVE_REPLY: 47666f35bb46SMatthias Ringwald case HCI_OPCODE_HCI_PIN_CODE_REQUEST_REPLY: 4767724d70a2SMatthias Ringwald reverse_bd_addr(&packet[3], addr); 4768f16129ceSMatthias Ringwald conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL); 47696724cd9eS[email protected] if (conn) { 47706724cd9eS[email protected] connectionClearAuthenticationFlags(conn, LEGACY_PAIRING_ACTIVE); 47716724cd9eS[email protected] } 47726f35bb46SMatthias Ringwald break; 47736f35bb46SMatthias Ringwald case HCI_OPCODE_HCI_USER_CONFIRMATION_REQUEST_NEGATIVE_REPLY: 47746f35bb46SMatthias Ringwald case HCI_OPCODE_HCI_USER_CONFIRMATION_REQUEST_REPLY: 47756f35bb46SMatthias Ringwald case HCI_OPCODE_HCI_USER_PASSKEY_REQUEST_NEGATIVE_REPLY: 47766f35bb46SMatthias Ringwald case HCI_OPCODE_HCI_USER_PASSKEY_REQUEST_REPLY: 4777724d70a2SMatthias Ringwald reverse_bd_addr(&packet[3], addr); 4778f16129ceSMatthias Ringwald conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL); 47796724cd9eS[email protected] if (conn) { 47806724cd9eS[email protected] connectionClearAuthenticationFlags(conn, SSP_PAIRING_ACTIVE); 47816724cd9eS[email protected] } 47826f35bb46SMatthias Ringwald break; 4783ee752bb8SMatthias Ringwald 47845b7087c7SMatthias Ringwald #if defined (ENABLE_SCO_OVER_HCI) || defined (HAVE_SCO_TRANSPORT) 47856f35bb46SMatthias Ringwald case HCI_OPCODE_HCI_SETUP_SYNCHRONOUS_CONNECTION: 4786ee752bb8SMatthias Ringwald // setup_synchronous_connection? Voice setting at offset 22 4787ee752bb8SMatthias Ringwald // TODO: compare to current setting if sco connection already active 4788ee752bb8SMatthias Ringwald hci_stack->sco_voice_setting_active = little_endian_read_16(packet, 15); 47896f35bb46SMatthias Ringwald break; 47906f35bb46SMatthias Ringwald case HCI_OPCODE_HCI_ACCEPT_SYNCHRONOUS_CONNECTION: 4791ee752bb8SMatthias Ringwald // accept_synchronus_connection? Voice setting at offset 18 4792ee752bb8SMatthias Ringwald // TODO: compare to current setting if sco connection already active 4793ee752bb8SMatthias Ringwald hci_stack->sco_voice_setting_active = little_endian_read_16(packet, 19); 47946f35bb46SMatthias Ringwald break; 4795ee752bb8SMatthias Ringwald #endif 479635454696SMatthias Ringwald #endif 47974b3e1e19SMatthias Ringwald 4798a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE 47996f35bb46SMatthias Ringwald case HCI_OPCODE_HCI_LE_SET_RANDOM_ADDRESS: 4800b95a5a35SMatthias Ringwald hci_stack->le_random_address_set = 1; 4801b95a5a35SMatthias Ringwald reverse_bd_addr(&packet[3], hci_stack->le_random_address); 48026f35bb46SMatthias Ringwald break; 48037e8d8b1dSMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 48046f35bb46SMatthias Ringwald case HCI_OPCODE_HCI_LE_SET_ADVERTISE_ENABLE: 48055226d7f2SMatthias Ringwald hci_stack->le_advertisements_active = packet[3] != 0; 48066f35bb46SMatthias Ringwald break; 4807d70217a2SMatthias Ringwald #endif 4808d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 48096f35bb46SMatthias Ringwald case HCI_OPCODE_HCI_LE_CREATE_CONNECTION: 4810b04dfa37SMatthias Ringwald // white list used? 48116f35bb46SMatthias Ringwald initiator_filter_policy = packet[7]; 4812b04dfa37SMatthias Ringwald switch (initiator_filter_policy) { 4813b04dfa37SMatthias Ringwald case 0: 4814b04dfa37SMatthias Ringwald // whitelist not used 4815b04dfa37SMatthias Ringwald hci_stack->le_connecting_state = LE_CONNECTING_DIRECT; 4816b04dfa37SMatthias Ringwald break; 4817b04dfa37SMatthias Ringwald case 1: 4818b04dfa37SMatthias Ringwald hci_stack->le_connecting_state = LE_CONNECTING_WHITELIST; 4819b04dfa37SMatthias Ringwald break; 4820b04dfa37SMatthias Ringwald default: 4821b04dfa37SMatthias Ringwald log_error("Invalid initiator_filter_policy in LE Create Connection %u", initiator_filter_policy); 4822b04dfa37SMatthias Ringwald break; 4823b04dfa37SMatthias Ringwald } 4824c163146eSMatthias Ringwald // track outgoing connection 482505002aecSMatthias Ringwald hci_stack->outgoing_addr_type = (bd_addr_type_t) packet[8]; // peer addres type 4826c163146eSMatthias Ringwald reverse_bd_addr( &packet[9], hci_stack->outgoing_addr); // peer address 48276f35bb46SMatthias Ringwald break; 48286f35bb46SMatthias Ringwald case HCI_OPCODE_HCI_LE_CREATE_CONNECTION_CANCEL: 48296ea9315cSMatthias Ringwald hci_stack->le_connecting_state = LE_CONNECTING_CANCEL; 48306f35bb46SMatthias Ringwald break; 48319cbd2215SMatthias Ringwald #endif 48329cbd2215SMatthias Ringwald #endif 48336f35bb46SMatthias Ringwald default: 48346f35bb46SMatthias Ringwald break; 4835b04dfa37SMatthias Ringwald } 483669a97523S[email protected] 48373a9fb326S[email protected] hci_stack->num_cmd_packets--; 48385bb5bc3eS[email protected] 48395bb5bc3eS[email protected] hci_dump_packet(HCI_COMMAND_DATA_PACKET, 0, packet, size); 4840bfea0222SMatthias Ringwald return hci_stack->hci_transport->send_packet(HCI_COMMAND_DATA_PACKET, packet, size); 484131452debSmatthias.ringwald } 48428adf0ddaSmatthias.ringwald 48432bd8b7e7S[email protected] // disconnect because of security block 48442bd8b7e7S[email protected] void hci_disconnect_security_block(hci_con_handle_t con_handle){ 48452bd8b7e7S[email protected] hci_connection_t * connection = hci_connection_for_handle(con_handle); 48462bd8b7e7S[email protected] if (!connection) return; 48472bd8b7e7S[email protected] connection->bonding_flags |= BONDING_DISCONNECT_SECURITY_BLOCK; 48482bd8b7e7S[email protected] } 48492bd8b7e7S[email protected] 48502bd8b7e7S[email protected] 4851dbe1a790S[email protected] // Configure Secure Simple Pairing 4852dbe1a790S[email protected] 485335454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 485435454696SMatthias Ringwald 4855dbe1a790S[email protected] // enable will enable SSP during init 485615a95bd5SMatthias Ringwald void gap_ssp_set_enable(int enable){ 48573a9fb326S[email protected] hci_stack->ssp_enable = enable; 4858dbe1a790S[email protected] } 4859dbe1a790S[email protected] 486095d71764SMatthias Ringwald static int hci_local_ssp_activated(void){ 486115a95bd5SMatthias Ringwald return gap_ssp_supported() && hci_stack->ssp_enable; 48622bd8b7e7S[email protected] } 48632bd8b7e7S[email protected] 4864dbe1a790S[email protected] // if set, BTstack will respond to io capability request using authentication requirement 486515a95bd5SMatthias Ringwald void gap_ssp_set_io_capability(int io_capability){ 48663a9fb326S[email protected] hci_stack->ssp_io_capability = io_capability; 4867dbe1a790S[email protected] } 486815a95bd5SMatthias Ringwald void gap_ssp_set_authentication_requirement(int authentication_requirement){ 48693a9fb326S[email protected] hci_stack->ssp_authentication_requirement = authentication_requirement; 4870dbe1a790S[email protected] } 4871dbe1a790S[email protected] 4872dbe1a790S[email protected] // if set, BTstack will confirm a numberic comparion and enter '000000' if requested 487315a95bd5SMatthias Ringwald void gap_ssp_set_auto_accept(int auto_accept){ 48743a9fb326S[email protected] hci_stack->ssp_auto_accept = auto_accept; 4875dbe1a790S[email protected] } 48765d23aae8SMatthias Ringwald 48775d23aae8SMatthias Ringwald void gap_secure_connections_enable(bool enable){ 48785d23aae8SMatthias Ringwald hci_stack->secure_connections_enable = enable; 48795d23aae8SMatthias Ringwald } 48805d23aae8SMatthias Ringwald 488135454696SMatthias Ringwald #endif 4882dbe1a790S[email protected] 488394be1a66SMatthias Ringwald // va_list part of hci_send_cmd 488494be1a66SMatthias Ringwald int hci_send_cmd_va_arg(const hci_cmd_t *cmd, va_list argptr){ 4885d94d3cafS[email protected] if (!hci_can_send_command_packet_now()){ 48869d14b626S[email protected] log_error("hci_send_cmd called but cannot send packet now"); 48879d14b626S[email protected] return 0; 48889d14b626S[email protected] } 48899d14b626S[email protected] 48905127cc62S[email protected] // for HCI INITIALIZATION 48919da54300S[email protected] // log_info("hci_send_cmd: opcode %04x", cmd->opcode); 48925127cc62S[email protected] hci_stack->last_cmd_opcode = cmd->opcode; 48935127cc62S[email protected] 48949d14b626S[email protected] hci_reserve_packet_buffer(); 48959d14b626S[email protected] uint8_t * packet = hci_stack->hci_packet_buffer; 489694be1a66SMatthias Ringwald uint16_t size = hci_cmd_create_from_template(packet, cmd, argptr); 4897bfea0222SMatthias Ringwald int err = hci_send_cmd_packet(packet, size); 4898bfea0222SMatthias Ringwald 4899593702caSMatthias Ringwald // release packet buffer on error or for synchronous transport implementations 4900593702caSMatthias Ringwald if ((err < 0) || hci_transport_synchronous()){ 4901e2d22487SMatthias Ringwald hci_release_packet_buffer(); 4902068b8592SMatthias Ringwald hci_emit_transport_packet_sent(); 4903bfea0222SMatthias Ringwald } 4904bfea0222SMatthias Ringwald 4905bfea0222SMatthias Ringwald return err; 490694be1a66SMatthias Ringwald } 49079d14b626S[email protected] 490894be1a66SMatthias Ringwald /** 490994be1a66SMatthias Ringwald * pre: numcmds >= 0 - it's allowed to send a command to the controller 491094be1a66SMatthias Ringwald */ 491194be1a66SMatthias Ringwald int hci_send_cmd(const hci_cmd_t *cmd, ...){ 49121cd208adSmatthias.ringwald va_list argptr; 49131cd208adSmatthias.ringwald va_start(argptr, cmd); 491494be1a66SMatthias Ringwald int res = hci_send_cmd_va_arg(cmd, argptr); 49151cd208adSmatthias.ringwald va_end(argptr); 491694be1a66SMatthias Ringwald return res; 491793b8dc03Smatthias.ringwald } 4918c8e4258aSmatthias.ringwald 4919ee091cf1Smatthias.ringwald // Create various non-HCI events. 4920ee091cf1Smatthias.ringwald // TODO: generalize, use table similar to hci_create_command 4921ee091cf1Smatthias.ringwald 4922d6b06661SMatthias Ringwald static void hci_emit_event(uint8_t * event, uint16_t size, int dump){ 4923fb37a842SMatthias Ringwald // dump packet 4924d6b06661SMatthias Ringwald if (dump) { 4925300c1ba4SMatthias Ringwald hci_dump_packet( HCI_EVENT_PACKET, 0, event, size); 4926d6b06661SMatthias Ringwald } 49271ef6bb52SMatthias Ringwald 4928fb37a842SMatthias Ringwald // dispatch to all event handlers 49291ef6bb52SMatthias Ringwald btstack_linked_list_iterator_t it; 49301ef6bb52SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->event_handlers); 49311ef6bb52SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 49321ef6bb52SMatthias Ringwald btstack_packet_callback_registration_t * entry = (btstack_packet_callback_registration_t*) btstack_linked_list_iterator_next(&it); 4933d9a7306aSMatthias Ringwald entry->callback(HCI_EVENT_PACKET, 0, event, size); 49341ef6bb52SMatthias Ringwald } 4935d6b06661SMatthias Ringwald } 4936d6b06661SMatthias Ringwald 4937d6b06661SMatthias Ringwald static void hci_emit_acl_packet(uint8_t * packet, uint16_t size){ 4938fb37a842SMatthias Ringwald if (!hci_stack->acl_packet_handler) return; 49393d50b4baSMatthias Ringwald hci_stack->acl_packet_handler(HCI_ACL_DATA_PACKET, 0, packet, size); 4940d6b06661SMatthias Ringwald } 4941d6b06661SMatthias Ringwald 494235454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 4943701e3307SMatthias Ringwald static void hci_notify_if_sco_can_send_now(void){ 49443bc639ceSMatthias Ringwald // notify SCO sender if waiting 4945701e3307SMatthias Ringwald if (!hci_stack->sco_waiting_for_can_send_now) return; 4946701e3307SMatthias Ringwald if (hci_can_send_sco_packet_now()){ 49473bc639ceSMatthias Ringwald hci_stack->sco_waiting_for_can_send_now = 0; 4948701e3307SMatthias Ringwald uint8_t event[2] = { HCI_EVENT_SCO_CAN_SEND_NOW, 0 }; 4949701e3307SMatthias Ringwald hci_dump_packet(HCI_EVENT_PACKET, 1, event, sizeof(event)); 49503d50b4baSMatthias Ringwald hci_stack->sco_packet_handler(HCI_EVENT_PACKET, 0, event, sizeof(event)); 49513bc639ceSMatthias Ringwald } 49523bc639ceSMatthias Ringwald } 49531cfb383eSMatthias Ringwald 49541cfb383eSMatthias Ringwald // parsing end emitting has been merged to reduce code size 49559784dac1SMatthias Ringwald static void gap_inquiry_explode(uint8_t *packet, uint16_t size) { 4956e4f5dd75SMatthias Ringwald uint8_t event[19+GAP_INQUIRY_MAX_NAME_LEN]; 49571cfb383eSMatthias Ringwald 49581cfb383eSMatthias Ringwald uint8_t * eir_data; 49591cfb383eSMatthias Ringwald ad_context_t context; 49601cfb383eSMatthias Ringwald const uint8_t * name; 49611cfb383eSMatthias Ringwald uint8_t name_len; 49621cfb383eSMatthias Ringwald 49639784dac1SMatthias Ringwald if (size < 3) return; 49649784dac1SMatthias Ringwald 49651cfb383eSMatthias Ringwald int event_type = hci_event_packet_get_type(packet); 4966a1df452eSMatthias Ringwald int num_reserved_fields = (event_type == HCI_EVENT_INQUIRY_RESULT) ? 2 : 1; // 2 for old event, 1 otherwise 49671cfb383eSMatthias Ringwald int num_responses = hci_event_inquiry_result_get_num_responses(packet); 49681cfb383eSMatthias Ringwald 49699784dac1SMatthias Ringwald switch (event_type){ 49709784dac1SMatthias Ringwald case HCI_EVENT_INQUIRY_RESULT: 49719784dac1SMatthias Ringwald case HCI_EVENT_INQUIRY_RESULT_WITH_RSSI: 49729784dac1SMatthias Ringwald if (size != (3 + (num_responses * 14))) return; 49739784dac1SMatthias Ringwald break; 49749784dac1SMatthias Ringwald case HCI_EVENT_EXTENDED_INQUIRY_RESPONSE: 49759784dac1SMatthias Ringwald if (size != 257) return; 49769784dac1SMatthias Ringwald if (num_responses != 1) return; 49779784dac1SMatthias Ringwald break; 49789784dac1SMatthias Ringwald default: 49799784dac1SMatthias Ringwald return; 49809784dac1SMatthias Ringwald } 49819784dac1SMatthias Ringwald 49821cfb383eSMatthias Ringwald // event[1] is set at the end 49831cfb383eSMatthias Ringwald int i; 49841cfb383eSMatthias Ringwald for (i=0; i<num_responses;i++){ 49851cfb383eSMatthias Ringwald memset(event, 0, sizeof(event)); 49861cfb383eSMatthias Ringwald event[0] = GAP_EVENT_INQUIRY_RESULT; 49871cfb383eSMatthias Ringwald uint8_t event_size = 18; // if name is not set by EIR 49881cfb383eSMatthias Ringwald 49896535961aSMatthias Ringwald (void)memcpy(&event[2], &packet[3 + (i * 6)], 6); // bd_addr 49900e588213SMatthias Ringwald event[8] = packet[3 + (num_responses*(6)) + (i*1)]; // page_scan_repetition_mode 49916535961aSMatthias Ringwald (void)memcpy(&event[9], 49926535961aSMatthias Ringwald &packet[3 + (num_responses * (6 + 1 + num_reserved_fields)) + (i * 3)], 49936535961aSMatthias Ringwald 3); // class of device 49946535961aSMatthias Ringwald (void)memcpy(&event[12], 49956535961aSMatthias Ringwald &packet[3 + (num_responses * (6 + 1 + num_reserved_fields + 3)) + (i * 2)], 49966535961aSMatthias Ringwald 2); // clock offset 49971cfb383eSMatthias Ringwald 49981cfb383eSMatthias Ringwald switch (event_type){ 49991cfb383eSMatthias Ringwald case HCI_EVENT_INQUIRY_RESULT: 50001cfb383eSMatthias Ringwald // 14,15,16,17 = 0, size 18 50011cfb383eSMatthias Ringwald break; 50021cfb383eSMatthias Ringwald case HCI_EVENT_INQUIRY_RESULT_WITH_RSSI: 50031cfb383eSMatthias Ringwald event[14] = 1; 5004a1df452eSMatthias Ringwald event[15] = packet [3 + (num_responses*(6+1+num_reserved_fields+3+2)) + (i*1)]; // rssi 50051cfb383eSMatthias Ringwald // 16,17 = 0, size 18 50061cfb383eSMatthias Ringwald break; 50071cfb383eSMatthias Ringwald case HCI_EVENT_EXTENDED_INQUIRY_RESPONSE: 50081cfb383eSMatthias Ringwald event[14] = 1; 5009a1df452eSMatthias Ringwald event[15] = packet [3 + (num_responses*(6+1+num_reserved_fields+3+2)) + (i*1)]; // rssi 501079186815SMatthias Ringwald // EIR packets only contain a single inquiry response 50111cfb383eSMatthias Ringwald eir_data = &packet[3 + (6+1+num_reserved_fields+3+2+1)]; 50121cfb383eSMatthias Ringwald name = NULL; 5013a8c4e5adSMatthias Ringwald // Iterate over EIR data 5014a8c4e5adSMatthias Ringwald for (ad_iterator_init(&context, EXTENDED_INQUIRY_RESPONSE_DATA_LEN, eir_data) ; ad_iterator_has_more(&context) ; ad_iterator_next(&context)){ 50151cfb383eSMatthias Ringwald uint8_t data_type = ad_iterator_get_data_type(&context); 50161cfb383eSMatthias Ringwald uint8_t data_size = ad_iterator_get_data_len(&context); 50171cfb383eSMatthias Ringwald const uint8_t * data = ad_iterator_get_data(&context); 50181cfb383eSMatthias Ringwald // Prefer Complete Local Name over Shortend Local Name 50191cfb383eSMatthias Ringwald switch (data_type){ 50201cfb383eSMatthias Ringwald case BLUETOOTH_DATA_TYPE_SHORTENED_LOCAL_NAME: 50211cfb383eSMatthias Ringwald if (name) continue; 5022cf373d3aSMatthias Ringwald /* fall through */ 50231cfb383eSMatthias Ringwald case BLUETOOTH_DATA_TYPE_COMPLETE_LOCAL_NAME: 50241cfb383eSMatthias Ringwald name = data; 50251cfb383eSMatthias Ringwald name_len = data_size; 50261cfb383eSMatthias Ringwald break; 50271cfb383eSMatthias Ringwald default: 50281cfb383eSMatthias Ringwald break; 50291cfb383eSMatthias Ringwald } 50301cfb383eSMatthias Ringwald } 50311cfb383eSMatthias Ringwald if (name){ 50321cfb383eSMatthias Ringwald event[16] = 1; 50331cfb383eSMatthias Ringwald // truncate name if needed 50341cfb383eSMatthias Ringwald int len = btstack_min(name_len, GAP_INQUIRY_MAX_NAME_LEN); 50351cfb383eSMatthias Ringwald event[17] = len; 50366535961aSMatthias Ringwald (void)memcpy(&event[18], name, len); 50371cfb383eSMatthias Ringwald event_size += len; 50381cfb383eSMatthias Ringwald } 50391cfb383eSMatthias Ringwald break; 50407bbeb3adSMilanka Ringwald default: 50417bbeb3adSMilanka Ringwald return; 50421cfb383eSMatthias Ringwald } 50431cfb383eSMatthias Ringwald event[1] = event_size - 2; 50441cfb383eSMatthias Ringwald hci_emit_event(event, event_size, 1); 50451cfb383eSMatthias Ringwald } 50461cfb383eSMatthias Ringwald } 504735454696SMatthias Ringwald #endif 50483bc639ceSMatthias Ringwald 504971de195eSMatthias Ringwald void hci_emit_state(void){ 50503a9fb326S[email protected] log_info("BTSTACK_EVENT_STATE %u", hci_stack->state); 5051425d1371Smatthias.ringwald uint8_t event[3]; 505280d52d6bSmatthias.ringwald event[0] = BTSTACK_EVENT_STATE; 50534ea43905SMatthias Ringwald event[1] = sizeof(event) - 2u; 50543a9fb326S[email protected] event[2] = hci_stack->state; 5055d6b06661SMatthias Ringwald hci_emit_event(event, sizeof(event), 1); 5056c8e4258aSmatthias.ringwald } 5057c8e4258aSmatthias.ringwald 505835454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 50592deddeceSMatthias Ringwald static void hci_emit_connection_complete(bd_addr_t address, hci_con_handle_t con_handle, uint8_t status){ 5060425d1371Smatthias.ringwald uint8_t event[13]; 5061c8e4258aSmatthias.ringwald event[0] = HCI_EVENT_CONNECTION_COMPLETE; 5062425d1371Smatthias.ringwald event[1] = sizeof(event) - 2; 506317f1ba2aSmatthias.ringwald event[2] = status; 50642deddeceSMatthias Ringwald little_endian_store_16(event, 3, con_handle); 50652deddeceSMatthias Ringwald reverse_bd_addr(address, &event[5]); 5066c8e4258aSmatthias.ringwald event[11] = 1; // ACL connection 5067c8e4258aSmatthias.ringwald event[12] = 0; // encryption disabled 5068d6b06661SMatthias Ringwald hci_emit_event(event, sizeof(event), 1); 5069c8e4258aSmatthias.ringwald } 507052db98b2SMatthias Ringwald static void hci_emit_l2cap_check_timeout(hci_connection_t *conn){ 507152db98b2SMatthias Ringwald if (disable_l2cap_timeouts) return; 507252db98b2SMatthias Ringwald log_info("L2CAP_EVENT_TIMEOUT_CHECK"); 507352db98b2SMatthias Ringwald uint8_t event[4]; 507452db98b2SMatthias Ringwald event[0] = L2CAP_EVENT_TIMEOUT_CHECK; 507552db98b2SMatthias Ringwald event[1] = sizeof(event) - 2; 507652db98b2SMatthias Ringwald little_endian_store_16(event, 2, conn->con_handle); 507752db98b2SMatthias Ringwald hci_emit_event(event, sizeof(event), 1); 507852db98b2SMatthias Ringwald } 507935454696SMatthias Ringwald #endif 5080c8e4258aSmatthias.ringwald 508135454696SMatthias Ringwald #ifdef ENABLE_BLE 5082d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 5083667ba9d1SMatthias 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){ 50844f3229d8S[email protected] uint8_t event[21]; 50854f3229d8S[email protected] event[0] = HCI_EVENT_LE_META; 50864ea43905SMatthias Ringwald event[1] = sizeof(event) - 2u; 50874f3229d8S[email protected] event[2] = HCI_SUBEVENT_LE_CONNECTION_COMPLETE; 50884f3229d8S[email protected] event[3] = status; 5089fc64f94aSMatthias Ringwald little_endian_store_16(event, 4, con_handle); 50904f3229d8S[email protected] event[6] = 0; // TODO: role 50916e2e9a6bS[email protected] event[7] = address_type; 5092724d70a2SMatthias Ringwald reverse_bd_addr(address, &event[8]); 5093f8fbdce0SMatthias Ringwald little_endian_store_16(event, 14, 0); // interval 5094f8fbdce0SMatthias Ringwald little_endian_store_16(event, 16, 0); // latency 5095f8fbdce0SMatthias Ringwald little_endian_store_16(event, 18, 0); // supervision timeout 50964f3229d8S[email protected] event[20] = 0; // master clock accuracy 5097d6b06661SMatthias Ringwald hci_emit_event(event, sizeof(event), 1); 50984f3229d8S[email protected] } 509935454696SMatthias Ringwald #endif 5100d70217a2SMatthias Ringwald #endif 51014f3229d8S[email protected] 5102fd43c0e0SMatthias Ringwald static void hci_emit_transport_packet_sent(void){ 5103fd43c0e0SMatthias Ringwald // notify upper stack that it might be possible to send again 5104fd43c0e0SMatthias Ringwald uint8_t event[] = { HCI_EVENT_TRANSPORT_PACKET_SENT, 0}; 5105fd43c0e0SMatthias Ringwald hci_emit_event(&event[0], sizeof(event), 0); // don't dump 5106fd43c0e0SMatthias Ringwald } 5107fd43c0e0SMatthias Ringwald 5108fc64f94aSMatthias Ringwald static void hci_emit_disconnection_complete(hci_con_handle_t con_handle, uint8_t reason){ 5109425d1371Smatthias.ringwald uint8_t event[6]; 51103c4d4b90Smatthias.ringwald event[0] = HCI_EVENT_DISCONNECTION_COMPLETE; 51114ea43905SMatthias Ringwald event[1] = sizeof(event) - 2u; 51123c4d4b90Smatthias.ringwald event[2] = 0; // status = OK 5113fc64f94aSMatthias Ringwald little_endian_store_16(event, 3, con_handle); 51143c4d4b90Smatthias.ringwald event[5] = reason; 5115d6b06661SMatthias Ringwald hci_emit_event(event, sizeof(event), 1); 51163c4d4b90Smatthias.ringwald } 51173c4d4b90Smatthias.ringwald 5118b83d5eabSMatthias Ringwald static void hci_emit_nr_connections_changed(void){ 5119e0abb8e7S[email protected] log_info("BTSTACK_EVENT_NR_CONNECTIONS_CHANGED %u", nr_hci_connections()); 5120425d1371Smatthias.ringwald uint8_t event[3]; 512180d52d6bSmatthias.ringwald event[0] = BTSTACK_EVENT_NR_CONNECTIONS_CHANGED; 51224ea43905SMatthias Ringwald event[1] = sizeof(event) - 2u; 512343bfb1bdSmatthias.ringwald event[2] = nr_hci_connections(); 5124d6b06661SMatthias Ringwald hci_emit_event(event, sizeof(event), 1); 512543bfb1bdSmatthias.ringwald } 5126038bc64cSmatthias.ringwald 5127b83d5eabSMatthias Ringwald static void hci_emit_hci_open_failed(void){ 5128e0abb8e7S[email protected] log_info("BTSTACK_EVENT_POWERON_FAILED"); 5129425d1371Smatthias.ringwald uint8_t event[2]; 513080d52d6bSmatthias.ringwald event[0] = BTSTACK_EVENT_POWERON_FAILED; 51314ea43905SMatthias Ringwald event[1] = sizeof(event) - 2u; 5132d6b06661SMatthias Ringwald hci_emit_event(event, sizeof(event), 1); 5133038bc64cSmatthias.ringwald } 51341b0e3922Smatthias.ringwald 513535454696SMatthias Ringwald static void hci_emit_dedicated_bonding_result(bd_addr_t address, uint8_t status){ 513635454696SMatthias Ringwald log_info("hci_emit_dedicated_bonding_result %u ", status); 513735454696SMatthias Ringwald uint8_t event[9]; 513835454696SMatthias Ringwald int pos = 0; 513935454696SMatthias Ringwald event[pos++] = GAP_EVENT_DEDICATED_BONDING_COMPLETED; 51404ea43905SMatthias Ringwald event[pos++] = sizeof(event) - 2u; 514135454696SMatthias Ringwald event[pos++] = status; 514235454696SMatthias Ringwald reverse_bd_addr(address, &event[pos]); 5143d6b06661SMatthias Ringwald hci_emit_event(event, sizeof(event), 1); 5144381fbed8Smatthias.ringwald } 5145458bf4e8S[email protected] 514635454696SMatthias Ringwald 514735454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 514835454696SMatthias Ringwald 5149b83d5eabSMatthias Ringwald static void hci_emit_security_level(hci_con_handle_t con_handle, gap_security_level_t level){ 5150df3354fcS[email protected] log_info("hci_emit_security_level %u for handle %x", level, con_handle); 5151a00031e2S[email protected] uint8_t event[5]; 5152e00caf9cS[email protected] int pos = 0; 51535611a760SMatthias Ringwald event[pos++] = GAP_EVENT_SECURITY_LEVEL; 5154e00caf9cS[email protected] event[pos++] = sizeof(event) - 2; 5155f8fbdce0SMatthias Ringwald little_endian_store_16(event, 2, con_handle); 5156e00caf9cS[email protected] pos += 2; 5157e00caf9cS[email protected] event[pos++] = level; 5158d6b06661SMatthias Ringwald hci_emit_event(event, sizeof(event), 1); 5159e00caf9cS[email protected] } 5160e00caf9cS[email protected] 516135454696SMatthias Ringwald static gap_security_level_t gap_security_level_for_connection(hci_connection_t * connection){ 516235454696SMatthias Ringwald if (!connection) return LEVEL_0; 516335454696SMatthias Ringwald if ((connection->authentication_flags & CONNECTION_ENCRYPTED) == 0) return LEVEL_0; 5164abdad579SMatthias Ringwald if ((connection->authentication_flags & CONNECTION_AUTHENTICATED) == 0) return LEVEL_0; 5165170fafaeSMatthias Ringwald if (connection->encryption_key_size < hci_stack->gap_required_encyrption_key_size) return LEVEL_0; 51664051b7ffSMatthias Ringwald gap_security_level_t security_level = gap_security_level_for_link_key_type(connection->link_key_type); 5167170fafaeSMatthias Ringwald // LEVEL 4 always requires 128 bit encrytion key size 51680e588213SMatthias Ringwald if ((security_level == LEVEL_4) && (connection->encryption_key_size < 16)){ 5169170fafaeSMatthias Ringwald security_level = LEVEL_3; 5170170fafaeSMatthias Ringwald } 5171170fafaeSMatthias Ringwald return security_level; 517235454696SMatthias Ringwald } 517335454696SMatthias Ringwald 517435454696SMatthias Ringwald static void hci_emit_discoverable_enabled(uint8_t enabled){ 517535454696SMatthias Ringwald log_info("BTSTACK_EVENT_DISCOVERABLE_ENABLED %u", enabled); 517635454696SMatthias Ringwald uint8_t event[3]; 517735454696SMatthias Ringwald event[0] = BTSTACK_EVENT_DISCOVERABLE_ENABLED; 517835454696SMatthias Ringwald event[1] = sizeof(event) - 2; 517935454696SMatthias Ringwald event[2] = enabled; 5180d6b06661SMatthias Ringwald hci_emit_event(event, sizeof(event), 1); 5181ad83dc6aS[email protected] } 5182ad83dc6aS[email protected] 518398a2fd1cSMatthias Ringwald // query if remote side supports eSCO 5184073bd0faSMatthias Ringwald int hci_remote_esco_supported(hci_con_handle_t con_handle){ 518598a2fd1cSMatthias Ringwald hci_connection_t * connection = hci_connection_for_handle(con_handle); 518698a2fd1cSMatthias Ringwald if (!connection) return 0; 518776ccfb2aSMatthias Ringwald return (connection->remote_supported_features[0] & 1) != 0; 518898a2fd1cSMatthias Ringwald } 518998a2fd1cSMatthias Ringwald 519067aae551SMatthias Ringwald static bool hci_ssp_supported(hci_connection_t * connection){ 519167aae551SMatthias Ringwald const uint8_t mask = BONDING_REMOTE_SUPPORTS_SSP_CONTROLLER | BONDING_REMOTE_SUPPORTS_SSP_HOST; 519267aae551SMatthias Ringwald return (connection->bonding_flags & mask) == mask; 519367aae551SMatthias Ringwald } 519467aae551SMatthias Ringwald 51952bd8b7e7S[email protected] // query if remote side supports SSP 51962bd8b7e7S[email protected] int hci_remote_ssp_supported(hci_con_handle_t con_handle){ 51972bd8b7e7S[email protected] hci_connection_t * connection = hci_connection_for_handle(con_handle); 51982bd8b7e7S[email protected] if (!connection) return 0; 519967aae551SMatthias Ringwald return hci_ssp_supported(connection) ? 1 : 0; 52002bd8b7e7S[email protected] } 52012bd8b7e7S[email protected] 520215a95bd5SMatthias Ringwald int gap_ssp_supported_on_both_sides(hci_con_handle_t handle){ 5203df3354fcS[email protected] return hci_local_ssp_activated() && hci_remote_ssp_supported(handle); 5204df3354fcS[email protected] } 5205df3354fcS[email protected] 5206458bf4e8S[email protected] // GAP API 5207458bf4e8S[email protected] /** 5208458bf4e8S[email protected] * @bbrief enable/disable bonding. default is enabled 5209458bf4e8S[email protected] * @praram enabled 5210458bf4e8S[email protected] */ 52114c57c146S[email protected] void gap_set_bondable_mode(int enable){ 52123a9fb326S[email protected] hci_stack->bondable = enable ? 1 : 0; 5213458bf4e8S[email protected] } 52144ef6443cSMatthias Ringwald /** 52154ef6443cSMatthias Ringwald * @brief Get bondable mode. 52164ef6443cSMatthias Ringwald * @return 1 if bondable 52174ef6443cSMatthias Ringwald */ 52184ef6443cSMatthias Ringwald int gap_get_bondable_mode(void){ 52194ef6443cSMatthias Ringwald return hci_stack->bondable; 52204ef6443cSMatthias Ringwald } 5221cb230b9dS[email protected] 5222cb230b9dS[email protected] /** 522334d2123cS[email protected] * @brief map link keys to security levels 5224cb230b9dS[email protected] */ 522534d2123cS[email protected] gap_security_level_t gap_security_level_for_link_key_type(link_key_type_t link_key_type){ 522634d2123cS[email protected] switch (link_key_type){ 52273c68dfa9S[email protected] case AUTHENTICATED_COMBINATION_KEY_GENERATED_FROM_P256: 52283c68dfa9S[email protected] return LEVEL_4; 52293c68dfa9S[email protected] case COMBINATION_KEY: 52303c68dfa9S[email protected] case AUTHENTICATED_COMBINATION_KEY_GENERATED_FROM_P192: 52313c68dfa9S[email protected] return LEVEL_3; 52323c68dfa9S[email protected] default: 52333c68dfa9S[email protected] return LEVEL_2; 52343c68dfa9S[email protected] } 5235cb230b9dS[email protected] } 5236cb230b9dS[email protected] 52378b35e16aSMatthias Ringwald /** 52388b35e16aSMatthias Ringwald * @brief map link keys to secure connection yes/no 52398b35e16aSMatthias Ringwald */ 52408b35e16aSMatthias Ringwald int gap_secure_connection_for_link_key_type(link_key_type_t link_key_type){ 52418b35e16aSMatthias Ringwald switch (link_key_type){ 52428b35e16aSMatthias Ringwald case AUTHENTICATED_COMBINATION_KEY_GENERATED_FROM_P256: 52438b35e16aSMatthias Ringwald case UNAUTHENTICATED_COMBINATION_KEY_GENERATED_FROM_P256: 52448b35e16aSMatthias Ringwald return 1; 52458b35e16aSMatthias Ringwald default: 52468b35e16aSMatthias Ringwald return 0; 52478b35e16aSMatthias Ringwald } 52488b35e16aSMatthias Ringwald } 52498b35e16aSMatthias Ringwald 52508b35e16aSMatthias Ringwald /** 52518b35e16aSMatthias Ringwald * @brief map link keys to authenticated 52528b35e16aSMatthias Ringwald */ 52538b35e16aSMatthias Ringwald int gap_authenticated_for_link_key_type(link_key_type_t link_key_type){ 52548b35e16aSMatthias Ringwald switch (link_key_type){ 52558b35e16aSMatthias Ringwald case AUTHENTICATED_COMBINATION_KEY_GENERATED_FROM_P256: 52568b35e16aSMatthias Ringwald case AUTHENTICATED_COMBINATION_KEY_GENERATED_FROM_P192: 52578b35e16aSMatthias Ringwald return 1; 52588b35e16aSMatthias Ringwald default: 52598b35e16aSMatthias Ringwald return 0; 52608b35e16aSMatthias Ringwald } 52618b35e16aSMatthias Ringwald } 52628b35e16aSMatthias Ringwald 5263106d6d11S[email protected] int gap_mitm_protection_required_for_security_level(gap_security_level_t level){ 52645127cc62S[email protected] log_info("gap_mitm_protection_required_for_security_level %u", level); 5265106d6d11S[email protected] return level > LEVEL_2; 5266106d6d11S[email protected] } 5267106d6d11S[email protected] 526834d2123cS[email protected] /** 526934d2123cS[email protected] * @brief get current security level 527034d2123cS[email protected] */ 527134d2123cS[email protected] gap_security_level_t gap_security_level(hci_con_handle_t con_handle){ 527234d2123cS[email protected] hci_connection_t * connection = hci_connection_for_handle(con_handle); 527334d2123cS[email protected] if (!connection) return LEVEL_0; 527434d2123cS[email protected] return gap_security_level_for_connection(connection); 527534d2123cS[email protected] } 527634d2123cS[email protected] 5277cb230b9dS[email protected] /** 5278cb230b9dS[email protected] * @brief request connection to device to 5279cb230b9dS[email protected] * @result GAP_AUTHENTICATION_RESULT 5280cb230b9dS[email protected] */ 528134d2123cS[email protected] void gap_request_security_level(hci_con_handle_t con_handle, gap_security_level_t requested_level){ 528234d2123cS[email protected] hci_connection_t * connection = hci_connection_for_handle(con_handle); 528334d2123cS[email protected] if (!connection){ 5284a00031e2S[email protected] hci_emit_security_level(con_handle, LEVEL_0); 528534d2123cS[email protected] return; 528634d2123cS[email protected] } 5287defbf200SMatthias Ringwald 5288defbf200SMatthias Ringwald btstack_assert(hci_is_le_connection(connection) == false); 5289defbf200SMatthias Ringwald 529034d2123cS[email protected] gap_security_level_t current_level = gap_security_level(con_handle); 529183d08d7cSMatthias Ringwald log_info("gap_request_security_level requested level %u, planned level %u, current level %u", 529283d08d7cSMatthias Ringwald requested_level, connection->requested_security_level, current_level); 529383d08d7cSMatthias Ringwald 529483d08d7cSMatthias Ringwald // assumption: earlier requested security higher than current level => security request is active 529583d08d7cSMatthias Ringwald if (current_level < connection->requested_security_level){ 529683d08d7cSMatthias Ringwald if (connection->requested_security_level < requested_level){ 529783d08d7cSMatthias Ringwald // increase requested level as new level is higher 529883d08d7cSMatthias Ringwald 529983d08d7cSMatthias Ringwald // TODO: handle re-authentication when done 530083d08d7cSMatthias Ringwald 530183d08d7cSMatthias Ringwald connection->requested_security_level = requested_level; 530283d08d7cSMatthias Ringwald } 530383d08d7cSMatthias Ringwald return; 530483d08d7cSMatthias Ringwald } 530583d08d7cSMatthias Ringwald 530683d08d7cSMatthias Ringwald // no request active, notify if security sufficient 530783d08d7cSMatthias Ringwald if (requested_level <= current_level){ 5308a00031e2S[email protected] hci_emit_security_level(con_handle, current_level); 530934d2123cS[email protected] return; 531034d2123cS[email protected] } 5311a00031e2S[email protected] 5312e060c07dSMatthias Ringwald // store request 531334d2123cS[email protected] connection->requested_security_level = requested_level; 5314a00031e2S[email protected] 5315e060c07dSMatthias Ringwald // start to authenticate connection if authentication not already active 5316abdad579SMatthias Ringwald if ((connection->bonding_flags & BONDING_SENT_AUTHENTICATE_REQUEST) != 0) return; 53171eb2563eS[email protected] connection->bonding_flags |= BONDING_SEND_AUTHENTICATE_REQUEST; 5318e80b2cf9S[email protected] hci_run(); 5319e00caf9cS[email protected] } 5320ad83dc6aS[email protected] 5321ad83dc6aS[email protected] /** 5322ad83dc6aS[email protected] * @brief start dedicated bonding with device. disconnect after bonding 5323ad83dc6aS[email protected] * @param device 5324ad83dc6aS[email protected] * @param request MITM protection 5325ad83dc6aS[email protected] * @result GAP_DEDICATED_BONDING_COMPLETE 5326ad83dc6aS[email protected] */ 5327ad83dc6aS[email protected] int gap_dedicated_bonding(bd_addr_t device, int mitm_protection_required){ 5328ad83dc6aS[email protected] 5329ad83dc6aS[email protected] // create connection state machine 5330f16129ceSMatthias Ringwald hci_connection_t * connection = create_connection_for_bd_addr_and_type(device, BD_ADDR_TYPE_ACL); 5331ad83dc6aS[email protected] 5332ad83dc6aS[email protected] if (!connection){ 5333ad83dc6aS[email protected] return BTSTACK_MEMORY_ALLOC_FAILED; 5334ad83dc6aS[email protected] } 5335ad83dc6aS[email protected] 5336ad83dc6aS[email protected] // delete linkn key 533715a95bd5SMatthias Ringwald gap_drop_link_key_for_bd_addr(device); 5338ad83dc6aS[email protected] 5339ad83dc6aS[email protected] // configure LEVEL_2/3, dedicated bonding 5340ad83dc6aS[email protected] connection->state = SEND_CREATE_CONNECTION; 5341ad83dc6aS[email protected] connection->requested_security_level = mitm_protection_required ? LEVEL_3 : LEVEL_2; 5342f04a0c31SMatthias Ringwald log_info("gap_dedicated_bonding, mitm %d -> level %u", mitm_protection_required, connection->requested_security_level); 5343ad83dc6aS[email protected] connection->bonding_flags = BONDING_DEDICATED; 5344ad83dc6aS[email protected] 5345ad83dc6aS[email protected] // wait for GAP Security Result and send GAP Dedicated Bonding complete 5346ad83dc6aS[email protected] 5347ad83dc6aS[email protected] // handle: connnection failure (connection complete != ok) 5348ad83dc6aS[email protected] // handle: authentication failure 5349ad83dc6aS[email protected] // handle: disconnect on done 5350ad83dc6aS[email protected] 5351ad83dc6aS[email protected] hci_run(); 5352ad83dc6aS[email protected] 5353ad83dc6aS[email protected] return 0; 5354ad83dc6aS[email protected] } 535535454696SMatthias Ringwald #endif 53568e618f72S[email protected] 53578e618f72S[email protected] void gap_set_local_name(const char * local_name){ 53588e618f72S[email protected] hci_stack->local_name = local_name; 53598e618f72S[email protected] } 53608e618f72S[email protected] 536135454696SMatthias Ringwald 536235454696SMatthias Ringwald #ifdef ENABLE_BLE 536335454696SMatthias Ringwald 5364d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 5365d8e8f12aSMatthias Ringwald void gap_start_scan(void){ 5366fde725feSMatthias Ringwald hci_stack->le_scanning_enabled = true; 53677bdc6798S[email protected] hci_run(); 53687bdc6798S[email protected] } 53698e618f72S[email protected] 5370d8e8f12aSMatthias Ringwald void gap_stop_scan(void){ 5371fde725feSMatthias Ringwald hci_stack->le_scanning_enabled = false; 53727bdc6798S[email protected] hci_run(); 53737bdc6798S[email protected] } 53744f3229d8S[email protected] 5375a7a719e9SMatthias Ringwald void gap_set_scan_params(uint8_t scan_type, uint16_t scan_interval, uint16_t scan_window, uint8_t scanning_filter_policy){ 5376ef11999fSmatthias.ringwald hci_stack->le_scan_type = scan_type; 5377a7a719e9SMatthias Ringwald hci_stack->le_scan_filter_policy = scanning_filter_policy; 5378ef11999fSmatthias.ringwald hci_stack->le_scan_interval = scan_interval; 5379ef11999fSmatthias.ringwald hci_stack->le_scan_window = scan_window; 53808b69e4c7SMatthias Ringwald hci_stack->le_scanning_param_update = true; 5381ef11999fSmatthias.ringwald hci_run(); 5382ef11999fSmatthias.ringwald } 53834f3229d8S[email protected] 5384a7a719e9SMatthias Ringwald void gap_set_scan_parameters(uint8_t scan_type, uint16_t scan_interval, uint16_t scan_window){ 5385a7a719e9SMatthias Ringwald gap_set_scan_params(scan_type, scan_interval, scan_window, 0); 5386a7a719e9SMatthias Ringwald } 5387a7a719e9SMatthias Ringwald 5388667ba9d1SMatthias Ringwald uint8_t gap_connect(const bd_addr_t addr, bd_addr_type_t addr_type){ 53894f3229d8S[email protected] hci_connection_t * conn = hci_connection_for_bd_addr_and_type(addr, addr_type); 53904f3229d8S[email protected] if (!conn){ 5391d32b3f05SMatthias Ringwald // disallow if le connection is already outgoing 5392d32b3f05SMatthias Ringwald if (hci_is_le_connection_type(addr_type) && hci_stack->le_connecting_request != LE_CONNECTING_IDLE){ 5393d32b3f05SMatthias Ringwald log_error("le connection already active"); 5394d32b3f05SMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 5395d32b3f05SMatthias Ringwald } 5396d32b3f05SMatthias Ringwald 5397d8e8f12aSMatthias Ringwald log_info("gap_connect: no connection exists yet, creating context"); 53982e77e513S[email protected] conn = create_connection_for_bd_addr_and_type(addr, addr_type); 53994f3229d8S[email protected] if (!conn){ 54004f3229d8S[email protected] // notify client that alloc failed 54016e2e9a6bS[email protected] hci_emit_le_connection_complete(addr_type, addr, 0, BTSTACK_MEMORY_ALLOC_FAILED); 5402d8e8f12aSMatthias Ringwald log_info("gap_connect: failed to alloc hci_connection_t"); 5403472a5742SMatthias Ringwald return GATT_CLIENT_NOT_CONNECTED; // don't sent packet to controller 54044f3229d8S[email protected] } 5405d5b1a89eSMatthias Ringwald 5406d5b1a89eSMatthias Ringwald // set le connecting state 5407d5b1a89eSMatthias Ringwald if (hci_is_le_connection_type(addr_type)){ 5408d5b1a89eSMatthias Ringwald hci_stack->le_connecting_request = LE_CONNECTING_DIRECT; 5409d5b1a89eSMatthias Ringwald } 5410d5b1a89eSMatthias Ringwald 54114f3229d8S[email protected] conn->state = SEND_CREATE_CONNECTION; 5412d8e8f12aSMatthias Ringwald log_info("gap_connect: send create connection next"); 5413564fca32S[email protected] hci_run(); 5414b0136355SMatthias Ringwald return ERROR_CODE_SUCCESS; 54154f3229d8S[email protected] } 54160bf6344aS[email protected] 54170bf6344aS[email protected] if (!hci_is_le_connection(conn) || 5418a1df452eSMatthias Ringwald (conn->state == SEND_CREATE_CONNECTION) || 54190e588213SMatthias Ringwald (conn->state == SENT_CREATE_CONNECTION)) { 54202e77e513S[email protected] hci_emit_le_connection_complete(conn->address_type, conn->address, 0, ERROR_CODE_COMMAND_DISALLOWED); 5421d8e8f12aSMatthias Ringwald log_error("gap_connect: classic connection or connect is already being created"); 5422616edd56SMatthias Ringwald return GATT_CLIENT_IN_WRONG_STATE; 54230bf6344aS[email protected] } 54240bf6344aS[email protected] 5425b0136355SMatthias Ringwald // check if connection was just disconnected 5426b0136355SMatthias Ringwald if (conn->state == RECEIVED_DISCONNECTION_COMPLETE){ 5427b0136355SMatthias Ringwald log_info("gap_connect: send create connection (again)"); 5428b0136355SMatthias Ringwald conn->state = SEND_CREATE_CONNECTION; 5429b0136355SMatthias Ringwald hci_run(); 5430b0136355SMatthias Ringwald return ERROR_CODE_SUCCESS; 5431b0136355SMatthias Ringwald } 5432b0136355SMatthias Ringwald 5433d8e8f12aSMatthias Ringwald log_info("gap_connect: context exists with state %u", conn->state); 5434d5b1a89eSMatthias Ringwald hci_emit_le_connection_complete(conn->address_type, conn->address, conn->con_handle, ERROR_CODE_SUCCESS); 54354f3229d8S[email protected] hci_run(); 5436b0136355SMatthias Ringwald return ERROR_CODE_SUCCESS; 54374f3229d8S[email protected] } 54384f3229d8S[email protected] 54397851196eSmatthias.ringwald // @assumption: only a single outgoing LE Connection exists 5440d8e8f12aSMatthias Ringwald static hci_connection_t * gap_get_outgoing_connection(void){ 5441665d90f2SMatthias Ringwald btstack_linked_item_t *it; 5442a0da043fSMatthias Ringwald for (it = (btstack_linked_item_t *) hci_stack->connections; it != NULL; it = it->next){ 54430bf6344aS[email protected] hci_connection_t * conn = (hci_connection_t *) it; 54440bf6344aS[email protected] if (!hci_is_le_connection(conn)) continue; 54450bf6344aS[email protected] switch (conn->state){ 5446a6725849S[email protected] case SEND_CREATE_CONNECTION: 54477851196eSmatthias.ringwald case SENT_CREATE_CONNECTION: 54489c77c9dbSMatthias Ringwald case SENT_CANCEL_CONNECTION: 54497851196eSmatthias.ringwald return conn; 54507851196eSmatthias.ringwald default: 54517851196eSmatthias.ringwald break; 54527851196eSmatthias.ringwald }; 54537851196eSmatthias.ringwald } 54547851196eSmatthias.ringwald return NULL; 54557851196eSmatthias.ringwald } 54567851196eSmatthias.ringwald 5457d8e8f12aSMatthias Ringwald uint8_t gap_connect_cancel(void){ 5458d8e8f12aSMatthias Ringwald hci_connection_t * conn = gap_get_outgoing_connection(); 5459616edd56SMatthias Ringwald if (!conn) return 0; 54607851196eSmatthias.ringwald switch (conn->state){ 54617851196eSmatthias.ringwald case SEND_CREATE_CONNECTION: 54627851196eSmatthias.ringwald // skip sending create connection and emit event instead 54632e77e513S[email protected] hci_emit_le_connection_complete(conn->address_type, conn->address, 0, ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER); 5464665d90f2SMatthias Ringwald btstack_linked_list_remove(&hci_stack->connections, (btstack_linked_item_t *) conn); 54657851196eSmatthias.ringwald btstack_memory_hci_connection_free( conn ); 54660bf6344aS[email protected] break; 5467a6725849S[email protected] case SENT_CREATE_CONNECTION: 54687851196eSmatthias.ringwald // request to send cancel connection 54690bf6344aS[email protected] conn->state = SEND_CANCEL_CONNECTION; 54700bf6344aS[email protected] hci_run(); 54710bf6344aS[email protected] break; 54720bf6344aS[email protected] default: 54730bf6344aS[email protected] break; 54740bf6344aS[email protected] } 5475616edd56SMatthias Ringwald return 0; 5476e31f89a7S[email protected] } 5477d70217a2SMatthias Ringwald #endif 54784f3229d8S[email protected] 547913e645d2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 5480c37a3166S[email protected] /** 54816012052bSMatthias Ringwald * @brief Set connection parameters for outgoing connections 5482cbe54ab2SJakob Krantz * @param conn_scan_interval (unit: 0.625 msec), default: 60 ms 5483cbe54ab2SJakob Krantz * @param conn_scan_window (unit: 0.625 msec), default: 30 ms 54846012052bSMatthias Ringwald * @param conn_interval_min (unit: 1.25ms), default: 10 ms 54856012052bSMatthias Ringwald * @param conn_interval_max (unit: 1.25ms), default: 30 ms 54866012052bSMatthias Ringwald * @param conn_latency, default: 4 54876012052bSMatthias Ringwald * @param supervision_timeout (unit: 10ms), default: 720 ms 54886012052bSMatthias Ringwald * @param min_ce_length (unit: 0.625ms), default: 10 ms 54896012052bSMatthias Ringwald * @param max_ce_length (unit: 0.625ms), default: 30 ms 54906012052bSMatthias Ringwald */ 54916012052bSMatthias Ringwald 5492cbe54ab2SJakob Krantz void gap_set_connection_parameters(uint16_t conn_scan_interval, uint16_t conn_scan_window, 5493cbe54ab2SJakob Krantz uint16_t conn_interval_min, uint16_t conn_interval_max, uint16_t conn_latency, 5494cbe54ab2SJakob Krantz uint16_t supervision_timeout, uint16_t min_ce_length, uint16_t max_ce_length){ 5495cbe54ab2SJakob Krantz hci_stack->le_connection_scan_interval = conn_scan_interval; 5496cbe54ab2SJakob Krantz hci_stack->le_connection_scan_window = conn_scan_window; 54976012052bSMatthias Ringwald hci_stack->le_connection_interval_min = conn_interval_min; 54986012052bSMatthias Ringwald hci_stack->le_connection_interval_max = conn_interval_max; 54996012052bSMatthias Ringwald hci_stack->le_connection_latency = conn_latency; 55006012052bSMatthias Ringwald hci_stack->le_supervision_timeout = supervision_timeout; 55016012052bSMatthias Ringwald hci_stack->le_minimum_ce_length = min_ce_length; 55026012052bSMatthias Ringwald hci_stack->le_maximum_ce_length = max_ce_length; 55036012052bSMatthias Ringwald } 550413e645d2SMatthias Ringwald #endif 55056012052bSMatthias Ringwald 55066012052bSMatthias Ringwald /** 5507c37a3166S[email protected] * @brief Updates the connection parameters for a given LE connection 5508c37a3166S[email protected] * @param handle 5509c37a3166S[email protected] * @param conn_interval_min (unit: 1.25ms) 5510c37a3166S[email protected] * @param conn_interval_max (unit: 1.25ms) 5511c37a3166S[email protected] * @param conn_latency 5512c37a3166S[email protected] * @param supervision_timeout (unit: 10ms) 5513c37a3166S[email protected] * @returns 0 if ok 5514c37a3166S[email protected] */ 5515c37a3166S[email protected] int gap_update_connection_parameters(hci_con_handle_t con_handle, uint16_t conn_interval_min, 5516c37a3166S[email protected] uint16_t conn_interval_max, uint16_t conn_latency, uint16_t supervision_timeout){ 5517c37a3166S[email protected] hci_connection_t * connection = hci_connection_for_handle(con_handle); 5518c37a3166S[email protected] if (!connection) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 5519c37a3166S[email protected] connection->le_conn_interval_min = conn_interval_min; 5520c37a3166S[email protected] connection->le_conn_interval_max = conn_interval_max; 5521c37a3166S[email protected] connection->le_conn_latency = conn_latency; 5522c37a3166S[email protected] connection->le_supervision_timeout = supervision_timeout; 552384cf6d83SMatthias Ringwald connection->le_con_parameter_update_state = CON_PARAMETER_UPDATE_CHANGE_HCI_CON_PARAMETERS; 5524cfc59f1bSMatthias Ringwald hci_run(); 5525c37a3166S[email protected] return 0; 5526c37a3166S[email protected] } 5527c37a3166S[email protected] 552845c102fdSMatthias Ringwald /** 5529b68d7bc3SMatthias Ringwald * @brief Request an update of the connection parameter for a given LE connection 5530b68d7bc3SMatthias Ringwald * @param handle 5531b68d7bc3SMatthias Ringwald * @param conn_interval_min (unit: 1.25ms) 5532b68d7bc3SMatthias Ringwald * @param conn_interval_max (unit: 1.25ms) 5533b68d7bc3SMatthias Ringwald * @param conn_latency 5534b68d7bc3SMatthias Ringwald * @param supervision_timeout (unit: 10ms) 5535b68d7bc3SMatthias Ringwald * @returns 0 if ok 5536b68d7bc3SMatthias Ringwald */ 5537b68d7bc3SMatthias Ringwald int gap_request_connection_parameter_update(hci_con_handle_t con_handle, uint16_t conn_interval_min, 5538b68d7bc3SMatthias Ringwald uint16_t conn_interval_max, uint16_t conn_latency, uint16_t supervision_timeout){ 5539b68d7bc3SMatthias Ringwald hci_connection_t * connection = hci_connection_for_handle(con_handle); 5540b68d7bc3SMatthias Ringwald if (!connection) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 5541b68d7bc3SMatthias Ringwald connection->le_conn_interval_min = conn_interval_min; 5542b68d7bc3SMatthias Ringwald connection->le_conn_interval_max = conn_interval_max; 5543b68d7bc3SMatthias Ringwald connection->le_conn_latency = conn_latency; 5544b68d7bc3SMatthias Ringwald connection->le_supervision_timeout = supervision_timeout; 5545b68d7bc3SMatthias Ringwald connection->le_con_parameter_update_state = CON_PARAMETER_UPDATE_SEND_REQUEST; 554609c9c963SMatthias Ringwald uint8_t l2cap_trigger_run_event[2] = { L2CAP_EVENT_TRIGGER_RUN, 0}; 554709c9c963SMatthias Ringwald hci_emit_event(l2cap_trigger_run_event, sizeof(l2cap_trigger_run_event), 0); 5548b68d7bc3SMatthias Ringwald return 0; 5549b68d7bc3SMatthias Ringwald } 5550b68d7bc3SMatthias Ringwald 5551d70217a2SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 5552d70217a2SMatthias Ringwald 5553b68d7bc3SMatthias Ringwald /** 555445c102fdSMatthias Ringwald * @brief Set Advertisement Data 555545c102fdSMatthias Ringwald * @param advertising_data_length 555645c102fdSMatthias Ringwald * @param advertising_data (max 31 octets) 555745c102fdSMatthias Ringwald * @note data is not copied, pointer has to stay valid 555845c102fdSMatthias Ringwald */ 555945c102fdSMatthias Ringwald void gap_advertisements_set_data(uint8_t advertising_data_length, uint8_t * advertising_data){ 556045c102fdSMatthias Ringwald hci_stack->le_advertisements_data_len = advertising_data_length; 556145c102fdSMatthias Ringwald hci_stack->le_advertisements_data = advertising_data; 5562501f56b3SMatthias Ringwald hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_SET_ADV_DATA; 5563bbc366e6SMatthias Ringwald hci_run(); 556445c102fdSMatthias Ringwald } 5565501f56b3SMatthias Ringwald 5566501f56b3SMatthias Ringwald /** 5567501f56b3SMatthias Ringwald * @brief Set Scan Response Data 5568501f56b3SMatthias Ringwald * @param advertising_data_length 5569501f56b3SMatthias Ringwald * @param advertising_data (max 31 octets) 5570501f56b3SMatthias Ringwald * @note data is not copied, pointer has to stay valid 5571501f56b3SMatthias Ringwald */ 5572501f56b3SMatthias Ringwald void gap_scan_response_set_data(uint8_t scan_response_data_length, uint8_t * scan_response_data){ 5573501f56b3SMatthias Ringwald hci_stack->le_scan_response_data_len = scan_response_data_length; 5574501f56b3SMatthias Ringwald hci_stack->le_scan_response_data = scan_response_data; 5575501f56b3SMatthias Ringwald hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_SET_SCAN_DATA; 5576bbc366e6SMatthias Ringwald hci_run(); 557745c102fdSMatthias Ringwald } 557845c102fdSMatthias Ringwald 557945c102fdSMatthias Ringwald /** 558045c102fdSMatthias Ringwald * @brief Set Advertisement Parameters 558145c102fdSMatthias Ringwald * @param adv_int_min 558245c102fdSMatthias Ringwald * @param adv_int_max 558345c102fdSMatthias Ringwald * @param adv_type 558445c102fdSMatthias Ringwald * @param direct_address_type 558545c102fdSMatthias Ringwald * @param direct_address 558645c102fdSMatthias Ringwald * @param channel_map 558745c102fdSMatthias Ringwald * @param filter_policy 558845c102fdSMatthias Ringwald * 558945c102fdSMatthias Ringwald * @note internal use. use gap_advertisements_set_params from gap_le.h instead. 559045c102fdSMatthias Ringwald */ 559145c102fdSMatthias Ringwald void hci_le_advertisements_set_params(uint16_t adv_int_min, uint16_t adv_int_max, uint8_t adv_type, 5592b95a5a35SMatthias Ringwald uint8_t direct_address_typ, bd_addr_t direct_address, 559345c102fdSMatthias Ringwald uint8_t channel_map, uint8_t filter_policy) { 559445c102fdSMatthias Ringwald 559545c102fdSMatthias Ringwald hci_stack->le_advertisements_interval_min = adv_int_min; 559645c102fdSMatthias Ringwald hci_stack->le_advertisements_interval_max = adv_int_max; 559745c102fdSMatthias Ringwald hci_stack->le_advertisements_type = adv_type; 559845c102fdSMatthias Ringwald hci_stack->le_advertisements_direct_address_type = direct_address_typ; 559945c102fdSMatthias Ringwald hci_stack->le_advertisements_channel_map = channel_map; 560045c102fdSMatthias Ringwald hci_stack->le_advertisements_filter_policy = filter_policy; 56016535961aSMatthias Ringwald (void)memcpy(hci_stack->le_advertisements_direct_address, direct_address, 56026535961aSMatthias Ringwald 6); 560345c102fdSMatthias Ringwald 560445c102fdSMatthias Ringwald hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_SET_PARAMS; 5605bbc366e6SMatthias Ringwald hci_run(); 560645c102fdSMatthias Ringwald } 560745c102fdSMatthias Ringwald 560845c102fdSMatthias Ringwald /** 560945c102fdSMatthias Ringwald * @brief Enable/Disable Advertisements 561045c102fdSMatthias Ringwald * @param enabled 561145c102fdSMatthias Ringwald */ 561245c102fdSMatthias Ringwald void gap_advertisements_enable(int enabled){ 56135226d7f2SMatthias Ringwald hci_stack->le_advertisements_enabled = enabled != 0; 5614bbc366e6SMatthias Ringwald hci_update_advertisements_enabled_for_current_roles(); 5615cfc59f1bSMatthias Ringwald hci_run(); 561645c102fdSMatthias Ringwald } 561745c102fdSMatthias Ringwald 561835454696SMatthias Ringwald #endif 561906e5cf96SMatthias Ringwald 562006e5cf96SMatthias Ringwald void hci_le_set_own_address_type(uint8_t own_address_type){ 562106e5cf96SMatthias Ringwald log_info("hci_le_set_own_address_type: old %u, new %u", hci_stack->le_own_addr_type, own_address_type); 562206e5cf96SMatthias Ringwald if (own_address_type == hci_stack->le_own_addr_type) return; 562306e5cf96SMatthias Ringwald hci_stack->le_own_addr_type = own_address_type; 562406e5cf96SMatthias Ringwald 562564068776SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 562606e5cf96SMatthias Ringwald // update advertisement parameters, too 562706e5cf96SMatthias Ringwald hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_SET_PARAMS; 5628bbc366e6SMatthias Ringwald hci_run(); 562964068776SMatthias Ringwald #endif 563064068776SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 563106e5cf96SMatthias Ringwald // note: we don't update scan parameters or modify ongoing connection attempts 563264068776SMatthias Ringwald #endif 563306e5cf96SMatthias Ringwald } 563406e5cf96SMatthias Ringwald 5635d70217a2SMatthias Ringwald #endif 563645c102fdSMatthias Ringwald 5637616edd56SMatthias Ringwald uint8_t gap_disconnect(hci_con_handle_t handle){ 56385917a5c5S[email protected] hci_connection_t * conn = hci_connection_for_handle(handle); 56395917a5c5S[email protected] if (!conn){ 56407851196eSmatthias.ringwald hci_emit_disconnection_complete(handle, 0); 5641616edd56SMatthias Ringwald return 0; 56425917a5c5S[email protected] } 56437fd7aa6fSMatthias Ringwald // ignore if already disconnected 56447fd7aa6fSMatthias Ringwald if (conn->state == RECEIVED_DISCONNECTION_COMPLETE){ 56457fd7aa6fSMatthias Ringwald return 0; 56467fd7aa6fSMatthias Ringwald } 56475917a5c5S[email protected] conn->state = SEND_DISCONNECT; 56485917a5c5S[email protected] hci_run(); 5649616edd56SMatthias Ringwald return 0; 56504f3229d8S[email protected] } 565104a6ef8cSmatthias.ringwald 5652228e430cSMatthias Ringwald int gap_read_rssi(hci_con_handle_t con_handle){ 5653228e430cSMatthias Ringwald hci_connection_t * hci_connection = hci_connection_for_handle(con_handle); 5654228e430cSMatthias Ringwald if (hci_connection == NULL) return 0; 5655228e430cSMatthias Ringwald connectionSetAuthenticationFlags(hci_connection, READ_RSSI); 5656228e430cSMatthias Ringwald hci_run(); 5657228e430cSMatthias Ringwald return 1; 5658228e430cSMatthias Ringwald } 5659228e430cSMatthias Ringwald 5660a1bf5ae7SMatthias Ringwald /** 5661a1bf5ae7SMatthias Ringwald * @brief Get connection type 5662a1bf5ae7SMatthias Ringwald * @param con_handle 5663a1bf5ae7SMatthias Ringwald * @result connection_type 5664a1bf5ae7SMatthias Ringwald */ 5665a1bf5ae7SMatthias Ringwald gap_connection_type_t gap_get_connection_type(hci_con_handle_t connection_handle){ 5666a1bf5ae7SMatthias Ringwald hci_connection_t * conn = hci_connection_for_handle(connection_handle); 5667a1bf5ae7SMatthias Ringwald if (!conn) return GAP_CONNECTION_INVALID; 5668a1bf5ae7SMatthias Ringwald switch (conn->address_type){ 5669a1bf5ae7SMatthias Ringwald case BD_ADDR_TYPE_LE_PUBLIC: 5670a1bf5ae7SMatthias Ringwald case BD_ADDR_TYPE_LE_RANDOM: 5671a1bf5ae7SMatthias Ringwald return GAP_CONNECTION_LE; 5672a1bf5ae7SMatthias Ringwald case BD_ADDR_TYPE_SCO: 5673a1bf5ae7SMatthias Ringwald return GAP_CONNECTION_SCO; 5674f16129ceSMatthias Ringwald case BD_ADDR_TYPE_ACL: 5675a1bf5ae7SMatthias Ringwald return GAP_CONNECTION_ACL; 5676a1bf5ae7SMatthias Ringwald default: 5677a1bf5ae7SMatthias Ringwald return GAP_CONNECTION_INVALID; 5678a1bf5ae7SMatthias Ringwald } 5679a1bf5ae7SMatthias Ringwald } 5680a1bf5ae7SMatthias Ringwald 56812dceb1d6SMatthias Ringwald hci_role_t gap_get_role(hci_con_handle_t connection_handle){ 56822dceb1d6SMatthias Ringwald hci_connection_t * conn = hci_connection_for_handle(connection_handle); 56832dceb1d6SMatthias Ringwald if (!conn) return HCI_ROLE_INVALID; 56842dceb1d6SMatthias Ringwald return (hci_role_t) conn->role; 56852dceb1d6SMatthias Ringwald } 56862dceb1d6SMatthias Ringwald 56872dceb1d6SMatthias Ringwald 568844f858f3SMatthias Ringwald #ifdef ENABLE_CLASSIC 5689667ba9d1SMatthias Ringwald uint8_t gap_request_role(const bd_addr_t addr, hci_role_t role){ 569088a03c8dSMatthias Ringwald hci_connection_t * conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL); 569188a03c8dSMatthias Ringwald if (!conn) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 569288a03c8dSMatthias Ringwald conn->request_role = role; 569388a03c8dSMatthias Ringwald hci_run(); 5694d04a455eSMatthias Ringwald return ERROR_CODE_SUCCESS; 569588a03c8dSMatthias Ringwald } 569644f858f3SMatthias Ringwald #endif 569788a03c8dSMatthias Ringwald 5698a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE 56994f551432SMatthias Ringwald 5700b90f6e0aSMatthias Ringwald uint8_t gap_le_set_phy(hci_con_handle_t connection_handle, uint8_t all_phys, uint8_t tx_phys, uint8_t rx_phys, uint8_t phy_options){ 5701b90f6e0aSMatthias Ringwald hci_connection_t * conn = hci_connection_for_handle(connection_handle); 5702b90f6e0aSMatthias Ringwald if (!conn) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 5703b90f6e0aSMatthias Ringwald 5704b90f6e0aSMatthias Ringwald conn->le_phy_update_all_phys = all_phys; 5705b90f6e0aSMatthias Ringwald conn->le_phy_update_tx_phys = tx_phys; 5706b90f6e0aSMatthias Ringwald conn->le_phy_update_rx_phys = rx_phys; 5707b90f6e0aSMatthias Ringwald conn->le_phy_update_phy_options = phy_options; 5708b90f6e0aSMatthias Ringwald 5709b90f6e0aSMatthias Ringwald hci_run(); 5710b90f6e0aSMatthias Ringwald 5711b90f6e0aSMatthias Ringwald return 0; 5712b90f6e0aSMatthias Ringwald } 5713b90f6e0aSMatthias Ringwald 5714667ba9d1SMatthias Ringwald static uint8_t hci_whitelist_add(bd_addr_type_t address_type, const bd_addr_t address){ 57157a92a9dbSMatthias Ringwald // check if already in list 57167a92a9dbSMatthias Ringwald btstack_linked_list_iterator_t it; 57177a92a9dbSMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->le_whitelist); 57187a92a9dbSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)) { 57197a92a9dbSMatthias Ringwald whitelist_entry_t *entry = (whitelist_entry_t *) btstack_linked_list_iterator_next(&it); 57207a92a9dbSMatthias Ringwald if (entry->address_type != address_type) { 57217a92a9dbSMatthias Ringwald continue; 57227a92a9dbSMatthias Ringwald } 57237a92a9dbSMatthias Ringwald if (memcmp(entry->address, address, 6) != 0) { 57247a92a9dbSMatthias Ringwald continue; 57257a92a9dbSMatthias Ringwald } 5726287379ccSMatthias Ringwald // disallow if already scheduled to add 5727287379ccSMatthias Ringwald if ((entry->state & LE_WHITELIST_ADD_TO_CONTROLLER) != 0){ 57287a92a9dbSMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 57297a92a9dbSMatthias Ringwald } 5730287379ccSMatthias Ringwald // still on controller, but scheduled to remove -> re-add 5731287379ccSMatthias Ringwald entry->state |= LE_WHITELIST_ADD_TO_CONTROLLER; 5732287379ccSMatthias Ringwald return ERROR_CODE_SUCCESS; 5733287379ccSMatthias Ringwald } 57347a92a9dbSMatthias Ringwald // alloc and add to list 5735e83201bcSMatthias Ringwald whitelist_entry_t * entry = btstack_memory_whitelist_entry_get(); 5736e83201bcSMatthias Ringwald if (!entry) return BTSTACK_MEMORY_ALLOC_FAILED; 5737e83201bcSMatthias Ringwald entry->address_type = address_type; 57386535961aSMatthias Ringwald (void)memcpy(entry->address, address, 6); 5739e83201bcSMatthias Ringwald entry->state = LE_WHITELIST_ADD_TO_CONTROLLER; 5740665d90f2SMatthias Ringwald btstack_linked_list_add(&hci_stack->le_whitelist, (btstack_linked_item_t*) entry); 5741226db5efSMatthias Ringwald return ERROR_CODE_SUCCESS; 5742ac9c45e0SMatthias Ringwald } 5743ac9c45e0SMatthias Ringwald 5744667ba9d1SMatthias Ringwald static uint8_t hci_whitelist_remove(bd_addr_type_t address_type, const bd_addr_t address){ 5745665d90f2SMatthias Ringwald btstack_linked_list_iterator_t it; 5746665d90f2SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->le_whitelist); 5747665d90f2SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 5748665d90f2SMatthias Ringwald whitelist_entry_t * entry = (whitelist_entry_t*) btstack_linked_list_iterator_next(&it); 57497a92a9dbSMatthias Ringwald if (entry->address_type != address_type) { 57507a92a9dbSMatthias Ringwald continue; 57517a92a9dbSMatthias Ringwald } 57527a92a9dbSMatthias Ringwald if (memcmp(entry->address, address, 6) != 0) { 57537a92a9dbSMatthias Ringwald continue; 57547a92a9dbSMatthias Ringwald } 5755e83201bcSMatthias Ringwald if (entry->state & LE_WHITELIST_ON_CONTROLLER){ 5756e83201bcSMatthias Ringwald // remove from controller if already present 5757e83201bcSMatthias Ringwald entry->state |= LE_WHITELIST_REMOVE_FROM_CONTROLLER; 5758a3b69fdeSMatthias Ringwald } else { 5759226db5efSMatthias Ringwald // directly remove entry from whitelist 5760665d90f2SMatthias Ringwald btstack_linked_list_iterator_remove(&it); 5761e83201bcSMatthias Ringwald btstack_memory_whitelist_entry_free(entry); 5762e83201bcSMatthias Ringwald } 5763a3b69fdeSMatthias Ringwald return ERROR_CODE_SUCCESS; 5764a3b69fdeSMatthias Ringwald } 5765a3b69fdeSMatthias Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 576642ff5ba1SMatthias Ringwald } 576742ff5ba1SMatthias Ringwald 5768226db5efSMatthias Ringwald static void hci_whitelist_clear(void){ 5769665d90f2SMatthias Ringwald btstack_linked_list_iterator_t it; 5770665d90f2SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->le_whitelist); 5771665d90f2SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 5772665d90f2SMatthias Ringwald whitelist_entry_t * entry = (whitelist_entry_t*) btstack_linked_list_iterator_next(&it); 5773e83201bcSMatthias Ringwald if (entry->state & LE_WHITELIST_ON_CONTROLLER){ 5774e83201bcSMatthias Ringwald // remove from controller if already present 5775e83201bcSMatthias Ringwald entry->state |= LE_WHITELIST_REMOVE_FROM_CONTROLLER; 5776e83201bcSMatthias Ringwald continue; 5777e83201bcSMatthias Ringwald } 577891915b0bSMatthias Ringwald // directly remove entry from whitelist 5779665d90f2SMatthias Ringwald btstack_linked_list_iterator_remove(&it); 5780e83201bcSMatthias Ringwald btstack_memory_whitelist_entry_free(entry); 5781e83201bcSMatthias Ringwald } 5782226db5efSMatthias Ringwald } 5783226db5efSMatthias Ringwald 5784a3b69fdeSMatthias Ringwald /** 5785a3b69fdeSMatthias Ringwald * @brief Clear Whitelist 5786a3b69fdeSMatthias Ringwald * @returns 0 if ok 5787a3b69fdeSMatthias Ringwald */ 5788a3b69fdeSMatthias Ringwald uint8_t gap_whitelist_clear(void){ 5789a3b69fdeSMatthias Ringwald hci_whitelist_clear(); 5790a3b69fdeSMatthias Ringwald hci_run(); 5791a3b69fdeSMatthias Ringwald return ERROR_CODE_SUCCESS; 5792a3b69fdeSMatthias Ringwald } 5793a3b69fdeSMatthias Ringwald 5794a3b69fdeSMatthias Ringwald /** 5795a3b69fdeSMatthias Ringwald * @brief Add Device to Whitelist 5796a3b69fdeSMatthias Ringwald * @param address_typ 5797a3b69fdeSMatthias Ringwald * @param address 5798a3b69fdeSMatthias Ringwald * @returns 0 if ok 5799a3b69fdeSMatthias Ringwald */ 5800667ba9d1SMatthias Ringwald uint8_t gap_whitelist_add(bd_addr_type_t address_type, const bd_addr_t address){ 5801a3b69fdeSMatthias Ringwald uint8_t status = hci_whitelist_add(address_type, address); 5802a3b69fdeSMatthias Ringwald if (status){ 5803a3b69fdeSMatthias Ringwald return status; 5804a3b69fdeSMatthias Ringwald } 5805a3b69fdeSMatthias Ringwald hci_run(); 5806a3b69fdeSMatthias Ringwald return ERROR_CODE_SUCCESS; 5807a3b69fdeSMatthias Ringwald } 5808a3b69fdeSMatthias Ringwald 5809a3b69fdeSMatthias Ringwald /** 5810a3b69fdeSMatthias Ringwald * @brief Remove Device from Whitelist 5811a3b69fdeSMatthias Ringwald * @param address_typ 5812a3b69fdeSMatthias Ringwald * @param address 5813a3b69fdeSMatthias Ringwald * @returns 0 if ok 5814a3b69fdeSMatthias Ringwald */ 5815667ba9d1SMatthias Ringwald uint8_t gap_whitelist_remove(bd_addr_type_t address_type, const bd_addr_t address){ 5816a3b69fdeSMatthias Ringwald uint8_t status = hci_whitelist_remove(address_type, address); 5817a3b69fdeSMatthias Ringwald if (status){ 5818a3b69fdeSMatthias Ringwald return status; 5819a3b69fdeSMatthias Ringwald } 5820a3b69fdeSMatthias Ringwald hci_run(); 5821a3b69fdeSMatthias Ringwald return ERROR_CODE_SUCCESS; 5822a3b69fdeSMatthias Ringwald } 5823a3b69fdeSMatthias Ringwald 5824226db5efSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 5825226db5efSMatthias Ringwald /** 582695e257d9SMatthias Ringwald * @brief Connect with Whitelist 582795e257d9SMatthias Ringwald * @note Explicit whitelist management and this connect with whitelist replace deprecated gap_auto_connection_* functions 582895e257d9SMatthias Ringwald * @returns - if ok 582995e257d9SMatthias Ringwald */ 583095e257d9SMatthias Ringwald uint8_t gap_connect_with_whitelist(void){ 583195e257d9SMatthias Ringwald if (hci_stack->le_connecting_request != LE_CONNECTING_IDLE){ 583295e257d9SMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 583395e257d9SMatthias Ringwald } 583495e257d9SMatthias Ringwald hci_stack->le_connecting_request = LE_CONNECTING_WHITELIST; 583595e257d9SMatthias Ringwald hci_run(); 583695e257d9SMatthias Ringwald return ERROR_CODE_SUCCESS; 583795e257d9SMatthias Ringwald } 583895e257d9SMatthias Ringwald 583995e257d9SMatthias Ringwald /** 5840226db5efSMatthias Ringwald * @brief Auto Connection Establishment - Start Connecting to device 5841226db5efSMatthias Ringwald * @param address_typ 5842226db5efSMatthias Ringwald * @param address 5843226db5efSMatthias Ringwald * @returns 0 if ok 5844226db5efSMatthias Ringwald */ 5845667ba9d1SMatthias Ringwald uint8_t gap_auto_connection_start(bd_addr_type_t address_type, const bd_addr_t address){ 584695e257d9SMatthias Ringwald if (hci_stack->le_connecting_request == LE_CONNECTING_DIRECT){ 5847226db5efSMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 5848226db5efSMatthias Ringwald } 5849226db5efSMatthias Ringwald 5850226db5efSMatthias Ringwald uint8_t status = hci_whitelist_add(address_type, address); 585163f2efc9SMatthias Ringwald if (status == BTSTACK_MEMORY_ALLOC_FAILED) { 5852226db5efSMatthias Ringwald return status; 5853226db5efSMatthias Ringwald } 5854226db5efSMatthias Ringwald 5855226db5efSMatthias Ringwald hci_stack->le_connecting_request = LE_CONNECTING_WHITELIST; 5856226db5efSMatthias Ringwald 5857226db5efSMatthias Ringwald hci_run(); 585895e257d9SMatthias Ringwald return ERROR_CODE_SUCCESS; 5859226db5efSMatthias Ringwald } 5860226db5efSMatthias Ringwald 5861226db5efSMatthias Ringwald /** 5862226db5efSMatthias Ringwald * @brief Auto Connection Establishment - Stop Connecting to device 5863226db5efSMatthias Ringwald * @param address_typ 5864226db5efSMatthias Ringwald * @param address 5865226db5efSMatthias Ringwald * @returns 0 if ok 5866226db5efSMatthias Ringwald */ 5867667ba9d1SMatthias Ringwald uint8_t gap_auto_connection_stop(bd_addr_type_t address_type, const bd_addr_t address){ 586895e257d9SMatthias Ringwald if (hci_stack->le_connecting_request == LE_CONNECTING_DIRECT){ 586995e257d9SMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 587095e257d9SMatthias Ringwald } 587195e257d9SMatthias Ringwald 5872226db5efSMatthias Ringwald hci_whitelist_remove(address_type, address); 587395e257d9SMatthias Ringwald if (btstack_linked_list_empty(&hci_stack->le_whitelist)){ 587495e257d9SMatthias Ringwald hci_stack->le_connecting_request = LE_CONNECTING_IDLE; 587595e257d9SMatthias Ringwald } 5876226db5efSMatthias Ringwald hci_run(); 5877226db5efSMatthias Ringwald return 0; 5878226db5efSMatthias Ringwald } 5879226db5efSMatthias Ringwald 5880226db5efSMatthias Ringwald /** 5881226db5efSMatthias Ringwald * @brief Auto Connection Establishment - Stop everything 5882226db5efSMatthias Ringwald * @note Convenience function to stop all active auto connection attempts 5883226db5efSMatthias Ringwald */ 588495e257d9SMatthias Ringwald uint8_t gap_auto_connection_stop_all(void){ 588595e257d9SMatthias Ringwald if (hci_stack->le_connecting_request == LE_CONNECTING_DIRECT) { 588695e257d9SMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 588795e257d9SMatthias Ringwald } 5888226db5efSMatthias Ringwald hci_whitelist_clear(); 5889226db5efSMatthias Ringwald hci_stack->le_connecting_request = LE_CONNECTING_IDLE; 5890e83201bcSMatthias Ringwald hci_run(); 589195e257d9SMatthias Ringwald return ERROR_CODE_SUCCESS; 5892ac9c45e0SMatthias Ringwald } 5893c9db5c21SMilanka Ringwald 5894c9db5c21SMilanka Ringwald uint16_t gap_le_connection_interval(hci_con_handle_t connection_handle){ 5895c9db5c21SMilanka Ringwald hci_connection_t * conn = hci_connection_for_handle(connection_handle); 5896c9db5c21SMilanka Ringwald if (!conn) return 0; 5897c9db5c21SMilanka Ringwald return conn->le_connection_interval; 5898c9db5c21SMilanka Ringwald } 5899d70217a2SMatthias Ringwald #endif 59004f551432SMatthias Ringwald #endif 59014f551432SMatthias Ringwald 590235454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 5903ac9c45e0SMatthias Ringwald /** 5904ff00ed1cSMatthias Ringwald * @brief Set Extended Inquiry Response data 5905a8c4e5adSMatthias Ringwald * @param eir_data size HCI_EXTENDED_INQUIRY_RESPONSE_DATA_LEN (240) bytes, is not copied make sure memory is accessible during stack startup 5906ff00ed1cSMatthias Ringwald * @note has to be done before stack starts up 5907ff00ed1cSMatthias Ringwald */ 5908ff00ed1cSMatthias Ringwald void gap_set_extended_inquiry_response(const uint8_t * data){ 5909ff00ed1cSMatthias Ringwald hci_stack->eir_data = data; 5910ff00ed1cSMatthias Ringwald } 5911ff00ed1cSMatthias Ringwald 5912ff00ed1cSMatthias Ringwald /** 5913f5875de5SMatthias Ringwald * @brief Start GAP Classic Inquiry 5914f5875de5SMatthias Ringwald * @param duration in 1.28s units 5915f5875de5SMatthias Ringwald * @return 0 if ok 5916f5875de5SMatthias Ringwald * @events: GAP_EVENT_INQUIRY_RESULT, GAP_EVENT_INQUIRY_COMPLETE 5917f5875de5SMatthias Ringwald */ 5918f5875de5SMatthias Ringwald int gap_inquiry_start(uint8_t duration_in_1280ms_units){ 591999449554SMatthias Ringwald if (hci_stack->state != HCI_STATE_WORKING) return ERROR_CODE_COMMAND_DISALLOWED; 5920f5875de5SMatthias Ringwald if (hci_stack->inquiry_state != GAP_INQUIRY_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED; 5921a1df452eSMatthias Ringwald if ((duration_in_1280ms_units < GAP_INQUIRY_DURATION_MIN) || (duration_in_1280ms_units > GAP_INQUIRY_DURATION_MAX)){ 5922f5875de5SMatthias Ringwald return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS; 5923f5875de5SMatthias Ringwald } 5924f5875de5SMatthias Ringwald hci_stack->inquiry_state = duration_in_1280ms_units; 5925f5875de5SMatthias Ringwald hci_run(); 5926f5875de5SMatthias Ringwald return 0; 5927f5875de5SMatthias Ringwald } 5928f5875de5SMatthias Ringwald 5929f5875de5SMatthias Ringwald /** 5930f5875de5SMatthias Ringwald * @brief Stop GAP Classic Inquiry 5931f5875de5SMatthias Ringwald * @returns 0 if ok 5932f5875de5SMatthias Ringwald */ 5933f5875de5SMatthias Ringwald int gap_inquiry_stop(void){ 5934a1df452eSMatthias Ringwald if ((hci_stack->inquiry_state >= GAP_INQUIRY_DURATION_MIN) && (hci_stack->inquiry_state <= GAP_INQUIRY_DURATION_MAX)) { 5935f5875de5SMatthias Ringwald // emit inquiry complete event, before it even started 5936f5875de5SMatthias Ringwald uint8_t event[] = { GAP_EVENT_INQUIRY_COMPLETE, 1, 0}; 5937f5875de5SMatthias Ringwald hci_emit_event(event, sizeof(event), 1); 5938f5875de5SMatthias Ringwald return 0; 5939f5875de5SMatthias Ringwald } 5940f5875de5SMatthias Ringwald if (hci_stack->inquiry_state != GAP_INQUIRY_STATE_ACTIVE) return ERROR_CODE_COMMAND_DISALLOWED; 5941f5875de5SMatthias Ringwald hci_stack->inquiry_state = GAP_INQUIRY_STATE_W2_CANCEL; 5942f5875de5SMatthias Ringwald hci_run(); 5943f5875de5SMatthias Ringwald return 0; 5944f5875de5SMatthias Ringwald } 5945f5875de5SMatthias Ringwald 5946b7f1ee76SMatthias Ringwald 5947b7f1ee76SMatthias Ringwald /** 5948b7f1ee76SMatthias Ringwald * @brief Remote Name Request 5949b7f1ee76SMatthias Ringwald * @param addr 5950b7f1ee76SMatthias Ringwald * @param page_scan_repetition_mode 5951b7f1ee76SMatthias Ringwald * @param clock_offset only used when bit 15 is set 5952b7f1ee76SMatthias Ringwald * @events: HCI_EVENT_REMOTE_NAME_REQUEST_COMPLETE 5953b7f1ee76SMatthias Ringwald */ 5954667ba9d1SMatthias Ringwald int gap_remote_name_request(const bd_addr_t addr, uint8_t page_scan_repetition_mode, uint16_t clock_offset){ 5955b7f1ee76SMatthias Ringwald if (hci_stack->remote_name_state != GAP_REMOTE_NAME_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED; 59566535961aSMatthias Ringwald (void)memcpy(hci_stack->remote_name_addr, addr, 6); 5957b7f1ee76SMatthias Ringwald hci_stack->remote_name_page_scan_repetition_mode = page_scan_repetition_mode; 5958b7f1ee76SMatthias Ringwald hci_stack->remote_name_clock_offset = clock_offset; 5959b7f1ee76SMatthias Ringwald hci_stack->remote_name_state = GAP_REMOTE_NAME_STATE_W2_SEND; 5960b7f1ee76SMatthias Ringwald hci_run(); 5961b7f1ee76SMatthias Ringwald return 0; 5962b7f1ee76SMatthias Ringwald } 5963b7f1ee76SMatthias Ringwald 5964667ba9d1SMatthias Ringwald static int gap_pairing_set_state_and_run(const bd_addr_t addr, uint8_t state){ 59650a51f88bSMatthias Ringwald hci_stack->gap_pairing_state = state; 59666535961aSMatthias Ringwald (void)memcpy(hci_stack->gap_pairing_addr, addr, 6); 59670a51f88bSMatthias Ringwald hci_run(); 59680a51f88bSMatthias Ringwald return 0; 59690a51f88bSMatthias Ringwald } 59700a51f88bSMatthias Ringwald 59710a51f88bSMatthias Ringwald /** 5972aad97216SMatthias Ringwald * @brief Legacy Pairing Pin Code Response for binary data / non-strings 5973aad97216SMatthias Ringwald * @param addr 5974aad97216SMatthias Ringwald * @param pin_data 5975aad97216SMatthias Ringwald * @param pin_len 5976aad97216SMatthias Ringwald * @return 0 if ok 5977aad97216SMatthias Ringwald */ 5978667ba9d1SMatthias Ringwald int gap_pin_code_response_binary(const bd_addr_t addr, const uint8_t * pin_data, uint8_t pin_len){ 5979aad97216SMatthias Ringwald if (hci_stack->gap_pairing_state != GAP_PAIRING_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED; 5980aad97216SMatthias Ringwald hci_stack->gap_pairing_input.gap_pairing_pin = pin_data; 5981aad97216SMatthias Ringwald hci_stack->gap_pairing_pin_len = pin_len; 5982aad97216SMatthias Ringwald return gap_pairing_set_state_and_run(addr, GAP_PAIRING_STATE_SEND_PIN); 5983aad97216SMatthias Ringwald } 5984aad97216SMatthias Ringwald 5985aad97216SMatthias Ringwald /** 59860a51f88bSMatthias Ringwald * @brief Legacy Pairing Pin Code Response 59870a51f88bSMatthias Ringwald * @param addr 59880a51f88bSMatthias Ringwald * @param pin 59890a51f88bSMatthias Ringwald * @return 0 if ok 59900a51f88bSMatthias Ringwald */ 5991667ba9d1SMatthias Ringwald int gap_pin_code_response(const bd_addr_t addr, const char * pin){ 5992aad97216SMatthias Ringwald return gap_pin_code_response_binary(addr, (const uint8_t*) pin, strlen(pin)); 59930a51f88bSMatthias Ringwald } 59940a51f88bSMatthias Ringwald 59950a51f88bSMatthias Ringwald /** 59960a51f88bSMatthias Ringwald * @brief Abort Legacy Pairing 59970a51f88bSMatthias Ringwald * @param addr 59980a51f88bSMatthias Ringwald * @param pin 59990a51f88bSMatthias Ringwald * @return 0 if ok 60000a51f88bSMatthias Ringwald */ 60010a51f88bSMatthias Ringwald int gap_pin_code_negative(bd_addr_t addr){ 6002cd74063aSMatthias Ringwald if (hci_stack->gap_pairing_state != GAP_PAIRING_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED; 60030a51f88bSMatthias Ringwald return gap_pairing_set_state_and_run(addr, GAP_PAIRING_STATE_SEND_PIN_NEGATIVE); 60040a51f88bSMatthias Ringwald } 60050a51f88bSMatthias Ringwald 60060a51f88bSMatthias Ringwald /** 60070a51f88bSMatthias Ringwald * @brief SSP Passkey Response 60080a51f88bSMatthias Ringwald * @param addr 60090a51f88bSMatthias Ringwald * @param passkey 60100a51f88bSMatthias Ringwald * @return 0 if ok 60110a51f88bSMatthias Ringwald */ 6012667ba9d1SMatthias Ringwald int gap_ssp_passkey_response(const bd_addr_t addr, uint32_t passkey){ 6013cd74063aSMatthias Ringwald if (hci_stack->gap_pairing_state != GAP_PAIRING_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED; 6014d504181aSMatthias Ringwald hci_stack->gap_pairing_input.gap_pairing_passkey = passkey; 60150a51f88bSMatthias Ringwald return gap_pairing_set_state_and_run(addr, GAP_PAIRING_STATE_SEND_PASSKEY); 60160a51f88bSMatthias Ringwald } 60170a51f88bSMatthias Ringwald 60180a51f88bSMatthias Ringwald /** 60190a51f88bSMatthias Ringwald * @brief Abort SSP Passkey Entry/Pairing 60200a51f88bSMatthias Ringwald * @param addr 60210a51f88bSMatthias Ringwald * @param pin 60220a51f88bSMatthias Ringwald * @return 0 if ok 60230a51f88bSMatthias Ringwald */ 6024667ba9d1SMatthias Ringwald int gap_ssp_passkey_negative(const bd_addr_t addr){ 6025cd74063aSMatthias Ringwald if (hci_stack->gap_pairing_state != GAP_PAIRING_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED; 60260a51f88bSMatthias Ringwald return gap_pairing_set_state_and_run(addr, GAP_PAIRING_STATE_SEND_PASSKEY_NEGATIVE); 60270a51f88bSMatthias Ringwald } 60280a51f88bSMatthias Ringwald 60290a51f88bSMatthias Ringwald /** 60300a51f88bSMatthias Ringwald * @brief Accept SSP Numeric Comparison 60310a51f88bSMatthias Ringwald * @param addr 60320a51f88bSMatthias Ringwald * @param passkey 60330a51f88bSMatthias Ringwald * @return 0 if ok 60340a51f88bSMatthias Ringwald */ 6035667ba9d1SMatthias Ringwald int gap_ssp_confirmation_response(const bd_addr_t addr){ 6036cd74063aSMatthias Ringwald if (hci_stack->gap_pairing_state != GAP_PAIRING_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED; 60370a51f88bSMatthias Ringwald return gap_pairing_set_state_and_run(addr, GAP_PAIRING_STATE_SEND_CONFIRMATION); 60380a51f88bSMatthias Ringwald } 60390a51f88bSMatthias Ringwald 60400a51f88bSMatthias Ringwald /** 60410a51f88bSMatthias Ringwald * @brief Abort SSP Numeric Comparison/Pairing 60420a51f88bSMatthias Ringwald * @param addr 60430a51f88bSMatthias Ringwald * @param pin 60440a51f88bSMatthias Ringwald * @return 0 if ok 60450a51f88bSMatthias Ringwald */ 6046667ba9d1SMatthias Ringwald int gap_ssp_confirmation_negative(const bd_addr_t addr){ 6047cd74063aSMatthias Ringwald if (hci_stack->gap_pairing_state != GAP_PAIRING_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED; 60480a51f88bSMatthias Ringwald return gap_pairing_set_state_and_run(addr, GAP_PAIRING_STATE_SEND_CONFIRMATION_NEGATIVE); 60490a51f88bSMatthias Ringwald } 60500a51f88bSMatthias Ringwald 605144565b0cSMatthias Ringwald #ifdef ENABLE_EXPLICIT_IO_CAPABILITIES_REPLY 605244565b0cSMatthias Ringwald 605344565b0cSMatthias Ringwald static uint8_t gap_set_auth_flag_and_run(const bd_addr_t addr, hci_authentication_flags_t flag){ 605444565b0cSMatthias Ringwald hci_connection_t * conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL); 605544565b0cSMatthias Ringwald if (!conn) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 605644565b0cSMatthias Ringwald connectionSetAuthenticationFlags(conn, flag); 605744565b0cSMatthias Ringwald hci_run(); 605844565b0cSMatthias Ringwald return ERROR_CODE_SUCCESS; 605944565b0cSMatthias Ringwald } 606044565b0cSMatthias Ringwald 606144565b0cSMatthias Ringwald uint8_t gap_ssp_io_capabilities_response(const bd_addr_t addr){ 606244565b0cSMatthias Ringwald return gap_set_auth_flag_and_run(addr, SEND_IO_CAPABILITIES_REPLY); 606344565b0cSMatthias Ringwald } 606444565b0cSMatthias Ringwald 606544565b0cSMatthias Ringwald uint8_t gap_ssp_io_capabilities_negative(const bd_addr_t addr){ 606644565b0cSMatthias Ringwald return gap_set_auth_flag_and_run(addr, SEND_IO_CAPABILITIES_NEGATIVE_REPLY); 606744565b0cSMatthias Ringwald } 606844565b0cSMatthias Ringwald #endif 606944565b0cSMatthias Ringwald 60701849becdSMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB 60711849becdSMatthias Ringwald /** 60721849becdSMatthias Ringwald * @brief Report Remote OOB Data 60731849becdSMatthias Ringwald * @param bd_addr 60741849becdSMatthias Ringwald * @param c_192 Simple Pairing Hash C derived from P-192 public key 60751849becdSMatthias Ringwald * @param r_192 Simple Pairing Randomizer derived from P-192 public key 60761849becdSMatthias Ringwald * @param c_256 Simple Pairing Hash C derived from P-256 public key 60771849becdSMatthias Ringwald * @param r_256 Simple Pairing Randomizer derived from P-256 public key 60781849becdSMatthias Ringwald */ 60791849becdSMatthias 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){ 60801849becdSMatthias Ringwald hci_connection_t * connection = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL); 60811849becdSMatthias Ringwald if (connection == NULL) { 60821849becdSMatthias Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 60831849becdSMatthias Ringwald } 60841849becdSMatthias Ringwald connection->classic_oob_c_192 = c_192; 60851849becdSMatthias Ringwald connection->classic_oob_r_192 = r_192; 60861849becdSMatthias Ringwald connection->classic_oob_c_256 = c_256; 60871849becdSMatthias Ringwald connection->classic_oob_r_256 = r_256; 60881849becdSMatthias Ringwald return ERROR_CODE_SUCCESS; 60891849becdSMatthias Ringwald } 6090cf01e888SMatthias Ringwald /** 6091cf01e888SMatthias Ringwald * @brief Generate new OOB data 6092cf01e888SMatthias Ringwald * @note OOB data will be provided in GAP_EVENT_LOCAL_OOB_DATA and be used in future pairing procedures 6093cf01e888SMatthias Ringwald */ 6094cf01e888SMatthias Ringwald void gap_ssp_generate_oob_data(void){ 6095cf01e888SMatthias Ringwald hci_stack->classic_read_local_oob_data = true; 6096cf01e888SMatthias Ringwald hci_run(); 6097cf01e888SMatthias Ringwald } 6098cf01e888SMatthias Ringwald 60991849becdSMatthias Ringwald #endif 61001849becdSMatthias Ringwald 6101f5875de5SMatthias Ringwald /** 6102f6858d14SMatthias Ringwald * @brief Set inquiry mode: standard, with RSSI, with RSSI + Extended Inquiry Results. Has to be called before power on. 6103f5875de5SMatthias Ringwald * @param inquiry_mode see bluetooth_defines.h 6104f6858d14SMatthias Ringwald */ 6105f6858d14SMatthias Ringwald void hci_set_inquiry_mode(inquiry_mode_t mode){ 6106f6858d14SMatthias Ringwald hci_stack->inquiry_mode = mode; 6107f6858d14SMatthias Ringwald } 6108f6858d14SMatthias Ringwald 6109f6858d14SMatthias Ringwald /** 6110d950d659SMatthias Ringwald * @brief Configure Voice Setting for use with SCO data in HSP/HFP 6111d950d659SMatthias Ringwald */ 6112d950d659SMatthias Ringwald void hci_set_sco_voice_setting(uint16_t voice_setting){ 6113d950d659SMatthias Ringwald hci_stack->sco_voice_setting = voice_setting; 6114d950d659SMatthias Ringwald } 6115d950d659SMatthias Ringwald 6116d950d659SMatthias Ringwald /** 6117d950d659SMatthias Ringwald * @brief Get SCO Voice Setting 6118d950d659SMatthias Ringwald * @return current voice setting 6119d950d659SMatthias Ringwald */ 61200cb5b971SMatthias Ringwald uint16_t hci_get_sco_voice_setting(void){ 6121d950d659SMatthias Ringwald return hci_stack->sco_voice_setting; 6122d950d659SMatthias Ringwald } 6123d950d659SMatthias Ringwald 6124400ff5abSMatthias Ringwald static int hci_have_usb_transport(void){ 6125400ff5abSMatthias Ringwald if (!hci_stack->hci_transport) return 0; 6126400ff5abSMatthias Ringwald const char * transport_name = hci_stack->hci_transport->name; 6127400ff5abSMatthias Ringwald if (!transport_name) return 0; 6128400ff5abSMatthias Ringwald return (transport_name[0] == 'H') && (transport_name[1] == '2'); 6129400ff5abSMatthias Ringwald } 6130400ff5abSMatthias Ringwald 6131b3aad8daSMatthias Ringwald /** @brief Get SCO packet length for current SCO Voice setting 6132b3aad8daSMatthias Ringwald * @note Using SCO packets of the exact length is required for USB transfer 6133b3aad8daSMatthias Ringwald * @return Length of SCO packets in bytes (not audio frames) 6134b3aad8daSMatthias Ringwald */ 6135b3aad8daSMatthias Ringwald int hci_get_sco_packet_length(void){ 6136a3069afeSMatthias Ringwald int sco_packet_length = 0; 6137cf119f3bSMatthias Ringwald 61381e20a53eSMatthias Ringwald #ifdef ENABLE_SCO_OVER_HCI 61396f28d2eeSMatthias Ringwald // Transparent = mSBC => 1, CVSD with 16-bit samples requires twice as much bytes 61401431ce27SMatthias Ringwald int multiplier = ((hci_stack->sco_voice_setting_active & 0x03) == 0x03) ? 1 : 2; 6141cf119f3bSMatthias Ringwald 6142400ff5abSMatthias Ringwald if (hci_have_usb_transport()){ 6143400ff5abSMatthias Ringwald // see Core Spec for H2 USB Transfer. 6144cf119f3bSMatthias Ringwald // 3 byte SCO header + 24 bytes per connection 614552e46257SMatthias Ringwald int num_sco_connections = btstack_max(1, hci_number_sco_connections()); 614652e46257SMatthias Ringwald sco_packet_length = 3 + 24 * num_sco_connections * multiplier; 6147400ff5abSMatthias Ringwald } else { 6148400ff5abSMatthias Ringwald // 3 byte SCO header + SCO packet size over the air (60 bytes) 6149400ff5abSMatthias Ringwald sco_packet_length = 3 + 60 * multiplier; 6150d966a453SMatthias Ringwald // assert that it still fits inside an SCO buffer 6151d966a453SMatthias Ringwald if (sco_packet_length > hci_stack->sco_data_packet_length){ 6152d966a453SMatthias Ringwald sco_packet_length = 3 + 60; 6153d966a453SMatthias Ringwald } 6154400ff5abSMatthias Ringwald } 6155a3069afeSMatthias Ringwald #endif 61565b7087c7SMatthias Ringwald 61575b7087c7SMatthias Ringwald #ifdef HAVE_SCO_TRANSPORT 61585b7087c7SMatthias Ringwald // Transparent = mSBC => 1, CVSD with 16-bit samples requires twice as much bytes 61591e20a53eSMatthias Ringwald int multiplier = ((hci_stack->sco_voice_setting_active & 0x03) == 0x03) ? 1 : 2; 61605b7087c7SMatthias Ringwald sco_packet_length = 3 + 60 * multiplier; 61615b7087c7SMatthias Ringwald #endif 6162a3069afeSMatthias Ringwald return sco_packet_length; 6163b3aad8daSMatthias Ringwald } 6164b3aad8daSMatthias Ringwald 6165c4c88f1bSJakob Krantz /** 6166c4c88f1bSJakob Krantz * @brief Sets the master/slave policy 6167c4c88f1bSJakob Krantz * @param policy (0: attempt to become master, 1: let connecting device decide) 6168c4c88f1bSJakob Krantz */ 6169c4c88f1bSJakob Krantz void hci_set_master_slave_policy(uint8_t policy){ 6170c4c88f1bSJakob Krantz hci_stack->master_slave_policy = policy; 6171c4c88f1bSJakob Krantz } 6172c4c88f1bSJakob Krantz 6173c4c88f1bSJakob Krantz #endif 6174ec111c8bSMatthias Ringwald 6175ec111c8bSMatthias Ringwald HCI_STATE hci_get_state(void){ 6176ec111c8bSMatthias Ringwald return hci_stack->state; 6177ec111c8bSMatthias Ringwald } 6178ec111c8bSMatthias Ringwald 617907e010b6SMilanka Ringwald #ifdef ENABLE_CLASSIC 61805e91d96cSMatthias Ringwald void gap_register_classic_connection_filter(int (*accept_callback)(bd_addr_t addr, hci_link_type_t link_type)){ 618107e010b6SMilanka Ringwald hci_stack->gap_classic_accept_callback = accept_callback; 618207e010b6SMilanka Ringwald } 618307e010b6SMilanka Ringwald #endif 6184ec111c8bSMatthias Ringwald 6185d950d659SMatthias Ringwald /** 6186d23838ecSMatthias Ringwald * @brief Set callback for Bluetooth Hardware Error 6187d23838ecSMatthias Ringwald */ 6188c2e1fa60SMatthias Ringwald void hci_set_hardware_error_callback(void (*fn)(uint8_t error)){ 6189d23838ecSMatthias Ringwald hci_stack->hardware_error_callback = fn; 6190d23838ecSMatthias Ringwald } 6191d23838ecSMatthias Ringwald 619271de195eSMatthias Ringwald void hci_disconnect_all(void){ 6193665d90f2SMatthias Ringwald btstack_linked_list_iterator_t it; 6194665d90f2SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->connections); 6195665d90f2SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 6196665d90f2SMatthias Ringwald hci_connection_t * con = (hci_connection_t*) btstack_linked_list_iterator_next(&it); 619704a6ef8cSmatthias.ringwald if (con->state == SENT_DISCONNECT) continue; 619804a6ef8cSmatthias.ringwald con->state = SEND_DISCONNECT; 619904a6ef8cSmatthias.ringwald } 6200d31fba26S[email protected] hci_run(); 620104a6ef8cSmatthias.ringwald } 620233373e40SMatthias Ringwald 620333373e40SMatthias Ringwald uint16_t hci_get_manufacturer(void){ 620433373e40SMatthias Ringwald return hci_stack->manufacturer; 620533373e40SMatthias Ringwald } 62069c6e867eSMatthias Ringwald 62073e329ddfSandryblack #ifdef ENABLE_BLE 62083e329ddfSandryblack 62099c6e867eSMatthias Ringwald static sm_connection_t * sm_get_connection_for_handle(hci_con_handle_t con_handle){ 62109c6e867eSMatthias Ringwald hci_connection_t * hci_con = hci_connection_for_handle(con_handle); 62119c6e867eSMatthias Ringwald if (!hci_con) return NULL; 62129c6e867eSMatthias Ringwald return &hci_con->sm_connection; 62139c6e867eSMatthias Ringwald } 62149c6e867eSMatthias Ringwald 62159c6e867eSMatthias Ringwald // extracted from sm.c to allow enabling of l2cap le data channels without adding sm.c to the build 62169c6e867eSMatthias Ringwald // without sm.c default values from create_connection_for_bd_addr_and_type() resulg in non-encrypted, not-authenticated 62179c6e867eSMatthias Ringwald 62189c6e867eSMatthias Ringwald int gap_encryption_key_size(hci_con_handle_t con_handle){ 6219c5fb5ca4SMatthias Ringwald hci_connection_t * hci_connection = hci_connection_for_handle(con_handle); 6220c5fb5ca4SMatthias Ringwald if (hci_connection == NULL) return 0; 6221c5fb5ca4SMatthias Ringwald if (hci_is_le_connection(hci_connection)){ 6222c5fb5ca4SMatthias Ringwald sm_connection_t * sm_conn = &hci_connection->sm_connection; 6223c5fb5ca4SMatthias Ringwald if (sm_conn->sm_connection_encrypted) { 62249c6e867eSMatthias Ringwald return sm_conn->sm_actual_encryption_key_size; 62259c6e867eSMatthias Ringwald } 6226c5fb5ca4SMatthias Ringwald } 6227c5fb5ca4SMatthias Ringwald #ifdef ENABLE_CLASSIC 6228c5fb5ca4SMatthias Ringwald else { 6229c5fb5ca4SMatthias Ringwald if ((hci_connection->authentication_flags & CONNECTION_ENCRYPTED)){ 6230c5fb5ca4SMatthias Ringwald return hci_connection->encryption_key_size; 6231c5fb5ca4SMatthias Ringwald } 6232c5fb5ca4SMatthias Ringwald } 6233c5fb5ca4SMatthias Ringwald #endif 6234c5fb5ca4SMatthias Ringwald return 0; 6235c5fb5ca4SMatthias Ringwald } 62369c6e867eSMatthias Ringwald 62379c6e867eSMatthias Ringwald int gap_authenticated(hci_con_handle_t con_handle){ 6238c5fb5ca4SMatthias Ringwald hci_connection_t * hci_connection = hci_connection_for_handle(con_handle); 6239c5fb5ca4SMatthias Ringwald if (hci_connection == NULL) return 0; 62405f3981bfSMatthias Ringwald 6241c5fb5ca4SMatthias Ringwald switch (hci_connection->address_type){ 62425f3981bfSMatthias Ringwald case BD_ADDR_TYPE_LE_PUBLIC: 62435f3981bfSMatthias Ringwald case BD_ADDR_TYPE_LE_RANDOM: 6244c5fb5ca4SMatthias Ringwald if (hci_connection->sm_connection.sm_connection_encrypted == 0) return 0; // unencrypted connection cannot be authenticated 6245c5fb5ca4SMatthias Ringwald return hci_connection->sm_connection.sm_connection_authenticated; 624659a1a47aSMatthias Ringwald #ifdef ENABLE_CLASSIC 62475f3981bfSMatthias Ringwald case BD_ADDR_TYPE_SCO: 6248f16129ceSMatthias Ringwald case BD_ADDR_TYPE_ACL: 6249c5fb5ca4SMatthias Ringwald return gap_authenticated_for_link_key_type(hci_connection->link_key_type); 625059a1a47aSMatthias Ringwald #endif 62515f3981bfSMatthias Ringwald default: 62525f3981bfSMatthias Ringwald return 0; 62535f3981bfSMatthias Ringwald } 62549c6e867eSMatthias Ringwald } 62559c6e867eSMatthias Ringwald 6256f1dfbe18SMatthias Ringwald int gap_secure_connection(hci_con_handle_t con_handle){ 6257c5fb5ca4SMatthias Ringwald hci_connection_t * hci_connection = hci_connection_for_handle(con_handle); 6258c5fb5ca4SMatthias Ringwald if (hci_connection == NULL) return 0; 62598b35e16aSMatthias Ringwald 6260c5fb5ca4SMatthias Ringwald switch (hci_connection->address_type){ 62618b35e16aSMatthias Ringwald case BD_ADDR_TYPE_LE_PUBLIC: 62628b35e16aSMatthias Ringwald case BD_ADDR_TYPE_LE_RANDOM: 6263c5fb5ca4SMatthias Ringwald if (hci_connection->sm_connection.sm_connection_encrypted == 0) return 0; // unencrypted connection cannot be authenticated 6264c5fb5ca4SMatthias Ringwald return hci_connection->sm_connection.sm_connection_sc; 626559a1a47aSMatthias Ringwald #ifdef ENABLE_CLASSIC 62668b35e16aSMatthias Ringwald case BD_ADDR_TYPE_SCO: 6267f16129ceSMatthias Ringwald case BD_ADDR_TYPE_ACL: 6268c5fb5ca4SMatthias Ringwald return gap_secure_connection_for_link_key_type(hci_connection->link_key_type); 626959a1a47aSMatthias Ringwald #endif 62708b35e16aSMatthias Ringwald default: 62718b35e16aSMatthias Ringwald return 0; 62728b35e16aSMatthias Ringwald } 6273f1dfbe18SMatthias Ringwald } 6274f1dfbe18SMatthias Ringwald 62751e122704SMatthias Ringwald bool gap_bonded(hci_con_handle_t con_handle){ 62761e122704SMatthias Ringwald hci_connection_t * hci_connection = hci_connection_for_handle(con_handle); 62771e122704SMatthias Ringwald if (hci_connection == NULL) return 0; 62781e122704SMatthias Ringwald 627948f33f37SMatthias Ringwald #ifdef ENABLE_CLASSIC 62801e122704SMatthias Ringwald link_key_t link_key; 62811e122704SMatthias Ringwald link_key_type_t link_key_type; 628248f33f37SMatthias Ringwald #endif 62831e122704SMatthias Ringwald switch (hci_connection->address_type){ 62841e122704SMatthias Ringwald case BD_ADDR_TYPE_LE_PUBLIC: 62851e122704SMatthias Ringwald case BD_ADDR_TYPE_LE_RANDOM: 62861e122704SMatthias Ringwald return hci_connection->sm_connection.sm_le_db_index >= 0; 62871e122704SMatthias Ringwald #ifdef ENABLE_CLASSIC 62881e122704SMatthias Ringwald case BD_ADDR_TYPE_SCO: 62891e122704SMatthias Ringwald case BD_ADDR_TYPE_ACL: 62901e122704SMatthias Ringwald return hci_stack->link_key_db && hci_stack->link_key_db->get_link_key(hci_connection->address, link_key, &link_key_type); 62911e122704SMatthias Ringwald #endif 62921e122704SMatthias Ringwald default: 62931e122704SMatthias Ringwald return false; 62941e122704SMatthias Ringwald } 62951e122704SMatthias Ringwald } 62961e122704SMatthias Ringwald 62971e122704SMatthias Ringwald 62989c6e867eSMatthias Ringwald authorization_state_t gap_authorization_state(hci_con_handle_t con_handle){ 62999c6e867eSMatthias Ringwald sm_connection_t * sm_conn = sm_get_connection_for_handle(con_handle); 63009c6e867eSMatthias Ringwald if (!sm_conn) return AUTHORIZATION_UNKNOWN; // wrong connection 63019c6e867eSMatthias Ringwald if (!sm_conn->sm_connection_encrypted) return AUTHORIZATION_UNKNOWN; // unencrypted connection cannot be authorized 63029c6e867eSMatthias Ringwald if (!sm_conn->sm_connection_authenticated) return AUTHORIZATION_UNKNOWN; // unauthenticatd connection cannot be authorized 63039c6e867eSMatthias Ringwald return sm_conn->sm_connection_authorization_state; 63049c6e867eSMatthias Ringwald } 63059c6e867eSMatthias Ringwald #endif 6306f8ee3071SMatthias Ringwald 6307f8ee3071SMatthias Ringwald #ifdef ENABLE_CLASSIC 6308f8ee3071SMatthias 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){ 6309f8ee3071SMatthias Ringwald hci_connection_t * conn = hci_connection_for_handle(con_handle); 6310f8ee3071SMatthias Ringwald if (!conn) return GAP_CONNECTION_INVALID; 6311f8ee3071SMatthias Ringwald conn->sniff_min_interval = sniff_min_interval; 6312f8ee3071SMatthias Ringwald conn->sniff_max_interval = sniff_max_interval; 6313f8ee3071SMatthias Ringwald conn->sniff_attempt = sniff_attempt; 6314f8ee3071SMatthias Ringwald conn->sniff_timeout = sniff_timeout; 6315f8ee3071SMatthias Ringwald hci_run(); 6316f8ee3071SMatthias Ringwald return 0; 6317f8ee3071SMatthias Ringwald } 6318f8ee3071SMatthias Ringwald 6319f8ee3071SMatthias Ringwald /** 6320f8ee3071SMatthias Ringwald * @brief Exit Sniff mode 6321f8ee3071SMatthias Ringwald * @param con_handle 6322f8ee3071SMatthias Ringwald @ @return 0 if ok 6323f8ee3071SMatthias Ringwald */ 6324f8ee3071SMatthias Ringwald uint8_t gap_sniff_mode_exit(hci_con_handle_t con_handle){ 6325f8ee3071SMatthias Ringwald hci_connection_t * conn = hci_connection_for_handle(con_handle); 6326f8ee3071SMatthias Ringwald if (!conn) return GAP_CONNECTION_INVALID; 6327f8ee3071SMatthias Ringwald conn->sniff_min_interval = 0xffff; 6328f8ee3071SMatthias Ringwald hci_run(); 6329f8ee3071SMatthias Ringwald return 0; 6330f8ee3071SMatthias Ringwald } 6331bea424a5SMatthias Ringwald 6332bea424a5SMatthias Ringwald void gap_set_page_scan_activity(uint16_t page_scan_interval, uint16_t page_scan_window){ 6333bea424a5SMatthias Ringwald hci_stack->new_page_scan_interval = page_scan_interval; 6334bea424a5SMatthias Ringwald hci_stack->new_page_scan_window = page_scan_window; 6335bea424a5SMatthias Ringwald hci_run(); 6336bea424a5SMatthias Ringwald } 6337bea424a5SMatthias Ringwald 6338bea424a5SMatthias Ringwald void gap_set_page_scan_type(page_scan_type_t page_scan_type){ 6339bea424a5SMatthias Ringwald hci_stack->new_page_scan_type = (uint8_t) page_scan_type; 6340bea424a5SMatthias Ringwald hci_run(); 6341bea424a5SMatthias Ringwald } 6342bea424a5SMatthias Ringwald 6343f8ee3071SMatthias Ringwald #endif 6344beceeddeSMatthias Ringwald 6345beceeddeSMatthias Ringwald void hci_halting_defer(void){ 6346beceeddeSMatthias Ringwald if (hci_stack->state != HCI_STATE_HALTING) return; 6347beceeddeSMatthias Ringwald switch (hci_stack->substate){ 6348beceeddeSMatthias Ringwald case HCI_HALTING_DISCONNECT_ALL_NO_TIMER: 6349beceeddeSMatthias Ringwald case HCI_HALTING_CLOSE: 6350beceeddeSMatthias Ringwald hci_stack->substate = HCI_HALTING_DISCONNECT_ALL_TIMER; 6351beceeddeSMatthias Ringwald break; 6352beceeddeSMatthias Ringwald default: 6353beceeddeSMatthias Ringwald break; 6354beceeddeSMatthias Ringwald } 6355beceeddeSMatthias Ringwald } 6356eddac615SMatthias Ringwald 635721debf25SMatthias Ringwald #ifdef ENABLE_LE_PRIVACY_ADDRESS_RESOLUTION 635821debf25SMatthias Ringwald void hci_load_le_device_db_entry_into_resolving_list(uint16_t le_device_db_index){ 635921debf25SMatthias Ringwald if (le_device_db_index >= MAX_NUM_RESOLVING_LIST_ENTRIES) return; 636021debf25SMatthias Ringwald if (le_device_db_index >= le_device_db_max_count()) return; 636121debf25SMatthias Ringwald uint8_t offset = le_device_db_index >> 3; 636221debf25SMatthias Ringwald uint8_t mask = 1 << (le_device_db_index & 7); 636302b02cffSMatthias Ringwald hci_stack->le_resolving_list_add_entries[offset] |= mask; 636421debf25SMatthias Ringwald if (hci_stack->le_resolving_list_state == LE_RESOLVING_LIST_DONE){ 636502b02cffSMatthias Ringwald // note: go back to remove entries, otherwise, a remove + add will skip the add 636602b02cffSMatthias Ringwald hci_stack->le_resolving_list_state = LE_RESOLVING_LIST_REMOVE_ENTRIES; 636702b02cffSMatthias Ringwald } 636802b02cffSMatthias Ringwald } 636902b02cffSMatthias Ringwald 637002b02cffSMatthias Ringwald void hci_remove_le_device_db_entry_from_resolving_list(uint16_t le_device_db_index){ 637102b02cffSMatthias Ringwald if (le_device_db_index >= MAX_NUM_RESOLVING_LIST_ENTRIES) return; 637202b02cffSMatthias Ringwald if (le_device_db_index >= le_device_db_max_count()) return; 637302b02cffSMatthias Ringwald uint8_t offset = le_device_db_index >> 3; 637402b02cffSMatthias Ringwald uint8_t mask = 1 << (le_device_db_index & 7); 637502b02cffSMatthias Ringwald hci_stack->le_resolving_list_remove_entries[offset] |= mask; 637602b02cffSMatthias Ringwald if (hci_stack->le_resolving_list_state == LE_RESOLVING_LIST_DONE){ 637702b02cffSMatthias Ringwald hci_stack->le_resolving_list_state = LE_RESOLVING_LIST_REMOVE_ENTRIES; 637821debf25SMatthias Ringwald } 637921debf25SMatthias Ringwald } 6380cf38a091SMatthias Ringwald 6381cf38a091SMatthias Ringwald uint8_t gap_load_resolving_list_from_le_device_db(void){ 6382cf38a091SMatthias Ringwald if ((hci_stack->local_supported_commands[1] & (1 << 2)) == 0) { 6383cf38a091SMatthias Ringwald return ERROR_CODE_UNSUPPORTED_FEATURE_OR_PARAMETER_VALUE; 6384cf38a091SMatthias Ringwald } 6385cf38a091SMatthias Ringwald if (hci_stack->le_resolving_list_state != LE_RESOLVING_LIST_SEND_ENABLE_ADDRESS_RESOLUTION){ 6386cf38a091SMatthias Ringwald // restart le resolving list update 6387cf38a091SMatthias Ringwald hci_stack->le_resolving_list_state = LE_RESOLVING_LIST_READ_SIZE; 6388cf38a091SMatthias Ringwald } 6389cf38a091SMatthias Ringwald return ERROR_CODE_SUCCESS; 6390cf38a091SMatthias Ringwald } 639121debf25SMatthias Ringwald #endif 639221debf25SMatthias Ringwald 6393eddac615SMatthias Ringwald #ifdef FUZZING_BUILD_MODE_UNSAFE_FOR_PRODUCTION 639418976c74SMatthias Ringwald void hci_setup_test_connections_fuzz(void){ 639518976c74SMatthias Ringwald hci_connection_t * conn; 639618976c74SMatthias Ringwald 639718976c74SMatthias Ringwald // default address: 66:55:44:33:00:01 639818976c74SMatthias Ringwald bd_addr_t addr = { 0x66, 0x55, 0x44, 0x33, 0x00, 0x00}; 639918976c74SMatthias Ringwald 64007d33cb26SMilanka Ringwald // setup Controller info 64017d33cb26SMilanka Ringwald hci_stack->num_cmd_packets = 255; 64027d33cb26SMilanka Ringwald hci_stack->acl_packets_total_num = 255; 64037d33cb26SMilanka Ringwald 640418976c74SMatthias Ringwald // setup incoming Classic ACL connection with con handle 0x0001, 66:55:44:33:22:01 640518976c74SMatthias Ringwald addr[5] = 0x01; 640618976c74SMatthias Ringwald conn = create_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL); 640718976c74SMatthias Ringwald conn->con_handle = addr[5]; 640818976c74SMatthias Ringwald conn->role = HCI_ROLE_SLAVE; 640918976c74SMatthias Ringwald conn->state = RECEIVED_CONNECTION_REQUEST; 64107d33cb26SMilanka Ringwald conn->sm_connection.sm_role = HCI_ROLE_SLAVE; 641118976c74SMatthias Ringwald 641218976c74SMatthias Ringwald // setup incoming Classic SCO connection with con handle 0x0002 641318976c74SMatthias Ringwald addr[5] = 0x02; 641418976c74SMatthias Ringwald conn = create_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_SCO); 641518976c74SMatthias Ringwald conn->con_handle = addr[5]; 641618976c74SMatthias Ringwald conn->role = HCI_ROLE_SLAVE; 641718976c74SMatthias Ringwald conn->state = RECEIVED_CONNECTION_REQUEST; 64187d33cb26SMilanka Ringwald conn->sm_connection.sm_role = HCI_ROLE_SLAVE; 641918976c74SMatthias Ringwald 642018976c74SMatthias Ringwald // setup ready Classic ACL connection with con handle 0x0003 642118976c74SMatthias Ringwald addr[5] = 0x03; 642218976c74SMatthias Ringwald conn = create_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL); 642318976c74SMatthias Ringwald conn->con_handle = addr[5]; 642418976c74SMatthias Ringwald conn->role = HCI_ROLE_SLAVE; 642518976c74SMatthias Ringwald conn->state = OPEN; 64267d33cb26SMilanka Ringwald conn->sm_connection.sm_role = HCI_ROLE_SLAVE; 642718976c74SMatthias Ringwald 642818976c74SMatthias Ringwald // setup ready Classic SCO connection with con handle 0x0004 642918976c74SMatthias Ringwald addr[5] = 0x04; 643018976c74SMatthias Ringwald conn = create_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_SCO); 643118976c74SMatthias Ringwald conn->con_handle = addr[5]; 643218976c74SMatthias Ringwald conn->role = HCI_ROLE_SLAVE; 643318976c74SMatthias Ringwald conn->state = OPEN; 64347d33cb26SMilanka Ringwald conn->sm_connection.sm_role = HCI_ROLE_SLAVE; 643518976c74SMatthias Ringwald 643618976c74SMatthias Ringwald // setup ready LE ACL connection with con handle 0x005 and public address 643718976c74SMatthias Ringwald addr[5] = 0x05; 643818976c74SMatthias Ringwald conn = create_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_LE_PUBLIC); 643918976c74SMatthias Ringwald conn->con_handle = addr[5]; 644018976c74SMatthias Ringwald conn->role = HCI_ROLE_SLAVE; 644118976c74SMatthias Ringwald conn->state = OPEN; 64427d33cb26SMilanka Ringwald conn->sm_connection.sm_role = HCI_ROLE_SLAVE; 64438046a24aSMatthias Ringwald conn->sm_connection.sm_connection_encrypted = 1; 644418976c74SMatthias Ringwald } 644518976c74SMatthias Ringwald 6446eddac615SMatthias Ringwald void hci_free_connections_fuzz(void){ 6447eddac615SMatthias Ringwald btstack_linked_list_iterator_t it; 6448eddac615SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->connections); 6449eddac615SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 6450eddac615SMatthias Ringwald hci_connection_t * con = (hci_connection_t*) btstack_linked_list_iterator_next(&it); 6451eddac615SMatthias Ringwald btstack_linked_list_iterator_remove(&it); 6452eddac615SMatthias Ringwald btstack_memory_hci_connection_free(con); 6453eddac615SMatthias Ringwald } 6454eddac615SMatthias Ringwald } 64551470db0cSMatthias Ringwald void hci_simulate_working_fuzz(void){ 64561470db0cSMatthias Ringwald hci_init_done(); 64571470db0cSMatthias Ringwald hci_stack->num_cmd_packets = 255; 64581470db0cSMatthias Ringwald } 6459eddac615SMatthias Ringwald #endif 6460