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 137cc15bb2cSMatthias Ringwald #define GAP_PAIRING_STATE_WAIT_FOR_COMMAND_COMPLETE 7 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); 14420dcdd22SMatthias Ringwald static bool 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; 2108daf94bcSMatthias Ringwald conn->authentication_flags = AUTH_FLAG_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; 215140c0557SMatthias Ringwald conn->sniff_subrating_max_latency = 0xffff; 216965a4ccfSMatthias Ringwald conn->qos_service_type = HCI_SERVICE_TYPE_INVALID; 217e9f98c4aSMatthias Ringwald conn->link_key_type = INVALID_LINK_KEY; 21891a977e8SMatthias Ringwald btstack_run_loop_set_timer_handler(&conn->timeout, hci_connection_timeout_handler); 21991a977e8SMatthias Ringwald btstack_run_loop_set_timer_context(&conn->timeout, conn); 22096a45072S[email protected] hci_connection_timestamp(conn); 22152db98b2SMatthias Ringwald #endif 22296a45072S[email protected] conn->acl_recombination_length = 0; 22396a45072S[email protected] conn->acl_recombination_pos = 0; 224ce41473eSMatthias Ringwald conn->num_packets_sent = 0; 225760b20efSMatthias Ringwald 226da886c03S[email protected] conn->le_con_parameter_update_state = CON_PARAMETER_UPDATE_NONE; 227b90f6e0aSMatthias Ringwald #ifdef ENABLE_BLE 228b90f6e0aSMatthias Ringwald conn->le_phy_update_all_phys = 0xff; 229b90f6e0aSMatthias Ringwald #endif 2300f3b27c5SMatthias Ringwald #ifdef ENABLE_LE_LIMIT_ACL_FRAGMENT_BY_MAX_OCTETS 2310f3b27c5SMatthias Ringwald conn->le_max_tx_octets = 27; 2320f3b27c5SMatthias Ringwald #endif 233665d90f2SMatthias Ringwald btstack_linked_list_add(&hci_stack->connections, (btstack_linked_item_t *) conn); 23496a45072S[email protected] return conn; 23596a45072S[email protected] } 23666fb9560S[email protected] 237da886c03S[email protected] 238da886c03S[email protected] /** 239da886c03S[email protected] * get le connection parameter range 240da886c03S[email protected] * 241da886c03S[email protected] * @return le connection parameter range struct 242da886c03S[email protected] */ 2434ced4e8cSMatthias Ringwald void gap_get_connection_parameter_range(le_connection_parameter_range_t * range){ 2444ced4e8cSMatthias Ringwald *range = hci_stack->le_connection_parameter_range; 245da886c03S[email protected] } 246da886c03S[email protected] 247da886c03S[email protected] /** 248da886c03S[email protected] * set le connection parameter range 249da886c03S[email protected] * 250da886c03S[email protected] */ 251da886c03S[email protected] 2524ced4e8cSMatthias Ringwald void gap_set_connection_parameter_range(le_connection_parameter_range_t *range){ 2534ced4e8cSMatthias Ringwald hci_stack->le_connection_parameter_range = *range; 254da886c03S[email protected] } 255da886c03S[email protected] 256da886c03S[email protected] /** 25773cd8a2aSMatthias Ringwald * @brief Test if connection parameters are inside in existing rage 25873cd8a2aSMatthias Ringwald * @param conn_interval_min (unit: 1.25ms) 25973cd8a2aSMatthias Ringwald * @param conn_interval_max (unit: 1.25ms) 26073cd8a2aSMatthias Ringwald * @param conn_latency 26173cd8a2aSMatthias Ringwald * @param supervision_timeout (unit: 10ms) 26273cd8a2aSMatthias Ringwald * @returns 1 if included 26373cd8a2aSMatthias Ringwald */ 26473cd8a2aSMatthias 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){ 26573cd8a2aSMatthias Ringwald if (le_conn_interval_min < existing_range->le_conn_interval_min) return 0; 26673cd8a2aSMatthias Ringwald if (le_conn_interval_max > existing_range->le_conn_interval_max) return 0; 26773cd8a2aSMatthias Ringwald 26873cd8a2aSMatthias Ringwald if (le_conn_latency < existing_range->le_conn_latency_min) return 0; 26973cd8a2aSMatthias Ringwald if (le_conn_latency > existing_range->le_conn_latency_max) return 0; 27073cd8a2aSMatthias Ringwald 27173cd8a2aSMatthias Ringwald if (le_supervision_timeout < existing_range->le_supervision_timeout_min) return 0; 27273cd8a2aSMatthias Ringwald if (le_supervision_timeout > existing_range->le_supervision_timeout_max) return 0; 27373cd8a2aSMatthias Ringwald 27473cd8a2aSMatthias Ringwald return 1; 27573cd8a2aSMatthias Ringwald } 27673cd8a2aSMatthias Ringwald 27773cd8a2aSMatthias Ringwald /** 2782b6ab3e6SMatthias Ringwald * @brief Set max number of connections in LE Peripheral role (if Bluetooth Controller supports it) 2792b6ab3e6SMatthias Ringwald * @note: default: 1 2802b6ab3e6SMatthias Ringwald * @param max_peripheral_connections 2812b6ab3e6SMatthias Ringwald */ 282d4e4907bSMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 2832b6ab3e6SMatthias Ringwald void gap_set_max_number_peripheral_connections(int max_peripheral_connections){ 2842b6ab3e6SMatthias Ringwald hci_stack->le_max_number_peripheral_connections = max_peripheral_connections; 2852b6ab3e6SMatthias Ringwald } 286d4e4907bSMatthias Ringwald #endif 2872b6ab3e6SMatthias Ringwald 2882b6ab3e6SMatthias Ringwald /** 289da886c03S[email protected] * get hci connections iterator 290da886c03S[email protected] * 291da886c03S[email protected] * @return hci connections iterator 292da886c03S[email protected] */ 293da886c03S[email protected] 294665d90f2SMatthias Ringwald void hci_connections_get_iterator(btstack_linked_list_iterator_t *it){ 295665d90f2SMatthias Ringwald btstack_linked_list_iterator_init(it, &hci_stack->connections); 296da886c03S[email protected] } 297da886c03S[email protected] 29897addcc5Smatthias.ringwald /** 299ee091cf1Smatthias.ringwald * get connection for a given handle 300ee091cf1Smatthias.ringwald * 301ee091cf1Smatthias.ringwald * @return connection OR NULL, if not found 302ee091cf1Smatthias.ringwald */ 3035061f3afS[email protected] hci_connection_t * hci_connection_for_handle(hci_con_handle_t con_handle){ 304665d90f2SMatthias Ringwald btstack_linked_list_iterator_t it; 305665d90f2SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->connections); 306665d90f2SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 307665d90f2SMatthias Ringwald hci_connection_t * item = (hci_connection_t *) btstack_linked_list_iterator_next(&it); 3083ac2fe56S[email protected] if ( item->con_handle == con_handle ) { 309da886c03S[email protected] return item; 310ee091cf1Smatthias.ringwald } 311ee091cf1Smatthias.ringwald } 312ee091cf1Smatthias.ringwald return NULL; 313ee091cf1Smatthias.ringwald } 314ee091cf1Smatthias.ringwald 31596a45072S[email protected] /** 31696a45072S[email protected] * get connection for given address 31796a45072S[email protected] * 31896a45072S[email protected] * @return connection OR NULL, if not found 31996a45072S[email protected] */ 320667ba9d1SMatthias Ringwald hci_connection_t * hci_connection_for_bd_addr_and_type(const bd_addr_t addr, bd_addr_type_t addr_type){ 321665d90f2SMatthias Ringwald btstack_linked_list_iterator_t it; 322665d90f2SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->connections); 323665d90f2SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 324665d90f2SMatthias Ringwald hci_connection_t * connection = (hci_connection_t *) btstack_linked_list_iterator_next(&it); 32596a45072S[email protected] if (connection->address_type != addr_type) continue; 32696a45072S[email protected] if (memcmp(addr, connection->address, 6) != 0) continue; 32762bda3fbS[email protected] return connection; 32862bda3fbS[email protected] } 32962bda3fbS[email protected] return NULL; 33062bda3fbS[email protected] } 33162bda3fbS[email protected] 3323e5e0926SMatthias Ringwald inline static void connectionClearAuthenticationFlags(hci_connection_t * conn, hci_authentication_flags_t flags){ 3333e5e0926SMatthias Ringwald conn->authentication_flags = (hci_authentication_flags_t)(conn->authentication_flags & ~flags); 3343e5e0926SMatthias Ringwald } 33552db98b2SMatthias Ringwald 336228e430cSMatthias Ringwald inline static void connectionSetAuthenticationFlags(hci_connection_t * conn, hci_authentication_flags_t flags){ 337228e430cSMatthias Ringwald conn->authentication_flags = (hci_authentication_flags_t)(conn->authentication_flags | flags); 338228e430cSMatthias Ringwald } 339228e430cSMatthias Ringwald 34052db98b2SMatthias Ringwald #ifdef ENABLE_CLASSIC 34152db98b2SMatthias Ringwald 342ee752bb8SMatthias Ringwald #ifdef ENABLE_SCO_OVER_HCI 343ee752bb8SMatthias Ringwald static int hci_number_sco_connections(void){ 344ee752bb8SMatthias Ringwald int connections = 0; 345ee752bb8SMatthias Ringwald btstack_linked_list_iterator_t it; 346ee752bb8SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->connections); 347ee752bb8SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 348ee752bb8SMatthias Ringwald hci_connection_t * connection = (hci_connection_t *) btstack_linked_list_iterator_next(&it); 349ee752bb8SMatthias Ringwald if (connection->address_type != BD_ADDR_TYPE_SCO) continue; 350ee752bb8SMatthias Ringwald connections++; 351ee752bb8SMatthias Ringwald } 352ee752bb8SMatthias Ringwald return connections; 353ee752bb8SMatthias Ringwald } 354ee752bb8SMatthias Ringwald #endif 355ee752bb8SMatthias Ringwald 356ec820d77SMatthias Ringwald static void hci_connection_timeout_handler(btstack_timer_source_t *timer){ 35791a977e8SMatthias Ringwald hci_connection_t * connection = (hci_connection_t *) btstack_run_loop_get_timer_context(timer); 358aec7654dSMatthias Ringwald #ifdef HAVE_EMBEDDED_TICK 359528a4a3bSMatthias Ringwald if (btstack_run_loop_embedded_get_ticks() > connection->timestamp + btstack_run_loop_embedded_ticks_for_ms(HCI_CONNECTION_TIMEOUT_MS)){ 360c785ef68Smatthias.ringwald // connections might be timed out 361c785ef68Smatthias.ringwald hci_emit_l2cap_check_timeout(connection); 362c785ef68Smatthias.ringwald } 363f316a845SMatthias Ringwald #else 364c1ab6cc1SMatthias Ringwald if (btstack_run_loop_get_time_ms() > (connection->timestamp + HCI_CONNECTION_TIMEOUT_MS)){ 3655f26aadcSMatthias Ringwald // connections might be timed out 3665f26aadcSMatthias Ringwald hci_emit_l2cap_check_timeout(connection); 3675f26aadcSMatthias Ringwald } 3685f26aadcSMatthias Ringwald #endif 369c785ef68Smatthias.ringwald } 370ee091cf1Smatthias.ringwald 371ee091cf1Smatthias.ringwald static void hci_connection_timestamp(hci_connection_t *connection){ 372aec7654dSMatthias Ringwald #ifdef HAVE_EMBEDDED_TICK 373528a4a3bSMatthias Ringwald connection->timestamp = btstack_run_loop_embedded_get_ticks(); 374f316a845SMatthias Ringwald #else 375528a4a3bSMatthias Ringwald connection->timestamp = btstack_run_loop_get_time_ms(); 3765f26aadcSMatthias Ringwald #endif 377ee091cf1Smatthias.ringwald } 378ee091cf1Smatthias.ringwald 37943bfb1bdSmatthias.ringwald /** 38080ca58a0Smatthias.ringwald * add authentication flags and reset timer 38196a45072S[email protected] * @note: assumes classic connection 3822e77e513S[email protected] * @note: bd_addr is passed in as litle endian uint8_t * as it is called from parsing packets 3837fde4af9Smatthias.ringwald */ 3847fde4af9Smatthias.ringwald static void hci_add_connection_flags_for_flipped_bd_addr(uint8_t *bd_addr, hci_authentication_flags_t flags){ 3857fde4af9Smatthias.ringwald bd_addr_t addr; 386724d70a2SMatthias Ringwald reverse_bd_addr(bd_addr, addr); 387f16129ceSMatthias Ringwald hci_connection_t * conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL); 3887fde4af9Smatthias.ringwald if (conn) { 38928ca2b46S[email protected] connectionSetAuthenticationFlags(conn, flags); 39080ca58a0Smatthias.ringwald hci_connection_timestamp(conn); 3917fde4af9Smatthias.ringwald } 3927fde4af9Smatthias.ringwald } 3937fde4af9Smatthias.ringwald 3941714cbbdSMatthias Ringwald static bool hci_pairing_active(hci_connection_t * hci_connection){ 3958daf94bcSMatthias Ringwald return (hci_connection->authentication_flags & AUTH_FLAG_PAIRING_ACTIVE_MASK) != 0; 3961714cbbdSMatthias Ringwald } 3971714cbbdSMatthias Ringwald 3981714cbbdSMatthias Ringwald static void hci_pairing_started(hci_connection_t * hci_connection, bool ssp){ 3991714cbbdSMatthias Ringwald if (hci_pairing_active(hci_connection)) return; 4001714cbbdSMatthias Ringwald if (ssp){ 4018daf94bcSMatthias Ringwald hci_connection->authentication_flags |= AUTH_FLAG_SSP_PAIRING_ACTIVE; 4021714cbbdSMatthias Ringwald } else { 4038daf94bcSMatthias Ringwald hci_connection->authentication_flags |= AUTH_FLAG_LEGACY_PAIRING_ACTIVE; 4041714cbbdSMatthias Ringwald } 4051714cbbdSMatthias Ringwald // if we are initiator, we have sent an HCI Authenticate Request 4061714cbbdSMatthias Ringwald bool initiator = (hci_connection->bonding_flags & BONDING_SENT_AUTHENTICATE_REQUEST) != 0; 4071714cbbdSMatthias Ringwald 4085a561920SMatthias Ringwald // if we are responder, use minimal service security level as required level 4095a561920SMatthias Ringwald if (!initiator){ 410acadfdd0SMatthias Ringwald hci_connection->requested_security_level = (gap_security_level_t) btstack_max((uint32_t) hci_connection->requested_security_level, (uint32_t) hci_stack->gap_minimal_service_security_level); 4115a561920SMatthias Ringwald } 4125a561920SMatthias Ringwald 4135a561920SMatthias Ringwald log_info("pairing started, ssp %u, initiator %u, requested level %u", (int) ssp, (int) initiator, hci_connection->requested_security_level); 41477208d90SMatthias Ringwald 41577208d90SMatthias Ringwald uint8_t event[12]; 41677208d90SMatthias Ringwald event[0] = GAP_EVENT_PAIRING_STARTED; 41777208d90SMatthias Ringwald event[1] = 10; 418bfaf6993SMatthias Ringwald little_endian_store_16(event, 2, (uint16_t) hci_connection->con_handle); 4194159a80bSMatthias Ringwald reverse_bd_addr(hci_connection->address, &event[4]); 42077208d90SMatthias Ringwald event[10] = (uint8_t) ssp; 42177208d90SMatthias Ringwald event[11] = (uint8_t) initiator; 42277208d90SMatthias Ringwald hci_emit_event(event, sizeof(event), 1); 4231714cbbdSMatthias Ringwald } 4241714cbbdSMatthias Ringwald 4251714cbbdSMatthias Ringwald static void hci_pairing_complete(hci_connection_t * hci_connection, uint8_t status){ 4263c439ac4SMatthias Ringwald hci_connection->requested_security_level = LEVEL_0; 4271714cbbdSMatthias Ringwald if (!hci_pairing_active(hci_connection)) return; 4288daf94bcSMatthias Ringwald hci_connection->authentication_flags &= ~AUTH_FLAG_PAIRING_ACTIVE_MASK; 4291714cbbdSMatthias Ringwald log_info("pairing complete, status %02x", status); 43077208d90SMatthias Ringwald 43177208d90SMatthias Ringwald uint8_t event[12]; 43277208d90SMatthias Ringwald event[0] = GAP_EVENT_PAIRING_COMPLETE; 43377208d90SMatthias Ringwald event[1] = 9; 434bfaf6993SMatthias Ringwald little_endian_store_16(event, 2, (uint16_t) hci_connection->con_handle); 4354159a80bSMatthias Ringwald reverse_bd_addr(hci_connection->address, &event[4]); 43677208d90SMatthias Ringwald event[10] = status; 43777208d90SMatthias Ringwald hci_emit_event(event, sizeof(event), 1); 4381714cbbdSMatthias Ringwald } 4391714cbbdSMatthias Ringwald 44020dcdd22SMatthias Ringwald bool hci_authentication_active_for_handle(hci_con_handle_t handle){ 4415061f3afS[email protected] hci_connection_t * conn = hci_connection_for_handle(handle); 44220dcdd22SMatthias Ringwald if (!conn) return false; 44320dcdd22SMatthias Ringwald return hci_pairing_active(conn); 44480ca58a0Smatthias.ringwald } 44580ca58a0Smatthias.ringwald 44615a95bd5SMatthias Ringwald void gap_drop_link_key_for_bd_addr(bd_addr_t addr){ 44755597469SMatthias Ringwald if (!hci_stack->link_key_db) return; 4482bacf595SMatthias Ringwald log_info("gap_drop_link_key_for_bd_addr: %s", bd_addr_to_str(addr)); 449a98592bcSMatthias Ringwald hci_stack->link_key_db->delete_link_key(addr); 450c12e46e7Smatthias.ringwald } 45155597469SMatthias Ringwald 45255597469SMatthias Ringwald void gap_store_link_key_for_bd_addr(bd_addr_t addr, link_key_t link_key, link_key_type_t type){ 45355597469SMatthias Ringwald if (!hci_stack->link_key_db) return; 4542bacf595SMatthias Ringwald log_info("gap_store_link_key_for_bd_addr: %s, type %u", bd_addr_to_str(addr), type); 45555597469SMatthias Ringwald hci_stack->link_key_db->put_link_key(addr, link_key, type); 456c12e46e7Smatthias.ringwald } 4571b6fb31bSMatthias Ringwald 458e8ad470fSMatthias Ringwald bool gap_get_link_key_for_bd_addr(bd_addr_t addr, link_key_t link_key, link_key_type_t * type){ 459e8ad470fSMatthias Ringwald if (!hci_stack->link_key_db) return false; 46076b0318eSMatthias Ringwald int result = hci_stack->link_key_db->get_link_key(addr, link_key, type) != 0; 46176b0318eSMatthias Ringwald log_info("link key for %s available %u, type %u", bd_addr_to_str(addr), result, (int) *type); 46276b0318eSMatthias Ringwald return result; 463e8ad470fSMatthias Ringwald } 464e8ad470fSMatthias Ringwald 465ceecb9d9SMatthias Ringwald void gap_delete_all_link_keys(void){ 466ceecb9d9SMatthias Ringwald bd_addr_t addr; 467ceecb9d9SMatthias Ringwald link_key_t link_key; 468ceecb9d9SMatthias Ringwald link_key_type_t type; 469ceecb9d9SMatthias Ringwald btstack_link_key_iterator_t it; 470ceecb9d9SMatthias Ringwald int ok = gap_link_key_iterator_init(&it); 471ceecb9d9SMatthias Ringwald if (!ok) { 472ceecb9d9SMatthias Ringwald log_error("could not initialize iterator"); 473ceecb9d9SMatthias Ringwald return; 474ceecb9d9SMatthias Ringwald } 475ceecb9d9SMatthias Ringwald while (gap_link_key_iterator_get_next(&it, addr, link_key, &type)){ 476ceecb9d9SMatthias Ringwald gap_drop_link_key_for_bd_addr(addr); 477ceecb9d9SMatthias Ringwald } 478ceecb9d9SMatthias Ringwald gap_link_key_iterator_done(&it); 479ceecb9d9SMatthias Ringwald } 480ceecb9d9SMatthias Ringwald 4811b6fb31bSMatthias Ringwald int gap_link_key_iterator_init(btstack_link_key_iterator_t * it){ 4821b6fb31bSMatthias Ringwald if (!hci_stack->link_key_db) return 0; 4831b6fb31bSMatthias Ringwald if (!hci_stack->link_key_db->iterator_init) return 0; 4841b6fb31bSMatthias Ringwald return hci_stack->link_key_db->iterator_init(it); 4851b6fb31bSMatthias Ringwald } 4861b6fb31bSMatthias 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){ 4871b6fb31bSMatthias Ringwald if (!hci_stack->link_key_db) return 0; 4881b6fb31bSMatthias Ringwald return hci_stack->link_key_db->iterator_get_next(it, bd_addr, link_key, type); 4891b6fb31bSMatthias Ringwald } 4901b6fb31bSMatthias Ringwald void gap_link_key_iterator_done(btstack_link_key_iterator_t * it){ 4911b6fb31bSMatthias Ringwald if (!hci_stack->link_key_db) return; 4921b6fb31bSMatthias Ringwald hci_stack->link_key_db->iterator_done(it); 4931b6fb31bSMatthias Ringwald } 49435454696SMatthias Ringwald #endif 495c12e46e7Smatthias.ringwald 496eb8076ddSMatthias Ringwald static bool hci_is_le_connection_type(bd_addr_type_t address_type){ 497eb8076ddSMatthias Ringwald switch (address_type){ 498ce41473eSMatthias Ringwald case BD_ADDR_TYPE_LE_PUBLIC: 499ce41473eSMatthias Ringwald case BD_ADDR_TYPE_LE_RANDOM: 500ce41473eSMatthias Ringwald case BD_ADDR_TYPE_LE_PRIVAT_FALLBACK_PUBLIC: 501ce41473eSMatthias Ringwald case BD_ADDR_TYPE_LE_PRIVAT_FALLBACK_RANDOM: 502eb8076ddSMatthias Ringwald return true; 503ce41473eSMatthias Ringwald default: 504eb8076ddSMatthias Ringwald return false; 505ce41473eSMatthias Ringwald } 5060bf6344aS[email protected] } 5070bf6344aS[email protected] 508eb8076ddSMatthias Ringwald static int hci_is_le_connection(hci_connection_t * connection){ 509eb8076ddSMatthias Ringwald return hci_is_le_connection_type(connection->address_type); 510eb8076ddSMatthias Ringwald } 511eb8076ddSMatthias Ringwald 5127fde4af9Smatthias.ringwald /** 51343bfb1bdSmatthias.ringwald * count connections 51443bfb1bdSmatthias.ringwald */ 51540d1c7a4Smatthias.ringwald static int nr_hci_connections(void){ 51656c253c9Smatthias.ringwald int count = 0; 517665d90f2SMatthias Ringwald btstack_linked_item_t *it; 518a0da043fSMatthias Ringwald for (it = (btstack_linked_item_t *) hci_stack->connections; it != NULL ; it = it->next){ 51915a27967SMatthias Ringwald count++; 52015a27967SMatthias Ringwald } 52143bfb1bdSmatthias.ringwald return count; 52243bfb1bdSmatthias.ringwald } 523c8e4258aSmatthias.ringwald 52495d71764SMatthias Ringwald static int hci_number_free_acl_slots_for_connection_type(bd_addr_type_t address_type){ 525ee303eddS[email protected] 526f04a0c31SMatthias Ringwald unsigned int num_packets_sent_classic = 0; 527f04a0c31SMatthias Ringwald unsigned int num_packets_sent_le = 0; 528ee303eddS[email protected] 529665d90f2SMatthias Ringwald btstack_linked_item_t *it; 530a0da043fSMatthias Ringwald for (it = (btstack_linked_item_t *) hci_stack->connections; it != NULL; it = it->next){ 531998906cdSmatthias.ringwald hci_connection_t * connection = (hci_connection_t *) it; 532ce41473eSMatthias Ringwald if (hci_is_le_connection(connection)){ 533ce41473eSMatthias Ringwald num_packets_sent_le += connection->num_packets_sent; 534ce41473eSMatthias Ringwald } 535f16129ceSMatthias Ringwald if (connection->address_type == BD_ADDR_TYPE_ACL){ 536ce41473eSMatthias Ringwald num_packets_sent_classic += connection->num_packets_sent; 537ee303eddS[email protected] } 538ee303eddS[email protected] } 539d999b54eSMatthias Ringwald log_debug("ACL classic buffers: %u used of %u", num_packets_sent_classic, hci_stack->acl_packets_total_num); 540ee303eddS[email protected] int free_slots_classic = hci_stack->acl_packets_total_num - num_packets_sent_classic; 541ee303eddS[email protected] int free_slots_le = 0; 542ee303eddS[email protected] 543ee303eddS[email protected] if (free_slots_classic < 0){ 5449da54300S[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); 545998906cdSmatthias.ringwald return 0; 546998906cdSmatthias.ringwald } 547ee303eddS[email protected] 548ee303eddS[email protected] if (hci_stack->le_acl_packets_total_num){ 549ee303eddS[email protected] // if we have LE slots, they are used 550ee303eddS[email protected] free_slots_le = hci_stack->le_acl_packets_total_num - num_packets_sent_le; 551ee303eddS[email protected] if (free_slots_le < 0){ 5529da54300S[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); 553ee303eddS[email protected] return 0; 554998906cdSmatthias.ringwald } 555ee303eddS[email protected] } else { 556ee303eddS[email protected] // otherwise, classic slots are used for LE, too 557ee303eddS[email protected] free_slots_classic -= num_packets_sent_le; 558ee303eddS[email protected] if (free_slots_classic < 0){ 5599da54300S[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); 560ee303eddS[email protected] return 0; 561ee303eddS[email protected] } 562ee303eddS[email protected] } 563ee303eddS[email protected] 564ee303eddS[email protected] switch (address_type){ 565ee303eddS[email protected] case BD_ADDR_TYPE_UNKNOWN: 5662125de09SMatthias Ringwald log_error("hci_number_free_acl_slots: unknown address type"); 567ee303eddS[email protected] return 0; 568ee303eddS[email protected] 569f16129ceSMatthias Ringwald case BD_ADDR_TYPE_ACL: 570ee303eddS[email protected] return free_slots_classic; 571ee303eddS[email protected] 572ee303eddS[email protected] default: 573cb00d3aaS[email protected] if (hci_stack->le_acl_packets_total_num){ 574ee303eddS[email protected] return free_slots_le; 575ee303eddS[email protected] } 576cb00d3aaS[email protected] return free_slots_classic; 577cb00d3aaS[email protected] } 578998906cdSmatthias.ringwald } 579998906cdSmatthias.ringwald 5802125de09SMatthias Ringwald int hci_number_free_acl_slots_for_handle(hci_con_handle_t con_handle){ 5812125de09SMatthias Ringwald // get connection type 5822125de09SMatthias Ringwald hci_connection_t * connection = hci_connection_for_handle(con_handle); 5832125de09SMatthias Ringwald if (!connection){ 5842125de09SMatthias Ringwald log_error("hci_number_free_acl_slots: handle 0x%04x not in connection list", con_handle); 5852125de09SMatthias Ringwald return 0; 5862125de09SMatthias Ringwald } 5872125de09SMatthias Ringwald return hci_number_free_acl_slots_for_connection_type(connection->address_type); 5882125de09SMatthias Ringwald } 5892125de09SMatthias Ringwald 59035454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 591701e3307SMatthias Ringwald static int hci_number_free_sco_slots(void){ 592f04a0c31SMatthias Ringwald unsigned int num_sco_packets_sent = 0; 593665d90f2SMatthias Ringwald btstack_linked_item_t *it; 594760b20efSMatthias Ringwald if (hci_stack->synchronous_flow_control_enabled){ 595760b20efSMatthias Ringwald // explicit flow control 596665d90f2SMatthias Ringwald for (it = (btstack_linked_item_t *) hci_stack->connections; it ; it = it->next){ 597e35edcc1S[email protected] hci_connection_t * connection = (hci_connection_t *) it; 598ce41473eSMatthias Ringwald if (connection->address_type != BD_ADDR_TYPE_SCO) continue; 599ce41473eSMatthias Ringwald num_sco_packets_sent += connection->num_packets_sent; 600e35edcc1S[email protected] } 601e35edcc1S[email protected] if (num_sco_packets_sent > hci_stack->sco_packets_total_num){ 602701e3307SMatthias Ringwald log_info("hci_number_free_sco_slots:packets (%u) > total packets (%u)", num_sco_packets_sent, hci_stack->sco_packets_total_num); 60344d0e3d5S[email protected] return 0; 60444d0e3d5S[email protected] } 605e35edcc1S[email protected] return hci_stack->sco_packets_total_num - num_sco_packets_sent; 60649205f5dSMatthias Ringwald } else { 60749205f5dSMatthias Ringwald // implicit flow control -- TODO 6086f28d2eeSMatthias Ringwald int num_ready = 0; 6096f28d2eeSMatthias Ringwald for (it = (btstack_linked_item_t *) hci_stack->connections; it ; it = it->next){ 6106f28d2eeSMatthias Ringwald hci_connection_t * connection = (hci_connection_t *) it; 6116f28d2eeSMatthias Ringwald if (connection->address_type != BD_ADDR_TYPE_SCO) continue; 6126f28d2eeSMatthias Ringwald if (connection->sco_tx_ready == 0) continue; 6136f28d2eeSMatthias Ringwald num_ready++; 61449205f5dSMatthias Ringwald } 6156f28d2eeSMatthias Ringwald return num_ready; 6166f28d2eeSMatthias Ringwald } 617e35edcc1S[email protected] } 61835454696SMatthias Ringwald #endif 61944d0e3d5S[email protected] 6202b838201SMatthias Ringwald // only used to send HCI Host Number Completed Packets 6212b838201SMatthias Ringwald static int hci_can_send_comand_packet_transport(void){ 622ac928cc2S[email protected] if (hci_stack->hci_packet_buffer_reserved) return 0; 623ac928cc2S[email protected] 624ac928cc2S[email protected] // check for async hci transport implementations 625ac928cc2S[email protected] if (hci_stack->hci_transport->can_send_packet_now){ 626ac928cc2S[email protected] if (!hci_stack->hci_transport->can_send_packet_now(HCI_COMMAND_DATA_PACKET)){ 627ac928cc2S[email protected] return 0; 628ac928cc2S[email protected] } 629ac928cc2S[email protected] } 6302b838201SMatthias Ringwald return 1; 6312b838201SMatthias Ringwald } 632ac928cc2S[email protected] 6332b838201SMatthias Ringwald // new functions replacing hci_can_send_packet_now[_using_packet_buffer] 6341972f31fSMatthias Ringwald bool hci_can_send_command_packet_now(void){ 6351972f31fSMatthias Ringwald if (hci_can_send_comand_packet_transport() == 0) return false; 6364ea43905SMatthias Ringwald return hci_stack->num_cmd_packets > 0u; 637ac928cc2S[email protected] } 638ac928cc2S[email protected] 6399d04d3a7SMatthias Ringwald static int hci_transport_can_send_prepared_packet_now(uint8_t packet_type){ 640ac928cc2S[email protected] // check for async hci transport implementations 6411972f31fSMatthias Ringwald if (!hci_stack->hci_transport->can_send_packet_now) return true; 6429d04d3a7SMatthias Ringwald return hci_stack->hci_transport->can_send_packet_now(packet_type); 643ac928cc2S[email protected] } 6449d04d3a7SMatthias Ringwald 6451972f31fSMatthias Ringwald static bool hci_can_send_prepared_acl_packet_for_address_type(bd_addr_type_t address_type){ 6461972f31fSMatthias Ringwald if (!hci_transport_can_send_prepared_packet_now(HCI_ACL_DATA_PACKET)) return false; 6479d04d3a7SMatthias Ringwald return hci_number_free_acl_slots_for_connection_type(address_type) > 0; 648ac928cc2S[email protected] } 6499d04d3a7SMatthias Ringwald 6501972f31fSMatthias Ringwald bool hci_can_send_acl_le_packet_now(void){ 6511972f31fSMatthias Ringwald if (hci_stack->hci_packet_buffer_reserved) return false; 6529d04d3a7SMatthias Ringwald return hci_can_send_prepared_acl_packet_for_address_type(BD_ADDR_TYPE_LE_PUBLIC); 6539d04d3a7SMatthias Ringwald } 6549d04d3a7SMatthias Ringwald 6551972f31fSMatthias Ringwald bool hci_can_send_prepared_acl_packet_now(hci_con_handle_t con_handle) { 6561972f31fSMatthias Ringwald if (!hci_transport_can_send_prepared_packet_now(HCI_ACL_DATA_PACKET)) return false; 657e79abdd6S[email protected] return hci_number_free_acl_slots_for_handle(con_handle) > 0; 658ac928cc2S[email protected] } 659ac928cc2S[email protected] 6601972f31fSMatthias Ringwald bool hci_can_send_acl_packet_now(hci_con_handle_t con_handle){ 6611972f31fSMatthias Ringwald if (hci_stack->hci_packet_buffer_reserved) return false; 662ac928cc2S[email protected] return hci_can_send_prepared_acl_packet_now(con_handle); 6636b4af23dS[email protected] } 6646b4af23dS[email protected] 66535454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 6661972f31fSMatthias Ringwald bool hci_can_send_acl_classic_packet_now(void){ 6671972f31fSMatthias Ringwald if (hci_stack->hci_packet_buffer_reserved) return false; 668f16129ceSMatthias Ringwald return hci_can_send_prepared_acl_packet_for_address_type(BD_ADDR_TYPE_ACL); 66935454696SMatthias Ringwald } 67035454696SMatthias Ringwald 6711972f31fSMatthias Ringwald bool hci_can_send_prepared_sco_packet_now(void){ 6721972f31fSMatthias Ringwald if (!hci_transport_can_send_prepared_packet_now(HCI_SCO_DATA_PACKET)) return false; 673f234b250SMatthias Ringwald if (hci_have_usb_transport()){ 674f234b250SMatthias Ringwald return hci_stack->sco_can_send_now; 675f234b250SMatthias Ringwald } else { 676701e3307SMatthias Ringwald return hci_number_free_sco_slots() > 0; 67744d0e3d5S[email protected] } 678f234b250SMatthias Ringwald } 67944d0e3d5S[email protected] 6801972f31fSMatthias Ringwald bool hci_can_send_sco_packet_now(void){ 6811972f31fSMatthias Ringwald if (hci_stack->hci_packet_buffer_reserved) return false; 682701e3307SMatthias Ringwald return hci_can_send_prepared_sco_packet_now(); 68344d0e3d5S[email protected] } 68444d0e3d5S[email protected] 685d057580eSMatthias Ringwald void hci_request_sco_can_send_now_event(void){ 686d057580eSMatthias Ringwald hci_stack->sco_waiting_for_can_send_now = 1; 687d057580eSMatthias Ringwald hci_notify_if_sco_can_send_now(); 688d057580eSMatthias Ringwald } 68935454696SMatthias Ringwald #endif 690d057580eSMatthias Ringwald 69195d71764SMatthias Ringwald // used for internal checks in l2cap.c 69202c7fc01SMatthias Ringwald bool hci_is_packet_buffer_reserved(void){ 693c8b9416aS[email protected] return hci_stack->hci_packet_buffer_reserved; 694c8b9416aS[email protected] } 695c8b9416aS[email protected] 6966b4af23dS[email protected] // reserves outgoing packet buffer. @returns 1 if successful 697cafc12e8SMatthias Ringwald bool hci_reserve_packet_buffer(void){ 6989d14b626S[email protected] if (hci_stack->hci_packet_buffer_reserved) { 6999d14b626S[email protected] log_error("hci_reserve_packet_buffer called but buffer already reserved"); 700cafc12e8SMatthias Ringwald return false; 7019d14b626S[email protected] } 70202c7fc01SMatthias Ringwald hci_stack->hci_packet_buffer_reserved = true; 703cafc12e8SMatthias Ringwald return true; 7046b4af23dS[email protected] } 7056b4af23dS[email protected] 70668a0fcf7S[email protected] void hci_release_packet_buffer(void){ 70702c7fc01SMatthias Ringwald hci_stack->hci_packet_buffer_reserved = false; 70868a0fcf7S[email protected] } 70968a0fcf7S[email protected] 7106b4af23dS[email protected] // assumption: synchronous implementations don't provide can_send_packet_now as they don't keep the buffer after the call 7117f02f414SMatthias Ringwald static int hci_transport_synchronous(void){ 7126b4af23dS[email protected] return hci_stack->hci_transport->can_send_packet_now == NULL; 7136b4af23dS[email protected] } 7146b4af23dS[email protected] 7153e2050f7SMatthias Ringwald static uint8_t hci_send_acl_packet_fragments(hci_connection_t *connection){ 716452cf3bbS[email protected] 717452cf3bbS[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); 718452cf3bbS[email protected] 719452cf3bbS[email protected] // max ACL data packet length depends on connection type (LE vs. Classic) and available buffers 720452cf3bbS[email protected] uint16_t max_acl_data_packet_length = hci_stack->acl_data_packet_length; 7214ea43905SMatthias Ringwald if (hci_is_le_connection(connection) && (hci_stack->le_data_packets_length > 0u)){ 722452cf3bbS[email protected] max_acl_data_packet_length = hci_stack->le_data_packets_length; 723452cf3bbS[email protected] } 724452cf3bbS[email protected] 7250f3b27c5SMatthias Ringwald #ifdef ENABLE_LE_LIMIT_ACL_FRAGMENT_BY_MAX_OCTETS 726fcf88f47SMatthias Ringwald if (hci_is_le_connection(connection) && (connection->le_max_tx_octets < max_acl_data_packet_length)){ 7270f3b27c5SMatthias Ringwald max_acl_data_packet_length = connection->le_max_tx_octets; 7280f3b27c5SMatthias Ringwald } 7290f3b27c5SMatthias Ringwald #endif 730452cf3bbS[email protected] 731d999b54eSMatthias Ringwald log_debug("hci_send_acl_packet_fragments entered"); 732d999b54eSMatthias Ringwald 7333e2050f7SMatthias Ringwald uint8_t status = ERROR_CODE_SUCCESS; 734452cf3bbS[email protected] // multiple packets could be send on a synchronous HCI transport 735ff3cc4a5SMatthias Ringwald while (true){ 736452cf3bbS[email protected] 737d999b54eSMatthias Ringwald log_debug("hci_send_acl_packet_fragments loop entered"); 738d999b54eSMatthias Ringwald 739452cf3bbS[email protected] // get current data 7404ea43905SMatthias Ringwald const uint16_t acl_header_pos = hci_stack->acl_fragmentation_pos - 4u; 741452cf3bbS[email protected] int current_acl_data_packet_length = hci_stack->acl_fragmentation_total_size - hci_stack->acl_fragmentation_pos; 7421979f09cSMatthias Ringwald bool more_fragments = false; 743452cf3bbS[email protected] 744452cf3bbS[email protected] // if ACL packet is larger than Bluetooth packet buffer, only send max_acl_data_packet_length 745452cf3bbS[email protected] if (current_acl_data_packet_length > max_acl_data_packet_length){ 7461979f09cSMatthias Ringwald more_fragments = true; 747452cf3bbS[email protected] current_acl_data_packet_length = max_acl_data_packet_length; 748452cf3bbS[email protected] } 749452cf3bbS[email protected] 750452cf3bbS[email protected] // copy handle_and_flags if not first fragment and update packet boundary flags to be 01 (continuing fragmnent) 7514ea43905SMatthias Ringwald if (acl_header_pos > 0u){ 752f8fbdce0SMatthias Ringwald uint16_t handle_and_flags = little_endian_read_16(hci_stack->hci_packet_buffer, 0); 7534ea43905SMatthias Ringwald handle_and_flags = (handle_and_flags & 0xcfffu) | (1u << 12u); 754f8fbdce0SMatthias Ringwald little_endian_store_16(hci_stack->hci_packet_buffer, acl_header_pos, handle_and_flags); 755452cf3bbS[email protected] } 756452cf3bbS[email protected] 757452cf3bbS[email protected] // update header len 7584ea43905SMatthias Ringwald little_endian_store_16(hci_stack->hci_packet_buffer, acl_header_pos + 2u, current_acl_data_packet_length); 759452cf3bbS[email protected] 760452cf3bbS[email protected] // count packet 761ce41473eSMatthias Ringwald connection->num_packets_sent++; 7621979f09cSMatthias Ringwald log_debug("hci_send_acl_packet_fragments loop before send (more fragments %d)", (int) more_fragments); 763d999b54eSMatthias Ringwald 764d999b54eSMatthias Ringwald // update state for next fragment (if any) as "transport done" might be sent during send_packet already 765d999b54eSMatthias Ringwald if (more_fragments){ 766d999b54eSMatthias Ringwald // update start of next fragment to send 767d999b54eSMatthias Ringwald hci_stack->acl_fragmentation_pos += current_acl_data_packet_length; 768d999b54eSMatthias Ringwald } else { 769d999b54eSMatthias Ringwald // done 770d999b54eSMatthias Ringwald hci_stack->acl_fragmentation_pos = 0; 771d999b54eSMatthias Ringwald hci_stack->acl_fragmentation_total_size = 0; 772d999b54eSMatthias Ringwald } 773452cf3bbS[email protected] 774452cf3bbS[email protected] // send packet 775452cf3bbS[email protected] uint8_t * packet = &hci_stack->hci_packet_buffer[acl_header_pos]; 776452cf3bbS[email protected] const int size = current_acl_data_packet_length + 4; 7775bb5bc3eS[email protected] hci_dump_packet(HCI_ACL_DATA_PACKET, 0, packet, size); 77881d2bdb2SMatthias Ringwald hci_stack->acl_fragmentation_tx_active = 1; 7793e2050f7SMatthias Ringwald int err = hci_stack->hci_transport->send_packet(HCI_ACL_DATA_PACKET, packet, size); 7803e2050f7SMatthias Ringwald if (err != 0){ 7813e2050f7SMatthias Ringwald // no error from HCI Transport expected 7823e2050f7SMatthias Ringwald status = ERROR_CODE_HARDWARE_FAILURE; 7833e2050f7SMatthias Ringwald } 784452cf3bbS[email protected] 7851979f09cSMatthias Ringwald log_debug("hci_send_acl_packet_fragments loop after send (more fragments %d)", (int) more_fragments); 786d999b54eSMatthias Ringwald 787452cf3bbS[email protected] // done yet? 788452cf3bbS[email protected] if (!more_fragments) break; 789452cf3bbS[email protected] 790452cf3bbS[email protected] // can send more? 7913e2050f7SMatthias Ringwald if (!hci_can_send_prepared_acl_packet_now(connection->con_handle)) return status; 792452cf3bbS[email protected] } 793452cf3bbS[email protected] 794d999b54eSMatthias Ringwald log_debug("hci_send_acl_packet_fragments loop over"); 795452cf3bbS[email protected] 796d051460cS[email protected] // release buffer now for synchronous transport 797203bace6S[email protected] if (hci_transport_synchronous()){ 79881d2bdb2SMatthias Ringwald hci_stack->acl_fragmentation_tx_active = 0; 799452cf3bbS[email protected] hci_release_packet_buffer(); 800fd43c0e0SMatthias Ringwald hci_emit_transport_packet_sent(); 801452cf3bbS[email protected] } 802452cf3bbS[email protected] 8033e2050f7SMatthias Ringwald return status; 804452cf3bbS[email protected] } 805452cf3bbS[email protected] 806826f7347S[email protected] // pre: caller has reserved the packet buffer 8073e2050f7SMatthias Ringwald uint8_t hci_send_acl_packet_buffer(int size){ 8083e2050f7SMatthias Ringwald btstack_assert(hci_stack->hci_packet_buffer_reserved); 809826f7347S[email protected] 810d713a683S[email protected] uint8_t * packet = hci_stack->hci_packet_buffer; 811d713a683S[email protected] hci_con_handle_t con_handle = READ_ACL_CONNECTION_HANDLE(packet); 812d713a683S[email protected] 813826f7347S[email protected] // check for free places on Bluetooth module 814d713a683S[email protected] if (!hci_can_send_prepared_acl_packet_now(con_handle)) { 815826f7347S[email protected] log_error("hci_send_acl_packet_buffer called but no free ACL buffers on controller"); 81697b61c7bS[email protected] hci_release_packet_buffer(); 817068b8592SMatthias Ringwald hci_emit_transport_packet_sent(); 81897b61c7bS[email protected] return BTSTACK_ACL_BUFFERS_FULL; 81997b61c7bS[email protected] } 8206218e6f1Smatthias.ringwald 8215061f3afS[email protected] hci_connection_t *connection = hci_connection_for_handle( con_handle); 82297b61c7bS[email protected] if (!connection) { 8235fa0b7cfS[email protected] log_error("hci_send_acl_packet_buffer called but no connection for handle 0x%04x", con_handle); 82497b61c7bS[email protected] hci_release_packet_buffer(); 825068b8592SMatthias Ringwald hci_emit_transport_packet_sent(); 8263e2050f7SMatthias Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 82797b61c7bS[email protected] } 82852db98b2SMatthias Ringwald 82952db98b2SMatthias Ringwald #ifdef ENABLE_CLASSIC 83056cf178bSmatthias.ringwald hci_connection_timestamp(connection); 83152db98b2SMatthias Ringwald #endif 83256cf178bSmatthias.ringwald 833452cf3bbS[email protected] // hci_dump_packet( HCI_ACL_DATA_PACKET, 0, packet, size); 8347856c818Smatthias.ringwald 835452cf3bbS[email protected] // setup data 836452cf3bbS[email protected] hci_stack->acl_fragmentation_total_size = size; 837452cf3bbS[email protected] hci_stack->acl_fragmentation_pos = 4; // start of L2CAP packet 8386218e6f1Smatthias.ringwald 839452cf3bbS[email protected] return hci_send_acl_packet_fragments(connection); 840ee091cf1Smatthias.ringwald } 841ee091cf1Smatthias.ringwald 84235454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 84344d0e3d5S[email protected] // pre: caller has reserved the packet buffer 8443e2050f7SMatthias Ringwald uint8_t hci_send_sco_packet_buffer(int size){ 8453e2050f7SMatthias Ringwald btstack_assert(hci_stack->hci_packet_buffer_reserved); 84644d0e3d5S[email protected] 84744d0e3d5S[email protected] uint8_t * packet = hci_stack->hci_packet_buffer; 8484b3e1e19SMatthias Ringwald 8494b3e1e19SMatthias Ringwald // skip checks in loopback mode 8504b3e1e19SMatthias Ringwald if (!hci_stack->loopback_mode){ 85144d0e3d5S[email protected] hci_con_handle_t con_handle = READ_ACL_CONNECTION_HANDLE(packet); // same for ACL and SCO 85244d0e3d5S[email protected] 85344d0e3d5S[email protected] // check for free places on Bluetooth module 854701e3307SMatthias Ringwald if (!hci_can_send_prepared_sco_packet_now()) { 855cbf638a9SMatthias Ringwald log_error("hci_send_sco_packet_buffer called but no free SCO buffers on controller"); 85644d0e3d5S[email protected] hci_release_packet_buffer(); 857068b8592SMatthias Ringwald hci_emit_transport_packet_sent(); 85844d0e3d5S[email protected] return BTSTACK_ACL_BUFFERS_FULL; 85944d0e3d5S[email protected] } 86044d0e3d5S[email protected] 861e35edcc1S[email protected] // track send packet in connection struct 862e35edcc1S[email protected] hci_connection_t *connection = hci_connection_for_handle( con_handle); 863e35edcc1S[email protected] if (!connection) { 864e35edcc1S[email protected] log_error("hci_send_sco_packet_buffer called but no connection for handle 0x%04x", con_handle); 865e35edcc1S[email protected] hci_release_packet_buffer(); 866068b8592SMatthias Ringwald hci_emit_transport_packet_sent(); 8673e2050f7SMatthias Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 868e35edcc1S[email protected] } 869f234b250SMatthias Ringwald 870f234b250SMatthias Ringwald if (hci_have_usb_transport()){ 871f234b250SMatthias Ringwald // token used 8721972f31fSMatthias Ringwald hci_stack->sco_can_send_now = false; 873f234b250SMatthias Ringwald } else { 874760b20efSMatthias Ringwald if (hci_stack->synchronous_flow_control_enabled){ 875ce41473eSMatthias Ringwald connection->num_packets_sent++; 8766f28d2eeSMatthias Ringwald } else { 877e4157653SMatthias Ringwald connection->sco_tx_ready--; 878760b20efSMatthias Ringwald } 8794b3e1e19SMatthias Ringwald } 880f234b250SMatthias Ringwald } 88144d0e3d5S[email protected] 88244d0e3d5S[email protected] hci_dump_packet( HCI_SCO_DATA_PACKET, 0, packet, size); 883543e835cSMatthias Ringwald 88443149fc9SMatthias Ringwald #ifdef HAVE_SCO_TRANSPORT 88543149fc9SMatthias Ringwald hci_stack->sco_transport->send_packet(packet, size); 88643149fc9SMatthias Ringwald hci_release_packet_buffer(); 88743149fc9SMatthias Ringwald hci_emit_transport_packet_sent(); 88843149fc9SMatthias Ringwald 88943149fc9SMatthias Ringwald return 0; 89043149fc9SMatthias Ringwald #else 89143149fc9SMatthias Ringwald int err = hci_stack->hci_transport->send_packet(HCI_SCO_DATA_PACKET, packet, size); 892543e835cSMatthias Ringwald if (hci_transport_synchronous()){ 893543e835cSMatthias Ringwald hci_release_packet_buffer(); 894fd43c0e0SMatthias Ringwald hci_emit_transport_packet_sent(); 895543e835cSMatthias Ringwald } 896543e835cSMatthias Ringwald 8973e2050f7SMatthias Ringwald if (err != 0){ 8983e2050f7SMatthias Ringwald return ERROR_CODE_HARDWARE_FAILURE; 8993e2050f7SMatthias Ringwald } 9003e2050f7SMatthias Ringwald return ERROR_CODE_SUCCESS; 90143149fc9SMatthias Ringwald #endif 90244d0e3d5S[email protected] } 90335454696SMatthias Ringwald #endif 90444d0e3d5S[email protected] 905c3b46f5aSMatthias Ringwald static void acl_handler(uint8_t *packet, uint16_t size){ 906e76a89eeS[email protected] 9077856c818Smatthias.ringwald // get info 9087856c818Smatthias.ringwald hci_con_handle_t con_handle = READ_ACL_CONNECTION_HANDLE(packet); 9095061f3afS[email protected] hci_connection_t *conn = hci_connection_for_handle(con_handle); 9107856c818Smatthias.ringwald uint8_t acl_flags = READ_ACL_FLAGS(packet); 9117856c818Smatthias.ringwald uint16_t acl_length = READ_ACL_LENGTH(packet); 9127856c818Smatthias.ringwald 9137856c818Smatthias.ringwald // ignore non-registered handle 9147856c818Smatthias.ringwald if (!conn){ 915c3b46f5aSMatthias Ringwald log_error("acl_handler called with non-registered handle %u!" , con_handle); 9167856c818Smatthias.ringwald return; 9177856c818Smatthias.ringwald } 9187856c818Smatthias.ringwald 919e76a89eeS[email protected] // assert packet is complete 9204ea43905SMatthias Ringwald if ((acl_length + 4u) != size){ 921c3b46f5aSMatthias Ringwald log_error("acl_handler called with ACL packet of wrong size %d, expected %u => dropping packet", size, acl_length + 4); 922e76a89eeS[email protected] return; 923e76a89eeS[email protected] } 924e76a89eeS[email protected] 92552db98b2SMatthias Ringwald #ifdef ENABLE_CLASSIC 9267856c818Smatthias.ringwald // update idle timestamp 9277856c818Smatthias.ringwald hci_connection_timestamp(conn); 92852db98b2SMatthias Ringwald #endif 9297856c818Smatthias.ringwald 9302b838201SMatthias Ringwald #ifdef ENABLE_HCI_CONTROLLER_TO_HOST_FLOW_CONTROL 9312b838201SMatthias Ringwald hci_stack->host_completed_packets = 1; 9322b838201SMatthias Ringwald conn->num_packets_completed++; 9332b838201SMatthias Ringwald #endif 9342b838201SMatthias Ringwald 9357856c818Smatthias.ringwald // handle different packet types 9364ea43905SMatthias Ringwald switch (acl_flags & 0x03u) { 9377856c818Smatthias.ringwald 9387856c818Smatthias.ringwald case 0x01: // continuation fragment 9397856c818Smatthias.ringwald 9400ca847afS[email protected] // sanity checks 9414ea43905SMatthias Ringwald if (conn->acl_recombination_pos == 0u) { 9429da54300S[email protected] log_error( "ACL Cont Fragment but no first fragment for handle 0x%02x", con_handle); 9437856c818Smatthias.ringwald return; 9447856c818Smatthias.ringwald } 9454ea43905SMatthias Ringwald if ((conn->acl_recombination_pos + acl_length) > (4u + HCI_ACL_BUFFER_SIZE)){ 9460ca847afS[email protected] log_error( "ACL Cont Fragment to large: combined packet %u > buffer size %u for handle 0x%02x", 9470ca847afS[email protected] conn->acl_recombination_pos + acl_length, 4 + HCI_ACL_BUFFER_SIZE, con_handle); 9480ca847afS[email protected] conn->acl_recombination_pos = 0; 9490ca847afS[email protected] return; 9500ca847afS[email protected] } 9517856c818Smatthias.ringwald 9527856c818Smatthias.ringwald // append fragment payload (header already stored) 9536535961aSMatthias Ringwald (void)memcpy(&conn->acl_recombination_buffer[HCI_INCOMING_PRE_BUFFER_SIZE + conn->acl_recombination_pos], 9546535961aSMatthias Ringwald &packet[4], acl_length); 9557856c818Smatthias.ringwald conn->acl_recombination_pos += acl_length; 9567856c818Smatthias.ringwald 9577856c818Smatthias.ringwald // forward complete L2CAP packet if complete. 9584ea43905SMatthias Ringwald if (conn->acl_recombination_pos >= (conn->acl_recombination_length + 4u + 4u)){ // pos already incl. ACL header 959d6b06661SMatthias Ringwald hci_emit_acl_packet(&conn->acl_recombination_buffer[HCI_INCOMING_PRE_BUFFER_SIZE], conn->acl_recombination_pos); 9607856c818Smatthias.ringwald // reset recombination buffer 9617856c818Smatthias.ringwald conn->acl_recombination_length = 0; 9627856c818Smatthias.ringwald conn->acl_recombination_pos = 0; 9637856c818Smatthias.ringwald } 9647856c818Smatthias.ringwald break; 9657856c818Smatthias.ringwald 9667856c818Smatthias.ringwald case 0x02: { // first fragment 9677856c818Smatthias.ringwald 96823a77e1aS[email protected] // sanity check 96923a77e1aS[email protected] if (conn->acl_recombination_pos) { 97023a77e1aS[email protected] log_error( "ACL First Fragment but data in buffer for handle 0x%02x, dropping stale fragments", con_handle); 97123a77e1aS[email protected] conn->acl_recombination_pos = 0; 97223a77e1aS[email protected] } 97323a77e1aS[email protected] 9747856c818Smatthias.ringwald // peek into L2CAP packet! 9757856c818Smatthias.ringwald uint16_t l2cap_length = READ_L2CAP_LENGTH( packet ); 9767856c818Smatthias.ringwald 9777856c818Smatthias.ringwald // compare fragment size to L2CAP packet size 9784ea43905SMatthias Ringwald if (acl_length >= (l2cap_length + 4u)){ 9797856c818Smatthias.ringwald // forward fragment as L2CAP packet 9804ea43905SMatthias Ringwald hci_emit_acl_packet(packet, acl_length + 4u); 9817856c818Smatthias.ringwald } else { 9820ca847afS[email protected] 9830ca847afS[email protected] if (acl_length > HCI_ACL_BUFFER_SIZE){ 9840ca847afS[email protected] log_error( "ACL First Fragment to large: fragment %u > buffer size %u for handle 0x%02x", 9850ca847afS[email protected] 4 + acl_length, 4 + HCI_ACL_BUFFER_SIZE, con_handle); 9860ca847afS[email protected] return; 9870ca847afS[email protected] } 9880ca847afS[email protected] 9897856c818Smatthias.ringwald // store first fragment and tweak acl length for complete package 9906535961aSMatthias Ringwald (void)memcpy(&conn->acl_recombination_buffer[HCI_INCOMING_PRE_BUFFER_SIZE], 9914ea43905SMatthias Ringwald packet, acl_length + 4u); 9924ea43905SMatthias Ringwald conn->acl_recombination_pos = acl_length + 4u; 9937856c818Smatthias.ringwald conn->acl_recombination_length = l2cap_length; 9944ea43905SMatthias Ringwald little_endian_store_16(conn->acl_recombination_buffer, HCI_INCOMING_PRE_BUFFER_SIZE + 2u, l2cap_length +4u); 9957856c818Smatthias.ringwald } 9967856c818Smatthias.ringwald break; 9977856c818Smatthias.ringwald 9987856c818Smatthias.ringwald } 9997856c818Smatthias.ringwald default: 1000c3b46f5aSMatthias Ringwald log_error( "acl_handler called with invalid packet boundary flags %u", acl_flags & 0x03); 10017856c818Smatthias.ringwald return; 10027856c818Smatthias.ringwald } 100394ab26f8Smatthias.ringwald 100494ab26f8Smatthias.ringwald // execute main loop 100594ab26f8Smatthias.ringwald hci_run(); 100616833f0aSmatthias.ringwald } 100722909952Smatthias.ringwald 100867a3e8ecSmatthias.ringwald static void hci_shutdown_connection(hci_connection_t *conn){ 10099da54300S[email protected] log_info("Connection closed: handle 0x%x, %s", conn->con_handle, bd_addr_to_str(conn->address)); 10103c4d4b90Smatthias.ringwald 1011b3264428SMatthias Ringwald #ifdef ENABLE_CLASSIC 1012cb70c5abSMatthias Ringwald #if defined(ENABLE_SCO_OVER_HCI) || defined(HAVE_SCO_TRANSPORT) 1013cb70c5abSMatthias Ringwald bd_addr_type_t addr_type = conn->address_type; 1014cb70c5abSMatthias Ringwald #endif 1015cb70c5abSMatthias Ringwald #ifdef HAVE_SCO_TRANSPORT 1016cb70c5abSMatthias Ringwald hci_con_handle_t con_handle = conn->con_handle; 1017ee752bb8SMatthias Ringwald #endif 1018b3264428SMatthias Ringwald #endif 1019ee752bb8SMatthias Ringwald 1020528a4a3bSMatthias Ringwald btstack_run_loop_remove_timer(&conn->timeout); 1021c785ef68Smatthias.ringwald 1022665d90f2SMatthias Ringwald btstack_linked_list_remove(&hci_stack->connections, (btstack_linked_item_t *) conn); 1023a3b02b71Smatthias.ringwald btstack_memory_hci_connection_free( conn ); 10243c4d4b90Smatthias.ringwald 10253c4d4b90Smatthias.ringwald // now it's gone 1026c7e0c5f6Smatthias.ringwald hci_emit_nr_connections_changed(); 1027ee752bb8SMatthias Ringwald 1028b3264428SMatthias Ringwald #ifdef ENABLE_CLASSIC 1029034e9b53SMatthias Ringwald #ifdef ENABLE_SCO_OVER_HCI 1030ee752bb8SMatthias Ringwald // update SCO 1031cb70c5abSMatthias Ringwald if ((addr_type == BD_ADDR_TYPE_SCO) && (hci_stack->hci_transport != NULL) && (hci_stack->hci_transport->set_sco_config != NULL)){ 1032ee752bb8SMatthias Ringwald hci_stack->hci_transport->set_sco_config(hci_stack->sco_voice_setting_active, hci_number_sco_connections()); 1033ee752bb8SMatthias Ringwald } 1034034e9b53SMatthias Ringwald #endif 1035cb70c5abSMatthias Ringwald #ifdef HAVE_SCO_TRANSPORT 1036cb70c5abSMatthias Ringwald if ((addr_type == BD_ADDR_TYPE_SCO) && (hci_stack->sco_transport != NULL)){ 1037cb70c5abSMatthias Ringwald hci_stack->sco_transport->close(con_handle); 1038cb70c5abSMatthias Ringwald } 1039cb70c5abSMatthias Ringwald #endif 1040b3264428SMatthias Ringwald #endif 1041c7e0c5f6Smatthias.ringwald } 1042c7e0c5f6Smatthias.ringwald 104335454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 104435454696SMatthias Ringwald 10450c042179S[email protected] static const uint16_t packet_type_sizes[] = { 10468f8108aaSmatthias.ringwald 0, HCI_ACL_2DH1_SIZE, HCI_ACL_3DH1_SIZE, HCI_ACL_DM1_SIZE, 10478f8108aaSmatthias.ringwald HCI_ACL_DH1_SIZE, 0, 0, 0, 10488f8108aaSmatthias.ringwald HCI_ACL_2DH3_SIZE, HCI_ACL_3DH3_SIZE, HCI_ACL_DM3_SIZE, HCI_ACL_DH3_SIZE, 10498f8108aaSmatthias.ringwald HCI_ACL_2DH5_SIZE, HCI_ACL_3DH5_SIZE, HCI_ACL_DM5_SIZE, HCI_ACL_DH5_SIZE 10508f8108aaSmatthias.ringwald }; 105165389bfcS[email protected] static const uint8_t packet_type_feature_requirement_bit[] = { 105265389bfcS[email protected] 0, // 3 slot packets 105365389bfcS[email protected] 1, // 5 slot packets 105465389bfcS[email protected] 25, // EDR 2 mpbs 105565389bfcS[email protected] 26, // EDR 3 mbps 105665389bfcS[email protected] 39, // 3 slot EDR packts 105765389bfcS[email protected] 40, // 5 slot EDR packet 105865389bfcS[email protected] }; 105965389bfcS[email protected] static const uint16_t packet_type_feature_packet_mask[] = { 106065389bfcS[email protected] 0x0f00, // 3 slot packets 106165389bfcS[email protected] 0xf000, // 5 slot packets 106265389bfcS[email protected] 0x1102, // EDR 2 mpbs 106365389bfcS[email protected] 0x2204, // EDR 3 mbps 106465389bfcS[email protected] 0x0300, // 3 slot EDR packts 106565389bfcS[email protected] 0x3000, // 5 slot EDR packet 106665389bfcS[email protected] }; 10678f8108aaSmatthias.ringwald 106865389bfcS[email protected] static uint16_t hci_acl_packet_types_for_buffer_size_and_local_features(uint16_t buffer_size, uint8_t * local_supported_features){ 106965389bfcS[email protected] // enable packet types based on size 10708f8108aaSmatthias.ringwald uint16_t packet_types = 0; 1071f16a69bbS[email protected] unsigned int i; 10728f8108aaSmatthias.ringwald for (i=0;i<16;i++){ 10738f8108aaSmatthias.ringwald if (packet_type_sizes[i] == 0) continue; 10748f8108aaSmatthias.ringwald if (packet_type_sizes[i] <= buffer_size){ 10758f8108aaSmatthias.ringwald packet_types |= 1 << i; 10768f8108aaSmatthias.ringwald } 10778f8108aaSmatthias.ringwald } 107865389bfcS[email protected] // disable packet types due to missing local supported features 107965389bfcS[email protected] for (i=0;i<sizeof(packet_type_feature_requirement_bit);i++){ 1080f04a0c31SMatthias Ringwald unsigned int bit_idx = packet_type_feature_requirement_bit[i]; 108165389bfcS[email protected] int feature_set = (local_supported_features[bit_idx >> 3] & (1<<(bit_idx & 7))) != 0; 108265389bfcS[email protected] if (feature_set) continue; 108365389bfcS[email protected] log_info("Features bit %02u is not set, removing packet types 0x%04x", bit_idx, packet_type_feature_packet_mask[i]); 108465389bfcS[email protected] packet_types &= ~packet_type_feature_packet_mask[i]; 108565389bfcS[email protected] } 10868f8108aaSmatthias.ringwald // flip bits for "may not be used" 10878f8108aaSmatthias.ringwald packet_types ^= 0x3306; 10888f8108aaSmatthias.ringwald return packet_types; 10898f8108aaSmatthias.ringwald } 10908f8108aaSmatthias.ringwald 10918f8108aaSmatthias.ringwald uint16_t hci_usable_acl_packet_types(void){ 10923a9fb326S[email protected] return hci_stack->packet_types; 10938f8108aaSmatthias.ringwald } 109435454696SMatthias Ringwald #endif 10958f8108aaSmatthias.ringwald 1096facf93fdS[email protected] uint8_t* hci_get_outgoing_packet_buffer(void){ 10977dc17943Smatthias.ringwald // hci packet buffer is >= acl data packet length 10983a9fb326S[email protected] return hci_stack->hci_packet_buffer; 10997dc17943Smatthias.ringwald } 11007dc17943Smatthias.ringwald 1101f5d8d141S[email protected] uint16_t hci_max_acl_data_packet_length(void){ 11023a9fb326S[email protected] return hci_stack->acl_data_packet_length; 11037dc17943Smatthias.ringwald } 11047dc17943Smatthias.ringwald 110506b9e820SMatthias Ringwald #ifdef ENABLE_CLASSIC 110620dcdd22SMatthias Ringwald bool hci_extended_sco_link_supported(void){ 11073e68d23dSMatthias Ringwald // No. 31, byte 3, bit 7 11083e68d23dSMatthias Ringwald return (hci_stack->local_supported_features[3] & (1 << 7)) != 0; 11093e68d23dSMatthias Ringwald } 111006b9e820SMatthias Ringwald #endif 11113e68d23dSMatthias Ringwald 111220dcdd22SMatthias Ringwald bool hci_non_flushable_packet_boundary_flag_supported(void){ 11136ac9a97eS[email protected] // No. 54, byte 6, bit 6 11144ea43905SMatthias Ringwald return (hci_stack->local_supported_features[6u] & (1u << 6u)) != 0u; 11156ac9a97eS[email protected] } 11166ac9a97eS[email protected] 111715a95bd5SMatthias Ringwald static int gap_ssp_supported(void){ 11186ac9a97eS[email protected] // No. 51, byte 6, bit 3 11194ea43905SMatthias Ringwald return (hci_stack->local_supported_features[6u] & (1u << 3u)) != 0u; 1120f5d8d141S[email protected] } 1121f5d8d141S[email protected] 11227f02f414SMatthias Ringwald static int hci_classic_supported(void){ 112335454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 11246ac9a97eS[email protected] // No. 37, byte 4, bit 5, = No BR/EDR Support 11253a9fb326S[email protected] return (hci_stack->local_supported_features[4] & (1 << 5)) == 0; 112635454696SMatthias Ringwald #else 112735454696SMatthias Ringwald return 0; 112835454696SMatthias Ringwald #endif 1129f5d8d141S[email protected] } 1130f5d8d141S[email protected] 11317f02f414SMatthias Ringwald static int hci_le_supported(void){ 1132a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE 11336ac9a97eS[email protected] // No. 37, byte 4, bit 6 = LE Supported (Controller) 11344ea43905SMatthias Ringwald return (hci_stack->local_supported_features[4u] & (1u << 6u)) != 0u; 1135f5d8d141S[email protected] #else 1136f5d8d141S[email protected] return 0; 1137f5d8d141S[email protected] #endif 1138f5d8d141S[email protected] } 1139f5d8d141S[email protected] 1140b95a5a35SMatthias Ringwald #ifdef ENABLE_BLE 1141b95a5a35SMatthias Ringwald 1142f5873674SMatthias Ringwald static void hci_get_own_address_for_addr_type(uint8_t own_addr_type, bd_addr_t own_addr){ 11436bcfa632SMatthias Ringwald if (own_addr_type == BD_ADDR_TYPE_LE_PUBLIC){ 11446bcfa632SMatthias Ringwald (void)memcpy(own_addr, hci_stack->local_bd_addr, 6); 114569a97523S[email protected] } else { 11466bcfa632SMatthias Ringwald (void)memcpy(own_addr, hci_stack->le_random_address, 6); 114769a97523S[email protected] } 114869a97523S[email protected] } 114969a97523S[email protected] 11506bcfa632SMatthias Ringwald void gap_le_get_own_address(uint8_t * addr_type, bd_addr_t addr){ 11516bcfa632SMatthias Ringwald *addr_type = hci_stack->le_own_addr_type; 11526bcfa632SMatthias Ringwald hci_get_own_address_for_addr_type(hci_stack->le_own_addr_type, addr); 11536bcfa632SMatthias Ringwald } 11546bcfa632SMatthias Ringwald 11556bcfa632SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 11566bcfa632SMatthias Ringwald void gap_le_get_own_advertisements_address(uint8_t * addr_type, bd_addr_t addr){ 11576bcfa632SMatthias Ringwald *addr_type = hci_stack->le_advertisements_own_addr_type; 11586bcfa632SMatthias Ringwald hci_get_own_address_for_addr_type(hci_stack->le_advertisements_own_addr_type, addr); 11596bcfa632SMatthias Ringwald }; 11606bcfa632SMatthias Ringwald #endif 11616bcfa632SMatthias Ringwald 1162e8c8828eSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 11636bcfa632SMatthias Ringwald 11646bcfa632SMatthias Ringwald /** 11656bcfa632SMatthias Ringwald * @brief Get own addr type and address used for LE connections (Central) 11666bcfa632SMatthias Ringwald */ 11676bcfa632SMatthias Ringwald void gap_le_get_own_connection_address(uint8_t * addr_type, bd_addr_t addr){ 11686bcfa632SMatthias Ringwald *addr_type = hci_stack->le_connection_own_addr_type; 11696bcfa632SMatthias Ringwald hci_get_own_address_for_addr_type(hci_stack->le_connection_own_addr_type, addr); 11706bcfa632SMatthias Ringwald } 11716bcfa632SMatthias Ringwald 1172384b59deSMatthias Ringwald void le_handle_advertisement_report(uint8_t *packet, uint16_t size){ 11739ec2630cSMatthias Ringwald 1174d1dc057bS[email protected] int offset = 3; 1175d1dc057bS[email protected] int num_reports = packet[offset]; 1176d1dc057bS[email protected] offset += 1; 1177d1dc057bS[email protected] 117857c9da5bS[email protected] int i; 11794f4e0224SMatthias Ringwald // log_info("HCI: handle adv report with num reports: %d", num_reports); 118003fbe9c6S[email protected] uint8_t event[12 + LE_ADVERTISING_DATA_SIZE]; // use upper bound to avoid var size automatic var 1181a1df452eSMatthias Ringwald for (i=0; (i<num_reports) && (offset < size);i++){ 118233e6948bSMatthias Ringwald // sanity checks on data_length: 118333e6948bSMatthias Ringwald uint8_t data_length = packet[offset + 8]; 118433e6948bSMatthias Ringwald if (data_length > LE_ADVERTISING_DATA_SIZE) return; 11854ea43905SMatthias Ringwald if ((offset + 9u + data_length + 1u) > size) return; 118633e6948bSMatthias Ringwald // setup event 11874ea43905SMatthias Ringwald uint8_t event_size = 10u + data_length; 1188d1dc057bS[email protected] int pos = 0; 1189045013feSMatthias Ringwald event[pos++] = GAP_EVENT_ADVERTISING_REPORT; 119057c9da5bS[email protected] event[pos++] = event_size; 11916535961aSMatthias Ringwald (void)memcpy(&event[pos], &packet[offset], 1 + 1 + 6); // event type + address type + address 1192d1dc057bS[email protected] offset += 8; 1193d1dc057bS[email protected] pos += 8; 1194d1dc057bS[email protected] event[pos++] = packet[offset + 1 + data_length]; // rssi 119533e6948bSMatthias Ringwald event[pos++] = data_length; 119633e6948bSMatthias Ringwald offset++; 11976535961aSMatthias Ringwald (void)memcpy(&event[pos], &packet[offset], data_length); 119857c9da5bS[email protected] pos += data_length; 11994ea43905SMatthias Ringwald offset += data_length + 1u; // rssi 1200d6b06661SMatthias Ringwald hci_emit_event(event, pos, 1); 120157c9da5bS[email protected] } 120257c9da5bS[email protected] } 1203b2f949feS[email protected] #endif 1204e8c8828eSMatthias Ringwald #endif 120557c9da5bS[email protected] 12062b6ab3e6SMatthias Ringwald #ifdef ENABLE_BLE 12072b6ab3e6SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 1208bbc366e6SMatthias Ringwald static void hci_update_advertisements_enabled_for_current_roles(void){ 1209bbc366e6SMatthias Ringwald if (hci_stack->le_advertisements_enabled){ 12102b6ab3e6SMatthias Ringwald // get number of active le slave connections 12112b6ab3e6SMatthias Ringwald int num_slave_connections = 0; 12122b6ab3e6SMatthias Ringwald btstack_linked_list_iterator_t it; 12132b6ab3e6SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->connections); 12142b6ab3e6SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 12152b6ab3e6SMatthias Ringwald hci_connection_t * con = (hci_connection_t*) btstack_linked_list_iterator_next(&it); 12162b6ab3e6SMatthias Ringwald log_info("state %u, role %u, le_con %u", con->state, con->role, hci_is_le_connection(con)); 12172b6ab3e6SMatthias Ringwald if (con->state != OPEN) continue; 12182b6ab3e6SMatthias Ringwald if (con->role != HCI_ROLE_SLAVE) continue; 12192b6ab3e6SMatthias Ringwald if (!hci_is_le_connection(con)) continue; 12202b6ab3e6SMatthias Ringwald num_slave_connections++; 12212b6ab3e6SMatthias Ringwald } 12222b6ab3e6SMatthias Ringwald log_info("Num LE Peripheral roles: %u of %u", num_slave_connections, hci_stack->le_max_number_peripheral_connections); 1223bbc366e6SMatthias Ringwald hci_stack->le_advertisements_enabled_for_current_roles = num_slave_connections < hci_stack->le_max_number_peripheral_connections; 1224bbc366e6SMatthias Ringwald } else { 1225bbc366e6SMatthias Ringwald hci_stack->le_advertisements_enabled_for_current_roles = false; 12262b6ab3e6SMatthias Ringwald } 12272b6ab3e6SMatthias Ringwald } 12282b6ab3e6SMatthias Ringwald #endif 12292b6ab3e6SMatthias Ringwald #endif 12302b6ab3e6SMatthias Ringwald 123159d59ecfSMatthias Ringwald #ifdef ENABLE_CLASSIC 123259d59ecfSMatthias Ringwald static void gap_run_set_local_name(void){ 123359d59ecfSMatthias Ringwald hci_reserve_packet_buffer(); 123459d59ecfSMatthias Ringwald uint8_t * packet = hci_stack->hci_packet_buffer; 123559d59ecfSMatthias Ringwald // construct HCI Command and send 123659d59ecfSMatthias Ringwald uint16_t opcode = hci_write_local_name.opcode; 123759d59ecfSMatthias Ringwald hci_stack->last_cmd_opcode = opcode; 123859d59ecfSMatthias Ringwald packet[0] = opcode & 0xff; 123959d59ecfSMatthias Ringwald packet[1] = opcode >> 8; 124059d59ecfSMatthias Ringwald packet[2] = DEVICE_NAME_LEN; 124159d59ecfSMatthias Ringwald memset(&packet[3], 0, DEVICE_NAME_LEN); 124259d59ecfSMatthias Ringwald uint16_t name_len = (uint16_t) strlen(hci_stack->local_name); 124359d59ecfSMatthias Ringwald uint16_t bytes_to_copy = btstack_min(name_len, DEVICE_NAME_LEN); 124459d59ecfSMatthias Ringwald // if shorter than DEVICE_NAME_LEN, it's implicitly NULL-terminated by memset call 124559d59ecfSMatthias Ringwald (void)memcpy(&packet[3], hci_stack->local_name, bytes_to_copy); 124659d59ecfSMatthias Ringwald // expand '00:00:00:00:00:00' in name with bd_addr 124759d59ecfSMatthias Ringwald btstack_replace_bd_addr_placeholder(&packet[3], bytes_to_copy, hci_stack->local_bd_addr); 124859d59ecfSMatthias Ringwald hci_send_cmd_packet(packet, HCI_CMD_HEADER_SIZE + DEVICE_NAME_LEN); 124959d59ecfSMatthias Ringwald } 125059d59ecfSMatthias Ringwald 125159d59ecfSMatthias Ringwald static void gap_run_set_eir_data(void){ 125259d59ecfSMatthias Ringwald hci_reserve_packet_buffer(); 125359d59ecfSMatthias Ringwald uint8_t * packet = hci_stack->hci_packet_buffer; 125459d59ecfSMatthias Ringwald // construct HCI Command in-place and send 125559d59ecfSMatthias Ringwald uint16_t opcode = hci_write_extended_inquiry_response.opcode; 125659d59ecfSMatthias Ringwald hci_stack->last_cmd_opcode = opcode; 125759d59ecfSMatthias Ringwald uint16_t offset = 0; 125859d59ecfSMatthias Ringwald packet[offset++] = opcode & 0xff; 125959d59ecfSMatthias Ringwald packet[offset++] = opcode >> 8; 126059d59ecfSMatthias Ringwald packet[offset++] = 1 + EXTENDED_INQUIRY_RESPONSE_DATA_LEN; 126159d59ecfSMatthias Ringwald packet[offset++] = 0; // FEC not required 126259d59ecfSMatthias Ringwald memset(&packet[offset], 0, EXTENDED_INQUIRY_RESPONSE_DATA_LEN); 126359d59ecfSMatthias Ringwald if (hci_stack->eir_data){ 126459d59ecfSMatthias Ringwald // copy items and expand '00:00:00:00:00:00' in name with bd_addr 126559d59ecfSMatthias Ringwald ad_context_t context; 126659d59ecfSMatthias Ringwald for (ad_iterator_init(&context, EXTENDED_INQUIRY_RESPONSE_DATA_LEN, hci_stack->eir_data) ; ad_iterator_has_more(&context) ; ad_iterator_next(&context)) { 126759d59ecfSMatthias Ringwald uint8_t data_type = ad_iterator_get_data_type(&context); 126859d59ecfSMatthias Ringwald uint8_t size = ad_iterator_get_data_len(&context); 126959d59ecfSMatthias Ringwald const uint8_t *data = ad_iterator_get_data(&context); 127059d59ecfSMatthias Ringwald // copy item 127159d59ecfSMatthias Ringwald packet[offset++] = size + 1; 127259d59ecfSMatthias Ringwald packet[offset++] = data_type; 127359d59ecfSMatthias Ringwald memcpy(&packet[offset], data, size); 127459d59ecfSMatthias Ringwald // update name item 127559d59ecfSMatthias Ringwald if ((data_type == BLUETOOTH_DATA_TYPE_SHORTENED_LOCAL_NAME) || (data_type == BLUETOOTH_DATA_TYPE_COMPLETE_LOCAL_NAME)){ 127659d59ecfSMatthias Ringwald btstack_replace_bd_addr_placeholder(&packet[offset], size, hci_stack->local_bd_addr); 127759d59ecfSMatthias Ringwald } 127859d59ecfSMatthias Ringwald offset += size; 127959d59ecfSMatthias Ringwald } 128059d59ecfSMatthias Ringwald } else { 128159d59ecfSMatthias Ringwald uint16_t name_len = (uint16_t) strlen(hci_stack->local_name); 128259d59ecfSMatthias Ringwald uint16_t bytes_to_copy = btstack_min(name_len, EXTENDED_INQUIRY_RESPONSE_DATA_LEN - 2); 128359d59ecfSMatthias Ringwald packet[offset++] = bytes_to_copy + 1; 128459d59ecfSMatthias Ringwald packet[offset++] = BLUETOOTH_DATA_TYPE_COMPLETE_LOCAL_NAME; 128559d59ecfSMatthias Ringwald (void)memcpy(&packet[6], hci_stack->local_name, bytes_to_copy); 128659d59ecfSMatthias Ringwald // expand '00:00:00:00:00:00' in name with bd_addr 128759d59ecfSMatthias Ringwald btstack_replace_bd_addr_placeholder(&packet[offset], bytes_to_copy, hci_stack->local_bd_addr); 128859d59ecfSMatthias Ringwald } 128959d59ecfSMatthias Ringwald hci_send_cmd_packet(packet, HCI_CMD_HEADER_SIZE + 1 + EXTENDED_INQUIRY_RESPONSE_DATA_LEN); 129059d59ecfSMatthias Ringwald } 129159d59ecfSMatthias Ringwald #endif 129259d59ecfSMatthias Ringwald 1293cd77dd38SMatthias Ringwald #if !defined(HAVE_PLATFORM_IPHONE_OS) && !defined (HAVE_HOST_CONTROLLER_API) 129406b9e820SMatthias Ringwald 129596b53536SMatthias Ringwald static uint32_t hci_transport_uart_get_main_baud_rate(void){ 129696b53536SMatthias Ringwald if (!hci_stack->config) return 0; 12979796ebeaSMatthias Ringwald uint32_t baud_rate = ((hci_transport_config_uart_t *)hci_stack->config)->baudrate_main; 129896b53536SMatthias Ringwald // Limit baud rate for Broadcom chipsets to 3 mbps 1299a1df452eSMatthias Ringwald if ((hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_BROADCOM_CORPORATION) && (baud_rate > 3000000)){ 130096b53536SMatthias Ringwald baud_rate = 3000000; 130196b53536SMatthias Ringwald } 130296b53536SMatthias Ringwald return baud_rate; 130396b53536SMatthias Ringwald } 130496b53536SMatthias Ringwald 1305ec820d77SMatthias Ringwald static void hci_initialization_timeout_handler(btstack_timer_source_t * ds){ 13069ec2630cSMatthias Ringwald UNUSED(ds); 13079ec2630cSMatthias Ringwald 13080305bdeaSMatthias Ringwald switch (hci_stack->substate){ 13090305bdeaSMatthias Ringwald case HCI_INIT_W4_SEND_RESET: 13107b0d7667SMatthias Ringwald log_info("Resend HCI Reset"); 13110305bdeaSMatthias Ringwald hci_stack->substate = HCI_INIT_SEND_RESET; 13127b0d7667SMatthias Ringwald hci_stack->num_cmd_packets = 1; 13130305bdeaSMatthias Ringwald hci_run(); 13140305bdeaSMatthias Ringwald break; 13159f007422SMatthias Ringwald case HCI_INIT_W4_CUSTOM_INIT_CSR_WARM_BOOT_LINK_RESET: 13169f007422SMatthias Ringwald log_info("Resend HCI Reset - CSR Warm Boot with Link Reset"); 13179f007422SMatthias Ringwald if (hci_stack->hci_transport->reset_link){ 13189f007422SMatthias Ringwald hci_stack->hci_transport->reset_link(); 13199f007422SMatthias Ringwald } 1320cf373d3aSMatthias Ringwald 1321cf373d3aSMatthias Ringwald /* fall through */ 1322cf373d3aSMatthias Ringwald 1323e47e68c7SMatthias Ringwald case HCI_INIT_W4_CUSTOM_INIT_CSR_WARM_BOOT: 1324e47e68c7SMatthias Ringwald log_info("Resend HCI Reset - CSR Warm Boot"); 1325e47e68c7SMatthias Ringwald hci_stack->substate = HCI_INIT_SEND_RESET_CSR_WARM_BOOT; 1326e47e68c7SMatthias Ringwald hci_stack->num_cmd_packets = 1; 1327e47e68c7SMatthias Ringwald hci_run(); 1328688c2635SMatthias Ringwald break; 13297224be7eSMatthias Ringwald case HCI_INIT_W4_SEND_BAUD_CHANGE: 13307224be7eSMatthias Ringwald if (hci_stack->hci_transport->set_baudrate){ 133196b53536SMatthias Ringwald uint32_t baud_rate = hci_transport_uart_get_main_baud_rate(); 1332cd724cb7SMatthias Ringwald log_info("Local baud rate change to %" PRIu32 "(timeout handler)", baud_rate); 13337dd9d0ecSMatthias Ringwald hci_stack->hci_transport->set_baudrate(baud_rate); 13347224be7eSMatthias Ringwald } 1335834bce8cSMatthias Ringwald // For CSR, HCI Reset is sent on new baud rate. Don't forget to reset link for H5/BCSP 133661f37892SMatthias Ringwald if (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_CAMBRIDGE_SILICON_RADIO){ 1337834bce8cSMatthias Ringwald if (hci_stack->hci_transport->reset_link){ 1338834bce8cSMatthias Ringwald log_info("Link Reset"); 1339834bce8cSMatthias Ringwald hci_stack->hci_transport->reset_link(); 1340834bce8cSMatthias Ringwald } 1341772a36d3SMatthias Ringwald hci_stack->substate = HCI_INIT_SEND_RESET_CSR_WARM_BOOT; 1342772a36d3SMatthias Ringwald hci_run(); 1343772a36d3SMatthias Ringwald } 13444696bddbSMatthias Ringwald break; 1345559961d0SMatthias Ringwald case HCI_INIT_W4_CUSTOM_INIT_BCM_DELAY: 1346559961d0SMatthias Ringwald // otherwise continue 1347559961d0SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_READ_LOCAL_SUPPORTED_COMMANDS; 1348559961d0SMatthias Ringwald hci_send_cmd(&hci_read_local_supported_commands); 1349559961d0SMatthias Ringwald break; 13500305bdeaSMatthias Ringwald default: 13510305bdeaSMatthias Ringwald break; 13520305bdeaSMatthias Ringwald } 13530305bdeaSMatthias Ringwald } 135406b9e820SMatthias Ringwald #endif 13550305bdeaSMatthias Ringwald 135671de195eSMatthias Ringwald static void hci_initializing_next_state(void){ 135774b323a9SMatthias Ringwald hci_stack->substate = (hci_substate_t )( ((int) hci_stack->substate) + 1); 135874b323a9SMatthias Ringwald } 135974b323a9SMatthias Ringwald 136074b323a9SMatthias Ringwald // assumption: hci_can_send_command_packet_now() == true 136171de195eSMatthias Ringwald static void hci_initializing_run(void){ 1362148ca237SMatthias Ringwald log_debug("hci_initializing_run: substate %u, can send %u", hci_stack->substate, hci_can_send_command_packet_now()); 136374b323a9SMatthias Ringwald switch (hci_stack->substate){ 136474b323a9SMatthias Ringwald case HCI_INIT_SEND_RESET: 136574b323a9SMatthias Ringwald hci_state_reset(); 1366a0cf2f3fSMatthias Ringwald 136706b9e820SMatthias Ringwald #if !defined(HAVE_PLATFORM_IPHONE_OS) && !defined (HAVE_HOST_CONTROLLER_API) 13680305bdeaSMatthias Ringwald // prepare reset if command complete not received in 100ms 1369659d758cSMatthias Ringwald btstack_run_loop_set_timer(&hci_stack->timeout, HCI_RESET_RESEND_TIMEOUT_MS); 1370528a4a3bSMatthias Ringwald btstack_run_loop_set_timer_handler(&hci_stack->timeout, hci_initialization_timeout_handler); 1371528a4a3bSMatthias Ringwald btstack_run_loop_add_timer(&hci_stack->timeout); 1372a0cf2f3fSMatthias Ringwald #endif 13730305bdeaSMatthias Ringwald // send command 137474b323a9SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_SEND_RESET; 13750305bdeaSMatthias Ringwald hci_send_cmd(&hci_reset); 137674b323a9SMatthias Ringwald break; 137776fcb19bSMatthias Ringwald case HCI_INIT_SEND_READ_LOCAL_VERSION_INFORMATION: 137876fcb19bSMatthias Ringwald hci_send_cmd(&hci_read_local_version_information); 137976fcb19bSMatthias Ringwald hci_stack->substate = HCI_INIT_W4_SEND_READ_LOCAL_VERSION_INFORMATION; 138076fcb19bSMatthias Ringwald break; 1381e90bae01SMatthias Ringwald case HCI_INIT_SEND_READ_LOCAL_NAME: 1382e90bae01SMatthias Ringwald hci_send_cmd(&hci_read_local_name); 1383e90bae01SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_SEND_READ_LOCAL_NAME; 1384e90bae01SMatthias Ringwald break; 138506b9e820SMatthias Ringwald 138606b9e820SMatthias Ringwald #if !defined(HAVE_PLATFORM_IPHONE_OS) && !defined (HAVE_HOST_CONTROLLER_API) 1387e47e68c7SMatthias Ringwald case HCI_INIT_SEND_RESET_CSR_WARM_BOOT: 1388e47e68c7SMatthias Ringwald hci_state_reset(); 1389e47e68c7SMatthias Ringwald // prepare reset if command complete not received in 100ms 1390659d758cSMatthias Ringwald btstack_run_loop_set_timer(&hci_stack->timeout, HCI_RESET_RESEND_TIMEOUT_MS); 1391528a4a3bSMatthias Ringwald btstack_run_loop_set_timer_handler(&hci_stack->timeout, hci_initialization_timeout_handler); 1392528a4a3bSMatthias Ringwald btstack_run_loop_add_timer(&hci_stack->timeout); 1393e47e68c7SMatthias Ringwald // send command 1394e47e68c7SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_CUSTOM_INIT_CSR_WARM_BOOT; 1395e47e68c7SMatthias Ringwald hci_send_cmd(&hci_reset); 1396e47e68c7SMatthias Ringwald break; 13978d29070eSMatthias Ringwald case HCI_INIT_SEND_RESET_ST_WARM_BOOT: 13988d29070eSMatthias Ringwald hci_state_reset(); 13998d29070eSMatthias Ringwald hci_stack->substate = HCI_INIT_W4_SEND_RESET_ST_WARM_BOOT; 14008d29070eSMatthias Ringwald hci_send_cmd(&hci_reset); 14018d29070eSMatthias Ringwald break; 1402fab26ab3SMatthias Ringwald case HCI_INIT_SEND_BAUD_CHANGE: { 140396b53536SMatthias Ringwald uint32_t baud_rate = hci_transport_uart_get_main_baud_rate(); 14043fb36a29SMatthias Ringwald hci_stack->chipset->set_baudrate_command(baud_rate, hci_stack->hci_packet_buffer); 1405f8fbdce0SMatthias Ringwald hci_stack->last_cmd_opcode = little_endian_read_16(hci_stack->hci_packet_buffer, 0); 140674b323a9SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_SEND_BAUD_CHANGE; 14074ea43905SMatthias Ringwald hci_send_cmd_packet(hci_stack->hci_packet_buffer, 3u + hci_stack->hci_packet_buffer[2u]); 14084696bddbSMatthias Ringwald // STLC25000D: baudrate change happens within 0.5 s after command was send, 14094696bddbSMatthias Ringwald // use timer to update baud rate after 100 ms (knowing exactly, when command was sent is non-trivial) 141061f37892SMatthias Ringwald if (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_ST_MICROELECTRONICS){ 1411659d758cSMatthias Ringwald btstack_run_loop_set_timer(&hci_stack->timeout, HCI_RESET_RESEND_TIMEOUT_MS); 1412528a4a3bSMatthias Ringwald btstack_run_loop_add_timer(&hci_stack->timeout); 14134696bddbSMatthias Ringwald } 141474b323a9SMatthias Ringwald break; 1415fab26ab3SMatthias Ringwald } 1416fab26ab3SMatthias Ringwald case HCI_INIT_SEND_BAUD_CHANGE_BCM: { 141796b53536SMatthias Ringwald uint32_t baud_rate = hci_transport_uart_get_main_baud_rate(); 14183fb36a29SMatthias Ringwald hci_stack->chipset->set_baudrate_command(baud_rate, hci_stack->hci_packet_buffer); 1419f8fbdce0SMatthias Ringwald hci_stack->last_cmd_opcode = little_endian_read_16(hci_stack->hci_packet_buffer, 0); 1420eb3a5314SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_SEND_BAUD_CHANGE_BCM; 14214ea43905SMatthias Ringwald hci_send_cmd_packet(hci_stack->hci_packet_buffer, 3u + hci_stack->hci_packet_buffer[2u]); 1422eb3a5314SMatthias Ringwald break; 1423fab26ab3SMatthias Ringwald } 142474b323a9SMatthias Ringwald case HCI_INIT_CUSTOM_INIT: 142574b323a9SMatthias Ringwald // Custom initialization 14263fb36a29SMatthias Ringwald if (hci_stack->chipset && hci_stack->chipset->next_command){ 1427ae334e9eSMatthias Ringwald hci_stack->chipset_result = (*hci_stack->chipset->next_command)(hci_stack->hci_packet_buffer); 14281979f09cSMatthias Ringwald bool send_cmd = false; 1429ae334e9eSMatthias Ringwald switch (hci_stack->chipset_result){ 1430f41911edSMatthias Ringwald case BTSTACK_CHIPSET_VALID_COMMAND: 14311979f09cSMatthias Ringwald send_cmd = true; 1432e47e68c7SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_CUSTOM_INIT; 1433e47e68c7SMatthias Ringwald break; 1434f41911edSMatthias Ringwald case BTSTACK_CHIPSET_WARMSTART_REQUIRED: 14351979f09cSMatthias Ringwald send_cmd = true; 1436f41911edSMatthias Ringwald // CSR Warm Boot: Wait a bit, then send HCI Reset until HCI Command Complete 1437e47e68c7SMatthias Ringwald log_info("CSR Warm Boot"); 1438659d758cSMatthias Ringwald btstack_run_loop_set_timer(&hci_stack->timeout, HCI_RESET_RESEND_TIMEOUT_MS); 1439528a4a3bSMatthias Ringwald btstack_run_loop_set_timer_handler(&hci_stack->timeout, hci_initialization_timeout_handler); 1440528a4a3bSMatthias Ringwald btstack_run_loop_add_timer(&hci_stack->timeout); 1441a1df452eSMatthias Ringwald if ((hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_CAMBRIDGE_SILICON_RADIO) 1442772a36d3SMatthias Ringwald && hci_stack->config 14433fb36a29SMatthias Ringwald && hci_stack->chipset 14443fb36a29SMatthias Ringwald // && hci_stack->chipset->set_baudrate_command -- there's no such command 1445772a36d3SMatthias Ringwald && hci_stack->hci_transport->set_baudrate 14462caefae9SMatthias Ringwald && hci_transport_uart_get_main_baud_rate()){ 1447772a36d3SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_SEND_BAUD_CHANGE; 1448772a36d3SMatthias Ringwald } else { 14499f007422SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_CUSTOM_INIT_CSR_WARM_BOOT_LINK_RESET; 1450772a36d3SMatthias Ringwald } 1451e47e68c7SMatthias Ringwald break; 1452f41911edSMatthias Ringwald default: 1453f41911edSMatthias Ringwald break; 1454e47e68c7SMatthias Ringwald } 1455ee720f3aSMatthias Ringwald 1456ee720f3aSMatthias Ringwald if (send_cmd){ 14574ea43905SMatthias Ringwald int size = 3u + hci_stack->hci_packet_buffer[2u]; 1458ee720f3aSMatthias Ringwald hci_stack->last_cmd_opcode = little_endian_read_16(hci_stack->hci_packet_buffer, 0); 1459ee720f3aSMatthias Ringwald hci_dump_packet(HCI_COMMAND_DATA_PACKET, 0, hci_stack->hci_packet_buffer, size); 14600305bdeaSMatthias Ringwald hci_stack->hci_transport->send_packet(HCI_COMMAND_DATA_PACKET, hci_stack->hci_packet_buffer, size); 146174b323a9SMatthias Ringwald break; 146274b323a9SMatthias Ringwald } 1463148ca237SMatthias Ringwald log_info("Init script done"); 146492a0d36dSMatthias Ringwald 1465559961d0SMatthias Ringwald // Init script download on Broadcom chipsets causes: 1466ae334e9eSMatthias Ringwald if ( (hci_stack->chipset_result != BTSTACK_CHIPSET_NO_INIT_SCRIPT) && 1467a1df452eSMatthias Ringwald ( (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_BROADCOM_CORPORATION) 1468a1df452eSMatthias Ringwald || (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_EM_MICROELECTRONIC_MARIN_SA)) ){ 1469e021ff1eSMatthias Ringwald 1470559961d0SMatthias Ringwald // - baud rate to reset, restore UART baud rate if needed 147192a0d36dSMatthias Ringwald int need_baud_change = hci_stack->config 14723fb36a29SMatthias Ringwald && hci_stack->chipset 14733fb36a29SMatthias Ringwald && hci_stack->chipset->set_baudrate_command 147492a0d36dSMatthias Ringwald && hci_stack->hci_transport->set_baudrate 14759796ebeaSMatthias Ringwald && ((hci_transport_config_uart_t *)hci_stack->config)->baudrate_main; 147692a0d36dSMatthias Ringwald if (need_baud_change) { 14779796ebeaSMatthias Ringwald uint32_t baud_rate = ((hci_transport_config_uart_t *)hci_stack->config)->baudrate_init; 1478cd724cb7SMatthias Ringwald log_info("Local baud rate change to %" PRIu32 " after init script (bcm)", baud_rate); 147992a0d36dSMatthias Ringwald hci_stack->hci_transport->set_baudrate(baud_rate); 148092a0d36dSMatthias Ringwald } 1481559961d0SMatthias Ringwald 1482f19b3c9eSMatthias Ringwald uint16_t bcm_delay_ms = 300; 1483f19b3c9eSMatthias Ringwald // - UART may or may not be disabled during update and Controller RTS may or may not be high during this time 1484f19b3c9eSMatthias Ringwald // -> Work around: wait here. 1485f19b3c9eSMatthias Ringwald log_info("BCM delay (%u ms) after init script", bcm_delay_ms); 1486559961d0SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_CUSTOM_INIT_BCM_DELAY; 1487f19b3c9eSMatthias Ringwald btstack_run_loop_set_timer(&hci_stack->timeout, bcm_delay_ms); 1488559961d0SMatthias Ringwald btstack_run_loop_set_timer_handler(&hci_stack->timeout, hci_initialization_timeout_handler); 1489559961d0SMatthias Ringwald btstack_run_loop_add_timer(&hci_stack->timeout); 1490559961d0SMatthias Ringwald break; 149192a0d36dSMatthias Ringwald } 149274b323a9SMatthias Ringwald } 149374b323a9SMatthias Ringwald // otherwise continue 1494a828a756SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_READ_LOCAL_SUPPORTED_COMMANDS; 1495a828a756SMatthias Ringwald hci_send_cmd(&hci_read_local_supported_commands); 1496a828a756SMatthias Ringwald break; 149753860077SMatthias Ringwald case HCI_INIT_SET_BD_ADDR: 149853860077SMatthias Ringwald log_info("Set Public BD ADDR to %s", bd_addr_to_str(hci_stack->custom_bd_addr)); 14993fb36a29SMatthias Ringwald hci_stack->chipset->set_bd_addr_command(hci_stack->custom_bd_addr, hci_stack->hci_packet_buffer); 1500f8fbdce0SMatthias Ringwald hci_stack->last_cmd_opcode = little_endian_read_16(hci_stack->hci_packet_buffer, 0); 150153860077SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_SET_BD_ADDR; 15024ea43905SMatthias Ringwald hci_send_cmd_packet(hci_stack->hci_packet_buffer, 3u + hci_stack->hci_packet_buffer[2u]); 150353860077SMatthias Ringwald break; 150406b9e820SMatthias Ringwald #endif 150506b9e820SMatthias Ringwald 150606b9e820SMatthias Ringwald case HCI_INIT_READ_LOCAL_SUPPORTED_COMMANDS: 150706b9e820SMatthias Ringwald log_info("Resend hci_read_local_supported_commands after CSR Warm Boot double reset"); 150806b9e820SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_READ_LOCAL_SUPPORTED_COMMANDS; 150906b9e820SMatthias Ringwald hci_send_cmd(&hci_read_local_supported_commands); 151006b9e820SMatthias Ringwald break; 151153860077SMatthias Ringwald case HCI_INIT_READ_BD_ADDR: 151253860077SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_READ_BD_ADDR; 151353860077SMatthias Ringwald hci_send_cmd(&hci_read_bd_addr); 151453860077SMatthias Ringwald break; 151574b323a9SMatthias Ringwald case HCI_INIT_READ_BUFFER_SIZE: 151674b323a9SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_READ_BUFFER_SIZE; 15170305bdeaSMatthias Ringwald hci_send_cmd(&hci_read_buffer_size); 151874b323a9SMatthias Ringwald break; 151953860077SMatthias Ringwald case HCI_INIT_READ_LOCAL_SUPPORTED_FEATURES: 152053860077SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_READ_LOCAL_SUPPORTED_FEATURES; 15210305bdeaSMatthias Ringwald hci_send_cmd(&hci_read_local_supported_features); 152274b323a9SMatthias Ringwald break; 15232b838201SMatthias Ringwald 15242b838201SMatthias Ringwald #ifdef ENABLE_HCI_CONTROLLER_TO_HOST_FLOW_CONTROL 15252b838201SMatthias Ringwald case HCI_INIT_SET_CONTROLLER_TO_HOST_FLOW_CONTROL: 15262b838201SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_SET_CONTROLLER_TO_HOST_FLOW_CONTROL; 15272b838201SMatthias Ringwald hci_send_cmd(&hci_set_controller_to_host_flow_control, 3); // ACL + SCO Flow Control 15282b838201SMatthias Ringwald break; 15292b838201SMatthias Ringwald case HCI_INIT_HOST_BUFFER_SIZE: 15302b838201SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_HOST_BUFFER_SIZE; 15312b838201SMatthias Ringwald hci_send_cmd(&hci_host_buffer_size, HCI_HOST_ACL_PACKET_LEN, HCI_HOST_SCO_PACKET_LEN, 15322b838201SMatthias Ringwald HCI_HOST_ACL_PACKET_NUM, HCI_HOST_SCO_PACKET_NUM); 15332b838201SMatthias Ringwald break; 15342b838201SMatthias Ringwald #endif 15352b838201SMatthias Ringwald 153674b323a9SMatthias Ringwald case HCI_INIT_SET_EVENT_MASK: 15370305bdeaSMatthias Ringwald hci_stack->substate = HCI_INIT_W4_SET_EVENT_MASK; 153874b323a9SMatthias Ringwald if (hci_le_supported()){ 15395ce1359eSMatthias Ringwald hci_send_cmd(&hci_set_event_mask,0xFFFFFFFFU, 0x3FFFFFFFU); 154074b323a9SMatthias Ringwald } else { 154174b323a9SMatthias Ringwald // Kensington Bluetooth 2.1 USB Dongle (CSR Chipset) returns an error for 0xffff... 15425ce1359eSMatthias Ringwald hci_send_cmd(&hci_set_event_mask,0xFFFFFFFFU, 0x1FFFFFFFU); 154374b323a9SMatthias Ringwald } 154474b323a9SMatthias Ringwald break; 15452b838201SMatthias Ringwald 154635454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 154774b323a9SMatthias Ringwald case HCI_INIT_WRITE_SIMPLE_PAIRING_MODE: 154874b323a9SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_WRITE_SIMPLE_PAIRING_MODE; 15490305bdeaSMatthias Ringwald hci_send_cmd(&hci_write_simple_pairing_mode, hci_stack->ssp_enable); 155074b323a9SMatthias Ringwald break; 155174b323a9SMatthias Ringwald case HCI_INIT_WRITE_PAGE_TIMEOUT: 155274b323a9SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_WRITE_PAGE_TIMEOUT; 15530305bdeaSMatthias Ringwald hci_send_cmd(&hci_write_page_timeout, 0x6000); // ca. 15 sec 155474b323a9SMatthias Ringwald break; 1555f6858d14SMatthias Ringwald case HCI_INIT_WRITE_INQUIRY_MODE: 1556f6858d14SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_WRITE_INQUIRY_MODE; 15578a114470SMatthias Ringwald hci_send_cmd(&hci_write_inquiry_mode, (int) hci_stack->inquiry_mode); 1558f6858d14SMatthias Ringwald break; 15595d23aae8SMatthias Ringwald case HCI_INIT_WRITE_SECURE_CONNECTIONS_HOST_ENABLE: 15605d23aae8SMatthias Ringwald hci_send_cmd(&hci_write_secure_connections_host_support, 1); 1561c214d65bSMatthias Ringwald hci_stack->secure_connections_active = true; 15625d23aae8SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_WRITE_SECURE_CONNECTIONS_HOST_ENABLE; 15635d23aae8SMatthias Ringwald break; 156474b323a9SMatthias Ringwald case HCI_INIT_WRITE_SCAN_ENABLE: 156574b323a9SMatthias Ringwald hci_send_cmd(&hci_write_scan_enable, (hci_stack->connectable << 1) | hci_stack->discoverable); // page scan 156674b323a9SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_WRITE_SCAN_ENABLE; 156774b323a9SMatthias Ringwald break; 1568483c5078SMatthias Ringwald // only sent if ENABLE_SCO_OVER_HCI is defined 1569729ed62eSMatthias Ringwald case HCI_INIT_WRITE_SYNCHRONOUS_FLOW_CONTROL_ENABLE: 1570729ed62eSMatthias Ringwald hci_stack->substate = HCI_INIT_W4_WRITE_SYNCHRONOUS_FLOW_CONTROL_ENABLE; 1571729ed62eSMatthias Ringwald hci_send_cmd(&hci_write_synchronous_flow_control_enable, 1); // SCO tracking enabled 1572729ed62eSMatthias Ringwald break; 1573483c5078SMatthias Ringwald case HCI_INIT_WRITE_DEFAULT_ERRONEOUS_DATA_REPORTING: 1574483c5078SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_WRITE_DEFAULT_ERRONEOUS_DATA_REPORTING; 1575483c5078SMatthias Ringwald hci_send_cmd(&hci_write_default_erroneous_data_reporting, 1); 1576483c5078SMatthias Ringwald break; 15778051253fSMatthias Ringwald // only sent if manufacturer is Broadcom and ENABLE_SCO_OVER_HCI or ENABLE_SCO_OVER_PCM is defined 1578a42798c3SMatthias Ringwald case HCI_INIT_BCM_WRITE_SCO_PCM_INT: 1579a42798c3SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_BCM_WRITE_SCO_PCM_INT; 15808051253fSMatthias Ringwald #ifdef ENABLE_SCO_OVER_HCI 1581a42798c3SMatthias Ringwald log_info("BCM: Route SCO data via HCI transport"); 1582a42798c3SMatthias Ringwald hci_send_cmd(&hci_bcm_write_sco_pcm_int, 1, 0, 0, 0, 0); 15838051253fSMatthias Ringwald #endif 15848051253fSMatthias Ringwald #ifdef ENABLE_SCO_OVER_PCM 15858051253fSMatthias Ringwald log_info("BCM: Route SCO data via PCM interface"); 15861d2bbd54SMatthias Ringwald #ifdef ENABLE_BCM_PCM_WBS 15871d2bbd54SMatthias Ringwald // 512 kHz bit clock for 2 channels x 16 bit x 8 kHz 15881d2bbd54SMatthias Ringwald hci_send_cmd(&hci_bcm_write_sco_pcm_int, 0, 2, 0, 1, 1); 15891d2bbd54SMatthias Ringwald #else 15901d2bbd54SMatthias Ringwald // 256 kHz bit clock for 2 channels x 16 bit x 8 kHz 15911d2bbd54SMatthias Ringwald hci_send_cmd(&hci_bcm_write_sco_pcm_int, 0, 1, 0, 1, 1); 15921d2bbd54SMatthias Ringwald #endif 15938051253fSMatthias Ringwald #endif 1594a42798c3SMatthias Ringwald break; 15954e821764SMatthias Ringwald #ifdef ENABLE_SCO_OVER_PCM 15964e821764SMatthias Ringwald case HCI_INIT_BCM_WRITE_I2SPCM_INTERFACE_PARAM: 15974e821764SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_BCM_WRITE_I2SPCM_INTERFACE_PARAM; 15984e821764SMatthias Ringwald log_info("BCM: Config PCM interface for I2S"); 15991d2bbd54SMatthias Ringwald #ifdef ENABLE_BCM_PCM_WBS 16001d2bbd54SMatthias Ringwald // 512 kHz bit clock for 2 channels x 16 bit x 8 kHz 16011d2bbd54SMatthias Ringwald hci_send_cmd(&hci_bcm_write_i2spcm_interface_param, 1, 1, 0, 2); 16021d2bbd54SMatthias Ringwald #else 16031d2bbd54SMatthias Ringwald // 256 kHz bit clock for 2 channels x 16 bit x 8 kHz 16041d2bbd54SMatthias Ringwald hci_send_cmd(&hci_bcm_write_i2spcm_interface_param, 1, 1, 0, 1); 16051d2bbd54SMatthias Ringwald #endif 16064e821764SMatthias Ringwald break; 160735454696SMatthias Ringwald #endif 16084e821764SMatthias Ringwald #endif 16094e821764SMatthias Ringwald 1610a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE 161174b323a9SMatthias Ringwald // LE INIT 161274b323a9SMatthias Ringwald case HCI_INIT_LE_READ_BUFFER_SIZE: 161374b323a9SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_LE_READ_BUFFER_SIZE; 16140305bdeaSMatthias Ringwald hci_send_cmd(&hci_le_read_buffer_size); 161574b323a9SMatthias Ringwald break; 1616daabb8b8SMatthias Ringwald case HCI_INIT_LE_SET_EVENT_MASK: 1617daabb8b8SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_LE_SET_EVENT_MASK; 1618729710c0SMatthias Ringwald hci_send_cmd(&hci_le_set_event_mask, 0x809FF, 0x0); // bits 0-8, 11, 19 1619daabb8b8SMatthias Ringwald break; 162074b323a9SMatthias Ringwald case HCI_INIT_WRITE_LE_HOST_SUPPORTED: 162174b323a9SMatthias Ringwald // LE Supported Host = 1, Simultaneous Host = 0 162274b323a9SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_WRITE_LE_HOST_SUPPORTED; 16230305bdeaSMatthias Ringwald hci_send_cmd(&hci_write_le_host_supported, 1, 0); 162474b323a9SMatthias Ringwald break; 1625b435e062SMatthias Ringwald #endif 1626b435e062SMatthias Ringwald 1627b435e062SMatthias Ringwald #ifdef ENABLE_LE_DATA_LENGTH_EXTENSION 1628dcd678baSMatthias Ringwald case HCI_INIT_LE_READ_MAX_DATA_LENGTH: 1629dcd678baSMatthias Ringwald hci_stack->substate = HCI_INIT_W4_LE_READ_MAX_DATA_LENGTH; 1630dcd678baSMatthias Ringwald hci_send_cmd(&hci_le_read_maximum_data_length); 1631dcd678baSMatthias Ringwald break; 1632dcd678baSMatthias Ringwald case HCI_INIT_LE_WRITE_SUGGESTED_DATA_LENGTH: 1633dcd678baSMatthias Ringwald hci_stack->substate = HCI_INIT_W4_LE_WRITE_SUGGESTED_DATA_LENGTH; 1634b435e062SMatthias 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); 1635dcd678baSMatthias Ringwald break; 1636b435e062SMatthias Ringwald #endif 1637b435e062SMatthias Ringwald 1638b95a5a35SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 16393b6d4121SMatthias Ringwald case HCI_INIT_READ_WHITE_LIST_SIZE: 16403b6d4121SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_READ_WHITE_LIST_SIZE; 16413b6d4121SMatthias Ringwald hci_send_cmd(&hci_le_read_white_list_size); 16423b6d4121SMatthias Ringwald break; 164374b323a9SMatthias Ringwald case HCI_INIT_LE_SET_SCAN_PARAMETERS: 164474b323a9SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_LE_SET_SCAN_PARAMETERS; 16458b69e4c7SMatthias 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); 164674b323a9SMatthias Ringwald break; 164774b323a9SMatthias Ringwald #endif 164874b323a9SMatthias Ringwald default: 164974b323a9SMatthias Ringwald return; 165074b323a9SMatthias Ringwald } 165155975f88SMatthias Ringwald } 165255975f88SMatthias Ringwald 1653a650ba4dSMatthias Ringwald static void hci_init_done(void){ 1654a650ba4dSMatthias Ringwald // done. tell the app 1655a650ba4dSMatthias Ringwald log_info("hci_init_done -> HCI_STATE_WORKING"); 1656a650ba4dSMatthias Ringwald hci_stack->state = HCI_STATE_WORKING; 1657a650ba4dSMatthias Ringwald hci_emit_state(); 1658a650ba4dSMatthias Ringwald hci_run(); 1659a650ba4dSMatthias Ringwald } 1660a650ba4dSMatthias Ringwald 166107fd2f31SMatthias Ringwald static bool hci_initializing_event_handler_command_completed(const uint8_t * packet){ 166207fd2f31SMatthias Ringwald bool command_completed = false; 16630e2df43fSMatthias Ringwald if (hci_event_packet_get_type(packet) == HCI_EVENT_COMMAND_COMPLETE){ 1664f8fbdce0SMatthias Ringwald uint16_t opcode = little_endian_read_16(packet,3); 16656155b3d3S[email protected] if (opcode == hci_stack->last_cmd_opcode){ 166607fd2f31SMatthias Ringwald command_completed = true; 1667148ca237SMatthias Ringwald log_debug("Command complete for expected opcode %04x at substate %u", opcode, hci_stack->substate); 16686155b3d3S[email protected] } else { 1669d58dd308SMatthias Ringwald log_info("Command complete for different opcode %04x, expected %04x, at substate %u", opcode, hci_stack->last_cmd_opcode, hci_stack->substate); 16706155b3d3S[email protected] } 16716155b3d3S[email protected] } 16720f97eae7SMatthias Ringwald 16730e2df43fSMatthias Ringwald if (hci_event_packet_get_type(packet) == HCI_EVENT_COMMAND_STATUS){ 16746155b3d3S[email protected] uint8_t status = packet[2]; 1675f8fbdce0SMatthias Ringwald uint16_t opcode = little_endian_read_16(packet,4); 16766155b3d3S[email protected] if (opcode == hci_stack->last_cmd_opcode){ 16776155b3d3S[email protected] if (status){ 167807fd2f31SMatthias Ringwald command_completed = true; 1679148ca237SMatthias Ringwald log_debug("Command status error 0x%02x for expected opcode %04x at substate %u", status, opcode, hci_stack->substate); 16806155b3d3S[email protected] } else { 16816155b3d3S[email protected] log_info("Command status OK for expected opcode %04x, waiting for command complete", opcode); 16826155b3d3S[email protected] } 16836155b3d3S[email protected] } else { 1684148ca237SMatthias Ringwald log_debug("Command status for opcode %04x, expected %04x", opcode, hci_stack->last_cmd_opcode); 16856155b3d3S[email protected] } 16866155b3d3S[email protected] } 168706b9e820SMatthias Ringwald #if !defined(HAVE_PLATFORM_IPHONE_OS) && !defined (HAVE_HOST_CONTROLLER_API) 1688e47e68c7SMatthias Ringwald // Vendor == CSR 16890e588213SMatthias Ringwald if ((hci_stack->substate == HCI_INIT_W4_CUSTOM_INIT) && (hci_event_packet_get_type(packet) == HCI_EVENT_VENDOR_SPECIFIC)){ 1690e47e68c7SMatthias Ringwald // TODO: track actual command 169107fd2f31SMatthias Ringwald command_completed = true; 1692e47e68c7SMatthias Ringwald } 1693a2481739S[email protected] 16944e9daa6fSMatthias Ringwald // Vendor == Toshiba 16950e588213SMatthias Ringwald if ((hci_stack->substate == HCI_INIT_W4_SEND_BAUD_CHANGE) && (hci_event_packet_get_type(packet) == HCI_EVENT_VENDOR_SPECIFIC)){ 16964e9daa6fSMatthias Ringwald // TODO: track actual command 169707fd2f31SMatthias Ringwald command_completed = true; 1698004902f1SMatthias Ringwald // Fix: no HCI Command Complete received, so num_cmd_packets not reset 1699004902f1SMatthias Ringwald hci_stack->num_cmd_packets = 1; 17004e9daa6fSMatthias Ringwald } 170107fd2f31SMatthias Ringwald #endif 170207fd2f31SMatthias Ringwald 170307fd2f31SMatthias Ringwald return command_completed; 170407fd2f31SMatthias Ringwald } 170507fd2f31SMatthias Ringwald 170607fd2f31SMatthias Ringwald static void hci_initializing_event_handler(const uint8_t * packet, uint16_t size){ 170707fd2f31SMatthias Ringwald 170807fd2f31SMatthias Ringwald UNUSED(size); // ok: less than 6 bytes are read from our buffer 170907fd2f31SMatthias Ringwald 171007fd2f31SMatthias Ringwald bool command_completed = hci_initializing_event_handler_command_completed(packet); 171107fd2f31SMatthias Ringwald 171207fd2f31SMatthias Ringwald #if !defined(HAVE_PLATFORM_IPHONE_OS) && !defined (HAVE_HOST_CONTROLLER_API) 17134e9daa6fSMatthias Ringwald 17140f97eae7SMatthias Ringwald // Late response (> 100 ms) for HCI Reset e.g. on Toshiba TC35661: 17150f97eae7SMatthias Ringwald // Command complete for HCI Reset arrives after we've resent the HCI Reset command 17160f97eae7SMatthias Ringwald // 17170f97eae7SMatthias Ringwald // HCI Reset 17180f97eae7SMatthias Ringwald // Timeout 100 ms 17190f97eae7SMatthias Ringwald // HCI Reset 17200f97eae7SMatthias Ringwald // Command Complete Reset 17210f97eae7SMatthias Ringwald // HCI Read Local Version Information 17220f97eae7SMatthias Ringwald // Command Complete Reset - but we expected Command Complete Read Local Version Information 17230f97eae7SMatthias Ringwald // hang... 17240f97eae7SMatthias Ringwald // 17250f97eae7SMatthias Ringwald // Fix: Command Complete for HCI Reset in HCI_INIT_W4_SEND_READ_LOCAL_VERSION_INFORMATION trigger resend 17260f97eae7SMatthias Ringwald if (!command_completed 1727a1df452eSMatthias Ringwald && (hci_event_packet_get_type(packet) == HCI_EVENT_COMMAND_COMPLETE) 17280e588213SMatthias Ringwald && (hci_stack->substate == HCI_INIT_W4_SEND_READ_LOCAL_VERSION_INFORMATION)){ 17290f97eae7SMatthias Ringwald 1730f8fbdce0SMatthias Ringwald uint16_t opcode = little_endian_read_16(packet,3); 17310f97eae7SMatthias Ringwald if (opcode == hci_reset.opcode){ 17320f97eae7SMatthias Ringwald hci_stack->substate = HCI_INIT_SEND_READ_LOCAL_VERSION_INFORMATION; 17330f97eae7SMatthias Ringwald return; 17340f97eae7SMatthias Ringwald } 17350f97eae7SMatthias Ringwald } 17360f97eae7SMatthias Ringwald 17379f007422SMatthias Ringwald // CSR & H5 17389f007422SMatthias Ringwald // Fix: Command Complete for HCI Reset in HCI_INIT_W4_SEND_READ_LOCAL_VERSION_INFORMATION trigger resend 17399f007422SMatthias Ringwald if (!command_completed 1740a1df452eSMatthias Ringwald && (hci_event_packet_get_type(packet) == HCI_EVENT_COMMAND_COMPLETE) 17410e588213SMatthias Ringwald && (hci_stack->substate == HCI_INIT_W4_READ_LOCAL_SUPPORTED_COMMANDS)){ 17429f007422SMatthias Ringwald 17439f007422SMatthias Ringwald uint16_t opcode = little_endian_read_16(packet,3); 17449f007422SMatthias Ringwald if (opcode == hci_reset.opcode){ 17459f007422SMatthias Ringwald hci_stack->substate = HCI_INIT_READ_LOCAL_SUPPORTED_COMMANDS; 17469f007422SMatthias Ringwald return; 17479f007422SMatthias Ringwald } 17489f007422SMatthias Ringwald } 17499f007422SMatthias Ringwald 17509f007422SMatthias 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 17519f007422SMatthias Ringwald // fix: Correct substate and behave as command below 17529f007422SMatthias Ringwald if (command_completed){ 17539f007422SMatthias Ringwald switch (hci_stack->substate){ 17549f007422SMatthias Ringwald case HCI_INIT_SEND_RESET: 17559f007422SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_SEND_RESET; 17569f007422SMatthias Ringwald break; 17579f007422SMatthias Ringwald case HCI_INIT_SEND_RESET_CSR_WARM_BOOT: 17589f007422SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_CUSTOM_INIT_CSR_WARM_BOOT; 17599f007422SMatthias Ringwald break; 17609f007422SMatthias Ringwald default: 17619f007422SMatthias Ringwald break; 17629f007422SMatthias Ringwald } 17639f007422SMatthias Ringwald } 17640f97eae7SMatthias Ringwald 176506b9e820SMatthias Ringwald #endif 17660f97eae7SMatthias Ringwald 1767a2481739S[email protected] if (!command_completed) return; 1768a2481739S[email protected] 176907fd2f31SMatthias Ringwald bool need_baud_change = false; 177007fd2f31SMatthias Ringwald bool need_addr_change = false; 177106b9e820SMatthias Ringwald 177206b9e820SMatthias Ringwald #if !defined(HAVE_PLATFORM_IPHONE_OS) && !defined (HAVE_HOST_CONTROLLER_API) 177306b9e820SMatthias Ringwald need_baud_change = hci_stack->config 17743fb36a29SMatthias Ringwald && hci_stack->chipset 17753fb36a29SMatthias Ringwald && hci_stack->chipset->set_baudrate_command 1776db8bc6ffSMatthias Ringwald && hci_stack->hci_transport->set_baudrate 17779796ebeaSMatthias Ringwald && ((hci_transport_config_uart_t *)hci_stack->config)->baudrate_main; 1778db8bc6ffSMatthias Ringwald 177906b9e820SMatthias Ringwald need_addr_change = hci_stack->custom_bd_addr_set 17803fb36a29SMatthias Ringwald && hci_stack->chipset 17813fb36a29SMatthias Ringwald && hci_stack->chipset->set_bd_addr_command; 178206b9e820SMatthias Ringwald #endif 1783a80162e9SMatthias Ringwald 17845c363727SMatthias Ringwald switch(hci_stack->substate){ 178506b9e820SMatthias Ringwald 178606b9e820SMatthias Ringwald #if !defined(HAVE_PLATFORM_IPHONE_OS) && !defined (HAVE_HOST_CONTROLLER_API) 17879f007422SMatthias Ringwald case HCI_INIT_SEND_RESET: 1788d58dd308SMatthias Ringwald // on CSR with BCSP/H5, resend triggers resend of HCI Reset and leads to substate == HCI_INIT_SEND_RESET 17899f007422SMatthias Ringwald // fix: just correct substate and behave as command below 17909f007422SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_SEND_RESET; 17919f007422SMatthias Ringwald btstack_run_loop_remove_timer(&hci_stack->timeout); 17929f007422SMatthias Ringwald break; 179374b323a9SMatthias Ringwald case HCI_INIT_W4_SEND_RESET: 1794528a4a3bSMatthias Ringwald btstack_run_loop_remove_timer(&hci_stack->timeout); 179576fcb19bSMatthias Ringwald break; 1796e90bae01SMatthias Ringwald case HCI_INIT_W4_SEND_READ_LOCAL_NAME: 179707fd2f31SMatthias Ringwald log_info("Received local name, need baud change %d", (int) need_baud_change); 17982f48d920SMatthias Ringwald if (need_baud_change){ 17992f48d920SMatthias Ringwald hci_stack->substate = HCI_INIT_SEND_BAUD_CHANGE; 18002f48d920SMatthias Ringwald return; 18012f48d920SMatthias Ringwald } 180253860077SMatthias Ringwald // skip baud change 180374b323a9SMatthias Ringwald hci_stack->substate = HCI_INIT_CUSTOM_INIT; 180474b323a9SMatthias Ringwald return; 1805a80162e9SMatthias Ringwald case HCI_INIT_W4_SEND_BAUD_CHANGE: 18064696bddbSMatthias Ringwald // for STLC2500D, baud rate change already happened. 1807fab26ab3SMatthias Ringwald // for others, baud rate gets changed now 180861f37892SMatthias Ringwald if ((hci_stack->manufacturer != BLUETOOTH_COMPANY_ID_ST_MICROELECTRONICS) && need_baud_change){ 180996b53536SMatthias Ringwald uint32_t baud_rate = hci_transport_uart_get_main_baud_rate(); 1810cd724cb7SMatthias Ringwald log_info("Local baud rate change to %" PRIu32 "(w4_send_baud_change)", baud_rate); 1811fab26ab3SMatthias Ringwald hci_stack->hci_transport->set_baudrate(baud_rate); 18124696bddbSMatthias Ringwald } 181374b323a9SMatthias Ringwald hci_stack->substate = HCI_INIT_CUSTOM_INIT; 181474b323a9SMatthias Ringwald return; 1815a80162e9SMatthias Ringwald case HCI_INIT_W4_CUSTOM_INIT_CSR_WARM_BOOT: 1816528a4a3bSMatthias Ringwald btstack_run_loop_remove_timer(&hci_stack->timeout); 1817a80162e9SMatthias Ringwald hci_stack->substate = HCI_INIT_CUSTOM_INIT; 1818a80162e9SMatthias Ringwald return; 181974b323a9SMatthias Ringwald case HCI_INIT_W4_CUSTOM_INIT: 182074b323a9SMatthias Ringwald // repeat custom init 182174b323a9SMatthias Ringwald hci_stack->substate = HCI_INIT_CUSTOM_INIT; 182274b323a9SMatthias Ringwald return; 182306b9e820SMatthias Ringwald #else 182406b9e820SMatthias Ringwald case HCI_INIT_W4_SEND_RESET: 182506b9e820SMatthias Ringwald hci_stack->substate = HCI_INIT_READ_LOCAL_SUPPORTED_COMMANDS; 182606b9e820SMatthias Ringwald return ; 182706b9e820SMatthias Ringwald #endif 182806b9e820SMatthias Ringwald 1829a828a756SMatthias Ringwald case HCI_INIT_W4_READ_LOCAL_SUPPORTED_COMMANDS: 18300e588213SMatthias Ringwald if (need_baud_change && (hci_stack->chipset_result != BTSTACK_CHIPSET_NO_INIT_SCRIPT) && 1831efd3b327SMatthias Ringwald ((hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_BROADCOM_CORPORATION) || 1832efd3b327SMatthias Ringwald (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_EM_MICROELECTRONIC_MARIN_SA))) { 1833eb3a5314SMatthias Ringwald hci_stack->substate = HCI_INIT_SEND_BAUD_CHANGE_BCM; 1834eb3a5314SMatthias Ringwald return; 1835eb3a5314SMatthias Ringwald } 183653860077SMatthias Ringwald if (need_addr_change){ 183753860077SMatthias Ringwald hci_stack->substate = HCI_INIT_SET_BD_ADDR; 183853860077SMatthias Ringwald return; 183953860077SMatthias Ringwald } 184053860077SMatthias Ringwald hci_stack->substate = HCI_INIT_READ_BD_ADDR; 184153860077SMatthias Ringwald return; 184206b9e820SMatthias Ringwald #if !defined(HAVE_PLATFORM_IPHONE_OS) && !defined (HAVE_HOST_CONTROLLER_API) 18437224be7eSMatthias Ringwald case HCI_INIT_W4_SEND_BAUD_CHANGE_BCM: 18447224be7eSMatthias Ringwald if (need_baud_change){ 184596b53536SMatthias Ringwald uint32_t baud_rate = hci_transport_uart_get_main_baud_rate(); 1846cd724cb7SMatthias Ringwald log_info("Local baud rate change to %" PRIu32 "(w4_send_baud_change_bcm))", baud_rate); 1847fab26ab3SMatthias Ringwald hci_stack->hci_transport->set_baudrate(baud_rate); 18487224be7eSMatthias Ringwald } 1849eb3a5314SMatthias Ringwald if (need_addr_change){ 1850eb3a5314SMatthias Ringwald hci_stack->substate = HCI_INIT_SET_BD_ADDR; 1851eb3a5314SMatthias Ringwald return; 1852eb3a5314SMatthias Ringwald } 1853eb3a5314SMatthias Ringwald hci_stack->substate = HCI_INIT_READ_BD_ADDR; 1854eb3a5314SMatthias Ringwald return; 185553860077SMatthias Ringwald case HCI_INIT_W4_SET_BD_ADDR: 18566ca9a99aSMatthias Ringwald // for STLC2500D + ATWILC3000, bd addr change only gets active after sending reset command 18576ca9a99aSMatthias Ringwald if ((hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_ST_MICROELECTRONICS) 18586ca9a99aSMatthias Ringwald || (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_ATMEL_CORPORATION)){ 185953860077SMatthias Ringwald hci_stack->substate = HCI_INIT_SEND_RESET_ST_WARM_BOOT; 186053860077SMatthias Ringwald return; 186153860077SMatthias Ringwald } 186253860077SMatthias Ringwald // skipping st warm boot 186353860077SMatthias Ringwald hci_stack->substate = HCI_INIT_READ_BD_ADDR; 186453860077SMatthias Ringwald return; 186553860077SMatthias Ringwald case HCI_INIT_W4_SEND_RESET_ST_WARM_BOOT: 186653860077SMatthias Ringwald hci_stack->substate = HCI_INIT_READ_BD_ADDR; 186753860077SMatthias Ringwald return; 186806b9e820SMatthias Ringwald #endif 186953860077SMatthias Ringwald case HCI_INIT_W4_READ_BD_ADDR: 187053860077SMatthias Ringwald // only read buffer size if supported 18714ea43905SMatthias Ringwald if (hci_stack->local_supported_commands[0u] & 0x01u) { 187253860077SMatthias Ringwald hci_stack->substate = HCI_INIT_READ_BUFFER_SIZE; 187353860077SMatthias Ringwald return; 187453860077SMatthias Ringwald } 187553860077SMatthias Ringwald // skipping read buffer size 187653860077SMatthias Ringwald hci_stack->substate = HCI_INIT_READ_LOCAL_SUPPORTED_FEATURES; 1877a828a756SMatthias Ringwald return; 187874b323a9SMatthias Ringwald case HCI_INIT_W4_SET_EVENT_MASK: 18796155b3d3S[email protected] // skip Classic init commands for LE only chipsets 18806155b3d3S[email protected] if (!hci_classic_supported()){ 18812c68f164SMatthias Ringwald #ifdef ENABLE_BLE 18826155b3d3S[email protected] if (hci_le_supported()){ 188374b323a9SMatthias Ringwald hci_stack->substate = HCI_INIT_LE_READ_BUFFER_SIZE; // skip all classic command 188474b323a9SMatthias Ringwald return; 18852c68f164SMatthias Ringwald } 18862c68f164SMatthias Ringwald #endif 18876155b3d3S[email protected] log_error("Neither BR/EDR nor LE supported"); 1888a650ba4dSMatthias Ringwald hci_init_done(); 188974b323a9SMatthias Ringwald return; 18906155b3d3S[email protected] } 189115a95bd5SMatthias Ringwald if (!gap_ssp_supported()){ 18925c363727SMatthias Ringwald hci_stack->substate = HCI_INIT_WRITE_PAGE_TIMEOUT; 189374b323a9SMatthias Ringwald return; 18946155b3d3S[email protected] } 18956155b3d3S[email protected] break; 1896903ea03aSMatthias Ringwald #ifdef ENABLE_BLE 1897a828a756SMatthias Ringwald case HCI_INIT_W4_LE_READ_BUFFER_SIZE: 1898a828a756SMatthias Ringwald // skip write le host if not supported (e.g. on LE only EM9301) 18994ea43905SMatthias Ringwald if (hci_stack->local_supported_commands[0u] & 0x02u) break; 1900daabb8b8SMatthias Ringwald hci_stack->substate = HCI_INIT_LE_SET_EVENT_MASK; 1901daabb8b8SMatthias Ringwald return; 1902daabb8b8SMatthias Ringwald 1903b435e062SMatthias Ringwald #ifdef ENABLE_LE_DATA_LENGTH_EXTENSION 1904b435e062SMatthias Ringwald case HCI_INIT_W4_WRITE_LE_HOST_SUPPORTED: 19056fab74dbSMatthias Ringwald log_info("Supported commands %x", hci_stack->local_supported_commands[0] & 0x30); 19064ea43905SMatthias Ringwald if ((hci_stack->local_supported_commands[0u] & 0x30u) == 0x30u){ 190780d7d618SMatthias Ringwald hci_stack->substate = HCI_INIT_LE_SET_EVENT_MASK; 1908b435e062SMatthias Ringwald return; 1909b435e062SMatthias Ringwald } 1910b435e062SMatthias Ringwald // explicit fall through to reduce repetitions 1911b435e062SMatthias Ringwald 1912b435e062SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 1913b435e062SMatthias Ringwald hci_stack->substate = HCI_INIT_READ_WHITE_LIST_SIZE; 1914903ea03aSMatthias Ringwald #else 1915903ea03aSMatthias Ringwald hci_init_done(); 1916903ea03aSMatthias Ringwald #endif 1917a828a756SMatthias Ringwald return; 191806337f4fSMatthias Ringwald #endif /* ENABLE_LE_DATA_LENGTH_EXTENSION */ 191906337f4fSMatthias Ringwald 192006337f4fSMatthias Ringwald #endif /* ENABLE_BLE */ 1921b435e062SMatthias Ringwald 19225d23aae8SMatthias Ringwald case HCI_INIT_W4_WRITE_INQUIRY_MODE: 19235d23aae8SMatthias Ringwald // skip write secure connections host support if not supported or disabled 19244ea43905SMatthias Ringwald if (!hci_stack->secure_connections_enable || (hci_stack->local_supported_commands[1u] & 0x02u) == 0u) { 19255d23aae8SMatthias Ringwald hci_stack->substate = HCI_INIT_WRITE_SCAN_ENABLE; 19265d23aae8SMatthias Ringwald return; 19275d23aae8SMatthias Ringwald } 19285d23aae8SMatthias Ringwald break; 19295d23aae8SMatthias Ringwald 193047bc3ebbSMatthias Ringwald #ifdef ENABLE_SCO_OVER_HCI 19313b65523cSMatthias Ringwald case HCI_INIT_W4_WRITE_SCAN_ENABLE: 19323905afbfSMatthias Ringwald // skip write synchronous flow control if not supported 19333905afbfSMatthias Ringwald if (hci_stack->local_supported_commands[0] & 0x04) break; 19343905afbfSMatthias Ringwald hci_stack->substate = HCI_INIT_W4_WRITE_SYNCHRONOUS_FLOW_CONTROL_ENABLE; 1935cf373d3aSMatthias Ringwald 1936cf373d3aSMatthias Ringwald /* fall through */ 19373905afbfSMatthias Ringwald 1938729ed62eSMatthias Ringwald case HCI_INIT_W4_WRITE_SYNCHRONOUS_FLOW_CONTROL_ENABLE: 19393905afbfSMatthias Ringwald // skip write default erroneous data reporting if not supported 19403905afbfSMatthias Ringwald if (hci_stack->local_supported_commands[0] & 0x08) break; 19413905afbfSMatthias Ringwald hci_stack->substate = HCI_INIT_W4_WRITE_DEFAULT_ERRONEOUS_DATA_REPORTING; 1942cf373d3aSMatthias Ringwald 1943cf373d3aSMatthias Ringwald /* fall through */ 19443905afbfSMatthias Ringwald 1945f064e0bbSMatthias Ringwald case HCI_INIT_W4_WRITE_DEFAULT_ERRONEOUS_DATA_REPORTING: 1946a42798c3SMatthias Ringwald // skip bcm set sco pcm config on non-Broadcom chipsets 194761f37892SMatthias Ringwald if (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_BROADCOM_CORPORATION) break; 19480168d82eSMatthias Ringwald hci_stack->substate = HCI_INIT_W4_BCM_WRITE_I2SPCM_INTERFACE_PARAM; 1949cf373d3aSMatthias Ringwald 1950cf373d3aSMatthias Ringwald /* fall through */ 1951a42798c3SMatthias Ringwald 1952a42798c3SMatthias Ringwald case HCI_INIT_W4_BCM_WRITE_SCO_PCM_INT: 1953729ed62eSMatthias Ringwald if (!hci_le_supported()){ 1954729ed62eSMatthias Ringwald // SKIP LE init for Classic only configuration 1955a650ba4dSMatthias Ringwald hci_init_done(); 1956729ed62eSMatthias Ringwald return; 1957729ed62eSMatthias Ringwald } 1958afe9bf34SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_BCM_WRITE_I2SPCM_INTERFACE_PARAM; 1959729ed62eSMatthias Ringwald break; 1960f3b012f9SMatthias Ringwald 1961f3b012f9SMatthias Ringwald #else /* !ENABLE_SCO_OVER_HCI */ 1962f3b012f9SMatthias Ringwald 196374b323a9SMatthias Ringwald case HCI_INIT_W4_WRITE_SCAN_ENABLE: 19648051253fSMatthias Ringwald #ifdef ENABLE_SCO_OVER_PCM 19658051253fSMatthias Ringwald if (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_BROADCOM_CORPORATION) { 19668051253fSMatthias Ringwald hci_stack->substate = HCI_INIT_BCM_WRITE_SCO_PCM_INT; 19678051253fSMatthias Ringwald return; 19688051253fSMatthias Ringwald } 19698051253fSMatthias Ringwald #endif 19708051253fSMatthias Ringwald /* fall through */ 19718051253fSMatthias Ringwald 19724e821764SMatthias Ringwald case HCI_INIT_W4_BCM_WRITE_I2SPCM_INTERFACE_PARAM: 1973f3b012f9SMatthias Ringwald #ifdef ENABLE_BLE 1974f3b012f9SMatthias Ringwald if (hci_le_supported()){ 1975f3b012f9SMatthias Ringwald hci_stack->substate = HCI_INIT_LE_READ_BUFFER_SIZE; 197674b323a9SMatthias Ringwald return; 19776155b3d3S[email protected] } 1978729ed62eSMatthias Ringwald #endif 1979f3b012f9SMatthias Ringwald // SKIP LE init for Classic only configuration 1980f3b012f9SMatthias Ringwald hci_init_done(); 1981f3b012f9SMatthias Ringwald return; 1982f3b012f9SMatthias Ringwald #endif /* ENABLE_SCO_OVER_HCI */ 1983f3b012f9SMatthias Ringwald 1984a4e96e78SMatthias Ringwald // avoid compile error due to duplicate cases: HCI_INIT_W4_BCM_WRITE_SCO_PCM_INT == HCI_INIT_DONE-1 1985a4e96e78SMatthias Ringwald #if defined(ENABLE_BLE) || defined(ENABLE_LE_DATA_LENGTH_EXTENSION) || defined(ENABLE_LE_CENTRAL) 1986a650ba4dSMatthias Ringwald // Response to command before init done state -> init done 1987a650ba4dSMatthias Ringwald case (HCI_INIT_DONE-1): 1988a650ba4dSMatthias Ringwald hci_init_done(); 1989a650ba4dSMatthias Ringwald return; 1990a4e96e78SMatthias Ringwald #endif 1991a650ba4dSMatthias Ringwald 19926155b3d3S[email protected] default: 199374b323a9SMatthias Ringwald break; 19946155b3d3S[email protected] } 199555975f88SMatthias Ringwald hci_initializing_next_state(); 19966155b3d3S[email protected] } 19976155b3d3S[email protected] 19980bbba85bSMatthias Ringwald static void hci_handle_connection_failed(hci_connection_t * conn, uint8_t status){ 1999229331c6SMatthias Ringwald log_info("Outgoing connection to %s failed", bd_addr_to_str(conn->address)); 20000bbba85bSMatthias Ringwald bd_addr_t bd_address; 20016535961aSMatthias Ringwald (void)memcpy(&bd_address, conn->address, 6); 20020bbba85bSMatthias Ringwald 20036bc9fa5eSMatthias Ringwald #ifdef ENABLE_CLASSIC 20046bc9fa5eSMatthias Ringwald // cache needed data 20056bc9fa5eSMatthias Ringwald int notify_dedicated_bonding_failed = conn->bonding_flags & BONDING_DEDICATED; 20066bc9fa5eSMatthias Ringwald #endif 20076bc9fa5eSMatthias Ringwald 20080bbba85bSMatthias Ringwald // connection failed, remove entry 20090bbba85bSMatthias Ringwald btstack_linked_list_remove(&hci_stack->connections, (btstack_linked_item_t *) conn); 20100bbba85bSMatthias Ringwald btstack_memory_hci_connection_free( conn ); 20110bbba85bSMatthias Ringwald 20126bc9fa5eSMatthias Ringwald #ifdef ENABLE_CLASSIC 20130bbba85bSMatthias Ringwald // notify client if dedicated bonding 20140bbba85bSMatthias Ringwald if (notify_dedicated_bonding_failed){ 20150bbba85bSMatthias Ringwald log_info("hci notify_dedicated_bonding_failed"); 20160bbba85bSMatthias Ringwald hci_emit_dedicated_bonding_result(bd_address, status); 20170bbba85bSMatthias Ringwald } 20180bbba85bSMatthias Ringwald 20190bbba85bSMatthias Ringwald // if authentication error, also delete link key 20200bbba85bSMatthias Ringwald if (status == ERROR_CODE_AUTHENTICATION_FAILURE) { 20210bbba85bSMatthias Ringwald gap_drop_link_key_for_bd_addr(bd_address); 20220bbba85bSMatthias Ringwald } 20231c79b5e3SMatthias Ringwald #else 20241c79b5e3SMatthias Ringwald UNUSED(status); 20256bc9fa5eSMatthias Ringwald #endif 20260bbba85bSMatthias Ringwald } 20270bbba85bSMatthias Ringwald 2028be500194SMatthias Ringwald #ifdef ENABLE_CLASSIC 20292f5c44baSMatthias Ringwald static void hci_handle_remote_features_page_0(hci_connection_t * conn, const uint8_t * features){ 20302f5c44baSMatthias Ringwald // SSP Controller 20312f5c44baSMatthias Ringwald if (features[6] & (1 << 3)){ 20322f5c44baSMatthias Ringwald conn->bonding_flags |= BONDING_REMOTE_SUPPORTS_SSP_CONTROLLER; 20332f5c44baSMatthias Ringwald } 20342f5c44baSMatthias Ringwald // eSCO 20352f5c44baSMatthias Ringwald if (features[3] & (1<<7)){ 20362f5c44baSMatthias Ringwald conn->remote_supported_features[0] |= 1; 20372f5c44baSMatthias Ringwald } 20382f5c44baSMatthias Ringwald // Extended features 20392f5c44baSMatthias Ringwald if (features[7] & (1<<7)){ 20402f5c44baSMatthias Ringwald conn->remote_supported_features[0] |= 2; 20412f5c44baSMatthias Ringwald } 20422f5c44baSMatthias Ringwald } 20432f5c44baSMatthias Ringwald 20442f5c44baSMatthias Ringwald static void hci_handle_remote_features_page_1(hci_connection_t * conn, const uint8_t * features){ 20452f5c44baSMatthias Ringwald // SSP Host 20462f5c44baSMatthias Ringwald if (features[0] & (1 << 0)){ 20472f5c44baSMatthias Ringwald conn->bonding_flags |= BONDING_REMOTE_SUPPORTS_SSP_HOST; 20482f5c44baSMatthias Ringwald } 204950c51a77SMatthias Ringwald // SC Host 205050c51a77SMatthias Ringwald if (features[0] & (1 << 3)){ 205150c51a77SMatthias Ringwald conn->bonding_flags |= BONDING_REMOTE_SUPPORTS_SC_HOST; 205250c51a77SMatthias Ringwald } 205350c51a77SMatthias Ringwald } 205450c51a77SMatthias Ringwald 205550c51a77SMatthias Ringwald static void hci_handle_remote_features_page_2(hci_connection_t * conn, const uint8_t * features){ 205650c51a77SMatthias Ringwald // SC Controller 205750c51a77SMatthias Ringwald if (features[1] & (1 << 0)){ 205850c51a77SMatthias Ringwald conn->bonding_flags |= BONDING_REMOTE_SUPPORTS_SC_CONTROLLER; 205950c51a77SMatthias Ringwald } 20602f5c44baSMatthias Ringwald } 20612f5c44baSMatthias Ringwald 2062de0df013SMatthias Ringwald static void hci_handle_remote_features_received(hci_connection_t * conn){ 2063de0df013SMatthias Ringwald conn->bonding_flags |= BONDING_RECEIVED_REMOTE_FEATURES; 206449bafb5eSMatthias Ringwald log_info("Remote features %02x, bonding flags %x", conn->remote_supported_features[0], conn->bonding_flags); 2065de0df013SMatthias Ringwald if (conn->bonding_flags & BONDING_DEDICATED){ 2066de0df013SMatthias Ringwald conn->bonding_flags |= BONDING_SEND_AUTHENTICATE_REQUEST; 2067de0df013SMatthias Ringwald } 2068de0df013SMatthias Ringwald } 2069128825c3SMatthias Ringwald static bool hci_remote_sc_enabled(hci_connection_t * connection){ 2070128825c3SMatthias Ringwald const uint16_t sc_enabled_mask = BONDING_REMOTE_SUPPORTS_SC_HOST | BONDING_REMOTE_SUPPORTS_SC_CONTROLLER; 2071128825c3SMatthias Ringwald return (connection->bonding_flags & sc_enabled_mask) == sc_enabled_mask; 2072128825c3SMatthias Ringwald } 2073128825c3SMatthias Ringwald 2074be500194SMatthias Ringwald #endif 2075de0df013SMatthias Ringwald 207667c6c9dcSMatthias Ringwald static void handle_event_for_current_stack_state(const uint8_t * packet, uint16_t size) { 207767c6c9dcSMatthias Ringwald // handle BT initialization 207867c6c9dcSMatthias Ringwald if (hci_stack->state == HCI_STATE_INITIALIZING) { 207967c6c9dcSMatthias Ringwald hci_initializing_event_handler(packet, size); 208067c6c9dcSMatthias Ringwald } 208167c6c9dcSMatthias Ringwald 208267c6c9dcSMatthias Ringwald // help with BT sleep 208367c6c9dcSMatthias Ringwald if ((hci_stack->state == HCI_STATE_FALLING_ASLEEP) 208467c6c9dcSMatthias Ringwald && (hci_stack->substate == HCI_FALLING_ASLEEP_W4_WRITE_SCAN_ENABLE) 208567c6c9dcSMatthias Ringwald && HCI_EVENT_IS_COMMAND_COMPLETE(packet, hci_write_scan_enable)) { 208667c6c9dcSMatthias Ringwald hci_initializing_next_state(); 208767c6c9dcSMatthias Ringwald } 208867c6c9dcSMatthias Ringwald } 208967c6c9dcSMatthias Ringwald 20909866fdc7SMatthias Ringwald #ifdef ENABLE_CLASSIC 20919866fdc7SMatthias Ringwald static void hci_handle_read_encryption_key_size_complete(hci_connection_t * conn, uint8_t encryption_key_size) { 20928daf94bcSMatthias Ringwald conn->authentication_flags |= AUTH_FLAG_CONNECTION_ENCRYPTED; 20939866fdc7SMatthias Ringwald conn->encryption_key_size = encryption_key_size; 2094abdad579SMatthias Ringwald 20958daf94bcSMatthias Ringwald if ((conn->authentication_flags & AUTH_FLAG_CONNECTION_AUTHENTICATED) != 0) { 20961cf0a6c8SMatthias Ringwald conn->requested_security_level = LEVEL_0; 20979866fdc7SMatthias Ringwald hci_emit_security_level(conn->con_handle, gap_security_level_for_connection(conn)); 2098abdad579SMatthias Ringwald return; 2099abdad579SMatthias Ringwald } 2100abdad579SMatthias Ringwald 2101abdad579SMatthias Ringwald // Request Authentication if not already done 2102abdad579SMatthias Ringwald if ((conn->bonding_flags & BONDING_SENT_AUTHENTICATE_REQUEST) != 0) return; 2103abdad579SMatthias Ringwald conn->bonding_flags |= BONDING_SEND_AUTHENTICATE_REQUEST; 21049866fdc7SMatthias Ringwald } 21059866fdc7SMatthias Ringwald #endif 21069866fdc7SMatthias Ringwald 21074f781026SMatthias Ringwald static void handle_command_complete_event(uint8_t * packet, uint16_t size){ 2108b08371a9SMilanka Ringwald UNUSED(size); 2109e76a89eeS[email protected] 21109cbd2215SMatthias Ringwald uint16_t manufacturer; 21119cbd2215SMatthias Ringwald #ifdef ENABLE_CLASSIC 2112fe1ed1b8Smatthias.ringwald hci_con_handle_t handle; 21131f7b95a1Smatthias.ringwald hci_connection_t * conn; 2114645b7c25SMatthias Ringwald uint8_t status; 21159cbd2215SMatthias Ringwald #endif 21166bef4003SMatthias Ringwald // get num cmd packets - limit to 1 to reduce complexity 21176bef4003SMatthias Ringwald hci_stack->num_cmd_packets = packet[2] ? 1 : 0; 21187ec5eeaaSmatthias.ringwald 2119645b7c25SMatthias Ringwald uint16_t opcode = hci_event_command_complete_get_command_opcode(packet); 2120645b7c25SMatthias Ringwald switch (opcode){ 2121645b7c25SMatthias Ringwald case HCI_OPCODE_HCI_READ_LOCAL_NAME: 2122645b7c25SMatthias Ringwald if (packet[5]) break; 21239e263bd7SMatthias Ringwald // terminate, name 248 chars 21249e263bd7SMatthias Ringwald packet[6+248] = 0; 21259e263bd7SMatthias Ringwald log_info("local name: %s", &packet[6]); 2126645b7c25SMatthias Ringwald break; 2127645b7c25SMatthias Ringwald case HCI_OPCODE_HCI_READ_BUFFER_SIZE: 21281d279b20Smatthias.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" 2129c3b46f5aSMatthias Ringwald if (hci_stack->state == HCI_STATE_INITIALIZING) { 2130429122ccSMatthias Ringwald uint16_t acl_len = little_endian_read_16(packet, 6); 2131429122ccSMatthias Ringwald uint16_t sco_len = packet[8]; 2132429122ccSMatthias Ringwald 2133429122ccSMatthias Ringwald // determine usable ACL/SCO payload size 2134429122ccSMatthias Ringwald hci_stack->acl_data_packet_length = btstack_min(acl_len, HCI_ACL_PAYLOAD_SIZE); 2135429122ccSMatthias Ringwald hci_stack->sco_data_packet_length = btstack_min(sco_len, HCI_ACL_PAYLOAD_SIZE); 2136429122ccSMatthias Ringwald 2137f8fbdce0SMatthias Ringwald hci_stack->acl_packets_total_num = little_endian_read_16(packet, 9); 2138f8fbdce0SMatthias Ringwald hci_stack->sco_packets_total_num = little_endian_read_16(packet, 11); 2139a8b12447S[email protected] 2140429122ccSMatthias Ringwald log_info("hci_read_buffer_size: ACL size module %u -> used %u, count %u / SCO size %u, count %u", 2141429122ccSMatthias Ringwald acl_len, hci_stack->acl_data_packet_length, hci_stack->acl_packets_total_num, 21421a06f663S[email protected] hci_stack->sco_data_packet_length, hci_stack->sco_packets_total_num); 2143c3b46f5aSMatthias Ringwald } 2144645b7c25SMatthias Ringwald break; 2145645b7c25SMatthias Ringwald case HCI_OPCODE_HCI_READ_RSSI: 2146645b7c25SMatthias Ringwald if (packet[5] == ERROR_CODE_SUCCESS){ 2147891b9fc2SMatthias Ringwald uint8_t event[5]; 2148891b9fc2SMatthias Ringwald event[0] = GAP_EVENT_RSSI_MEASUREMENT; 2149891b9fc2SMatthias Ringwald event[1] = 3; 21506535961aSMatthias Ringwald (void)memcpy(&event[2], &packet[6], 3); 2151891b9fc2SMatthias Ringwald hci_emit_event(event, sizeof(event), 1); 2152891b9fc2SMatthias Ringwald } 2153645b7c25SMatthias Ringwald break; 2154a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE 2155645b7c25SMatthias Ringwald case HCI_OPCODE_HCI_LE_READ_BUFFER_SIZE: 2156f8fbdce0SMatthias Ringwald hci_stack->le_data_packets_length = little_endian_read_16(packet, 6); 2157ee303eddS[email protected] hci_stack->le_acl_packets_total_num = packet[8]; 21586c26b087S[email protected] // determine usable ACL payload size 21596c26b087S[email protected] if (HCI_ACL_PAYLOAD_SIZE < hci_stack->le_data_packets_length){ 21606c26b087S[email protected] hci_stack->le_data_packets_length = HCI_ACL_PAYLOAD_SIZE; 21616c26b087S[email protected] } 21629da54300S[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); 2163645b7c25SMatthias Ringwald break; 2164b435e062SMatthias Ringwald #endif 2165b435e062SMatthias Ringwald #ifdef ENABLE_LE_DATA_LENGTH_EXTENSION 2166645b7c25SMatthias Ringwald case HCI_OPCODE_HCI_LE_READ_MAXIMUM_DATA_LENGTH: 2167dcd678baSMatthias Ringwald hci_stack->le_supported_max_tx_octets = little_endian_read_16(packet, 6); 2168dcd678baSMatthias Ringwald hci_stack->le_supported_max_tx_time = little_endian_read_16(packet, 8); 2169dcd678baSMatthias 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); 2170645b7c25SMatthias Ringwald break; 2171b435e062SMatthias Ringwald #endif 2172d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 2173645b7c25SMatthias Ringwald case HCI_OPCODE_HCI_LE_READ_WHITE_LIST_SIZE: 2174e691bb38SMatthias Ringwald hci_stack->le_whitelist_capacity = packet[6]; 217515d0a15bSMatthias Ringwald log_info("hci_le_read_white_list_size: size %u", hci_stack->le_whitelist_capacity); 2176645b7c25SMatthias Ringwald break; 217765a46ef3S[email protected] #endif 2178645b7c25SMatthias Ringwald case HCI_OPCODE_HCI_READ_BD_ADDR: 2179645b7c25SMatthias Ringwald reverse_bd_addr(&packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE + 1], hci_stack->local_bd_addr); 2180645b7c25SMatthias 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)); 218133373e40SMatthias Ringwald #ifdef ENABLE_CLASSIC 21821624665aSMatthias Ringwald if (hci_stack->link_key_db){ 21831624665aSMatthias Ringwald hci_stack->link_key_db->set_local_bd_addr(hci_stack->local_bd_addr); 21841624665aSMatthias Ringwald } 218533373e40SMatthias Ringwald #endif 2186645b7c25SMatthias Ringwald break; 218735454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 2188645b7c25SMatthias Ringwald case HCI_OPCODE_HCI_WRITE_SCAN_ENABLE: 21893a9fb326S[email protected] hci_emit_discoverable_enabled(hci_stack->discoverable); 2190645b7c25SMatthias Ringwald break; 2191645b7c25SMatthias Ringwald case HCI_OPCODE_HCI_INQUIRY_CANCEL: 2192f5875de5SMatthias Ringwald if (hci_stack->inquiry_state == GAP_INQUIRY_STATE_W4_CANCELLED){ 2193f5875de5SMatthias Ringwald hci_stack->inquiry_state = GAP_INQUIRY_STATE_IDLE; 2194f5875de5SMatthias Ringwald uint8_t event[] = { GAP_EVENT_INQUIRY_COMPLETE, 1, 0}; 2195f5875de5SMatthias Ringwald hci_emit_event(event, sizeof(event), 1); 2196f5875de5SMatthias Ringwald } 2197645b7c25SMatthias Ringwald break; 219835454696SMatthias Ringwald #endif 2199645b7c25SMatthias Ringwald case HCI_OPCODE_HCI_READ_LOCAL_SUPPORTED_FEATURES: 22004f781026SMatthias Ringwald (void)memcpy(hci_stack->local_supported_features, &packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE + 1], 8); 220165389bfcS[email protected] 220235454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 2203a5a23fc2S[email protected] // determine usable ACL packet types based on host buffer size and supported features 2204a5a23fc2S[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]); 22058b96126aSMatthias Ringwald log_info("Packet types %04x, eSCO %u", hci_stack->packet_types, hci_extended_sco_link_supported()); 220635454696SMatthias Ringwald #endif 2207f5d8d141S[email protected] // Classic/LE 2208f5d8d141S[email protected] log_info("BR/EDR support %u, LE support %u", hci_classic_supported(), hci_le_supported()); 2209645b7c25SMatthias Ringwald break; 2210645b7c25SMatthias Ringwald case HCI_OPCODE_HCI_READ_LOCAL_VERSION_INFORMATION: 2211645b7c25SMatthias Ringwald manufacturer = little_endian_read_16(packet, 10); 2212c21d89f3SMatthias Ringwald // map Cypress to Broadcom 2213c21d89f3SMatthias Ringwald if (manufacturer == BLUETOOTH_COMPANY_ID_CYPRESS_SEMICONDUCTOR){ 2214c21d89f3SMatthias Ringwald log_info("Treat Cypress as Broadcom"); 2215c21d89f3SMatthias Ringwald manufacturer = BLUETOOTH_COMPANY_ID_BROADCOM_CORPORATION; 2216c21d89f3SMatthias Ringwald little_endian_store_16(packet, 10, manufacturer); 2217c21d89f3SMatthias Ringwald } 2218c21d89f3SMatthias Ringwald hci_stack->manufacturer = manufacturer; 22194696bddbSMatthias Ringwald log_info("Manufacturer: 0x%04x", hci_stack->manufacturer); 2220645b7c25SMatthias Ringwald break; 2221645b7c25SMatthias Ringwald case HCI_OPCODE_HCI_READ_LOCAL_SUPPORTED_COMMANDS: 2222a828a756SMatthias Ringwald hci_stack->local_supported_commands[0] = 22234ea43905SMatthias Ringwald ((packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1u+14u] & 0x80u) >> 7u) | // bit 0 = Octet 14, bit 7 / Read Buffer Size 22244ea43905SMatthias Ringwald ((packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1u+24u] & 0x40u) >> 5u) | // bit 1 = Octet 24, bit 6 / Write Le Host Supported 22254ea43905SMatthias Ringwald ((packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1u+10u] & 0x10u) >> 2u) | // bit 2 = Octet 10, bit 4 / Write Synchronous Flow Control Enable 22264ea43905SMatthias Ringwald ((packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1u+18u] & 0x08u) ) | // bit 3 = Octet 18, bit 3 / Write Default Erroneous Data Reporting 22274ea43905SMatthias Ringwald ((packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1u+34u] & 0x01u) << 4u) | // bit 4 = Octet 34, bit 0 / LE Write Suggested Default Data Length 22284ea43905SMatthias Ringwald ((packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1u+35u] & 0x08u) << 2u) | // bit 5 = Octet 35, bit 3 / LE Read Maximum Data Length 22294ea43905SMatthias Ringwald ((packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1u+35u] & 0x20u) << 1u) | // bit 6 = Octet 35, bit 5 / LE Set Default PHY 22304ea43905SMatthias Ringwald ((packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1u+20u] & 0x10u) << 3u); // bit 7 = Octet 20, bit 4 / Read Encryption Key Size 22318d2d8af1SMatthias Ringwald hci_stack->local_supported_commands[1] = 22324ea43905SMatthias Ringwald ((packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1u+ 2u] & 0x40u) >> 6u) | // bit 8 = Octet 2, bit 6 / Read Remote Extended Features 223399b14827SMatthias Ringwald ((packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1u+32u] & 0x08u) >> 2u) | // bit 9 = Octet 32, bit 3 / Write Secure Connections Host 2234f21849cbSMatthias Ringwald ((packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1u+35u] & 0x02u) << 1u) | // bit 10 = Octet 35, bit 1 / LE Set Address Resolution Enable 2235f21849cbSMatthias Ringwald ((packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1u+32u] & 0x02u) << 2u) | // bit 11 = Octet 32, bit 1 / Remote OOB Extended Data Request Reply 2236f21849cbSMatthias Ringwald ((packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1u+32u] & 0x40u) >> 2u); // bit 12 = Octet 32, bit 6 / Read Local OOB Extended Data command 22378d2d8af1SMatthias Ringwald log_info("Local supported commands summary %02x - %02x", hci_stack->local_supported_commands[0], hci_stack->local_supported_commands[1]); 2238645b7c25SMatthias Ringwald break; 2239e8c8828eSMatthias Ringwald #ifdef ENABLE_CLASSIC 2240645b7c25SMatthias Ringwald case HCI_OPCODE_HCI_WRITE_SYNCHRONOUS_FLOW_CONTROL_ENABLE: 22414f781026SMatthias Ringwald if (packet[5]) return; 22425b9b590fSMatthias Ringwald hci_stack->synchronous_flow_control_enabled = 1; 2243645b7c25SMatthias Ringwald break; 2244645b7c25SMatthias Ringwald case HCI_OPCODE_HCI_READ_ENCRYPTION_KEY_SIZE: 2245645b7c25SMatthias Ringwald status = packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE]; 2246573897a0SMatthias Ringwald handle = little_endian_read_16(packet, OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1); 2247573897a0SMatthias Ringwald conn = hci_connection_for_handle(handle); 2248c3b46f5aSMatthias Ringwald if (conn != NULL) { 22499866fdc7SMatthias Ringwald uint8_t key_size = 0; 2250573897a0SMatthias Ringwald if (status == 0){ 22519866fdc7SMatthias Ringwald key_size = packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+3]; 22524a659b0eSMatthias Ringwald log_info("Handle %04x key Size: %u", handle, key_size); 2253170fafaeSMatthias Ringwald } else { 2254e9f98c4aSMatthias Ringwald key_size = 1; 22559866fdc7SMatthias Ringwald log_info("Read Encryption Key Size failed 0x%02x-> assuming insecure connection with key size of 1", status); 2256573897a0SMatthias Ringwald } 22579866fdc7SMatthias Ringwald hci_handle_read_encryption_key_size_complete(conn, key_size); 2258c3b46f5aSMatthias Ringwald } 2259645b7c25SMatthias Ringwald break; 2260cc15bb2cSMatthias Ringwald // assert pairing complete event is emitted. 2261cc15bb2cSMatthias Ringwald // note: for SSP, Simple Pairing Complete Event is sufficient, but we want to be more robust 2262cc15bb2cSMatthias Ringwald case HCI_OPCODE_HCI_PIN_CODE_REQUEST_NEGATIVE_REPLY: 2263cc15bb2cSMatthias Ringwald case HCI_OPCODE_HCI_USER_PASSKEY_REQUEST_NEGATIVE_REPLY: 2264cc15bb2cSMatthias Ringwald case HCI_OPCODE_HCI_USER_CONFIRMATION_REQUEST_NEGATIVE_REPLY: 2265cc15bb2cSMatthias Ringwald // lookup connection by gap pairing addr 2266cc15bb2cSMatthias Ringwald conn = hci_connection_for_bd_addr_and_type(hci_stack->gap_pairing_addr, BD_ADDR_TYPE_ACL); 2267cc15bb2cSMatthias Ringwald if (conn == NULL) break; 2268cc15bb2cSMatthias Ringwald hci_pairing_complete(conn, ERROR_CODE_AUTHENTICATION_FAILURE); 2269cc15bb2cSMatthias Ringwald break; 2270cc15bb2cSMatthias Ringwald 227175a8e4faSMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB 227275a8e4faSMatthias Ringwald case HCI_OPCODE_HCI_READ_LOCAL_OOB_DATA: 227375a8e4faSMatthias Ringwald case HCI_OPCODE_HCI_READ_LOCAL_EXTENDED_OOB_DATA:{ 227475a8e4faSMatthias Ringwald uint8_t event[67]; 227575a8e4faSMatthias Ringwald event[0] = GAP_EVENT_LOCAL_OOB_DATA; 227675a8e4faSMatthias Ringwald event[1] = 65; 227775a8e4faSMatthias Ringwald (void)memset(&event[2], 0, 65); 227875a8e4faSMatthias Ringwald if (packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE] == ERROR_CODE_SUCCESS){ 227975a8e4faSMatthias Ringwald (void)memcpy(&event[3], &packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1], 32); 228075a8e4faSMatthias Ringwald if (opcode == HCI_OPCODE_HCI_READ_LOCAL_EXTENDED_OOB_DATA){ 228175a8e4faSMatthias Ringwald event[2] = 3; 228275a8e4faSMatthias Ringwald (void)memcpy(&event[35], &packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+33], 32); 228375a8e4faSMatthias Ringwald } else { 228475a8e4faSMatthias Ringwald event[2] = 1; 228575a8e4faSMatthias Ringwald } 228675a8e4faSMatthias Ringwald } 228775a8e4faSMatthias Ringwald hci_emit_event(event, sizeof(event), 0); 228875a8e4faSMatthias Ringwald break; 228975a8e4faSMatthias Ringwald } 22901ae74bf3SMatthias Ringwald 22911ae74bf3SMatthias Ringwald // note: only needed if user does not provide OOB data 22921ae74bf3SMatthias Ringwald case HCI_OPCODE_HCI_REMOTE_OOB_DATA_REQUEST_NEGATIVE_REPLY: 22931ae74bf3SMatthias Ringwald conn = hci_connection_for_handle(hci_stack->classic_oob_con_handle); 22941ae74bf3SMatthias Ringwald hci_stack->classic_oob_con_handle = HCI_CON_HANDLE_INVALID; 22951ae74bf3SMatthias Ringwald if (conn == NULL) break; 22961ae74bf3SMatthias Ringwald hci_pairing_complete(conn, ERROR_CODE_AUTHENTICATION_FAILURE); 22971ae74bf3SMatthias Ringwald break; 2298e8c8828eSMatthias Ringwald #endif 229975a8e4faSMatthias Ringwald #endif 23006f35bb46SMatthias Ringwald default: 23016f35bb46SMatthias Ringwald break; 23024f781026SMatthias Ringwald } 2303645b7c25SMatthias Ringwald } 23044f781026SMatthias Ringwald 23050ce3f217SMatthias Ringwald #ifdef ENABLE_BLE 23060ce3f217SMatthias Ringwald static void event_handle_le_connection_complete(const uint8_t * packet){ 23070ce3f217SMatthias Ringwald bd_addr_t addr; 23080ce3f217SMatthias Ringwald bd_addr_type_t addr_type; 23090ce3f217SMatthias Ringwald hci_connection_t * conn; 23100ce3f217SMatthias Ringwald 23110ce3f217SMatthias Ringwald // Connection management 23120ce3f217SMatthias Ringwald reverse_bd_addr(&packet[8], addr); 23130ce3f217SMatthias Ringwald addr_type = (bd_addr_type_t)packet[7]; 23140ce3f217SMatthias Ringwald log_info("LE Connection_complete (status=%u) type %u, %s", packet[3], addr_type, bd_addr_to_str(addr)); 23150ce3f217SMatthias Ringwald conn = hci_connection_for_bd_addr_and_type(addr, addr_type); 23160ce3f217SMatthias Ringwald 23170ce3f217SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 23180ce3f217SMatthias Ringwald // handle error: error is reported only to the initiator -> outgoing connection 23190ce3f217SMatthias Ringwald if (packet[3]){ 23200ce3f217SMatthias Ringwald 23210ce3f217SMatthias Ringwald // handle cancelled outgoing connection 23220ce3f217SMatthias Ringwald // "If the cancellation was successful then, after the Command Complete event for the LE_Create_Connection_Cancel command, 23230ce3f217SMatthias Ringwald // either an LE Connection Complete or an LE Enhanced Connection Complete event shall be generated. 23240ce3f217SMatthias Ringwald // In either case, the event shall be sent with the error code Unknown Connection Identifier (0x02)." 23250ce3f217SMatthias Ringwald if (packet[3] == ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER){ 23261f468175SMatthias Ringwald // reset state 23270ce3f217SMatthias Ringwald hci_stack->le_connecting_state = LE_CONNECTING_IDLE; 23281f468175SMatthias Ringwald hci_stack->le_connecting_request = LE_CONNECTING_IDLE; 23290ce3f217SMatthias Ringwald // get outgoing connection conn struct for direct connect 23300ce3f217SMatthias Ringwald conn = gap_get_outgoing_connection(); 23310ce3f217SMatthias Ringwald } 23320ce3f217SMatthias Ringwald 23330ce3f217SMatthias Ringwald // outgoing le connection establishment is done 23340ce3f217SMatthias Ringwald if (conn){ 23350ce3f217SMatthias Ringwald // remove entry 23360ce3f217SMatthias Ringwald btstack_linked_list_remove(&hci_stack->connections, (btstack_linked_item_t *) conn); 23370ce3f217SMatthias Ringwald btstack_memory_hci_connection_free( conn ); 23380ce3f217SMatthias Ringwald } 23390ce3f217SMatthias Ringwald return; 23400ce3f217SMatthias Ringwald } 23410ce3f217SMatthias Ringwald #endif 23420ce3f217SMatthias Ringwald 23430ce3f217SMatthias Ringwald // on success, both hosts receive connection complete event 23440ce3f217SMatthias Ringwald if (packet[6] == HCI_ROLE_MASTER){ 23450ce3f217SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 23460ce3f217SMatthias Ringwald // if we're master on an le connection, it was an outgoing connection and we're done with it 23470ce3f217SMatthias Ringwald // note: no hci_connection_t object exists yet for connect with whitelist 23480ce3f217SMatthias Ringwald if (hci_is_le_connection_type(addr_type)){ 23490ce3f217SMatthias Ringwald hci_stack->le_connecting_state = LE_CONNECTING_IDLE; 23500ce3f217SMatthias Ringwald hci_stack->le_connecting_request = LE_CONNECTING_IDLE; 23510ce3f217SMatthias Ringwald } 23520ce3f217SMatthias Ringwald #endif 23530ce3f217SMatthias Ringwald } else { 23540ce3f217SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 23550ce3f217SMatthias Ringwald // if we're slave, it was an incoming connection, advertisements have stopped 23560ce3f217SMatthias Ringwald hci_stack->le_advertisements_active = false; 23570ce3f217SMatthias Ringwald #endif 23580ce3f217SMatthias Ringwald } 23590ce3f217SMatthias Ringwald 23600ce3f217SMatthias Ringwald // LE connections are auto-accepted, so just create a connection if there isn't one already 23610ce3f217SMatthias Ringwald if (!conn){ 23620ce3f217SMatthias Ringwald conn = create_connection_for_bd_addr_and_type(addr, addr_type); 23630ce3f217SMatthias Ringwald } 23640ce3f217SMatthias Ringwald 23650ce3f217SMatthias Ringwald // no memory, sorry. 23660ce3f217SMatthias Ringwald if (!conn){ 23670ce3f217SMatthias Ringwald return; 23680ce3f217SMatthias Ringwald } 23690ce3f217SMatthias Ringwald 23700ce3f217SMatthias Ringwald conn->state = OPEN; 23710ce3f217SMatthias Ringwald conn->role = packet[6]; 23720ce3f217SMatthias Ringwald conn->con_handle = hci_subevent_le_connection_complete_get_connection_handle(packet); 23730ce3f217SMatthias Ringwald conn->le_connection_interval = hci_subevent_le_connection_complete_get_conn_interval(packet); 23740ce3f217SMatthias Ringwald 23750ce3f217SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 23760ce3f217SMatthias Ringwald if (packet[6] == HCI_ROLE_SLAVE){ 23770ce3f217SMatthias Ringwald hci_update_advertisements_enabled_for_current_roles(); 23780ce3f217SMatthias Ringwald } 23790ce3f217SMatthias Ringwald #endif 23800ce3f217SMatthias Ringwald 2381dde9ff1eSMatthias Ringwald // init unenhanced att bearer mtu 2382dde9ff1eSMatthias Ringwald conn->att_connection.mtu = ATT_DEFAULT_MTU; 2383dde9ff1eSMatthias Ringwald conn->att_connection.mtu_exchanged = false; 2384dde9ff1eSMatthias Ringwald 23850ce3f217SMatthias Ringwald // TODO: store - role, peer address type, conn_interval, conn_latency, supervision timeout, master clock 23860ce3f217SMatthias Ringwald 23870ce3f217SMatthias Ringwald // restart timer 23880ce3f217SMatthias Ringwald // btstack_run_loop_set_timer(&conn->timeout, HCI_CONNECTION_TIMEOUT_MS); 23890ce3f217SMatthias Ringwald // btstack_run_loop_add_timer(&conn->timeout); 23900ce3f217SMatthias Ringwald 23910ce3f217SMatthias Ringwald log_info("New connection: handle %u, %s", conn->con_handle, bd_addr_to_str(conn->address)); 23920ce3f217SMatthias Ringwald 23930ce3f217SMatthias Ringwald hci_emit_nr_connections_changed(); 23940ce3f217SMatthias Ringwald } 23950ce3f217SMatthias Ringwald #endif 23960ce3f217SMatthias Ringwald 239717c6fe5cSMatthias Ringwald #ifdef ENABLE_CLASSIC 239817c6fe5cSMatthias Ringwald static bool hci_ssp_security_level_possible_for_io_cap(gap_security_level_t level, uint8_t io_cap_local, uint8_t io_cap_remote){ 239917c6fe5cSMatthias Ringwald if (io_cap_local == SSP_IO_CAPABILITY_UNKNOWN) return false; 240017c6fe5cSMatthias Ringwald // LEVEL_4 is tested by l2cap 24019a8f78c1SMatthias Ringwald // LEVEL 3 requires MITM protection -> check io capabilities if Authenticated is possible 24029a8f78c1SMatthias Ringwald // @see: Core Spec v5.3, Vol 3, Part C, Table 5.7 240317c6fe5cSMatthias Ringwald if (level >= LEVEL_3){ 24049a8f78c1SMatthias Ringwald // MITM not possible without keyboard or display 240517c6fe5cSMatthias Ringwald if (io_cap_remote >= SSP_IO_CAPABILITY_NO_INPUT_NO_OUTPUT) return false; 240617c6fe5cSMatthias Ringwald if (io_cap_local >= SSP_IO_CAPABILITY_NO_INPUT_NO_OUTPUT) return false; 24079a8f78c1SMatthias Ringwald 24089a8f78c1SMatthias Ringwald // MITM possible if one side has keyboard and the other has keyboard or display 24099a8f78c1SMatthias Ringwald if (io_cap_remote == SSP_IO_CAPABILITY_KEYBOARD_ONLY) return true; 24109a8f78c1SMatthias Ringwald if (io_cap_local == SSP_IO_CAPABILITY_KEYBOARD_ONLY) return true; 24119a8f78c1SMatthias Ringwald 24129a8f78c1SMatthias Ringwald // MITM not possible if one side has only display and other side has no keyboard 24139a8f78c1SMatthias Ringwald if (io_cap_remote == SSP_IO_CAPABILITY_DISPLAY_ONLY) return false; 24149a8f78c1SMatthias Ringwald if (io_cap_local == SSP_IO_CAPABILITY_DISPLAY_ONLY) return false; 241517c6fe5cSMatthias Ringwald } 241617c6fe5cSMatthias Ringwald // LEVEL 2 requires SSP, which is a given 241717c6fe5cSMatthias Ringwald return true; 241817c6fe5cSMatthias Ringwald } 24193817f9dfSMatthias Ringwald 24203817f9dfSMatthias Ringwald static bool btstack_is_null(uint8_t * data, uint16_t size){ 24213817f9dfSMatthias Ringwald uint16_t i; 24223817f9dfSMatthias Ringwald for (i=0; i < size ; i++){ 24233817f9dfSMatthias Ringwald if (data[i] != 0) { 24243817f9dfSMatthias Ringwald return false; 24253817f9dfSMatthias Ringwald } 24263817f9dfSMatthias Ringwald } 24273817f9dfSMatthias Ringwald return true; 24283817f9dfSMatthias Ringwald } 24293817f9dfSMatthias Ringwald 2430b3c4163bSMatthias Ringwald static void hci_ssp_assess_security_on_io_cap_request(hci_connection_t * conn){ 24312dd8985bSMatthias Ringwald // get requested security level 24322dd8985bSMatthias Ringwald gap_security_level_t requested_security_level = conn->requested_security_level; 24332dd8985bSMatthias Ringwald if (hci_stack->gap_secure_connections_only_mode){ 24342dd8985bSMatthias Ringwald requested_security_level = LEVEL_4; 24352dd8985bSMatthias Ringwald } 24362dd8985bSMatthias Ringwald 2437b3c4163bSMatthias Ringwald // assess security: LEVEL 4 requires SC 24382dd8985bSMatthias Ringwald // skip this preliminary test if remote features are not available yet to work around potential issue in ESP32 controller 24392dd8985bSMatthias Ringwald if ((requested_security_level == LEVEL_4) && 24402dd8985bSMatthias Ringwald ((conn->bonding_flags & BONDING_RECEIVED_REMOTE_FEATURES) != 0) && 24412dd8985bSMatthias Ringwald !hci_remote_sc_enabled(conn)){ 2442b3c4163bSMatthias Ringwald log_info("Level 4 required, but SC not supported -> abort"); 2443b3c4163bSMatthias Ringwald hci_pairing_complete(conn, ERROR_CODE_INSUFFICIENT_SECURITY); 2444b3c4163bSMatthias Ringwald connectionSetAuthenticationFlags(conn, AUTH_FLAG_SEND_IO_CAPABILITIES_NEGATIVE_REPLY); 2445b3c4163bSMatthias Ringwald return; 2446b3c4163bSMatthias Ringwald } 2447b3c4163bSMatthias Ringwald 2448b3c4163bSMatthias Ringwald // assess security based on io capabilities 2449b3c4163bSMatthias Ringwald if (conn->authentication_flags & AUTH_FLAG_RECV_IO_CAPABILITIES_RESPONSE){ 2450b3c4163bSMatthias Ringwald // responder: fully validate io caps of both sides as well as OOB data 2451b3c4163bSMatthias Ringwald bool security_possible = false; 2452b3c4163bSMatthias Ringwald security_possible = hci_ssp_security_level_possible_for_io_cap(requested_security_level, hci_stack->ssp_io_capability, conn->io_cap_response_io); 2453b3c4163bSMatthias Ringwald 2454b3c4163bSMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB 2455b3c4163bSMatthias Ringwald // We assume that both Controller can reach LEVEL 4, if one side has received P-192 and the other has received P-256, 2456b3c4163bSMatthias Ringwald // so we merge the OOB data availability 2457b3c4163bSMatthias Ringwald uint8_t have_oob_data = conn->io_cap_response_oob_data; 2458b3c4163bSMatthias Ringwald if (conn->classic_oob_c_192 != NULL){ 2459b3c4163bSMatthias Ringwald have_oob_data |= 1; 2460b3c4163bSMatthias Ringwald } 2461b3c4163bSMatthias Ringwald if (conn->classic_oob_c_256 != NULL){ 2462b3c4163bSMatthias Ringwald have_oob_data |= 2; 2463b3c4163bSMatthias Ringwald } 2464b3c4163bSMatthias Ringwald // for up to Level 3, either P-192 as well as P-256 will do 2465b3c4163bSMatthias Ringwald // if we don't support SC, then a) conn->classic_oob_c_256 will be NULL and b) remote should not report P-256 available 2466b3c4163bSMatthias Ringwald // if remote does not SC, we should not receive P-256 data either 2467b3c4163bSMatthias Ringwald if ((requested_security_level <= LEVEL_3) && (have_oob_data != 0)){ 2468b3c4163bSMatthias Ringwald security_possible = true; 2469b3c4163bSMatthias Ringwald } 2470b3c4163bSMatthias Ringwald // for Level 4, P-256 is needed 2471b3c4163bSMatthias Ringwald if ((requested_security_level == LEVEL_4 && ((have_oob_data & 2) != 0))){ 2472b3c4163bSMatthias Ringwald security_possible = true; 2473b3c4163bSMatthias Ringwald } 2474b3c4163bSMatthias Ringwald #endif 2475b3c4163bSMatthias Ringwald 2476b3c4163bSMatthias Ringwald if (security_possible == false){ 24772dd8985bSMatthias Ringwald log_info("IOCap/OOB insufficient for level %u -> abort", requested_security_level); 2478b3c4163bSMatthias Ringwald hci_pairing_complete(conn, ERROR_CODE_INSUFFICIENT_SECURITY); 2479b3c4163bSMatthias Ringwald connectionSetAuthenticationFlags(conn, AUTH_FLAG_SEND_IO_CAPABILITIES_NEGATIVE_REPLY); 2480b3c4163bSMatthias Ringwald return; 2481b3c4163bSMatthias Ringwald } 2482b3c4163bSMatthias Ringwald } else { 2483b3c4163bSMatthias Ringwald // initiator: remote io cap not yet, only check if we have ability for MITM protection if requested and OOB is not supported 2484*1fe968f5SMatthias Ringwald #ifndef ENABLE_CLASSIC_PAIRING_OOB 2485*1fe968f5SMatthias Ringwald #ifndef ENABLE_EXPLICIT_IO_CAPABILITIES_REPLY 2486b3c4163bSMatthias Ringwald if ((conn->requested_security_level >= LEVEL_3) && (hci_stack->ssp_io_capability >= SSP_IO_CAPABILITY_NO_INPUT_NO_OUTPUT)){ 2487b3c4163bSMatthias Ringwald log_info("Level 3+ required, but no input/output -> abort"); 2488b3c4163bSMatthias Ringwald hci_pairing_complete(conn, ERROR_CODE_INSUFFICIENT_SECURITY); 2489b3c4163bSMatthias Ringwald connectionSetAuthenticationFlags(conn, AUTH_FLAG_SEND_IO_CAPABILITIES_NEGATIVE_REPLY); 2490b3c4163bSMatthias Ringwald return; 2491b3c4163bSMatthias Ringwald } 2492b3c4163bSMatthias Ringwald #endif 2493*1fe968f5SMatthias Ringwald #endif 2494b3c4163bSMatthias Ringwald } 2495b3c4163bSMatthias Ringwald 2496b3c4163bSMatthias Ringwald #ifndef ENABLE_EXPLICIT_IO_CAPABILITIES_REPLY 2497b3c4163bSMatthias Ringwald if (hci_stack->ssp_io_capability != SSP_IO_CAPABILITY_UNKNOWN){ 2498b3c4163bSMatthias Ringwald connectionSetAuthenticationFlags(conn, AUTH_FLAG_SEND_IO_CAPABILITIES_REPLY); 2499b3c4163bSMatthias Ringwald } else { 2500b3c4163bSMatthias Ringwald connectionSetAuthenticationFlags(conn, AUTH_FLAG_SEND_IO_CAPABILITIES_NEGATIVE_REPLY); 2501b3c4163bSMatthias Ringwald } 2502b3c4163bSMatthias Ringwald #endif 2503b3c4163bSMatthias Ringwald } 2504b3c4163bSMatthias Ringwald 250517c6fe5cSMatthias Ringwald #endif 250617c6fe5cSMatthias Ringwald 2507c3b46f5aSMatthias Ringwald static void event_handler(uint8_t *packet, uint16_t size){ 25084f781026SMatthias Ringwald 25094f781026SMatthias Ringwald uint16_t event_length = packet[1]; 25104f781026SMatthias Ringwald 25114f781026SMatthias Ringwald // assert packet is complete 25124ea43905SMatthias Ringwald if (size != (event_length + 2u)){ 25134f781026SMatthias Ringwald log_error("event_handler called with packet of wrong size %d, expected %u => dropping packet", size, event_length + 2); 25144f781026SMatthias Ringwald return; 25154f781026SMatthias Ringwald } 25164f781026SMatthias Ringwald 25174f781026SMatthias Ringwald bd_addr_type_t addr_type; 25184f781026SMatthias Ringwald hci_con_handle_t handle; 25194f781026SMatthias Ringwald hci_connection_t * conn; 25204f781026SMatthias Ringwald int i; 25214f781026SMatthias Ringwald int create_connection_cmd; 25224f781026SMatthias Ringwald 25234f781026SMatthias Ringwald #ifdef ENABLE_CLASSIC 25245e91d96cSMatthias Ringwald hci_link_type_t link_type; 252548f33f37SMatthias Ringwald bd_addr_t addr; 25264f781026SMatthias Ringwald #endif 25274f781026SMatthias Ringwald 25284f781026SMatthias Ringwald // log_info("HCI:EVENT:%02x", hci_event_packet_get_type(packet)); 25294f781026SMatthias Ringwald 25304f781026SMatthias Ringwald switch (hci_event_packet_get_type(packet)) { 25314f781026SMatthias Ringwald 25324f781026SMatthias Ringwald case HCI_EVENT_COMMAND_COMPLETE: 25334f781026SMatthias Ringwald handle_command_complete_event(packet, size); 253456cf178bSmatthias.ringwald break; 253556cf178bSmatthias.ringwald 25367ec5eeaaSmatthias.ringwald case HCI_EVENT_COMMAND_STATUS: 25376bef4003SMatthias Ringwald // get num cmd packets - limit to 1 to reduce complexity 25386bef4003SMatthias Ringwald hci_stack->num_cmd_packets = packet[3] ? 1 : 0; 2539229331c6SMatthias Ringwald 2540229331c6SMatthias Ringwald // check command status to detected failed outgoing connections 2541c57fa566SMatthias Ringwald create_connection_cmd = 0; 2542c57fa566SMatthias Ringwald #ifdef ENABLE_CLASSIC 2543c57fa566SMatthias Ringwald if (HCI_EVENT_IS_COMMAND_STATUS(packet, hci_create_connection)){ 2544c57fa566SMatthias Ringwald create_connection_cmd = 1; 2545c57fa566SMatthias Ringwald } 2546c57fa566SMatthias Ringwald #endif 2547c57fa566SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 2548c57fa566SMatthias Ringwald if (HCI_EVENT_IS_COMMAND_STATUS(packet, hci_le_create_connection)){ 2549c57fa566SMatthias Ringwald create_connection_cmd = 1; 2550c57fa566SMatthias Ringwald } 2551c57fa566SMatthias Ringwald #endif 2552c57fa566SMatthias Ringwald if (create_connection_cmd) { 2553229331c6SMatthias Ringwald uint8_t status = hci_event_command_status_get_status(packet); 25548da98cbeSMatthias Ringwald addr_type = hci_stack->outgoing_addr_type; 25556ea9315cSMatthias Ringwald conn = hci_connection_for_bd_addr_and_type(hci_stack->outgoing_addr, addr_type); 25566ea9315cSMatthias 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); 2557229331c6SMatthias Ringwald 2558229331c6SMatthias Ringwald // reset outgoing address info 2559229331c6SMatthias Ringwald memset(hci_stack->outgoing_addr, 0, 6); 2560229331c6SMatthias Ringwald hci_stack->outgoing_addr_type = BD_ADDR_TYPE_UNKNOWN; 2561229331c6SMatthias Ringwald 25626ea9315cSMatthias Ringwald // on error 25636ea9315cSMatthias Ringwald if (status != ERROR_CODE_SUCCESS){ 2564f75e06adSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 25656ea9315cSMatthias Ringwald if (hci_is_le_connection_type(addr_type)){ 25666ea9315cSMatthias Ringwald hci_stack->le_connecting_state = LE_CONNECTING_IDLE; 2567f7e6a692SMatthias Ringwald hci_stack->le_connecting_request = LE_CONNECTING_IDLE; 25686ea9315cSMatthias Ringwald } 2569f75e06adSMatthias Ringwald #endif 2570229331c6SMatthias Ringwald // error => outgoing connection failed 25716ea9315cSMatthias Ringwald if (conn != NULL){ 2572229331c6SMatthias Ringwald hci_handle_connection_failed(conn, status); 2573229331c6SMatthias Ringwald } 2574229331c6SMatthias Ringwald } 25756ea9315cSMatthias Ringwald } 2576beb3c81dSMatthias Ringwald 2577beb3c81dSMatthias Ringwald #ifdef ENABLE_CLASSIC 2578beb3c81dSMatthias Ringwald if (HCI_EVENT_IS_COMMAND_STATUS(packet, hci_inquiry)) { 2579beb3c81dSMatthias Ringwald uint8_t status = hci_event_command_status_get_status(packet); 2580beb3c81dSMatthias Ringwald log_info("command status (inquiry), status %x", status); 2581beb3c81dSMatthias Ringwald if (status == ERROR_CODE_SUCCESS) { 2582beb3c81dSMatthias Ringwald hci_stack->inquiry_state = GAP_INQUIRY_STATE_ACTIVE; 2583beb3c81dSMatthias Ringwald } else { 2584beb3c81dSMatthias Ringwald hci_stack->inquiry_state = GAP_INQUIRY_STATE_IDLE; 2585beb3c81dSMatthias Ringwald } 2586beb3c81dSMatthias Ringwald } 2587beb3c81dSMatthias Ringwald #endif 25887ec5eeaaSmatthias.ringwald break; 25897ec5eeaaSmatthias.ringwald 25902e440c8aS[email protected] case HCI_EVENT_NUMBER_OF_COMPLETED_PACKETS:{ 25919784dac1SMatthias Ringwald if (size < 3) return; 25929784dac1SMatthias Ringwald uint16_t num_handles = packet[2]; 25934ea43905SMatthias Ringwald if (size != (3u + num_handles * 4u)) return; 25949784dac1SMatthias Ringwald uint16_t offset = 3; 25959784dac1SMatthias Ringwald for (i=0; i<num_handles;i++){ 25964ea43905SMatthias Ringwald handle = little_endian_read_16(packet, offset) & 0x0fffu; 25974ea43905SMatthias Ringwald offset += 2u; 2598f8fbdce0SMatthias Ringwald uint16_t num_packets = little_endian_read_16(packet, offset); 25994ea43905SMatthias Ringwald offset += 2u; 26002e440c8aS[email protected] 26015061f3afS[email protected] conn = hci_connection_for_handle(handle); 260256cf178bSmatthias.ringwald if (!conn){ 26039da54300S[email protected] log_error("hci_number_completed_packet lists unused con handle %u", handle); 260456cf178bSmatthias.ringwald continue; 260556cf178bSmatthias.ringwald } 260623bed257S[email protected] 2607ce41473eSMatthias Ringwald if (conn->num_packets_sent >= num_packets){ 2608ce41473eSMatthias Ringwald conn->num_packets_sent -= num_packets; 2609e35edcc1S[email protected] } else { 2610ce41473eSMatthias Ringwald log_error("hci_number_completed_packets, more packet slots freed then sent."); 2611ce41473eSMatthias Ringwald conn->num_packets_sent = 0; 2612e35edcc1S[email protected] } 2613ce41473eSMatthias Ringwald // log_info("hci_number_completed_packet %u processed for handle %u, outstanding %u", num_packets, handle, conn->num_packets_sent); 2614760b20efSMatthias Ringwald 2615760b20efSMatthias Ringwald #ifdef ENABLE_CLASSIC 2616760b20efSMatthias Ringwald // For SCO, we do the can_send_now_check here 2617760b20efSMatthias Ringwald hci_notify_if_sco_can_send_now(); 2618760b20efSMatthias Ringwald #endif 261956cf178bSmatthias.ringwald } 26206772a24cSmatthias.ringwald break; 26212e440c8aS[email protected] } 262235454696SMatthias Ringwald 262335454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 2624f5875de5SMatthias Ringwald case HCI_EVENT_INQUIRY_COMPLETE: 2625f5875de5SMatthias Ringwald if (hci_stack->inquiry_state == GAP_INQUIRY_STATE_ACTIVE){ 2626f5875de5SMatthias Ringwald hci_stack->inquiry_state = GAP_INQUIRY_STATE_IDLE; 2627f5875de5SMatthias Ringwald uint8_t event[] = { GAP_EVENT_INQUIRY_COMPLETE, 1, 0}; 2628f5875de5SMatthias Ringwald hci_emit_event(event, sizeof(event), 1); 2629f5875de5SMatthias Ringwald } 2630f5875de5SMatthias Ringwald break; 2631b7f1ee76SMatthias Ringwald case HCI_EVENT_REMOTE_NAME_REQUEST_COMPLETE: 2632b7f1ee76SMatthias Ringwald if (hci_stack->remote_name_state == GAP_REMOTE_NAME_STATE_W4_COMPLETE){ 2633b7f1ee76SMatthias Ringwald hci_stack->remote_name_state = GAP_REMOTE_NAME_STATE_IDLE; 2634b7f1ee76SMatthias Ringwald } 2635b7f1ee76SMatthias Ringwald break; 26361f7b95a1Smatthias.ringwald case HCI_EVENT_CONNECTION_REQUEST: 2637724d70a2SMatthias Ringwald reverse_bd_addr(&packet[2], addr); 26385e91d96cSMatthias Ringwald link_type = (hci_link_type_t) packet[11]; 263972cf8859SMatthias Ringwald 264072cf8859SMatthias Ringwald // CVE-2020-26555: reject incoming connection from device with same BD ADDR 264172cf8859SMatthias Ringwald if (memcmp(hci_stack->local_bd_addr, addr, 6) == 0){ 264272cf8859SMatthias Ringwald hci_stack->decline_reason = ERROR_CODE_CONNECTION_REJECTED_DUE_TO_UNACCEPTABLE_BD_ADDR; 264372cf8859SMatthias Ringwald bd_addr_copy(hci_stack->decline_addr, addr); 264472cf8859SMatthias Ringwald break; 264572cf8859SMatthias Ringwald } 264672cf8859SMatthias Ringwald 264707e010b6SMilanka Ringwald if (hci_stack->gap_classic_accept_callback != NULL){ 26485e91d96cSMatthias Ringwald if ((*hci_stack->gap_classic_accept_callback)(addr, link_type) == 0){ 26494536712cSMilanka Ringwald hci_stack->decline_reason = ERROR_CODE_CONNECTION_REJECTED_DUE_TO_UNACCEPTABLE_BD_ADDR; 265007e010b6SMilanka Ringwald bd_addr_copy(hci_stack->decline_addr, addr); 265107e010b6SMilanka Ringwald break; 265207e010b6SMilanka Ringwald } 265307e010b6SMilanka Ringwald } 265407e010b6SMilanka Ringwald 265537eaa4cfSmatthias.ringwald // TODO: eval COD 8-10 26565e91d96cSMatthias Ringwald log_info("Connection_incoming: %s, type %u", bd_addr_to_str(addr), (unsigned int) link_type); 26575e91d96cSMatthias Ringwald addr_type = (link_type == HCI_LINK_TYPE_ACL) ? BD_ADDR_TYPE_ACL : BD_ADDR_TYPE_SCO; 26582e77e513S[email protected] conn = hci_connection_for_bd_addr_and_type(addr, addr_type); 26591f7b95a1Smatthias.ringwald if (!conn) { 26605293c072S[email protected] conn = create_connection_for_bd_addr_and_type(addr, addr_type); 26611f7b95a1Smatthias.ringwald } 2662ce4c8fabSmatthias.ringwald if (!conn) { 2663ce4c8fabSmatthias.ringwald // CONNECTION REJECTED DUE TO LIMITED RESOURCES (0X0D) 26644536712cSMilanka Ringwald hci_stack->decline_reason = ERROR_CODE_CONNECTION_REJECTED_DUE_TO_LIMITED_RESOURCES; 2665058e3d6bSMatthias Ringwald bd_addr_copy(hci_stack->decline_addr, addr); 2666ce4c8fabSmatthias.ringwald break; 2667ce4c8fabSmatthias.ringwald } 26685cf766e8SMatthias Ringwald conn->role = HCI_ROLE_SLAVE; 266932ab9390Smatthias.ringwald conn->state = RECEIVED_CONNECTION_REQUEST; 2670f3a16b9aSMatthias Ringwald // store info about eSCO 26715e91d96cSMatthias Ringwald if (link_type == HCI_LINK_TYPE_ESCO){ 267276ccfb2aSMatthias Ringwald conn->remote_supported_features[0] |= 1; 2673f3a16b9aSMatthias Ringwald } 267432ab9390Smatthias.ringwald hci_run(); 26751f7b95a1Smatthias.ringwald break; 26761f7b95a1Smatthias.ringwald 26776772a24cSmatthias.ringwald case HCI_EVENT_CONNECTION_COMPLETE: 2678fe1ed1b8Smatthias.ringwald // Connection management 2679724d70a2SMatthias Ringwald reverse_bd_addr(&packet[5], addr); 26809da54300S[email protected] log_info("Connection_complete (status=%u) %s", packet[2], bd_addr_to_str(addr)); 2681f16129ceSMatthias Ringwald addr_type = BD_ADDR_TYPE_ACL; 26822e77e513S[email protected] conn = hci_connection_for_bd_addr_and_type(addr, addr_type); 2683fe1ed1b8Smatthias.ringwald if (conn) { 2684b448a0e7Smatthias.ringwald if (!packet[2]){ 2685c8e4258aSmatthias.ringwald conn->state = OPEN; 2686f8fbdce0SMatthias Ringwald conn->con_handle = little_endian_read_16(packet, 3); 26876909f064SMatthias Ringwald 26886909f064SMatthias Ringwald // queue get remote feature 2689ba018746SMatthias Ringwald conn->bonding_flags |= BONDING_REQUEST_REMOTE_FEATURES_PAGE_0; 2690ee091cf1Smatthias.ringwald 2691e6c51921SMatthias Ringwald // queue set supervision timeout if we're master 2692d821984bSMatthias Ringwald if ((hci_stack->link_supervision_timeout != HCI_LINK_SUPERVISION_TIMEOUT_DEFAULT) && (conn->role == HCI_ROLE_MASTER)){ 26938daf94bcSMatthias Ringwald connectionSetAuthenticationFlags(conn, AUTH_FLAG_WRITE_SUPERVISION_TIMEOUT); 26946909f064SMatthias Ringwald } 26956909f064SMatthias Ringwald 2696c785ef68Smatthias.ringwald // restart timer 2697528a4a3bSMatthias Ringwald btstack_run_loop_set_timer(&conn->timeout, HCI_CONNECTION_TIMEOUT_MS); 2698528a4a3bSMatthias Ringwald btstack_run_loop_add_timer(&conn->timeout); 2699c785ef68Smatthias.ringwald 27009da54300S[email protected] log_info("New connection: handle %u, %s", conn->con_handle, bd_addr_to_str(conn->address)); 270143bfb1bdSmatthias.ringwald 270243bfb1bdSmatthias.ringwald hci_emit_nr_connections_changed(); 2703b448a0e7Smatthias.ringwald } else { 27040bbba85bSMatthias Ringwald // connection failed 27050bbba85bSMatthias Ringwald hci_handle_connection_failed(conn, packet[2]); 2706fe1ed1b8Smatthias.ringwald } 2707fe1ed1b8Smatthias.ringwald } 27086772a24cSmatthias.ringwald break; 2709fe1ed1b8Smatthias.ringwald 271044d0e3d5S[email protected] case HCI_EVENT_SYNCHRONOUS_CONNECTION_COMPLETE: 2711724d70a2SMatthias Ringwald reverse_bd_addr(&packet[5], addr); 271244d0e3d5S[email protected] log_info("Synchronous Connection Complete (status=%u) %s", packet[2], bd_addr_to_str(addr)); 27131a06f663S[email protected] if (packet[2]){ 271444d0e3d5S[email protected] // connection failed 271544d0e3d5S[email protected] break; 271644d0e3d5S[email protected] } 27172e77e513S[email protected] conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_SCO); 2718e35edcc1S[email protected] if (!conn) { 2719e35edcc1S[email protected] conn = create_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_SCO); 2720e35edcc1S[email protected] } 2721e35edcc1S[email protected] if (!conn) { 2722e35edcc1S[email protected] break; 2723e35edcc1S[email protected] } 27241a06f663S[email protected] conn->state = OPEN; 2725f8fbdce0SMatthias Ringwald conn->con_handle = little_endian_read_16(packet, 3); 2726ee752bb8SMatthias Ringwald 2727ee752bb8SMatthias Ringwald #ifdef ENABLE_SCO_OVER_HCI 2728ee752bb8SMatthias Ringwald // update SCO 2729ee752bb8SMatthias Ringwald if (conn->address_type == BD_ADDR_TYPE_SCO && hci_stack->hci_transport && hci_stack->hci_transport->set_sco_config){ 2730ee752bb8SMatthias Ringwald hci_stack->hci_transport->set_sco_config(hci_stack->sco_voice_setting_active, hci_number_sco_connections()); 2731ee752bb8SMatthias Ringwald } 2732f234b250SMatthias Ringwald // trigger can send now 2733f234b250SMatthias Ringwald if (hci_have_usb_transport()){ 27341972f31fSMatthias Ringwald hci_stack->sco_can_send_now = true; 2735f234b250SMatthias Ringwald } 2736ee752bb8SMatthias Ringwald #endif 2737cb70c5abSMatthias Ringwald #ifdef HAVE_SCO_TRANSPORT 2738cb70c5abSMatthias Ringwald // configure sco transport 2739cb70c5abSMatthias Ringwald if (hci_stack->sco_transport != NULL){ 2740cb70c5abSMatthias Ringwald sco_format_t sco_format = ((hci_stack->sco_voice_setting_active & 0x03) == 0x03) ? SCO_FORMAT_8_BIT : SCO_FORMAT_16_BIT; 2741cb70c5abSMatthias Ringwald hci_stack->sco_transport->open(conn->con_handle, sco_format); 2742cb70c5abSMatthias Ringwald } 2743cb70c5abSMatthias Ringwald #endif 274444d0e3d5S[email protected] break; 274544d0e3d5S[email protected] 2746afd4e962S[email protected] case HCI_EVENT_READ_REMOTE_SUPPORTED_FEATURES_COMPLETE: 2747f8fbdce0SMatthias Ringwald handle = little_endian_read_16(packet, 3); 2748afd4e962S[email protected] conn = hci_connection_for_handle(handle); 2749afd4e962S[email protected] if (!conn) break; 2750afd4e962S[email protected] if (!packet[2]){ 27512f5c44baSMatthias Ringwald const uint8_t * features = &packet[5]; 27522f5c44baSMatthias Ringwald hci_handle_remote_features_page_0(conn, features); 27532f5c44baSMatthias Ringwald 27545ccef624SMatthias Ringwald // read extended features if possible 27555ccef624SMatthias Ringwald if (((hci_stack->local_supported_commands[1] & 1) != 0) && ((conn->remote_supported_features[0] & 2) != 0)) { 27565ccef624SMatthias Ringwald conn->bonding_flags |= BONDING_REQUEST_REMOTE_FEATURES_PAGE_1; 27575ccef624SMatthias Ringwald break; 27585ccef624SMatthias Ringwald } 27595ccef624SMatthias Ringwald } 27605ccef624SMatthias Ringwald hci_handle_remote_features_received(conn); 27615ccef624SMatthias Ringwald break; 27625ccef624SMatthias Ringwald 27635ccef624SMatthias Ringwald case HCI_EVENT_READ_REMOTE_EXTENDED_FEATURES_COMPLETE: 27645ccef624SMatthias Ringwald handle = little_endian_read_16(packet, 3); 27655ccef624SMatthias Ringwald conn = hci_connection_for_handle(handle); 27665ccef624SMatthias Ringwald if (!conn) break; 27675ccef624SMatthias Ringwald // status = ok, page = 1 276850c51a77SMatthias Ringwald if (!packet[2]) { 276950c51a77SMatthias Ringwald uint8_t page_number = packet[5]; 277050c51a77SMatthias Ringwald uint8_t maximum_page_number = packet[6]; 27715ccef624SMatthias Ringwald const uint8_t * features = &packet[7]; 277250c51a77SMatthias Ringwald bool done = false; 277350c51a77SMatthias Ringwald switch (page_number){ 277450c51a77SMatthias Ringwald case 1: 27752f5c44baSMatthias Ringwald hci_handle_remote_features_page_1(conn, features); 277650c51a77SMatthias Ringwald if (maximum_page_number >= 2){ 277750c51a77SMatthias Ringwald // get Secure Connections (Controller) from Page 2 if available 277850c51a77SMatthias Ringwald conn->bonding_flags |= BONDING_REQUEST_REMOTE_FEATURES_PAGE_2; 277950c51a77SMatthias Ringwald } else { 278050c51a77SMatthias Ringwald // otherwise, assume SC (Controller) == SC (Host) 278150c51a77SMatthias Ringwald if ((conn->bonding_flags & BONDING_REMOTE_SUPPORTS_SC_HOST) != 0){ 278250c51a77SMatthias Ringwald conn->bonding_flags |= BONDING_REMOTE_SUPPORTS_SC_CONTROLLER; 278350c51a77SMatthias Ringwald } 278450c51a77SMatthias Ringwald done = true; 278550c51a77SMatthias Ringwald } 278650c51a77SMatthias Ringwald break; 278750c51a77SMatthias Ringwald case 2: 278850c51a77SMatthias Ringwald hci_handle_remote_features_page_2(conn, features); 278950c51a77SMatthias Ringwald done = true; 279050c51a77SMatthias Ringwald break; 279150c51a77SMatthias Ringwald default: 279250c51a77SMatthias Ringwald break; 279350c51a77SMatthias Ringwald } 279450c51a77SMatthias Ringwald if (!done) break; 2795afd4e962S[email protected] } 2796de0df013SMatthias Ringwald hci_handle_remote_features_received(conn); 2797afd4e962S[email protected] break; 2798afd4e962S[email protected] 27997fde4af9Smatthias.ringwald case HCI_EVENT_LINK_KEY_REQUEST: 2800608f51bbSMatthias Ringwald // request handled by hci_run() 28018daf94bcSMatthias Ringwald hci_add_connection_flags_for_flipped_bd_addr(&packet[2], AUTH_FLAG_HANDLE_LINK_KEY_REQUEST); 2802608f51bbSMatthias Ringwald break; 28037fde4af9Smatthias.ringwald 28049ab95c90S[email protected] case HCI_EVENT_LINK_KEY_NOTIFICATION: { 28051714cbbdSMatthias Ringwald hci_event_link_key_request_get_bd_addr(packet, addr); 2806f16129ceSMatthias Ringwald conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL); 28079ab95c90S[email protected] if (!conn) break; 28081714cbbdSMatthias Ringwald 28091714cbbdSMatthias Ringwald hci_pairing_complete(conn, ERROR_CODE_SUCCESS); 28101714cbbdSMatthias Ringwald 28113817f9dfSMatthias Ringwald // CVE-2020-26555: ignore NULL link key 28123817f9dfSMatthias Ringwald // default link_key_type = INVALID_LINK_KEY asserts that NULL key won't be used for encryption 28133817f9dfSMatthias Ringwald if (btstack_is_null(&packet[8], 16)) break; 28143817f9dfSMatthias Ringwald 28157bdc6798S[email protected] link_key_type_t link_key_type = (link_key_type_t)packet[24]; 28169ab95c90S[email protected] // Change Connection Encryption keeps link key type 28179ab95c90S[email protected] if (link_key_type != CHANGED_COMBINATION_KEY){ 28189ab95c90S[email protected] conn->link_key_type = link_key_type; 28199ab95c90S[email protected] } 28203817f9dfSMatthias Ringwald 2821e9f98c4aSMatthias Ringwald // cache link key. link keys stored in little-endian format for legacy reasons 2822e9f98c4aSMatthias Ringwald memcpy(&conn->link_key, &packet[8], 16); 2823e9f98c4aSMatthias Ringwald 2824bec5f683SMatthias Ringwald // only store link key: 2825bec5f683SMatthias Ringwald // - if bondable enabled 2826bec5f683SMatthias Ringwald if (hci_stack->bondable == false) break; 28276edaed7fSMatthias Ringwald // - if security level sufficient 28286edaed7fSMatthias Ringwald if (gap_security_level_for_link_key_type(link_key_type) < conn->requested_security_level) break; 2829bec5f683SMatthias Ringwald // - for SSP, also check if remote side requested bonding as well 2830bec5f683SMatthias Ringwald if (conn->link_key_type != COMBINATION_KEY){ 2831532454f9SMatthias Ringwald bool remote_bonding = conn->io_cap_response_auth_req >= SSP_IO_AUTHREQ_MITM_PROTECTION_NOT_REQUIRED_DEDICATED_BONDING; 2832532454f9SMatthias Ringwald if (!remote_bonding){ 2833bec5f683SMatthias Ringwald break; 2834bec5f683SMatthias Ringwald } 2835bec5f683SMatthias Ringwald } 283655597469SMatthias Ringwald gap_store_link_key_for_bd_addr(addr, &packet[8], conn->link_key_type); 28377fde4af9Smatthias.ringwald break; 28389ab95c90S[email protected] } 28397fde4af9Smatthias.ringwald 28407fde4af9Smatthias.ringwald case HCI_EVENT_PIN_CODE_REQUEST: 28411714cbbdSMatthias Ringwald hci_event_pin_code_request_get_bd_addr(packet, addr); 28421714cbbdSMatthias Ringwald conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL); 28431714cbbdSMatthias Ringwald if (!conn) break; 28441714cbbdSMatthias Ringwald 28451714cbbdSMatthias Ringwald hci_pairing_started(conn, false); 2846a800d95eSMatthias Ringwald // abort pairing if: non-bondable mode (pin code request is not forwarded to app) 28473a9fb326S[email protected] if (!hci_stack->bondable ){ 28488daf94bcSMatthias Ringwald conn->authentication_flags |= AUTH_FLAG_DENY_PIN_CODE_REQUEST; 28491714cbbdSMatthias Ringwald hci_pairing_complete(conn, ERROR_CODE_PAIRING_NOT_ALLOWED); 2850f8fb5f6eS[email protected] hci_run(); 2851f8fb5f6eS[email protected] return; 28524c57c146S[email protected] } 2853a800d95eSMatthias Ringwald // abort pairing if: LEVEL_4 required (pin code request is not forwarded to app) 2854a800d95eSMatthias Ringwald if ((hci_stack->gap_secure_connections_only_mode) || (conn->requested_security_level == LEVEL_4)){ 2855a800d95eSMatthias Ringwald log_info("Level 4 required, but SC not supported -> abort"); 285650dcc63cSMatthias Ringwald conn->authentication_flags |= AUTH_FLAG_DENY_PIN_CODE_REQUEST; 285750dcc63cSMatthias Ringwald hci_pairing_complete(conn, ERROR_CODE_INSUFFICIENT_SECURITY); 285850dcc63cSMatthias Ringwald hci_run(); 285950dcc63cSMatthias Ringwald return; 286050dcc63cSMatthias Ringwald } 28617fde4af9Smatthias.ringwald break; 28627fde4af9Smatthias.ringwald 286350d7398cSMatthias Ringwald case HCI_EVENT_IO_CAPABILITY_RESPONSE: 286450d7398cSMatthias Ringwald hci_event_io_capability_response_get_bd_addr(packet, addr); 286550d7398cSMatthias Ringwald conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL); 286650d7398cSMatthias Ringwald if (!conn) break; 28671714cbbdSMatthias Ringwald 28688daf94bcSMatthias Ringwald hci_add_connection_flags_for_flipped_bd_addr(&packet[2], AUTH_FLAG_RECV_IO_CAPABILITIES_RESPONSE); 28691714cbbdSMatthias Ringwald hci_pairing_started(conn, true); 287050d7398cSMatthias Ringwald conn->io_cap_response_auth_req = hci_event_io_capability_response_get_authentication_requirements(packet); 2871e276e383SMatthias Ringwald conn->io_cap_response_io = hci_event_io_capability_response_get_io_capability(packet); 2872d22b82d6SMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB 2873d22b82d6SMatthias Ringwald conn->io_cap_response_oob_data = hci_event_io_capability_response_get_oob_data_present(packet); 2874d22b82d6SMatthias Ringwald #endif 287550d7398cSMatthias Ringwald break; 287650d7398cSMatthias Ringwald 28771d6b20aeS[email protected] case HCI_EVENT_IO_CAPABILITY_REQUEST: 28781714cbbdSMatthias Ringwald hci_event_io_capability_response_get_bd_addr(packet, addr); 28791714cbbdSMatthias Ringwald conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL); 28801714cbbdSMatthias Ringwald if (!conn) break; 28811714cbbdSMatthias Ringwald 2882c950c316SMatthias Ringwald hci_add_connection_flags_for_flipped_bd_addr(&packet[2], AUTH_FLAG_RECV_IO_CAPABILITIES_REQUEST); 28839671e615SMatthias Ringwald hci_connection_timestamp(conn); 28841714cbbdSMatthias Ringwald hci_pairing_started(conn, true); 2885dbe1a790S[email protected] break; 2886dbe1a790S[email protected] 28871849becdSMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB 28881849becdSMatthias Ringwald case HCI_EVENT_REMOTE_OOB_DATA_REQUEST: 28897ca4a7edSMatthias Ringwald hci_event_remote_oob_data_request_get_bd_addr(packet, addr); 28907ca4a7edSMatthias Ringwald conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL); 28917ca4a7edSMatthias Ringwald if (!conn) break; 28927ca4a7edSMatthias Ringwald 28937ca4a7edSMatthias Ringwald hci_connection_timestamp(conn); 28947ca4a7edSMatthias Ringwald 28957ca4a7edSMatthias Ringwald hci_pairing_started(conn, true); 28967ca4a7edSMatthias Ringwald 28977ca4a7edSMatthias Ringwald connectionSetAuthenticationFlags(conn, AUTH_FLAG_SEND_REMOTE_OOB_DATA_REPLY); 28981849becdSMatthias Ringwald break; 28991849becdSMatthias Ringwald #endif 29001849becdSMatthias Ringwald 2901dbe1a790S[email protected] case HCI_EVENT_USER_CONFIRMATION_REQUEST: 290217c6fe5cSMatthias Ringwald hci_event_user_confirmation_request_get_bd_addr(packet, addr); 2903367aedc0SMatthias Ringwald conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL); 2904367aedc0SMatthias Ringwald if (!conn) break; 2905367aedc0SMatthias Ringwald if (hci_ssp_security_level_possible_for_io_cap(conn->requested_security_level, hci_stack->ssp_io_capability, conn->io_cap_response_io)) { 2906367aedc0SMatthias Ringwald if (hci_stack->ssp_auto_accept){ 29078daf94bcSMatthias Ringwald hci_add_connection_flags_for_flipped_bd_addr(&packet[2], AUTH_FLAG_SEND_USER_CONFIRM_REPLY); 2908367aedc0SMatthias Ringwald }; 2909367aedc0SMatthias Ringwald } else { 2910367aedc0SMatthias Ringwald hci_pairing_complete(conn, ERROR_CODE_INSUFFICIENT_SECURITY); 2911367aedc0SMatthias Ringwald hci_add_connection_flags_for_flipped_bd_addr(&packet[2], AUTH_FLAG_SEND_USER_CONFIRM_NEGATIVE_REPLY); 2912367aedc0SMatthias Ringwald // don't forward event to app 2913367aedc0SMatthias Ringwald hci_run(); 2914367aedc0SMatthias Ringwald return; 2915367aedc0SMatthias Ringwald } 2916dbe1a790S[email protected] break; 2917dbe1a790S[email protected] 2918dbe1a790S[email protected] case HCI_EVENT_USER_PASSKEY_REQUEST: 2919367aedc0SMatthias Ringwald // Pairing using Passkey results in MITM protection. If Level 4 is required, support for SC is validated on IO Cap Request 2920367aedc0SMatthias Ringwald if (hci_stack->ssp_auto_accept){ 29218daf94bcSMatthias Ringwald hci_add_connection_flags_for_flipped_bd_addr(&packet[2], AUTH_FLAG_SEND_USER_PASSKEY_REPLY); 2922367aedc0SMatthias Ringwald }; 29231d6b20aeS[email protected] break; 29241849becdSMatthias Ringwald 29253dce6128SMatthias Ringwald case HCI_EVENT_MODE_CHANGE: 29263dce6128SMatthias Ringwald handle = hci_event_mode_change_get_handle(packet); 29273dce6128SMatthias Ringwald conn = hci_connection_for_handle(handle); 29283dce6128SMatthias Ringwald if (!conn) break; 29293dce6128SMatthias Ringwald conn->connection_mode = hci_event_mode_change_get_mode(packet); 29303dce6128SMatthias Ringwald log_info("HCI_EVENT_MODE_CHANGE, handle 0x%04x, mode %u", handle, conn->connection_mode); 29313dce6128SMatthias Ringwald break; 293235454696SMatthias Ringwald #endif 29331d6b20aeS[email protected] 2934f0944df2S[email protected] case HCI_EVENT_ENCRYPTION_CHANGE: 2935254b78eeSMatthias Ringwald handle = hci_event_encryption_change_get_connection_handle(packet); 2936f0944df2S[email protected] conn = hci_connection_for_handle(handle); 2937f0944df2S[email protected] if (!conn) break; 29384ea43905SMatthias Ringwald if (hci_event_encryption_change_get_status(packet) == 0u) { 2939254b78eeSMatthias Ringwald uint8_t encryption_enabled = hci_event_encryption_change_get_encryption_enabled(packet); 2940254b78eeSMatthias Ringwald if (encryption_enabled){ 2941573897a0SMatthias Ringwald if (hci_is_le_connection(conn)){ 2942573897a0SMatthias Ringwald // For LE, we accept connection as encrypted 29438daf94bcSMatthias Ringwald conn->authentication_flags |= AUTH_FLAG_CONNECTION_ENCRYPTED; 2944573897a0SMatthias Ringwald } 2945573897a0SMatthias Ringwald #ifdef ENABLE_CLASSIC 2946573897a0SMatthias Ringwald else { 2947fcaf38b9SMatthias Ringwald 2948fcaf38b9SMatthias Ringwald // dedicated bonding: send result and disconnect 2949fcaf38b9SMatthias Ringwald if (conn->bonding_flags & BONDING_DEDICATED){ 2950fcaf38b9SMatthias Ringwald conn->bonding_flags &= ~BONDING_DEDICATED; 2951fcaf38b9SMatthias Ringwald conn->bonding_flags |= BONDING_DISCONNECT_DEDICATED_DONE; 2952fcaf38b9SMatthias Ringwald conn->bonding_status = packet[2]; 2953fcaf38b9SMatthias Ringwald break; 2954fcaf38b9SMatthias Ringwald } 2955fcaf38b9SMatthias Ringwald 2956254b78eeSMatthias Ringwald // Detect Secure Connection -> Legacy Connection Downgrade Attack (BIAS) 2957254b78eeSMatthias Ringwald bool sc_used_during_pairing = gap_secure_connection_for_link_key_type(conn->link_key_type) != 0; 2958254b78eeSMatthias Ringwald bool connected_uses_aes_ccm = encryption_enabled == 2; 2959edc1ac20SMatthias Ringwald if (hci_stack->secure_connections_active && sc_used_during_pairing && !connected_uses_aes_ccm){ 2960254b78eeSMatthias Ringwald log_info("SC during pairing, but only E0 now -> abort"); 29619ece71c2SMatthias Ringwald conn->bonding_flags |= BONDING_DISCONNECT_SECURITY_BLOCK; 2962254b78eeSMatthias Ringwald break; 2963254b78eeSMatthias Ringwald } 2964254b78eeSMatthias Ringwald 2965aa2fe986SMatthias Ringwald // if AES-CCM is used, authentication used SC -> authentication was mutual and we can skip explicit authentication 2966aa2fe986SMatthias Ringwald if (connected_uses_aes_ccm){ 2967aa2fe986SMatthias Ringwald conn->authentication_flags |= AUTH_FLAG_CONNECTION_AUTHENTICATED; 2968aa2fe986SMatthias Ringwald } 2969aa2fe986SMatthias Ringwald 2970aa2fe986SMatthias Ringwald #ifdef ENABLE_TESTING_SUPPORT 2971aa2fe986SMatthias Ringwald // work around for issue with PTS dongle 2972aa2fe986SMatthias Ringwald conn->authentication_flags |= AUTH_FLAG_CONNECTION_AUTHENTICATED; 2973aa2fe986SMatthias Ringwald #endif 2974aa2fe986SMatthias Ringwald 29756e058d3fSMatthias Ringwald if ((hci_stack->local_supported_commands[0] & 0x80) != 0){ 29766e058d3fSMatthias Ringwald // For Classic, we need to validate encryption key size first, if possible (== supported by Controller) 2977573897a0SMatthias Ringwald conn->bonding_flags |= BONDING_SEND_READ_ENCRYPTION_KEY_SIZE; 29786e058d3fSMatthias Ringwald } else { 29796e058d3fSMatthias Ringwald // if not, pretend everything is perfect 29809866fdc7SMatthias Ringwald hci_handle_read_encryption_key_size_complete(conn, 16); 29816e058d3fSMatthias Ringwald } 2982573897a0SMatthias Ringwald } 2983573897a0SMatthias Ringwald #endif 2984f0944df2S[email protected] } else { 29858daf94bcSMatthias Ringwald conn->authentication_flags &= ~AUTH_FLAG_CONNECTION_ENCRYPTED; 2986f0944df2S[email protected] } 2987ad83dc6aS[email protected] } 2988573897a0SMatthias Ringwald 2989f0944df2S[email protected] break; 2990f0944df2S[email protected] 299135454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 29921eb2563eS[email protected] case HCI_EVENT_AUTHENTICATION_COMPLETE_EVENT: 2993abdad579SMatthias Ringwald handle = hci_event_authentication_complete_get_connection_handle(packet); 29941eb2563eS[email protected] conn = hci_connection_for_handle(handle); 29951eb2563eS[email protected] if (!conn) break; 2996ad83dc6aS[email protected] 2997dbd5dcc3SMatthias Ringwald // clear authentication active flag 2998dbd5dcc3SMatthias Ringwald conn->bonding_flags &= ~BONDING_SENT_AUTHENTICATE_REQUEST; 29991714cbbdSMatthias Ringwald hci_pairing_complete(conn, hci_event_authentication_complete_get_status(packet)); 3000dbd5dcc3SMatthias Ringwald 3001abdad579SMatthias Ringwald // authenticated only if auth status == 0 3002abdad579SMatthias Ringwald if (hci_event_authentication_complete_get_status(packet) == 0){ 3003abdad579SMatthias Ringwald // authenticated 30048daf94bcSMatthias Ringwald conn->authentication_flags |= AUTH_FLAG_CONNECTION_AUTHENTICATED; 3005abdad579SMatthias Ringwald 3006131ef17aSMatthias Ringwald // If not already encrypted, start encryption 30078daf94bcSMatthias Ringwald if ((conn->authentication_flags & AUTH_FLAG_CONNECTION_ENCRYPTED) == 0){ 30081eb2563eS[email protected] conn->bonding_flags |= BONDING_SEND_ENCRYPTION_REQUEST; 3009ad83dc6aS[email protected] break; 3010ad83dc6aS[email protected] } 3011abdad579SMatthias Ringwald } 3012abdad579SMatthias Ringwald 3013abdad579SMatthias Ringwald // emit updated security level 30141eb2563eS[email protected] hci_emit_security_level(handle, gap_security_level_for_connection(conn)); 30151eb2563eS[email protected] break; 30161714cbbdSMatthias Ringwald 30171714cbbdSMatthias Ringwald case HCI_EVENT_SIMPLE_PAIRING_COMPLETE: 30181714cbbdSMatthias Ringwald hci_event_simple_pairing_complete_get_bd_addr(packet, addr); 30191714cbbdSMatthias Ringwald conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL); 30201714cbbdSMatthias Ringwald if (!conn) break; 30211714cbbdSMatthias Ringwald 3022aa2fe986SMatthias Ringwald // treat successfully paired connection as authenticated 3023aa2fe986SMatthias Ringwald if (hci_event_simple_pairing_complete_get_status(packet) == ERROR_CODE_SUCCESS){ 3024f3aafff1SMatthias Ringwald conn->authentication_flags |= AUTH_FLAG_CONNECTION_AUTHENTICATED; 3025aa2fe986SMatthias Ringwald } 3026aa2fe986SMatthias Ringwald 30271714cbbdSMatthias Ringwald hci_pairing_complete(conn, hci_event_simple_pairing_complete_get_status(packet)); 30281714cbbdSMatthias Ringwald break; 302935454696SMatthias Ringwald #endif 303034d2123cS[email protected] 303186805605S[email protected] // HCI_EVENT_DISCONNECTION_COMPLETE 3032ccda6e14S[email protected] // has been split, to first notify stack before shutting connection down 3033ccda6e14S[email protected] // see end of function, too. 3034a4f30ec0S[email protected] case HCI_EVENT_DISCONNECTION_COMPLETE: 3035a4f30ec0S[email protected] if (packet[2]) break; // status != 0 3036f8fbdce0SMatthias Ringwald handle = little_endian_read_16(packet, 3); 303781d2bdb2SMatthias Ringwald // drop outgoing ACL fragments if it is for closed connection and release buffer if tx not active 30384ea43905SMatthias Ringwald if (hci_stack->acl_fragmentation_total_size > 0u) { 3039c6a37cfdSMatthias Ringwald if (handle == READ_ACL_CONNECTION_HANDLE(hci_stack->hci_packet_buffer)){ 30404ea43905SMatthias Ringwald int release_buffer = hci_stack->acl_fragmentation_tx_active == 0u; 304181d2bdb2SMatthias Ringwald log_info("drop fragmented ACL data for closed connection, release buffer %u", release_buffer); 3042c6a37cfdSMatthias Ringwald hci_stack->acl_fragmentation_total_size = 0; 3043c6a37cfdSMatthias Ringwald hci_stack->acl_fragmentation_pos = 0; 304481d2bdb2SMatthias Ringwald if (release_buffer){ 304581d2bdb2SMatthias Ringwald hci_release_packet_buffer(); 304681d2bdb2SMatthias Ringwald } 3047c6a37cfdSMatthias Ringwald } 3048c6a37cfdSMatthias Ringwald } 304935454696SMatthias Ringwald 3050c6a37cfdSMatthias Ringwald conn = hci_connection_for_handle(handle); 3051c6a37cfdSMatthias Ringwald if (!conn) break; 30521714cbbdSMatthias Ringwald #ifdef ENABLE_CLASSIC 30531714cbbdSMatthias Ringwald // pairing failed if it was ongoing 30541714cbbdSMatthias Ringwald hci_pairing_complete(conn, ERROR_CODE_REMOTE_USER_TERMINATED_CONNECTION); 30551714cbbdSMatthias Ringwald #endif 3056046ec007SMatthias Ringwald // mark connection for shutdown 3057a70e17d4SMatthias Ringwald conn->state = RECEIVED_DISCONNECTION_COMPLETE; 3058046ec007SMatthias Ringwald 3059046ec007SMatthias Ringwald // emit dedicatd bonding event 3060046ec007SMatthias Ringwald if (conn->bonding_flags & BONDING_EMIT_COMPLETE_ON_DISCONNECT){ 3061046ec007SMatthias Ringwald hci_emit_dedicated_bonding_result(conn->address, conn->bonding_status); 3062046ec007SMatthias Ringwald } 3063046ec007SMatthias Ringwald 306435454696SMatthias Ringwald #ifdef ENABLE_BLE 3065d70217a2SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 3066046ec007SMatthias Ringwald // re-enable advertisements for le connections if active 30672b6ab3e6SMatthias Ringwald if (hci_is_le_connection(conn)){ 3068bbc366e6SMatthias Ringwald hci_update_advertisements_enabled_for_current_roles(); 30699a2e4658SMatthias Ringwald } 307035454696SMatthias Ringwald #endif 3071d70217a2SMatthias Ringwald #endif 3072ccda6e14S[email protected] break; 30736772a24cSmatthias.ringwald 3074c68bdf90Smatthias.ringwald case HCI_EVENT_HARDWARE_ERROR: 3075313e5f9cSMatthias Ringwald log_error("Hardware Error: 0x%02x", packet[2]); 3076d23838ecSMatthias Ringwald if (hci_stack->hardware_error_callback){ 3077c2e1fa60SMatthias Ringwald (*hci_stack->hardware_error_callback)(packet[2]); 30787586ee35S[email protected] } else { 30797586ee35S[email protected] // if no special requests, just reboot stack 30807586ee35S[email protected] hci_power_control_off(); 30817586ee35S[email protected] hci_power_control_on(); 3082c68bdf90Smatthias.ringwald } 3083c68bdf90Smatthias.ringwald break; 3084c68bdf90Smatthias.ringwald 30850e6f3837SMatthias Ringwald #ifdef ENABLE_CLASSIC 30865cf766e8SMatthias Ringwald case HCI_EVENT_ROLE_CHANGE: 30875cf766e8SMatthias Ringwald if (packet[2]) break; // status != 0 3088c4c88f1bSJakob Krantz reverse_bd_addr(&packet[3], addr); 3089f16129ceSMatthias Ringwald addr_type = BD_ADDR_TYPE_ACL; 3090c4c88f1bSJakob Krantz conn = hci_connection_for_bd_addr_and_type(addr, addr_type); 3091c4c88f1bSJakob Krantz if (!conn) break; 30925cf766e8SMatthias Ringwald conn->role = packet[9]; 30935cf766e8SMatthias Ringwald break; 30940e6f3837SMatthias Ringwald #endif 30955cf766e8SMatthias Ringwald 309663fa3374SMatthias Ringwald case HCI_EVENT_TRANSPORT_PACKET_SENT: 3097d051460cS[email protected] // release packet buffer only for asynchronous transport and if there are not further fragements 30984fa24b5fS[email protected] if (hci_transport_synchronous()) { 309963fa3374SMatthias Ringwald log_error("Synchronous HCI Transport shouldn't send HCI_EVENT_TRANSPORT_PACKET_SENT"); 31004fa24b5fS[email protected] return; // instead of break: to avoid re-entering hci_run() 31014fa24b5fS[email protected] } 310281d2bdb2SMatthias Ringwald hci_stack->acl_fragmentation_tx_active = 0; 3103d051460cS[email protected] if (hci_stack->acl_fragmentation_total_size) break; 3104d051460cS[email protected] hci_release_packet_buffer(); 3105701e3307SMatthias Ringwald 310663fa3374SMatthias Ringwald // L2CAP receives this event via the hci_emit_event below 310763fa3374SMatthias Ringwald 310835454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 310963fa3374SMatthias Ringwald // For SCO, we do the can_send_now_check here 3110701e3307SMatthias Ringwald hci_notify_if_sco_can_send_now(); 311135454696SMatthias Ringwald #endif 31126b4af23dS[email protected] break; 31136b4af23dS[email protected] 311435454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 311563fa3374SMatthias Ringwald case HCI_EVENT_SCO_CAN_SEND_NOW: 311663fa3374SMatthias Ringwald // For SCO, we do the can_send_now_check here 31171972f31fSMatthias Ringwald hci_stack->sco_can_send_now = true; 311863fa3374SMatthias Ringwald hci_notify_if_sco_can_send_now(); 311963fa3374SMatthias Ringwald return; 31201cfb383eSMatthias Ringwald 31211cfb383eSMatthias Ringwald // explode inquriy results for easier consumption 31221cfb383eSMatthias Ringwald case HCI_EVENT_INQUIRY_RESULT: 31231cfb383eSMatthias Ringwald case HCI_EVENT_INQUIRY_RESULT_WITH_RSSI: 31241cfb383eSMatthias Ringwald case HCI_EVENT_EXTENDED_INQUIRY_RESPONSE: 31259784dac1SMatthias Ringwald gap_inquiry_explode(packet, size); 31261cfb383eSMatthias Ringwald break; 312735454696SMatthias Ringwald #endif 312863fa3374SMatthias Ringwald 3129a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE 31305909f7f2Smatthias.ringwald case HCI_EVENT_LE_META: 31315909f7f2Smatthias.ringwald switch (packet[2]){ 3132d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 313357c9da5bS[email protected] case HCI_SUBEVENT_LE_ADVERTISING_REPORT: 31344f4e0224SMatthias Ringwald // log_info("advertising report received"); 31356fab74dbSMatthias Ringwald if (!hci_stack->le_scanning_enabled) break; 313657c9da5bS[email protected] le_handle_advertisement_report(packet, size); 31377bdc6798S[email protected] break; 3138d70217a2SMatthias Ringwald #endif 31395909f7f2Smatthias.ringwald case HCI_SUBEVENT_LE_CONNECTION_COMPLETE: 31400ce3f217SMatthias Ringwald event_handle_le_connection_complete(packet); 31415909f7f2Smatthias.ringwald break; 31425909f7f2Smatthias.ringwald 3143f8fbdce0SMatthias Ringwald // log_info("LE buffer size: %u, count %u", little_endian_read_16(packet,6), packet[8]); 3144c9db5c21SMilanka Ringwald case HCI_SUBEVENT_LE_CONNECTION_UPDATE_COMPLETE: 3145c9db5c21SMilanka Ringwald handle = hci_subevent_le_connection_update_complete_get_connection_handle(packet); 3146c9db5c21SMilanka Ringwald conn = hci_connection_for_handle(handle); 3147c9db5c21SMilanka Ringwald if (!conn) break; 3148c9db5c21SMilanka Ringwald conn->le_connection_interval = hci_subevent_le_connection_update_complete_get_conn_interval(packet); 3149c9db5c21SMilanka Ringwald break; 315065a46ef3S[email protected] 315173cd8a2aSMatthias Ringwald case HCI_SUBEVENT_LE_REMOTE_CONNECTION_PARAMETER_REQUEST: 315273cd8a2aSMatthias Ringwald // connection 315373cd8a2aSMatthias Ringwald handle = hci_subevent_le_remote_connection_parameter_request_get_connection_handle(packet); 315473cd8a2aSMatthias Ringwald conn = hci_connection_for_handle(handle); 315573cd8a2aSMatthias Ringwald if (conn) { 315673cd8a2aSMatthias Ringwald // read arguments 315773cd8a2aSMatthias Ringwald uint16_t le_conn_interval_min = hci_subevent_le_remote_connection_parameter_request_get_interval_min(packet); 315873cd8a2aSMatthias Ringwald uint16_t le_conn_interval_max = hci_subevent_le_remote_connection_parameter_request_get_interval_max(packet); 315973cd8a2aSMatthias Ringwald uint16_t le_conn_latency = hci_subevent_le_remote_connection_parameter_request_get_latency(packet); 316073cd8a2aSMatthias Ringwald uint16_t le_supervision_timeout = hci_subevent_le_remote_connection_parameter_request_get_timeout(packet); 316173cd8a2aSMatthias Ringwald 316273cd8a2aSMatthias Ringwald // validate against current connection parameter range 316373cd8a2aSMatthias Ringwald le_connection_parameter_range_t existing_range; 316473cd8a2aSMatthias Ringwald gap_get_connection_parameter_range(&existing_range); 316573cd8a2aSMatthias 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); 316673cd8a2aSMatthias Ringwald if (update_parameter){ 316773cd8a2aSMatthias Ringwald conn->le_con_parameter_update_state = CON_PARAMETER_UPDATE_REPLY; 316873cd8a2aSMatthias Ringwald conn->le_conn_interval_min = le_conn_interval_min; 316973cd8a2aSMatthias Ringwald conn->le_conn_interval_max = le_conn_interval_max; 317073cd8a2aSMatthias Ringwald conn->le_conn_latency = le_conn_latency; 317173cd8a2aSMatthias Ringwald conn->le_supervision_timeout = le_supervision_timeout; 317273cd8a2aSMatthias Ringwald } else { 3173c3898ca4SMatthias Ringwald conn->le_con_parameter_update_state = CON_PARAMETER_UPDATE_NEGATIVE_REPLY; 317473cd8a2aSMatthias Ringwald } 317573cd8a2aSMatthias Ringwald } 317673cd8a2aSMatthias Ringwald break; 31770f3b27c5SMatthias Ringwald #ifdef ENABLE_LE_LIMIT_ACL_FRAGMENT_BY_MAX_OCTETS 31780f3b27c5SMatthias Ringwald case HCI_SUBEVENT_LE_DATA_LENGTH_CHANGE: 31790f3b27c5SMatthias Ringwald handle = hci_subevent_le_data_length_change_get_connection_handle(packet); 31800f3b27c5SMatthias Ringwald conn = hci_connection_for_handle(handle); 31810f3b27c5SMatthias Ringwald if (conn) { 31820f3b27c5SMatthias Ringwald conn->le_max_tx_octets = hci_subevent_le_data_length_change_get_max_tx_octets(packet); 31830f3b27c5SMatthias Ringwald } 31840f3b27c5SMatthias Ringwald break; 31850f3b27c5SMatthias Ringwald #endif 31865909f7f2Smatthias.ringwald default: 31875909f7f2Smatthias.ringwald break; 31885909f7f2Smatthias.ringwald } 31895909f7f2Smatthias.ringwald break; 31905909f7f2Smatthias.ringwald #endif 31910b36101dSMatthias Ringwald case HCI_EVENT_VENDOR_SPECIFIC: 31920b36101dSMatthias Ringwald // Vendor specific commands often create vendor specific event instead of num completed packets 31930b36101dSMatthias Ringwald // To avoid getting stuck as num_cmds_packets is zero, reset it to 1 for controllers with this behaviour 31940b36101dSMatthias Ringwald switch (hci_stack->manufacturer){ 31950b36101dSMatthias Ringwald case BLUETOOTH_COMPANY_ID_CAMBRIDGE_SILICON_RADIO: 31960b36101dSMatthias Ringwald hci_stack->num_cmd_packets = 1; 31970b36101dSMatthias Ringwald break; 31980b36101dSMatthias Ringwald default: 31990b36101dSMatthias Ringwald break; 32000b36101dSMatthias Ringwald } 32010b36101dSMatthias Ringwald break; 32026772a24cSmatthias.ringwald default: 32036772a24cSmatthias.ringwald break; 3204fe1ed1b8Smatthias.ringwald } 3205fe1ed1b8Smatthias.ringwald 320667c6c9dcSMatthias Ringwald handle_event_for_current_stack_state(packet, size); 320789db417bSmatthias.ringwald 320886805605S[email protected] // notify upper stack 3209d6b06661SMatthias Ringwald hci_emit_event(packet, size, 0); // don't dump, already happened in packet handler 321094ab26f8Smatthias.ringwald 321186805605S[email protected] // moved here to give upper stack a chance to close down everything with hci_connection_t intact 3212797b2a3fSMatthias Ringwald if ((hci_event_packet_get_type(packet) == HCI_EVENT_DISCONNECTION_COMPLETE) && (packet[2] == 0)){ 3213f8fbdce0SMatthias Ringwald handle = little_endian_read_16(packet, 3); 321405ae8de3SMatthias Ringwald hci_connection_t * aConn = hci_connection_for_handle(handle); 3215046ec007SMatthias Ringwald // discard connection if app did not trigger a reconnect in the event handler 3216797b2a3fSMatthias Ringwald if (aConn && aConn->state == RECEIVED_DISCONNECTION_COMPLETE){ 321705ae8de3SMatthias Ringwald hci_shutdown_connection(aConn); 3218b0136355SMatthias Ringwald } 321986805605S[email protected] } 322086805605S[email protected] 322194ab26f8Smatthias.ringwald // execute main loop 322294ab26f8Smatthias.ringwald hci_run(); 322316833f0aSmatthias.ringwald } 322416833f0aSmatthias.ringwald 322535454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 32266f28d2eeSMatthias Ringwald 32276be3cf7fSMatthias Ringwald #ifdef ENABLE_SCO_OVER_HCI 32286f28d2eeSMatthias Ringwald static void sco_tx_timeout_handler(btstack_timer_source_t * ts); 32296f28d2eeSMatthias Ringwald static void sco_schedule_tx(hci_connection_t * conn); 32306f28d2eeSMatthias Ringwald 32316f28d2eeSMatthias Ringwald static void sco_tx_timeout_handler(btstack_timer_source_t * ts){ 323259c33575SMatthias Ringwald log_debug("SCO TX Timeout"); 32335a6b2dbdSMatthias Ringwald hci_con_handle_t con_handle = (hci_con_handle_t) (uintptr_t) btstack_run_loop_get_timer_context(ts); 32346f28d2eeSMatthias Ringwald hci_connection_t * conn = hci_connection_for_handle(con_handle); 32356f28d2eeSMatthias Ringwald if (!conn) return; 32366f28d2eeSMatthias Ringwald 3237afaddd67SMatthias Ringwald // trigger send 3238afaddd67SMatthias Ringwald conn->sco_tx_ready = 1; 3239e4157653SMatthias Ringwald // extra packet if CVSD but SCO buffer is too short 3240a1df452eSMatthias Ringwald if (((hci_stack->sco_voice_setting_active & 0x03) != 0x03) && (hci_stack->sco_data_packet_length < 123)){ 3241e4157653SMatthias Ringwald conn->sco_tx_ready++; 3242e4157653SMatthias Ringwald } 3243afaddd67SMatthias Ringwald hci_notify_if_sco_can_send_now(); 32446f28d2eeSMatthias Ringwald } 32456f28d2eeSMatthias Ringwald 324659c33575SMatthias Ringwald 324759c33575SMatthias Ringwald #define SCO_TX_AFTER_RX_MS (6) 324859c33575SMatthias Ringwald 32496f28d2eeSMatthias Ringwald static void sco_schedule_tx(hci_connection_t * conn){ 325059c33575SMatthias Ringwald 32516f28d2eeSMatthias Ringwald uint32_t now = btstack_run_loop_get_time_ms(); 325259c33575SMatthias Ringwald uint32_t sco_tx_ms = conn->sco_rx_ms + SCO_TX_AFTER_RX_MS; 325359c33575SMatthias Ringwald int time_delta_ms = sco_tx_ms - now; 325459c33575SMatthias Ringwald 325559c33575SMatthias Ringwald btstack_timer_source_t * timer = (conn->sco_rx_count & 1) ? &conn->timeout : &conn->timeout_sco; 325659c33575SMatthias Ringwald 325759c33575SMatthias Ringwald // log_error("SCO TX at %u in %u", (int) sco_tx_ms, time_delta_ms); 3258ddbec4ceSMatthias Ringwald btstack_run_loop_remove_timer(timer); 325959c33575SMatthias Ringwald btstack_run_loop_set_timer(timer, time_delta_ms); 326059c33575SMatthias Ringwald btstack_run_loop_set_timer_context(timer, (void *) (uintptr_t) conn->con_handle); 326159c33575SMatthias Ringwald btstack_run_loop_set_timer_handler(timer, &sco_tx_timeout_handler); 326259c33575SMatthias Ringwald btstack_run_loop_add_timer(timer); 32636f28d2eeSMatthias Ringwald } 32646be3cf7fSMatthias Ringwald #endif 32656f28d2eeSMatthias Ringwald 3266c91d150bS[email protected] static void sco_handler(uint8_t * packet, uint16_t size){ 32670b3f95dfSMatthias Ringwald // lookup connection struct 32682b838201SMatthias Ringwald hci_con_handle_t con_handle = READ_SCO_CONNECTION_HANDLE(packet); 32692b838201SMatthias Ringwald hci_connection_t * conn = hci_connection_for_handle(con_handle); 32700b3f95dfSMatthias Ringwald if (!conn) return; 32710b3f95dfSMatthias Ringwald 32726be3cf7fSMatthias Ringwald #ifdef ENABLE_SCO_OVER_HCI 3273760b20efSMatthias Ringwald // CSR 8811 prefixes 60 byte SCO packet in transparent mode with 20 zero bytes -> skip first 20 payload bytes 3274760b20efSMatthias Ringwald if (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_CAMBRIDGE_SILICON_RADIO){ 3275a1df452eSMatthias Ringwald if ((size == 83) && ((hci_stack->sco_voice_setting_active & 0x03) == 0x03)){ 3276760b20efSMatthias Ringwald packet[2] = 0x3c; 3277760b20efSMatthias Ringwald memmove(&packet[3], &packet[23], 63); 3278760b20efSMatthias Ringwald size = 63; 32790b3f95dfSMatthias Ringwald } 32800b3f95dfSMatthias Ringwald } 3281760b20efSMatthias Ringwald 3282f234b250SMatthias Ringwald if (hci_have_usb_transport()){ 3283f234b250SMatthias Ringwald // Nothing to do 3284f234b250SMatthias Ringwald } else { 328549205f5dSMatthias 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); 3286760b20efSMatthias Ringwald if (hci_stack->synchronous_flow_control_enabled == 0){ 32876f28d2eeSMatthias Ringwald uint32_t now = btstack_run_loop_get_time_ms(); 328859c33575SMatthias Ringwald 328959c33575SMatthias Ringwald if (!conn->sco_rx_valid){ 329059c33575SMatthias Ringwald // ignore first 10 packets 32916f28d2eeSMatthias Ringwald conn->sco_rx_count++; 329259c33575SMatthias Ringwald // log_debug("sco rx count %u", conn->sco_rx_count); 329359c33575SMatthias Ringwald if (conn->sco_rx_count == 10) { 329459c33575SMatthias Ringwald // use first timestamp as is and pretent it just started 32956f28d2eeSMatthias Ringwald conn->sco_rx_ms = now; 32966f28d2eeSMatthias Ringwald conn->sco_rx_valid = 1; 329759c33575SMatthias Ringwald conn->sco_rx_count = 0; 329859c33575SMatthias Ringwald sco_schedule_tx(conn); 329959c33575SMatthias Ringwald } 330059c33575SMatthias Ringwald } else { 330159c33575SMatthias Ringwald // track expected arrival timme 330259c33575SMatthias Ringwald conn->sco_rx_count++; 330359c33575SMatthias Ringwald conn->sco_rx_ms += 7; 330459c33575SMatthias Ringwald int delta = (int32_t) (now - conn->sco_rx_ms); 330559c33575SMatthias Ringwald if (delta > 0){ 330659c33575SMatthias Ringwald conn->sco_rx_ms++; 330759c33575SMatthias Ringwald } 330859c33575SMatthias Ringwald // log_debug("sco rx %u", conn->sco_rx_ms); 33096f28d2eeSMatthias Ringwald sco_schedule_tx(conn); 33106f28d2eeSMatthias Ringwald } 3311760b20efSMatthias Ringwald } 3312f234b250SMatthias Ringwald } 33136be3cf7fSMatthias Ringwald #endif 33146be3cf7fSMatthias Ringwald 33150b3f95dfSMatthias Ringwald // deliver to app 33160b3f95dfSMatthias Ringwald if (hci_stack->sco_packet_handler) { 33170b3f95dfSMatthias Ringwald hci_stack->sco_packet_handler(HCI_SCO_DATA_PACKET, 0, packet, size); 33180b3f95dfSMatthias Ringwald } 33190b3f95dfSMatthias Ringwald 3320ed325439SMatthias Ringwald #ifdef HAVE_SCO_TRANSPORT 3321ed325439SMatthias Ringwald // We can send one packet for each received packet 3322ed325439SMatthias Ringwald conn->sco_tx_ready++; 3323ed325439SMatthias Ringwald hci_notify_if_sco_can_send_now(); 3324ed325439SMatthias Ringwald #endif 3325ed325439SMatthias Ringwald 33260b3f95dfSMatthias Ringwald #ifdef ENABLE_HCI_CONTROLLER_TO_HOST_FLOW_CONTROL 33272b838201SMatthias Ringwald conn->num_packets_completed++; 33282b838201SMatthias Ringwald hci_stack->host_completed_packets = 1; 33292b838201SMatthias Ringwald hci_run(); 33302b838201SMatthias Ringwald #endif 3331c91d150bS[email protected] } 333235454696SMatthias Ringwald #endif 3333c91d150bS[email protected] 33340a57e69fSmatthias.ringwald static void packet_handler(uint8_t packet_type, uint8_t *packet, uint16_t size){ 33355bb5bc3eS[email protected] hci_dump_packet(packet_type, 1, packet, size); 333610e830c9Smatthias.ringwald switch (packet_type) { 333710e830c9Smatthias.ringwald case HCI_EVENT_PACKET: 333810e830c9Smatthias.ringwald event_handler(packet, size); 333910e830c9Smatthias.ringwald break; 334010e830c9Smatthias.ringwald case HCI_ACL_DATA_PACKET: 334110e830c9Smatthias.ringwald acl_handler(packet, size); 334210e830c9Smatthias.ringwald break; 334335454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 3344c91d150bS[email protected] case HCI_SCO_DATA_PACKET: 3345c91d150bS[email protected] sco_handler(packet, size); 3346202c8a4cSMatthias Ringwald break; 334735454696SMatthias Ringwald #endif 334810e830c9Smatthias.ringwald default: 334910e830c9Smatthias.ringwald break; 335010e830c9Smatthias.ringwald } 335110e830c9Smatthias.ringwald } 335210e830c9Smatthias.ringwald 3353d6b06661SMatthias Ringwald /** 3354d6b06661SMatthias Ringwald * @brief Add event packet handler. 3355d6b06661SMatthias Ringwald */ 3356d6b06661SMatthias Ringwald void hci_add_event_handler(btstack_packet_callback_registration_t * callback_handler){ 3357d6b06661SMatthias Ringwald btstack_linked_list_add_tail(&hci_stack->event_handlers, (btstack_linked_item_t*) callback_handler); 3358d6b06661SMatthias Ringwald } 3359d6b06661SMatthias Ringwald 3360d6b06661SMatthias Ringwald 3361fcadd0caSmatthias.ringwald /** Register HCI packet handlers */ 33623d50b4baSMatthias Ringwald void hci_register_acl_packet_handler(btstack_packet_handler_t handler){ 3363fb37a842SMatthias Ringwald hci_stack->acl_packet_handler = handler; 336416833f0aSmatthias.ringwald } 336516833f0aSmatthias.ringwald 336635454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 33678abbe8b5SMatthias Ringwald /** 33688abbe8b5SMatthias Ringwald * @brief Registers a packet handler for SCO data. Used for HSP and HFP profiles. 33698abbe8b5SMatthias Ringwald */ 33703d50b4baSMatthias Ringwald void hci_register_sco_packet_handler(btstack_packet_handler_t handler){ 33718abbe8b5SMatthias Ringwald hci_stack->sco_packet_handler = handler; 33728abbe8b5SMatthias Ringwald } 337335454696SMatthias Ringwald #endif 33748abbe8b5SMatthias Ringwald 337571de195eSMatthias Ringwald static void hci_state_reset(void){ 3376595bdbfbS[email protected] // no connections yet 3377595bdbfbS[email protected] hci_stack->connections = NULL; 337874308b23Smatthias.ringwald 337974308b23Smatthias.ringwald // keep discoverable/connectable as this has been requested by the client(s) 338074308b23Smatthias.ringwald // hci_stack->discoverable = 0; 338174308b23Smatthias.ringwald // hci_stack->connectable = 0; 338274308b23Smatthias.ringwald // hci_stack->bondable = 1; 3383b95a5a35SMatthias Ringwald // hci_stack->own_addr_type = 0; 3384595bdbfbS[email protected] 338544935e40S[email protected] // buffer is free 338602c7fc01SMatthias Ringwald hci_stack->hci_packet_buffer_reserved = false; 338744935e40S[email protected] 3388595bdbfbS[email protected] // no pending cmds 3389595bdbfbS[email protected] hci_stack->decline_reason = 0; 3390595bdbfbS[email protected] hci_stack->new_scan_enable_value = 0xff; 3391595bdbfbS[email protected] 3392c214d65bSMatthias Ringwald hci_stack->secure_connections_active = false; 3393c214d65bSMatthias Ringwald 3394bea424a5SMatthias Ringwald #ifdef ENABLE_CLASSIC 3395bea424a5SMatthias Ringwald hci_stack->new_page_scan_interval = 0xffff; 3396bea424a5SMatthias Ringwald hci_stack->new_page_scan_window = 0xffff; 3397bea424a5SMatthias Ringwald hci_stack->new_page_scan_type = 0xff; 3398496bb884SMatthias Ringwald hci_stack->inquiry_lap = GAP_IAC_GENERAL_INQUIRY; 339959d59ecfSMatthias Ringwald hci_stack->gap_tasks = 340059d59ecfSMatthias Ringwald GAP_TASK_SET_DEFAULT_LINK_POLICY | 340159d59ecfSMatthias Ringwald GAP_TASK_SET_CLASS_OF_DEVICE | 340259d59ecfSMatthias Ringwald GAP_TASK_SET_LOCAL_NAME | 340359d59ecfSMatthias Ringwald GAP_TASK_SET_EIR_DATA; 3404bea424a5SMatthias Ringwald #endif 3405bea424a5SMatthias Ringwald 3406cf01e888SMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB 3407cf01e888SMatthias Ringwald hci_stack->classic_read_local_oob_data = true; 34081ae74bf3SMatthias Ringwald hci_stack->classic_oob_con_handle = HCI_CON_HANDLE_INVALID; 3409cf01e888SMatthias Ringwald #endif 3410cf01e888SMatthias Ringwald 3411595bdbfbS[email protected] // LE 3412b95a5a35SMatthias Ringwald #ifdef ENABLE_BLE 3413b95a5a35SMatthias Ringwald memset(hci_stack->le_random_address, 0, 6); 3414b95a5a35SMatthias Ringwald hci_stack->le_random_address_set = 0; 3415d70217a2SMatthias Ringwald #endif 3416d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 3417a61834b6SMatthias Ringwald hci_stack->le_scanning_active = false; 3418b04dfa37SMatthias Ringwald hci_stack->le_connecting_state = LE_CONNECTING_IDLE; 3419d5b1a89eSMatthias Ringwald hci_stack->le_connecting_request = LE_CONNECTING_IDLE; 3420e83201bcSMatthias Ringwald hci_stack->le_whitelist_capacity = 0; 3421d70217a2SMatthias Ringwald #endif 3422a61834b6SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 3423a61834b6SMatthias Ringwald hci_stack->le_advertisements_active = false; 3424a61834b6SMatthias Ringwald if ((hci_stack->le_advertisements_todo & LE_ADVERTISEMENT_TASKS_PARAMS_SET) != 0){ 3425a61834b6SMatthias Ringwald hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_SET_PARAMS; 3426a61834b6SMatthias Ringwald } 3427a61834b6SMatthias Ringwald if (hci_stack->le_advertisements_data != NULL){ 3428a61834b6SMatthias Ringwald hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_SET_ADV_DATA; 3429a61834b6SMatthias Ringwald } 3430a61834b6SMatthias Ringwald #endif 3431595bdbfbS[email protected] } 3432595bdbfbS[email protected] 343335454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 34342d5e09d6SMatthias Ringwald /** 34352d5e09d6SMatthias Ringwald * @brief Configure Bluetooth hardware control. Has to be called before power on. 34362d5e09d6SMatthias Ringwald */ 34372d5e09d6SMatthias Ringwald void hci_set_link_key_db(btstack_link_key_db_t const * link_key_db){ 34382d5e09d6SMatthias Ringwald // store and open remote device db 34392d5e09d6SMatthias Ringwald hci_stack->link_key_db = link_key_db; 34402d5e09d6SMatthias Ringwald if (hci_stack->link_key_db) { 34412d5e09d6SMatthias Ringwald hci_stack->link_key_db->open(); 34422d5e09d6SMatthias Ringwald } 34432d5e09d6SMatthias Ringwald } 344435454696SMatthias Ringwald #endif 34452d5e09d6SMatthias Ringwald 34462d5e09d6SMatthias Ringwald void hci_init(const hci_transport_t *transport, const void *config){ 3447475c8125Smatthias.ringwald 34483a9fb326S[email protected] #ifdef HAVE_MALLOC 34493a9fb326S[email protected] if (!hci_stack) { 34503a9fb326S[email protected] hci_stack = (hci_stack_t*) malloc(sizeof(hci_stack_t)); 34513a9fb326S[email protected] } 34523a9fb326S[email protected] #else 34533a9fb326S[email protected] hci_stack = &hci_stack_static; 34543a9fb326S[email protected] #endif 345566fb9560S[email protected] memset(hci_stack, 0, sizeof(hci_stack_t)); 34563a9fb326S[email protected] 3457475c8125Smatthias.ringwald // reference to use transport layer implementation 34583a9fb326S[email protected] hci_stack->hci_transport = transport; 3459475c8125Smatthias.ringwald 346011e23e5fSmatthias.ringwald // reference to used config 34613a9fb326S[email protected] hci_stack->config = config; 346211e23e5fSmatthias.ringwald 346326a9b6daSMatthias Ringwald // setup pointer for outgoing packet buffer 346426a9b6daSMatthias Ringwald hci_stack->hci_packet_buffer = &hci_stack->hci_packet_buffer_data[HCI_OUTGOING_PRE_BUFFER_SIZE]; 346526a9b6daSMatthias Ringwald 34668fcba05dSmatthias.ringwald // max acl payload size defined in config.h 34673a9fb326S[email protected] hci_stack->acl_data_packet_length = HCI_ACL_PAYLOAD_SIZE; 34688fcba05dSmatthias.ringwald 346916833f0aSmatthias.ringwald // register packet handlers with transport 347010e830c9Smatthias.ringwald transport->register_packet_handler(&packet_handler); 3471f5454fc6Smatthias.ringwald 34723a9fb326S[email protected] hci_stack->state = HCI_STATE_OFF; 3473e2386ba1S[email protected] 3474e2386ba1S[email protected] // class of device 34753a9fb326S[email protected] hci_stack->class_of_device = 0x007a020c; // Smartphone 3476a45d6b9fS[email protected] 3477f20168b8Smatthias.ringwald // bondable by default 3478f20168b8Smatthias.ringwald hci_stack->bondable = 1; 3479f20168b8Smatthias.ringwald 3480e9f343c8SMatthias Ringwald #ifdef ENABLE_CLASSIC 348163168530SMatthias Ringwald // classic name 348263168530SMatthias Ringwald hci_stack->local_name = default_classic_name; 3483c4c88f1bSJakob Krantz 3484c4c88f1bSJakob Krantz // Master slave policy 3485c4c88f1bSJakob Krantz hci_stack->master_slave_policy = 1; 3486170fafaeSMatthias Ringwald 3487b4eb4420SMatthias Ringwald // Allow Role Switch 3488b4eb4420SMatthias Ringwald hci_stack->allow_role_switch = 1; 3489b4eb4420SMatthias Ringwald 349078315a58SMatthias Ringwald // Default / minimum security level = 2 349178315a58SMatthias Ringwald hci_stack->gap_security_level = LEVEL_2; 349278315a58SMatthias Ringwald 34935dbec6b3SMatthias Ringwald // Default Security Mode 4 34945dbec6b3SMatthias Ringwald hci_stack->gap_security_mode = GAP_SECURITY_MODE_4; 34955dbec6b3SMatthias Ringwald 3496cd345294SMatthias Ringwald // Errata-11838 mandates 7 bytes for GAP Security Level 1-3 3497cd345294SMatthias Ringwald hci_stack->gap_required_encyrption_key_size = 7; 3498d821984bSMatthias Ringwald 3499d821984bSMatthias Ringwald // Link Supervision Timeout 3500d821984bSMatthias Ringwald hci_stack->link_supervision_timeout = HCI_LINK_SUPERVISION_TIMEOUT_DEFAULT; 3501d821984bSMatthias Ringwald 3502e9f343c8SMatthias Ringwald #endif 350363168530SMatthias Ringwald 350463048403S[email protected] // Secure Simple Pairing default: enable, no I/O capabilities, general bonding, mitm not required, auto accept 35053a9fb326S[email protected] hci_stack->ssp_enable = 1; 35063a9fb326S[email protected] hci_stack->ssp_io_capability = SSP_IO_CAPABILITY_NO_INPUT_NO_OUTPUT; 35073a9fb326S[email protected] hci_stack->ssp_authentication_requirement = SSP_IO_AUTHREQ_MITM_PROTECTION_NOT_REQUIRED_GENERAL_BONDING; 35083a9fb326S[email protected] hci_stack->ssp_auto_accept = 1; 350969a97523S[email protected] 35105d23aae8SMatthias Ringwald // Secure Connections: enable (requires support from Controller) 35115d23aae8SMatthias Ringwald hci_stack->secure_connections_enable = true; 35125d23aae8SMatthias Ringwald 3513fac2e2feSMatthias Ringwald // voice setting - signed 16 bit pcm data with CVSD over the air 3514fac2e2feSMatthias Ringwald hci_stack->sco_voice_setting = 0x60; 3515d950d659SMatthias Ringwald 3516831711daSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 3517831711daSMatthias Ringwald // connection parameter to use for outgoing connections 3518cbe54ab2SJakob Krantz hci_stack->le_connection_scan_interval = 0x0060; // 60ms 3519cbe54ab2SJakob Krantz hci_stack->le_connection_scan_window = 0x0030; // 30ms 3520831711daSMatthias Ringwald hci_stack->le_connection_interval_min = 0x0008; // 10 ms 3521831711daSMatthias Ringwald hci_stack->le_connection_interval_max = 0x0018; // 30 ms 3522831711daSMatthias Ringwald hci_stack->le_connection_latency = 4; // 4 3523831711daSMatthias Ringwald hci_stack->le_supervision_timeout = 0x0048; // 720 ms 3524831711daSMatthias Ringwald hci_stack->le_minimum_ce_length = 2; // 1.25 ms 3525831711daSMatthias Ringwald hci_stack->le_maximum_ce_length = 0x0030; // 30 ms 35267261e5d8SMatthias Ringwald 35277261e5d8SMatthias Ringwald // default LE Scanning 35288b69e4c7SMatthias Ringwald hci_stack->le_scan_type = 0x1; // active 35298b69e4c7SMatthias Ringwald hci_stack->le_scan_interval = 0x1e0; // 300 ms 35308b69e4c7SMatthias Ringwald hci_stack->le_scan_window = 0x30; // 30 ms 3531831711daSMatthias Ringwald #endif 3532831711daSMatthias Ringwald 35332b6ab3e6SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 35342b6ab3e6SMatthias Ringwald hci_stack->le_max_number_peripheral_connections = 1; // only single connection as peripheral 35352b6ab3e6SMatthias Ringwald #endif 35362b6ab3e6SMatthias Ringwald 3537831711daSMatthias Ringwald // connection parameter range used to answer connection parameter update requests in l2cap 3538831711daSMatthias Ringwald hci_stack->le_connection_parameter_range.le_conn_interval_min = 6; 3539831711daSMatthias Ringwald hci_stack->le_connection_parameter_range.le_conn_interval_max = 3200; 3540831711daSMatthias Ringwald hci_stack->le_connection_parameter_range.le_conn_latency_min = 0; 3541831711daSMatthias Ringwald hci_stack->le_connection_parameter_range.le_conn_latency_max = 500; 3542831711daSMatthias Ringwald hci_stack->le_connection_parameter_range.le_supervision_timeout_min = 10; 3543831711daSMatthias Ringwald hci_stack->le_connection_parameter_range.le_supervision_timeout_max = 3200; 3544831711daSMatthias Ringwald 3545595bdbfbS[email protected] hci_state_reset(); 3546475c8125Smatthias.ringwald } 3547475c8125Smatthias.ringwald 35484688f216SMatthias Ringwald void hci_deinit(void){ 35494688f216SMatthias Ringwald #ifdef HAVE_MALLOC 35504688f216SMatthias Ringwald if (hci_stack) { 35514688f216SMatthias Ringwald free(hci_stack); 35524688f216SMatthias Ringwald } 35534688f216SMatthias Ringwald #endif 35544688f216SMatthias Ringwald hci_stack = NULL; 3555b5bbcbf4SMatthias Ringwald 3556b5bbcbf4SMatthias Ringwald #ifdef ENABLE_CLASSIC 35574688f216SMatthias Ringwald disable_l2cap_timeouts = 0; 3558b5bbcbf4SMatthias Ringwald #endif 35594688f216SMatthias Ringwald } 35604688f216SMatthias Ringwald 35613fb36a29SMatthias Ringwald /** 35623fb36a29SMatthias Ringwald * @brief Configure Bluetooth chipset driver. Has to be called before power on, or right after receiving the local version information 35633fb36a29SMatthias Ringwald */ 35643fb36a29SMatthias Ringwald void hci_set_chipset(const btstack_chipset_t *chipset_driver){ 35653fb36a29SMatthias Ringwald hci_stack->chipset = chipset_driver; 35663fb36a29SMatthias Ringwald 35673fb36a29SMatthias Ringwald // reset chipset driver - init is also called on power_up 35683fb36a29SMatthias Ringwald if (hci_stack->chipset && hci_stack->chipset->init){ 35693fb36a29SMatthias Ringwald hci_stack->chipset->init(hci_stack->config); 35703fb36a29SMatthias Ringwald } 35713fb36a29SMatthias Ringwald } 35723fb36a29SMatthias Ringwald 3573fb55bd0aSMatthias Ringwald /** 3574d0b87befSMatthias Ringwald * @brief Configure Bluetooth hardware control. Has to be called after hci_init() but before power on. 3575fb55bd0aSMatthias Ringwald */ 3576fb55bd0aSMatthias Ringwald void hci_set_control(const btstack_control_t *hardware_control){ 3577fb55bd0aSMatthias Ringwald // references to used control implementation 3578fb55bd0aSMatthias Ringwald hci_stack->control = hardware_control; 3579d0b87befSMatthias Ringwald // init with transport config 3580d0b87befSMatthias Ringwald hardware_control->init(hci_stack->config); 3581fb55bd0aSMatthias Ringwald } 3582fb55bd0aSMatthias Ringwald 358371de195eSMatthias Ringwald void hci_close(void){ 3584e6d6524dSMatthias Ringwald 3585e6d6524dSMatthias Ringwald #ifdef ENABLE_CLASSIC 3586404843c1Smatthias.ringwald // close remote device db 3587a98592bcSMatthias Ringwald if (hci_stack->link_key_db) { 3588a98592bcSMatthias Ringwald hci_stack->link_key_db->close(); 3589404843c1Smatthias.ringwald } 3590e6d6524dSMatthias Ringwald #endif 35917224be7eSMatthias Ringwald 35927224be7eSMatthias Ringwald btstack_linked_list_iterator_t lit; 35937224be7eSMatthias Ringwald btstack_linked_list_iterator_init(&lit, &hci_stack->connections); 35947224be7eSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&lit)){ 35957224be7eSMatthias Ringwald // cancel all l2cap connections by emitting dicsconnection complete before shutdown (free) connection 35967224be7eSMatthias Ringwald hci_connection_t * connection = (hci_connection_t*) btstack_linked_list_iterator_next(&lit); 35977224be7eSMatthias Ringwald hci_emit_disconnection_complete(connection->con_handle, 0x16); // terminated by local host 35987224be7eSMatthias Ringwald hci_shutdown_connection(connection); 3599f5454fc6Smatthias.ringwald } 36007224be7eSMatthias Ringwald 3601f5454fc6Smatthias.ringwald hci_power_control(HCI_POWER_OFF); 36023a9fb326S[email protected] 36033a9fb326S[email protected] #ifdef HAVE_MALLOC 36043a9fb326S[email protected] free(hci_stack); 36053a9fb326S[email protected] #endif 36063a9fb326S[email protected] hci_stack = NULL; 3607404843c1Smatthias.ringwald } 3608404843c1Smatthias.ringwald 3609cb70c5abSMatthias Ringwald #ifdef HAVE_SCO_TRANSPORT 3610cb70c5abSMatthias Ringwald void hci_set_sco_transport(const btstack_sco_transport_t *sco_transport){ 3611cb70c5abSMatthias Ringwald hci_stack->sco_transport = sco_transport; 3612cb70c5abSMatthias Ringwald sco_transport->register_packet_handler(&packet_handler); 3613cb70c5abSMatthias Ringwald } 3614cb70c5abSMatthias Ringwald #endif 3615cb70c5abSMatthias Ringwald 361635454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 3617170fafaeSMatthias Ringwald void gap_set_required_encryption_key_size(uint8_t encryption_key_size){ 3618170fafaeSMatthias Ringwald // validate ranage and set 3619170fafaeSMatthias Ringwald if (encryption_key_size < 7) return; 3620170fafaeSMatthias Ringwald if (encryption_key_size > 16) return; 3621170fafaeSMatthias Ringwald hci_stack->gap_required_encyrption_key_size = encryption_key_size; 3622170fafaeSMatthias Ringwald } 362378315a58SMatthias Ringwald 3624137715ebSMatthias Ringwald uint8_t gap_set_security_mode(gap_security_mode_t security_mode){ 3625137715ebSMatthias Ringwald if ((security_mode == GAP_SECURITY_MODE_4) || (security_mode == GAP_SECURITY_MODE_2)){ 36265dbec6b3SMatthias Ringwald hci_stack->gap_security_mode = security_mode; 3627137715ebSMatthias Ringwald return ERROR_CODE_SUCCESS; 3628137715ebSMatthias Ringwald } else { 3629137715ebSMatthias Ringwald return ERROR_CODE_UNSUPPORTED_FEATURE_OR_PARAMETER_VALUE; 3630137715ebSMatthias Ringwald } 36315dbec6b3SMatthias Ringwald } 36325dbec6b3SMatthias Ringwald 36335dbec6b3SMatthias Ringwald gap_security_mode_t gap_get_security_mode(void){ 36345dbec6b3SMatthias Ringwald return hci_stack->gap_security_mode; 36355dbec6b3SMatthias Ringwald } 36365dbec6b3SMatthias Ringwald 363778315a58SMatthias Ringwald void gap_set_security_level(gap_security_level_t security_level){ 363878315a58SMatthias Ringwald hci_stack->gap_security_level = security_level; 363978315a58SMatthias Ringwald } 364078315a58SMatthias Ringwald 364178315a58SMatthias Ringwald gap_security_level_t gap_get_security_level(void){ 3642d7387af3SMatthias Ringwald if (hci_stack->gap_secure_connections_only_mode){ 3643d7387af3SMatthias Ringwald return LEVEL_4; 3644d7387af3SMatthias Ringwald } 364578315a58SMatthias Ringwald return hci_stack->gap_security_level; 364678315a58SMatthias Ringwald } 364730cdf3c6SMatthias Ringwald 36488ad4dfffSMatthias Ringwald void gap_set_minimal_service_security_level(gap_security_level_t security_level){ 36498ad4dfffSMatthias Ringwald hci_stack->gap_minimal_service_security_level = security_level; 36508ad4dfffSMatthias Ringwald } 36518ad4dfffSMatthias Ringwald 365230cdf3c6SMatthias Ringwald void gap_set_secure_connections_only_mode(bool enable){ 365330cdf3c6SMatthias Ringwald hci_stack->gap_secure_connections_only_mode = enable; 365430cdf3c6SMatthias Ringwald } 365530cdf3c6SMatthias Ringwald 365630cdf3c6SMatthias Ringwald bool gap_get_secure_connections_only_mode(void){ 365730cdf3c6SMatthias Ringwald return hci_stack->gap_secure_connections_only_mode; 365830cdf3c6SMatthias Ringwald } 3659170fafaeSMatthias Ringwald #endif 3660170fafaeSMatthias Ringwald 3661170fafaeSMatthias Ringwald #ifdef ENABLE_CLASSIC 366260b9e82fSMatthias Ringwald void gap_set_class_of_device(uint32_t class_of_device){ 36639e61646fS[email protected] hci_stack->class_of_device = class_of_device; 366459d59ecfSMatthias Ringwald hci_stack->gap_tasks |= GAP_TASK_SET_CLASS_OF_DEVICE; 366559d59ecfSMatthias Ringwald hci_run(); 36669e61646fS[email protected] } 366776f27cffSMatthias Ringwald 3668c33e56d3SMatthias Ringwald void gap_set_default_link_policy_settings(uint16_t default_link_policy_settings){ 3669c33e56d3SMatthias Ringwald hci_stack->default_link_policy_settings = default_link_policy_settings; 367059d59ecfSMatthias Ringwald hci_stack->gap_tasks |= GAP_TASK_SET_DEFAULT_LINK_POLICY; 367159d59ecfSMatthias Ringwald hci_run(); 3672c33e56d3SMatthias Ringwald } 3673c33e56d3SMatthias Ringwald 3674b4eb4420SMatthias Ringwald void gap_set_allow_role_switch(bool allow_role_switch){ 3675b4eb4420SMatthias Ringwald hci_stack->allow_role_switch = allow_role_switch ? 1 : 0; 3676b4eb4420SMatthias Ringwald } 3677b4eb4420SMatthias Ringwald 3678b4eb4420SMatthias Ringwald uint8_t hci_get_allow_role_switch(void){ 3679b4eb4420SMatthias Ringwald return hci_stack->allow_role_switch; 3680b4eb4420SMatthias Ringwald } 3681b4eb4420SMatthias Ringwald 36820c3eb48dSMatthias Ringwald void gap_set_link_supervision_timeout(uint16_t link_supervision_timeout){ 36830c3eb48dSMatthias Ringwald hci_stack->link_supervision_timeout = link_supervision_timeout; 36840c3eb48dSMatthias Ringwald } 36850c3eb48dSMatthias Ringwald 368676f27cffSMatthias Ringwald void hci_disable_l2cap_timeout_check(void){ 368776f27cffSMatthias Ringwald disable_l2cap_timeouts = 1; 368876f27cffSMatthias Ringwald } 368935454696SMatthias Ringwald #endif 36909e61646fS[email protected] 369176f27cffSMatthias Ringwald #if !defined(HAVE_PLATFORM_IPHONE_OS) && !defined (HAVE_HOST_CONTROLLER_API) 3692f456b2d0S[email protected] // Set Public BD ADDR - passed on to Bluetooth chipset if supported in bt_control_h 3693f456b2d0S[email protected] void hci_set_bd_addr(bd_addr_t addr){ 36946535961aSMatthias Ringwald (void)memcpy(hci_stack->custom_bd_addr, addr, 6); 3695f456b2d0S[email protected] hci_stack->custom_bd_addr_set = 1; 3696f456b2d0S[email protected] } 369776f27cffSMatthias Ringwald #endif 3698f456b2d0S[email protected] 36998d213e1aSmatthias.ringwald // State-Module-Driver overview 37008d213e1aSmatthias.ringwald // state module low-level 37018d213e1aSmatthias.ringwald // HCI_STATE_OFF off close 37028d213e1aSmatthias.ringwald // HCI_STATE_INITIALIZING, on open 37038d213e1aSmatthias.ringwald // HCI_STATE_WORKING, on open 37048d213e1aSmatthias.ringwald // HCI_STATE_HALTING, on open 3705d661ed19Smatthias.ringwald // HCI_STATE_SLEEPING, off/sleep close 3706d661ed19Smatthias.ringwald // HCI_STATE_FALLING_ASLEEP on open 3707c7e0c5f6Smatthias.ringwald 370840d1c7a4Smatthias.ringwald static int hci_power_control_on(void){ 37097301ad89Smatthias.ringwald 3710038bc64cSmatthias.ringwald // power on 3711f9a30166Smatthias.ringwald int err = 0; 37123a9fb326S[email protected] if (hci_stack->control && hci_stack->control->on){ 3713d0b87befSMatthias Ringwald err = (*hci_stack->control->on)(); 3714f9a30166Smatthias.ringwald } 3715038bc64cSmatthias.ringwald if (err){ 37169da54300S[email protected] log_error( "POWER_ON failed"); 3717038bc64cSmatthias.ringwald hci_emit_hci_open_failed(); 3718038bc64cSmatthias.ringwald return err; 3719038bc64cSmatthias.ringwald } 3720038bc64cSmatthias.ringwald 372124b3c629SMatthias Ringwald // int chipset driver 37223fb36a29SMatthias Ringwald if (hci_stack->chipset && hci_stack->chipset->init){ 37233fb36a29SMatthias Ringwald hci_stack->chipset->init(hci_stack->config); 37243fb36a29SMatthias Ringwald } 37253fb36a29SMatthias Ringwald 372624b3c629SMatthias Ringwald // init transport 372724b3c629SMatthias Ringwald if (hci_stack->hci_transport->init){ 372824b3c629SMatthias Ringwald hci_stack->hci_transport->init(hci_stack->config); 372924b3c629SMatthias Ringwald } 373024b3c629SMatthias Ringwald 373124b3c629SMatthias Ringwald // open transport 373224b3c629SMatthias Ringwald err = hci_stack->hci_transport->open(); 3733038bc64cSmatthias.ringwald if (err){ 37349da54300S[email protected] log_error( "HCI_INIT failed, turning Bluetooth off again"); 37353a9fb326S[email protected] if (hci_stack->control && hci_stack->control->off){ 3736d0b87befSMatthias Ringwald (*hci_stack->control->off)(); 3737f9a30166Smatthias.ringwald } 3738038bc64cSmatthias.ringwald hci_emit_hci_open_failed(); 3739038bc64cSmatthias.ringwald return err; 3740038bc64cSmatthias.ringwald } 37418d213e1aSmatthias.ringwald return 0; 37428d213e1aSmatthias.ringwald } 3743038bc64cSmatthias.ringwald 374440d1c7a4Smatthias.ringwald static void hci_power_control_off(void){ 37458d213e1aSmatthias.ringwald 37469da54300S[email protected] log_info("hci_power_control_off"); 37479418f9c9Smatthias.ringwald 37488d213e1aSmatthias.ringwald // close low-level device 374924b3c629SMatthias Ringwald hci_stack->hci_transport->close(); 37508d213e1aSmatthias.ringwald 37519da54300S[email protected] log_info("hci_power_control_off - hci_transport closed"); 37529418f9c9Smatthias.ringwald 37538d213e1aSmatthias.ringwald // power off 37543a9fb326S[email protected] if (hci_stack->control && hci_stack->control->off){ 3755d0b87befSMatthias Ringwald (*hci_stack->control->off)(); 37568d213e1aSmatthias.ringwald } 37579418f9c9Smatthias.ringwald 37589da54300S[email protected] log_info("hci_power_control_off - control closed"); 37599418f9c9Smatthias.ringwald 37603a9fb326S[email protected] hci_stack->state = HCI_STATE_OFF; 376172ea5239Smatthias.ringwald } 376272ea5239Smatthias.ringwald 376340d1c7a4Smatthias.ringwald static void hci_power_control_sleep(void){ 376472ea5239Smatthias.ringwald 37659da54300S[email protected] log_info("hci_power_control_sleep"); 37663144bce4Smatthias.ringwald 3767b429b9b7Smatthias.ringwald #if 0 3768b429b9b7Smatthias.ringwald // don't close serial port during sleep 3769b429b9b7Smatthias.ringwald 377072ea5239Smatthias.ringwald // close low-level device 37713a9fb326S[email protected] hci_stack->hci_transport->close(hci_stack->config); 3772b429b9b7Smatthias.ringwald #endif 377372ea5239Smatthias.ringwald 377472ea5239Smatthias.ringwald // sleep mode 37753a9fb326S[email protected] if (hci_stack->control && hci_stack->control->sleep){ 3776d0b87befSMatthias Ringwald (*hci_stack->control->sleep)(); 377772ea5239Smatthias.ringwald } 3778b429b9b7Smatthias.ringwald 37793a9fb326S[email protected] hci_stack->state = HCI_STATE_SLEEPING; 37808d213e1aSmatthias.ringwald } 37818d213e1aSmatthias.ringwald 378240d1c7a4Smatthias.ringwald static int hci_power_control_wake(void){ 3783b429b9b7Smatthias.ringwald 37849da54300S[email protected] log_info("hci_power_control_wake"); 3785b429b9b7Smatthias.ringwald 3786b429b9b7Smatthias.ringwald // wake on 37873a9fb326S[email protected] if (hci_stack->control && hci_stack->control->wake){ 3788d0b87befSMatthias Ringwald (*hci_stack->control->wake)(); 3789b429b9b7Smatthias.ringwald } 3790b429b9b7Smatthias.ringwald 3791b429b9b7Smatthias.ringwald #if 0 3792b429b9b7Smatthias.ringwald // open low-level device 37933a9fb326S[email protected] int err = hci_stack->hci_transport->open(hci_stack->config); 3794b429b9b7Smatthias.ringwald if (err){ 37959da54300S[email protected] log_error( "HCI_INIT failed, turning Bluetooth off again"); 37963a9fb326S[email protected] if (hci_stack->control && hci_stack->control->off){ 3797d0b87befSMatthias Ringwald (*hci_stack->control->off)(); 3798b429b9b7Smatthias.ringwald } 3799b429b9b7Smatthias.ringwald hci_emit_hci_open_failed(); 3800b429b9b7Smatthias.ringwald return err; 3801b429b9b7Smatthias.ringwald } 3802b429b9b7Smatthias.ringwald #endif 3803b429b9b7Smatthias.ringwald 3804b429b9b7Smatthias.ringwald return 0; 3805b429b9b7Smatthias.ringwald } 3806b429b9b7Smatthias.ringwald 380744935e40S[email protected] static void hci_power_transition_to_initializing(void){ 380844935e40S[email protected] // set up state machine 380944935e40S[email protected] hci_stack->num_cmd_packets = 1; // assume that one cmd can be sent 381002c7fc01SMatthias Ringwald hci_stack->hci_packet_buffer_reserved = false; 381144935e40S[email protected] hci_stack->state = HCI_STATE_INITIALIZING; 38125c363727SMatthias Ringwald hci_stack->substate = HCI_INIT_SEND_RESET; 381344935e40S[email protected] } 3814b429b9b7Smatthias.ringwald 381542bd3d77SMatthias Ringwald // returns error 381642bd3d77SMatthias Ringwald static int hci_power_control_state_off(HCI_POWER_MODE power_mode){ 381742bd3d77SMatthias Ringwald int err; 38188d213e1aSmatthias.ringwald switch (power_mode){ 38198d213e1aSmatthias.ringwald case HCI_POWER_ON: 38208d213e1aSmatthias.ringwald err = hci_power_control_on(); 382142bd3d77SMatthias Ringwald if (err != 0) { 3822f04a0c31SMatthias Ringwald log_error("hci_power_control_on() error %d", err); 382397b61c7bS[email protected] return err; 382497b61c7bS[email protected] } 382544935e40S[email protected] hci_power_transition_to_initializing(); 38268d213e1aSmatthias.ringwald break; 38278d213e1aSmatthias.ringwald case HCI_POWER_OFF: 38288d213e1aSmatthias.ringwald // do nothing 38298d213e1aSmatthias.ringwald break; 38308d213e1aSmatthias.ringwald case HCI_POWER_SLEEP: 3831b546ac54Smatthias.ringwald // do nothing (with SLEEP == OFF) 38328d213e1aSmatthias.ringwald break; 38337bbeb3adSMilanka Ringwald default: 38347bbeb3adSMilanka Ringwald btstack_assert(false); 38357bbeb3adSMilanka Ringwald break; 38368d213e1aSmatthias.ringwald } 383742bd3d77SMatthias Ringwald return ERROR_CODE_SUCCESS; 383842bd3d77SMatthias Ringwald } 38397301ad89Smatthias.ringwald 384042bd3d77SMatthias Ringwald static int hci_power_control_state_initializing(HCI_POWER_MODE power_mode){ 38418d213e1aSmatthias.ringwald switch (power_mode){ 38428d213e1aSmatthias.ringwald case HCI_POWER_ON: 38438d213e1aSmatthias.ringwald // do nothing 38448d213e1aSmatthias.ringwald break; 38458d213e1aSmatthias.ringwald case HCI_POWER_OFF: 38468d213e1aSmatthias.ringwald // no connections yet, just turn it off 38478d213e1aSmatthias.ringwald hci_power_control_off(); 38488d213e1aSmatthias.ringwald break; 38498d213e1aSmatthias.ringwald case HCI_POWER_SLEEP: 3850b546ac54Smatthias.ringwald // no connections yet, just turn it off 385172ea5239Smatthias.ringwald hci_power_control_sleep(); 38528d213e1aSmatthias.ringwald break; 38537bbeb3adSMilanka Ringwald default: 38547bbeb3adSMilanka Ringwald btstack_assert(false); 38557bbeb3adSMilanka Ringwald break; 38568d213e1aSmatthias.ringwald } 385742bd3d77SMatthias Ringwald return ERROR_CODE_SUCCESS; 385842bd3d77SMatthias Ringwald } 38597301ad89Smatthias.ringwald 386042bd3d77SMatthias Ringwald static int hci_power_control_state_working(HCI_POWER_MODE power_mode) { 38618d213e1aSmatthias.ringwald switch (power_mode){ 38628d213e1aSmatthias.ringwald case HCI_POWER_ON: 38638d213e1aSmatthias.ringwald // do nothing 38648d213e1aSmatthias.ringwald break; 38658d213e1aSmatthias.ringwald case HCI_POWER_OFF: 3866c7e0c5f6Smatthias.ringwald // see hci_run 38673a9fb326S[email protected] hci_stack->state = HCI_STATE_HALTING; 3868beceeddeSMatthias Ringwald hci_stack->substate = HCI_HALTING_DISCONNECT_ALL_NO_TIMER; 38698d213e1aSmatthias.ringwald break; 38708d213e1aSmatthias.ringwald case HCI_POWER_SLEEP: 3871b546ac54Smatthias.ringwald // see hci_run 38723a9fb326S[email protected] hci_stack->state = HCI_STATE_FALLING_ASLEEP; 387374b323a9SMatthias Ringwald hci_stack->substate = HCI_FALLING_ASLEEP_DISCONNECT; 38748d213e1aSmatthias.ringwald break; 38757bbeb3adSMilanka Ringwald default: 38767bbeb3adSMilanka Ringwald btstack_assert(false); 38777bbeb3adSMilanka Ringwald break; 38788d213e1aSmatthias.ringwald } 387942bd3d77SMatthias Ringwald return ERROR_CODE_SUCCESS; 388042bd3d77SMatthias Ringwald } 38817301ad89Smatthias.ringwald 388242bd3d77SMatthias Ringwald static int hci_power_control_state_halting(HCI_POWER_MODE power_mode) { 38838d213e1aSmatthias.ringwald switch (power_mode){ 38848d213e1aSmatthias.ringwald case HCI_POWER_ON: 388544935e40S[email protected] hci_power_transition_to_initializing(); 38868d213e1aSmatthias.ringwald break; 38878d213e1aSmatthias.ringwald case HCI_POWER_OFF: 38888d213e1aSmatthias.ringwald // do nothing 38898d213e1aSmatthias.ringwald break; 38908d213e1aSmatthias.ringwald case HCI_POWER_SLEEP: 3891b546ac54Smatthias.ringwald // see hci_run 38923a9fb326S[email protected] hci_stack->state = HCI_STATE_FALLING_ASLEEP; 389374b323a9SMatthias Ringwald hci_stack->substate = HCI_FALLING_ASLEEP_DISCONNECT; 38948d213e1aSmatthias.ringwald break; 38957bbeb3adSMilanka Ringwald default: 38967bbeb3adSMilanka Ringwald btstack_assert(false); 38977bbeb3adSMilanka Ringwald break; 38988d213e1aSmatthias.ringwald } 389900278272SMatthias Ringwald return ERROR_CODE_SUCCESS; 390042bd3d77SMatthias Ringwald } 39018d213e1aSmatthias.ringwald 390242bd3d77SMatthias Ringwald static int hci_power_control_state_falling_asleep(HCI_POWER_MODE power_mode) { 39038d213e1aSmatthias.ringwald switch (power_mode){ 39048d213e1aSmatthias.ringwald case HCI_POWER_ON: 390528171530Smatthias.ringwald 3906423a3e49SMatthias Ringwald #ifdef HAVE_PLATFORM_IPHONE_OS 390728171530Smatthias.ringwald // nothing to do, if H4 supports power management 3908d0b87befSMatthias Ringwald if (btstack_control_iphone_power_management_enabled()){ 39093a9fb326S[email protected] hci_stack->state = HCI_STATE_INITIALIZING; 391074b323a9SMatthias Ringwald hci_stack->substate = HCI_INIT_WRITE_SCAN_ENABLE; // init after sleep 391128171530Smatthias.ringwald break; 391228171530Smatthias.ringwald } 391328171530Smatthias.ringwald #endif 391444935e40S[email protected] hci_power_transition_to_initializing(); 39158d213e1aSmatthias.ringwald break; 39168d213e1aSmatthias.ringwald case HCI_POWER_OFF: 3917b546ac54Smatthias.ringwald // see hci_run 39183a9fb326S[email protected] hci_stack->state = HCI_STATE_HALTING; 3919beceeddeSMatthias Ringwald hci_stack->substate = HCI_HALTING_DISCONNECT_ALL_NO_TIMER; 39208d213e1aSmatthias.ringwald break; 39218d213e1aSmatthias.ringwald case HCI_POWER_SLEEP: 3922b546ac54Smatthias.ringwald // do nothing 39238d213e1aSmatthias.ringwald break; 39247bbeb3adSMilanka Ringwald default: 39257bbeb3adSMilanka Ringwald btstack_assert(false); 39267bbeb3adSMilanka Ringwald break; 39278d213e1aSmatthias.ringwald } 392842bd3d77SMatthias Ringwald return ERROR_CODE_SUCCESS; 392942bd3d77SMatthias Ringwald } 39308d213e1aSmatthias.ringwald 393142bd3d77SMatthias Ringwald static int hci_power_control_state_sleeping(HCI_POWER_MODE power_mode) { 393242bd3d77SMatthias Ringwald int err; 39338d213e1aSmatthias.ringwald switch (power_mode){ 39348d213e1aSmatthias.ringwald case HCI_POWER_ON: 3935423a3e49SMatthias Ringwald #ifdef HAVE_PLATFORM_IPHONE_OS 393628171530Smatthias.ringwald // nothing to do, if H4 supports power management 3937d0b87befSMatthias Ringwald if (btstack_control_iphone_power_management_enabled()){ 39383a9fb326S[email protected] hci_stack->state = HCI_STATE_INITIALIZING; 39395c363727SMatthias Ringwald hci_stack->substate = HCI_INIT_AFTER_SLEEP; 3940758b46ceSmatthias.ringwald hci_update_scan_enable(); 394128171530Smatthias.ringwald break; 394228171530Smatthias.ringwald } 394328171530Smatthias.ringwald #endif 39443144bce4Smatthias.ringwald err = hci_power_control_wake(); 39453144bce4Smatthias.ringwald if (err) return err; 394644935e40S[email protected] hci_power_transition_to_initializing(); 39478d213e1aSmatthias.ringwald break; 39488d213e1aSmatthias.ringwald case HCI_POWER_OFF: 39493a9fb326S[email protected] hci_stack->state = HCI_STATE_HALTING; 3950beceeddeSMatthias Ringwald hci_stack->substate = HCI_HALTING_DISCONNECT_ALL_NO_TIMER; 39518d213e1aSmatthias.ringwald break; 39528d213e1aSmatthias.ringwald case HCI_POWER_SLEEP: 3953b546ac54Smatthias.ringwald // do nothing 39548d213e1aSmatthias.ringwald break; 39557bbeb3adSMilanka Ringwald default: 39567bbeb3adSMilanka Ringwald btstack_assert(false); 39577bbeb3adSMilanka Ringwald break; 39588d213e1aSmatthias.ringwald } 395942bd3d77SMatthias Ringwald return ERROR_CODE_SUCCESS; 396042bd3d77SMatthias Ringwald } 39617bbeb3adSMilanka Ringwald 396242bd3d77SMatthias Ringwald int hci_power_control(HCI_POWER_MODE power_mode){ 396342bd3d77SMatthias Ringwald log_info("hci_power_control: %d, current mode %u", power_mode, hci_stack->state); 396424f87726SMatthias Ringwald int err = 0; 396542bd3d77SMatthias Ringwald switch (hci_stack->state){ 396642bd3d77SMatthias Ringwald case HCI_STATE_OFF: 396742bd3d77SMatthias Ringwald err = hci_power_control_state_off(power_mode); 396842bd3d77SMatthias Ringwald break; 396942bd3d77SMatthias Ringwald case HCI_STATE_INITIALIZING: 397042bd3d77SMatthias Ringwald err = hci_power_control_state_initializing(power_mode); 397142bd3d77SMatthias Ringwald break; 397242bd3d77SMatthias Ringwald case HCI_STATE_WORKING: 397342bd3d77SMatthias Ringwald err = hci_power_control_state_working(power_mode); 397442bd3d77SMatthias Ringwald break; 397542bd3d77SMatthias Ringwald case HCI_STATE_HALTING: 397642bd3d77SMatthias Ringwald err = hci_power_control_state_halting(power_mode); 397742bd3d77SMatthias Ringwald break; 397842bd3d77SMatthias Ringwald case HCI_STATE_FALLING_ASLEEP: 397942bd3d77SMatthias Ringwald err = hci_power_control_state_falling_asleep(power_mode); 398042bd3d77SMatthias Ringwald break; 398142bd3d77SMatthias Ringwald case HCI_STATE_SLEEPING: 398242bd3d77SMatthias Ringwald err = hci_power_control_state_sleeping(power_mode); 398342bd3d77SMatthias Ringwald break; 39847bbeb3adSMilanka Ringwald default: 39857bbeb3adSMilanka Ringwald btstack_assert(false); 39867bbeb3adSMilanka Ringwald break; 398711e23e5fSmatthias.ringwald } 398824f87726SMatthias Ringwald if (err != 0){ 398942bd3d77SMatthias Ringwald return err; 399042bd3d77SMatthias Ringwald } 399168d92d03Smatthias.ringwald 3992038bc64cSmatthias.ringwald // create internal event 3993ee8bf225Smatthias.ringwald hci_emit_state(); 3994ee8bf225Smatthias.ringwald 399568d92d03Smatthias.ringwald // trigger next/first action 399668d92d03Smatthias.ringwald hci_run(); 399768d92d03Smatthias.ringwald 3998475c8125Smatthias.ringwald return 0; 3999475c8125Smatthias.ringwald } 4000475c8125Smatthias.ringwald 400135454696SMatthias Ringwald 400235454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 400335454696SMatthias Ringwald 4004758b46ceSmatthias.ringwald static void hci_update_scan_enable(void){ 4005758b46ceSmatthias.ringwald // 2 = page scan, 1 = inq scan 4006a1df452eSMatthias Ringwald hci_stack->new_scan_enable_value = (hci_stack->connectable << 1) | hci_stack->discoverable; 4007758b46ceSmatthias.ringwald hci_run(); 4008758b46ceSmatthias.ringwald } 4009758b46ceSmatthias.ringwald 401015a95bd5SMatthias Ringwald void gap_discoverable_control(uint8_t enable){ 4011381fbed8Smatthias.ringwald if (enable) enable = 1; // normalize argument 4012381fbed8Smatthias.ringwald 40133a9fb326S[email protected] if (hci_stack->discoverable == enable){ 40143a9fb326S[email protected] hci_emit_discoverable_enabled(hci_stack->discoverable); 4015381fbed8Smatthias.ringwald return; 4016381fbed8Smatthias.ringwald } 4017381fbed8Smatthias.ringwald 40183a9fb326S[email protected] hci_stack->discoverable = enable; 4019758b46ceSmatthias.ringwald hci_update_scan_enable(); 4020758b46ceSmatthias.ringwald } 4021b031bebbSmatthias.ringwald 402215a95bd5SMatthias Ringwald void gap_connectable_control(uint8_t enable){ 4023758b46ceSmatthias.ringwald if (enable) enable = 1; // normalize argument 4024758b46ceSmatthias.ringwald 4025758b46ceSmatthias.ringwald // don't emit event 40263a9fb326S[email protected] if (hci_stack->connectable == enable) return; 4027758b46ceSmatthias.ringwald 40283a9fb326S[email protected] hci_stack->connectable = enable; 4029758b46ceSmatthias.ringwald hci_update_scan_enable(); 4030381fbed8Smatthias.ringwald } 403135454696SMatthias Ringwald #endif 4032381fbed8Smatthias.ringwald 403315a95bd5SMatthias Ringwald void gap_local_bd_addr(bd_addr_t address_buffer){ 40346535961aSMatthias Ringwald (void)memcpy(address_buffer, hci_stack->local_bd_addr, 6); 40355061f3afS[email protected] } 40365061f3afS[email protected] 40372b838201SMatthias Ringwald #ifdef ENABLE_HCI_CONTROLLER_TO_HOST_FLOW_CONTROL 40382b838201SMatthias Ringwald static void hci_host_num_completed_packets(void){ 40392b838201SMatthias Ringwald 40402b838201SMatthias Ringwald // create packet manually as arrays are not supported and num_commands should not get reduced 40412b838201SMatthias Ringwald hci_reserve_packet_buffer(); 40422b838201SMatthias Ringwald uint8_t * packet = hci_get_outgoing_packet_buffer(); 40432b838201SMatthias Ringwald 40442b838201SMatthias Ringwald uint16_t size = 0; 40452b838201SMatthias Ringwald uint16_t num_handles = 0; 40462b838201SMatthias Ringwald packet[size++] = 0x35; 40472b838201SMatthias Ringwald packet[size++] = 0x0c; 40482b838201SMatthias Ringwald size++; // skip param len 40492b838201SMatthias Ringwald size++; // skip num handles 40502b838201SMatthias Ringwald 40512b838201SMatthias Ringwald // add { handle, packets } entries 40522b838201SMatthias Ringwald btstack_linked_item_t * it; 40532b838201SMatthias Ringwald for (it = (btstack_linked_item_t *) hci_stack->connections; it ; it = it->next){ 40542b838201SMatthias Ringwald hci_connection_t * connection = (hci_connection_t *) it; 40552b838201SMatthias Ringwald if (connection->num_packets_completed){ 40562b838201SMatthias Ringwald little_endian_store_16(packet, size, connection->con_handle); 40572b838201SMatthias Ringwald size += 2; 40582b838201SMatthias Ringwald little_endian_store_16(packet, size, connection->num_packets_completed); 40592b838201SMatthias Ringwald size += 2; 40602b838201SMatthias Ringwald // 40612b838201SMatthias Ringwald num_handles++; 40622b838201SMatthias Ringwald connection->num_packets_completed = 0; 40632b838201SMatthias Ringwald } 40642b838201SMatthias Ringwald } 40652b838201SMatthias Ringwald 40662b838201SMatthias Ringwald packet[2] = size - 3; 40672b838201SMatthias Ringwald packet[3] = num_handles; 40682b838201SMatthias Ringwald 40692b838201SMatthias Ringwald hci_stack->host_completed_packets = 0; 40702b838201SMatthias Ringwald 40712b838201SMatthias Ringwald hci_dump_packet(HCI_COMMAND_DATA_PACKET, 0, packet, size); 40722b838201SMatthias Ringwald hci_stack->hci_transport->send_packet(HCI_COMMAND_DATA_PACKET, packet, size); 40732b838201SMatthias Ringwald 40742b838201SMatthias Ringwald // release packet buffer for synchronous transport implementations 40752b838201SMatthias Ringwald if (hci_transport_synchronous()){ 4076e2d22487SMatthias Ringwald hci_release_packet_buffer(); 4077068b8592SMatthias Ringwald hci_emit_transport_packet_sent(); 40782b838201SMatthias Ringwald } 40792b838201SMatthias Ringwald } 40802b838201SMatthias Ringwald #endif 40812b838201SMatthias Ringwald 408226fe9592SMatthias Ringwald static void hci_halting_timeout_handler(btstack_timer_source_t * ds){ 408326fe9592SMatthias Ringwald UNUSED(ds); 408426fe9592SMatthias Ringwald hci_stack->substate = HCI_HALTING_CLOSE; 4085beceeddeSMatthias Ringwald // allow packet handlers to defer final shutdown 4086beceeddeSMatthias Ringwald hci_emit_state(); 408726fe9592SMatthias Ringwald hci_run(); 408826fe9592SMatthias Ringwald } 408926fe9592SMatthias Ringwald 4090f30077b7SMatthias Ringwald static bool hci_run_acl_fragments(void){ 40914ea43905SMatthias Ringwald if (hci_stack->acl_fragmentation_total_size > 0u) { 4092b5d8b22bS[email protected] hci_con_handle_t con_handle = READ_ACL_CONNECTION_HANDLE(hci_stack->hci_packet_buffer); 4093b5d8b22bS[email protected] hci_connection_t *connection = hci_connection_for_handle(con_handle); 4094b5d8b22bS[email protected] if (connection) { 409528a0332dSMatthias Ringwald if (hci_can_send_prepared_acl_packet_now(con_handle)){ 4096b5d8b22bS[email protected] hci_send_acl_packet_fragments(connection); 4097f30077b7SMatthias Ringwald return true; 4098b5d8b22bS[email protected] } 409928a0332dSMatthias Ringwald } else { 4100b5d8b22bS[email protected] // connection gone -> discard further fragments 410128a0332dSMatthias Ringwald log_info("hci_run: fragmented ACL packet no connection -> discard fragment"); 4102b5d8b22bS[email protected] hci_stack->acl_fragmentation_total_size = 0; 4103b5d8b22bS[email protected] hci_stack->acl_fragmentation_pos = 0; 4104b5d8b22bS[email protected] } 4105b5d8b22bS[email protected] } 4106f30077b7SMatthias Ringwald return false; 41072b838201SMatthias Ringwald } 4108b031bebbSmatthias.ringwald 410935454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 4110f30077b7SMatthias Ringwald static bool hci_run_general_gap_classic(void){ 4111f30077b7SMatthias Ringwald 411259d59ecfSMatthias Ringwald // assert stack is working and classic is active 411359d59ecfSMatthias Ringwald if (hci_classic_supported() == false) return false; 411459d59ecfSMatthias Ringwald if (hci_stack->state != HCI_STATE_WORKING) return false; 411559d59ecfSMatthias Ringwald 4116b031bebbSmatthias.ringwald // decline incoming connections 41173a9fb326S[email protected] if (hci_stack->decline_reason){ 41183a9fb326S[email protected] uint8_t reason = hci_stack->decline_reason; 41193a9fb326S[email protected] hci_stack->decline_reason = 0; 41203a9fb326S[email protected] hci_send_cmd(&hci_reject_connection_request, hci_stack->decline_addr, reason); 4121f30077b7SMatthias Ringwald return true; 4122ce4c8fabSmatthias.ringwald } 412359d59ecfSMatthias Ringwald 412459d59ecfSMatthias Ringwald if ((hci_stack->gap_tasks & GAP_TASK_SET_CLASS_OF_DEVICE) != 0) { 412559d59ecfSMatthias Ringwald hci_stack->gap_tasks &= ~GAP_TASK_SET_CLASS_OF_DEVICE; 412659d59ecfSMatthias Ringwald hci_send_cmd(&hci_write_class_of_device, hci_stack->class_of_device); 412759d59ecfSMatthias Ringwald return true; 412859d59ecfSMatthias Ringwald } 412959d59ecfSMatthias Ringwald if ((hci_stack->gap_tasks & GAP_TASK_SET_LOCAL_NAME) != 0) { 413059d59ecfSMatthias Ringwald hci_stack->gap_tasks &= ~GAP_TASK_SET_LOCAL_NAME; 413159d59ecfSMatthias Ringwald gap_run_set_local_name(); 413259d59ecfSMatthias Ringwald return true; 413359d59ecfSMatthias Ringwald } 413459d59ecfSMatthias Ringwald if ((hci_stack->gap_tasks & GAP_TASK_SET_EIR_DATA) != 0) { 413559d59ecfSMatthias Ringwald hci_stack->gap_tasks &= ~GAP_TASK_SET_EIR_DATA; 413659d59ecfSMatthias Ringwald gap_run_set_eir_data(); 413759d59ecfSMatthias Ringwald return true; 413859d59ecfSMatthias Ringwald } 413959d59ecfSMatthias Ringwald if ((hci_stack->gap_tasks & GAP_TASK_SET_DEFAULT_LINK_POLICY) != 0) { 414059d59ecfSMatthias Ringwald hci_stack->gap_tasks &= ~GAP_TASK_SET_DEFAULT_LINK_POLICY; 414159d59ecfSMatthias Ringwald hci_send_cmd(&hci_write_default_link_policy_setting, hci_stack->default_link_policy_settings); 414259d59ecfSMatthias Ringwald return true; 414359d59ecfSMatthias Ringwald } 4144bea424a5SMatthias Ringwald // write page scan activity 414559d59ecfSMatthias Ringwald if (hci_stack->new_page_scan_interval != 0xffff) { 414659d59ecfSMatthias Ringwald uint16_t new_page_scan_interval = hci_stack->new_page_scan_interval; 414759d59ecfSMatthias Ringwald uint16_t new_page_scan_window = hci_stack->new_page_scan_window; 4148bea424a5SMatthias Ringwald hci_stack->new_page_scan_interval = 0xffff; 4149bea424a5SMatthias Ringwald hci_stack->new_page_scan_window = 0xffff; 415059d59ecfSMatthias Ringwald hci_send_cmd(&hci_write_page_scan_activity, new_page_scan_interval, new_page_scan_window); 4151bea424a5SMatthias Ringwald return true; 4152bea424a5SMatthias Ringwald } 4153bea424a5SMatthias Ringwald // write page scan type 415459d59ecfSMatthias Ringwald if (hci_stack->new_page_scan_type != 0xff) { 415559d59ecfSMatthias Ringwald uint8_t new_page_scan_type = hci_stack->new_page_scan_type; 4156bea424a5SMatthias Ringwald hci_stack->new_page_scan_type = 0xff; 415759d59ecfSMatthias Ringwald hci_send_cmd(&hci_write_page_scan_type, new_page_scan_type); 4158bea424a5SMatthias Ringwald return true; 4159bea424a5SMatthias Ringwald } 4160b031bebbSmatthias.ringwald // send scan enable 416159d59ecfSMatthias Ringwald if (hci_stack->new_scan_enable_value != 0xff) { 416259d59ecfSMatthias Ringwald uint8_t new_scan_enable_value = hci_stack->new_scan_enable_value; 41633a9fb326S[email protected] hci_stack->new_scan_enable_value = 0xff; 416459d59ecfSMatthias Ringwald hci_send_cmd(&hci_write_scan_enable, new_scan_enable_value); 4165f30077b7SMatthias Ringwald return true; 4166b031bebbSmatthias.ringwald } 416759d59ecfSMatthias Ringwald 4168f5875de5SMatthias Ringwald // start/stop inquiry 4169a1df452eSMatthias Ringwald if ((hci_stack->inquiry_state >= GAP_INQUIRY_DURATION_MIN) && (hci_stack->inquiry_state <= GAP_INQUIRY_DURATION_MAX)){ 4170f5875de5SMatthias Ringwald uint8_t duration = hci_stack->inquiry_state; 4171beb3c81dSMatthias Ringwald hci_stack->inquiry_state = GAP_INQUIRY_STATE_W4_ACTIVE; 4172496bb884SMatthias Ringwald hci_send_cmd(&hci_inquiry, hci_stack->inquiry_lap, duration, 0); 4173f30077b7SMatthias Ringwald return true; 4174f5875de5SMatthias Ringwald } 4175f5875de5SMatthias Ringwald if (hci_stack->inquiry_state == GAP_INQUIRY_STATE_W2_CANCEL){ 4176f5875de5SMatthias Ringwald hci_stack->inquiry_state = GAP_INQUIRY_STATE_W4_CANCELLED; 4177f5875de5SMatthias Ringwald hci_send_cmd(&hci_inquiry_cancel); 4178f30077b7SMatthias Ringwald return true; 4179f5875de5SMatthias Ringwald } 4180b7f1ee76SMatthias Ringwald // remote name request 4181b7f1ee76SMatthias Ringwald if (hci_stack->remote_name_state == GAP_REMOTE_NAME_STATE_W2_SEND){ 4182b7f1ee76SMatthias Ringwald hci_stack->remote_name_state = GAP_REMOTE_NAME_STATE_W4_COMPLETE; 4183b7f1ee76SMatthias Ringwald hci_send_cmd(&hci_remote_name_request, hci_stack->remote_name_addr, 4184ee8a36c8SMatthias Ringwald hci_stack->remote_name_page_scan_repetition_mode, 0, hci_stack->remote_name_clock_offset); 4185f30077b7SMatthias Ringwald return true; 4186b7f1ee76SMatthias Ringwald } 4187cf01e888SMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB 4188cf01e888SMatthias Ringwald // Local OOB data 418959d59ecfSMatthias Ringwald if (hci_stack->classic_read_local_oob_data){ 4190cf01e888SMatthias Ringwald hci_stack->classic_read_local_oob_data = false; 4191cf01e888SMatthias Ringwald if (hci_stack->local_supported_commands[1] & 0x10u){ 4192cf01e888SMatthias Ringwald hci_send_cmd(&hci_read_local_extended_oob_data); 4193cf01e888SMatthias Ringwald } else { 4194cf01e888SMatthias Ringwald hci_send_cmd(&hci_read_local_oob_data); 4195cf01e888SMatthias Ringwald } 4196cf01e888SMatthias Ringwald } 4197cf01e888SMatthias Ringwald #endif 41980a51f88bSMatthias Ringwald // pairing 41990a51f88bSMatthias Ringwald if (hci_stack->gap_pairing_state != GAP_PAIRING_STATE_IDLE){ 42000a51f88bSMatthias Ringwald uint8_t state = hci_stack->gap_pairing_state; 42013f659ee4SMilanka Ringwald uint8_t pin_code[16]; 42020a51f88bSMatthias Ringwald switch (state){ 42030a51f88bSMatthias Ringwald case GAP_PAIRING_STATE_SEND_PIN: 4204cc15bb2cSMatthias Ringwald hci_stack->gap_pairing_state = GAP_PAIRING_STATE_IDLE; 42053f659ee4SMilanka Ringwald memset(pin_code, 0, 16); 42063f659ee4SMilanka Ringwald memcpy(pin_code, hci_stack->gap_pairing_input.gap_pairing_pin, hci_stack->gap_pairing_pin_len); 42073f659ee4SMilanka Ringwald hci_send_cmd(&hci_pin_code_request_reply, hci_stack->gap_pairing_addr, hci_stack->gap_pairing_pin_len, pin_code); 42080a51f88bSMatthias Ringwald break; 42090a51f88bSMatthias Ringwald case GAP_PAIRING_STATE_SEND_PIN_NEGATIVE: 4210cc15bb2cSMatthias Ringwald hci_stack->gap_pairing_state = GAP_PAIRING_STATE_WAIT_FOR_COMMAND_COMPLETE; 42110a51f88bSMatthias Ringwald hci_send_cmd(&hci_pin_code_request_negative_reply, hci_stack->gap_pairing_addr); 42120a51f88bSMatthias Ringwald break; 42130a51f88bSMatthias Ringwald case GAP_PAIRING_STATE_SEND_PASSKEY: 4214cc15bb2cSMatthias Ringwald hci_stack->gap_pairing_state = GAP_PAIRING_STATE_IDLE; 4215d504181aSMatthias Ringwald hci_send_cmd(&hci_user_passkey_request_reply, hci_stack->gap_pairing_addr, hci_stack->gap_pairing_input.gap_pairing_passkey); 42160a51f88bSMatthias Ringwald break; 42170a51f88bSMatthias Ringwald case GAP_PAIRING_STATE_SEND_PASSKEY_NEGATIVE: 4218cc15bb2cSMatthias Ringwald hci_stack->gap_pairing_state = GAP_PAIRING_STATE_WAIT_FOR_COMMAND_COMPLETE; 42190a51f88bSMatthias Ringwald hci_send_cmd(&hci_user_passkey_request_negative_reply, hci_stack->gap_pairing_addr); 42200a51f88bSMatthias Ringwald break; 42210a51f88bSMatthias Ringwald case GAP_PAIRING_STATE_SEND_CONFIRMATION: 4222cc15bb2cSMatthias Ringwald hci_stack->gap_pairing_state = GAP_PAIRING_STATE_IDLE; 42230a51f88bSMatthias Ringwald hci_send_cmd(&hci_user_confirmation_request_reply, hci_stack->gap_pairing_addr); 42240a51f88bSMatthias Ringwald break; 42250a51f88bSMatthias Ringwald case GAP_PAIRING_STATE_SEND_CONFIRMATION_NEGATIVE: 4226cc15bb2cSMatthias Ringwald hci_stack->gap_pairing_state = GAP_PAIRING_STATE_WAIT_FOR_COMMAND_COMPLETE; 42270a51f88bSMatthias Ringwald hci_send_cmd(&hci_user_confirmation_request_negative_reply, hci_stack->gap_pairing_addr); 42280a51f88bSMatthias Ringwald break; 42290a51f88bSMatthias Ringwald default: 42300a51f88bSMatthias Ringwald break; 42310a51f88bSMatthias Ringwald } 4232f30077b7SMatthias Ringwald return true; 4233f30077b7SMatthias Ringwald } 4234f30077b7SMatthias Ringwald return false; 42350a51f88bSMatthias Ringwald } 423635454696SMatthias Ringwald #endif 4237b031bebbSmatthias.ringwald 4238a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE 4239f30077b7SMatthias Ringwald static bool hci_run_general_gap_le(void){ 4240f30077b7SMatthias Ringwald 4241f30077b7SMatthias Ringwald // advertisements, active scanning, and creating connections requires random address to be set if using private address 4242f30077b7SMatthias Ringwald 4243f30077b7SMatthias Ringwald if (hci_stack->state != HCI_STATE_WORKING) return false; 42444ea43905SMatthias Ringwald if ( (hci_stack->le_own_addr_type != BD_ADDR_TYPE_LE_PUBLIC) && (hci_stack->le_random_address_set == 0u) ) return false; 4245d70217a2SMatthias Ringwald 4246a41310b7SMatthias Ringwald 4247a41310b7SMatthias Ringwald // Phase 1: collect what to stop 4248a41310b7SMatthias Ringwald 4249a41310b7SMatthias Ringwald bool scanning_stop = false; 4250a41310b7SMatthias Ringwald bool connecting_stop = false; 4251a41310b7SMatthias Ringwald bool advertising_stop = false; 4252a41310b7SMatthias Ringwald 4253a41310b7SMatthias Ringwald #ifndef ENABLE_LE_CENTRAL 4254a41310b7SMatthias Ringwald UNUSED(scanning_stop); 42550abd9f64SMatthias Ringwald UNUSED(connecting_stop); 4256a41310b7SMatthias Ringwald #endif 4257a41310b7SMatthias Ringwald #ifndef ENABLE_LE_PERIPHERAL 4258a41310b7SMatthias Ringwald UNUSED(advertising_stop); 4259a41310b7SMatthias Ringwald #endif 4260a41310b7SMatthias Ringwald 426129c24bebSMatthias Ringwald // check if whitelist needs modification 426229c24bebSMatthias Ringwald bool whitelist_modification_pending = false; 426329c24bebSMatthias Ringwald btstack_linked_list_iterator_t lit; 426429c24bebSMatthias Ringwald btstack_linked_list_iterator_init(&lit, &hci_stack->le_whitelist); 426529c24bebSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&lit)){ 426629c24bebSMatthias Ringwald whitelist_entry_t * entry = (whitelist_entry_t*) btstack_linked_list_iterator_next(&lit); 426729c24bebSMatthias Ringwald if (entry->state & (LE_WHITELIST_REMOVE_FROM_CONTROLLER | LE_WHITELIST_ADD_TO_CONTROLLER)){ 426829c24bebSMatthias Ringwald whitelist_modification_pending = true; 426929c24bebSMatthias Ringwald break; 427029c24bebSMatthias Ringwald } 427129c24bebSMatthias Ringwald } 427221debf25SMatthias Ringwald // check if resolving list needs modification 427321debf25SMatthias Ringwald bool resolving_list_modification_pending = false; 427421debf25SMatthias Ringwald #ifdef ENABLE_LE_PRIVACY_ADDRESS_RESOLUTION 4275ea151974SMatthias Ringwald bool resolving_list_supported = (hci_stack->local_supported_commands[1] & (1 << 2)) != 0; 4276ea151974SMatthias Ringwald if (resolving_list_supported && hci_stack->le_resolving_list_state != LE_RESOLVING_LIST_DONE){ 427721debf25SMatthias Ringwald resolving_list_modification_pending = true; 427821debf25SMatthias Ringwald } 427921debf25SMatthias Ringwald #endif 428029c24bebSMatthias Ringwald 4281d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 4282fde725feSMatthias Ringwald // scanning control 42833251a108SMatthias Ringwald if (hci_stack->le_scanning_active) { 428429c24bebSMatthias Ringwald // stop if: 428529c24bebSMatthias Ringwald // - parameter change required 428629c24bebSMatthias Ringwald // - it's disabled 428729c24bebSMatthias Ringwald // - whitelist change required but used for scanning 428821debf25SMatthias Ringwald // - resolving list modified 428929c24bebSMatthias Ringwald bool scanning_uses_whitelist = (hci_stack->le_scan_filter_policy & 1) == 1; 429021debf25SMatthias Ringwald if ((hci_stack->le_scanning_param_update) || 429121debf25SMatthias Ringwald !hci_stack->le_scanning_enabled || 429221debf25SMatthias Ringwald scanning_uses_whitelist || 429321debf25SMatthias Ringwald resolving_list_modification_pending){ 429421debf25SMatthias Ringwald 42952d5c2a27SMatthias Ringwald scanning_stop = true; 4296fde725feSMatthias Ringwald } 4297fde725feSMatthias Ringwald } 429829c24bebSMatthias Ringwald #endif 4299fde725feSMatthias Ringwald 430029c24bebSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 430129c24bebSMatthias Ringwald // connecting control 4302f496d06eSMatthias Ringwald bool connecting_with_whitelist; 4303f496d06eSMatthias Ringwald switch (hci_stack->le_connecting_state){ 4304f496d06eSMatthias Ringwald case LE_CONNECTING_DIRECT: 4305f496d06eSMatthias Ringwald case LE_CONNECTING_WHITELIST: 4306af64f147SMatthias Ringwald // stop connecting if: 4307af64f147SMatthias Ringwald // - connecting uses white and whitelist modification pending 4308af64f147SMatthias Ringwald // - if it got disabled 430921debf25SMatthias Ringwald // - resolving list modified 4310f496d06eSMatthias Ringwald connecting_with_whitelist = hci_stack->le_connecting_state == LE_CONNECTING_WHITELIST; 4311f496d06eSMatthias Ringwald if ((connecting_with_whitelist && whitelist_modification_pending) || 431221debf25SMatthias Ringwald (hci_stack->le_connecting_request == LE_CONNECTING_IDLE) || 431321debf25SMatthias Ringwald resolving_list_modification_pending) { 431421debf25SMatthias Ringwald 431529c24bebSMatthias Ringwald connecting_stop = true; 431629c24bebSMatthias Ringwald } 4317f496d06eSMatthias Ringwald break; 4318f496d06eSMatthias Ringwald default: 4319f496d06eSMatthias Ringwald break; 432029c24bebSMatthias Ringwald } 4321d70217a2SMatthias Ringwald #endif 432229c24bebSMatthias Ringwald 4323d70217a2SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 432445c102fdSMatthias Ringwald // le advertisement control 4325bbc366e6SMatthias Ringwald if (hci_stack->le_advertisements_active){ 432629c24bebSMatthias Ringwald // stop if: 432729c24bebSMatthias Ringwald // - parameter change required 432829c24bebSMatthias Ringwald // - it's disabled 4329ba44ad41SMatthias Ringwald // - whitelist change required but used for advertisement filter policy 433021debf25SMatthias Ringwald // - resolving list modified 4331a61834b6SMatthias Ringwald bool advertising_uses_whitelist = hci_stack->le_advertisements_filter_policy != 0; 43324e5d21eaSMatthias Ringwald bool advertising_change = (hci_stack->le_advertisements_todo & LE_ADVERTISEMENT_TASKS_SET_PARAMS) != 0; 4333a61834b6SMatthias Ringwald if (advertising_change || 4334a61834b6SMatthias Ringwald (hci_stack->le_advertisements_enabled_for_current_roles == 0) || 433521debf25SMatthias Ringwald (advertising_uses_whitelist & whitelist_modification_pending) || 433621debf25SMatthias Ringwald resolving_list_modification_pending) { 433721debf25SMatthias Ringwald 4338fde725feSMatthias Ringwald advertising_stop = true; 4339fde725feSMatthias Ringwald } 4340fde725feSMatthias Ringwald } 4341a41310b7SMatthias Ringwald #endif 4342fde725feSMatthias Ringwald 4343a41310b7SMatthias Ringwald 4344a41310b7SMatthias Ringwald // Phase 2: stop everything that should be off during modifications 4345a41310b7SMatthias Ringwald 4346a41310b7SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 4347a41310b7SMatthias Ringwald if (scanning_stop){ 43485226d7f2SMatthias Ringwald hci_stack->le_scanning_active = false; 4349a41310b7SMatthias Ringwald hci_send_cmd(&hci_le_set_scan_enable, 0, 0); 4350a41310b7SMatthias Ringwald return true; 4351a41310b7SMatthias Ringwald } 4352a41310b7SMatthias Ringwald #endif 4353a41310b7SMatthias Ringwald 4354a41310b7SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 4355a41310b7SMatthias Ringwald if (connecting_stop){ 4356a41310b7SMatthias Ringwald hci_send_cmd(&hci_le_create_connection_cancel); 4357a41310b7SMatthias Ringwald return true; 4358a41310b7SMatthias Ringwald } 4359a41310b7SMatthias Ringwald #endif 4360a41310b7SMatthias Ringwald 4361a41310b7SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 4362fde725feSMatthias Ringwald if (advertising_stop){ 43635226d7f2SMatthias Ringwald hci_stack->le_advertisements_active = false; 436445c102fdSMatthias Ringwald hci_send_cmd(&hci_le_set_advertise_enable, 0); 4365f30077b7SMatthias Ringwald return true; 436645c102fdSMatthias Ringwald } 4367a41310b7SMatthias Ringwald #endif 4368fde725feSMatthias Ringwald 4369a41310b7SMatthias Ringwald // Phase 3: modify 4370a41310b7SMatthias Ringwald 4371a41310b7SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 4372a41310b7SMatthias Ringwald if (hci_stack->le_scanning_param_update){ 4373a41310b7SMatthias Ringwald hci_stack->le_scanning_param_update = false; 4374a41310b7SMatthias Ringwald hci_send_cmd(&hci_le_set_scan_parameters, hci_stack->le_scan_type, hci_stack->le_scan_interval, hci_stack->le_scan_window, 4375a41310b7SMatthias Ringwald hci_stack->le_own_addr_type, hci_stack->le_scan_filter_policy); 4376a41310b7SMatthias Ringwald return true; 4377a41310b7SMatthias Ringwald } 4378a41310b7SMatthias Ringwald #endif 4379a41310b7SMatthias Ringwald 4380a41310b7SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 438145c102fdSMatthias Ringwald if (hci_stack->le_advertisements_todo & LE_ADVERTISEMENT_TASKS_SET_PARAMS){ 438245c102fdSMatthias Ringwald hci_stack->le_advertisements_todo &= ~LE_ADVERTISEMENT_TASKS_SET_PARAMS; 43836bcfa632SMatthias Ringwald hci_stack->le_advertisements_own_addr_type = hci_stack->le_own_addr_type; 438445c102fdSMatthias Ringwald hci_send_cmd(&hci_le_set_advertising_parameters, 438545c102fdSMatthias Ringwald hci_stack->le_advertisements_interval_min, 438645c102fdSMatthias Ringwald hci_stack->le_advertisements_interval_max, 438745c102fdSMatthias Ringwald hci_stack->le_advertisements_type, 43886bcfa632SMatthias Ringwald hci_stack->le_advertisements_own_addr_type, 438945c102fdSMatthias Ringwald hci_stack->le_advertisements_direct_address_type, 439045c102fdSMatthias Ringwald hci_stack->le_advertisements_direct_address, 439145c102fdSMatthias Ringwald hci_stack->le_advertisements_channel_map, 439245c102fdSMatthias Ringwald hci_stack->le_advertisements_filter_policy); 4393f30077b7SMatthias Ringwald return true; 439445c102fdSMatthias Ringwald } 4395501f56b3SMatthias Ringwald if (hci_stack->le_advertisements_todo & LE_ADVERTISEMENT_TASKS_SET_ADV_DATA){ 4396501f56b3SMatthias Ringwald hci_stack->le_advertisements_todo &= ~LE_ADVERTISEMENT_TASKS_SET_ADV_DATA; 43977a85e4f5SMatthias Ringwald uint8_t adv_data_clean[31]; 43987a85e4f5SMatthias Ringwald memset(adv_data_clean, 0, sizeof(adv_data_clean)); 43996535961aSMatthias Ringwald (void)memcpy(adv_data_clean, hci_stack->le_advertisements_data, 44006535961aSMatthias Ringwald hci_stack->le_advertisements_data_len); 44013c9da642SMatthias Ringwald btstack_replace_bd_addr_placeholder(adv_data_clean, hci_stack->le_advertisements_data_len, hci_stack->local_bd_addr); 44027a85e4f5SMatthias Ringwald hci_send_cmd(&hci_le_set_advertising_data, hci_stack->le_advertisements_data_len, adv_data_clean); 4403f30077b7SMatthias Ringwald return true; 440445c102fdSMatthias Ringwald } 4405501f56b3SMatthias Ringwald if (hci_stack->le_advertisements_todo & LE_ADVERTISEMENT_TASKS_SET_SCAN_DATA){ 4406501f56b3SMatthias Ringwald hci_stack->le_advertisements_todo &= ~LE_ADVERTISEMENT_TASKS_SET_SCAN_DATA; 4407f868b059SMatthias Ringwald uint8_t scan_data_clean[31]; 4408f868b059SMatthias Ringwald memset(scan_data_clean, 0, sizeof(scan_data_clean)); 44096535961aSMatthias Ringwald (void)memcpy(scan_data_clean, hci_stack->le_scan_response_data, 44106535961aSMatthias Ringwald hci_stack->le_scan_response_data_len); 44113c9da642SMatthias Ringwald btstack_replace_bd_addr_placeholder(scan_data_clean, hci_stack->le_scan_response_data_len, hci_stack->local_bd_addr); 4412214bfd60SMatthias Ringwald hci_send_cmd(&hci_le_set_scan_response_data, hci_stack->le_scan_response_data_len, scan_data_clean); 4413f30077b7SMatthias Ringwald return true; 4414501f56b3SMatthias Ringwald } 4415d70217a2SMatthias Ringwald #endif 44169956955bSMatthias Ringwald 441713eb2a2eSMatthias Ringwald 4418057ab60cSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 4419a41310b7SMatthias Ringwald // if connect with whitelist was active and is not cancelled yet, wait until next time 4420a41310b7SMatthias Ringwald if (hci_stack->le_connecting_state == LE_CONNECTING_CANCEL) return false; 4421057ab60cSMatthias Ringwald #endif 4422057ab60cSMatthias Ringwald 4423a41310b7SMatthias Ringwald // LE Whitelist Management 4424a41310b7SMatthias Ringwald if (whitelist_modification_pending){ 44259956955bSMatthias Ringwald // add/remove entries 4426665d90f2SMatthias Ringwald btstack_linked_list_iterator_init(&lit, &hci_stack->le_whitelist); 4427665d90f2SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&lit)){ 4428665d90f2SMatthias Ringwald whitelist_entry_t * entry = (whitelist_entry_t*) btstack_linked_list_iterator_next(&lit); 4429453459ddSMatthias Ringwald if (entry->state & LE_WHITELIST_REMOVE_FROM_CONTROLLER){ 4430453459ddSMatthias Ringwald entry->state &= ~LE_WHITELIST_REMOVE_FROM_CONTROLLER; 4431453459ddSMatthias Ringwald hci_send_cmd(&hci_le_remove_device_from_white_list, entry->address_type, entry->address); 4432453459ddSMatthias Ringwald return true; 4433453459ddSMatthias Ringwald } 44349956955bSMatthias Ringwald if (entry->state & LE_WHITELIST_ADD_TO_CONTROLLER){ 4435453459ddSMatthias Ringwald entry->state &= ~LE_WHITELIST_ADD_TO_CONTROLLER; 4436453459ddSMatthias Ringwald entry->state |= LE_WHITELIST_ON_CONTROLLER; 44379956955bSMatthias Ringwald hci_send_cmd(&hci_le_add_device_to_white_list, entry->address_type, entry->address); 4438f30077b7SMatthias Ringwald return true; 44399956955bSMatthias Ringwald } 4440453459ddSMatthias Ringwald if ((entry->state & LE_WHITELIST_ON_CONTROLLER) == 0){ 4441665d90f2SMatthias Ringwald btstack_linked_list_remove(&hci_stack->le_whitelist, (btstack_linked_item_t *) entry); 44429956955bSMatthias Ringwald btstack_memory_whitelist_entry_free(entry); 44439956955bSMatthias Ringwald } 44449956955bSMatthias Ringwald } 444591915b0bSMatthias Ringwald } 44469956955bSMatthias Ringwald 444721debf25SMatthias Ringwald #ifdef ENABLE_LE_PRIVACY_ADDRESS_RESOLUTION 444821debf25SMatthias Ringwald // LE Resolving List Management 4449ea151974SMatthias Ringwald if (resolving_list_supported) { 445021debf25SMatthias Ringwald uint16_t i; 445121debf25SMatthias Ringwald switch (hci_stack->le_resolving_list_state) { 445221debf25SMatthias Ringwald case LE_RESOLVING_LIST_SEND_ENABLE_ADDRESS_RESOLUTION: 445321debf25SMatthias Ringwald hci_stack->le_resolving_list_state = LE_RESOLVING_LIST_READ_SIZE; 445421debf25SMatthias Ringwald hci_send_cmd(&hci_le_set_address_resolution_enabled, 1); 445521debf25SMatthias Ringwald return true; 445621debf25SMatthias Ringwald case LE_RESOLVING_LIST_READ_SIZE: 445721debf25SMatthias Ringwald hci_stack->le_resolving_list_state = LE_RESOLVING_LIST_SEND_CLEAR; 445821debf25SMatthias Ringwald hci_send_cmd(&hci_le_read_resolving_list_size); 445921debf25SMatthias Ringwald return true; 446021debf25SMatthias Ringwald case LE_RESOLVING_LIST_SEND_CLEAR: 446102b02cffSMatthias Ringwald hci_stack->le_resolving_list_state = LE_RESOLVING_LIST_REMOVE_ENTRIES; 4462ea151974SMatthias Ringwald (void) memset(hci_stack->le_resolving_list_add_entries, 0xff, 4463ea151974SMatthias Ringwald sizeof(hci_stack->le_resolving_list_add_entries)); 4464ea151974SMatthias Ringwald (void) memset(hci_stack->le_resolving_list_remove_entries, 0, 4465ea151974SMatthias Ringwald sizeof(hci_stack->le_resolving_list_remove_entries)); 446621debf25SMatthias Ringwald hci_send_cmd(&hci_le_clear_resolving_list); 446721debf25SMatthias Ringwald return true; 446802b02cffSMatthias Ringwald case LE_RESOLVING_LIST_REMOVE_ENTRIES: 446902b02cffSMatthias Ringwald for (i = 0; i < MAX_NUM_RESOLVING_LIST_ENTRIES && i < le_device_db_max_count(); i++) { 447002b02cffSMatthias Ringwald uint8_t offset = i >> 3; 447102b02cffSMatthias Ringwald uint8_t mask = 1 << (i & 7); 447202b02cffSMatthias Ringwald if ((hci_stack->le_resolving_list_remove_entries[offset] & mask) == 0) continue; 447302b02cffSMatthias Ringwald hci_stack->le_resolving_list_remove_entries[offset] &= ~mask; 447402b02cffSMatthias Ringwald bd_addr_t peer_identity_addreses; 447502b02cffSMatthias Ringwald int peer_identity_addr_type = (int) BD_ADDR_TYPE_UNKNOWN; 447602b02cffSMatthias Ringwald sm_key_t peer_irk; 447702b02cffSMatthias Ringwald le_device_db_info(i, &peer_identity_addr_type, peer_identity_addreses, peer_irk); 447802b02cffSMatthias Ringwald if (peer_identity_addr_type == BD_ADDR_TYPE_UNKNOWN) continue; 4479f5228c62SMatthias Ringwald 4480f5228c62SMatthias Ringwald #ifdef ENABLE_LE_WHITELIST_TOUCH_AFTER_RESOLVING_LIST_UPDATE 4481f5228c62SMatthias Ringwald // trigger whitelist entry 'update' (work around for controller bug) 4482f5228c62SMatthias Ringwald btstack_linked_list_iterator_init(&lit, &hci_stack->le_whitelist); 4483f5228c62SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&lit)) { 4484f5228c62SMatthias Ringwald whitelist_entry_t *entry = (whitelist_entry_t *) btstack_linked_list_iterator_next(&lit); 4485f5228c62SMatthias Ringwald if (entry->address_type != peer_identity_addr_type) continue; 4486f5228c62SMatthias Ringwald if (memcmp(entry->address, peer_identity_addreses, 6) != 0) continue; 4487f5228c62SMatthias Ringwald log_info("trigger whitelist update %s", bd_addr_to_str(peer_identity_addreses)); 4488f5228c62SMatthias Ringwald entry->state |= LE_WHITELIST_REMOVE_FROM_CONTROLLER | LE_WHITELIST_ADD_TO_CONTROLLER; 4489f5228c62SMatthias Ringwald } 4490f5228c62SMatthias Ringwald #endif 4491f5228c62SMatthias Ringwald 4492ea151974SMatthias Ringwald hci_send_cmd(&hci_le_remove_device_from_resolving_list, peer_identity_addr_type, 4493ea151974SMatthias Ringwald peer_identity_addreses); 449402b02cffSMatthias Ringwald return true; 449502b02cffSMatthias Ringwald } 449602b02cffSMatthias Ringwald 449702b02cffSMatthias Ringwald hci_stack->le_resolving_list_state = LE_RESOLVING_LIST_ADD_ENTRIES; 449802b02cffSMatthias Ringwald 449902b02cffSMatthias Ringwald /* fall through */ 450002b02cffSMatthias Ringwald 450121debf25SMatthias Ringwald case LE_RESOLVING_LIST_ADD_ENTRIES: 450221debf25SMatthias Ringwald for (i = 0; i < MAX_NUM_RESOLVING_LIST_ENTRIES && i < le_device_db_max_count(); i++) { 450321debf25SMatthias Ringwald uint8_t offset = i >> 3; 450421debf25SMatthias Ringwald uint8_t mask = 1 << (i & 7); 450502b02cffSMatthias Ringwald if ((hci_stack->le_resolving_list_add_entries[offset] & mask) == 0) continue; 450602b02cffSMatthias Ringwald hci_stack->le_resolving_list_add_entries[offset] &= ~mask; 450721debf25SMatthias Ringwald bd_addr_t peer_identity_addreses; 450821debf25SMatthias Ringwald int peer_identity_addr_type = (int) BD_ADDR_TYPE_UNKNOWN; 450921debf25SMatthias Ringwald sm_key_t peer_irk; 451021debf25SMatthias Ringwald le_device_db_info(i, &peer_identity_addr_type, peer_identity_addreses, peer_irk); 451121debf25SMatthias Ringwald if (peer_identity_addr_type == BD_ADDR_TYPE_UNKNOWN) continue; 451221debf25SMatthias Ringwald const uint8_t *local_irk = gap_get_persistent_irk(); 451321debf25SMatthias Ringwald // command uses format specifier 'P' that stores 16-byte value without flip 451421debf25SMatthias Ringwald uint8_t local_irk_flipped[16]; 451521debf25SMatthias Ringwald uint8_t peer_irk_flipped[16]; 451621debf25SMatthias Ringwald reverse_128(local_irk, local_irk_flipped); 451721debf25SMatthias Ringwald reverse_128(peer_irk, peer_irk_flipped); 4518ea151974SMatthias Ringwald hci_send_cmd(&hci_le_add_device_to_resolving_list, peer_identity_addr_type, peer_identity_addreses, 4519ea151974SMatthias Ringwald peer_irk_flipped, local_irk_flipped); 452021debf25SMatthias Ringwald return true; 452121debf25SMatthias Ringwald } 452202b02cffSMatthias Ringwald hci_stack->le_resolving_list_state = LE_RESOLVING_LIST_DONE; 452321debf25SMatthias Ringwald break; 452402b02cffSMatthias Ringwald 452521debf25SMatthias Ringwald default: 452621debf25SMatthias Ringwald break; 452721debf25SMatthias Ringwald } 4528ea151974SMatthias Ringwald } 452921debf25SMatthias Ringwald hci_stack->le_resolving_list_state = LE_RESOLVING_LIST_DONE; 453021debf25SMatthias Ringwald #endif 4531a41310b7SMatthias Ringwald 4532a41310b7SMatthias Ringwald // Phase 4: restore state 453329c24bebSMatthias Ringwald 453429c24bebSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 4535af64f147SMatthias Ringwald // re-start scanning 453629c24bebSMatthias Ringwald if ((hci_stack->le_scanning_enabled && !hci_stack->le_scanning_active)){ 453729c24bebSMatthias Ringwald hci_stack->le_scanning_active = true; 453829c24bebSMatthias Ringwald hci_send_cmd(&hci_le_set_scan_enable, 1, 0); 453929c24bebSMatthias Ringwald return true; 454029c24bebSMatthias Ringwald } 454129c24bebSMatthias Ringwald #endif 454229c24bebSMatthias Ringwald 454313eb2a2eSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 4544af64f147SMatthias Ringwald // re-start connecting 4545af64f147SMatthias Ringwald if ( (hci_stack->le_connecting_state == LE_CONNECTING_IDLE) && (hci_stack->le_connecting_request == LE_CONNECTING_WHITELIST)){ 45469956955bSMatthias Ringwald bd_addr_t null_addr; 45479956955bSMatthias Ringwald memset(null_addr, 0, 6); 45486bcfa632SMatthias Ringwald hci_stack->le_connection_own_addr_type = hci_stack->le_own_addr_type; 45496bcfa632SMatthias Ringwald hci_get_own_address_for_addr_type(hci_stack->le_connection_own_addr_type, hci_stack->le_connection_own_address); 45509956955bSMatthias Ringwald hci_send_cmd(&hci_le_create_connection, 4551cbe54ab2SJakob Krantz hci_stack->le_connection_scan_interval, // scan interval: 60 ms 4552cbe54ab2SJakob Krantz hci_stack->le_connection_scan_window, // scan interval: 30 ms 45539956955bSMatthias Ringwald 1, // use whitelist 45549956955bSMatthias Ringwald 0, // peer address type 45559956955bSMatthias Ringwald null_addr, // peer bd addr 45566bcfa632SMatthias Ringwald hci_stack->le_connection_own_addr_type, // our addr type: 455773044eb2SMatthias Ringwald hci_stack->le_connection_interval_min, // conn interval min 455873044eb2SMatthias Ringwald hci_stack->le_connection_interval_max, // conn interval max 455973044eb2SMatthias Ringwald hci_stack->le_connection_latency, // conn latency 456073044eb2SMatthias Ringwald hci_stack->le_supervision_timeout, // conn latency 456173044eb2SMatthias Ringwald hci_stack->le_minimum_ce_length, // min ce length 456273044eb2SMatthias Ringwald hci_stack->le_maximum_ce_length // max ce length 45639956955bSMatthias Ringwald ); 4564f30077b7SMatthias Ringwald return true; 45659956955bSMatthias Ringwald } 4566d70217a2SMatthias Ringwald #endif 4567a41310b7SMatthias Ringwald 4568a41310b7SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 4569a41310b7SMatthias Ringwald // re-start advertising 45708978dcf1SMatthias Ringwald if (hci_stack->le_advertisements_enabled_for_current_roles && !hci_stack->le_advertisements_active){ 4571a41310b7SMatthias Ringwald // check if advertisements should be enabled given 45725226d7f2SMatthias Ringwald hci_stack->le_advertisements_active = true; 45736bcfa632SMatthias Ringwald hci_get_own_address_for_addr_type(hci_stack->le_connection_own_addr_type, hci_stack->le_advertisements_own_address); 4574a41310b7SMatthias Ringwald hci_send_cmd(&hci_le_set_advertise_enable, 1); 4575a41310b7SMatthias Ringwald return true; 4576a41310b7SMatthias Ringwald } 4577a41310b7SMatthias Ringwald #endif 4578a41310b7SMatthias Ringwald 4579f30077b7SMatthias Ringwald return false; 45807bdc6798S[email protected] } 4581b2f949feS[email protected] #endif 45827bdc6798S[email protected] 458388a03c8dSMatthias Ringwald static bool hci_run_general_pending_commands(void){ 4584f30077b7SMatthias Ringwald btstack_linked_item_t * it; 4585a0da043fSMatthias Ringwald for (it = (btstack_linked_item_t *) hci_stack->connections; it != NULL; it = it->next){ 458605ae8de3SMatthias Ringwald hci_connection_t * connection = (hci_connection_t *) it; 458732ab9390Smatthias.ringwald 45880bf6344aS[email protected] switch(connection->state){ 45890bf6344aS[email protected] case SEND_CREATE_CONNECTION: 45904f3229d8S[email protected] switch(connection->address_type){ 459135454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 4592f16129ceSMatthias Ringwald case BD_ADDR_TYPE_ACL: 45939da54300S[email protected] log_info("sending hci_create_connection"); 4594b4eb4420SMatthias Ringwald hci_send_cmd(&hci_create_connection, connection->address, hci_usable_acl_packet_types(), 0, 0, 0, hci_stack->allow_role_switch); 45954f3229d8S[email protected] break; 459635454696SMatthias Ringwald #endif 45974f3229d8S[email protected] default: 4598a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE 4599d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 46009da54300S[email protected] log_info("sending hci_le_create_connection"); 46016bcfa632SMatthias Ringwald hci_stack->le_connection_own_addr_type = hci_stack->le_own_addr_type; 46026bcfa632SMatthias Ringwald hci_get_own_address_for_addr_type(hci_stack->le_connection_own_addr_type, hci_stack->le_connection_own_address); 46034f3229d8S[email protected] hci_send_cmd(&hci_le_create_connection, 4604cbe54ab2SJakob Krantz hci_stack->le_connection_scan_interval, // conn scan interval 4605cbe54ab2SJakob Krantz hci_stack->le_connection_scan_window, // conn scan windows 46064f3229d8S[email protected] 0, // don't use whitelist 46074f3229d8S[email protected] connection->address_type, // peer address type 46084f3229d8S[email protected] connection->address, // peer bd addr 46096bcfa632SMatthias Ringwald hci_stack->le_connection_own_addr_type, // our addr type: 461073044eb2SMatthias Ringwald hci_stack->le_connection_interval_min, // conn interval min 461173044eb2SMatthias Ringwald hci_stack->le_connection_interval_max, // conn interval max 461273044eb2SMatthias Ringwald hci_stack->le_connection_latency, // conn latency 461373044eb2SMatthias Ringwald hci_stack->le_supervision_timeout, // conn latency 461473044eb2SMatthias Ringwald hci_stack->le_minimum_ce_length, // min ce length 461573044eb2SMatthias Ringwald hci_stack->le_maximum_ce_length // max ce length 46164f3229d8S[email protected] ); 46174f3229d8S[email protected] connection->state = SENT_CREATE_CONNECTION; 4618b2f949feS[email protected] #endif 4619d70217a2SMatthias Ringwald #endif 46204f3229d8S[email protected] break; 46214f3229d8S[email protected] } 4622f30077b7SMatthias Ringwald return true; 4623ad83dc6aS[email protected] 462435454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 46250bf6344aS[email protected] case RECEIVED_CONNECTION_REQUEST: 46265cf766e8SMatthias Ringwald connection->role = HCI_ROLE_SLAVE; 4627f16129ceSMatthias Ringwald if (connection->address_type == BD_ADDR_TYPE_ACL){ 462876ccfb2aSMatthias Ringwald log_info("sending hci_accept_connection_request"); 4629895f6685SMilanka Ringwald connection->state = ACCEPTED_CONNECTION_REQUEST; 4630c4c88f1bSJakob Krantz hci_send_cmd(&hci_accept_connection_request, connection->address, hci_stack->master_slave_policy); 4631e35edcc1S[email protected] } 4632f30077b7SMatthias Ringwald return true; 463335454696SMatthias Ringwald #endif 46340bf6344aS[email protected] 4635a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE 4636d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 46370bf6344aS[email protected] case SEND_CANCEL_CONNECTION: 46380bf6344aS[email protected] connection->state = SENT_CANCEL_CONNECTION; 46390bf6344aS[email protected] hci_send_cmd(&hci_le_create_connection_cancel); 4640f30077b7SMatthias Ringwald return true; 4641a6725849S[email protected] #endif 4642d70217a2SMatthias Ringwald #endif 46430bf6344aS[email protected] case SEND_DISCONNECT: 46440bf6344aS[email protected] connection->state = SENT_DISCONNECT; 46456ef3696aSMatthias Ringwald hci_send_cmd(&hci_disconnect, connection->con_handle, ERROR_CODE_REMOTE_USER_TERMINATED_CONNECTION); 4646f30077b7SMatthias Ringwald return true; 46470bf6344aS[email protected] 46480bf6344aS[email protected] default: 46490bf6344aS[email protected] break; 4650c7e0c5f6Smatthias.ringwald } 4651c7e0c5f6Smatthias.ringwald 4652cabf004eSMatthias Ringwald // no further commands if connection is about to get shut down 4653cabf004eSMatthias Ringwald if (connection->state == SENT_DISCONNECT) continue; 4654cabf004eSMatthias Ringwald 46558daf94bcSMatthias Ringwald if (connection->authentication_flags & AUTH_FLAG_READ_RSSI){ 46568daf94bcSMatthias Ringwald connectionClearAuthenticationFlags(connection, AUTH_FLAG_READ_RSSI); 4657891b9fc2SMatthias Ringwald hci_send_cmd(&hci_read_rssi, connection->con_handle); 4658f30077b7SMatthias Ringwald return true; 4659891b9fc2SMatthias Ringwald } 4660891b9fc2SMatthias Ringwald 466194418890SMatthias Ringwald #ifdef ENABLE_CLASSIC 466294418890SMatthias Ringwald 46638daf94bcSMatthias Ringwald if (connection->authentication_flags & AUTH_FLAG_WRITE_SUPERVISION_TIMEOUT){ 46648daf94bcSMatthias Ringwald connectionClearAuthenticationFlags(connection, AUTH_FLAG_WRITE_SUPERVISION_TIMEOUT); 46656909f064SMatthias Ringwald hci_send_cmd(&hci_write_link_supervision_timeout, connection->con_handle, hci_stack->link_supervision_timeout); 4666f30077b7SMatthias Ringwald return true; 46676909f064SMatthias Ringwald } 46686909f064SMatthias Ringwald 46694a0faa05SMatthias Ringwald if (connection->bonding_flags & BONDING_REQUEST_REMOTE_FEATURES_PAGE_0){ 46704a0faa05SMatthias Ringwald connection->bonding_flags &= ~BONDING_REQUEST_REMOTE_FEATURES_PAGE_0; 46714a0faa05SMatthias Ringwald hci_send_cmd(&hci_read_remote_supported_features_command, connection->con_handle); 46724a0faa05SMatthias Ringwald return true; 46734a0faa05SMatthias Ringwald } 46744a0faa05SMatthias Ringwald 46754a0faa05SMatthias Ringwald if (connection->bonding_flags & BONDING_REQUEST_REMOTE_FEATURES_PAGE_1){ 46764a0faa05SMatthias Ringwald connection->bonding_flags &= ~BONDING_REQUEST_REMOTE_FEATURES_PAGE_1; 46774a0faa05SMatthias Ringwald hci_send_cmd(&hci_read_remote_extended_features_command, connection->con_handle, 1); 46784a0faa05SMatthias Ringwald return true; 46794a0faa05SMatthias Ringwald } 46804a0faa05SMatthias Ringwald 46814a0faa05SMatthias Ringwald if (connection->bonding_flags & BONDING_REQUEST_REMOTE_FEATURES_PAGE_2){ 46824a0faa05SMatthias Ringwald connection->bonding_flags &= ~BONDING_REQUEST_REMOTE_FEATURES_PAGE_2; 46834a0faa05SMatthias Ringwald hci_send_cmd(&hci_read_remote_extended_features_command, connection->con_handle, 2); 46844a0faa05SMatthias Ringwald return true; 46854a0faa05SMatthias Ringwald } 46864a0faa05SMatthias Ringwald 4687ad20f0c8SMatthias Ringwald // Handling link key request requires remote supported features 468850f49832SMatthias Ringwald if (((connection->authentication_flags & AUTH_FLAG_HANDLE_LINK_KEY_REQUEST) != 0)){ 4689608f51bbSMatthias Ringwald log_info("responding to link key request, have link key db: %u", hci_stack->link_key_db != NULL); 46908daf94bcSMatthias Ringwald connectionClearAuthenticationFlags(connection, AUTH_FLAG_HANDLE_LINK_KEY_REQUEST); 469130e72d78SMatthias Ringwald 4692e9f98c4aSMatthias Ringwald // lookup link key using cached key first 4693e9f98c4aSMatthias Ringwald bool have_link_key = connection->link_key_type != INVALID_LINK_KEY; 4694e9f98c4aSMatthias Ringwald if (!have_link_key && (hci_stack->link_key_db != NULL)){ 4695e9f98c4aSMatthias Ringwald have_link_key = hci_stack->link_key_db->get_link_key(connection->address, connection->link_key, &connection->link_key_type); 4696e9f98c4aSMatthias Ringwald } 469730e72d78SMatthias Ringwald 4698e9f98c4aSMatthias Ringwald bool security_level_sufficient = have_link_key && (gap_security_level_for_link_key_type(connection->link_key_type) >= connection->requested_security_level); 469930e72d78SMatthias Ringwald if (have_link_key && security_level_sufficient){ 4700e9f98c4aSMatthias Ringwald hci_send_cmd(&hci_link_key_request_reply, connection->address, &connection->link_key); 470132ab9390Smatthias.ringwald } else { 470232ab9390Smatthias.ringwald hci_send_cmd(&hci_link_key_request_negative_reply, connection->address); 470332ab9390Smatthias.ringwald } 4704f30077b7SMatthias Ringwald return true; 470532ab9390Smatthias.ringwald } 47061d6b20aeS[email protected] 47078daf94bcSMatthias Ringwald if (connection->authentication_flags & AUTH_FLAG_DENY_PIN_CODE_REQUEST){ 47089da54300S[email protected] log_info("denying to pin request"); 47098daf94bcSMatthias Ringwald connectionClearAuthenticationFlags(connection, AUTH_FLAG_DENY_PIN_CODE_REQUEST); 471034d2123cS[email protected] hci_send_cmd(&hci_pin_code_request_negative_reply, connection->address); 4711f30077b7SMatthias Ringwald return true; 47124c57c146S[email protected] } 47134c57c146S[email protected] 4714c950c316SMatthias Ringwald // security assessment requires remote features 47152dd8985bSMatthias Ringwald if ((connection->authentication_flags & AUTH_FLAG_RECV_IO_CAPABILITIES_REQUEST) != 0){ 4716c950c316SMatthias Ringwald connectionClearAuthenticationFlags(connection, AUTH_FLAG_RECV_IO_CAPABILITIES_REQUEST); 4717c950c316SMatthias Ringwald hci_ssp_assess_security_on_io_cap_request(connection); 4718c950c316SMatthias Ringwald // no return here as hci_ssp_assess_security_on_io_cap_request only sets AUTH_FLAG_SEND_IO_CAPABILITIES_REPLY or AUTH_FLAG_SEND_IO_CAPABILITIES_NEGATIVE_REPLY 4719c950c316SMatthias Ringwald } 4720c950c316SMatthias Ringwald 47218daf94bcSMatthias Ringwald if (connection->authentication_flags & AUTH_FLAG_SEND_IO_CAPABILITIES_REPLY){ 47228daf94bcSMatthias Ringwald connectionClearAuthenticationFlags(connection, AUTH_FLAG_SEND_IO_CAPABILITIES_REPLY); 4723a8d20135SMatthias Ringwald // set authentication requirements: 4724a8d20135SMatthias Ringwald // - MITM = ssp_authentication_requirement (USER) | requested_security_level (dynamic) 4725532454f9SMatthias Ringwald // - BONDING MODE: dedicated if requested, bondable otherwise. Drop bondable if not set for remote 4726a8d20135SMatthias Ringwald uint8_t authreq = hci_stack->ssp_authentication_requirement & 1; 47279faad3abS[email protected] if (gap_mitm_protection_required_for_security_level(connection->requested_security_level)){ 47289faad3abS[email protected] authreq |= 1; 4729106d6d11S[email protected] } 4730532454f9SMatthias Ringwald bool bonding = hci_stack->bondable; 47318daf94bcSMatthias Ringwald if (connection->authentication_flags & AUTH_FLAG_RECV_IO_CAPABILITIES_RESPONSE){ 4732532454f9SMatthias Ringwald // if we have received IO Cap Response, we're in responder role 4733532454f9SMatthias Ringwald bool remote_bonding = connection->io_cap_response_auth_req >= SSP_IO_AUTHREQ_MITM_PROTECTION_NOT_REQUIRED_DEDICATED_BONDING; 4734532454f9SMatthias Ringwald if (bonding && !remote_bonding){ 4735532454f9SMatthias Ringwald log_info("Remote not bonding, dropping local flag"); 4736532454f9SMatthias Ringwald bonding = false; 4737532454f9SMatthias Ringwald } 4738532454f9SMatthias Ringwald } 4739532454f9SMatthias Ringwald if (bonding){ 4740a8d20135SMatthias Ringwald if (connection->bonding_flags & BONDING_DEDICATED){ 4741a8d20135SMatthias Ringwald authreq |= SSP_IO_AUTHREQ_MITM_PROTECTION_NOT_REQUIRED_DEDICATED_BONDING; 4742532454f9SMatthias Ringwald } else { 4743a8d20135SMatthias Ringwald authreq |= SSP_IO_AUTHREQ_MITM_PROTECTION_NOT_REQUIRED_GENERAL_BONDING; 4744a8d20135SMatthias Ringwald } 4745532454f9SMatthias Ringwald } 47461849becdSMatthias Ringwald uint8_t have_oob_data = 0; 47471849becdSMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB 47481849becdSMatthias Ringwald if (connection->classic_oob_c_192 != NULL){ 47491849becdSMatthias Ringwald have_oob_data |= 1; 47501849becdSMatthias Ringwald } 47511849becdSMatthias Ringwald if (connection->classic_oob_c_256 != NULL){ 47521849becdSMatthias Ringwald have_oob_data |= 2; 47531849becdSMatthias Ringwald } 47541849becdSMatthias Ringwald #endif 47551849becdSMatthias Ringwald hci_send_cmd(&hci_io_capability_request_reply, &connection->address, hci_stack->ssp_io_capability, have_oob_data, authreq); 475611b03efaSMatthias Ringwald return true; 4757f8fb5f6eS[email protected] } 475811b03efaSMatthias Ringwald 47598daf94bcSMatthias Ringwald if (connection->authentication_flags & AUTH_FLAG_SEND_IO_CAPABILITIES_NEGATIVE_REPLY) { 47608daf94bcSMatthias Ringwald connectionClearAuthenticationFlags(connection, AUTH_FLAG_SEND_IO_CAPABILITIES_NEGATIVE_REPLY); 476111b03efaSMatthias Ringwald hci_send_cmd(&hci_io_capability_request_negative_reply, &connection->address, ERROR_CODE_PAIRING_NOT_ALLOWED); 4762f30077b7SMatthias Ringwald return true; 476332ab9390Smatthias.ringwald } 476432ab9390Smatthias.ringwald 47651849becdSMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB 47667ca4a7edSMatthias Ringwald if (connection->authentication_flags & AUTH_FLAG_SEND_REMOTE_OOB_DATA_REPLY){ 47677ca4a7edSMatthias Ringwald connectionClearAuthenticationFlags(connection, AUTH_FLAG_SEND_REMOTE_OOB_DATA_REPLY); 47681849becdSMatthias Ringwald const uint8_t zero[16] = { 0 }; 47691849becdSMatthias Ringwald const uint8_t * r_192 = zero; 47701849becdSMatthias Ringwald const uint8_t * c_192 = zero; 47711849becdSMatthias Ringwald const uint8_t * r_256 = zero; 47721849becdSMatthias Ringwald const uint8_t * c_256 = zero; 47731849becdSMatthias Ringwald // verify P-256 OOB 47741849becdSMatthias Ringwald if ((connection->classic_oob_c_256 != NULL) && ((hci_stack->local_supported_commands[1] & 0x08u) != 0)) { 47751849becdSMatthias Ringwald c_256 = connection->classic_oob_c_256; 47761849becdSMatthias Ringwald if (connection->classic_oob_r_256 != NULL) { 47771849becdSMatthias Ringwald r_256 = connection->classic_oob_r_256; 47781849becdSMatthias Ringwald } 47791849becdSMatthias Ringwald } 47801849becdSMatthias Ringwald // verify P-192 OOB 47811849becdSMatthias Ringwald if ((connection->classic_oob_c_192 != NULL)) { 47821849becdSMatthias Ringwald c_192 = connection->classic_oob_c_192; 47831849becdSMatthias Ringwald if (connection->classic_oob_r_192 != NULL) { 47841849becdSMatthias Ringwald r_192 = connection->classic_oob_r_192; 47851849becdSMatthias Ringwald } 47861849becdSMatthias Ringwald } 47877ca4a7edSMatthias Ringwald 47887ca4a7edSMatthias Ringwald // assess security 47897ca4a7edSMatthias Ringwald bool need_level_4 = hci_stack->gap_secure_connections_only_mode || (connection->requested_security_level == LEVEL_4); 47907ca4a7edSMatthias Ringwald bool can_reach_level_4 = hci_remote_sc_enabled(connection) && (c_256 != NULL); 47917ca4a7edSMatthias Ringwald if (need_level_4 && !can_reach_level_4){ 47927ca4a7edSMatthias Ringwald log_info("Level 4 required, but not possible -> abort"); 47937ca4a7edSMatthias Ringwald hci_pairing_complete(connection, ERROR_CODE_INSUFFICIENT_SECURITY); 47947ca4a7edSMatthias Ringwald // send oob negative reply 47957ca4a7edSMatthias Ringwald c_256 = NULL; 47967ca4a7edSMatthias Ringwald c_192 = NULL; 47977ca4a7edSMatthias Ringwald } 47987ca4a7edSMatthias Ringwald 47991849becdSMatthias Ringwald // Reply 48001849becdSMatthias Ringwald if (c_256 != zero) { 48011849becdSMatthias Ringwald hci_send_cmd(&hci_remote_oob_extended_data_request_reply, &connection->address, c_192, r_192, c_256, r_256); 48021849becdSMatthias Ringwald } else if (c_192 != zero){ 48031849becdSMatthias Ringwald hci_send_cmd(&hci_remote_oob_data_request_reply, &connection->address, c_192, r_192); 48041849becdSMatthias Ringwald } else { 48051ae74bf3SMatthias Ringwald hci_stack->classic_oob_con_handle = connection->con_handle; 48061849becdSMatthias Ringwald hci_send_cmd(&hci_remote_oob_data_request_negative_reply, &connection->address); 48071849becdSMatthias Ringwald } 48081849becdSMatthias Ringwald return true; 48091849becdSMatthias Ringwald } 48101849becdSMatthias Ringwald #endif 48111849becdSMatthias Ringwald 48128daf94bcSMatthias Ringwald if (connection->authentication_flags & AUTH_FLAG_SEND_USER_CONFIRM_REPLY){ 48138daf94bcSMatthias Ringwald connectionClearAuthenticationFlags(connection, AUTH_FLAG_SEND_USER_CONFIRM_REPLY); 481434d2123cS[email protected] hci_send_cmd(&hci_user_confirmation_request_reply, &connection->address); 4815f30077b7SMatthias Ringwald return true; 4816dbe1a790S[email protected] } 4817dbe1a790S[email protected] 4818367aedc0SMatthias Ringwald if (connection->authentication_flags & AUTH_FLAG_SEND_USER_CONFIRM_NEGATIVE_REPLY){ 4819367aedc0SMatthias Ringwald connectionClearAuthenticationFlags(connection, AUTH_FLAG_SEND_USER_CONFIRM_NEGATIVE_REPLY); 4820367aedc0SMatthias Ringwald hci_send_cmd(&hci_user_confirmation_request_negative_reply, &connection->address); 4821367aedc0SMatthias Ringwald return true; 4822367aedc0SMatthias Ringwald } 4823367aedc0SMatthias Ringwald 48248daf94bcSMatthias Ringwald if (connection->authentication_flags & AUTH_FLAG_SEND_USER_PASSKEY_REPLY){ 48258daf94bcSMatthias Ringwald connectionClearAuthenticationFlags(connection, AUTH_FLAG_SEND_USER_PASSKEY_REPLY); 482634d2123cS[email protected] hci_send_cmd(&hci_user_passkey_request_reply, &connection->address, 000000); 4827f30077b7SMatthias Ringwald return true; 4828dbe1a790S[email protected] } 4829afd4e962S[email protected] 4830ad83dc6aS[email protected] if (connection->bonding_flags & BONDING_DISCONNECT_DEDICATED_DONE){ 4831ad83dc6aS[email protected] connection->bonding_flags &= ~BONDING_DISCONNECT_DEDICATED_DONE; 48321bd5283dS[email protected] connection->bonding_flags |= BONDING_EMIT_COMPLETE_ON_DISCONNECT; 48336ef3696aSMatthias Ringwald connection->state = SENT_DISCONNECT; 48346ef3696aSMatthias Ringwald hci_send_cmd(&hci_disconnect, connection->con_handle, ERROR_CODE_REMOTE_USER_TERMINATED_CONNECTION); 4835f30077b7SMatthias Ringwald return true; 4836ad83dc6aS[email protected] } 483776f27cffSMatthias Ringwald 48382a75353aSMatthias Ringwald if ((connection->bonding_flags & BONDING_SEND_AUTHENTICATE_REQUEST) && ((connection->bonding_flags & BONDING_RECEIVED_REMOTE_FEATURES) != 0)){ 483934d2123cS[email protected] connection->bonding_flags &= ~BONDING_SEND_AUTHENTICATE_REQUEST; 4840abdad579SMatthias Ringwald connection->bonding_flags |= BONDING_SENT_AUTHENTICATE_REQUEST; 484134d2123cS[email protected] hci_send_cmd(&hci_authentication_requested, connection->con_handle); 4842f30077b7SMatthias Ringwald return true; 4843afd4e962S[email protected] } 484476f27cffSMatthias Ringwald 4845dce78009S[email protected] if (connection->bonding_flags & BONDING_SEND_ENCRYPTION_REQUEST){ 4846dce78009S[email protected] connection->bonding_flags &= ~BONDING_SEND_ENCRYPTION_REQUEST; 4847dce78009S[email protected] hci_send_cmd(&hci_set_connection_encryption, connection->con_handle, 1); 4848f30077b7SMatthias Ringwald return true; 4849dce78009S[email protected] } 4850573897a0SMatthias Ringwald if (connection->bonding_flags & BONDING_SEND_READ_ENCRYPTION_KEY_SIZE){ 4851573897a0SMatthias Ringwald connection->bonding_flags &= ~BONDING_SEND_READ_ENCRYPTION_KEY_SIZE; 4852573897a0SMatthias Ringwald hci_send_cmd(&hci_read_encryption_key_size, connection->con_handle, 1); 4853f30077b7SMatthias Ringwald return true; 4854573897a0SMatthias Ringwald } 485576f27cffSMatthias Ringwald #endif 485676f27cffSMatthias Ringwald 485776f27cffSMatthias Ringwald if (connection->bonding_flags & BONDING_DISCONNECT_SECURITY_BLOCK){ 485876f27cffSMatthias Ringwald connection->bonding_flags &= ~BONDING_DISCONNECT_SECURITY_BLOCK; 48591714cbbdSMatthias Ringwald #ifdef ENABLE_CLASSIC 48601714cbbdSMatthias Ringwald hci_pairing_complete(connection, ERROR_CODE_CONNECTION_REJECTED_DUE_TO_SECURITY_REASONS); 48611714cbbdSMatthias Ringwald #endif 48626ef3696aSMatthias Ringwald if (connection->state != SENT_DISCONNECT){ 48636ef3696aSMatthias Ringwald connection->state = SENT_DISCONNECT; 48646ef3696aSMatthias Ringwald hci_send_cmd(&hci_disconnect, connection->con_handle, ERROR_CODE_AUTHENTICATION_FAILURE); 4865f30077b7SMatthias Ringwald return true; 486676f27cffSMatthias Ringwald } 48676ef3696aSMatthias Ringwald } 4868da886c03S[email protected] 48696cdc2862SMatthias Ringwald #ifdef ENABLE_CLASSIC 4870f8ee3071SMatthias Ringwald uint16_t sniff_min_interval; 4871f8ee3071SMatthias Ringwald switch (connection->sniff_min_interval){ 4872f8ee3071SMatthias Ringwald case 0: 4873f8ee3071SMatthias Ringwald break; 4874f8ee3071SMatthias Ringwald case 0xffff: 4875f8ee3071SMatthias Ringwald connection->sniff_min_interval = 0; 4876f8ee3071SMatthias Ringwald hci_send_cmd(&hci_exit_sniff_mode, connection->con_handle); 4877f30077b7SMatthias Ringwald return true; 4878f8ee3071SMatthias Ringwald default: 4879f8ee3071SMatthias Ringwald sniff_min_interval = connection->sniff_min_interval; 4880f8ee3071SMatthias Ringwald connection->sniff_min_interval = 0; 4881f8ee3071SMatthias Ringwald hci_send_cmd(&hci_sniff_mode, connection->con_handle, connection->sniff_max_interval, sniff_min_interval, connection->sniff_attempt, connection->sniff_timeout); 4882f30077b7SMatthias Ringwald return true; 4883f8ee3071SMatthias Ringwald } 488488a03c8dSMatthias Ringwald 4885140c0557SMatthias Ringwald if (connection->sniff_subrating_max_latency != 0xffff){ 4886140c0557SMatthias Ringwald uint16_t max_latency = connection->sniff_subrating_max_latency; 4887140c0557SMatthias Ringwald connection->sniff_subrating_max_latency = 0; 4888140c0557SMatthias Ringwald hci_send_cmd(&hci_sniff_subrating, connection->con_handle, max_latency, connection->sniff_subrating_min_remote_timeout, connection->sniff_subrating_min_local_timeout); 4889140c0557SMatthias Ringwald return true; 4890140c0557SMatthias Ringwald } 4891140c0557SMatthias Ringwald 4892965a4ccfSMatthias Ringwald if (connection->qos_service_type != HCI_SERVICE_TYPE_INVALID){ 4893278ff8a9SMatthias Ringwald uint8_t service_type = (uint8_t) connection->qos_service_type; 4894965a4ccfSMatthias Ringwald connection->qos_service_type = HCI_SERVICE_TYPE_INVALID; 4895278ff8a9SMatthias Ringwald hci_send_cmd(&hci_qos_setup, connection->con_handle, 0, service_type, connection->qos_token_rate, connection->qos_peak_bandwidth, connection->qos_latency, connection->qos_delay_variation); 4896278ff8a9SMatthias Ringwald return true; 4897278ff8a9SMatthias Ringwald } 4898278ff8a9SMatthias Ringwald 489988a03c8dSMatthias Ringwald if (connection->request_role != HCI_ROLE_INVALID){ 490088a03c8dSMatthias Ringwald hci_role_t role = connection->request_role; 490188a03c8dSMatthias Ringwald connection->request_role = HCI_ROLE_INVALID; 490288a03c8dSMatthias Ringwald hci_send_cmd(&hci_switch_role_command, connection->address, role); 490388a03c8dSMatthias Ringwald return true; 490488a03c8dSMatthias Ringwald } 49056cdc2862SMatthias Ringwald #endif 4906f8ee3071SMatthias Ringwald 4907a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE 490873cd8a2aSMatthias Ringwald switch (connection->le_con_parameter_update_state){ 490973cd8a2aSMatthias Ringwald // response to L2CAP CON PARAMETER UPDATE REQUEST 491073cd8a2aSMatthias Ringwald case CON_PARAMETER_UPDATE_CHANGE_HCI_CON_PARAMETERS: 4911da886c03S[email protected] connection->le_con_parameter_update_state = CON_PARAMETER_UPDATE_NONE; 491273cd8a2aSMatthias Ringwald hci_send_cmd(&hci_le_connection_update, connection->con_handle, connection->le_conn_interval_min, 4913c37a3166S[email protected] connection->le_conn_interval_max, connection->le_conn_latency, connection->le_supervision_timeout, 4914c37a3166S[email protected] 0x0000, 0xffff); 4915f30077b7SMatthias Ringwald return true; 491673cd8a2aSMatthias Ringwald case CON_PARAMETER_UPDATE_REPLY: 491773cd8a2aSMatthias Ringwald connection->le_con_parameter_update_state = CON_PARAMETER_UPDATE_NONE; 491873cd8a2aSMatthias Ringwald hci_send_cmd(&hci_le_remote_connection_parameter_request_reply, connection->con_handle, connection->le_conn_interval_min, 491973cd8a2aSMatthias Ringwald connection->le_conn_interval_max, connection->le_conn_latency, connection->le_supervision_timeout, 492073cd8a2aSMatthias Ringwald 0x0000, 0xffff); 4921f30077b7SMatthias Ringwald return true; 492273cd8a2aSMatthias Ringwald case CON_PARAMETER_UPDATE_NEGATIVE_REPLY: 492373cd8a2aSMatthias Ringwald connection->le_con_parameter_update_state = CON_PARAMETER_UPDATE_NONE; 492473cd8a2aSMatthias Ringwald hci_send_cmd(&hci_le_remote_connection_parameter_request_negative_reply, ERROR_CODE_UNSUPPORTED_LMP_PARAMETER_VALUE_UNSUPPORTED_LL_PARAMETER_VALUE); 4925f30077b7SMatthias Ringwald return true; 492673cd8a2aSMatthias Ringwald default: 492773cd8a2aSMatthias Ringwald break; 4928c37a3166S[email protected] } 49294ea43905SMatthias Ringwald if (connection->le_phy_update_all_phys != 0xffu){ 4930b90f6e0aSMatthias Ringwald uint8_t all_phys = connection->le_phy_update_all_phys; 4931b90f6e0aSMatthias Ringwald connection->le_phy_update_all_phys = 0xff; 4932b90f6e0aSMatthias 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); 4933f30077b7SMatthias Ringwald return true; 4934b90f6e0aSMatthias Ringwald } 4935c37a3166S[email protected] #endif 4936dbe1a790S[email protected] } 4937f30077b7SMatthias Ringwald return false; 4938f30077b7SMatthias Ringwald } 4939c7e0c5f6Smatthias.ringwald 4940f30077b7SMatthias Ringwald static void hci_run(void){ 4941f30077b7SMatthias Ringwald 4942f30077b7SMatthias Ringwald bool done; 4943f30077b7SMatthias Ringwald 4944f30077b7SMatthias Ringwald // send continuation fragments first, as they block the prepared packet buffer 4945f30077b7SMatthias Ringwald done = hci_run_acl_fragments(); 4946f30077b7SMatthias Ringwald if (done) return; 4947f30077b7SMatthias Ringwald 4948f30077b7SMatthias Ringwald #ifdef ENABLE_HCI_CONTROLLER_TO_HOST_FLOW_CONTROL 4949f30077b7SMatthias Ringwald // send host num completed packets next as they don't require num_cmd_packets > 0 4950f30077b7SMatthias Ringwald if (!hci_can_send_comand_packet_transport()) return; 4951f30077b7SMatthias Ringwald if (hci_stack->host_completed_packets){ 4952f30077b7SMatthias Ringwald hci_host_num_completed_packets(); 4953f30077b7SMatthias Ringwald return; 4954f30077b7SMatthias Ringwald } 4955f30077b7SMatthias Ringwald #endif 4956f30077b7SMatthias Ringwald 4957f30077b7SMatthias Ringwald if (!hci_can_send_command_packet_now()) return; 4958f30077b7SMatthias Ringwald 4959f30077b7SMatthias Ringwald // global/non-connection oriented commands 4960f30077b7SMatthias Ringwald 4961f30077b7SMatthias Ringwald 4962f30077b7SMatthias Ringwald #ifdef ENABLE_CLASSIC 4963f30077b7SMatthias Ringwald // general gap classic 4964f30077b7SMatthias Ringwald done = hci_run_general_gap_classic(); 4965f30077b7SMatthias Ringwald if (done) return; 4966f30077b7SMatthias Ringwald #endif 4967f30077b7SMatthias Ringwald 4968f30077b7SMatthias Ringwald #ifdef ENABLE_BLE 4969f30077b7SMatthias Ringwald // general gap le 4970f30077b7SMatthias Ringwald done = hci_run_general_gap_le(); 4971f30077b7SMatthias Ringwald if (done) return; 4972f30077b7SMatthias Ringwald #endif 4973f30077b7SMatthias Ringwald 4974f30077b7SMatthias Ringwald // send pending HCI commands 497588a03c8dSMatthias Ringwald done = hci_run_general_pending_commands(); 4976f30077b7SMatthias Ringwald if (done) return; 4977f30077b7SMatthias Ringwald 4978f30077b7SMatthias Ringwald // stack state sub statemachines 497905ae8de3SMatthias Ringwald hci_connection_t * connection; 49803a9fb326S[email protected] switch (hci_stack->state){ 49813429f56bSmatthias.ringwald case HCI_STATE_INITIALIZING: 498274b323a9SMatthias Ringwald hci_initializing_run(); 49833429f56bSmatthias.ringwald break; 4984c7e0c5f6Smatthias.ringwald 4985c7e0c5f6Smatthias.ringwald case HCI_STATE_HALTING: 4986c7e0c5f6Smatthias.ringwald 498726fe9592SMatthias Ringwald log_info("HCI_STATE_HALTING, substate %x\n", hci_stack->substate); 498826fe9592SMatthias Ringwald switch (hci_stack->substate){ 4989beceeddeSMatthias Ringwald case HCI_HALTING_DISCONNECT_ALL_NO_TIMER: 4990beceeddeSMatthias Ringwald case HCI_HALTING_DISCONNECT_ALL_TIMER: 4991beceeddeSMatthias Ringwald 4992a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE 4993d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 4994beceeddeSMatthias Ringwald // free whitelist entries 49959956955bSMatthias Ringwald { 4996665d90f2SMatthias Ringwald btstack_linked_list_iterator_t lit; 4997665d90f2SMatthias Ringwald btstack_linked_list_iterator_init(&lit, &hci_stack->le_whitelist); 4998665d90f2SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&lit)){ 4999665d90f2SMatthias Ringwald whitelist_entry_t * entry = (whitelist_entry_t*) btstack_linked_list_iterator_next(&lit); 5000665d90f2SMatthias Ringwald btstack_linked_list_remove(&hci_stack->le_whitelist, (btstack_linked_item_t *) entry); 50019956955bSMatthias Ringwald btstack_memory_whitelist_entry_free(entry); 50029956955bSMatthias Ringwald } 50039956955bSMatthias Ringwald } 50049956955bSMatthias Ringwald #endif 5005d70217a2SMatthias Ringwald #endif 5006c7e0c5f6Smatthias.ringwald // close all open connections 50073a9fb326S[email protected] connection = (hci_connection_t *) hci_stack->connections; 5008c7e0c5f6Smatthias.ringwald if (connection){ 5009711e6c80SMatthias Ringwald hci_con_handle_t con_handle = (uint16_t) connection->con_handle; 5010d94d3cafS[email protected] if (!hci_can_send_command_packet_now()) return; 501132ab9390Smatthias.ringwald 50128fca890eSMatthias Ringwald // check state 50138fca890eSMatthias Ringwald if (connection->state == SENT_DISCONNECT) return; 50148fca890eSMatthias Ringwald connection->state = SENT_DISCONNECT; 50158fca890eSMatthias Ringwald 50168837e9efSMatthias Ringwald log_info("HCI_STATE_HALTING, connection %p, handle %u", connection, con_handle); 5017c7e0c5f6Smatthias.ringwald 50188837e9efSMatthias Ringwald // cancel all l2cap connections right away instead of waiting for disconnection complete event ... 50198837e9efSMatthias Ringwald hci_emit_disconnection_complete(con_handle, 0x16); // terminated by local host 50208837e9efSMatthias Ringwald 50218837e9efSMatthias Ringwald // ... which would be ignored anyway as we shutdown (free) the connection now 5022c7e0c5f6Smatthias.ringwald hci_shutdown_connection(connection); 50238837e9efSMatthias Ringwald 50248837e9efSMatthias Ringwald // finally, send the disconnect command 50256ef3696aSMatthias Ringwald hci_send_cmd(&hci_disconnect, con_handle, ERROR_CODE_REMOTE_USER_TERMINATED_CONNECTION); 5026c7e0c5f6Smatthias.ringwald return; 5027c7e0c5f6Smatthias.ringwald } 502826fe9592SMatthias Ringwald 5029beceeddeSMatthias Ringwald if (hci_stack->substate == HCI_HALTING_DISCONNECT_ALL_TIMER){ 5030beceeddeSMatthias Ringwald // no connections left, wait a bit to assert that btstack_cyrpto isn't waiting for an HCI event 5031beceeddeSMatthias Ringwald log_info("HCI_STATE_HALTING: wait 50 ms"); 503226fe9592SMatthias Ringwald hci_stack->substate = HCI_HALTING_W4_TIMER; 5033beceeddeSMatthias Ringwald btstack_run_loop_set_timer(&hci_stack->timeout, 50); 503426fe9592SMatthias Ringwald btstack_run_loop_set_timer_handler(&hci_stack->timeout, hci_halting_timeout_handler); 503526fe9592SMatthias Ringwald btstack_run_loop_add_timer(&hci_stack->timeout); 503626fe9592SMatthias Ringwald break; 5037beceeddeSMatthias Ringwald } 503826fe9592SMatthias Ringwald 5039cf373d3aSMatthias Ringwald /* fall through */ 504026fe9592SMatthias Ringwald 504126fe9592SMatthias Ringwald case HCI_HALTING_CLOSE: 50429da54300S[email protected] log_info("HCI_STATE_HALTING, calling off"); 5043c7e0c5f6Smatthias.ringwald 504472ea5239Smatthias.ringwald // switch mode 5045c7e0c5f6Smatthias.ringwald hci_power_control_off(); 50469418f9c9Smatthias.ringwald 50479da54300S[email protected] log_info("HCI_STATE_HALTING, emitting state"); 504872ea5239Smatthias.ringwald hci_emit_state(); 50499da54300S[email protected] log_info("HCI_STATE_HALTING, done"); 505072ea5239Smatthias.ringwald break; 5051beceeddeSMatthias Ringwald 5052beceeddeSMatthias Ringwald case HCI_HALTING_W4_TIMER: 5053beceeddeSMatthias Ringwald // keep waiting 5054beceeddeSMatthias Ringwald 5055beceeddeSMatthias Ringwald break; 505626fe9592SMatthias Ringwald default: 505726fe9592SMatthias Ringwald break; 505826fe9592SMatthias Ringwald } 505926fe9592SMatthias Ringwald 506026fe9592SMatthias Ringwald break; 5061c7e0c5f6Smatthias.ringwald 506272ea5239Smatthias.ringwald case HCI_STATE_FALLING_ASLEEP: 50633a9fb326S[email protected] switch(hci_stack->substate) { 506474b323a9SMatthias Ringwald case HCI_FALLING_ASLEEP_DISCONNECT: 50659da54300S[email protected] log_info("HCI_STATE_FALLING_ASLEEP"); 506672ea5239Smatthias.ringwald // close all open connections 50673a9fb326S[email protected] connection = (hci_connection_t *) hci_stack->connections; 506866da7044Smatthias.ringwald 5069423a3e49SMatthias Ringwald #ifdef HAVE_PLATFORM_IPHONE_OS 507066da7044Smatthias.ringwald // don't close connections, if H4 supports power management 5071d0b87befSMatthias Ringwald if (btstack_control_iphone_power_management_enabled()){ 507266da7044Smatthias.ringwald connection = NULL; 507366da7044Smatthias.ringwald } 507466da7044Smatthias.ringwald #endif 507572ea5239Smatthias.ringwald if (connection){ 507632ab9390Smatthias.ringwald 507772ea5239Smatthias.ringwald // send disconnect 5078d94d3cafS[email protected] if (!hci_can_send_command_packet_now()) return; 507932ab9390Smatthias.ringwald 50809da54300S[email protected] log_info("HCI_STATE_FALLING_ASLEEP, connection %p, handle %u", connection, (uint16_t)connection->con_handle); 50816ef3696aSMatthias Ringwald hci_send_cmd(&hci_disconnect, connection->con_handle, ERROR_CODE_REMOTE_USER_TERMINATED_CONNECTION); 508272ea5239Smatthias.ringwald 508372ea5239Smatthias.ringwald // send disconnected event right away - causes higher layer connections to get closed, too. 508472ea5239Smatthias.ringwald hci_shutdown_connection(connection); 508572ea5239Smatthias.ringwald return; 508672ea5239Smatthias.ringwald } 508772ea5239Smatthias.ringwald 508892368cd3S[email protected] if (hci_classic_supported()){ 508989db417bSmatthias.ringwald // disable page and inquiry scan 5090d94d3cafS[email protected] if (!hci_can_send_command_packet_now()) return; 509132ab9390Smatthias.ringwald 50929da54300S[email protected] log_info("HCI_STATE_HALTING, disabling inq scans"); 50933a9fb326S[email protected] hci_send_cmd(&hci_write_scan_enable, hci_stack->connectable << 1); // drop inquiry scan but keep page scan 509489db417bSmatthias.ringwald 509589db417bSmatthias.ringwald // continue in next sub state 509674b323a9SMatthias Ringwald hci_stack->substate = HCI_FALLING_ASLEEP_W4_WRITE_SCAN_ENABLE; 509789db417bSmatthias.ringwald break; 509892368cd3S[email protected] } 5099cf373d3aSMatthias Ringwald 5100cf373d3aSMatthias Ringwald /* fall through */ 510192368cd3S[email protected] 510274b323a9SMatthias Ringwald case HCI_FALLING_ASLEEP_COMPLETE: 51039da54300S[email protected] log_info("HCI_STATE_HALTING, calling sleep"); 5104423a3e49SMatthias Ringwald #ifdef HAVE_PLATFORM_IPHONE_OS 510528171530Smatthias.ringwald // don't actually go to sleep, if H4 supports power management 5106d0b87befSMatthias Ringwald if (btstack_control_iphone_power_management_enabled()){ 510728171530Smatthias.ringwald // SLEEP MODE reached 51083a9fb326S[email protected] hci_stack->state = HCI_STATE_SLEEPING; 510928171530Smatthias.ringwald hci_emit_state(); 511028171530Smatthias.ringwald break; 511128171530Smatthias.ringwald } 511228171530Smatthias.ringwald #endif 511372ea5239Smatthias.ringwald // switch mode 51143a9fb326S[email protected] hci_power_control_sleep(); // changes hci_stack->state to SLEEP 5115c7e0c5f6Smatthias.ringwald hci_emit_state(); 511628171530Smatthias.ringwald break; 511728171530Smatthias.ringwald 511889db417bSmatthias.ringwald default: 511989db417bSmatthias.ringwald break; 512089db417bSmatthias.ringwald } 5121c7e0c5f6Smatthias.ringwald break; 5122c7e0c5f6Smatthias.ringwald 51233429f56bSmatthias.ringwald default: 51243429f56bSmatthias.ringwald break; 51251f504dbdSmatthias.ringwald } 51263429f56bSmatthias.ringwald } 512716833f0aSmatthias.ringwald 51283e2050f7SMatthias Ringwald uint8_t hci_send_cmd_packet(uint8_t *packet, int size){ 512935454696SMatthias Ringwald // house-keeping 513035454696SMatthias Ringwald 513135454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 5132c8e4258aSmatthias.ringwald bd_addr_t addr; 5133c8e4258aSmatthias.ringwald hci_connection_t * conn; 5134c123d999SMatthias Ringwald #endif 5135c123d999SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 51366f35bb46SMatthias Ringwald uint8_t initiator_filter_policy; 51379cbd2215SMatthias Ringwald #endif 5138c8e4258aSmatthias.ringwald 51396f35bb46SMatthias Ringwald uint16_t opcode = little_endian_read_16(packet, 0); 51406f35bb46SMatthias Ringwald switch (opcode) { 51419cbd2215SMatthias Ringwald case HCI_OPCODE_HCI_WRITE_LOOPBACK_MODE: 51429cbd2215SMatthias Ringwald hci_stack->loopback_mode = packet[3]; 51439cbd2215SMatthias Ringwald break; 51449cbd2215SMatthias Ringwald 51459cbd2215SMatthias Ringwald #ifdef ENABLE_CLASSIC 51466f35bb46SMatthias Ringwald case HCI_OPCODE_HCI_CREATE_CONNECTION: 5147724d70a2SMatthias Ringwald reverse_bd_addr(&packet[3], addr); 51489da54300S[email protected] log_info("Create_connection to %s", bd_addr_to_str(addr)); 5149c8e4258aSmatthias.ringwald 515072cf8859SMatthias Ringwald // CVE-2020-26555: reject outgoing connection to device with same BD ADDR 515172cf8859SMatthias Ringwald if (memcmp(hci_stack->local_bd_addr, addr, 6) == 0) { 515279e0fa07SMatthias Ringwald hci_emit_connection_complete(addr, 0, ERROR_CODE_CONNECTION_REJECTED_DUE_TO_UNACCEPTABLE_BD_ADDR); 51533e2050f7SMatthias Ringwald return ERROR_CODE_CONNECTION_REJECTED_DUE_TO_UNACCEPTABLE_BD_ADDR; 515472cf8859SMatthias Ringwald } 515572cf8859SMatthias Ringwald 5156f16129ceSMatthias Ringwald conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL); 5157ad83dc6aS[email protected] if (!conn) { 5158f16129ceSMatthias Ringwald conn = create_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL); 515917f1ba2aSmatthias.ringwald if (!conn) { 516017f1ba2aSmatthias.ringwald // notify client that alloc failed 51612deddeceSMatthias Ringwald hci_emit_connection_complete(addr, 0, BTSTACK_MEMORY_ALLOC_FAILED); 51623e2050f7SMatthias Ringwald return BTSTACK_MEMORY_ALLOC_FAILED; // packet not sent to controller 516317f1ba2aSmatthias.ringwald } 5164ad83dc6aS[email protected] conn->state = SEND_CREATE_CONNECTION; 5165f3e2cd2aSMatthias Ringwald conn->role = HCI_ROLE_MASTER; 5166ad83dc6aS[email protected] } 5167ad83dc6aS[email protected] log_info("conn state %u", conn->state); 51683e2050f7SMatthias Ringwald // TODO: L2CAP should not send create connection command, instead a (new) gap function should be used 5169ad83dc6aS[email protected] switch (conn->state) { 5170ad83dc6aS[email protected] // if connection active exists 5171ad83dc6aS[email protected] case OPEN: 5172f5e5741dSMatthias Ringwald // and OPEN, emit connection complete command 517372cf8859SMatthias Ringwald hci_emit_connection_complete(addr, conn->con_handle, ERROR_CODE_SUCCESS); 51743e2050f7SMatthias Ringwald // packet not sent to controller 51753e2050f7SMatthias Ringwald return ERROR_CODE_ACL_CONNECTION_ALREADY_EXISTS; 5176672e36abSMatthias Ringwald case RECEIVED_DISCONNECTION_COMPLETE: 5177672e36abSMatthias Ringwald // create connection triggered in disconnect complete event, let's do it now 5178672e36abSMatthias Ringwald break; 5179ad83dc6aS[email protected] case SEND_CREATE_CONNECTION: 5180532f91a5SMatthias Ringwald // connection created by hci, e.g. dedicated bonding, but not executed yet, let's do it now 5181532f91a5SMatthias Ringwald break; 5182ad83dc6aS[email protected] default: 5183ad83dc6aS[email protected] // otherwise, just ignore as it is already in the open process 51843e2050f7SMatthias Ringwald // packet not sent to controller 51853e2050f7SMatthias Ringwald return ERROR_CODE_ACL_CONNECTION_ALREADY_EXISTS; 5186ad83dc6aS[email protected] } 5187c8e4258aSmatthias.ringwald conn->state = SENT_CREATE_CONNECTION; 5188229331c6SMatthias Ringwald 5189229331c6SMatthias Ringwald // track outgoing connection 5190f16129ceSMatthias Ringwald hci_stack->outgoing_addr_type = BD_ADDR_TYPE_ACL; 51916535961aSMatthias Ringwald (void) memcpy(hci_stack->outgoing_addr, addr, 6); 51926f35bb46SMatthias Ringwald break; 51936f35bb46SMatthias Ringwald case HCI_OPCODE_HCI_DELETE_STORED_LINK_KEY: 5194a98592bcSMatthias Ringwald if (hci_stack->link_key_db) { 5195724d70a2SMatthias Ringwald reverse_bd_addr(&packet[3], addr); 5196a98592bcSMatthias Ringwald hci_stack->link_key_db->delete_link_key(addr); 51978ef73945Smatthias.ringwald } 51986f35bb46SMatthias Ringwald break; 5199ee752bb8SMatthias Ringwald 52005b7087c7SMatthias Ringwald #if defined (ENABLE_SCO_OVER_HCI) || defined (HAVE_SCO_TRANSPORT) 52016f35bb46SMatthias Ringwald case HCI_OPCODE_HCI_SETUP_SYNCHRONOUS_CONNECTION: 5202ee752bb8SMatthias Ringwald // setup_synchronous_connection? Voice setting at offset 22 5203ee752bb8SMatthias Ringwald // TODO: compare to current setting if sco connection already active 5204ee752bb8SMatthias Ringwald hci_stack->sco_voice_setting_active = little_endian_read_16(packet, 15); 52056f35bb46SMatthias Ringwald break; 52066f35bb46SMatthias Ringwald case HCI_OPCODE_HCI_ACCEPT_SYNCHRONOUS_CONNECTION: 5207ee752bb8SMatthias Ringwald // accept_synchronus_connection? Voice setting at offset 18 5208ee752bb8SMatthias Ringwald // TODO: compare to current setting if sco connection already active 5209ee752bb8SMatthias Ringwald hci_stack->sco_voice_setting_active = little_endian_read_16(packet, 19); 52106f35bb46SMatthias Ringwald break; 5211ee752bb8SMatthias Ringwald #endif 521235454696SMatthias Ringwald #endif 52134b3e1e19SMatthias Ringwald 5214a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE 52156f35bb46SMatthias Ringwald case HCI_OPCODE_HCI_LE_SET_RANDOM_ADDRESS: 5216b95a5a35SMatthias Ringwald hci_stack->le_random_address_set = 1; 5217b95a5a35SMatthias Ringwald reverse_bd_addr(&packet[3], hci_stack->le_random_address); 52186f35bb46SMatthias Ringwald break; 52197e8d8b1dSMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 52206f35bb46SMatthias Ringwald case HCI_OPCODE_HCI_LE_SET_ADVERTISE_ENABLE: 52215226d7f2SMatthias Ringwald hci_stack->le_advertisements_active = packet[3] != 0; 52226f35bb46SMatthias Ringwald break; 5223d70217a2SMatthias Ringwald #endif 5224d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 52256f35bb46SMatthias Ringwald case HCI_OPCODE_HCI_LE_CREATE_CONNECTION: 5226b04dfa37SMatthias Ringwald // white list used? 52276f35bb46SMatthias Ringwald initiator_filter_policy = packet[7]; 5228b04dfa37SMatthias Ringwald switch (initiator_filter_policy) { 5229b04dfa37SMatthias Ringwald case 0: 5230b04dfa37SMatthias Ringwald // whitelist not used 5231b04dfa37SMatthias Ringwald hci_stack->le_connecting_state = LE_CONNECTING_DIRECT; 5232b04dfa37SMatthias Ringwald break; 5233b04dfa37SMatthias Ringwald case 1: 5234b04dfa37SMatthias Ringwald hci_stack->le_connecting_state = LE_CONNECTING_WHITELIST; 5235b04dfa37SMatthias Ringwald break; 5236b04dfa37SMatthias Ringwald default: 5237b04dfa37SMatthias Ringwald log_error("Invalid initiator_filter_policy in LE Create Connection %u", initiator_filter_policy); 5238b04dfa37SMatthias Ringwald break; 5239b04dfa37SMatthias Ringwald } 5240c163146eSMatthias Ringwald // track outgoing connection 524105002aecSMatthias Ringwald hci_stack->outgoing_addr_type = (bd_addr_type_t) packet[8]; // peer addres type 5242c163146eSMatthias Ringwald reverse_bd_addr( &packet[9], hci_stack->outgoing_addr); // peer address 52436f35bb46SMatthias Ringwald break; 52446f35bb46SMatthias Ringwald case HCI_OPCODE_HCI_LE_CREATE_CONNECTION_CANCEL: 52456ea9315cSMatthias Ringwald hci_stack->le_connecting_state = LE_CONNECTING_CANCEL; 52466f35bb46SMatthias Ringwald break; 52479cbd2215SMatthias Ringwald #endif 52489cbd2215SMatthias Ringwald #endif 52496f35bb46SMatthias Ringwald default: 52506f35bb46SMatthias Ringwald break; 5251b04dfa37SMatthias Ringwald } 525269a97523S[email protected] 52533a9fb326S[email protected] hci_stack->num_cmd_packets--; 52545bb5bc3eS[email protected] 52555bb5bc3eS[email protected] hci_dump_packet(HCI_COMMAND_DATA_PACKET, 0, packet, size); 52563e2050f7SMatthias Ringwald int err = hci_stack->hci_transport->send_packet(HCI_COMMAND_DATA_PACKET, packet, size); 52573e2050f7SMatthias Ringwald if (err != 0){ 52583e2050f7SMatthias Ringwald return ERROR_CODE_HARDWARE_FAILURE; 52593e2050f7SMatthias Ringwald } 52603e2050f7SMatthias Ringwald return ERROR_CODE_SUCCESS; 526131452debSmatthias.ringwald } 52628adf0ddaSmatthias.ringwald 52632bd8b7e7S[email protected] // disconnect because of security block 52642bd8b7e7S[email protected] void hci_disconnect_security_block(hci_con_handle_t con_handle){ 52652bd8b7e7S[email protected] hci_connection_t * connection = hci_connection_for_handle(con_handle); 52662bd8b7e7S[email protected] if (!connection) return; 52672bd8b7e7S[email protected] connection->bonding_flags |= BONDING_DISCONNECT_SECURITY_BLOCK; 52682bd8b7e7S[email protected] } 52692bd8b7e7S[email protected] 52702bd8b7e7S[email protected] 5271dbe1a790S[email protected] // Configure Secure Simple Pairing 5272dbe1a790S[email protected] 527335454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 527435454696SMatthias Ringwald 5275dbe1a790S[email protected] // enable will enable SSP during init 527615a95bd5SMatthias Ringwald void gap_ssp_set_enable(int enable){ 52773a9fb326S[email protected] hci_stack->ssp_enable = enable; 5278dbe1a790S[email protected] } 5279dbe1a790S[email protected] 528095d71764SMatthias Ringwald static int hci_local_ssp_activated(void){ 528115a95bd5SMatthias Ringwald return gap_ssp_supported() && hci_stack->ssp_enable; 52822bd8b7e7S[email protected] } 52832bd8b7e7S[email protected] 5284dbe1a790S[email protected] // if set, BTstack will respond to io capability request using authentication requirement 528515a95bd5SMatthias Ringwald void gap_ssp_set_io_capability(int io_capability){ 52863a9fb326S[email protected] hci_stack->ssp_io_capability = io_capability; 5287dbe1a790S[email protected] } 528815a95bd5SMatthias Ringwald void gap_ssp_set_authentication_requirement(int authentication_requirement){ 52893a9fb326S[email protected] hci_stack->ssp_authentication_requirement = authentication_requirement; 5290dbe1a790S[email protected] } 5291dbe1a790S[email protected] 5292dbe1a790S[email protected] // if set, BTstack will confirm a numberic comparion and enter '000000' if requested 529315a95bd5SMatthias Ringwald void gap_ssp_set_auto_accept(int auto_accept){ 52943a9fb326S[email protected] hci_stack->ssp_auto_accept = auto_accept; 5295dbe1a790S[email protected] } 52965d23aae8SMatthias Ringwald 52975d23aae8SMatthias Ringwald void gap_secure_connections_enable(bool enable){ 52985d23aae8SMatthias Ringwald hci_stack->secure_connections_enable = enable; 52995d23aae8SMatthias Ringwald } 53005d23aae8SMatthias Ringwald 530135454696SMatthias Ringwald #endif 5302dbe1a790S[email protected] 530394be1a66SMatthias Ringwald // va_list part of hci_send_cmd 53043e2050f7SMatthias Ringwald uint8_t hci_send_cmd_va_arg(const hci_cmd_t * cmd, va_list argptr){ 5305d94d3cafS[email protected] if (!hci_can_send_command_packet_now()){ 53069d14b626S[email protected] log_error("hci_send_cmd called but cannot send packet now"); 53073e2050f7SMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 53089d14b626S[email protected] } 53099d14b626S[email protected] 53105127cc62S[email protected] // for HCI INITIALIZATION 53119da54300S[email protected] // log_info("hci_send_cmd: opcode %04x", cmd->opcode); 53125127cc62S[email protected] hci_stack->last_cmd_opcode = cmd->opcode; 53135127cc62S[email protected] 53149d14b626S[email protected] hci_reserve_packet_buffer(); 53159d14b626S[email protected] uint8_t * packet = hci_stack->hci_packet_buffer; 531694be1a66SMatthias Ringwald uint16_t size = hci_cmd_create_from_template(packet, cmd, argptr); 53173e2050f7SMatthias Ringwald uint8_t status = hci_send_cmd_packet(packet, size); 5318bfea0222SMatthias Ringwald 5319593702caSMatthias Ringwald // release packet buffer on error or for synchronous transport implementations 53203e2050f7SMatthias Ringwald if ((status != ERROR_CODE_SUCCESS) || hci_transport_synchronous()){ 5321e2d22487SMatthias Ringwald hci_release_packet_buffer(); 5322068b8592SMatthias Ringwald hci_emit_transport_packet_sent(); 5323bfea0222SMatthias Ringwald } 5324bfea0222SMatthias Ringwald 53253e2050f7SMatthias Ringwald return status; 532694be1a66SMatthias Ringwald } 53279d14b626S[email protected] 532894be1a66SMatthias Ringwald /** 532994be1a66SMatthias Ringwald * pre: numcmds >= 0 - it's allowed to send a command to the controller 533094be1a66SMatthias Ringwald */ 53313e2050f7SMatthias Ringwald uint8_t hci_send_cmd(const hci_cmd_t * cmd, ...){ 53321cd208adSmatthias.ringwald va_list argptr; 53331cd208adSmatthias.ringwald va_start(argptr, cmd); 53343e2050f7SMatthias Ringwald uint8_t status = hci_send_cmd_va_arg(cmd, argptr); 53351cd208adSmatthias.ringwald va_end(argptr); 53363e2050f7SMatthias Ringwald return status; 533793b8dc03Smatthias.ringwald } 5338c8e4258aSmatthias.ringwald 5339ee091cf1Smatthias.ringwald // Create various non-HCI events. 5340ee091cf1Smatthias.ringwald // TODO: generalize, use table similar to hci_create_command 5341ee091cf1Smatthias.ringwald 5342d6b06661SMatthias Ringwald static void hci_emit_event(uint8_t * event, uint16_t size, int dump){ 5343fb37a842SMatthias Ringwald // dump packet 5344d6b06661SMatthias Ringwald if (dump) { 5345300c1ba4SMatthias Ringwald hci_dump_packet( HCI_EVENT_PACKET, 0, event, size); 5346d6b06661SMatthias Ringwald } 53471ef6bb52SMatthias Ringwald 5348fb37a842SMatthias Ringwald // dispatch to all event handlers 53491ef6bb52SMatthias Ringwald btstack_linked_list_iterator_t it; 53501ef6bb52SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->event_handlers); 53511ef6bb52SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 53521ef6bb52SMatthias Ringwald btstack_packet_callback_registration_t * entry = (btstack_packet_callback_registration_t*) btstack_linked_list_iterator_next(&it); 5353d9a7306aSMatthias Ringwald entry->callback(HCI_EVENT_PACKET, 0, event, size); 53541ef6bb52SMatthias Ringwald } 5355d6b06661SMatthias Ringwald } 5356d6b06661SMatthias Ringwald 5357d6b06661SMatthias Ringwald static void hci_emit_acl_packet(uint8_t * packet, uint16_t size){ 5358fb37a842SMatthias Ringwald if (!hci_stack->acl_packet_handler) return; 53593d50b4baSMatthias Ringwald hci_stack->acl_packet_handler(HCI_ACL_DATA_PACKET, 0, packet, size); 5360d6b06661SMatthias Ringwald } 5361d6b06661SMatthias Ringwald 536235454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 5363701e3307SMatthias Ringwald static void hci_notify_if_sco_can_send_now(void){ 53643bc639ceSMatthias Ringwald // notify SCO sender if waiting 5365701e3307SMatthias Ringwald if (!hci_stack->sco_waiting_for_can_send_now) return; 5366701e3307SMatthias Ringwald if (hci_can_send_sco_packet_now()){ 53673bc639ceSMatthias Ringwald hci_stack->sco_waiting_for_can_send_now = 0; 5368701e3307SMatthias Ringwald uint8_t event[2] = { HCI_EVENT_SCO_CAN_SEND_NOW, 0 }; 5369701e3307SMatthias Ringwald hci_dump_packet(HCI_EVENT_PACKET, 1, event, sizeof(event)); 53703d50b4baSMatthias Ringwald hci_stack->sco_packet_handler(HCI_EVENT_PACKET, 0, event, sizeof(event)); 53713bc639ceSMatthias Ringwald } 53723bc639ceSMatthias Ringwald } 53731cfb383eSMatthias Ringwald 53741cfb383eSMatthias Ringwald // parsing end emitting has been merged to reduce code size 53759784dac1SMatthias Ringwald static void gap_inquiry_explode(uint8_t *packet, uint16_t size) { 5376ac9136ccSMatthias Ringwald uint8_t event[28+GAP_INQUIRY_MAX_NAME_LEN]; 53771cfb383eSMatthias Ringwald 53781cfb383eSMatthias Ringwald uint8_t * eir_data; 53791cfb383eSMatthias Ringwald ad_context_t context; 53801cfb383eSMatthias Ringwald const uint8_t * name; 53811cfb383eSMatthias Ringwald uint8_t name_len; 53821cfb383eSMatthias Ringwald 53839784dac1SMatthias Ringwald if (size < 3) return; 53849784dac1SMatthias Ringwald 53851cfb383eSMatthias Ringwald int event_type = hci_event_packet_get_type(packet); 5386a1df452eSMatthias Ringwald int num_reserved_fields = (event_type == HCI_EVENT_INQUIRY_RESULT) ? 2 : 1; // 2 for old event, 1 otherwise 53871cfb383eSMatthias Ringwald int num_responses = hci_event_inquiry_result_get_num_responses(packet); 53881cfb383eSMatthias Ringwald 53899784dac1SMatthias Ringwald switch (event_type){ 53909784dac1SMatthias Ringwald case HCI_EVENT_INQUIRY_RESULT: 53919784dac1SMatthias Ringwald case HCI_EVENT_INQUIRY_RESULT_WITH_RSSI: 53929784dac1SMatthias Ringwald if (size != (3 + (num_responses * 14))) return; 53939784dac1SMatthias Ringwald break; 53949784dac1SMatthias Ringwald case HCI_EVENT_EXTENDED_INQUIRY_RESPONSE: 53959784dac1SMatthias Ringwald if (size != 257) return; 53969784dac1SMatthias Ringwald if (num_responses != 1) return; 53979784dac1SMatthias Ringwald break; 53989784dac1SMatthias Ringwald default: 53999784dac1SMatthias Ringwald return; 54009784dac1SMatthias Ringwald } 54019784dac1SMatthias Ringwald 54021cfb383eSMatthias Ringwald // event[1] is set at the end 54031cfb383eSMatthias Ringwald int i; 54041cfb383eSMatthias Ringwald for (i=0; i<num_responses;i++){ 54051cfb383eSMatthias Ringwald memset(event, 0, sizeof(event)); 54061cfb383eSMatthias Ringwald event[0] = GAP_EVENT_INQUIRY_RESULT; 5407ac973fd6SMatthias Ringwald uint8_t event_size = 27; // if name is not set by EIR 54081cfb383eSMatthias Ringwald 54096535961aSMatthias Ringwald (void)memcpy(&event[2], &packet[3 + (i * 6)], 6); // bd_addr 54100e588213SMatthias Ringwald event[8] = packet[3 + (num_responses*(6)) + (i*1)]; // page_scan_repetition_mode 54116535961aSMatthias Ringwald (void)memcpy(&event[9], 54126535961aSMatthias Ringwald &packet[3 + (num_responses * (6 + 1 + num_reserved_fields)) + (i * 3)], 54136535961aSMatthias Ringwald 3); // class of device 54146535961aSMatthias Ringwald (void)memcpy(&event[12], 54156535961aSMatthias Ringwald &packet[3 + (num_responses * (6 + 1 + num_reserved_fields + 3)) + (i * 2)], 54166535961aSMatthias Ringwald 2); // clock offset 54171cfb383eSMatthias Ringwald 54181cfb383eSMatthias Ringwald switch (event_type){ 54191cfb383eSMatthias Ringwald case HCI_EVENT_INQUIRY_RESULT: 54201cfb383eSMatthias Ringwald // 14,15,16,17 = 0, size 18 54211cfb383eSMatthias Ringwald break; 54221cfb383eSMatthias Ringwald case HCI_EVENT_INQUIRY_RESULT_WITH_RSSI: 54231cfb383eSMatthias Ringwald event[14] = 1; 5424a1df452eSMatthias Ringwald event[15] = packet [3 + (num_responses*(6+1+num_reserved_fields+3+2)) + (i*1)]; // rssi 54251cfb383eSMatthias Ringwald // 16,17 = 0, size 18 54261cfb383eSMatthias Ringwald break; 54271cfb383eSMatthias Ringwald case HCI_EVENT_EXTENDED_INQUIRY_RESPONSE: 54281cfb383eSMatthias Ringwald event[14] = 1; 5429a1df452eSMatthias Ringwald event[15] = packet [3 + (num_responses*(6+1+num_reserved_fields+3+2)) + (i*1)]; // rssi 543079186815SMatthias Ringwald // EIR packets only contain a single inquiry response 54311cfb383eSMatthias Ringwald eir_data = &packet[3 + (6+1+num_reserved_fields+3+2+1)]; 54321cfb383eSMatthias Ringwald name = NULL; 5433a8c4e5adSMatthias Ringwald // Iterate over EIR data 5434a8c4e5adSMatthias Ringwald for (ad_iterator_init(&context, EXTENDED_INQUIRY_RESPONSE_DATA_LEN, eir_data) ; ad_iterator_has_more(&context) ; ad_iterator_next(&context)){ 54351cfb383eSMatthias Ringwald uint8_t data_type = ad_iterator_get_data_type(&context); 54361cfb383eSMatthias Ringwald uint8_t data_size = ad_iterator_get_data_len(&context); 54371cfb383eSMatthias Ringwald const uint8_t * data = ad_iterator_get_data(&context); 5438ac9136ccSMatthias Ringwald // Prefer Complete Local Name over Shortened Local Name 54391cfb383eSMatthias Ringwald switch (data_type){ 54401cfb383eSMatthias Ringwald case BLUETOOTH_DATA_TYPE_SHORTENED_LOCAL_NAME: 54411cfb383eSMatthias Ringwald if (name) continue; 5442cf373d3aSMatthias Ringwald /* fall through */ 54431cfb383eSMatthias Ringwald case BLUETOOTH_DATA_TYPE_COMPLETE_LOCAL_NAME: 54441cfb383eSMatthias Ringwald name = data; 54451cfb383eSMatthias Ringwald name_len = data_size; 54461cfb383eSMatthias Ringwald break; 5447ac9136ccSMatthias Ringwald case BLUETOOTH_DATA_TYPE_DEVICE_ID: 5448ac9136ccSMatthias Ringwald if (data_size != 8) break; 5449ac9136ccSMatthias Ringwald event[16] = 1; 54503c0c7fefSMatthias Ringwald memcpy(&event[17], data, 8); 5451ac9136ccSMatthias Ringwald break; 54521cfb383eSMatthias Ringwald default: 54531cfb383eSMatthias Ringwald break; 54541cfb383eSMatthias Ringwald } 54551cfb383eSMatthias Ringwald } 54561cfb383eSMatthias Ringwald if (name){ 5457ac9136ccSMatthias Ringwald event[25] = 1; 54581cfb383eSMatthias Ringwald // truncate name if needed 54591cfb383eSMatthias Ringwald int len = btstack_min(name_len, GAP_INQUIRY_MAX_NAME_LEN); 5460ac9136ccSMatthias Ringwald event[26] = len; 5461ac9136ccSMatthias Ringwald (void)memcpy(&event[27], name, len); 54621cfb383eSMatthias Ringwald event_size += len; 54631cfb383eSMatthias Ringwald } 54641cfb383eSMatthias Ringwald break; 54657bbeb3adSMilanka Ringwald default: 54667bbeb3adSMilanka Ringwald return; 54671cfb383eSMatthias Ringwald } 54681cfb383eSMatthias Ringwald event[1] = event_size - 2; 54691cfb383eSMatthias Ringwald hci_emit_event(event, event_size, 1); 54701cfb383eSMatthias Ringwald } 54711cfb383eSMatthias Ringwald } 547235454696SMatthias Ringwald #endif 54733bc639ceSMatthias Ringwald 547471de195eSMatthias Ringwald void hci_emit_state(void){ 54753a9fb326S[email protected] log_info("BTSTACK_EVENT_STATE %u", hci_stack->state); 5476425d1371Smatthias.ringwald uint8_t event[3]; 547780d52d6bSmatthias.ringwald event[0] = BTSTACK_EVENT_STATE; 54784ea43905SMatthias Ringwald event[1] = sizeof(event) - 2u; 54793a9fb326S[email protected] event[2] = hci_stack->state; 5480d6b06661SMatthias Ringwald hci_emit_event(event, sizeof(event), 1); 5481c8e4258aSmatthias.ringwald } 5482c8e4258aSmatthias.ringwald 548335454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 54842deddeceSMatthias Ringwald static void hci_emit_connection_complete(bd_addr_t address, hci_con_handle_t con_handle, uint8_t status){ 5485425d1371Smatthias.ringwald uint8_t event[13]; 5486c8e4258aSmatthias.ringwald event[0] = HCI_EVENT_CONNECTION_COMPLETE; 5487425d1371Smatthias.ringwald event[1] = sizeof(event) - 2; 548817f1ba2aSmatthias.ringwald event[2] = status; 54892deddeceSMatthias Ringwald little_endian_store_16(event, 3, con_handle); 54902deddeceSMatthias Ringwald reverse_bd_addr(address, &event[5]); 5491c8e4258aSmatthias.ringwald event[11] = 1; // ACL connection 5492c8e4258aSmatthias.ringwald event[12] = 0; // encryption disabled 5493d6b06661SMatthias Ringwald hci_emit_event(event, sizeof(event), 1); 5494c8e4258aSmatthias.ringwald } 549552db98b2SMatthias Ringwald static void hci_emit_l2cap_check_timeout(hci_connection_t *conn){ 549652db98b2SMatthias Ringwald if (disable_l2cap_timeouts) return; 549752db98b2SMatthias Ringwald log_info("L2CAP_EVENT_TIMEOUT_CHECK"); 549852db98b2SMatthias Ringwald uint8_t event[4]; 549952db98b2SMatthias Ringwald event[0] = L2CAP_EVENT_TIMEOUT_CHECK; 550052db98b2SMatthias Ringwald event[1] = sizeof(event) - 2; 550152db98b2SMatthias Ringwald little_endian_store_16(event, 2, conn->con_handle); 550252db98b2SMatthias Ringwald hci_emit_event(event, sizeof(event), 1); 550352db98b2SMatthias Ringwald } 550435454696SMatthias Ringwald #endif 5505c8e4258aSmatthias.ringwald 550635454696SMatthias Ringwald #ifdef ENABLE_BLE 5507d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 5508667ba9d1SMatthias 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){ 55094f3229d8S[email protected] uint8_t event[21]; 55104f3229d8S[email protected] event[0] = HCI_EVENT_LE_META; 55114ea43905SMatthias Ringwald event[1] = sizeof(event) - 2u; 55124f3229d8S[email protected] event[2] = HCI_SUBEVENT_LE_CONNECTION_COMPLETE; 55134f3229d8S[email protected] event[3] = status; 5514fc64f94aSMatthias Ringwald little_endian_store_16(event, 4, con_handle); 55154f3229d8S[email protected] event[6] = 0; // TODO: role 55166e2e9a6bS[email protected] event[7] = address_type; 5517724d70a2SMatthias Ringwald reverse_bd_addr(address, &event[8]); 5518f8fbdce0SMatthias Ringwald little_endian_store_16(event, 14, 0); // interval 5519f8fbdce0SMatthias Ringwald little_endian_store_16(event, 16, 0); // latency 5520f8fbdce0SMatthias Ringwald little_endian_store_16(event, 18, 0); // supervision timeout 55214f3229d8S[email protected] event[20] = 0; // master clock accuracy 5522d6b06661SMatthias Ringwald hci_emit_event(event, sizeof(event), 1); 55234f3229d8S[email protected] } 552435454696SMatthias Ringwald #endif 5525d70217a2SMatthias Ringwald #endif 55264f3229d8S[email protected] 5527fd43c0e0SMatthias Ringwald static void hci_emit_transport_packet_sent(void){ 5528fd43c0e0SMatthias Ringwald // notify upper stack that it might be possible to send again 5529fd43c0e0SMatthias Ringwald uint8_t event[] = { HCI_EVENT_TRANSPORT_PACKET_SENT, 0}; 5530fd43c0e0SMatthias Ringwald hci_emit_event(&event[0], sizeof(event), 0); // don't dump 5531fd43c0e0SMatthias Ringwald } 5532fd43c0e0SMatthias Ringwald 5533fc64f94aSMatthias Ringwald static void hci_emit_disconnection_complete(hci_con_handle_t con_handle, uint8_t reason){ 5534425d1371Smatthias.ringwald uint8_t event[6]; 55353c4d4b90Smatthias.ringwald event[0] = HCI_EVENT_DISCONNECTION_COMPLETE; 55364ea43905SMatthias Ringwald event[1] = sizeof(event) - 2u; 55373c4d4b90Smatthias.ringwald event[2] = 0; // status = OK 5538fc64f94aSMatthias Ringwald little_endian_store_16(event, 3, con_handle); 55393c4d4b90Smatthias.ringwald event[5] = reason; 5540d6b06661SMatthias Ringwald hci_emit_event(event, sizeof(event), 1); 55413c4d4b90Smatthias.ringwald } 55423c4d4b90Smatthias.ringwald 5543b83d5eabSMatthias Ringwald static void hci_emit_nr_connections_changed(void){ 5544e0abb8e7S[email protected] log_info("BTSTACK_EVENT_NR_CONNECTIONS_CHANGED %u", nr_hci_connections()); 5545425d1371Smatthias.ringwald uint8_t event[3]; 554680d52d6bSmatthias.ringwald event[0] = BTSTACK_EVENT_NR_CONNECTIONS_CHANGED; 55474ea43905SMatthias Ringwald event[1] = sizeof(event) - 2u; 554843bfb1bdSmatthias.ringwald event[2] = nr_hci_connections(); 5549d6b06661SMatthias Ringwald hci_emit_event(event, sizeof(event), 1); 555043bfb1bdSmatthias.ringwald } 5551038bc64cSmatthias.ringwald 5552b83d5eabSMatthias Ringwald static void hci_emit_hci_open_failed(void){ 5553e0abb8e7S[email protected] log_info("BTSTACK_EVENT_POWERON_FAILED"); 5554425d1371Smatthias.ringwald uint8_t event[2]; 555580d52d6bSmatthias.ringwald event[0] = BTSTACK_EVENT_POWERON_FAILED; 55564ea43905SMatthias Ringwald event[1] = sizeof(event) - 2u; 5557d6b06661SMatthias Ringwald hci_emit_event(event, sizeof(event), 1); 5558038bc64cSmatthias.ringwald } 55591b0e3922Smatthias.ringwald 556035454696SMatthias Ringwald static void hci_emit_dedicated_bonding_result(bd_addr_t address, uint8_t status){ 556135454696SMatthias Ringwald log_info("hci_emit_dedicated_bonding_result %u ", status); 556235454696SMatthias Ringwald uint8_t event[9]; 556335454696SMatthias Ringwald int pos = 0; 556435454696SMatthias Ringwald event[pos++] = GAP_EVENT_DEDICATED_BONDING_COMPLETED; 55654ea43905SMatthias Ringwald event[pos++] = sizeof(event) - 2u; 556635454696SMatthias Ringwald event[pos++] = status; 556735454696SMatthias Ringwald reverse_bd_addr(address, &event[pos]); 5568d6b06661SMatthias Ringwald hci_emit_event(event, sizeof(event), 1); 5569381fbed8Smatthias.ringwald } 5570458bf4e8S[email protected] 557135454696SMatthias Ringwald 557235454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 557335454696SMatthias Ringwald 5574b83d5eabSMatthias Ringwald static void hci_emit_security_level(hci_con_handle_t con_handle, gap_security_level_t level){ 5575df3354fcS[email protected] log_info("hci_emit_security_level %u for handle %x", level, con_handle); 5576a00031e2S[email protected] uint8_t event[5]; 5577e00caf9cS[email protected] int pos = 0; 55785611a760SMatthias Ringwald event[pos++] = GAP_EVENT_SECURITY_LEVEL; 5579e00caf9cS[email protected] event[pos++] = sizeof(event) - 2; 5580f8fbdce0SMatthias Ringwald little_endian_store_16(event, 2, con_handle); 5581e00caf9cS[email protected] pos += 2; 5582e00caf9cS[email protected] event[pos++] = level; 5583d6b06661SMatthias Ringwald hci_emit_event(event, sizeof(event), 1); 5584e00caf9cS[email protected] } 5585e00caf9cS[email protected] 558635454696SMatthias Ringwald static gap_security_level_t gap_security_level_for_connection(hci_connection_t * connection){ 558735454696SMatthias Ringwald if (!connection) return LEVEL_0; 55888daf94bcSMatthias Ringwald if ((connection->authentication_flags & AUTH_FLAG_CONNECTION_ENCRYPTED) == 0) return LEVEL_0; 5589fcaf38b9SMatthias Ringwald // BIAS: we only consider Authenticated if the connection is already encrypted, which requires that both sides have link key 55908daf94bcSMatthias Ringwald if ((connection->authentication_flags & AUTH_FLAG_CONNECTION_AUTHENTICATED) == 0) return LEVEL_0; 5591170fafaeSMatthias Ringwald if (connection->encryption_key_size < hci_stack->gap_required_encyrption_key_size) return LEVEL_0; 55924051b7ffSMatthias Ringwald gap_security_level_t security_level = gap_security_level_for_link_key_type(connection->link_key_type); 5593170fafaeSMatthias Ringwald // LEVEL 4 always requires 128 bit encrytion key size 55940e588213SMatthias Ringwald if ((security_level == LEVEL_4) && (connection->encryption_key_size < 16)){ 5595170fafaeSMatthias Ringwald security_level = LEVEL_3; 5596170fafaeSMatthias Ringwald } 5597170fafaeSMatthias Ringwald return security_level; 559835454696SMatthias Ringwald } 559935454696SMatthias Ringwald 560035454696SMatthias Ringwald static void hci_emit_discoverable_enabled(uint8_t enabled){ 560135454696SMatthias Ringwald log_info("BTSTACK_EVENT_DISCOVERABLE_ENABLED %u", enabled); 560235454696SMatthias Ringwald uint8_t event[3]; 560335454696SMatthias Ringwald event[0] = BTSTACK_EVENT_DISCOVERABLE_ENABLED; 560435454696SMatthias Ringwald event[1] = sizeof(event) - 2; 560535454696SMatthias Ringwald event[2] = enabled; 5606d6b06661SMatthias Ringwald hci_emit_event(event, sizeof(event), 1); 5607ad83dc6aS[email protected] } 5608ad83dc6aS[email protected] 560998a2fd1cSMatthias Ringwald // query if remote side supports eSCO 561020dcdd22SMatthias Ringwald bool hci_remote_esco_supported(hci_con_handle_t con_handle){ 561198a2fd1cSMatthias Ringwald hci_connection_t * connection = hci_connection_for_handle(con_handle); 561220dcdd22SMatthias Ringwald if (!connection) return false; 561376ccfb2aSMatthias Ringwald return (connection->remote_supported_features[0] & 1) != 0; 561498a2fd1cSMatthias Ringwald } 561598a2fd1cSMatthias Ringwald 561667aae551SMatthias Ringwald static bool hci_ssp_supported(hci_connection_t * connection){ 561767aae551SMatthias Ringwald const uint8_t mask = BONDING_REMOTE_SUPPORTS_SSP_CONTROLLER | BONDING_REMOTE_SUPPORTS_SSP_HOST; 561867aae551SMatthias Ringwald return (connection->bonding_flags & mask) == mask; 561967aae551SMatthias Ringwald } 562067aae551SMatthias Ringwald 56212bd8b7e7S[email protected] // query if remote side supports SSP 562220dcdd22SMatthias Ringwald bool hci_remote_ssp_supported(hci_con_handle_t con_handle){ 56232bd8b7e7S[email protected] hci_connection_t * connection = hci_connection_for_handle(con_handle); 562420dcdd22SMatthias Ringwald if (!connection) return false; 562567aae551SMatthias Ringwald return hci_ssp_supported(connection) ? 1 : 0; 56262bd8b7e7S[email protected] } 56272bd8b7e7S[email protected] 562820dcdd22SMatthias Ringwald bool gap_ssp_supported_on_both_sides(hci_con_handle_t handle){ 5629df3354fcS[email protected] return hci_local_ssp_activated() && hci_remote_ssp_supported(handle); 5630df3354fcS[email protected] } 5631df3354fcS[email protected] 5632458bf4e8S[email protected] // GAP API 5633458bf4e8S[email protected] /** 5634458bf4e8S[email protected] * @bbrief enable/disable bonding. default is enabled 5635458bf4e8S[email protected] * @praram enabled 5636458bf4e8S[email protected] */ 56374c57c146S[email protected] void gap_set_bondable_mode(int enable){ 56383a9fb326S[email protected] hci_stack->bondable = enable ? 1 : 0; 5639458bf4e8S[email protected] } 56404ef6443cSMatthias Ringwald /** 56414ef6443cSMatthias Ringwald * @brief Get bondable mode. 56424ef6443cSMatthias Ringwald * @return 1 if bondable 56434ef6443cSMatthias Ringwald */ 56444ef6443cSMatthias Ringwald int gap_get_bondable_mode(void){ 56454ef6443cSMatthias Ringwald return hci_stack->bondable; 56464ef6443cSMatthias Ringwald } 5647cb230b9dS[email protected] 5648cb230b9dS[email protected] /** 564934d2123cS[email protected] * @brief map link keys to security levels 5650cb230b9dS[email protected] */ 565134d2123cS[email protected] gap_security_level_t gap_security_level_for_link_key_type(link_key_type_t link_key_type){ 565234d2123cS[email protected] switch (link_key_type){ 56533c68dfa9S[email protected] case AUTHENTICATED_COMBINATION_KEY_GENERATED_FROM_P256: 56543c68dfa9S[email protected] return LEVEL_4; 56553c68dfa9S[email protected] case COMBINATION_KEY: 56563c68dfa9S[email protected] case AUTHENTICATED_COMBINATION_KEY_GENERATED_FROM_P192: 56573c68dfa9S[email protected] return LEVEL_3; 56583c68dfa9S[email protected] default: 56593c68dfa9S[email protected] return LEVEL_2; 56603c68dfa9S[email protected] } 5661cb230b9dS[email protected] } 5662cb230b9dS[email protected] 56638b35e16aSMatthias Ringwald /** 56648b35e16aSMatthias Ringwald * @brief map link keys to secure connection yes/no 56658b35e16aSMatthias Ringwald */ 56668b35e16aSMatthias Ringwald int gap_secure_connection_for_link_key_type(link_key_type_t link_key_type){ 56678b35e16aSMatthias Ringwald switch (link_key_type){ 56688b35e16aSMatthias Ringwald case AUTHENTICATED_COMBINATION_KEY_GENERATED_FROM_P256: 56698b35e16aSMatthias Ringwald case UNAUTHENTICATED_COMBINATION_KEY_GENERATED_FROM_P256: 56708b35e16aSMatthias Ringwald return 1; 56718b35e16aSMatthias Ringwald default: 56728b35e16aSMatthias Ringwald return 0; 56738b35e16aSMatthias Ringwald } 56748b35e16aSMatthias Ringwald } 56758b35e16aSMatthias Ringwald 56768b35e16aSMatthias Ringwald /** 56778b35e16aSMatthias Ringwald * @brief map link keys to authenticated 56788b35e16aSMatthias Ringwald */ 56798b35e16aSMatthias Ringwald int gap_authenticated_for_link_key_type(link_key_type_t link_key_type){ 56808b35e16aSMatthias Ringwald switch (link_key_type){ 56818b35e16aSMatthias Ringwald case AUTHENTICATED_COMBINATION_KEY_GENERATED_FROM_P256: 56828b35e16aSMatthias Ringwald case AUTHENTICATED_COMBINATION_KEY_GENERATED_FROM_P192: 56838b35e16aSMatthias Ringwald return 1; 56848b35e16aSMatthias Ringwald default: 56858b35e16aSMatthias Ringwald return 0; 56868b35e16aSMatthias Ringwald } 56878b35e16aSMatthias Ringwald } 56888b35e16aSMatthias Ringwald 5689106d6d11S[email protected] int gap_mitm_protection_required_for_security_level(gap_security_level_t level){ 56905127cc62S[email protected] log_info("gap_mitm_protection_required_for_security_level %u", level); 5691106d6d11S[email protected] return level > LEVEL_2; 5692106d6d11S[email protected] } 5693106d6d11S[email protected] 569434d2123cS[email protected] /** 569534d2123cS[email protected] * @brief get current security level 569634d2123cS[email protected] */ 569734d2123cS[email protected] gap_security_level_t gap_security_level(hci_con_handle_t con_handle){ 569834d2123cS[email protected] hci_connection_t * connection = hci_connection_for_handle(con_handle); 569934d2123cS[email protected] if (!connection) return LEVEL_0; 570034d2123cS[email protected] return gap_security_level_for_connection(connection); 570134d2123cS[email protected] } 570234d2123cS[email protected] 5703cb230b9dS[email protected] /** 5704cb230b9dS[email protected] * @brief request connection to device to 5705cb230b9dS[email protected] * @result GAP_AUTHENTICATION_RESULT 5706cb230b9dS[email protected] */ 570734d2123cS[email protected] void gap_request_security_level(hci_con_handle_t con_handle, gap_security_level_t requested_level){ 570834d2123cS[email protected] hci_connection_t * connection = hci_connection_for_handle(con_handle); 570934d2123cS[email protected] if (!connection){ 5710a00031e2S[email protected] hci_emit_security_level(con_handle, LEVEL_0); 571134d2123cS[email protected] return; 571234d2123cS[email protected] } 5713defbf200SMatthias Ringwald 5714defbf200SMatthias Ringwald btstack_assert(hci_is_le_connection(connection) == false); 5715defbf200SMatthias Ringwald 5716bc00e12cSMatthias Ringwald // Core Spec 5.2, GAP 5.2.2: "When in Secure Connections Only mode, all services (except those allowed to have Security Mode 4, Level 0) 5717bc00e12cSMatthias Ringwald // available on the BR/EDR physical transport require Security Mode 4, Level 4 " 5718bc00e12cSMatthias Ringwald if (hci_stack->gap_secure_connections_only_mode && (requested_level != LEVEL_0)){ 5719bc00e12cSMatthias Ringwald requested_level = LEVEL_4; 5720bc00e12cSMatthias Ringwald } 5721bc00e12cSMatthias Ringwald 572234d2123cS[email protected] gap_security_level_t current_level = gap_security_level(con_handle); 572383d08d7cSMatthias Ringwald log_info("gap_request_security_level requested level %u, planned level %u, current level %u", 572483d08d7cSMatthias Ringwald requested_level, connection->requested_security_level, current_level); 572583d08d7cSMatthias Ringwald 5726dbd5dcc3SMatthias Ringwald // authentication active if authentication request was sent or planned level > 0 5727dbd5dcc3SMatthias Ringwald bool authentication_active = ((connection->bonding_flags & BONDING_SENT_AUTHENTICATE_REQUEST) != 0) || (connection->requested_security_level > LEVEL_0); 5728dbd5dcc3SMatthias Ringwald if (authentication_active){ 57291cf0a6c8SMatthias Ringwald // authentication already active 573083d08d7cSMatthias Ringwald if (connection->requested_security_level < requested_level){ 573183d08d7cSMatthias Ringwald // increase requested level as new level is higher 573283d08d7cSMatthias Ringwald // TODO: handle re-authentication when done 573383d08d7cSMatthias Ringwald connection->requested_security_level = requested_level; 573483d08d7cSMatthias Ringwald } 57351cf0a6c8SMatthias Ringwald } else { 573683d08d7cSMatthias Ringwald // no request active, notify if security sufficient 573783d08d7cSMatthias Ringwald if (requested_level <= current_level){ 5738a00031e2S[email protected] hci_emit_security_level(con_handle, current_level); 573934d2123cS[email protected] return; 574034d2123cS[email protected] } 5741a00031e2S[email protected] 5742e060c07dSMatthias Ringwald // store request 574334d2123cS[email protected] connection->requested_security_level = requested_level; 5744a00031e2S[email protected] 57451cf0a6c8SMatthias Ringwald // start to authenticate connection 57461eb2563eS[email protected] connection->bonding_flags |= BONDING_SEND_AUTHENTICATE_REQUEST; 5747e80b2cf9S[email protected] hci_run(); 5748e00caf9cS[email protected] } 57491cf0a6c8SMatthias Ringwald } 5750ad83dc6aS[email protected] 5751ad83dc6aS[email protected] /** 5752ad83dc6aS[email protected] * @brief start dedicated bonding with device. disconnect after bonding 5753ad83dc6aS[email protected] * @param device 5754ad83dc6aS[email protected] * @param request MITM protection 5755ad83dc6aS[email protected] * @result GAP_DEDICATED_BONDING_COMPLETE 5756ad83dc6aS[email protected] */ 5757ad83dc6aS[email protected] int gap_dedicated_bonding(bd_addr_t device, int mitm_protection_required){ 5758ad83dc6aS[email protected] 5759ad83dc6aS[email protected] // create connection state machine 5760f16129ceSMatthias Ringwald hci_connection_t * connection = create_connection_for_bd_addr_and_type(device, BD_ADDR_TYPE_ACL); 5761ad83dc6aS[email protected] 5762ad83dc6aS[email protected] if (!connection){ 5763ad83dc6aS[email protected] return BTSTACK_MEMORY_ALLOC_FAILED; 5764ad83dc6aS[email protected] } 5765ad83dc6aS[email protected] 5766ad83dc6aS[email protected] // delete linkn key 576715a95bd5SMatthias Ringwald gap_drop_link_key_for_bd_addr(device); 5768ad83dc6aS[email protected] 5769ad83dc6aS[email protected] // configure LEVEL_2/3, dedicated bonding 5770ad83dc6aS[email protected] connection->state = SEND_CREATE_CONNECTION; 5771ad83dc6aS[email protected] connection->requested_security_level = mitm_protection_required ? LEVEL_3 : LEVEL_2; 5772f04a0c31SMatthias Ringwald log_info("gap_dedicated_bonding, mitm %d -> level %u", mitm_protection_required, connection->requested_security_level); 5773ad83dc6aS[email protected] connection->bonding_flags = BONDING_DEDICATED; 5774ad83dc6aS[email protected] 5775ad83dc6aS[email protected] // wait for GAP Security Result and send GAP Dedicated Bonding complete 5776ad83dc6aS[email protected] 5777ad83dc6aS[email protected] // handle: connnection failure (connection complete != ok) 5778ad83dc6aS[email protected] // handle: authentication failure 5779ad83dc6aS[email protected] // handle: disconnect on done 5780ad83dc6aS[email protected] 5781ad83dc6aS[email protected] hci_run(); 5782ad83dc6aS[email protected] 5783ad83dc6aS[email protected] return 0; 5784ad83dc6aS[email protected] } 57858e618f72S[email protected] 57868e618f72S[email protected] void gap_set_local_name(const char * local_name){ 57878e618f72S[email protected] hci_stack->local_name = local_name; 578859d59ecfSMatthias Ringwald hci_stack->gap_tasks |= GAP_TASK_SET_LOCAL_NAME; 578959d59ecfSMatthias Ringwald // also update EIR if not set by user 579059d59ecfSMatthias Ringwald if (hci_stack->eir_data == NULL){ 579159d59ecfSMatthias Ringwald hci_stack->gap_tasks |= GAP_TASK_SET_EIR_DATA; 579259d59ecfSMatthias Ringwald } 579359d59ecfSMatthias Ringwald hci_run(); 57948e618f72S[email protected] } 57951aeec2ebSMatthias Ringwald #endif 57968e618f72S[email protected] 579735454696SMatthias Ringwald 579835454696SMatthias Ringwald #ifdef ENABLE_BLE 579935454696SMatthias Ringwald 5800d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 5801d8e8f12aSMatthias Ringwald void gap_start_scan(void){ 5802fde725feSMatthias Ringwald hci_stack->le_scanning_enabled = true; 58037bdc6798S[email protected] hci_run(); 58047bdc6798S[email protected] } 58058e618f72S[email protected] 5806d8e8f12aSMatthias Ringwald void gap_stop_scan(void){ 5807fde725feSMatthias Ringwald hci_stack->le_scanning_enabled = false; 58087bdc6798S[email protected] hci_run(); 58097bdc6798S[email protected] } 58104f3229d8S[email protected] 5811a7a719e9SMatthias Ringwald void gap_set_scan_params(uint8_t scan_type, uint16_t scan_interval, uint16_t scan_window, uint8_t scanning_filter_policy){ 5812ef11999fSmatthias.ringwald hci_stack->le_scan_type = scan_type; 5813a7a719e9SMatthias Ringwald hci_stack->le_scan_filter_policy = scanning_filter_policy; 5814ef11999fSmatthias.ringwald hci_stack->le_scan_interval = scan_interval; 5815ef11999fSmatthias.ringwald hci_stack->le_scan_window = scan_window; 58168b69e4c7SMatthias Ringwald hci_stack->le_scanning_param_update = true; 5817ef11999fSmatthias.ringwald hci_run(); 5818ef11999fSmatthias.ringwald } 58194f3229d8S[email protected] 5820a7a719e9SMatthias Ringwald void gap_set_scan_parameters(uint8_t scan_type, uint16_t scan_interval, uint16_t scan_window){ 5821a7a719e9SMatthias Ringwald gap_set_scan_params(scan_type, scan_interval, scan_window, 0); 5822a7a719e9SMatthias Ringwald } 5823a7a719e9SMatthias Ringwald 5824667ba9d1SMatthias Ringwald uint8_t gap_connect(const bd_addr_t addr, bd_addr_type_t addr_type){ 58254f3229d8S[email protected] hci_connection_t * conn = hci_connection_for_bd_addr_and_type(addr, addr_type); 58264f3229d8S[email protected] if (!conn){ 5827d32b3f05SMatthias Ringwald // disallow if le connection is already outgoing 5828d32b3f05SMatthias Ringwald if (hci_is_le_connection_type(addr_type) && hci_stack->le_connecting_request != LE_CONNECTING_IDLE){ 5829d32b3f05SMatthias Ringwald log_error("le connection already active"); 5830d32b3f05SMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 5831d32b3f05SMatthias Ringwald } 5832d32b3f05SMatthias Ringwald 5833d8e8f12aSMatthias Ringwald log_info("gap_connect: no connection exists yet, creating context"); 58342e77e513S[email protected] conn = create_connection_for_bd_addr_and_type(addr, addr_type); 58354f3229d8S[email protected] if (!conn){ 58364f3229d8S[email protected] // notify client that alloc failed 58376e2e9a6bS[email protected] hci_emit_le_connection_complete(addr_type, addr, 0, BTSTACK_MEMORY_ALLOC_FAILED); 5838d8e8f12aSMatthias Ringwald log_info("gap_connect: failed to alloc hci_connection_t"); 5839472a5742SMatthias Ringwald return GATT_CLIENT_NOT_CONNECTED; // don't sent packet to controller 58404f3229d8S[email protected] } 5841d5b1a89eSMatthias Ringwald 5842d5b1a89eSMatthias Ringwald // set le connecting state 5843d5b1a89eSMatthias Ringwald if (hci_is_le_connection_type(addr_type)){ 5844d5b1a89eSMatthias Ringwald hci_stack->le_connecting_request = LE_CONNECTING_DIRECT; 5845d5b1a89eSMatthias Ringwald } 5846d5b1a89eSMatthias Ringwald 58474f3229d8S[email protected] conn->state = SEND_CREATE_CONNECTION; 5848d8e8f12aSMatthias Ringwald log_info("gap_connect: send create connection next"); 5849564fca32S[email protected] hci_run(); 5850b0136355SMatthias Ringwald return ERROR_CODE_SUCCESS; 58514f3229d8S[email protected] } 58520bf6344aS[email protected] 58530bf6344aS[email protected] if (!hci_is_le_connection(conn) || 5854a1df452eSMatthias Ringwald (conn->state == SEND_CREATE_CONNECTION) || 58550e588213SMatthias Ringwald (conn->state == SENT_CREATE_CONNECTION)) { 58562e77e513S[email protected] hci_emit_le_connection_complete(conn->address_type, conn->address, 0, ERROR_CODE_COMMAND_DISALLOWED); 5857d8e8f12aSMatthias Ringwald log_error("gap_connect: classic connection or connect is already being created"); 5858616edd56SMatthias Ringwald return GATT_CLIENT_IN_WRONG_STATE; 58590bf6344aS[email protected] } 58600bf6344aS[email protected] 5861b0136355SMatthias Ringwald // check if connection was just disconnected 5862b0136355SMatthias Ringwald if (conn->state == RECEIVED_DISCONNECTION_COMPLETE){ 5863b0136355SMatthias Ringwald log_info("gap_connect: send create connection (again)"); 5864b0136355SMatthias Ringwald conn->state = SEND_CREATE_CONNECTION; 5865b0136355SMatthias Ringwald hci_run(); 5866b0136355SMatthias Ringwald return ERROR_CODE_SUCCESS; 5867b0136355SMatthias Ringwald } 5868b0136355SMatthias Ringwald 5869d8e8f12aSMatthias Ringwald log_info("gap_connect: context exists with state %u", conn->state); 5870d5b1a89eSMatthias Ringwald hci_emit_le_connection_complete(conn->address_type, conn->address, conn->con_handle, ERROR_CODE_SUCCESS); 58714f3229d8S[email protected] hci_run(); 5872b0136355SMatthias Ringwald return ERROR_CODE_SUCCESS; 58734f3229d8S[email protected] } 58744f3229d8S[email protected] 58757851196eSmatthias.ringwald // @assumption: only a single outgoing LE Connection exists 5876d8e8f12aSMatthias Ringwald static hci_connection_t * gap_get_outgoing_connection(void){ 5877665d90f2SMatthias Ringwald btstack_linked_item_t *it; 5878a0da043fSMatthias Ringwald for (it = (btstack_linked_item_t *) hci_stack->connections; it != NULL; it = it->next){ 58790bf6344aS[email protected] hci_connection_t * conn = (hci_connection_t *) it; 58800bf6344aS[email protected] if (!hci_is_le_connection(conn)) continue; 58810bf6344aS[email protected] switch (conn->state){ 5882a6725849S[email protected] case SEND_CREATE_CONNECTION: 58837851196eSmatthias.ringwald case SENT_CREATE_CONNECTION: 58849c77c9dbSMatthias Ringwald case SENT_CANCEL_CONNECTION: 58857851196eSmatthias.ringwald return conn; 58867851196eSmatthias.ringwald default: 58877851196eSmatthias.ringwald break; 58887851196eSmatthias.ringwald }; 58897851196eSmatthias.ringwald } 58907851196eSmatthias.ringwald return NULL; 58917851196eSmatthias.ringwald } 58927851196eSmatthias.ringwald 5893d8e8f12aSMatthias Ringwald uint8_t gap_connect_cancel(void){ 5894d8e8f12aSMatthias Ringwald hci_connection_t * conn = gap_get_outgoing_connection(); 5895616edd56SMatthias Ringwald if (!conn) return 0; 58967851196eSmatthias.ringwald switch (conn->state){ 58977851196eSmatthias.ringwald case SEND_CREATE_CONNECTION: 58987851196eSmatthias.ringwald // skip sending create connection and emit event instead 589910f8f469SMatthias Ringwald hci_stack->le_connecting_request = LE_CONNECTING_IDLE; 59002e77e513S[email protected] hci_emit_le_connection_complete(conn->address_type, conn->address, 0, ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER); 5901665d90f2SMatthias Ringwald btstack_linked_list_remove(&hci_stack->connections, (btstack_linked_item_t *) conn); 59027851196eSmatthias.ringwald btstack_memory_hci_connection_free( conn ); 59030bf6344aS[email protected] break; 5904a6725849S[email protected] case SENT_CREATE_CONNECTION: 59057851196eSmatthias.ringwald // request to send cancel connection 59060bf6344aS[email protected] conn->state = SEND_CANCEL_CONNECTION; 59070bf6344aS[email protected] hci_run(); 59080bf6344aS[email protected] break; 59090bf6344aS[email protected] default: 59100bf6344aS[email protected] break; 59110bf6344aS[email protected] } 5912616edd56SMatthias Ringwald return 0; 5913e31f89a7S[email protected] } 5914d70217a2SMatthias Ringwald #endif 59154f3229d8S[email protected] 591613e645d2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 5917c37a3166S[email protected] /** 59186012052bSMatthias Ringwald * @brief Set connection parameters for outgoing connections 5919cbe54ab2SJakob Krantz * @param conn_scan_interval (unit: 0.625 msec), default: 60 ms 5920cbe54ab2SJakob Krantz * @param conn_scan_window (unit: 0.625 msec), default: 30 ms 59216012052bSMatthias Ringwald * @param conn_interval_min (unit: 1.25ms), default: 10 ms 59226012052bSMatthias Ringwald * @param conn_interval_max (unit: 1.25ms), default: 30 ms 59236012052bSMatthias Ringwald * @param conn_latency, default: 4 59246012052bSMatthias Ringwald * @param supervision_timeout (unit: 10ms), default: 720 ms 59256012052bSMatthias Ringwald * @param min_ce_length (unit: 0.625ms), default: 10 ms 59266012052bSMatthias Ringwald * @param max_ce_length (unit: 0.625ms), default: 30 ms 59276012052bSMatthias Ringwald */ 59286012052bSMatthias Ringwald 5929cbe54ab2SJakob Krantz void gap_set_connection_parameters(uint16_t conn_scan_interval, uint16_t conn_scan_window, 5930cbe54ab2SJakob Krantz uint16_t conn_interval_min, uint16_t conn_interval_max, uint16_t conn_latency, 5931cbe54ab2SJakob Krantz uint16_t supervision_timeout, uint16_t min_ce_length, uint16_t max_ce_length){ 5932cbe54ab2SJakob Krantz hci_stack->le_connection_scan_interval = conn_scan_interval; 5933cbe54ab2SJakob Krantz hci_stack->le_connection_scan_window = conn_scan_window; 59346012052bSMatthias Ringwald hci_stack->le_connection_interval_min = conn_interval_min; 59356012052bSMatthias Ringwald hci_stack->le_connection_interval_max = conn_interval_max; 59366012052bSMatthias Ringwald hci_stack->le_connection_latency = conn_latency; 59376012052bSMatthias Ringwald hci_stack->le_supervision_timeout = supervision_timeout; 59386012052bSMatthias Ringwald hci_stack->le_minimum_ce_length = min_ce_length; 59396012052bSMatthias Ringwald hci_stack->le_maximum_ce_length = max_ce_length; 59406012052bSMatthias Ringwald } 594113e645d2SMatthias Ringwald #endif 59426012052bSMatthias Ringwald 59436012052bSMatthias Ringwald /** 5944c37a3166S[email protected] * @brief Updates the connection parameters for a given LE connection 5945c37a3166S[email protected] * @param handle 5946c37a3166S[email protected] * @param conn_interval_min (unit: 1.25ms) 5947c37a3166S[email protected] * @param conn_interval_max (unit: 1.25ms) 5948c37a3166S[email protected] * @param conn_latency 5949c37a3166S[email protected] * @param supervision_timeout (unit: 10ms) 5950c37a3166S[email protected] * @returns 0 if ok 5951c37a3166S[email protected] */ 5952c37a3166S[email protected] int gap_update_connection_parameters(hci_con_handle_t con_handle, uint16_t conn_interval_min, 5953c37a3166S[email protected] uint16_t conn_interval_max, uint16_t conn_latency, uint16_t supervision_timeout){ 5954c37a3166S[email protected] hci_connection_t * connection = hci_connection_for_handle(con_handle); 5955c37a3166S[email protected] if (!connection) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 5956c37a3166S[email protected] connection->le_conn_interval_min = conn_interval_min; 5957c37a3166S[email protected] connection->le_conn_interval_max = conn_interval_max; 5958c37a3166S[email protected] connection->le_conn_latency = conn_latency; 5959c37a3166S[email protected] connection->le_supervision_timeout = supervision_timeout; 596084cf6d83SMatthias Ringwald connection->le_con_parameter_update_state = CON_PARAMETER_UPDATE_CHANGE_HCI_CON_PARAMETERS; 5961cfc59f1bSMatthias Ringwald hci_run(); 5962c37a3166S[email protected] return 0; 5963c37a3166S[email protected] } 5964c37a3166S[email protected] 596545c102fdSMatthias Ringwald /** 5966b68d7bc3SMatthias Ringwald * @brief Request an update of the connection parameter for a given LE connection 5967b68d7bc3SMatthias Ringwald * @param handle 5968b68d7bc3SMatthias Ringwald * @param conn_interval_min (unit: 1.25ms) 5969b68d7bc3SMatthias Ringwald * @param conn_interval_max (unit: 1.25ms) 5970b68d7bc3SMatthias Ringwald * @param conn_latency 5971b68d7bc3SMatthias Ringwald * @param supervision_timeout (unit: 10ms) 5972b68d7bc3SMatthias Ringwald * @returns 0 if ok 5973b68d7bc3SMatthias Ringwald */ 5974b68d7bc3SMatthias Ringwald int gap_request_connection_parameter_update(hci_con_handle_t con_handle, uint16_t conn_interval_min, 5975b68d7bc3SMatthias Ringwald uint16_t conn_interval_max, uint16_t conn_latency, uint16_t supervision_timeout){ 5976b68d7bc3SMatthias Ringwald hci_connection_t * connection = hci_connection_for_handle(con_handle); 5977b68d7bc3SMatthias Ringwald if (!connection) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 5978b68d7bc3SMatthias Ringwald connection->le_conn_interval_min = conn_interval_min; 5979b68d7bc3SMatthias Ringwald connection->le_conn_interval_max = conn_interval_max; 5980b68d7bc3SMatthias Ringwald connection->le_conn_latency = conn_latency; 5981b68d7bc3SMatthias Ringwald connection->le_supervision_timeout = supervision_timeout; 5982b68d7bc3SMatthias Ringwald connection->le_con_parameter_update_state = CON_PARAMETER_UPDATE_SEND_REQUEST; 598309c9c963SMatthias Ringwald uint8_t l2cap_trigger_run_event[2] = { L2CAP_EVENT_TRIGGER_RUN, 0}; 598409c9c963SMatthias Ringwald hci_emit_event(l2cap_trigger_run_event, sizeof(l2cap_trigger_run_event), 0); 5985b68d7bc3SMatthias Ringwald return 0; 5986b68d7bc3SMatthias Ringwald } 5987b68d7bc3SMatthias Ringwald 5988d70217a2SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 5989d70217a2SMatthias Ringwald 5990b68d7bc3SMatthias Ringwald /** 599145c102fdSMatthias Ringwald * @brief Set Advertisement Data 599245c102fdSMatthias Ringwald * @param advertising_data_length 599345c102fdSMatthias Ringwald * @param advertising_data (max 31 octets) 599445c102fdSMatthias Ringwald * @note data is not copied, pointer has to stay valid 599545c102fdSMatthias Ringwald */ 599645c102fdSMatthias Ringwald void gap_advertisements_set_data(uint8_t advertising_data_length, uint8_t * advertising_data){ 599745c102fdSMatthias Ringwald hci_stack->le_advertisements_data_len = advertising_data_length; 599845c102fdSMatthias Ringwald hci_stack->le_advertisements_data = advertising_data; 5999501f56b3SMatthias Ringwald hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_SET_ADV_DATA; 6000bbc366e6SMatthias Ringwald hci_run(); 600145c102fdSMatthias Ringwald } 6002501f56b3SMatthias Ringwald 6003501f56b3SMatthias Ringwald /** 6004501f56b3SMatthias Ringwald * @brief Set Scan Response Data 6005501f56b3SMatthias Ringwald * @param advertising_data_length 6006501f56b3SMatthias Ringwald * @param advertising_data (max 31 octets) 6007501f56b3SMatthias Ringwald * @note data is not copied, pointer has to stay valid 6008501f56b3SMatthias Ringwald */ 6009501f56b3SMatthias Ringwald void gap_scan_response_set_data(uint8_t scan_response_data_length, uint8_t * scan_response_data){ 6010501f56b3SMatthias Ringwald hci_stack->le_scan_response_data_len = scan_response_data_length; 6011501f56b3SMatthias Ringwald hci_stack->le_scan_response_data = scan_response_data; 6012501f56b3SMatthias Ringwald hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_SET_SCAN_DATA; 6013bbc366e6SMatthias Ringwald hci_run(); 601445c102fdSMatthias Ringwald } 601545c102fdSMatthias Ringwald 601645c102fdSMatthias Ringwald /** 601745c102fdSMatthias Ringwald * @brief Set Advertisement Parameters 601845c102fdSMatthias Ringwald * @param adv_int_min 601945c102fdSMatthias Ringwald * @param adv_int_max 602045c102fdSMatthias Ringwald * @param adv_type 602145c102fdSMatthias Ringwald * @param direct_address_type 602245c102fdSMatthias Ringwald * @param direct_address 602345c102fdSMatthias Ringwald * @param channel_map 602445c102fdSMatthias Ringwald * @param filter_policy 602545c102fdSMatthias Ringwald * 602645c102fdSMatthias Ringwald * @note internal use. use gap_advertisements_set_params from gap_le.h instead. 602745c102fdSMatthias Ringwald */ 602845c102fdSMatthias Ringwald void hci_le_advertisements_set_params(uint16_t adv_int_min, uint16_t adv_int_max, uint8_t adv_type, 6029b95a5a35SMatthias Ringwald uint8_t direct_address_typ, bd_addr_t direct_address, 603045c102fdSMatthias Ringwald uint8_t channel_map, uint8_t filter_policy) { 603145c102fdSMatthias Ringwald 603245c102fdSMatthias Ringwald hci_stack->le_advertisements_interval_min = adv_int_min; 603345c102fdSMatthias Ringwald hci_stack->le_advertisements_interval_max = adv_int_max; 603445c102fdSMatthias Ringwald hci_stack->le_advertisements_type = adv_type; 603545c102fdSMatthias Ringwald hci_stack->le_advertisements_direct_address_type = direct_address_typ; 603645c102fdSMatthias Ringwald hci_stack->le_advertisements_channel_map = channel_map; 603745c102fdSMatthias Ringwald hci_stack->le_advertisements_filter_policy = filter_policy; 60386535961aSMatthias Ringwald (void)memcpy(hci_stack->le_advertisements_direct_address, direct_address, 60396535961aSMatthias Ringwald 6); 604045c102fdSMatthias Ringwald 6041a61834b6SMatthias Ringwald hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_SET_PARAMS | LE_ADVERTISEMENT_TASKS_PARAMS_SET; 6042bbc366e6SMatthias Ringwald hci_run(); 604345c102fdSMatthias Ringwald } 604445c102fdSMatthias Ringwald 604545c102fdSMatthias Ringwald /** 604645c102fdSMatthias Ringwald * @brief Enable/Disable Advertisements 604745c102fdSMatthias Ringwald * @param enabled 604845c102fdSMatthias Ringwald */ 604945c102fdSMatthias Ringwald void gap_advertisements_enable(int enabled){ 60505226d7f2SMatthias Ringwald hci_stack->le_advertisements_enabled = enabled != 0; 6051bbc366e6SMatthias Ringwald hci_update_advertisements_enabled_for_current_roles(); 6052cfc59f1bSMatthias Ringwald hci_run(); 605345c102fdSMatthias Ringwald } 605445c102fdSMatthias Ringwald 605535454696SMatthias Ringwald #endif 605606e5cf96SMatthias Ringwald 605706e5cf96SMatthias Ringwald void hci_le_set_own_address_type(uint8_t own_address_type){ 605806e5cf96SMatthias Ringwald log_info("hci_le_set_own_address_type: old %u, new %u", hci_stack->le_own_addr_type, own_address_type); 605906e5cf96SMatthias Ringwald if (own_address_type == hci_stack->le_own_addr_type) return; 606006e5cf96SMatthias Ringwald hci_stack->le_own_addr_type = own_address_type; 606106e5cf96SMatthias Ringwald 606264068776SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 606306e5cf96SMatthias Ringwald // update advertisement parameters, too 606406e5cf96SMatthias Ringwald hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_SET_PARAMS; 6065bbc366e6SMatthias Ringwald hci_run(); 606664068776SMatthias Ringwald #endif 606764068776SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 606806e5cf96SMatthias Ringwald // note: we don't update scan parameters or modify ongoing connection attempts 606964068776SMatthias Ringwald #endif 607006e5cf96SMatthias Ringwald } 607106e5cf96SMatthias Ringwald 6072d70217a2SMatthias Ringwald #endif 607345c102fdSMatthias Ringwald 6074616edd56SMatthias Ringwald uint8_t gap_disconnect(hci_con_handle_t handle){ 60755917a5c5S[email protected] hci_connection_t * conn = hci_connection_for_handle(handle); 60765917a5c5S[email protected] if (!conn){ 60777851196eSmatthias.ringwald hci_emit_disconnection_complete(handle, 0); 6078616edd56SMatthias Ringwald return 0; 60795917a5c5S[email protected] } 60807fd7aa6fSMatthias Ringwald // ignore if already disconnected 60817fd7aa6fSMatthias Ringwald if (conn->state == RECEIVED_DISCONNECTION_COMPLETE){ 60827fd7aa6fSMatthias Ringwald return 0; 60837fd7aa6fSMatthias Ringwald } 60845917a5c5S[email protected] conn->state = SEND_DISCONNECT; 60855917a5c5S[email protected] hci_run(); 6086616edd56SMatthias Ringwald return 0; 60874f3229d8S[email protected] } 608804a6ef8cSmatthias.ringwald 6089228e430cSMatthias Ringwald int gap_read_rssi(hci_con_handle_t con_handle){ 6090228e430cSMatthias Ringwald hci_connection_t * hci_connection = hci_connection_for_handle(con_handle); 6091228e430cSMatthias Ringwald if (hci_connection == NULL) return 0; 60928daf94bcSMatthias Ringwald connectionSetAuthenticationFlags(hci_connection, AUTH_FLAG_READ_RSSI); 6093228e430cSMatthias Ringwald hci_run(); 6094228e430cSMatthias Ringwald return 1; 6095228e430cSMatthias Ringwald } 6096228e430cSMatthias Ringwald 6097a1bf5ae7SMatthias Ringwald /** 6098a1bf5ae7SMatthias Ringwald * @brief Get connection type 6099a1bf5ae7SMatthias Ringwald * @param con_handle 6100a1bf5ae7SMatthias Ringwald * @result connection_type 6101a1bf5ae7SMatthias Ringwald */ 6102a1bf5ae7SMatthias Ringwald gap_connection_type_t gap_get_connection_type(hci_con_handle_t connection_handle){ 6103a1bf5ae7SMatthias Ringwald hci_connection_t * conn = hci_connection_for_handle(connection_handle); 6104a1bf5ae7SMatthias Ringwald if (!conn) return GAP_CONNECTION_INVALID; 6105a1bf5ae7SMatthias Ringwald switch (conn->address_type){ 6106a1bf5ae7SMatthias Ringwald case BD_ADDR_TYPE_LE_PUBLIC: 6107a1bf5ae7SMatthias Ringwald case BD_ADDR_TYPE_LE_RANDOM: 6108a1bf5ae7SMatthias Ringwald return GAP_CONNECTION_LE; 6109a1bf5ae7SMatthias Ringwald case BD_ADDR_TYPE_SCO: 6110a1bf5ae7SMatthias Ringwald return GAP_CONNECTION_SCO; 6111f16129ceSMatthias Ringwald case BD_ADDR_TYPE_ACL: 6112a1bf5ae7SMatthias Ringwald return GAP_CONNECTION_ACL; 6113a1bf5ae7SMatthias Ringwald default: 6114a1bf5ae7SMatthias Ringwald return GAP_CONNECTION_INVALID; 6115a1bf5ae7SMatthias Ringwald } 6116a1bf5ae7SMatthias Ringwald } 6117a1bf5ae7SMatthias Ringwald 61182dceb1d6SMatthias Ringwald hci_role_t gap_get_role(hci_con_handle_t connection_handle){ 61192dceb1d6SMatthias Ringwald hci_connection_t * conn = hci_connection_for_handle(connection_handle); 61202dceb1d6SMatthias Ringwald if (!conn) return HCI_ROLE_INVALID; 61212dceb1d6SMatthias Ringwald return (hci_role_t) conn->role; 61222dceb1d6SMatthias Ringwald } 61232dceb1d6SMatthias Ringwald 61242dceb1d6SMatthias Ringwald 612544f858f3SMatthias Ringwald #ifdef ENABLE_CLASSIC 6126667ba9d1SMatthias Ringwald uint8_t gap_request_role(const bd_addr_t addr, hci_role_t role){ 612788a03c8dSMatthias Ringwald hci_connection_t * conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL); 612888a03c8dSMatthias Ringwald if (!conn) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 612988a03c8dSMatthias Ringwald conn->request_role = role; 613088a03c8dSMatthias Ringwald hci_run(); 6131d04a455eSMatthias Ringwald return ERROR_CODE_SUCCESS; 613288a03c8dSMatthias Ringwald } 613344f858f3SMatthias Ringwald #endif 613488a03c8dSMatthias Ringwald 6135a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE 61364f551432SMatthias Ringwald 6137b45b7749SMilanka Ringwald uint8_t gap_le_set_phy(hci_con_handle_t con_handle, uint8_t all_phys, uint8_t tx_phys, uint8_t rx_phys, uint8_t phy_options){ 6138b45b7749SMilanka Ringwald hci_connection_t * conn = hci_connection_for_handle(con_handle); 6139b90f6e0aSMatthias Ringwald if (!conn) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 6140b90f6e0aSMatthias Ringwald 6141b90f6e0aSMatthias Ringwald conn->le_phy_update_all_phys = all_phys; 6142b90f6e0aSMatthias Ringwald conn->le_phy_update_tx_phys = tx_phys; 6143b90f6e0aSMatthias Ringwald conn->le_phy_update_rx_phys = rx_phys; 6144b90f6e0aSMatthias Ringwald conn->le_phy_update_phy_options = phy_options; 6145b90f6e0aSMatthias Ringwald 6146b90f6e0aSMatthias Ringwald hci_run(); 6147b90f6e0aSMatthias Ringwald 6148b90f6e0aSMatthias Ringwald return 0; 6149b90f6e0aSMatthias Ringwald } 6150b90f6e0aSMatthias Ringwald 6151667ba9d1SMatthias Ringwald static uint8_t hci_whitelist_add(bd_addr_type_t address_type, const bd_addr_t address){ 61527a92a9dbSMatthias Ringwald // check if already in list 61537a92a9dbSMatthias Ringwald btstack_linked_list_iterator_t it; 61547a92a9dbSMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->le_whitelist); 61557a92a9dbSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)) { 61567a92a9dbSMatthias Ringwald whitelist_entry_t *entry = (whitelist_entry_t *) btstack_linked_list_iterator_next(&it); 61577a92a9dbSMatthias Ringwald if (entry->address_type != address_type) { 61587a92a9dbSMatthias Ringwald continue; 61597a92a9dbSMatthias Ringwald } 61607a92a9dbSMatthias Ringwald if (memcmp(entry->address, address, 6) != 0) { 61617a92a9dbSMatthias Ringwald continue; 61627a92a9dbSMatthias Ringwald } 6163287379ccSMatthias Ringwald // disallow if already scheduled to add 6164287379ccSMatthias Ringwald if ((entry->state & LE_WHITELIST_ADD_TO_CONTROLLER) != 0){ 61657a92a9dbSMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 61667a92a9dbSMatthias Ringwald } 6167287379ccSMatthias Ringwald // still on controller, but scheduled to remove -> re-add 6168287379ccSMatthias Ringwald entry->state |= LE_WHITELIST_ADD_TO_CONTROLLER; 6169287379ccSMatthias Ringwald return ERROR_CODE_SUCCESS; 6170287379ccSMatthias Ringwald } 61717a92a9dbSMatthias Ringwald // alloc and add to list 6172e83201bcSMatthias Ringwald whitelist_entry_t * entry = btstack_memory_whitelist_entry_get(); 6173e83201bcSMatthias Ringwald if (!entry) return BTSTACK_MEMORY_ALLOC_FAILED; 6174e83201bcSMatthias Ringwald entry->address_type = address_type; 61756535961aSMatthias Ringwald (void)memcpy(entry->address, address, 6); 6176e83201bcSMatthias Ringwald entry->state = LE_WHITELIST_ADD_TO_CONTROLLER; 6177665d90f2SMatthias Ringwald btstack_linked_list_add(&hci_stack->le_whitelist, (btstack_linked_item_t*) entry); 6178226db5efSMatthias Ringwald return ERROR_CODE_SUCCESS; 6179ac9c45e0SMatthias Ringwald } 6180ac9c45e0SMatthias Ringwald 6181667ba9d1SMatthias Ringwald static uint8_t hci_whitelist_remove(bd_addr_type_t address_type, const bd_addr_t address){ 6182665d90f2SMatthias Ringwald btstack_linked_list_iterator_t it; 6183665d90f2SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->le_whitelist); 6184665d90f2SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 6185665d90f2SMatthias Ringwald whitelist_entry_t * entry = (whitelist_entry_t*) btstack_linked_list_iterator_next(&it); 61867a92a9dbSMatthias Ringwald if (entry->address_type != address_type) { 61877a92a9dbSMatthias Ringwald continue; 61887a92a9dbSMatthias Ringwald } 61897a92a9dbSMatthias Ringwald if (memcmp(entry->address, address, 6) != 0) { 61907a92a9dbSMatthias Ringwald continue; 61917a92a9dbSMatthias Ringwald } 6192e83201bcSMatthias Ringwald if (entry->state & LE_WHITELIST_ON_CONTROLLER){ 6193e83201bcSMatthias Ringwald // remove from controller if already present 6194e83201bcSMatthias Ringwald entry->state |= LE_WHITELIST_REMOVE_FROM_CONTROLLER; 6195a3b69fdeSMatthias Ringwald } else { 6196226db5efSMatthias Ringwald // directly remove entry from whitelist 6197665d90f2SMatthias Ringwald btstack_linked_list_iterator_remove(&it); 6198e83201bcSMatthias Ringwald btstack_memory_whitelist_entry_free(entry); 6199e83201bcSMatthias Ringwald } 6200a3b69fdeSMatthias Ringwald return ERROR_CODE_SUCCESS; 6201a3b69fdeSMatthias Ringwald } 6202a3b69fdeSMatthias Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 620342ff5ba1SMatthias Ringwald } 620442ff5ba1SMatthias Ringwald 6205226db5efSMatthias Ringwald static void hci_whitelist_clear(void){ 6206665d90f2SMatthias Ringwald btstack_linked_list_iterator_t it; 6207665d90f2SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->le_whitelist); 6208665d90f2SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 6209665d90f2SMatthias Ringwald whitelist_entry_t * entry = (whitelist_entry_t*) btstack_linked_list_iterator_next(&it); 6210e83201bcSMatthias Ringwald if (entry->state & LE_WHITELIST_ON_CONTROLLER){ 6211e83201bcSMatthias Ringwald // remove from controller if already present 6212e83201bcSMatthias Ringwald entry->state |= LE_WHITELIST_REMOVE_FROM_CONTROLLER; 6213e83201bcSMatthias Ringwald continue; 6214e83201bcSMatthias Ringwald } 621591915b0bSMatthias Ringwald // directly remove entry from whitelist 6216665d90f2SMatthias Ringwald btstack_linked_list_iterator_remove(&it); 6217e83201bcSMatthias Ringwald btstack_memory_whitelist_entry_free(entry); 6218e83201bcSMatthias Ringwald } 6219226db5efSMatthias Ringwald } 6220226db5efSMatthias Ringwald 6221a3b69fdeSMatthias Ringwald /** 6222a3b69fdeSMatthias Ringwald * @brief Clear Whitelist 6223a3b69fdeSMatthias Ringwald * @returns 0 if ok 6224a3b69fdeSMatthias Ringwald */ 6225a3b69fdeSMatthias Ringwald uint8_t gap_whitelist_clear(void){ 6226a3b69fdeSMatthias Ringwald hci_whitelist_clear(); 6227a3b69fdeSMatthias Ringwald hci_run(); 6228a3b69fdeSMatthias Ringwald return ERROR_CODE_SUCCESS; 6229a3b69fdeSMatthias Ringwald } 6230a3b69fdeSMatthias Ringwald 6231a3b69fdeSMatthias Ringwald /** 6232a3b69fdeSMatthias Ringwald * @brief Add Device to Whitelist 6233a3b69fdeSMatthias Ringwald * @param address_typ 6234a3b69fdeSMatthias Ringwald * @param address 6235a3b69fdeSMatthias Ringwald * @returns 0 if ok 6236a3b69fdeSMatthias Ringwald */ 6237667ba9d1SMatthias Ringwald uint8_t gap_whitelist_add(bd_addr_type_t address_type, const bd_addr_t address){ 6238a3b69fdeSMatthias Ringwald uint8_t status = hci_whitelist_add(address_type, address); 6239a3b69fdeSMatthias Ringwald if (status){ 6240a3b69fdeSMatthias Ringwald return status; 6241a3b69fdeSMatthias Ringwald } 6242a3b69fdeSMatthias Ringwald hci_run(); 6243a3b69fdeSMatthias Ringwald return ERROR_CODE_SUCCESS; 6244a3b69fdeSMatthias Ringwald } 6245a3b69fdeSMatthias Ringwald 6246a3b69fdeSMatthias Ringwald /** 6247a3b69fdeSMatthias Ringwald * @brief Remove Device from Whitelist 6248a3b69fdeSMatthias Ringwald * @param address_typ 6249a3b69fdeSMatthias Ringwald * @param address 6250a3b69fdeSMatthias Ringwald * @returns 0 if ok 6251a3b69fdeSMatthias Ringwald */ 6252667ba9d1SMatthias Ringwald uint8_t gap_whitelist_remove(bd_addr_type_t address_type, const bd_addr_t address){ 6253a3b69fdeSMatthias Ringwald uint8_t status = hci_whitelist_remove(address_type, address); 6254a3b69fdeSMatthias Ringwald if (status){ 6255a3b69fdeSMatthias Ringwald return status; 6256a3b69fdeSMatthias Ringwald } 6257a3b69fdeSMatthias Ringwald hci_run(); 6258a3b69fdeSMatthias Ringwald return ERROR_CODE_SUCCESS; 6259a3b69fdeSMatthias Ringwald } 6260a3b69fdeSMatthias Ringwald 6261226db5efSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 6262226db5efSMatthias Ringwald /** 626395e257d9SMatthias Ringwald * @brief Connect with Whitelist 626495e257d9SMatthias Ringwald * @note Explicit whitelist management and this connect with whitelist replace deprecated gap_auto_connection_* functions 626595e257d9SMatthias Ringwald * @returns - if ok 626695e257d9SMatthias Ringwald */ 626795e257d9SMatthias Ringwald uint8_t gap_connect_with_whitelist(void){ 626895e257d9SMatthias Ringwald if (hci_stack->le_connecting_request != LE_CONNECTING_IDLE){ 626995e257d9SMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 627095e257d9SMatthias Ringwald } 627195e257d9SMatthias Ringwald hci_stack->le_connecting_request = LE_CONNECTING_WHITELIST; 627295e257d9SMatthias Ringwald hci_run(); 627395e257d9SMatthias Ringwald return ERROR_CODE_SUCCESS; 627495e257d9SMatthias Ringwald } 627595e257d9SMatthias Ringwald 627695e257d9SMatthias Ringwald /** 6277226db5efSMatthias Ringwald * @brief Auto Connection Establishment - Start Connecting to device 6278226db5efSMatthias Ringwald * @param address_typ 6279226db5efSMatthias Ringwald * @param address 6280226db5efSMatthias Ringwald * @returns 0 if ok 6281226db5efSMatthias Ringwald */ 6282667ba9d1SMatthias Ringwald uint8_t gap_auto_connection_start(bd_addr_type_t address_type, const bd_addr_t address){ 628395e257d9SMatthias Ringwald if (hci_stack->le_connecting_request == LE_CONNECTING_DIRECT){ 6284226db5efSMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 6285226db5efSMatthias Ringwald } 6286226db5efSMatthias Ringwald 6287226db5efSMatthias Ringwald uint8_t status = hci_whitelist_add(address_type, address); 628863f2efc9SMatthias Ringwald if (status == BTSTACK_MEMORY_ALLOC_FAILED) { 6289226db5efSMatthias Ringwald return status; 6290226db5efSMatthias Ringwald } 6291226db5efSMatthias Ringwald 6292226db5efSMatthias Ringwald hci_stack->le_connecting_request = LE_CONNECTING_WHITELIST; 6293226db5efSMatthias Ringwald 6294226db5efSMatthias Ringwald hci_run(); 629595e257d9SMatthias Ringwald return ERROR_CODE_SUCCESS; 6296226db5efSMatthias Ringwald } 6297226db5efSMatthias Ringwald 6298226db5efSMatthias Ringwald /** 6299226db5efSMatthias Ringwald * @brief Auto Connection Establishment - Stop Connecting to device 6300226db5efSMatthias Ringwald * @param address_typ 6301226db5efSMatthias Ringwald * @param address 6302226db5efSMatthias Ringwald * @returns 0 if ok 6303226db5efSMatthias Ringwald */ 6304667ba9d1SMatthias Ringwald uint8_t gap_auto_connection_stop(bd_addr_type_t address_type, const bd_addr_t address){ 630595e257d9SMatthias Ringwald if (hci_stack->le_connecting_request == LE_CONNECTING_DIRECT){ 630695e257d9SMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 630795e257d9SMatthias Ringwald } 630895e257d9SMatthias Ringwald 6309226db5efSMatthias Ringwald hci_whitelist_remove(address_type, address); 631095e257d9SMatthias Ringwald if (btstack_linked_list_empty(&hci_stack->le_whitelist)){ 631195e257d9SMatthias Ringwald hci_stack->le_connecting_request = LE_CONNECTING_IDLE; 631295e257d9SMatthias Ringwald } 6313226db5efSMatthias Ringwald hci_run(); 6314226db5efSMatthias Ringwald return 0; 6315226db5efSMatthias Ringwald } 6316226db5efSMatthias Ringwald 6317226db5efSMatthias Ringwald /** 6318226db5efSMatthias Ringwald * @brief Auto Connection Establishment - Stop everything 6319226db5efSMatthias Ringwald * @note Convenience function to stop all active auto connection attempts 6320226db5efSMatthias Ringwald */ 632195e257d9SMatthias Ringwald uint8_t gap_auto_connection_stop_all(void){ 632295e257d9SMatthias Ringwald if (hci_stack->le_connecting_request == LE_CONNECTING_DIRECT) { 632395e257d9SMatthias Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 632495e257d9SMatthias Ringwald } 6325226db5efSMatthias Ringwald hci_whitelist_clear(); 6326226db5efSMatthias Ringwald hci_stack->le_connecting_request = LE_CONNECTING_IDLE; 6327e83201bcSMatthias Ringwald hci_run(); 632895e257d9SMatthias Ringwald return ERROR_CODE_SUCCESS; 6329ac9c45e0SMatthias Ringwald } 6330c9db5c21SMilanka Ringwald 6331b45b7749SMilanka Ringwald uint16_t gap_le_connection_interval(hci_con_handle_t con_handle){ 6332b45b7749SMilanka Ringwald hci_connection_t * conn = hci_connection_for_handle(con_handle); 6333c9db5c21SMilanka Ringwald if (!conn) return 0; 6334c9db5c21SMilanka Ringwald return conn->le_connection_interval; 6335c9db5c21SMilanka Ringwald } 6336d70217a2SMatthias Ringwald #endif 63374f551432SMatthias Ringwald #endif 63384f551432SMatthias Ringwald 633935454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 6340ac9c45e0SMatthias Ringwald /** 6341ff00ed1cSMatthias Ringwald * @brief Set Extended Inquiry Response data 6342a8c4e5adSMatthias Ringwald * @param eir_data size HCI_EXTENDED_INQUIRY_RESPONSE_DATA_LEN (240) bytes, is not copied make sure memory is accessible during stack startup 6343ff00ed1cSMatthias Ringwald * @note has to be done before stack starts up 6344ff00ed1cSMatthias Ringwald */ 6345ff00ed1cSMatthias Ringwald void gap_set_extended_inquiry_response(const uint8_t * data){ 6346ff00ed1cSMatthias Ringwald hci_stack->eir_data = data; 634759d59ecfSMatthias Ringwald hci_stack->gap_tasks |= GAP_TASK_SET_EIR_DATA; 634859d59ecfSMatthias Ringwald hci_run(); 6349ff00ed1cSMatthias Ringwald } 6350ff00ed1cSMatthias Ringwald 6351ff00ed1cSMatthias Ringwald /** 6352f5875de5SMatthias Ringwald * @brief Start GAP Classic Inquiry 6353f5875de5SMatthias Ringwald * @param duration in 1.28s units 6354f5875de5SMatthias Ringwald * @return 0 if ok 6355f5875de5SMatthias Ringwald * @events: GAP_EVENT_INQUIRY_RESULT, GAP_EVENT_INQUIRY_COMPLETE 6356f5875de5SMatthias Ringwald */ 6357f5875de5SMatthias Ringwald int gap_inquiry_start(uint8_t duration_in_1280ms_units){ 635899449554SMatthias Ringwald if (hci_stack->state != HCI_STATE_WORKING) return ERROR_CODE_COMMAND_DISALLOWED; 6359f5875de5SMatthias Ringwald if (hci_stack->inquiry_state != GAP_INQUIRY_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED; 6360a1df452eSMatthias Ringwald if ((duration_in_1280ms_units < GAP_INQUIRY_DURATION_MIN) || (duration_in_1280ms_units > GAP_INQUIRY_DURATION_MAX)){ 6361f5875de5SMatthias Ringwald return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS; 6362f5875de5SMatthias Ringwald } 6363f5875de5SMatthias Ringwald hci_stack->inquiry_state = duration_in_1280ms_units; 6364f5875de5SMatthias Ringwald hci_run(); 6365f5875de5SMatthias Ringwald return 0; 6366f5875de5SMatthias Ringwald } 6367f5875de5SMatthias Ringwald 6368f5875de5SMatthias Ringwald /** 6369f5875de5SMatthias Ringwald * @brief Stop GAP Classic Inquiry 6370f5875de5SMatthias Ringwald * @returns 0 if ok 6371f5875de5SMatthias Ringwald */ 6372f5875de5SMatthias Ringwald int gap_inquiry_stop(void){ 6373a1df452eSMatthias Ringwald if ((hci_stack->inquiry_state >= GAP_INQUIRY_DURATION_MIN) && (hci_stack->inquiry_state <= GAP_INQUIRY_DURATION_MAX)) { 6374f5875de5SMatthias Ringwald // emit inquiry complete event, before it even started 6375f5875de5SMatthias Ringwald uint8_t event[] = { GAP_EVENT_INQUIRY_COMPLETE, 1, 0}; 6376f5875de5SMatthias Ringwald hci_emit_event(event, sizeof(event), 1); 6377f5875de5SMatthias Ringwald return 0; 6378f5875de5SMatthias Ringwald } 6379f5875de5SMatthias Ringwald if (hci_stack->inquiry_state != GAP_INQUIRY_STATE_ACTIVE) return ERROR_CODE_COMMAND_DISALLOWED; 6380f5875de5SMatthias Ringwald hci_stack->inquiry_state = GAP_INQUIRY_STATE_W2_CANCEL; 6381f5875de5SMatthias Ringwald hci_run(); 6382f5875de5SMatthias Ringwald return 0; 6383f5875de5SMatthias Ringwald } 6384f5875de5SMatthias Ringwald 6385496bb884SMatthias Ringwald void gap_inquiry_set_lap(uint32_t lap){ 6386496bb884SMatthias Ringwald hci_stack->inquiry_lap = lap; 6387496bb884SMatthias Ringwald } 6388496bb884SMatthias Ringwald 6389b7f1ee76SMatthias Ringwald 6390b7f1ee76SMatthias Ringwald /** 6391b7f1ee76SMatthias Ringwald * @brief Remote Name Request 6392b7f1ee76SMatthias Ringwald * @param addr 6393b7f1ee76SMatthias Ringwald * @param page_scan_repetition_mode 6394b7f1ee76SMatthias Ringwald * @param clock_offset only used when bit 15 is set 6395b7f1ee76SMatthias Ringwald * @events: HCI_EVENT_REMOTE_NAME_REQUEST_COMPLETE 6396b7f1ee76SMatthias Ringwald */ 6397667ba9d1SMatthias Ringwald int gap_remote_name_request(const bd_addr_t addr, uint8_t page_scan_repetition_mode, uint16_t clock_offset){ 6398b7f1ee76SMatthias Ringwald if (hci_stack->remote_name_state != GAP_REMOTE_NAME_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED; 63996535961aSMatthias Ringwald (void)memcpy(hci_stack->remote_name_addr, addr, 6); 6400b7f1ee76SMatthias Ringwald hci_stack->remote_name_page_scan_repetition_mode = page_scan_repetition_mode; 6401b7f1ee76SMatthias Ringwald hci_stack->remote_name_clock_offset = clock_offset; 6402b7f1ee76SMatthias Ringwald hci_stack->remote_name_state = GAP_REMOTE_NAME_STATE_W2_SEND; 6403b7f1ee76SMatthias Ringwald hci_run(); 6404b7f1ee76SMatthias Ringwald return 0; 6405b7f1ee76SMatthias Ringwald } 6406b7f1ee76SMatthias Ringwald 6407667ba9d1SMatthias Ringwald static int gap_pairing_set_state_and_run(const bd_addr_t addr, uint8_t state){ 64080a51f88bSMatthias Ringwald hci_stack->gap_pairing_state = state; 64096535961aSMatthias Ringwald (void)memcpy(hci_stack->gap_pairing_addr, addr, 6); 64100a51f88bSMatthias Ringwald hci_run(); 64110a51f88bSMatthias Ringwald return 0; 64120a51f88bSMatthias Ringwald } 64130a51f88bSMatthias Ringwald 64140a51f88bSMatthias Ringwald /** 6415aad97216SMatthias Ringwald * @brief Legacy Pairing Pin Code Response for binary data / non-strings 6416aad97216SMatthias Ringwald * @param addr 6417aad97216SMatthias Ringwald * @param pin_data 6418aad97216SMatthias Ringwald * @param pin_len 6419aad97216SMatthias Ringwald * @return 0 if ok 6420aad97216SMatthias Ringwald */ 6421667ba9d1SMatthias Ringwald int gap_pin_code_response_binary(const bd_addr_t addr, const uint8_t * pin_data, uint8_t pin_len){ 6422aad97216SMatthias Ringwald if (hci_stack->gap_pairing_state != GAP_PAIRING_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED; 6423aad97216SMatthias Ringwald hci_stack->gap_pairing_input.gap_pairing_pin = pin_data; 6424aad97216SMatthias Ringwald hci_stack->gap_pairing_pin_len = pin_len; 6425aad97216SMatthias Ringwald return gap_pairing_set_state_and_run(addr, GAP_PAIRING_STATE_SEND_PIN); 6426aad97216SMatthias Ringwald } 6427aad97216SMatthias Ringwald 6428aad97216SMatthias Ringwald /** 64290a51f88bSMatthias Ringwald * @brief Legacy Pairing Pin Code Response 64300a51f88bSMatthias Ringwald * @param addr 64310a51f88bSMatthias Ringwald * @param pin 64320a51f88bSMatthias Ringwald * @return 0 if ok 64330a51f88bSMatthias Ringwald */ 6434667ba9d1SMatthias Ringwald int gap_pin_code_response(const bd_addr_t addr, const char * pin){ 6435aad97216SMatthias Ringwald return gap_pin_code_response_binary(addr, (const uint8_t*) pin, strlen(pin)); 64360a51f88bSMatthias Ringwald } 64370a51f88bSMatthias Ringwald 64380a51f88bSMatthias Ringwald /** 64390a51f88bSMatthias Ringwald * @brief Abort Legacy Pairing 64400a51f88bSMatthias Ringwald * @param addr 64410a51f88bSMatthias Ringwald * @param pin 64420a51f88bSMatthias Ringwald * @return 0 if ok 64430a51f88bSMatthias Ringwald */ 64440a51f88bSMatthias Ringwald int gap_pin_code_negative(bd_addr_t addr){ 6445cd74063aSMatthias Ringwald if (hci_stack->gap_pairing_state != GAP_PAIRING_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED; 64460a51f88bSMatthias Ringwald return gap_pairing_set_state_and_run(addr, GAP_PAIRING_STATE_SEND_PIN_NEGATIVE); 64470a51f88bSMatthias Ringwald } 64480a51f88bSMatthias Ringwald 64490a51f88bSMatthias Ringwald /** 64500a51f88bSMatthias Ringwald * @brief SSP Passkey Response 64510a51f88bSMatthias Ringwald * @param addr 64520a51f88bSMatthias Ringwald * @param passkey 64530a51f88bSMatthias Ringwald * @return 0 if ok 64540a51f88bSMatthias Ringwald */ 6455667ba9d1SMatthias Ringwald int gap_ssp_passkey_response(const bd_addr_t addr, uint32_t passkey){ 6456cd74063aSMatthias Ringwald if (hci_stack->gap_pairing_state != GAP_PAIRING_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED; 6457d504181aSMatthias Ringwald hci_stack->gap_pairing_input.gap_pairing_passkey = passkey; 64580a51f88bSMatthias Ringwald return gap_pairing_set_state_and_run(addr, GAP_PAIRING_STATE_SEND_PASSKEY); 64590a51f88bSMatthias Ringwald } 64600a51f88bSMatthias Ringwald 64610a51f88bSMatthias Ringwald /** 64620a51f88bSMatthias Ringwald * @brief Abort SSP Passkey Entry/Pairing 64630a51f88bSMatthias Ringwald * @param addr 64640a51f88bSMatthias Ringwald * @param pin 64650a51f88bSMatthias Ringwald * @return 0 if ok 64660a51f88bSMatthias Ringwald */ 6467667ba9d1SMatthias Ringwald int gap_ssp_passkey_negative(const bd_addr_t addr){ 6468cd74063aSMatthias Ringwald if (hci_stack->gap_pairing_state != GAP_PAIRING_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED; 64690a51f88bSMatthias Ringwald return gap_pairing_set_state_and_run(addr, GAP_PAIRING_STATE_SEND_PASSKEY_NEGATIVE); 64700a51f88bSMatthias Ringwald } 64710a51f88bSMatthias Ringwald 64720a51f88bSMatthias Ringwald /** 64730a51f88bSMatthias Ringwald * @brief Accept SSP Numeric Comparison 64740a51f88bSMatthias Ringwald * @param addr 64750a51f88bSMatthias Ringwald * @param passkey 64760a51f88bSMatthias Ringwald * @return 0 if ok 64770a51f88bSMatthias Ringwald */ 6478667ba9d1SMatthias Ringwald int gap_ssp_confirmation_response(const bd_addr_t addr){ 6479cd74063aSMatthias Ringwald if (hci_stack->gap_pairing_state != GAP_PAIRING_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED; 64800a51f88bSMatthias Ringwald return gap_pairing_set_state_and_run(addr, GAP_PAIRING_STATE_SEND_CONFIRMATION); 64810a51f88bSMatthias Ringwald } 64820a51f88bSMatthias Ringwald 64830a51f88bSMatthias Ringwald /** 64840a51f88bSMatthias Ringwald * @brief Abort SSP Numeric Comparison/Pairing 64850a51f88bSMatthias Ringwald * @param addr 64860a51f88bSMatthias Ringwald * @param pin 64870a51f88bSMatthias Ringwald * @return 0 if ok 64880a51f88bSMatthias Ringwald */ 6489667ba9d1SMatthias Ringwald int gap_ssp_confirmation_negative(const bd_addr_t addr){ 6490cd74063aSMatthias Ringwald if (hci_stack->gap_pairing_state != GAP_PAIRING_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED; 64910a51f88bSMatthias Ringwald return gap_pairing_set_state_and_run(addr, GAP_PAIRING_STATE_SEND_CONFIRMATION_NEGATIVE); 64920a51f88bSMatthias Ringwald } 64930a51f88bSMatthias Ringwald 649444565b0cSMatthias Ringwald #ifdef ENABLE_EXPLICIT_IO_CAPABILITIES_REPLY 649544565b0cSMatthias Ringwald 649644565b0cSMatthias Ringwald static uint8_t gap_set_auth_flag_and_run(const bd_addr_t addr, hci_authentication_flags_t flag){ 649744565b0cSMatthias Ringwald hci_connection_t * conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL); 649844565b0cSMatthias Ringwald if (!conn) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 649944565b0cSMatthias Ringwald connectionSetAuthenticationFlags(conn, flag); 650044565b0cSMatthias Ringwald hci_run(); 650144565b0cSMatthias Ringwald return ERROR_CODE_SUCCESS; 650244565b0cSMatthias Ringwald } 650344565b0cSMatthias Ringwald 650444565b0cSMatthias Ringwald uint8_t gap_ssp_io_capabilities_response(const bd_addr_t addr){ 65057ca4a7edSMatthias Ringwald return gap_set_auth_flag_and_run(addr, AUTH_FLAG_SEND_IO_CAPABILITIES_REPLY); 650644565b0cSMatthias Ringwald } 650744565b0cSMatthias Ringwald 650844565b0cSMatthias Ringwald uint8_t gap_ssp_io_capabilities_negative(const bd_addr_t addr){ 65097ca4a7edSMatthias Ringwald return gap_set_auth_flag_and_run(addr, AUTH_FLAG_SEND_IO_CAPABILITIES_NEGATIVE_REPLY); 651044565b0cSMatthias Ringwald } 651144565b0cSMatthias Ringwald #endif 651244565b0cSMatthias Ringwald 65131849becdSMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB 65141849becdSMatthias Ringwald /** 65151849becdSMatthias Ringwald * @brief Report Remote OOB Data 65161849becdSMatthias Ringwald * @param bd_addr 65171849becdSMatthias Ringwald * @param c_192 Simple Pairing Hash C derived from P-192 public key 65181849becdSMatthias Ringwald * @param r_192 Simple Pairing Randomizer derived from P-192 public key 65191849becdSMatthias Ringwald * @param c_256 Simple Pairing Hash C derived from P-256 public key 65201849becdSMatthias Ringwald * @param r_256 Simple Pairing Randomizer derived from P-256 public key 65211849becdSMatthias Ringwald */ 65221849becdSMatthias 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){ 65231849becdSMatthias Ringwald hci_connection_t * connection = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL); 65241849becdSMatthias Ringwald if (connection == NULL) { 65251849becdSMatthias Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 65261849becdSMatthias Ringwald } 65271849becdSMatthias Ringwald connection->classic_oob_c_192 = c_192; 65281849becdSMatthias Ringwald connection->classic_oob_r_192 = r_192; 6529204e8f1dSMatthias Ringwald 6530204e8f1dSMatthias Ringwald // ignore P-256 if not supported by us 6531204e8f1dSMatthias Ringwald if (hci_stack->secure_connections_active){ 65321849becdSMatthias Ringwald connection->classic_oob_c_256 = c_256; 65331849becdSMatthias Ringwald connection->classic_oob_r_256 = r_256; 6534204e8f1dSMatthias Ringwald } 6535204e8f1dSMatthias Ringwald 65361849becdSMatthias Ringwald return ERROR_CODE_SUCCESS; 65371849becdSMatthias Ringwald } 6538cf01e888SMatthias Ringwald /** 6539cf01e888SMatthias Ringwald * @brief Generate new OOB data 6540cf01e888SMatthias Ringwald * @note OOB data will be provided in GAP_EVENT_LOCAL_OOB_DATA and be used in future pairing procedures 6541cf01e888SMatthias Ringwald */ 6542cf01e888SMatthias Ringwald void gap_ssp_generate_oob_data(void){ 6543cf01e888SMatthias Ringwald hci_stack->classic_read_local_oob_data = true; 6544cf01e888SMatthias Ringwald hci_run(); 6545cf01e888SMatthias Ringwald } 6546cf01e888SMatthias Ringwald 65471849becdSMatthias Ringwald #endif 65481849becdSMatthias Ringwald 6549f5875de5SMatthias Ringwald /** 6550f6858d14SMatthias Ringwald * @brief Set inquiry mode: standard, with RSSI, with RSSI + Extended Inquiry Results. Has to be called before power on. 6551f5875de5SMatthias Ringwald * @param inquiry_mode see bluetooth_defines.h 6552f6858d14SMatthias Ringwald */ 6553b45b7749SMilanka Ringwald void hci_set_inquiry_mode(inquiry_mode_t inquiry_mode){ 6554b45b7749SMilanka Ringwald hci_stack->inquiry_mode = inquiry_mode; 6555f6858d14SMatthias Ringwald } 6556f6858d14SMatthias Ringwald 6557f6858d14SMatthias Ringwald /** 6558d950d659SMatthias Ringwald * @brief Configure Voice Setting for use with SCO data in HSP/HFP 6559d950d659SMatthias Ringwald */ 6560d950d659SMatthias Ringwald void hci_set_sco_voice_setting(uint16_t voice_setting){ 6561d950d659SMatthias Ringwald hci_stack->sco_voice_setting = voice_setting; 6562d950d659SMatthias Ringwald } 6563d950d659SMatthias Ringwald 6564d950d659SMatthias Ringwald /** 6565d950d659SMatthias Ringwald * @brief Get SCO Voice Setting 6566d950d659SMatthias Ringwald * @return current voice setting 6567d950d659SMatthias Ringwald */ 65680cb5b971SMatthias Ringwald uint16_t hci_get_sco_voice_setting(void){ 6569d950d659SMatthias Ringwald return hci_stack->sco_voice_setting; 6570d950d659SMatthias Ringwald } 6571d950d659SMatthias Ringwald 6572400ff5abSMatthias Ringwald static int hci_have_usb_transport(void){ 6573400ff5abSMatthias Ringwald if (!hci_stack->hci_transport) return 0; 6574400ff5abSMatthias Ringwald const char * transport_name = hci_stack->hci_transport->name; 6575400ff5abSMatthias Ringwald if (!transport_name) return 0; 6576400ff5abSMatthias Ringwald return (transport_name[0] == 'H') && (transport_name[1] == '2'); 6577400ff5abSMatthias Ringwald } 6578400ff5abSMatthias Ringwald 6579b3aad8daSMatthias Ringwald /** @brief Get SCO packet length for current SCO Voice setting 6580b3aad8daSMatthias Ringwald * @note Using SCO packets of the exact length is required for USB transfer 6581b3aad8daSMatthias Ringwald * @return Length of SCO packets in bytes (not audio frames) 6582b3aad8daSMatthias Ringwald */ 658320dcdd22SMatthias Ringwald uint16_t hci_get_sco_packet_length(void){ 658420dcdd22SMatthias Ringwald uint16_t sco_packet_length = 0; 6585cf119f3bSMatthias Ringwald 65861e20a53eSMatthias Ringwald #ifdef ENABLE_SCO_OVER_HCI 65876f28d2eeSMatthias Ringwald // Transparent = mSBC => 1, CVSD with 16-bit samples requires twice as much bytes 65881431ce27SMatthias Ringwald int multiplier = ((hci_stack->sco_voice_setting_active & 0x03) == 0x03) ? 1 : 2; 6589cf119f3bSMatthias Ringwald 6590400ff5abSMatthias Ringwald if (hci_have_usb_transport()){ 6591400ff5abSMatthias Ringwald // see Core Spec for H2 USB Transfer. 6592cf119f3bSMatthias Ringwald // 3 byte SCO header + 24 bytes per connection 659352e46257SMatthias Ringwald int num_sco_connections = btstack_max(1, hci_number_sco_connections()); 659452e46257SMatthias Ringwald sco_packet_length = 3 + 24 * num_sco_connections * multiplier; 6595400ff5abSMatthias Ringwald } else { 6596400ff5abSMatthias Ringwald // 3 byte SCO header + SCO packet size over the air (60 bytes) 6597400ff5abSMatthias Ringwald sco_packet_length = 3 + 60 * multiplier; 6598d966a453SMatthias Ringwald // assert that it still fits inside an SCO buffer 6599d966a453SMatthias Ringwald if (sco_packet_length > hci_stack->sco_data_packet_length){ 6600d966a453SMatthias Ringwald sco_packet_length = 3 + 60; 6601d966a453SMatthias Ringwald } 6602400ff5abSMatthias Ringwald } 6603a3069afeSMatthias Ringwald #endif 66045b7087c7SMatthias Ringwald 66055b7087c7SMatthias Ringwald #ifdef HAVE_SCO_TRANSPORT 66065b7087c7SMatthias Ringwald // Transparent = mSBC => 1, CVSD with 16-bit samples requires twice as much bytes 66071e20a53eSMatthias Ringwald int multiplier = ((hci_stack->sco_voice_setting_active & 0x03) == 0x03) ? 1 : 2; 66085b7087c7SMatthias Ringwald sco_packet_length = 3 + 60 * multiplier; 66095b7087c7SMatthias Ringwald #endif 6610a3069afeSMatthias Ringwald return sco_packet_length; 6611b3aad8daSMatthias Ringwald } 6612b3aad8daSMatthias Ringwald 6613c4c88f1bSJakob Krantz /** 6614c4c88f1bSJakob Krantz * @brief Sets the master/slave policy 6615c4c88f1bSJakob Krantz * @param policy (0: attempt to become master, 1: let connecting device decide) 6616c4c88f1bSJakob Krantz */ 6617c4c88f1bSJakob Krantz void hci_set_master_slave_policy(uint8_t policy){ 6618c4c88f1bSJakob Krantz hci_stack->master_slave_policy = policy; 6619c4c88f1bSJakob Krantz } 6620c4c88f1bSJakob Krantz 6621c4c88f1bSJakob Krantz #endif 6622ec111c8bSMatthias Ringwald 6623ec111c8bSMatthias Ringwald HCI_STATE hci_get_state(void){ 6624ec111c8bSMatthias Ringwald return hci_stack->state; 6625ec111c8bSMatthias Ringwald } 6626ec111c8bSMatthias Ringwald 662707e010b6SMilanka Ringwald #ifdef ENABLE_CLASSIC 66285e91d96cSMatthias Ringwald void gap_register_classic_connection_filter(int (*accept_callback)(bd_addr_t addr, hci_link_type_t link_type)){ 662907e010b6SMilanka Ringwald hci_stack->gap_classic_accept_callback = accept_callback; 663007e010b6SMilanka Ringwald } 663107e010b6SMilanka Ringwald #endif 6632ec111c8bSMatthias Ringwald 6633d950d659SMatthias Ringwald /** 6634d23838ecSMatthias Ringwald * @brief Set callback for Bluetooth Hardware Error 6635d23838ecSMatthias Ringwald */ 6636c2e1fa60SMatthias Ringwald void hci_set_hardware_error_callback(void (*fn)(uint8_t error)){ 6637d23838ecSMatthias Ringwald hci_stack->hardware_error_callback = fn; 6638d23838ecSMatthias Ringwald } 6639d23838ecSMatthias Ringwald 664071de195eSMatthias Ringwald void hci_disconnect_all(void){ 6641665d90f2SMatthias Ringwald btstack_linked_list_iterator_t it; 6642665d90f2SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->connections); 6643665d90f2SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 6644665d90f2SMatthias Ringwald hci_connection_t * con = (hci_connection_t*) btstack_linked_list_iterator_next(&it); 664504a6ef8cSmatthias.ringwald if (con->state == SENT_DISCONNECT) continue; 664604a6ef8cSmatthias.ringwald con->state = SEND_DISCONNECT; 664704a6ef8cSmatthias.ringwald } 6648d31fba26S[email protected] hci_run(); 664904a6ef8cSmatthias.ringwald } 665033373e40SMatthias Ringwald 665133373e40SMatthias Ringwald uint16_t hci_get_manufacturer(void){ 665233373e40SMatthias Ringwald return hci_stack->manufacturer; 665333373e40SMatthias Ringwald } 66549c6e867eSMatthias Ringwald 66553e329ddfSandryblack #ifdef ENABLE_BLE 66569c6e867eSMatthias Ringwald static sm_connection_t * sm_get_connection_for_handle(hci_con_handle_t con_handle){ 66579c6e867eSMatthias Ringwald hci_connection_t * hci_con = hci_connection_for_handle(con_handle); 66589c6e867eSMatthias Ringwald if (!hci_con) return NULL; 66599c6e867eSMatthias Ringwald return &hci_con->sm_connection; 66609c6e867eSMatthias Ringwald } 66619c6e867eSMatthias Ringwald 66629c6e867eSMatthias Ringwald // extracted from sm.c to allow enabling of l2cap le data channels without adding sm.c to the build 66639c6e867eSMatthias Ringwald // without sm.c default values from create_connection_for_bd_addr_and_type() resulg in non-encrypted, not-authenticated 66646a79f6baSMatthias Ringwald #endif 66659c6e867eSMatthias Ringwald 66669c6e867eSMatthias Ringwald int gap_encryption_key_size(hci_con_handle_t con_handle){ 6667c5fb5ca4SMatthias Ringwald hci_connection_t * hci_connection = hci_connection_for_handle(con_handle); 6668c5fb5ca4SMatthias Ringwald if (hci_connection == NULL) return 0; 6669c5fb5ca4SMatthias Ringwald if (hci_is_le_connection(hci_connection)){ 66706a79f6baSMatthias Ringwald #ifdef ENABLE_BLE 6671c5fb5ca4SMatthias Ringwald sm_connection_t * sm_conn = &hci_connection->sm_connection; 6672c5fb5ca4SMatthias Ringwald if (sm_conn->sm_connection_encrypted) { 66739c6e867eSMatthias Ringwald return sm_conn->sm_actual_encryption_key_size; 66749c6e867eSMatthias Ringwald } 66756a79f6baSMatthias Ringwald #endif 66766a79f6baSMatthias Ringwald } else { 6677c5fb5ca4SMatthias Ringwald #ifdef ENABLE_CLASSIC 66788daf94bcSMatthias Ringwald if ((hci_connection->authentication_flags & AUTH_FLAG_CONNECTION_ENCRYPTED)){ 6679c5fb5ca4SMatthias Ringwald return hci_connection->encryption_key_size; 6680c5fb5ca4SMatthias Ringwald } 6681c5fb5ca4SMatthias Ringwald #endif 66826a79f6baSMatthias Ringwald } 6683c5fb5ca4SMatthias Ringwald return 0; 6684c5fb5ca4SMatthias Ringwald } 66859c6e867eSMatthias Ringwald 66869c6e867eSMatthias Ringwald int gap_authenticated(hci_con_handle_t con_handle){ 6687c5fb5ca4SMatthias Ringwald hci_connection_t * hci_connection = hci_connection_for_handle(con_handle); 6688c5fb5ca4SMatthias Ringwald if (hci_connection == NULL) return 0; 66895f3981bfSMatthias Ringwald 6690c5fb5ca4SMatthias Ringwald switch (hci_connection->address_type){ 66916a79f6baSMatthias Ringwald #ifdef ENABLE_BLE 66925f3981bfSMatthias Ringwald case BD_ADDR_TYPE_LE_PUBLIC: 66935f3981bfSMatthias Ringwald case BD_ADDR_TYPE_LE_RANDOM: 6694c5fb5ca4SMatthias Ringwald if (hci_connection->sm_connection.sm_connection_encrypted == 0) return 0; // unencrypted connection cannot be authenticated 6695c5fb5ca4SMatthias Ringwald return hci_connection->sm_connection.sm_connection_authenticated; 66966a79f6baSMatthias Ringwald #endif 669759a1a47aSMatthias Ringwald #ifdef ENABLE_CLASSIC 66985f3981bfSMatthias Ringwald case BD_ADDR_TYPE_SCO: 6699f16129ceSMatthias Ringwald case BD_ADDR_TYPE_ACL: 6700c5fb5ca4SMatthias Ringwald return gap_authenticated_for_link_key_type(hci_connection->link_key_type); 670159a1a47aSMatthias Ringwald #endif 67025f3981bfSMatthias Ringwald default: 67035f3981bfSMatthias Ringwald return 0; 67045f3981bfSMatthias Ringwald } 67059c6e867eSMatthias Ringwald } 67069c6e867eSMatthias Ringwald 6707f1dfbe18SMatthias Ringwald int gap_secure_connection(hci_con_handle_t con_handle){ 6708c5fb5ca4SMatthias Ringwald hci_connection_t * hci_connection = hci_connection_for_handle(con_handle); 6709c5fb5ca4SMatthias Ringwald if (hci_connection == NULL) return 0; 67108b35e16aSMatthias Ringwald 6711c5fb5ca4SMatthias Ringwald switch (hci_connection->address_type){ 67126a79f6baSMatthias Ringwald #ifdef ENABLE_BLE 67138b35e16aSMatthias Ringwald case BD_ADDR_TYPE_LE_PUBLIC: 67148b35e16aSMatthias Ringwald case BD_ADDR_TYPE_LE_RANDOM: 6715c5fb5ca4SMatthias Ringwald if (hci_connection->sm_connection.sm_connection_encrypted == 0) return 0; // unencrypted connection cannot be authenticated 6716c5fb5ca4SMatthias Ringwald return hci_connection->sm_connection.sm_connection_sc; 67176a79f6baSMatthias Ringwald #endif 671859a1a47aSMatthias Ringwald #ifdef ENABLE_CLASSIC 67198b35e16aSMatthias Ringwald case BD_ADDR_TYPE_SCO: 6720f16129ceSMatthias Ringwald case BD_ADDR_TYPE_ACL: 6721c5fb5ca4SMatthias Ringwald return gap_secure_connection_for_link_key_type(hci_connection->link_key_type); 672259a1a47aSMatthias Ringwald #endif 67238b35e16aSMatthias Ringwald default: 67248b35e16aSMatthias Ringwald return 0; 67258b35e16aSMatthias Ringwald } 6726f1dfbe18SMatthias Ringwald } 6727f1dfbe18SMatthias Ringwald 67281e122704SMatthias Ringwald bool gap_bonded(hci_con_handle_t con_handle){ 67291e122704SMatthias Ringwald hci_connection_t * hci_connection = hci_connection_for_handle(con_handle); 67301e122704SMatthias Ringwald if (hci_connection == NULL) return 0; 67311e122704SMatthias Ringwald 673248f33f37SMatthias Ringwald #ifdef ENABLE_CLASSIC 67331e122704SMatthias Ringwald link_key_t link_key; 67341e122704SMatthias Ringwald link_key_type_t link_key_type; 673548f33f37SMatthias Ringwald #endif 67361e122704SMatthias Ringwald switch (hci_connection->address_type){ 67376a79f6baSMatthias Ringwald #ifdef ENABLE_BLE 67381e122704SMatthias Ringwald case BD_ADDR_TYPE_LE_PUBLIC: 67391e122704SMatthias Ringwald case BD_ADDR_TYPE_LE_RANDOM: 67401e122704SMatthias Ringwald return hci_connection->sm_connection.sm_le_db_index >= 0; 67416a79f6baSMatthias Ringwald #endif 67421e122704SMatthias Ringwald #ifdef ENABLE_CLASSIC 67431e122704SMatthias Ringwald case BD_ADDR_TYPE_SCO: 67441e122704SMatthias Ringwald case BD_ADDR_TYPE_ACL: 67451e122704SMatthias Ringwald return hci_stack->link_key_db && hci_stack->link_key_db->get_link_key(hci_connection->address, link_key, &link_key_type); 67461e122704SMatthias Ringwald #endif 67471e122704SMatthias Ringwald default: 67481e122704SMatthias Ringwald return false; 67491e122704SMatthias Ringwald } 67501e122704SMatthias Ringwald } 67511e122704SMatthias Ringwald 67526a79f6baSMatthias Ringwald #ifdef ENABLE_BLE 67539c6e867eSMatthias Ringwald authorization_state_t gap_authorization_state(hci_con_handle_t con_handle){ 67549c6e867eSMatthias Ringwald sm_connection_t * sm_conn = sm_get_connection_for_handle(con_handle); 67559c6e867eSMatthias Ringwald if (!sm_conn) return AUTHORIZATION_UNKNOWN; // wrong connection 67569c6e867eSMatthias Ringwald if (!sm_conn->sm_connection_encrypted) return AUTHORIZATION_UNKNOWN; // unencrypted connection cannot be authorized 67579c6e867eSMatthias Ringwald if (!sm_conn->sm_connection_authenticated) return AUTHORIZATION_UNKNOWN; // unauthenticatd connection cannot be authorized 67589c6e867eSMatthias Ringwald return sm_conn->sm_connection_authorization_state; 67599c6e867eSMatthias Ringwald } 67609c6e867eSMatthias Ringwald #endif 6761f8ee3071SMatthias Ringwald 6762f8ee3071SMatthias Ringwald #ifdef ENABLE_CLASSIC 6763f8ee3071SMatthias 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){ 6764f8ee3071SMatthias Ringwald hci_connection_t * conn = hci_connection_for_handle(con_handle); 6765f8ee3071SMatthias Ringwald if (!conn) return GAP_CONNECTION_INVALID; 6766f8ee3071SMatthias Ringwald conn->sniff_min_interval = sniff_min_interval; 6767f8ee3071SMatthias Ringwald conn->sniff_max_interval = sniff_max_interval; 6768f8ee3071SMatthias Ringwald conn->sniff_attempt = sniff_attempt; 6769f8ee3071SMatthias Ringwald conn->sniff_timeout = sniff_timeout; 6770f8ee3071SMatthias Ringwald hci_run(); 6771f8ee3071SMatthias Ringwald return 0; 6772f8ee3071SMatthias Ringwald } 6773f8ee3071SMatthias Ringwald 6774f8ee3071SMatthias Ringwald /** 6775f8ee3071SMatthias Ringwald * @brief Exit Sniff mode 6776f8ee3071SMatthias Ringwald * @param con_handle 6777f8ee3071SMatthias Ringwald @ @return 0 if ok 6778f8ee3071SMatthias Ringwald */ 6779f8ee3071SMatthias Ringwald uint8_t gap_sniff_mode_exit(hci_con_handle_t con_handle){ 6780f8ee3071SMatthias Ringwald hci_connection_t * conn = hci_connection_for_handle(con_handle); 6781f8ee3071SMatthias Ringwald if (!conn) return GAP_CONNECTION_INVALID; 6782f8ee3071SMatthias Ringwald conn->sniff_min_interval = 0xffff; 6783f8ee3071SMatthias Ringwald hci_run(); 6784f8ee3071SMatthias Ringwald return 0; 6785f8ee3071SMatthias Ringwald } 6786bea424a5SMatthias Ringwald 6787140c0557SMatthias Ringwald uint8_t gap_sniff_subrating_configure(hci_con_handle_t con_handle, uint16_t max_latency, uint16_t min_remote_timeout, uint16_t min_local_timeout){ 6788140c0557SMatthias Ringwald hci_connection_t * conn = hci_connection_for_handle(con_handle); 6789140c0557SMatthias Ringwald if (!conn) return GAP_CONNECTION_INVALID; 6790140c0557SMatthias Ringwald conn->sniff_subrating_max_latency = max_latency; 6791140c0557SMatthias Ringwald conn->sniff_subrating_min_remote_timeout = min_remote_timeout; 6792140c0557SMatthias Ringwald conn->sniff_subrating_min_local_timeout = min_local_timeout; 6793140c0557SMatthias Ringwald hci_run(); 6794dc8d5bd3SMatthias Ringwald return ERROR_CODE_SUCCESS; 6795140c0557SMatthias Ringwald } 6796140c0557SMatthias Ringwald 6797278ff8a9SMatthias Ringwald uint8_t gap_qos_set(hci_con_handle_t con_handle, hci_service_type_t service_type, uint32_t token_rate, uint32_t peak_bandwidth, uint32_t latency, uint32_t delay_variation){ 6798278ff8a9SMatthias Ringwald hci_connection_t * conn = hci_connection_for_handle(con_handle); 6799278ff8a9SMatthias Ringwald if (!conn) return GAP_CONNECTION_INVALID; 6800278ff8a9SMatthias Ringwald conn->qos_service_type = service_type; 6801278ff8a9SMatthias Ringwald conn->qos_token_rate = token_rate; 6802278ff8a9SMatthias Ringwald conn->qos_peak_bandwidth = peak_bandwidth; 6803278ff8a9SMatthias Ringwald conn->qos_latency = latency; 6804278ff8a9SMatthias Ringwald conn->qos_delay_variation = delay_variation; 6805278ff8a9SMatthias Ringwald hci_run(); 6806278ff8a9SMatthias Ringwald return ERROR_CODE_SUCCESS; 6807278ff8a9SMatthias Ringwald } 6808278ff8a9SMatthias Ringwald 6809bea424a5SMatthias Ringwald void gap_set_page_scan_activity(uint16_t page_scan_interval, uint16_t page_scan_window){ 6810bea424a5SMatthias Ringwald hci_stack->new_page_scan_interval = page_scan_interval; 6811bea424a5SMatthias Ringwald hci_stack->new_page_scan_window = page_scan_window; 6812bea424a5SMatthias Ringwald hci_run(); 6813bea424a5SMatthias Ringwald } 6814bea424a5SMatthias Ringwald 6815bea424a5SMatthias Ringwald void gap_set_page_scan_type(page_scan_type_t page_scan_type){ 6816bea424a5SMatthias Ringwald hci_stack->new_page_scan_type = (uint8_t) page_scan_type; 6817bea424a5SMatthias Ringwald hci_run(); 6818bea424a5SMatthias Ringwald } 6819bea424a5SMatthias Ringwald 6820f8ee3071SMatthias Ringwald #endif 6821beceeddeSMatthias Ringwald 6822beceeddeSMatthias Ringwald void hci_halting_defer(void){ 6823beceeddeSMatthias Ringwald if (hci_stack->state != HCI_STATE_HALTING) return; 6824beceeddeSMatthias Ringwald switch (hci_stack->substate){ 6825beceeddeSMatthias Ringwald case HCI_HALTING_DISCONNECT_ALL_NO_TIMER: 6826beceeddeSMatthias Ringwald case HCI_HALTING_CLOSE: 6827beceeddeSMatthias Ringwald hci_stack->substate = HCI_HALTING_DISCONNECT_ALL_TIMER; 6828beceeddeSMatthias Ringwald break; 6829beceeddeSMatthias Ringwald default: 6830beceeddeSMatthias Ringwald break; 6831beceeddeSMatthias Ringwald } 6832beceeddeSMatthias Ringwald } 6833eddac615SMatthias Ringwald 683421debf25SMatthias Ringwald #ifdef ENABLE_LE_PRIVACY_ADDRESS_RESOLUTION 683521debf25SMatthias Ringwald void hci_load_le_device_db_entry_into_resolving_list(uint16_t le_device_db_index){ 683621debf25SMatthias Ringwald if (le_device_db_index >= MAX_NUM_RESOLVING_LIST_ENTRIES) return; 683721debf25SMatthias Ringwald if (le_device_db_index >= le_device_db_max_count()) return; 683821debf25SMatthias Ringwald uint8_t offset = le_device_db_index >> 3; 683921debf25SMatthias Ringwald uint8_t mask = 1 << (le_device_db_index & 7); 684002b02cffSMatthias Ringwald hci_stack->le_resolving_list_add_entries[offset] |= mask; 684121debf25SMatthias Ringwald if (hci_stack->le_resolving_list_state == LE_RESOLVING_LIST_DONE){ 684202b02cffSMatthias Ringwald // note: go back to remove entries, otherwise, a remove + add will skip the add 684302b02cffSMatthias Ringwald hci_stack->le_resolving_list_state = LE_RESOLVING_LIST_REMOVE_ENTRIES; 684402b02cffSMatthias Ringwald } 684502b02cffSMatthias Ringwald } 684602b02cffSMatthias Ringwald 684702b02cffSMatthias Ringwald void hci_remove_le_device_db_entry_from_resolving_list(uint16_t le_device_db_index){ 684802b02cffSMatthias Ringwald if (le_device_db_index >= MAX_NUM_RESOLVING_LIST_ENTRIES) return; 684902b02cffSMatthias Ringwald if (le_device_db_index >= le_device_db_max_count()) return; 685002b02cffSMatthias Ringwald uint8_t offset = le_device_db_index >> 3; 685102b02cffSMatthias Ringwald uint8_t mask = 1 << (le_device_db_index & 7); 685202b02cffSMatthias Ringwald hci_stack->le_resolving_list_remove_entries[offset] |= mask; 685302b02cffSMatthias Ringwald if (hci_stack->le_resolving_list_state == LE_RESOLVING_LIST_DONE){ 685402b02cffSMatthias Ringwald hci_stack->le_resolving_list_state = LE_RESOLVING_LIST_REMOVE_ENTRIES; 685521debf25SMatthias Ringwald } 685621debf25SMatthias Ringwald } 6857cf38a091SMatthias Ringwald 6858cf38a091SMatthias Ringwald uint8_t gap_load_resolving_list_from_le_device_db(void){ 6859cf38a091SMatthias Ringwald if ((hci_stack->local_supported_commands[1] & (1 << 2)) == 0) { 6860cf38a091SMatthias Ringwald return ERROR_CODE_UNSUPPORTED_FEATURE_OR_PARAMETER_VALUE; 6861cf38a091SMatthias Ringwald } 6862cf38a091SMatthias Ringwald if (hci_stack->le_resolving_list_state != LE_RESOLVING_LIST_SEND_ENABLE_ADDRESS_RESOLUTION){ 6863cf38a091SMatthias Ringwald // restart le resolving list update 6864cf38a091SMatthias Ringwald hci_stack->le_resolving_list_state = LE_RESOLVING_LIST_READ_SIZE; 6865cf38a091SMatthias Ringwald } 6866cf38a091SMatthias Ringwald return ERROR_CODE_SUCCESS; 6867cf38a091SMatthias Ringwald } 686821debf25SMatthias Ringwald #endif 686921debf25SMatthias Ringwald 6870eddac615SMatthias Ringwald #ifdef FUZZING_BUILD_MODE_UNSAFE_FOR_PRODUCTION 687118976c74SMatthias Ringwald void hci_setup_test_connections_fuzz(void){ 687218976c74SMatthias Ringwald hci_connection_t * conn; 687318976c74SMatthias Ringwald 687418976c74SMatthias Ringwald // default address: 66:55:44:33:00:01 687518976c74SMatthias Ringwald bd_addr_t addr = { 0x66, 0x55, 0x44, 0x33, 0x00, 0x00}; 687618976c74SMatthias Ringwald 68777d33cb26SMilanka Ringwald // setup Controller info 68787d33cb26SMilanka Ringwald hci_stack->num_cmd_packets = 255; 68797d33cb26SMilanka Ringwald hci_stack->acl_packets_total_num = 255; 68807d33cb26SMilanka Ringwald 688118976c74SMatthias Ringwald // setup incoming Classic ACL connection with con handle 0x0001, 66:55:44:33:22:01 688218976c74SMatthias Ringwald addr[5] = 0x01; 688318976c74SMatthias Ringwald conn = create_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL); 688418976c74SMatthias Ringwald conn->con_handle = addr[5]; 688518976c74SMatthias Ringwald conn->role = HCI_ROLE_SLAVE; 688618976c74SMatthias Ringwald conn->state = RECEIVED_CONNECTION_REQUEST; 68877d33cb26SMilanka Ringwald conn->sm_connection.sm_role = HCI_ROLE_SLAVE; 688818976c74SMatthias Ringwald 688918976c74SMatthias Ringwald // setup incoming Classic SCO connection with con handle 0x0002 689018976c74SMatthias Ringwald addr[5] = 0x02; 689118976c74SMatthias Ringwald conn = create_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_SCO); 689218976c74SMatthias Ringwald conn->con_handle = addr[5]; 689318976c74SMatthias Ringwald conn->role = HCI_ROLE_SLAVE; 689418976c74SMatthias Ringwald conn->state = RECEIVED_CONNECTION_REQUEST; 68957d33cb26SMilanka Ringwald conn->sm_connection.sm_role = HCI_ROLE_SLAVE; 689618976c74SMatthias Ringwald 689718976c74SMatthias Ringwald // setup ready Classic ACL connection with con handle 0x0003 689818976c74SMatthias Ringwald addr[5] = 0x03; 689918976c74SMatthias Ringwald conn = create_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL); 690018976c74SMatthias Ringwald conn->con_handle = addr[5]; 690118976c74SMatthias Ringwald conn->role = HCI_ROLE_SLAVE; 690218976c74SMatthias Ringwald conn->state = OPEN; 69037d33cb26SMilanka Ringwald conn->sm_connection.sm_role = HCI_ROLE_SLAVE; 690418976c74SMatthias Ringwald 690518976c74SMatthias Ringwald // setup ready Classic SCO connection with con handle 0x0004 690618976c74SMatthias Ringwald addr[5] = 0x04; 690718976c74SMatthias Ringwald conn = create_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_SCO); 690818976c74SMatthias Ringwald conn->con_handle = addr[5]; 690918976c74SMatthias Ringwald conn->role = HCI_ROLE_SLAVE; 691018976c74SMatthias Ringwald conn->state = OPEN; 69117d33cb26SMilanka Ringwald conn->sm_connection.sm_role = HCI_ROLE_SLAVE; 691218976c74SMatthias Ringwald 691318976c74SMatthias Ringwald // setup ready LE ACL connection with con handle 0x005 and public address 691418976c74SMatthias Ringwald addr[5] = 0x05; 691518976c74SMatthias Ringwald conn = create_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_LE_PUBLIC); 691618976c74SMatthias Ringwald conn->con_handle = addr[5]; 691718976c74SMatthias Ringwald conn->role = HCI_ROLE_SLAVE; 691818976c74SMatthias Ringwald conn->state = OPEN; 69197d33cb26SMilanka Ringwald conn->sm_connection.sm_role = HCI_ROLE_SLAVE; 69208046a24aSMatthias Ringwald conn->sm_connection.sm_connection_encrypted = 1; 692118976c74SMatthias Ringwald } 692218976c74SMatthias Ringwald 6923eddac615SMatthias Ringwald void hci_free_connections_fuzz(void){ 6924eddac615SMatthias Ringwald btstack_linked_list_iterator_t it; 6925eddac615SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->connections); 6926eddac615SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 6927eddac615SMatthias Ringwald hci_connection_t * con = (hci_connection_t*) btstack_linked_list_iterator_next(&it); 6928eddac615SMatthias Ringwald btstack_linked_list_iterator_remove(&it); 6929eddac615SMatthias Ringwald btstack_memory_hci_connection_free(con); 6930eddac615SMatthias Ringwald } 6931eddac615SMatthias Ringwald } 69321470db0cSMatthias Ringwald void hci_simulate_working_fuzz(void){ 69331470db0cSMatthias Ringwald hci_init_done(); 69341470db0cSMatthias Ringwald hci_stack->num_cmd_packets = 255; 69351470db0cSMatthias Ringwald } 6936eddac615SMatthias Ringwald #endif 6937