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" 6245c102fdSMatthias Ringwald #endif 6345c102fdSMatthias Ringwald 6493b8dc03Smatthias.ringwald #include <stdarg.h> 6593b8dc03Smatthias.ringwald #include <string.h> 6656fe0872Smatthias.ringwald #include <stdio.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 96169f8b28Smatthias.ringwald #define HCI_CONNECTION_TIMEOUT_MS 10000 97659d758cSMatthias Ringwald #define HCI_RESET_RESEND_TIMEOUT_MS 200 98ee091cf1Smatthias.ringwald 991cfb383eSMatthias Ringwald // Names are arbitrarily shortened to 32 bytes if not requested otherwise 1001cfb383eSMatthias Ringwald #ifndef GAP_INQUIRY_MAX_NAME_LEN 1011cfb383eSMatthias Ringwald #define GAP_INQUIRY_MAX_NAME_LEN 32 1021cfb383eSMatthias Ringwald #endif 1031cfb383eSMatthias Ringwald 104f5875de5SMatthias Ringwald // GAP inquiry state: 0 = off, 0x01 - 0x30 = requested duration, 0xfe = active, 0xff = stop requested 105f5875de5SMatthias Ringwald #define GAP_INQUIRY_DURATION_MIN 0x01 106f5875de5SMatthias Ringwald #define GAP_INQUIRY_DURATION_MAX 0x30 107f5875de5SMatthias Ringwald #define GAP_INQUIRY_STATE_ACTIVE 0x80 108f5875de5SMatthias Ringwald #define GAP_INQUIRY_STATE_IDLE 0 109f5875de5SMatthias Ringwald #define GAP_INQUIRY_STATE_W2_CANCEL 0x81 110f5875de5SMatthias Ringwald #define GAP_INQUIRY_STATE_W4_CANCELLED 0x82 111f5875de5SMatthias Ringwald 112b7f1ee76SMatthias Ringwald // GAP Remote Name Request 113b7f1ee76SMatthias Ringwald #define GAP_REMOTE_NAME_STATE_IDLE 0 114b7f1ee76SMatthias Ringwald #define GAP_REMOTE_NAME_STATE_W2_SEND 1 115b7f1ee76SMatthias Ringwald #define GAP_REMOTE_NAME_STATE_W4_COMPLETE 2 116b7f1ee76SMatthias Ringwald 1170a51f88bSMatthias Ringwald // GAP Pairing 1180a51f88bSMatthias Ringwald #define GAP_PAIRING_STATE_IDLE 0 1190a51f88bSMatthias Ringwald #define GAP_PAIRING_STATE_SEND_PIN 1 1200a51f88bSMatthias Ringwald #define GAP_PAIRING_STATE_SEND_PIN_NEGATIVE 2 1210a51f88bSMatthias Ringwald #define GAP_PAIRING_STATE_SEND_PASSKEY 3 1220a51f88bSMatthias Ringwald #define GAP_PAIRING_STATE_SEND_PASSKEY_NEGATIVE 4 1230a51f88bSMatthias Ringwald #define GAP_PAIRING_STATE_SEND_CONFIRMATION 5 1240a51f88bSMatthias Ringwald #define GAP_PAIRING_STATE_SEND_CONFIRMATION_NEGATIVE 6 1250a51f88bSMatthias Ringwald 1260a51f88bSMatthias Ringwald 127b83d5eabSMatthias Ringwald // prototypes 12835454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 129758b46ceSmatthias.ringwald static void hci_update_scan_enable(void); 13035454696SMatthias Ringwald static void hci_emit_discoverable_enabled(uint8_t enabled); 13135454696SMatthias Ringwald static int hci_local_ssp_activated(void); 13235454696SMatthias Ringwald static int hci_remote_ssp_supported(hci_con_handle_t con_handle); 13335454696SMatthias Ringwald static void hci_notify_if_sco_can_send_now(void); 13435454696SMatthias Ringwald static void hci_emit_connection_complete(bd_addr_t address, hci_con_handle_t con_handle, uint8_t status); 135a00031e2S[email protected] static gap_security_level_t gap_security_level_for_connection(hci_connection_t * connection); 13635454696SMatthias Ringwald static void hci_emit_security_level(hci_con_handle_t con_handle, gap_security_level_t level); 137ec820d77SMatthias Ringwald static void hci_connection_timeout_handler(btstack_timer_source_t *timer); 13896a45072S[email protected] static void hci_connection_timestamp(hci_connection_t *connection); 13952db98b2SMatthias Ringwald static void hci_emit_l2cap_check_timeout(hci_connection_t *conn); 1401cfb383eSMatthias Ringwald static void gap_inquiry_explode(uint8_t * packet); 14152db98b2SMatthias Ringwald #endif 1421cfb383eSMatthias Ringwald 1437586ee35S[email protected] static int hci_power_control_on(void); 1447586ee35S[email protected] static void hci_power_control_off(void); 1456da48142SSean Wilson static void hci_state_reset(void); 146fd43c0e0SMatthias Ringwald static void hci_emit_transport_packet_sent(void); 147fc64f94aSMatthias Ringwald static void hci_emit_disconnection_complete(hci_con_handle_t con_handle, uint8_t reason); 148b83d5eabSMatthias Ringwald static void hci_emit_nr_connections_changed(void); 149b83d5eabSMatthias Ringwald static void hci_emit_hci_open_failed(void); 150b83d5eabSMatthias Ringwald static void hci_emit_dedicated_bonding_result(bd_addr_t address, uint8_t status); 151b83d5eabSMatthias Ringwald static void hci_emit_event(uint8_t * event, uint16_t size, int dump); 152b83d5eabSMatthias Ringwald static void hci_emit_acl_packet(uint8_t * packet, uint16_t size); 15395d71764SMatthias Ringwald static void hci_run(void); 15495d71764SMatthias Ringwald static int hci_is_le_connection(hci_connection_t * connection); 15595d71764SMatthias Ringwald static int hci_number_free_acl_slots_for_connection_type( bd_addr_type_t address_type); 156f234b250SMatthias Ringwald static int hci_have_usb_transport(void); 1575d509858SMatthias Ringwald 158a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE 159e8c8828eSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 16039677e66SMatthias Ringwald // called from test/ble_client/advertising_data_parser.c 161384b59deSMatthias Ringwald void le_handle_advertisement_report(uint8_t *packet, uint16_t size); 16242ff5ba1SMatthias Ringwald static void hci_remove_from_whitelist(bd_addr_type_t address_type, bd_addr_t address); 1639c77c9dbSMatthias Ringwald static hci_connection_t * gap_get_outgoing_connection(void); 1645d509858SMatthias Ringwald #endif 165d70217a2SMatthias Ringwald #endif 166758b46ceSmatthias.ringwald 16706b35ec0Smatthias.ringwald // the STACK is here 1683a9fb326S[email protected] #ifndef HAVE_MALLOC 1693a9fb326S[email protected] static hci_stack_t hci_stack_static; 1703a9fb326S[email protected] #endif 1713a9fb326S[email protected] static hci_stack_t * hci_stack = NULL; 17216833f0aSmatthias.ringwald 1731c9e5e9dSMatthias Ringwald #ifdef ENABLE_CLASSIC 17463168530SMatthias Ringwald // default name 17563168530SMatthias Ringwald static const char * default_classic_name = "BTstack 00:00:00:00:00:00"; 17663168530SMatthias Ringwald 17766fb9560S[email protected] // test helper 17866fb9560S[email protected] static uint8_t disable_l2cap_timeouts = 0; 1791c9e5e9dSMatthias Ringwald #endif 18066fb9560S[email protected] 18196a45072S[email protected] /** 18296a45072S[email protected] * create connection for given address 18396a45072S[email protected] * 18496a45072S[email protected] * @return connection OR NULL, if no memory left 18596a45072S[email protected] */ 18696a45072S[email protected] static hci_connection_t * create_connection_for_bd_addr_and_type(bd_addr_t addr, bd_addr_type_t addr_type){ 1871a06f663S[email protected] log_info("create_connection_for_addr %s, type %x", bd_addr_to_str(addr), addr_type); 188bb69aaaeS[email protected] hci_connection_t * conn = btstack_memory_hci_connection_get(); 18996a45072S[email protected] if (!conn) return NULL; 190058e3d6bSMatthias Ringwald bd_addr_copy(conn->address, addr); 19196a45072S[email protected] conn->address_type = addr_type; 19296a45072S[email protected] conn->con_handle = 0xffff; 19396a45072S[email protected] conn->authentication_flags = AUTH_FLAGS_NONE; 19496a45072S[email protected] conn->bonding_flags = 0; 19596a45072S[email protected] conn->requested_security_level = LEVEL_0; 19652db98b2SMatthias Ringwald #ifdef ENABLE_CLASSIC 19791a977e8SMatthias Ringwald btstack_run_loop_set_timer_handler(&conn->timeout, hci_connection_timeout_handler); 19891a977e8SMatthias Ringwald btstack_run_loop_set_timer_context(&conn->timeout, conn); 19996a45072S[email protected] hci_connection_timestamp(conn); 20052db98b2SMatthias Ringwald #endif 20196a45072S[email protected] conn->acl_recombination_length = 0; 20296a45072S[email protected] conn->acl_recombination_pos = 0; 203ce41473eSMatthias Ringwald conn->num_packets_sent = 0; 204760b20efSMatthias Ringwald 205da886c03S[email protected] conn->le_con_parameter_update_state = CON_PARAMETER_UPDATE_NONE; 206b90f6e0aSMatthias Ringwald #ifdef ENABLE_BLE 207b90f6e0aSMatthias Ringwald conn->le_phy_update_all_phys = 0xff; 208b90f6e0aSMatthias Ringwald #endif 209665d90f2SMatthias Ringwald btstack_linked_list_add(&hci_stack->connections, (btstack_linked_item_t *) conn); 21096a45072S[email protected] return conn; 21196a45072S[email protected] } 21266fb9560S[email protected] 213da886c03S[email protected] 214da886c03S[email protected] /** 215da886c03S[email protected] * get le connection parameter range 216da886c03S[email protected] * 217da886c03S[email protected] * @return le connection parameter range struct 218da886c03S[email protected] */ 2194ced4e8cSMatthias Ringwald void gap_get_connection_parameter_range(le_connection_parameter_range_t * range){ 2204ced4e8cSMatthias Ringwald *range = hci_stack->le_connection_parameter_range; 221da886c03S[email protected] } 222da886c03S[email protected] 223da886c03S[email protected] /** 224da886c03S[email protected] * set le connection parameter range 225da886c03S[email protected] * 226da886c03S[email protected] */ 227da886c03S[email protected] 2284ced4e8cSMatthias Ringwald void gap_set_connection_parameter_range(le_connection_parameter_range_t *range){ 2294ced4e8cSMatthias Ringwald hci_stack->le_connection_parameter_range = *range; 230da886c03S[email protected] } 231da886c03S[email protected] 232da886c03S[email protected] /** 23373cd8a2aSMatthias Ringwald * @brief Test if connection parameters are inside in existing rage 23473cd8a2aSMatthias Ringwald * @param conn_interval_min (unit: 1.25ms) 23573cd8a2aSMatthias Ringwald * @param conn_interval_max (unit: 1.25ms) 23673cd8a2aSMatthias Ringwald * @param conn_latency 23773cd8a2aSMatthias Ringwald * @param supervision_timeout (unit: 10ms) 23873cd8a2aSMatthias Ringwald * @returns 1 if included 23973cd8a2aSMatthias Ringwald */ 24073cd8a2aSMatthias 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){ 24173cd8a2aSMatthias Ringwald if (le_conn_interval_min < existing_range->le_conn_interval_min) return 0; 24273cd8a2aSMatthias Ringwald if (le_conn_interval_max > existing_range->le_conn_interval_max) return 0; 24373cd8a2aSMatthias Ringwald 24473cd8a2aSMatthias Ringwald if (le_conn_latency < existing_range->le_conn_latency_min) return 0; 24573cd8a2aSMatthias Ringwald if (le_conn_latency > existing_range->le_conn_latency_max) return 0; 24673cd8a2aSMatthias Ringwald 24773cd8a2aSMatthias Ringwald if (le_supervision_timeout < existing_range->le_supervision_timeout_min) return 0; 24873cd8a2aSMatthias Ringwald if (le_supervision_timeout > existing_range->le_supervision_timeout_max) return 0; 24973cd8a2aSMatthias Ringwald 25073cd8a2aSMatthias Ringwald return 1; 25173cd8a2aSMatthias Ringwald } 25273cd8a2aSMatthias Ringwald 25373cd8a2aSMatthias Ringwald /** 2542b6ab3e6SMatthias Ringwald * @brief Set max number of connections in LE Peripheral role (if Bluetooth Controller supports it) 2552b6ab3e6SMatthias Ringwald * @note: default: 1 2562b6ab3e6SMatthias Ringwald * @param max_peripheral_connections 2572b6ab3e6SMatthias Ringwald */ 258d4e4907bSMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 2592b6ab3e6SMatthias Ringwald void gap_set_max_number_peripheral_connections(int max_peripheral_connections){ 2602b6ab3e6SMatthias Ringwald hci_stack->le_max_number_peripheral_connections = max_peripheral_connections; 2612b6ab3e6SMatthias Ringwald } 262d4e4907bSMatthias Ringwald #endif 2632b6ab3e6SMatthias Ringwald 2642b6ab3e6SMatthias Ringwald /** 265da886c03S[email protected] * get hci connections iterator 266da886c03S[email protected] * 267da886c03S[email protected] * @return hci connections iterator 268da886c03S[email protected] */ 269da886c03S[email protected] 270665d90f2SMatthias Ringwald void hci_connections_get_iterator(btstack_linked_list_iterator_t *it){ 271665d90f2SMatthias Ringwald btstack_linked_list_iterator_init(it, &hci_stack->connections); 272da886c03S[email protected] } 273da886c03S[email protected] 27497addcc5Smatthias.ringwald /** 275ee091cf1Smatthias.ringwald * get connection for a given handle 276ee091cf1Smatthias.ringwald * 277ee091cf1Smatthias.ringwald * @return connection OR NULL, if not found 278ee091cf1Smatthias.ringwald */ 2795061f3afS[email protected] hci_connection_t * hci_connection_for_handle(hci_con_handle_t con_handle){ 280665d90f2SMatthias Ringwald btstack_linked_list_iterator_t it; 281665d90f2SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->connections); 282665d90f2SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 283665d90f2SMatthias Ringwald hci_connection_t * item = (hci_connection_t *) btstack_linked_list_iterator_next(&it); 2843ac2fe56S[email protected] if ( item->con_handle == con_handle ) { 285da886c03S[email protected] return item; 286ee091cf1Smatthias.ringwald } 287ee091cf1Smatthias.ringwald } 288ee091cf1Smatthias.ringwald return NULL; 289ee091cf1Smatthias.ringwald } 290ee091cf1Smatthias.ringwald 29196a45072S[email protected] /** 29296a45072S[email protected] * get connection for given address 29396a45072S[email protected] * 29496a45072S[email protected] * @return connection OR NULL, if not found 29596a45072S[email protected] */ 2962e77e513S[email protected] hci_connection_t * hci_connection_for_bd_addr_and_type(bd_addr_t addr, bd_addr_type_t addr_type){ 297665d90f2SMatthias Ringwald btstack_linked_list_iterator_t it; 298665d90f2SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->connections); 299665d90f2SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 300665d90f2SMatthias Ringwald hci_connection_t * connection = (hci_connection_t *) btstack_linked_list_iterator_next(&it); 30196a45072S[email protected] if (connection->address_type != addr_type) continue; 30296a45072S[email protected] if (memcmp(addr, connection->address, 6) != 0) continue; 30362bda3fbS[email protected] return connection; 30462bda3fbS[email protected] } 30562bda3fbS[email protected] return NULL; 30662bda3fbS[email protected] } 30762bda3fbS[email protected] 30852db98b2SMatthias Ringwald 30952db98b2SMatthias Ringwald #ifdef ENABLE_CLASSIC 31052db98b2SMatthias Ringwald 311ee752bb8SMatthias Ringwald #ifdef ENABLE_SCO_OVER_HCI 312ee752bb8SMatthias Ringwald static int hci_number_sco_connections(void){ 313ee752bb8SMatthias Ringwald int connections = 0; 314ee752bb8SMatthias Ringwald btstack_linked_list_iterator_t it; 315ee752bb8SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->connections); 316ee752bb8SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 317ee752bb8SMatthias Ringwald hci_connection_t * connection = (hci_connection_t *) btstack_linked_list_iterator_next(&it); 318ee752bb8SMatthias Ringwald if (connection->address_type != BD_ADDR_TYPE_SCO) continue; 319ee752bb8SMatthias Ringwald connections++; 320ee752bb8SMatthias Ringwald } 321ee752bb8SMatthias Ringwald return connections; 322ee752bb8SMatthias Ringwald } 323ee752bb8SMatthias Ringwald #endif 324ee752bb8SMatthias Ringwald 325ec820d77SMatthias Ringwald static void hci_connection_timeout_handler(btstack_timer_source_t *timer){ 32691a977e8SMatthias Ringwald hci_connection_t * connection = (hci_connection_t *) btstack_run_loop_get_timer_context(timer); 327aec7654dSMatthias Ringwald #ifdef HAVE_EMBEDDED_TICK 328528a4a3bSMatthias Ringwald if (btstack_run_loop_embedded_get_ticks() > connection->timestamp + btstack_run_loop_embedded_ticks_for_ms(HCI_CONNECTION_TIMEOUT_MS)){ 329c785ef68Smatthias.ringwald // connections might be timed out 330c785ef68Smatthias.ringwald hci_emit_l2cap_check_timeout(connection); 331c785ef68Smatthias.ringwald } 332f316a845SMatthias Ringwald #else 333528a4a3bSMatthias Ringwald if (btstack_run_loop_get_time_ms() > connection->timestamp + HCI_CONNECTION_TIMEOUT_MS){ 3345f26aadcSMatthias Ringwald // connections might be timed out 3355f26aadcSMatthias Ringwald hci_emit_l2cap_check_timeout(connection); 3365f26aadcSMatthias Ringwald } 3375f26aadcSMatthias Ringwald #endif 338c785ef68Smatthias.ringwald } 339ee091cf1Smatthias.ringwald 340ee091cf1Smatthias.ringwald static void hci_connection_timestamp(hci_connection_t *connection){ 341aec7654dSMatthias Ringwald #ifdef HAVE_EMBEDDED_TICK 342528a4a3bSMatthias Ringwald connection->timestamp = btstack_run_loop_embedded_get_ticks(); 343f316a845SMatthias Ringwald #else 344528a4a3bSMatthias Ringwald connection->timestamp = btstack_run_loop_get_time_ms(); 3455f26aadcSMatthias Ringwald #endif 346ee091cf1Smatthias.ringwald } 347ee091cf1Smatthias.ringwald 34828ca2b46S[email protected] inline static void connectionSetAuthenticationFlags(hci_connection_t * conn, hci_authentication_flags_t flags){ 34928ca2b46S[email protected] conn->authentication_flags = (hci_authentication_flags_t)(conn->authentication_flags | flags); 35028ca2b46S[email protected] } 35128ca2b46S[email protected] 35235454696SMatthias Ringwald 35328ca2b46S[email protected] inline static void connectionClearAuthenticationFlags(hci_connection_t * conn, hci_authentication_flags_t flags){ 35428ca2b46S[email protected] conn->authentication_flags = (hci_authentication_flags_t)(conn->authentication_flags & ~flags); 35528ca2b46S[email protected] } 35628ca2b46S[email protected] 35743bfb1bdSmatthias.ringwald /** 35880ca58a0Smatthias.ringwald * add authentication flags and reset timer 35996a45072S[email protected] * @note: assumes classic connection 3602e77e513S[email protected] * @note: bd_addr is passed in as litle endian uint8_t * as it is called from parsing packets 3617fde4af9Smatthias.ringwald */ 3627fde4af9Smatthias.ringwald static void hci_add_connection_flags_for_flipped_bd_addr(uint8_t *bd_addr, hci_authentication_flags_t flags){ 3637fde4af9Smatthias.ringwald bd_addr_t addr; 364724d70a2SMatthias Ringwald reverse_bd_addr(bd_addr, addr); 3652e77e513S[email protected] hci_connection_t * conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_CLASSIC); 3667fde4af9Smatthias.ringwald if (conn) { 36728ca2b46S[email protected] connectionSetAuthenticationFlags(conn, flags); 36880ca58a0Smatthias.ringwald hci_connection_timestamp(conn); 3697fde4af9Smatthias.ringwald } 3707fde4af9Smatthias.ringwald } 3717fde4af9Smatthias.ringwald 37280ca58a0Smatthias.ringwald int hci_authentication_active_for_handle(hci_con_handle_t handle){ 3735061f3afS[email protected] hci_connection_t * conn = hci_connection_for_handle(handle); 37480ca58a0Smatthias.ringwald if (!conn) return 0; 3756724cd9eS[email protected] if (conn->authentication_flags & LEGACY_PAIRING_ACTIVE) return 1; 3766724cd9eS[email protected] if (conn->authentication_flags & SSP_PAIRING_ACTIVE) return 1; 3776724cd9eS[email protected] return 0; 37880ca58a0Smatthias.ringwald } 37980ca58a0Smatthias.ringwald 38015a95bd5SMatthias Ringwald void gap_drop_link_key_for_bd_addr(bd_addr_t addr){ 38155597469SMatthias Ringwald if (!hci_stack->link_key_db) return; 3822bacf595SMatthias Ringwald log_info("gap_drop_link_key_for_bd_addr: %s", bd_addr_to_str(addr)); 383a98592bcSMatthias Ringwald hci_stack->link_key_db->delete_link_key(addr); 384c12e46e7Smatthias.ringwald } 38555597469SMatthias Ringwald 38655597469SMatthias Ringwald void gap_store_link_key_for_bd_addr(bd_addr_t addr, link_key_t link_key, link_key_type_t type){ 38755597469SMatthias Ringwald if (!hci_stack->link_key_db) return; 3882bacf595SMatthias Ringwald log_info("gap_store_link_key_for_bd_addr: %s, type %u", bd_addr_to_str(addr), type); 38955597469SMatthias Ringwald hci_stack->link_key_db->put_link_key(addr, link_key, type); 390c12e46e7Smatthias.ringwald } 3911b6fb31bSMatthias Ringwald 392ceecb9d9SMatthias Ringwald void gap_delete_all_link_keys(void){ 393ceecb9d9SMatthias Ringwald bd_addr_t addr; 394ceecb9d9SMatthias Ringwald link_key_t link_key; 395ceecb9d9SMatthias Ringwald link_key_type_t type; 396ceecb9d9SMatthias Ringwald btstack_link_key_iterator_t it; 397ceecb9d9SMatthias Ringwald int ok = gap_link_key_iterator_init(&it); 398ceecb9d9SMatthias Ringwald if (!ok) { 399ceecb9d9SMatthias Ringwald log_error("could not initialize iterator"); 400ceecb9d9SMatthias Ringwald return; 401ceecb9d9SMatthias Ringwald } 402ceecb9d9SMatthias Ringwald while (gap_link_key_iterator_get_next(&it, addr, link_key, &type)){ 403ceecb9d9SMatthias Ringwald gap_drop_link_key_for_bd_addr(addr); 404ceecb9d9SMatthias Ringwald } 405ceecb9d9SMatthias Ringwald gap_link_key_iterator_done(&it); 406ceecb9d9SMatthias Ringwald } 407ceecb9d9SMatthias Ringwald 4081b6fb31bSMatthias Ringwald int gap_link_key_iterator_init(btstack_link_key_iterator_t * it){ 4091b6fb31bSMatthias Ringwald if (!hci_stack->link_key_db) return 0; 4101b6fb31bSMatthias Ringwald if (!hci_stack->link_key_db->iterator_init) return 0; 4111b6fb31bSMatthias Ringwald return hci_stack->link_key_db->iterator_init(it); 4121b6fb31bSMatthias Ringwald } 4131b6fb31bSMatthias 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){ 4141b6fb31bSMatthias Ringwald if (!hci_stack->link_key_db) return 0; 4151b6fb31bSMatthias Ringwald return hci_stack->link_key_db->iterator_get_next(it, bd_addr, link_key, type); 4161b6fb31bSMatthias Ringwald } 4171b6fb31bSMatthias Ringwald void gap_link_key_iterator_done(btstack_link_key_iterator_t * it){ 4181b6fb31bSMatthias Ringwald if (!hci_stack->link_key_db) return; 4191b6fb31bSMatthias Ringwald hci_stack->link_key_db->iterator_done(it); 4201b6fb31bSMatthias Ringwald } 42135454696SMatthias Ringwald #endif 422c12e46e7Smatthias.ringwald 42395d71764SMatthias Ringwald static int hci_is_le_connection(hci_connection_t * connection){ 424ce41473eSMatthias Ringwald switch (connection->address_type){ 425ce41473eSMatthias Ringwald case BD_ADDR_TYPE_LE_PUBLIC: 426ce41473eSMatthias Ringwald case BD_ADDR_TYPE_LE_RANDOM: 427ce41473eSMatthias Ringwald case BD_ADDR_TYPE_LE_PRIVAT_FALLBACK_PUBLIC: 428ce41473eSMatthias Ringwald case BD_ADDR_TYPE_LE_PRIVAT_FALLBACK_RANDOM: 429ce41473eSMatthias Ringwald return 1; 430ce41473eSMatthias Ringwald default: 431ce41473eSMatthias Ringwald return 0; 432ce41473eSMatthias Ringwald } 4330bf6344aS[email protected] } 4340bf6344aS[email protected] 4357fde4af9Smatthias.ringwald /** 43643bfb1bdSmatthias.ringwald * count connections 43743bfb1bdSmatthias.ringwald */ 43840d1c7a4Smatthias.ringwald static int nr_hci_connections(void){ 43956c253c9Smatthias.ringwald int count = 0; 440665d90f2SMatthias Ringwald btstack_linked_item_t *it; 441665d90f2SMatthias Ringwald for (it = (btstack_linked_item_t *) hci_stack->connections; it ; it = it->next, count++); 44243bfb1bdSmatthias.ringwald return count; 44343bfb1bdSmatthias.ringwald } 444c8e4258aSmatthias.ringwald 44595d71764SMatthias Ringwald static int hci_number_free_acl_slots_for_connection_type(bd_addr_type_t address_type){ 446ee303eddS[email protected] 447f04a0c31SMatthias Ringwald unsigned int num_packets_sent_classic = 0; 448f04a0c31SMatthias Ringwald unsigned int num_packets_sent_le = 0; 449ee303eddS[email protected] 450665d90f2SMatthias Ringwald btstack_linked_item_t *it; 451665d90f2SMatthias Ringwald for (it = (btstack_linked_item_t *) hci_stack->connections; it ; it = it->next){ 452998906cdSmatthias.ringwald hci_connection_t * connection = (hci_connection_t *) it; 453ce41473eSMatthias Ringwald if (hci_is_le_connection(connection)){ 454ce41473eSMatthias Ringwald num_packets_sent_le += connection->num_packets_sent; 455ce41473eSMatthias Ringwald } 456ee303eddS[email protected] if (connection->address_type == BD_ADDR_TYPE_CLASSIC){ 457ce41473eSMatthias Ringwald num_packets_sent_classic += connection->num_packets_sent; 458ee303eddS[email protected] } 459ee303eddS[email protected] } 460d999b54eSMatthias Ringwald log_debug("ACL classic buffers: %u used of %u", num_packets_sent_classic, hci_stack->acl_packets_total_num); 461ee303eddS[email protected] int free_slots_classic = hci_stack->acl_packets_total_num - num_packets_sent_classic; 462ee303eddS[email protected] int free_slots_le = 0; 463ee303eddS[email protected] 464ee303eddS[email protected] if (free_slots_classic < 0){ 4659da54300S[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); 466998906cdSmatthias.ringwald return 0; 467998906cdSmatthias.ringwald } 468ee303eddS[email protected] 469ee303eddS[email protected] if (hci_stack->le_acl_packets_total_num){ 470ee303eddS[email protected] // if we have LE slots, they are used 471ee303eddS[email protected] free_slots_le = hci_stack->le_acl_packets_total_num - num_packets_sent_le; 472ee303eddS[email protected] if (free_slots_le < 0){ 4739da54300S[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); 474ee303eddS[email protected] return 0; 475998906cdSmatthias.ringwald } 476ee303eddS[email protected] } else { 477ee303eddS[email protected] // otherwise, classic slots are used for LE, too 478ee303eddS[email protected] free_slots_classic -= num_packets_sent_le; 479ee303eddS[email protected] if (free_slots_classic < 0){ 4809da54300S[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); 481ee303eddS[email protected] return 0; 482ee303eddS[email protected] } 483ee303eddS[email protected] } 484ee303eddS[email protected] 485ee303eddS[email protected] switch (address_type){ 486ee303eddS[email protected] case BD_ADDR_TYPE_UNKNOWN: 4872125de09SMatthias Ringwald log_error("hci_number_free_acl_slots: unknown address type"); 488ee303eddS[email protected] return 0; 489ee303eddS[email protected] 490ee303eddS[email protected] case BD_ADDR_TYPE_CLASSIC: 491ee303eddS[email protected] return free_slots_classic; 492ee303eddS[email protected] 493ee303eddS[email protected] default: 494cb00d3aaS[email protected] if (hci_stack->le_acl_packets_total_num){ 495ee303eddS[email protected] return free_slots_le; 496ee303eddS[email protected] } 497cb00d3aaS[email protected] return free_slots_classic; 498cb00d3aaS[email protected] } 499998906cdSmatthias.ringwald } 500998906cdSmatthias.ringwald 5012125de09SMatthias Ringwald int hci_number_free_acl_slots_for_handle(hci_con_handle_t con_handle){ 5022125de09SMatthias Ringwald // get connection type 5032125de09SMatthias Ringwald hci_connection_t * connection = hci_connection_for_handle(con_handle); 5042125de09SMatthias Ringwald if (!connection){ 5052125de09SMatthias Ringwald log_error("hci_number_free_acl_slots: handle 0x%04x not in connection list", con_handle); 5062125de09SMatthias Ringwald return 0; 5072125de09SMatthias Ringwald } 5082125de09SMatthias Ringwald return hci_number_free_acl_slots_for_connection_type(connection->address_type); 5092125de09SMatthias Ringwald } 5102125de09SMatthias Ringwald 51135454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 512701e3307SMatthias Ringwald static int hci_number_free_sco_slots(void){ 513f04a0c31SMatthias Ringwald unsigned int num_sco_packets_sent = 0; 514665d90f2SMatthias Ringwald btstack_linked_item_t *it; 515760b20efSMatthias Ringwald if (hci_stack->synchronous_flow_control_enabled){ 516760b20efSMatthias Ringwald // explicit flow control 517665d90f2SMatthias Ringwald for (it = (btstack_linked_item_t *) hci_stack->connections; it ; it = it->next){ 518e35edcc1S[email protected] hci_connection_t * connection = (hci_connection_t *) it; 519ce41473eSMatthias Ringwald if (connection->address_type != BD_ADDR_TYPE_SCO) continue; 520ce41473eSMatthias Ringwald num_sco_packets_sent += connection->num_packets_sent; 521e35edcc1S[email protected] } 522e35edcc1S[email protected] if (num_sco_packets_sent > hci_stack->sco_packets_total_num){ 523701e3307SMatthias Ringwald log_info("hci_number_free_sco_slots:packets (%u) > total packets (%u)", num_sco_packets_sent, hci_stack->sco_packets_total_num); 52444d0e3d5S[email protected] return 0; 52544d0e3d5S[email protected] } 526e35edcc1S[email protected] return hci_stack->sco_packets_total_num - num_sco_packets_sent; 52749205f5dSMatthias Ringwald } else { 52849205f5dSMatthias Ringwald // implicit flow control -- TODO 5296f28d2eeSMatthias Ringwald int num_ready = 0; 5306f28d2eeSMatthias Ringwald for (it = (btstack_linked_item_t *) hci_stack->connections; it ; it = it->next){ 5316f28d2eeSMatthias Ringwald hci_connection_t * connection = (hci_connection_t *) it; 5326f28d2eeSMatthias Ringwald if (connection->address_type != BD_ADDR_TYPE_SCO) continue; 5336f28d2eeSMatthias Ringwald if (connection->sco_tx_ready == 0) continue; 5346f28d2eeSMatthias Ringwald num_ready++; 53549205f5dSMatthias Ringwald } 5366f28d2eeSMatthias Ringwald return num_ready; 5376f28d2eeSMatthias Ringwald } 538e35edcc1S[email protected] } 53935454696SMatthias Ringwald #endif 54044d0e3d5S[email protected] 5412b838201SMatthias Ringwald // only used to send HCI Host Number Completed Packets 5422b838201SMatthias Ringwald static int hci_can_send_comand_packet_transport(void){ 543ac928cc2S[email protected] if (hci_stack->hci_packet_buffer_reserved) return 0; 544ac928cc2S[email protected] 545ac928cc2S[email protected] // check for async hci transport implementations 546ac928cc2S[email protected] if (hci_stack->hci_transport->can_send_packet_now){ 547ac928cc2S[email protected] if (!hci_stack->hci_transport->can_send_packet_now(HCI_COMMAND_DATA_PACKET)){ 548ac928cc2S[email protected] return 0; 549ac928cc2S[email protected] } 550ac928cc2S[email protected] } 5512b838201SMatthias Ringwald return 1; 5522b838201SMatthias Ringwald } 553ac928cc2S[email protected] 5542b838201SMatthias Ringwald // new functions replacing hci_can_send_packet_now[_using_packet_buffer] 5552b838201SMatthias Ringwald int hci_can_send_command_packet_now(void){ 5562b838201SMatthias Ringwald if (hci_can_send_comand_packet_transport() == 0) return 0; 557ac928cc2S[email protected] return hci_stack->num_cmd_packets > 0; 558ac928cc2S[email protected] } 559ac928cc2S[email protected] 5609d04d3a7SMatthias Ringwald static int hci_transport_can_send_prepared_packet_now(uint8_t packet_type){ 561ac928cc2S[email protected] // check for async hci transport implementations 5629d04d3a7SMatthias Ringwald if (!hci_stack->hci_transport->can_send_packet_now) return 1; 5639d04d3a7SMatthias Ringwald return hci_stack->hci_transport->can_send_packet_now(packet_type); 564ac928cc2S[email protected] } 5659d04d3a7SMatthias Ringwald 5669d04d3a7SMatthias Ringwald static int hci_can_send_prepared_acl_packet_for_address_type(bd_addr_type_t address_type){ 5679d04d3a7SMatthias Ringwald if (!hci_transport_can_send_prepared_packet_now(HCI_ACL_DATA_PACKET)) return 0; 5689d04d3a7SMatthias Ringwald return hci_number_free_acl_slots_for_connection_type(address_type) > 0; 569ac928cc2S[email protected] } 5709d04d3a7SMatthias Ringwald 5719d04d3a7SMatthias Ringwald int hci_can_send_acl_le_packet_now(void){ 5729d04d3a7SMatthias Ringwald if (hci_stack->hci_packet_buffer_reserved) return 0; 5739d04d3a7SMatthias Ringwald return hci_can_send_prepared_acl_packet_for_address_type(BD_ADDR_TYPE_LE_PUBLIC); 5749d04d3a7SMatthias Ringwald } 5759d04d3a7SMatthias Ringwald 5769d04d3a7SMatthias Ringwald int hci_can_send_prepared_acl_packet_now(hci_con_handle_t con_handle) { 5779d04d3a7SMatthias Ringwald if (!hci_transport_can_send_prepared_packet_now(HCI_ACL_DATA_PACKET)) return 0; 578e79abdd6S[email protected] return hci_number_free_acl_slots_for_handle(con_handle) > 0; 579ac928cc2S[email protected] } 580ac928cc2S[email protected] 581ac928cc2S[email protected] int hci_can_send_acl_packet_now(hci_con_handle_t con_handle){ 582ac928cc2S[email protected] if (hci_stack->hci_packet_buffer_reserved) return 0; 583ac928cc2S[email protected] return hci_can_send_prepared_acl_packet_now(con_handle); 5846b4af23dS[email protected] } 5856b4af23dS[email protected] 58635454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 58735454696SMatthias Ringwald int hci_can_send_acl_classic_packet_now(void){ 58835454696SMatthias Ringwald if (hci_stack->hci_packet_buffer_reserved) return 0; 58935454696SMatthias Ringwald return hci_can_send_prepared_acl_packet_for_address_type(BD_ADDR_TYPE_CLASSIC); 59035454696SMatthias Ringwald } 59135454696SMatthias Ringwald 592701e3307SMatthias Ringwald int hci_can_send_prepared_sco_packet_now(void){ 593d057580eSMatthias Ringwald if (!hci_transport_can_send_prepared_packet_now(HCI_SCO_DATA_PACKET)) return 0; 594f234b250SMatthias Ringwald if (hci_have_usb_transport()){ 595f234b250SMatthias Ringwald return hci_stack->sco_can_send_now; 596f234b250SMatthias Ringwald } else { 597701e3307SMatthias Ringwald return hci_number_free_sco_slots() > 0; 59844d0e3d5S[email protected] } 599f234b250SMatthias Ringwald } 60044d0e3d5S[email protected] 601701e3307SMatthias Ringwald int hci_can_send_sco_packet_now(void){ 602d057580eSMatthias Ringwald if (hci_stack->hci_packet_buffer_reserved) return 0; 603701e3307SMatthias Ringwald return hci_can_send_prepared_sco_packet_now(); 60444d0e3d5S[email protected] } 60544d0e3d5S[email protected] 606d057580eSMatthias Ringwald void hci_request_sco_can_send_now_event(void){ 607d057580eSMatthias Ringwald hci_stack->sco_waiting_for_can_send_now = 1; 608d057580eSMatthias Ringwald hci_notify_if_sco_can_send_now(); 609d057580eSMatthias Ringwald } 61035454696SMatthias Ringwald #endif 611d057580eSMatthias Ringwald 61295d71764SMatthias Ringwald // used for internal checks in l2cap.c 613c8b9416aS[email protected] int hci_is_packet_buffer_reserved(void){ 614c8b9416aS[email protected] return hci_stack->hci_packet_buffer_reserved; 615c8b9416aS[email protected] } 616c8b9416aS[email protected] 6176b4af23dS[email protected] // reserves outgoing packet buffer. @returns 1 if successful 6186b4af23dS[email protected] int hci_reserve_packet_buffer(void){ 6199d14b626S[email protected] if (hci_stack->hci_packet_buffer_reserved) { 6209d14b626S[email protected] log_error("hci_reserve_packet_buffer called but buffer already reserved"); 6219d14b626S[email protected] return 0; 6229d14b626S[email protected] } 6236b4af23dS[email protected] hci_stack->hci_packet_buffer_reserved = 1; 6246b4af23dS[email protected] return 1; 6256b4af23dS[email protected] } 6266b4af23dS[email protected] 62768a0fcf7S[email protected] void hci_release_packet_buffer(void){ 62868a0fcf7S[email protected] hci_stack->hci_packet_buffer_reserved = 0; 62968a0fcf7S[email protected] } 63068a0fcf7S[email protected] 6316b4af23dS[email protected] // assumption: synchronous implementations don't provide can_send_packet_now as they don't keep the buffer after the call 6327f02f414SMatthias Ringwald static int hci_transport_synchronous(void){ 6336b4af23dS[email protected] return hci_stack->hci_transport->can_send_packet_now == NULL; 6346b4af23dS[email protected] } 6356b4af23dS[email protected] 636452cf3bbS[email protected] static int hci_send_acl_packet_fragments(hci_connection_t *connection){ 637452cf3bbS[email protected] 638452cf3bbS[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); 639452cf3bbS[email protected] 640452cf3bbS[email protected] // max ACL data packet length depends on connection type (LE vs. Classic) and available buffers 641452cf3bbS[email protected] uint16_t max_acl_data_packet_length = hci_stack->acl_data_packet_length; 642452cf3bbS[email protected] if (hci_is_le_connection(connection) && hci_stack->le_data_packets_length > 0){ 643452cf3bbS[email protected] max_acl_data_packet_length = hci_stack->le_data_packets_length; 644452cf3bbS[email protected] } 645452cf3bbS[email protected] 646452cf3bbS[email protected] // testing: reduce buffer to minimum 647452cf3bbS[email protected] // max_acl_data_packet_length = 52; 648452cf3bbS[email protected] 649d999b54eSMatthias Ringwald log_debug("hci_send_acl_packet_fragments entered"); 650d999b54eSMatthias Ringwald 651452cf3bbS[email protected] int err; 652452cf3bbS[email protected] // multiple packets could be send on a synchronous HCI transport 653452cf3bbS[email protected] while (1){ 654452cf3bbS[email protected] 655d999b54eSMatthias Ringwald log_debug("hci_send_acl_packet_fragments loop entered"); 656d999b54eSMatthias Ringwald 657452cf3bbS[email protected] // get current data 658452cf3bbS[email protected] const uint16_t acl_header_pos = hci_stack->acl_fragmentation_pos - 4; 659452cf3bbS[email protected] int current_acl_data_packet_length = hci_stack->acl_fragmentation_total_size - hci_stack->acl_fragmentation_pos; 660452cf3bbS[email protected] int more_fragments = 0; 661452cf3bbS[email protected] 662452cf3bbS[email protected] // if ACL packet is larger than Bluetooth packet buffer, only send max_acl_data_packet_length 663452cf3bbS[email protected] if (current_acl_data_packet_length > max_acl_data_packet_length){ 664452cf3bbS[email protected] more_fragments = 1; 665452cf3bbS[email protected] current_acl_data_packet_length = max_acl_data_packet_length; 666452cf3bbS[email protected] } 667452cf3bbS[email protected] 668452cf3bbS[email protected] // copy handle_and_flags if not first fragment and update packet boundary flags to be 01 (continuing fragmnent) 669452cf3bbS[email protected] if (acl_header_pos > 0){ 670f8fbdce0SMatthias Ringwald uint16_t handle_and_flags = little_endian_read_16(hci_stack->hci_packet_buffer, 0); 671452cf3bbS[email protected] handle_and_flags = (handle_and_flags & 0xcfff) | (1 << 12); 672f8fbdce0SMatthias Ringwald little_endian_store_16(hci_stack->hci_packet_buffer, acl_header_pos, handle_and_flags); 673452cf3bbS[email protected] } 674452cf3bbS[email protected] 675452cf3bbS[email protected] // update header len 676f8fbdce0SMatthias Ringwald little_endian_store_16(hci_stack->hci_packet_buffer, acl_header_pos + 2, current_acl_data_packet_length); 677452cf3bbS[email protected] 678452cf3bbS[email protected] // count packet 679ce41473eSMatthias Ringwald connection->num_packets_sent++; 680f04a0c31SMatthias Ringwald log_debug("hci_send_acl_packet_fragments loop before send (more fragments %d)", more_fragments); 681d999b54eSMatthias Ringwald 682d999b54eSMatthias Ringwald // update state for next fragment (if any) as "transport done" might be sent during send_packet already 683d999b54eSMatthias Ringwald if (more_fragments){ 684d999b54eSMatthias Ringwald // update start of next fragment to send 685d999b54eSMatthias Ringwald hci_stack->acl_fragmentation_pos += current_acl_data_packet_length; 686d999b54eSMatthias Ringwald } else { 687d999b54eSMatthias Ringwald // done 688d999b54eSMatthias Ringwald hci_stack->acl_fragmentation_pos = 0; 689d999b54eSMatthias Ringwald hci_stack->acl_fragmentation_total_size = 0; 690d999b54eSMatthias Ringwald } 691452cf3bbS[email protected] 692452cf3bbS[email protected] // send packet 693452cf3bbS[email protected] uint8_t * packet = &hci_stack->hci_packet_buffer[acl_header_pos]; 694452cf3bbS[email protected] const int size = current_acl_data_packet_length + 4; 6955bb5bc3eS[email protected] hci_dump_packet(HCI_ACL_DATA_PACKET, 0, packet, size); 69681d2bdb2SMatthias Ringwald hci_stack->acl_fragmentation_tx_active = 1; 697452cf3bbS[email protected] err = hci_stack->hci_transport->send_packet(HCI_ACL_DATA_PACKET, packet, size); 698452cf3bbS[email protected] 699f04a0c31SMatthias Ringwald log_debug("hci_send_acl_packet_fragments loop after send (more fragments %d)", more_fragments); 700d999b54eSMatthias Ringwald 701452cf3bbS[email protected] // done yet? 702452cf3bbS[email protected] if (!more_fragments) break; 703452cf3bbS[email protected] 704452cf3bbS[email protected] // can send more? 705452cf3bbS[email protected] if (!hci_can_send_prepared_acl_packet_now(connection->con_handle)) return err; 706452cf3bbS[email protected] } 707452cf3bbS[email protected] 708d999b54eSMatthias Ringwald log_debug("hci_send_acl_packet_fragments loop over"); 709452cf3bbS[email protected] 710d051460cS[email protected] // release buffer now for synchronous transport 711203bace6S[email protected] if (hci_transport_synchronous()){ 71281d2bdb2SMatthias Ringwald hci_stack->acl_fragmentation_tx_active = 0; 713452cf3bbS[email protected] hci_release_packet_buffer(); 714fd43c0e0SMatthias Ringwald hci_emit_transport_packet_sent(); 715452cf3bbS[email protected] } 716452cf3bbS[email protected] 717452cf3bbS[email protected] return err; 718452cf3bbS[email protected] } 719452cf3bbS[email protected] 720826f7347S[email protected] // pre: caller has reserved the packet buffer 721826f7347S[email protected] int hci_send_acl_packet_buffer(int size){ 7227856c818Smatthias.ringwald 723452cf3bbS[email protected] // log_info("hci_send_acl_packet_buffer size %u", size); 724452cf3bbS[email protected] 725826f7347S[email protected] if (!hci_stack->hci_packet_buffer_reserved) { 726826f7347S[email protected] log_error("hci_send_acl_packet_buffer called without reserving packet buffer"); 727826f7347S[email protected] return 0; 728826f7347S[email protected] } 729826f7347S[email protected] 730d713a683S[email protected] uint8_t * packet = hci_stack->hci_packet_buffer; 731d713a683S[email protected] hci_con_handle_t con_handle = READ_ACL_CONNECTION_HANDLE(packet); 732d713a683S[email protected] 733826f7347S[email protected] // check for free places on Bluetooth module 734d713a683S[email protected] if (!hci_can_send_prepared_acl_packet_now(con_handle)) { 735826f7347S[email protected] log_error("hci_send_acl_packet_buffer called but no free ACL buffers on controller"); 73697b61c7bS[email protected] hci_release_packet_buffer(); 737068b8592SMatthias Ringwald hci_emit_transport_packet_sent(); 73897b61c7bS[email protected] return BTSTACK_ACL_BUFFERS_FULL; 73997b61c7bS[email protected] } 7406218e6f1Smatthias.ringwald 7415061f3afS[email protected] hci_connection_t *connection = hci_connection_for_handle( con_handle); 74297b61c7bS[email protected] if (!connection) { 7435fa0b7cfS[email protected] log_error("hci_send_acl_packet_buffer called but no connection for handle 0x%04x", con_handle); 74497b61c7bS[email protected] hci_release_packet_buffer(); 745068b8592SMatthias Ringwald hci_emit_transport_packet_sent(); 74697b61c7bS[email protected] return 0; 74797b61c7bS[email protected] } 74852db98b2SMatthias Ringwald 74952db98b2SMatthias Ringwald #ifdef ENABLE_CLASSIC 75056cf178bSmatthias.ringwald hci_connection_timestamp(connection); 75152db98b2SMatthias Ringwald #endif 75256cf178bSmatthias.ringwald 753452cf3bbS[email protected] // hci_dump_packet( HCI_ACL_DATA_PACKET, 0, packet, size); 7547856c818Smatthias.ringwald 755452cf3bbS[email protected] // setup data 756452cf3bbS[email protected] hci_stack->acl_fragmentation_total_size = size; 757452cf3bbS[email protected] hci_stack->acl_fragmentation_pos = 4; // start of L2CAP packet 7586218e6f1Smatthias.ringwald 759452cf3bbS[email protected] return hci_send_acl_packet_fragments(connection); 760ee091cf1Smatthias.ringwald } 761ee091cf1Smatthias.ringwald 76235454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 76344d0e3d5S[email protected] // pre: caller has reserved the packet buffer 76444d0e3d5S[email protected] int hci_send_sco_packet_buffer(int size){ 76544d0e3d5S[email protected] 76644d0e3d5S[email protected] // log_info("hci_send_acl_packet_buffer size %u", size); 76744d0e3d5S[email protected] 76844d0e3d5S[email protected] if (!hci_stack->hci_packet_buffer_reserved) { 76944d0e3d5S[email protected] log_error("hci_send_acl_packet_buffer called without reserving packet buffer"); 77044d0e3d5S[email protected] return 0; 77144d0e3d5S[email protected] } 77244d0e3d5S[email protected] 77344d0e3d5S[email protected] uint8_t * packet = hci_stack->hci_packet_buffer; 7744b3e1e19SMatthias Ringwald 7754b3e1e19SMatthias Ringwald // skip checks in loopback mode 7764b3e1e19SMatthias Ringwald if (!hci_stack->loopback_mode){ 77744d0e3d5S[email protected] hci_con_handle_t con_handle = READ_ACL_CONNECTION_HANDLE(packet); // same for ACL and SCO 77844d0e3d5S[email protected] 77944d0e3d5S[email protected] // check for free places on Bluetooth module 780701e3307SMatthias Ringwald if (!hci_can_send_prepared_sco_packet_now()) { 781cbf638a9SMatthias Ringwald log_error("hci_send_sco_packet_buffer called but no free SCO buffers on controller"); 78244d0e3d5S[email protected] hci_release_packet_buffer(); 783068b8592SMatthias Ringwald hci_emit_transport_packet_sent(); 78444d0e3d5S[email protected] return BTSTACK_ACL_BUFFERS_FULL; 78544d0e3d5S[email protected] } 78644d0e3d5S[email protected] 787e35edcc1S[email protected] // track send packet in connection struct 788e35edcc1S[email protected] hci_connection_t *connection = hci_connection_for_handle( con_handle); 789e35edcc1S[email protected] if (!connection) { 790e35edcc1S[email protected] log_error("hci_send_sco_packet_buffer called but no connection for handle 0x%04x", con_handle); 791e35edcc1S[email protected] hci_release_packet_buffer(); 792068b8592SMatthias Ringwald hci_emit_transport_packet_sent(); 793e35edcc1S[email protected] return 0; 794e35edcc1S[email protected] } 795f234b250SMatthias Ringwald 796f234b250SMatthias Ringwald if (hci_have_usb_transport()){ 797f234b250SMatthias Ringwald // token used 798f234b250SMatthias Ringwald hci_stack->sco_can_send_now = 0; 799f234b250SMatthias Ringwald } else { 800760b20efSMatthias Ringwald if (hci_stack->synchronous_flow_control_enabled){ 801ce41473eSMatthias Ringwald connection->num_packets_sent++; 8026f28d2eeSMatthias Ringwald } else { 803e4157653SMatthias Ringwald connection->sco_tx_ready--; 804760b20efSMatthias Ringwald } 8054b3e1e19SMatthias Ringwald } 806f234b250SMatthias Ringwald } 80744d0e3d5S[email protected] 80844d0e3d5S[email protected] hci_dump_packet( HCI_SCO_DATA_PACKET, 0, packet, size); 809543e835cSMatthias Ringwald int err = hci_stack->hci_transport->send_packet(HCI_SCO_DATA_PACKET, packet, size); 810543e835cSMatthias Ringwald 811543e835cSMatthias Ringwald if (hci_transport_synchronous()){ 812543e835cSMatthias Ringwald hci_release_packet_buffer(); 813fd43c0e0SMatthias Ringwald hci_emit_transport_packet_sent(); 814543e835cSMatthias Ringwald } 815543e835cSMatthias Ringwald 816543e835cSMatthias Ringwald return err; 81744d0e3d5S[email protected] } 81835454696SMatthias Ringwald #endif 81944d0e3d5S[email protected] 82016833f0aSmatthias.ringwald static void acl_handler(uint8_t *packet, int size){ 8217856c818Smatthias.ringwald 822e76a89eeS[email protected] // log_info("acl_handler: size %u", size); 823e76a89eeS[email protected] 8247856c818Smatthias.ringwald // get info 8257856c818Smatthias.ringwald hci_con_handle_t con_handle = READ_ACL_CONNECTION_HANDLE(packet); 8265061f3afS[email protected] hci_connection_t *conn = hci_connection_for_handle(con_handle); 8277856c818Smatthias.ringwald uint8_t acl_flags = READ_ACL_FLAGS(packet); 8287856c818Smatthias.ringwald uint16_t acl_length = READ_ACL_LENGTH(packet); 8297856c818Smatthias.ringwald 8307856c818Smatthias.ringwald // ignore non-registered handle 8317856c818Smatthias.ringwald if (!conn){ 8329da54300S[email protected] log_error( "hci.c: acl_handler called with non-registered handle %u!" , con_handle); 8337856c818Smatthias.ringwald return; 8347856c818Smatthias.ringwald } 8357856c818Smatthias.ringwald 836e76a89eeS[email protected] // assert packet is complete 8379ecc3e17S[email protected] if (acl_length + 4 != size){ 838f04a0c31SMatthias Ringwald log_error("hci.c: acl_handler called with ACL packet of wrong size %d, expected %u => dropping packet", size, acl_length + 4); 839e76a89eeS[email protected] return; 840e76a89eeS[email protected] } 841e76a89eeS[email protected] 84252db98b2SMatthias Ringwald #ifdef ENABLE_CLASSIC 8437856c818Smatthias.ringwald // update idle timestamp 8447856c818Smatthias.ringwald hci_connection_timestamp(conn); 84552db98b2SMatthias Ringwald #endif 8467856c818Smatthias.ringwald 8472b838201SMatthias Ringwald #ifdef ENABLE_HCI_CONTROLLER_TO_HOST_FLOW_CONTROL 8482b838201SMatthias Ringwald hci_stack->host_completed_packets = 1; 8492b838201SMatthias Ringwald conn->num_packets_completed++; 8502b838201SMatthias Ringwald #endif 8512b838201SMatthias Ringwald 8527856c818Smatthias.ringwald // handle different packet types 8537856c818Smatthias.ringwald switch (acl_flags & 0x03) { 8547856c818Smatthias.ringwald 8557856c818Smatthias.ringwald case 0x01: // continuation fragment 8567856c818Smatthias.ringwald 8570ca847afS[email protected] // sanity checks 8587856c818Smatthias.ringwald if (conn->acl_recombination_pos == 0) { 8599da54300S[email protected] log_error( "ACL Cont Fragment but no first fragment for handle 0x%02x", con_handle); 8607856c818Smatthias.ringwald return; 8617856c818Smatthias.ringwald } 8620ca847afS[email protected] if (conn->acl_recombination_pos + acl_length > 4 + HCI_ACL_BUFFER_SIZE){ 8630ca847afS[email protected] log_error( "ACL Cont Fragment to large: combined packet %u > buffer size %u for handle 0x%02x", 8640ca847afS[email protected] conn->acl_recombination_pos + acl_length, 4 + HCI_ACL_BUFFER_SIZE, con_handle); 8650ca847afS[email protected] conn->acl_recombination_pos = 0; 8660ca847afS[email protected] return; 8670ca847afS[email protected] } 8687856c818Smatthias.ringwald 8697856c818Smatthias.ringwald // append fragment payload (header already stored) 870ec6321eeS[email protected] memcpy(&conn->acl_recombination_buffer[HCI_INCOMING_PRE_BUFFER_SIZE + conn->acl_recombination_pos], &packet[4], acl_length ); 8717856c818Smatthias.ringwald conn->acl_recombination_pos += acl_length; 8727856c818Smatthias.ringwald 8739da54300S[email protected] // log_error( "ACL Cont Fragment: acl_len %u, combined_len %u, l2cap_len %u", acl_length, 874decc01a8Smatthias.ringwald // conn->acl_recombination_pos, conn->acl_recombination_length); 8757856c818Smatthias.ringwald 8767856c818Smatthias.ringwald // forward complete L2CAP packet if complete. 8777856c818Smatthias.ringwald if (conn->acl_recombination_pos >= conn->acl_recombination_length + 4 + 4){ // pos already incl. ACL header 878d6b06661SMatthias Ringwald hci_emit_acl_packet(&conn->acl_recombination_buffer[HCI_INCOMING_PRE_BUFFER_SIZE], conn->acl_recombination_pos); 8797856c818Smatthias.ringwald // reset recombination buffer 8807856c818Smatthias.ringwald conn->acl_recombination_length = 0; 8817856c818Smatthias.ringwald conn->acl_recombination_pos = 0; 8827856c818Smatthias.ringwald } 8837856c818Smatthias.ringwald break; 8847856c818Smatthias.ringwald 8857856c818Smatthias.ringwald case 0x02: { // first fragment 8867856c818Smatthias.ringwald 88723a77e1aS[email protected] // sanity check 88823a77e1aS[email protected] if (conn->acl_recombination_pos) { 88923a77e1aS[email protected] log_error( "ACL First Fragment but data in buffer for handle 0x%02x, dropping stale fragments", con_handle); 89023a77e1aS[email protected] conn->acl_recombination_pos = 0; 89123a77e1aS[email protected] } 89223a77e1aS[email protected] 8937856c818Smatthias.ringwald // peek into L2CAP packet! 8947856c818Smatthias.ringwald uint16_t l2cap_length = READ_L2CAP_LENGTH( packet ); 8957856c818Smatthias.ringwald 8969da54300S[email protected] // log_info( "ACL First Fragment: acl_len %u, l2cap_len %u", acl_length, l2cap_length); 897decc01a8Smatthias.ringwald 8987856c818Smatthias.ringwald // compare fragment size to L2CAP packet size 8997856c818Smatthias.ringwald if (acl_length >= l2cap_length + 4){ 9007856c818Smatthias.ringwald // forward fragment as L2CAP packet 901d6b06661SMatthias Ringwald hci_emit_acl_packet(packet, acl_length + 4); 9027856c818Smatthias.ringwald } else { 9030ca847afS[email protected] 9040ca847afS[email protected] if (acl_length > HCI_ACL_BUFFER_SIZE){ 9050ca847afS[email protected] log_error( "ACL First Fragment to large: fragment %u > buffer size %u for handle 0x%02x", 9060ca847afS[email protected] 4 + acl_length, 4 + HCI_ACL_BUFFER_SIZE, con_handle); 9070ca847afS[email protected] return; 9080ca847afS[email protected] } 9090ca847afS[email protected] 9107856c818Smatthias.ringwald // store first fragment and tweak acl length for complete package 911ec6321eeS[email protected] memcpy(&conn->acl_recombination_buffer[HCI_INCOMING_PRE_BUFFER_SIZE], packet, acl_length + 4); 9127856c818Smatthias.ringwald conn->acl_recombination_pos = acl_length + 4; 9137856c818Smatthias.ringwald conn->acl_recombination_length = l2cap_length; 914f8fbdce0SMatthias Ringwald little_endian_store_16(conn->acl_recombination_buffer, HCI_INCOMING_PRE_BUFFER_SIZE + 2, l2cap_length +4); 9157856c818Smatthias.ringwald } 9167856c818Smatthias.ringwald break; 9177856c818Smatthias.ringwald 9187856c818Smatthias.ringwald } 9197856c818Smatthias.ringwald default: 9209da54300S[email protected] log_error( "hci.c: acl_handler called with invalid packet boundary flags %u", acl_flags & 0x03); 9217856c818Smatthias.ringwald return; 9227856c818Smatthias.ringwald } 92394ab26f8Smatthias.ringwald 92494ab26f8Smatthias.ringwald // execute main loop 92594ab26f8Smatthias.ringwald hci_run(); 92616833f0aSmatthias.ringwald } 92722909952Smatthias.ringwald 92867a3e8ecSmatthias.ringwald static void hci_shutdown_connection(hci_connection_t *conn){ 9299da54300S[email protected] log_info("Connection closed: handle 0x%x, %s", conn->con_handle, bd_addr_to_str(conn->address)); 9303c4d4b90Smatthias.ringwald 931b3264428SMatthias Ringwald #ifdef ENABLE_CLASSIC 932ee752bb8SMatthias Ringwald #ifdef ENABLE_SCO_OVER_HCI 933ee752bb8SMatthias Ringwald int addr_type = conn->address_type; 934ee752bb8SMatthias Ringwald #endif 935b3264428SMatthias Ringwald #endif 936ee752bb8SMatthias Ringwald 937528a4a3bSMatthias Ringwald btstack_run_loop_remove_timer(&conn->timeout); 938c785ef68Smatthias.ringwald 939665d90f2SMatthias Ringwald btstack_linked_list_remove(&hci_stack->connections, (btstack_linked_item_t *) conn); 940a3b02b71Smatthias.ringwald btstack_memory_hci_connection_free( conn ); 9413c4d4b90Smatthias.ringwald 9423c4d4b90Smatthias.ringwald // now it's gone 943c7e0c5f6Smatthias.ringwald hci_emit_nr_connections_changed(); 944ee752bb8SMatthias Ringwald 945b3264428SMatthias Ringwald #ifdef ENABLE_CLASSIC 946034e9b53SMatthias Ringwald #ifdef ENABLE_SCO_OVER_HCI 947ee752bb8SMatthias Ringwald // update SCO 948ee752bb8SMatthias Ringwald if (addr_type == BD_ADDR_TYPE_SCO && hci_stack->hci_transport && hci_stack->hci_transport->set_sco_config){ 949ee752bb8SMatthias Ringwald hci_stack->hci_transport->set_sco_config(hci_stack->sco_voice_setting_active, hci_number_sco_connections()); 950ee752bb8SMatthias Ringwald } 951034e9b53SMatthias Ringwald #endif 952b3264428SMatthias Ringwald #endif 953c7e0c5f6Smatthias.ringwald } 954c7e0c5f6Smatthias.ringwald 95535454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 95635454696SMatthias Ringwald 9570c042179S[email protected] static const uint16_t packet_type_sizes[] = { 9588f8108aaSmatthias.ringwald 0, HCI_ACL_2DH1_SIZE, HCI_ACL_3DH1_SIZE, HCI_ACL_DM1_SIZE, 9598f8108aaSmatthias.ringwald HCI_ACL_DH1_SIZE, 0, 0, 0, 9608f8108aaSmatthias.ringwald HCI_ACL_2DH3_SIZE, HCI_ACL_3DH3_SIZE, HCI_ACL_DM3_SIZE, HCI_ACL_DH3_SIZE, 9618f8108aaSmatthias.ringwald HCI_ACL_2DH5_SIZE, HCI_ACL_3DH5_SIZE, HCI_ACL_DM5_SIZE, HCI_ACL_DH5_SIZE 9628f8108aaSmatthias.ringwald }; 96365389bfcS[email protected] static const uint8_t packet_type_feature_requirement_bit[] = { 96465389bfcS[email protected] 0, // 3 slot packets 96565389bfcS[email protected] 1, // 5 slot packets 96665389bfcS[email protected] 25, // EDR 2 mpbs 96765389bfcS[email protected] 26, // EDR 3 mbps 96865389bfcS[email protected] 39, // 3 slot EDR packts 96965389bfcS[email protected] 40, // 5 slot EDR packet 97065389bfcS[email protected] }; 97165389bfcS[email protected] static const uint16_t packet_type_feature_packet_mask[] = { 97265389bfcS[email protected] 0x0f00, // 3 slot packets 97365389bfcS[email protected] 0xf000, // 5 slot packets 97465389bfcS[email protected] 0x1102, // EDR 2 mpbs 97565389bfcS[email protected] 0x2204, // EDR 3 mbps 97665389bfcS[email protected] 0x0300, // 3 slot EDR packts 97765389bfcS[email protected] 0x3000, // 5 slot EDR packet 97865389bfcS[email protected] }; 9798f8108aaSmatthias.ringwald 98065389bfcS[email protected] static uint16_t hci_acl_packet_types_for_buffer_size_and_local_features(uint16_t buffer_size, uint8_t * local_supported_features){ 98165389bfcS[email protected] // enable packet types based on size 9828f8108aaSmatthias.ringwald uint16_t packet_types = 0; 983f16a69bbS[email protected] unsigned int i; 9848f8108aaSmatthias.ringwald for (i=0;i<16;i++){ 9858f8108aaSmatthias.ringwald if (packet_type_sizes[i] == 0) continue; 9868f8108aaSmatthias.ringwald if (packet_type_sizes[i] <= buffer_size){ 9878f8108aaSmatthias.ringwald packet_types |= 1 << i; 9888f8108aaSmatthias.ringwald } 9898f8108aaSmatthias.ringwald } 99065389bfcS[email protected] // disable packet types due to missing local supported features 99165389bfcS[email protected] for (i=0;i<sizeof(packet_type_feature_requirement_bit);i++){ 992f04a0c31SMatthias Ringwald unsigned int bit_idx = packet_type_feature_requirement_bit[i]; 99365389bfcS[email protected] int feature_set = (local_supported_features[bit_idx >> 3] & (1<<(bit_idx & 7))) != 0; 99465389bfcS[email protected] if (feature_set) continue; 99565389bfcS[email protected] log_info("Features bit %02u is not set, removing packet types 0x%04x", bit_idx, packet_type_feature_packet_mask[i]); 99665389bfcS[email protected] packet_types &= ~packet_type_feature_packet_mask[i]; 99765389bfcS[email protected] } 9988f8108aaSmatthias.ringwald // flip bits for "may not be used" 9998f8108aaSmatthias.ringwald packet_types ^= 0x3306; 10008f8108aaSmatthias.ringwald return packet_types; 10018f8108aaSmatthias.ringwald } 10028f8108aaSmatthias.ringwald 10038f8108aaSmatthias.ringwald uint16_t hci_usable_acl_packet_types(void){ 10043a9fb326S[email protected] return hci_stack->packet_types; 10058f8108aaSmatthias.ringwald } 100635454696SMatthias Ringwald #endif 10078f8108aaSmatthias.ringwald 1008facf93fdS[email protected] uint8_t* hci_get_outgoing_packet_buffer(void){ 10097dc17943Smatthias.ringwald // hci packet buffer is >= acl data packet length 10103a9fb326S[email protected] return hci_stack->hci_packet_buffer; 10117dc17943Smatthias.ringwald } 10127dc17943Smatthias.ringwald 1013f5d8d141S[email protected] uint16_t hci_max_acl_data_packet_length(void){ 10143a9fb326S[email protected] return hci_stack->acl_data_packet_length; 10157dc17943Smatthias.ringwald } 10167dc17943Smatthias.ringwald 101706b9e820SMatthias Ringwald #ifdef ENABLE_CLASSIC 10183e68d23dSMatthias Ringwald int hci_extended_sco_link_supported(void){ 10193e68d23dSMatthias Ringwald // No. 31, byte 3, bit 7 10203e68d23dSMatthias Ringwald return (hci_stack->local_supported_features[3] & (1 << 7)) != 0; 10213e68d23dSMatthias Ringwald } 102206b9e820SMatthias Ringwald #endif 10233e68d23dSMatthias Ringwald 10246ac9a97eS[email protected] int hci_non_flushable_packet_boundary_flag_supported(void){ 10256ac9a97eS[email protected] // No. 54, byte 6, bit 6 10266ac9a97eS[email protected] return (hci_stack->local_supported_features[6] & (1 << 6)) != 0; 10276ac9a97eS[email protected] } 10286ac9a97eS[email protected] 102915a95bd5SMatthias Ringwald static int gap_ssp_supported(void){ 10306ac9a97eS[email protected] // No. 51, byte 6, bit 3 10313a9fb326S[email protected] return (hci_stack->local_supported_features[6] & (1 << 3)) != 0; 1032f5d8d141S[email protected] } 1033f5d8d141S[email protected] 10347f02f414SMatthias Ringwald static int hci_classic_supported(void){ 103535454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 10366ac9a97eS[email protected] // No. 37, byte 4, bit 5, = No BR/EDR Support 10373a9fb326S[email protected] return (hci_stack->local_supported_features[4] & (1 << 5)) == 0; 103835454696SMatthias Ringwald #else 103935454696SMatthias Ringwald return 0; 104035454696SMatthias Ringwald #endif 1041f5d8d141S[email protected] } 1042f5d8d141S[email protected] 10437f02f414SMatthias Ringwald static int hci_le_supported(void){ 1044a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE 10456ac9a97eS[email protected] // No. 37, byte 4, bit 6 = LE Supported (Controller) 10463a9fb326S[email protected] return (hci_stack->local_supported_features[4] & (1 << 6)) != 0; 1047f5d8d141S[email protected] #else 1048f5d8d141S[email protected] return 0; 1049f5d8d141S[email protected] #endif 1050f5d8d141S[email protected] } 1051f5d8d141S[email protected] 1052b95a5a35SMatthias Ringwald #ifdef ENABLE_BLE 1053b95a5a35SMatthias Ringwald 1054b95a5a35SMatthias Ringwald /** 1055b95a5a35SMatthias Ringwald * @brief Get addr type and address used for LE in Advertisements, Scan Responses, 1056b95a5a35SMatthias Ringwald */ 1057b95a5a35SMatthias Ringwald void gap_le_get_own_address(uint8_t * addr_type, bd_addr_t addr){ 1058b95a5a35SMatthias Ringwald *addr_type = hci_stack->le_own_addr_type; 1059b95a5a35SMatthias Ringwald if (hci_stack->le_own_addr_type){ 1060b95a5a35SMatthias Ringwald memcpy(addr, hci_stack->le_random_address, 6); 106169a97523S[email protected] } else { 10623a9fb326S[email protected] memcpy(addr, hci_stack->local_bd_addr, 6); 106369a97523S[email protected] } 106469a97523S[email protected] } 106569a97523S[email protected] 1066e8c8828eSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 1067384b59deSMatthias Ringwald void le_handle_advertisement_report(uint8_t *packet, uint16_t size){ 10689ec2630cSMatthias Ringwald 1069d1dc057bS[email protected] int offset = 3; 1070d1dc057bS[email protected] int num_reports = packet[offset]; 1071d1dc057bS[email protected] offset += 1; 1072d1dc057bS[email protected] 107357c9da5bS[email protected] int i; 10744f4e0224SMatthias Ringwald // log_info("HCI: handle adv report with num reports: %d", num_reports); 107503fbe9c6S[email protected] uint8_t event[12 + LE_ADVERTISING_DATA_SIZE]; // use upper bound to avoid var size automatic var 1076384b59deSMatthias Ringwald for (i=0; i<num_reports && offset < size;i++){ 107733e6948bSMatthias Ringwald // sanity checks on data_length: 107833e6948bSMatthias Ringwald uint8_t data_length = packet[offset + 8]; 107933e6948bSMatthias Ringwald if (data_length > LE_ADVERTISING_DATA_SIZE) return; 108033e6948bSMatthias Ringwald if (offset + 9 + data_length + 1 > size) return; 108133e6948bSMatthias Ringwald // setup event 1082a0aac9c4S[email protected] uint8_t event_size = 10 + data_length; 1083d1dc057bS[email protected] int pos = 0; 1084045013feSMatthias Ringwald event[pos++] = GAP_EVENT_ADVERTISING_REPORT; 108557c9da5bS[email protected] event[pos++] = event_size; 1086210c6774S[email protected] memcpy(&event[pos], &packet[offset], 1+1+6); // event type + address type + address 1087d1dc057bS[email protected] offset += 8; 1088d1dc057bS[email protected] pos += 8; 1089d1dc057bS[email protected] event[pos++] = packet[offset + 1 + data_length]; // rssi 109033e6948bSMatthias Ringwald event[pos++] = data_length; 109133e6948bSMatthias Ringwald offset++; 1092d1dc057bS[email protected] memcpy(&event[pos], &packet[offset], data_length); 109357c9da5bS[email protected] pos += data_length; 1094d1dc057bS[email protected] offset += data_length + 1; // rssi 1095d6b06661SMatthias Ringwald hci_emit_event(event, pos, 1); 109657c9da5bS[email protected] } 109757c9da5bS[email protected] } 1098b2f949feS[email protected] #endif 1099e8c8828eSMatthias Ringwald #endif 110057c9da5bS[email protected] 11012b6ab3e6SMatthias Ringwald #ifdef ENABLE_BLE 11022b6ab3e6SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 11032b6ab3e6SMatthias Ringwald static void hci_reenable_advertisements_if_needed(void){ 11042b6ab3e6SMatthias Ringwald if (!hci_stack->le_advertisements_active && hci_stack->le_advertisements_enabled){ 11052b6ab3e6SMatthias Ringwald // get number of active le slave connections 11062b6ab3e6SMatthias Ringwald int num_slave_connections = 0; 11072b6ab3e6SMatthias Ringwald btstack_linked_list_iterator_t it; 11082b6ab3e6SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->connections); 11092b6ab3e6SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 11102b6ab3e6SMatthias Ringwald hci_connection_t * con = (hci_connection_t*) btstack_linked_list_iterator_next(&it); 11112b6ab3e6SMatthias Ringwald log_info("state %u, role %u, le_con %u", con->state, con->role, hci_is_le_connection(con)); 11122b6ab3e6SMatthias Ringwald if (con->state != OPEN) continue; 11132b6ab3e6SMatthias Ringwald if (con->role != HCI_ROLE_SLAVE) continue; 11142b6ab3e6SMatthias Ringwald if (!hci_is_le_connection(con)) continue; 11152b6ab3e6SMatthias Ringwald num_slave_connections++; 11162b6ab3e6SMatthias Ringwald } 11172b6ab3e6SMatthias Ringwald log_info("Num LE Peripheral roles: %u of %u", num_slave_connections, hci_stack->le_max_number_peripheral_connections); 11182b6ab3e6SMatthias Ringwald if (num_slave_connections < hci_stack->le_max_number_peripheral_connections){ 11192b6ab3e6SMatthias Ringwald hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_ENABLE; 11202b6ab3e6SMatthias Ringwald } 11212b6ab3e6SMatthias Ringwald } 11222b6ab3e6SMatthias Ringwald } 11232b6ab3e6SMatthias Ringwald #endif 11242b6ab3e6SMatthias Ringwald #endif 11252b6ab3e6SMatthias Ringwald 1126cd77dd38SMatthias Ringwald #if !defined(HAVE_PLATFORM_IPHONE_OS) && !defined (HAVE_HOST_CONTROLLER_API) 112706b9e820SMatthias Ringwald 112896b53536SMatthias Ringwald static uint32_t hci_transport_uart_get_main_baud_rate(void){ 112996b53536SMatthias Ringwald if (!hci_stack->config) return 0; 11309796ebeaSMatthias Ringwald uint32_t baud_rate = ((hci_transport_config_uart_t *)hci_stack->config)->baudrate_main; 113196b53536SMatthias Ringwald // Limit baud rate for Broadcom chipsets to 3 mbps 113261f37892SMatthias Ringwald if (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_BROADCOM_CORPORATION && baud_rate > 3000000){ 113396b53536SMatthias Ringwald baud_rate = 3000000; 113496b53536SMatthias Ringwald } 113596b53536SMatthias Ringwald return baud_rate; 113696b53536SMatthias Ringwald } 113796b53536SMatthias Ringwald 1138ec820d77SMatthias Ringwald static void hci_initialization_timeout_handler(btstack_timer_source_t * ds){ 11399ec2630cSMatthias Ringwald UNUSED(ds); 11409ec2630cSMatthias Ringwald 11410305bdeaSMatthias Ringwald switch (hci_stack->substate){ 11420305bdeaSMatthias Ringwald case HCI_INIT_W4_SEND_RESET: 11437b0d7667SMatthias Ringwald log_info("Resend HCI Reset"); 11440305bdeaSMatthias Ringwald hci_stack->substate = HCI_INIT_SEND_RESET; 11457b0d7667SMatthias Ringwald hci_stack->num_cmd_packets = 1; 11460305bdeaSMatthias Ringwald hci_run(); 11470305bdeaSMatthias Ringwald break; 11489f007422SMatthias Ringwald case HCI_INIT_W4_CUSTOM_INIT_CSR_WARM_BOOT_LINK_RESET: 11499f007422SMatthias Ringwald log_info("Resend HCI Reset - CSR Warm Boot with Link Reset"); 11509f007422SMatthias Ringwald if (hci_stack->hci_transport->reset_link){ 11519f007422SMatthias Ringwald hci_stack->hci_transport->reset_link(); 11529f007422SMatthias Ringwald } 1153202c8a4cSMatthias Ringwald // no break - explicit fallthrough to HCI_INIT_W4_CUSTOM_INIT_CSR_WARM_BOOT 1154e47e68c7SMatthias Ringwald case HCI_INIT_W4_CUSTOM_INIT_CSR_WARM_BOOT: 1155e47e68c7SMatthias Ringwald log_info("Resend HCI Reset - CSR Warm Boot"); 1156e47e68c7SMatthias Ringwald hci_stack->substate = HCI_INIT_SEND_RESET_CSR_WARM_BOOT; 1157e47e68c7SMatthias Ringwald hci_stack->num_cmd_packets = 1; 1158e47e68c7SMatthias Ringwald hci_run(); 1159688c2635SMatthias Ringwald break; 11607224be7eSMatthias Ringwald case HCI_INIT_W4_SEND_BAUD_CHANGE: 11617224be7eSMatthias Ringwald if (hci_stack->hci_transport->set_baudrate){ 116296b53536SMatthias Ringwald uint32_t baud_rate = hci_transport_uart_get_main_baud_rate(); 1163cd724cb7SMatthias Ringwald log_info("Local baud rate change to %"PRIu32"(timeout handler)", baud_rate); 11647dd9d0ecSMatthias Ringwald hci_stack->hci_transport->set_baudrate(baud_rate); 11657224be7eSMatthias Ringwald } 1166834bce8cSMatthias Ringwald // For CSR, HCI Reset is sent on new baud rate. Don't forget to reset link for H5/BCSP 116761f37892SMatthias Ringwald if (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_CAMBRIDGE_SILICON_RADIO){ 1168834bce8cSMatthias Ringwald if (hci_stack->hci_transport->reset_link){ 1169834bce8cSMatthias Ringwald log_info("Link Reset"); 1170834bce8cSMatthias Ringwald hci_stack->hci_transport->reset_link(); 1171834bce8cSMatthias Ringwald } 1172772a36d3SMatthias Ringwald hci_stack->substate = HCI_INIT_SEND_RESET_CSR_WARM_BOOT; 1173772a36d3SMatthias Ringwald hci_run(); 1174772a36d3SMatthias Ringwald } 11754696bddbSMatthias Ringwald break; 1176559961d0SMatthias Ringwald case HCI_INIT_W4_CUSTOM_INIT_BCM_DELAY: 1177559961d0SMatthias Ringwald // otherwise continue 1178559961d0SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_READ_LOCAL_SUPPORTED_COMMANDS; 1179559961d0SMatthias Ringwald hci_send_cmd(&hci_read_local_supported_commands); 1180559961d0SMatthias Ringwald break; 11810305bdeaSMatthias Ringwald default: 11820305bdeaSMatthias Ringwald break; 11830305bdeaSMatthias Ringwald } 11840305bdeaSMatthias Ringwald } 118506b9e820SMatthias Ringwald #endif 11860305bdeaSMatthias Ringwald 118771de195eSMatthias Ringwald static void hci_initializing_next_state(void){ 118874b323a9SMatthias Ringwald hci_stack->substate = (hci_substate_t )( ((int) hci_stack->substate) + 1); 118974b323a9SMatthias Ringwald } 119074b323a9SMatthias Ringwald 1191e9f343c8SMatthias Ringwald #if defined(ENABLE_CLASSIC) || defined(ENABLE_LE_PERIPHERAL) 11921c2a62f5SMatthias Ringwald static void hci_replace_bd_addr_placeholder(uint8_t * data, uint16_t size){ 11931c2a62f5SMatthias Ringwald const int bd_addr_string_len = 17; 11941c2a62f5SMatthias Ringwald int i = 0; 11951c2a62f5SMatthias Ringwald while (i < size - bd_addr_string_len){ 11961c2a62f5SMatthias Ringwald if (memcmp(&data[i], "00:00:00:00:00:00", bd_addr_string_len)) { 11971c2a62f5SMatthias Ringwald i++; 11981c2a62f5SMatthias Ringwald continue; 11991c2a62f5SMatthias Ringwald } 12001c2a62f5SMatthias Ringwald // set real address 12011c2a62f5SMatthias Ringwald memcpy(&data[i], bd_addr_to_str(hci_stack->local_bd_addr), bd_addr_string_len); 12021c2a62f5SMatthias Ringwald i += bd_addr_string_len; 12031c2a62f5SMatthias Ringwald } 12041c2a62f5SMatthias Ringwald } 12051c2a62f5SMatthias Ringwald #endif 12061c2a62f5SMatthias Ringwald 120774b323a9SMatthias Ringwald // assumption: hci_can_send_command_packet_now() == true 120871de195eSMatthias Ringwald static void hci_initializing_run(void){ 1209148ca237SMatthias Ringwald log_debug("hci_initializing_run: substate %u, can send %u", hci_stack->substate, hci_can_send_command_packet_now()); 121074b323a9SMatthias Ringwald switch (hci_stack->substate){ 121174b323a9SMatthias Ringwald case HCI_INIT_SEND_RESET: 121274b323a9SMatthias Ringwald hci_state_reset(); 1213a0cf2f3fSMatthias Ringwald 121406b9e820SMatthias Ringwald #if !defined(HAVE_PLATFORM_IPHONE_OS) && !defined (HAVE_HOST_CONTROLLER_API) 12150305bdeaSMatthias Ringwald // prepare reset if command complete not received in 100ms 1216659d758cSMatthias Ringwald btstack_run_loop_set_timer(&hci_stack->timeout, HCI_RESET_RESEND_TIMEOUT_MS); 1217528a4a3bSMatthias Ringwald btstack_run_loop_set_timer_handler(&hci_stack->timeout, hci_initialization_timeout_handler); 1218528a4a3bSMatthias Ringwald btstack_run_loop_add_timer(&hci_stack->timeout); 1219a0cf2f3fSMatthias Ringwald #endif 12200305bdeaSMatthias Ringwald // send command 122174b323a9SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_SEND_RESET; 12220305bdeaSMatthias Ringwald hci_send_cmd(&hci_reset); 122374b323a9SMatthias Ringwald break; 122476fcb19bSMatthias Ringwald case HCI_INIT_SEND_READ_LOCAL_VERSION_INFORMATION: 122576fcb19bSMatthias Ringwald hci_send_cmd(&hci_read_local_version_information); 122676fcb19bSMatthias Ringwald hci_stack->substate = HCI_INIT_W4_SEND_READ_LOCAL_VERSION_INFORMATION; 122776fcb19bSMatthias Ringwald break; 1228e90bae01SMatthias Ringwald case HCI_INIT_SEND_READ_LOCAL_NAME: 1229e90bae01SMatthias Ringwald hci_send_cmd(&hci_read_local_name); 1230e90bae01SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_SEND_READ_LOCAL_NAME; 1231e90bae01SMatthias Ringwald break; 123206b9e820SMatthias Ringwald 123306b9e820SMatthias Ringwald #if !defined(HAVE_PLATFORM_IPHONE_OS) && !defined (HAVE_HOST_CONTROLLER_API) 1234e47e68c7SMatthias Ringwald case HCI_INIT_SEND_RESET_CSR_WARM_BOOT: 1235e47e68c7SMatthias Ringwald hci_state_reset(); 1236e47e68c7SMatthias Ringwald // prepare reset if command complete not received in 100ms 1237659d758cSMatthias Ringwald btstack_run_loop_set_timer(&hci_stack->timeout, HCI_RESET_RESEND_TIMEOUT_MS); 1238528a4a3bSMatthias Ringwald btstack_run_loop_set_timer_handler(&hci_stack->timeout, hci_initialization_timeout_handler); 1239528a4a3bSMatthias Ringwald btstack_run_loop_add_timer(&hci_stack->timeout); 1240e47e68c7SMatthias Ringwald // send command 1241e47e68c7SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_CUSTOM_INIT_CSR_WARM_BOOT; 1242e47e68c7SMatthias Ringwald hci_send_cmd(&hci_reset); 1243e47e68c7SMatthias Ringwald break; 12448d29070eSMatthias Ringwald case HCI_INIT_SEND_RESET_ST_WARM_BOOT: 12458d29070eSMatthias Ringwald hci_state_reset(); 12468d29070eSMatthias Ringwald hci_stack->substate = HCI_INIT_W4_SEND_RESET_ST_WARM_BOOT; 12478d29070eSMatthias Ringwald hci_send_cmd(&hci_reset); 12488d29070eSMatthias Ringwald break; 1249fab26ab3SMatthias Ringwald case HCI_INIT_SEND_BAUD_CHANGE: { 125096b53536SMatthias Ringwald uint32_t baud_rate = hci_transport_uart_get_main_baud_rate(); 12513fb36a29SMatthias Ringwald hci_stack->chipset->set_baudrate_command(baud_rate, hci_stack->hci_packet_buffer); 1252f8fbdce0SMatthias Ringwald hci_stack->last_cmd_opcode = little_endian_read_16(hci_stack->hci_packet_buffer, 0); 125374b323a9SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_SEND_BAUD_CHANGE; 12540305bdeaSMatthias Ringwald hci_send_cmd_packet(hci_stack->hci_packet_buffer, 3 + hci_stack->hci_packet_buffer[2]); 12554696bddbSMatthias Ringwald // STLC25000D: baudrate change happens within 0.5 s after command was send, 12564696bddbSMatthias Ringwald // use timer to update baud rate after 100 ms (knowing exactly, when command was sent is non-trivial) 125761f37892SMatthias Ringwald if (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_ST_MICROELECTRONICS){ 1258659d758cSMatthias Ringwald btstack_run_loop_set_timer(&hci_stack->timeout, HCI_RESET_RESEND_TIMEOUT_MS); 1259528a4a3bSMatthias Ringwald btstack_run_loop_add_timer(&hci_stack->timeout); 12604696bddbSMatthias Ringwald } 126174b323a9SMatthias Ringwald break; 1262fab26ab3SMatthias Ringwald } 1263fab26ab3SMatthias Ringwald case HCI_INIT_SEND_BAUD_CHANGE_BCM: { 126496b53536SMatthias Ringwald uint32_t baud_rate = hci_transport_uart_get_main_baud_rate(); 12653fb36a29SMatthias Ringwald hci_stack->chipset->set_baudrate_command(baud_rate, hci_stack->hci_packet_buffer); 1266f8fbdce0SMatthias Ringwald hci_stack->last_cmd_opcode = little_endian_read_16(hci_stack->hci_packet_buffer, 0); 1267eb3a5314SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_SEND_BAUD_CHANGE_BCM; 1268eb3a5314SMatthias Ringwald hci_send_cmd_packet(hci_stack->hci_packet_buffer, 3 + hci_stack->hci_packet_buffer[2]); 1269eb3a5314SMatthias Ringwald break; 1270fab26ab3SMatthias Ringwald } 127174b323a9SMatthias Ringwald case HCI_INIT_CUSTOM_INIT: 127274b323a9SMatthias Ringwald // Custom initialization 12733fb36a29SMatthias Ringwald if (hci_stack->chipset && hci_stack->chipset->next_command){ 1274ae334e9eSMatthias Ringwald hci_stack->chipset_result = (*hci_stack->chipset->next_command)(hci_stack->hci_packet_buffer); 1275ee720f3aSMatthias Ringwald int send_cmd = 0; 1276ae334e9eSMatthias Ringwald switch (hci_stack->chipset_result){ 1277f41911edSMatthias Ringwald case BTSTACK_CHIPSET_VALID_COMMAND: 1278ee720f3aSMatthias Ringwald send_cmd = 1; 1279e47e68c7SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_CUSTOM_INIT; 1280e47e68c7SMatthias Ringwald break; 1281f41911edSMatthias Ringwald case BTSTACK_CHIPSET_WARMSTART_REQUIRED: 1282ee720f3aSMatthias Ringwald send_cmd = 1; 1283f41911edSMatthias Ringwald // CSR Warm Boot: Wait a bit, then send HCI Reset until HCI Command Complete 1284e47e68c7SMatthias Ringwald log_info("CSR Warm Boot"); 1285659d758cSMatthias Ringwald btstack_run_loop_set_timer(&hci_stack->timeout, HCI_RESET_RESEND_TIMEOUT_MS); 1286528a4a3bSMatthias Ringwald btstack_run_loop_set_timer_handler(&hci_stack->timeout, hci_initialization_timeout_handler); 1287528a4a3bSMatthias Ringwald btstack_run_loop_add_timer(&hci_stack->timeout); 128861f37892SMatthias Ringwald if (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_CAMBRIDGE_SILICON_RADIO 1289772a36d3SMatthias Ringwald && hci_stack->config 12903fb36a29SMatthias Ringwald && hci_stack->chipset 12913fb36a29SMatthias Ringwald // && hci_stack->chipset->set_baudrate_command -- there's no such command 1292772a36d3SMatthias Ringwald && hci_stack->hci_transport->set_baudrate 12932caefae9SMatthias Ringwald && hci_transport_uart_get_main_baud_rate()){ 1294772a36d3SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_SEND_BAUD_CHANGE; 1295772a36d3SMatthias Ringwald } else { 12969f007422SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_CUSTOM_INIT_CSR_WARM_BOOT_LINK_RESET; 1297772a36d3SMatthias Ringwald } 1298e47e68c7SMatthias Ringwald break; 1299f41911edSMatthias Ringwald default: 1300f41911edSMatthias Ringwald break; 1301e47e68c7SMatthias Ringwald } 1302ee720f3aSMatthias Ringwald 1303ee720f3aSMatthias Ringwald if (send_cmd){ 1304ee720f3aSMatthias Ringwald int size = 3 + hci_stack->hci_packet_buffer[2]; 1305ee720f3aSMatthias Ringwald hci_stack->last_cmd_opcode = little_endian_read_16(hci_stack->hci_packet_buffer, 0); 1306ee720f3aSMatthias Ringwald hci_dump_packet(HCI_COMMAND_DATA_PACKET, 0, hci_stack->hci_packet_buffer, size); 13070305bdeaSMatthias Ringwald hci_stack->hci_transport->send_packet(HCI_COMMAND_DATA_PACKET, hci_stack->hci_packet_buffer, size); 130874b323a9SMatthias Ringwald break; 130974b323a9SMatthias Ringwald } 1310148ca237SMatthias Ringwald log_info("Init script done"); 131192a0d36dSMatthias Ringwald 1312559961d0SMatthias Ringwald // Init script download on Broadcom chipsets causes: 1313ae334e9eSMatthias Ringwald if ( (hci_stack->chipset_result != BTSTACK_CHIPSET_NO_INIT_SCRIPT) && 13141565be94SMatthias Ringwald ( hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_BROADCOM_CORPORATION 13151565be94SMatthias Ringwald || hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_EM_MICROELECTRONIC_MARIN_SA) ){ 1316e021ff1eSMatthias Ringwald 1317559961d0SMatthias Ringwald // - baud rate to reset, restore UART baud rate if needed 131892a0d36dSMatthias Ringwald int need_baud_change = hci_stack->config 13193fb36a29SMatthias Ringwald && hci_stack->chipset 13203fb36a29SMatthias Ringwald && hci_stack->chipset->set_baudrate_command 132192a0d36dSMatthias Ringwald && hci_stack->hci_transport->set_baudrate 13229796ebeaSMatthias Ringwald && ((hci_transport_config_uart_t *)hci_stack->config)->baudrate_main; 132392a0d36dSMatthias Ringwald if (need_baud_change) { 13249796ebeaSMatthias Ringwald uint32_t baud_rate = ((hci_transport_config_uart_t *)hci_stack->config)->baudrate_init; 1325cd724cb7SMatthias Ringwald log_info("Local baud rate change to %"PRIu32" after init script (bcm)", baud_rate); 132692a0d36dSMatthias Ringwald hci_stack->hci_transport->set_baudrate(baud_rate); 132792a0d36dSMatthias Ringwald } 1328559961d0SMatthias Ringwald 1329559961d0SMatthias Ringwald // - RTS will raise during update, but manual RTS/CTS in WICED port on RedBear Duo cannot handle this 1330559961d0SMatthias Ringwald // -> Work around: wait a few milliseconds here. 1331559961d0SMatthias Ringwald log_info("BCM delay after init script"); 1332559961d0SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_CUSTOM_INIT_BCM_DELAY; 1333559961d0SMatthias Ringwald btstack_run_loop_set_timer(&hci_stack->timeout, 10); 1334559961d0SMatthias Ringwald btstack_run_loop_set_timer_handler(&hci_stack->timeout, hci_initialization_timeout_handler); 1335559961d0SMatthias Ringwald btstack_run_loop_add_timer(&hci_stack->timeout); 1336559961d0SMatthias Ringwald break; 133792a0d36dSMatthias Ringwald } 133874b323a9SMatthias Ringwald } 133974b323a9SMatthias Ringwald // otherwise continue 1340a828a756SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_READ_LOCAL_SUPPORTED_COMMANDS; 1341a828a756SMatthias Ringwald hci_send_cmd(&hci_read_local_supported_commands); 1342a828a756SMatthias Ringwald break; 134353860077SMatthias Ringwald case HCI_INIT_SET_BD_ADDR: 134453860077SMatthias Ringwald log_info("Set Public BD ADDR to %s", bd_addr_to_str(hci_stack->custom_bd_addr)); 13453fb36a29SMatthias Ringwald hci_stack->chipset->set_bd_addr_command(hci_stack->custom_bd_addr, hci_stack->hci_packet_buffer); 1346f8fbdce0SMatthias Ringwald hci_stack->last_cmd_opcode = little_endian_read_16(hci_stack->hci_packet_buffer, 0); 134753860077SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_SET_BD_ADDR; 134853860077SMatthias Ringwald hci_send_cmd_packet(hci_stack->hci_packet_buffer, 3 + hci_stack->hci_packet_buffer[2]); 134953860077SMatthias Ringwald break; 135006b9e820SMatthias Ringwald #endif 135106b9e820SMatthias Ringwald 135206b9e820SMatthias Ringwald case HCI_INIT_READ_LOCAL_SUPPORTED_COMMANDS: 135306b9e820SMatthias Ringwald log_info("Resend hci_read_local_supported_commands after CSR Warm Boot double reset"); 135406b9e820SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_READ_LOCAL_SUPPORTED_COMMANDS; 135506b9e820SMatthias Ringwald hci_send_cmd(&hci_read_local_supported_commands); 135606b9e820SMatthias Ringwald break; 135753860077SMatthias Ringwald case HCI_INIT_READ_BD_ADDR: 135853860077SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_READ_BD_ADDR; 135953860077SMatthias Ringwald hci_send_cmd(&hci_read_bd_addr); 136053860077SMatthias Ringwald break; 136174b323a9SMatthias Ringwald case HCI_INIT_READ_BUFFER_SIZE: 136274b323a9SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_READ_BUFFER_SIZE; 13630305bdeaSMatthias Ringwald hci_send_cmd(&hci_read_buffer_size); 136474b323a9SMatthias Ringwald break; 136553860077SMatthias Ringwald case HCI_INIT_READ_LOCAL_SUPPORTED_FEATURES: 136653860077SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_READ_LOCAL_SUPPORTED_FEATURES; 13670305bdeaSMatthias Ringwald hci_send_cmd(&hci_read_local_supported_features); 136874b323a9SMatthias Ringwald break; 13692b838201SMatthias Ringwald 13702b838201SMatthias Ringwald #ifdef ENABLE_HCI_CONTROLLER_TO_HOST_FLOW_CONTROL 13712b838201SMatthias Ringwald case HCI_INIT_SET_CONTROLLER_TO_HOST_FLOW_CONTROL: 13722b838201SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_SET_CONTROLLER_TO_HOST_FLOW_CONTROL; 13732b838201SMatthias Ringwald hci_send_cmd(&hci_set_controller_to_host_flow_control, 3); // ACL + SCO Flow Control 13742b838201SMatthias Ringwald break; 13752b838201SMatthias Ringwald case HCI_INIT_HOST_BUFFER_SIZE: 13762b838201SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_HOST_BUFFER_SIZE; 13772b838201SMatthias Ringwald hci_send_cmd(&hci_host_buffer_size, HCI_HOST_ACL_PACKET_LEN, HCI_HOST_SCO_PACKET_LEN, 13782b838201SMatthias Ringwald HCI_HOST_ACL_PACKET_NUM, HCI_HOST_SCO_PACKET_NUM); 13792b838201SMatthias Ringwald break; 13802b838201SMatthias Ringwald #endif 13812b838201SMatthias Ringwald 138274b323a9SMatthias Ringwald case HCI_INIT_SET_EVENT_MASK: 13830305bdeaSMatthias Ringwald hci_stack->substate = HCI_INIT_W4_SET_EVENT_MASK; 138474b323a9SMatthias Ringwald if (hci_le_supported()){ 138574b323a9SMatthias Ringwald hci_send_cmd(&hci_set_event_mask,0xffffffff, 0x3FFFFFFF); 138674b323a9SMatthias Ringwald } else { 138774b323a9SMatthias Ringwald // Kensington Bluetooth 2.1 USB Dongle (CSR Chipset) returns an error for 0xffff... 138874b323a9SMatthias Ringwald hci_send_cmd(&hci_set_event_mask,0xffffffff, 0x1FFFFFFF); 138974b323a9SMatthias Ringwald } 139074b323a9SMatthias Ringwald break; 13912b838201SMatthias Ringwald 139235454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 139374b323a9SMatthias Ringwald case HCI_INIT_WRITE_SIMPLE_PAIRING_MODE: 139474b323a9SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_WRITE_SIMPLE_PAIRING_MODE; 13950305bdeaSMatthias Ringwald hci_send_cmd(&hci_write_simple_pairing_mode, hci_stack->ssp_enable); 139674b323a9SMatthias Ringwald break; 139774b323a9SMatthias Ringwald case HCI_INIT_WRITE_PAGE_TIMEOUT: 139874b323a9SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_WRITE_PAGE_TIMEOUT; 13990305bdeaSMatthias Ringwald hci_send_cmd(&hci_write_page_timeout, 0x6000); // ca. 15 sec 140074b323a9SMatthias Ringwald break; 1401c33e56d3SMatthias Ringwald case HCI_INIT_WRITE_DEFAULT_LINK_POLICY_SETTING: 1402c33e56d3SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_WRITE_DEFAULT_LINK_POLICY_SETTING; 1403c33e56d3SMatthias Ringwald hci_send_cmd(&hci_write_default_link_policy_setting, hci_stack->default_link_policy_settings); 1404c33e56d3SMatthias Ringwald break; 140574b323a9SMatthias Ringwald case HCI_INIT_WRITE_CLASS_OF_DEVICE: 140674b323a9SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_WRITE_CLASS_OF_DEVICE; 14070305bdeaSMatthias Ringwald hci_send_cmd(&hci_write_class_of_device, hci_stack->class_of_device); 140874b323a9SMatthias Ringwald break; 14091c2a62f5SMatthias Ringwald case HCI_INIT_WRITE_LOCAL_NAME: { 14100305bdeaSMatthias Ringwald hci_stack->substate = HCI_INIT_W4_WRITE_LOCAL_NAME; 14111c2a62f5SMatthias Ringwald hci_reserve_packet_buffer(); 14121c2a62f5SMatthias Ringwald uint8_t * packet = hci_stack->hci_packet_buffer; 14131c2a62f5SMatthias Ringwald // construct HCI Command and send 14141c2a62f5SMatthias Ringwald uint16_t opcode = hci_write_local_name.opcode; 14151c2a62f5SMatthias Ringwald hci_stack->last_cmd_opcode = opcode; 14161c2a62f5SMatthias Ringwald packet[0] = opcode & 0xff; 14171c2a62f5SMatthias Ringwald packet[1] = opcode >> 8; 14181c2a62f5SMatthias Ringwald packet[2] = DEVICE_NAME_LEN; 14191c2a62f5SMatthias Ringwald memset(&packet[3], 0, DEVICE_NAME_LEN); 142063168530SMatthias Ringwald memcpy(&packet[3], hci_stack->local_name, strlen(hci_stack->local_name)); 14211c2a62f5SMatthias Ringwald // expand '00:00:00:00:00:00' in name with bd_addr 14221c2a62f5SMatthias Ringwald hci_replace_bd_addr_placeholder(&packet[3], DEVICE_NAME_LEN); 14231c2a62f5SMatthias Ringwald hci_send_cmd_packet(packet, HCI_CMD_HEADER_SIZE + DEVICE_NAME_LEN); 142474b323a9SMatthias Ringwald break; 14251c2a62f5SMatthias Ringwald } 142629af07f3SMatthias Ringwald case HCI_INIT_WRITE_EIR_DATA: { 14278a114470SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_WRITE_EIR_DATA; 142829af07f3SMatthias Ringwald hci_reserve_packet_buffer(); 142929af07f3SMatthias Ringwald uint8_t * packet = hci_stack->hci_packet_buffer; 143029af07f3SMatthias Ringwald // construct HCI Command and send 143129af07f3SMatthias Ringwald uint16_t opcode = hci_write_extended_inquiry_response.opcode; 143229af07f3SMatthias Ringwald hci_stack->last_cmd_opcode = opcode; 143329af07f3SMatthias Ringwald packet[0] = opcode & 0xff; 143429af07f3SMatthias Ringwald packet[1] = opcode >> 8; 143529af07f3SMatthias Ringwald packet[2] = 1 + 240; 143629af07f3SMatthias Ringwald packet[3] = 0; // FEC not required 1437ad0d1108SMatthias Ringwald if (hci_stack->eir_data){ 143829af07f3SMatthias Ringwald memcpy(&packet[4], hci_stack->eir_data, 240); 1439ad0d1108SMatthias Ringwald } else { 1440ad0d1108SMatthias Ringwald memset(&packet[4], 0, 240); 1441ad0d1108SMatthias Ringwald int name_len = strlen(hci_stack->local_name); 1442ad0d1108SMatthias Ringwald packet[4] = name_len + 1; 1443ad0d1108SMatthias Ringwald packet[5] = BLUETOOTH_DATA_TYPE_COMPLETE_LOCAL_NAME; 1444ad0d1108SMatthias Ringwald memcpy(&packet[6], hci_stack->local_name, name_len); 1445ad0d1108SMatthias Ringwald } 144629af07f3SMatthias Ringwald // expand '00:00:00:00:00:00' in name with bd_addr 144729af07f3SMatthias Ringwald hci_replace_bd_addr_placeholder(&packet[4], 240); 1448c439e296SMatthias Ringwald hci_send_cmd_packet(packet, HCI_CMD_HEADER_SIZE + 1 + 240); 1449ff00ed1cSMatthias Ringwald break; 145029af07f3SMatthias Ringwald } 1451f6858d14SMatthias Ringwald case HCI_INIT_WRITE_INQUIRY_MODE: 1452f6858d14SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_WRITE_INQUIRY_MODE; 14538a114470SMatthias Ringwald hci_send_cmd(&hci_write_inquiry_mode, (int) hci_stack->inquiry_mode); 1454f6858d14SMatthias Ringwald break; 145574b323a9SMatthias Ringwald case HCI_INIT_WRITE_SCAN_ENABLE: 145674b323a9SMatthias Ringwald hci_send_cmd(&hci_write_scan_enable, (hci_stack->connectable << 1) | hci_stack->discoverable); // page scan 145774b323a9SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_WRITE_SCAN_ENABLE; 145874b323a9SMatthias Ringwald break; 1459483c5078SMatthias Ringwald // only sent if ENABLE_SCO_OVER_HCI is defined 1460729ed62eSMatthias Ringwald case HCI_INIT_WRITE_SYNCHRONOUS_FLOW_CONTROL_ENABLE: 1461729ed62eSMatthias Ringwald hci_stack->substate = HCI_INIT_W4_WRITE_SYNCHRONOUS_FLOW_CONTROL_ENABLE; 1462729ed62eSMatthias Ringwald hci_send_cmd(&hci_write_synchronous_flow_control_enable, 1); // SCO tracking enabled 1463729ed62eSMatthias Ringwald break; 1464483c5078SMatthias Ringwald case HCI_INIT_WRITE_DEFAULT_ERRONEOUS_DATA_REPORTING: 1465483c5078SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_WRITE_DEFAULT_ERRONEOUS_DATA_REPORTING; 1466483c5078SMatthias Ringwald hci_send_cmd(&hci_write_default_erroneous_data_reporting, 1); 1467483c5078SMatthias Ringwald break; 1468a42798c3SMatthias Ringwald // only sent if ENABLE_SCO_OVER_HCI and manufacturer is Broadcom 1469a42798c3SMatthias Ringwald case HCI_INIT_BCM_WRITE_SCO_PCM_INT: 1470a42798c3SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_BCM_WRITE_SCO_PCM_INT; 1471a42798c3SMatthias Ringwald log_info("BCM: Route SCO data via HCI transport"); 1472a42798c3SMatthias Ringwald hci_send_cmd(&hci_bcm_write_sco_pcm_int, 1, 0, 0, 0, 0); 1473a42798c3SMatthias Ringwald break; 1474a42798c3SMatthias Ringwald 147535454696SMatthias Ringwald #endif 1476a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE 147774b323a9SMatthias Ringwald // LE INIT 147874b323a9SMatthias Ringwald case HCI_INIT_LE_READ_BUFFER_SIZE: 147974b323a9SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_LE_READ_BUFFER_SIZE; 14800305bdeaSMatthias Ringwald hci_send_cmd(&hci_le_read_buffer_size); 148174b323a9SMatthias Ringwald break; 1482daabb8b8SMatthias Ringwald case HCI_INIT_LE_SET_EVENT_MASK: 1483daabb8b8SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_LE_SET_EVENT_MASK; 1484729710c0SMatthias Ringwald hci_send_cmd(&hci_le_set_event_mask, 0x809FF, 0x0); // bits 0-8, 11, 19 1485daabb8b8SMatthias Ringwald break; 148674b323a9SMatthias Ringwald case HCI_INIT_WRITE_LE_HOST_SUPPORTED: 148774b323a9SMatthias Ringwald // LE Supported Host = 1, Simultaneous Host = 0 148874b323a9SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_WRITE_LE_HOST_SUPPORTED; 14890305bdeaSMatthias Ringwald hci_send_cmd(&hci_write_le_host_supported, 1, 0); 149074b323a9SMatthias Ringwald break; 1491b435e062SMatthias Ringwald #endif 1492b435e062SMatthias Ringwald 1493b435e062SMatthias Ringwald #ifdef ENABLE_LE_DATA_LENGTH_EXTENSION 1494dcd678baSMatthias Ringwald case HCI_INIT_LE_READ_MAX_DATA_LENGTH: 1495dcd678baSMatthias Ringwald hci_stack->substate = HCI_INIT_W4_LE_READ_MAX_DATA_LENGTH; 1496dcd678baSMatthias Ringwald hci_send_cmd(&hci_le_read_maximum_data_length); 1497dcd678baSMatthias Ringwald break; 1498dcd678baSMatthias Ringwald case HCI_INIT_LE_WRITE_SUGGESTED_DATA_LENGTH: 1499dcd678baSMatthias Ringwald hci_stack->substate = HCI_INIT_W4_LE_WRITE_SUGGESTED_DATA_LENGTH; 1500b435e062SMatthias 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); 1501dcd678baSMatthias Ringwald break; 1502b435e062SMatthias Ringwald #endif 1503b435e062SMatthias Ringwald 1504b95a5a35SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 15053b6d4121SMatthias Ringwald case HCI_INIT_READ_WHITE_LIST_SIZE: 15063b6d4121SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_READ_WHITE_LIST_SIZE; 15073b6d4121SMatthias Ringwald hci_send_cmd(&hci_le_read_white_list_size); 15083b6d4121SMatthias Ringwald break; 150974b323a9SMatthias Ringwald case HCI_INIT_LE_SET_SCAN_PARAMETERS: 1510b95a5a35SMatthias Ringwald // LE Scan Parameters: active scanning, 300 ms interval, 30 ms window, own address type, accept all advs 151174b323a9SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_LE_SET_SCAN_PARAMETERS; 151263270faaSMatthias Ringwald hci_send_cmd(&hci_le_set_scan_parameters, 1, hci_stack->le_scan_interval, hci_stack->le_scan_window, hci_stack->le_own_addr_type, 0); 151374b323a9SMatthias Ringwald break; 151474b323a9SMatthias Ringwald #endif 151574b323a9SMatthias Ringwald default: 151674b323a9SMatthias Ringwald return; 151774b323a9SMatthias Ringwald } 151855975f88SMatthias Ringwald } 151955975f88SMatthias Ringwald 1520a650ba4dSMatthias Ringwald static void hci_init_done(void){ 1521a650ba4dSMatthias Ringwald // done. tell the app 1522a650ba4dSMatthias Ringwald log_info("hci_init_done -> HCI_STATE_WORKING"); 1523a650ba4dSMatthias Ringwald hci_stack->state = HCI_STATE_WORKING; 1524a650ba4dSMatthias Ringwald hci_emit_state(); 1525a650ba4dSMatthias Ringwald hci_run(); 1526a650ba4dSMatthias Ringwald } 1527a650ba4dSMatthias Ringwald 15286155b3d3S[email protected] static void hci_initializing_event_handler(uint8_t * packet, uint16_t size){ 1529384b59deSMatthias Ringwald 1530384b59deSMatthias Ringwald UNUSED(size); // ok: less than 6 bytes are read from our buffer 15319ec2630cSMatthias Ringwald 1532a2481739S[email protected] uint8_t command_completed = 0; 1533c4633093SMatthias Ringwald 15340e2df43fSMatthias Ringwald if (hci_event_packet_get_type(packet) == HCI_EVENT_COMMAND_COMPLETE){ 1535f8fbdce0SMatthias Ringwald uint16_t opcode = little_endian_read_16(packet,3); 15366155b3d3S[email protected] if (opcode == hci_stack->last_cmd_opcode){ 1537a2481739S[email protected] command_completed = 1; 1538148ca237SMatthias Ringwald log_debug("Command complete for expected opcode %04x at substate %u", opcode, hci_stack->substate); 15396155b3d3S[email protected] } else { 1540d58dd308SMatthias Ringwald log_info("Command complete for different opcode %04x, expected %04x, at substate %u", opcode, hci_stack->last_cmd_opcode, hci_stack->substate); 15416155b3d3S[email protected] } 15426155b3d3S[email protected] } 15430f97eae7SMatthias Ringwald 15440e2df43fSMatthias Ringwald if (hci_event_packet_get_type(packet) == HCI_EVENT_COMMAND_STATUS){ 15456155b3d3S[email protected] uint8_t status = packet[2]; 1546f8fbdce0SMatthias Ringwald uint16_t opcode = little_endian_read_16(packet,4); 15476155b3d3S[email protected] if (opcode == hci_stack->last_cmd_opcode){ 15486155b3d3S[email protected] if (status){ 1549a2481739S[email protected] command_completed = 1; 1550148ca237SMatthias Ringwald log_debug("Command status error 0x%02x for expected opcode %04x at substate %u", status, opcode, hci_stack->substate); 15516155b3d3S[email protected] } else { 15526155b3d3S[email protected] log_info("Command status OK for expected opcode %04x, waiting for command complete", opcode); 15536155b3d3S[email protected] } 15546155b3d3S[email protected] } else { 1555148ca237SMatthias Ringwald log_debug("Command status for opcode %04x, expected %04x", opcode, hci_stack->last_cmd_opcode); 15566155b3d3S[email protected] } 15576155b3d3S[email protected] } 15580f97eae7SMatthias Ringwald 155906b9e820SMatthias Ringwald #if !defined(HAVE_PLATFORM_IPHONE_OS) && !defined (HAVE_HOST_CONTROLLER_API) 156006b9e820SMatthias Ringwald 1561e47e68c7SMatthias Ringwald // Vendor == CSR 15620e2df43fSMatthias Ringwald if (hci_stack->substate == HCI_INIT_W4_CUSTOM_INIT && hci_event_packet_get_type(packet) == HCI_EVENT_VENDOR_SPECIFIC){ 1563e47e68c7SMatthias Ringwald // TODO: track actual command 1564e47e68c7SMatthias Ringwald command_completed = 1; 1565e47e68c7SMatthias Ringwald } 1566a2481739S[email protected] 15674e9daa6fSMatthias Ringwald // Vendor == Toshiba 15680e2df43fSMatthias Ringwald if (hci_stack->substate == HCI_INIT_W4_SEND_BAUD_CHANGE && hci_event_packet_get_type(packet) == HCI_EVENT_VENDOR_SPECIFIC){ 15694e9daa6fSMatthias Ringwald // TODO: track actual command 15704e9daa6fSMatthias Ringwald command_completed = 1; 1571004902f1SMatthias Ringwald // Fix: no HCI Command Complete received, so num_cmd_packets not reset 1572004902f1SMatthias Ringwald hci_stack->num_cmd_packets = 1; 15734e9daa6fSMatthias Ringwald } 15744e9daa6fSMatthias Ringwald 15750f97eae7SMatthias Ringwald // Late response (> 100 ms) for HCI Reset e.g. on Toshiba TC35661: 15760f97eae7SMatthias Ringwald // Command complete for HCI Reset arrives after we've resent the HCI Reset command 15770f97eae7SMatthias Ringwald // 15780f97eae7SMatthias Ringwald // HCI Reset 15790f97eae7SMatthias Ringwald // Timeout 100 ms 15800f97eae7SMatthias Ringwald // HCI Reset 15810f97eae7SMatthias Ringwald // Command Complete Reset 15820f97eae7SMatthias Ringwald // HCI Read Local Version Information 15830f97eae7SMatthias Ringwald // Command Complete Reset - but we expected Command Complete Read Local Version Information 15840f97eae7SMatthias Ringwald // hang... 15850f97eae7SMatthias Ringwald // 15860f97eae7SMatthias Ringwald // Fix: Command Complete for HCI Reset in HCI_INIT_W4_SEND_READ_LOCAL_VERSION_INFORMATION trigger resend 15870f97eae7SMatthias Ringwald if (!command_completed 15880e2df43fSMatthias Ringwald && hci_event_packet_get_type(packet) == HCI_EVENT_COMMAND_COMPLETE 15890f97eae7SMatthias Ringwald && hci_stack->substate == HCI_INIT_W4_SEND_READ_LOCAL_VERSION_INFORMATION){ 15900f97eae7SMatthias Ringwald 1591f8fbdce0SMatthias Ringwald uint16_t opcode = little_endian_read_16(packet,3); 15920f97eae7SMatthias Ringwald if (opcode == hci_reset.opcode){ 15930f97eae7SMatthias Ringwald hci_stack->substate = HCI_INIT_SEND_READ_LOCAL_VERSION_INFORMATION; 15940f97eae7SMatthias Ringwald return; 15950f97eae7SMatthias Ringwald } 15960f97eae7SMatthias Ringwald } 15970f97eae7SMatthias Ringwald 15989f007422SMatthias Ringwald // CSR & H5 15999f007422SMatthias Ringwald // Fix: Command Complete for HCI Reset in HCI_INIT_W4_SEND_READ_LOCAL_VERSION_INFORMATION trigger resend 16009f007422SMatthias Ringwald if (!command_completed 16019f007422SMatthias Ringwald && hci_event_packet_get_type(packet) == HCI_EVENT_COMMAND_COMPLETE 16029f007422SMatthias Ringwald && hci_stack->substate == HCI_INIT_W4_READ_LOCAL_SUPPORTED_COMMANDS){ 16039f007422SMatthias Ringwald 16049f007422SMatthias Ringwald uint16_t opcode = little_endian_read_16(packet,3); 16059f007422SMatthias Ringwald if (opcode == hci_reset.opcode){ 16069f007422SMatthias Ringwald hci_stack->substate = HCI_INIT_READ_LOCAL_SUPPORTED_COMMANDS; 16079f007422SMatthias Ringwald return; 16089f007422SMatthias Ringwald } 16099f007422SMatthias Ringwald } 16109f007422SMatthias Ringwald 16119f007422SMatthias 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 16129f007422SMatthias Ringwald // fix: Correct substate and behave as command below 16139f007422SMatthias Ringwald if (command_completed){ 16149f007422SMatthias Ringwald switch (hci_stack->substate){ 16159f007422SMatthias Ringwald case HCI_INIT_SEND_RESET: 16169f007422SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_SEND_RESET; 16179f007422SMatthias Ringwald break; 16189f007422SMatthias Ringwald case HCI_INIT_SEND_RESET_CSR_WARM_BOOT: 16199f007422SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_CUSTOM_INIT_CSR_WARM_BOOT; 16209f007422SMatthias Ringwald break; 16219f007422SMatthias Ringwald default: 16229f007422SMatthias Ringwald break; 16239f007422SMatthias Ringwald } 16249f007422SMatthias Ringwald } 16250f97eae7SMatthias Ringwald 162606b9e820SMatthias Ringwald #endif 16270f97eae7SMatthias Ringwald 1628a2481739S[email protected] if (!command_completed) return; 1629a2481739S[email protected] 163006b9e820SMatthias Ringwald int need_baud_change = 0; 163106b9e820SMatthias Ringwald int need_addr_change = 0; 163206b9e820SMatthias Ringwald 163306b9e820SMatthias Ringwald #if !defined(HAVE_PLATFORM_IPHONE_OS) && !defined (HAVE_HOST_CONTROLLER_API) 163406b9e820SMatthias Ringwald need_baud_change = hci_stack->config 16353fb36a29SMatthias Ringwald && hci_stack->chipset 16363fb36a29SMatthias Ringwald && hci_stack->chipset->set_baudrate_command 1637db8bc6ffSMatthias Ringwald && hci_stack->hci_transport->set_baudrate 16389796ebeaSMatthias Ringwald && ((hci_transport_config_uart_t *)hci_stack->config)->baudrate_main; 1639db8bc6ffSMatthias Ringwald 164006b9e820SMatthias Ringwald need_addr_change = hci_stack->custom_bd_addr_set 16413fb36a29SMatthias Ringwald && hci_stack->chipset 16423fb36a29SMatthias Ringwald && hci_stack->chipset->set_bd_addr_command; 164306b9e820SMatthias Ringwald #endif 1644a80162e9SMatthias Ringwald 16455c363727SMatthias Ringwald switch(hci_stack->substate){ 164606b9e820SMatthias Ringwald 164706b9e820SMatthias Ringwald #if !defined(HAVE_PLATFORM_IPHONE_OS) && !defined (HAVE_HOST_CONTROLLER_API) 16489f007422SMatthias Ringwald case HCI_INIT_SEND_RESET: 1649d58dd308SMatthias Ringwald // on CSR with BCSP/H5, resend triggers resend of HCI Reset and leads to substate == HCI_INIT_SEND_RESET 16509f007422SMatthias Ringwald // fix: just correct substate and behave as command below 16519f007422SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_SEND_RESET; 16529f007422SMatthias Ringwald btstack_run_loop_remove_timer(&hci_stack->timeout); 16539f007422SMatthias Ringwald break; 165474b323a9SMatthias Ringwald case HCI_INIT_W4_SEND_RESET: 1655528a4a3bSMatthias Ringwald btstack_run_loop_remove_timer(&hci_stack->timeout); 165676fcb19bSMatthias Ringwald break; 1657e90bae01SMatthias Ringwald case HCI_INIT_W4_SEND_READ_LOCAL_NAME: 1658e90bae01SMatthias Ringwald log_info("Received local name, need baud change %d", need_baud_change); 16592f48d920SMatthias Ringwald if (need_baud_change){ 16602f48d920SMatthias Ringwald hci_stack->substate = HCI_INIT_SEND_BAUD_CHANGE; 16612f48d920SMatthias Ringwald return; 16622f48d920SMatthias Ringwald } 166353860077SMatthias Ringwald // skip baud change 166474b323a9SMatthias Ringwald hci_stack->substate = HCI_INIT_CUSTOM_INIT; 166574b323a9SMatthias Ringwald return; 1666a80162e9SMatthias Ringwald case HCI_INIT_W4_SEND_BAUD_CHANGE: 16674696bddbSMatthias Ringwald // for STLC2500D, baud rate change already happened. 1668fab26ab3SMatthias Ringwald // for others, baud rate gets changed now 166961f37892SMatthias Ringwald if ((hci_stack->manufacturer != BLUETOOTH_COMPANY_ID_ST_MICROELECTRONICS) && need_baud_change){ 167096b53536SMatthias Ringwald uint32_t baud_rate = hci_transport_uart_get_main_baud_rate(); 1671cd724cb7SMatthias Ringwald log_info("Local baud rate change to %"PRIu32"(w4_send_baud_change)", baud_rate); 1672fab26ab3SMatthias Ringwald hci_stack->hci_transport->set_baudrate(baud_rate); 16734696bddbSMatthias Ringwald } 167474b323a9SMatthias Ringwald hci_stack->substate = HCI_INIT_CUSTOM_INIT; 167574b323a9SMatthias Ringwald return; 1676a80162e9SMatthias Ringwald case HCI_INIT_W4_CUSTOM_INIT_CSR_WARM_BOOT: 1677528a4a3bSMatthias Ringwald btstack_run_loop_remove_timer(&hci_stack->timeout); 1678a80162e9SMatthias Ringwald hci_stack->substate = HCI_INIT_CUSTOM_INIT; 1679a80162e9SMatthias Ringwald return; 168074b323a9SMatthias Ringwald case HCI_INIT_W4_CUSTOM_INIT: 168174b323a9SMatthias Ringwald // repeat custom init 168274b323a9SMatthias Ringwald hci_stack->substate = HCI_INIT_CUSTOM_INIT; 168374b323a9SMatthias Ringwald return; 168406b9e820SMatthias Ringwald #else 168506b9e820SMatthias Ringwald case HCI_INIT_W4_SEND_RESET: 168606b9e820SMatthias Ringwald hci_stack->substate = HCI_INIT_READ_LOCAL_SUPPORTED_COMMANDS; 168706b9e820SMatthias Ringwald return ; 168806b9e820SMatthias Ringwald #endif 168906b9e820SMatthias Ringwald 1690a828a756SMatthias Ringwald case HCI_INIT_W4_READ_LOCAL_SUPPORTED_COMMANDS: 1691ae334e9eSMatthias Ringwald if (need_baud_change && hci_stack->chipset_result != BTSTACK_CHIPSET_NO_INIT_SCRIPT && 1692efd3b327SMatthias Ringwald ((hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_BROADCOM_CORPORATION) || 1693efd3b327SMatthias Ringwald (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_EM_MICROELECTRONIC_MARIN_SA))) { 1694eb3a5314SMatthias Ringwald hci_stack->substate = HCI_INIT_SEND_BAUD_CHANGE_BCM; 1695eb3a5314SMatthias Ringwald return; 1696eb3a5314SMatthias Ringwald } 169753860077SMatthias Ringwald if (need_addr_change){ 169853860077SMatthias Ringwald hci_stack->substate = HCI_INIT_SET_BD_ADDR; 169953860077SMatthias Ringwald return; 170053860077SMatthias Ringwald } 170153860077SMatthias Ringwald hci_stack->substate = HCI_INIT_READ_BD_ADDR; 170253860077SMatthias Ringwald return; 170306b9e820SMatthias Ringwald #if !defined(HAVE_PLATFORM_IPHONE_OS) && !defined (HAVE_HOST_CONTROLLER_API) 17047224be7eSMatthias Ringwald case HCI_INIT_W4_SEND_BAUD_CHANGE_BCM: 17057224be7eSMatthias Ringwald if (need_baud_change){ 170696b53536SMatthias Ringwald uint32_t baud_rate = hci_transport_uart_get_main_baud_rate(); 1707cd724cb7SMatthias Ringwald log_info("Local baud rate change to %"PRIu32"(w4_send_baud_change_bcm))", baud_rate); 1708fab26ab3SMatthias Ringwald hci_stack->hci_transport->set_baudrate(baud_rate); 17097224be7eSMatthias Ringwald } 1710eb3a5314SMatthias Ringwald if (need_addr_change){ 1711eb3a5314SMatthias Ringwald hci_stack->substate = HCI_INIT_SET_BD_ADDR; 1712eb3a5314SMatthias Ringwald return; 1713eb3a5314SMatthias Ringwald } 1714eb3a5314SMatthias Ringwald hci_stack->substate = HCI_INIT_READ_BD_ADDR; 1715eb3a5314SMatthias Ringwald return; 171653860077SMatthias Ringwald case HCI_INIT_W4_SET_BD_ADDR: 17176ca9a99aSMatthias Ringwald // for STLC2500D + ATWILC3000, bd addr change only gets active after sending reset command 17186ca9a99aSMatthias Ringwald if ((hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_ST_MICROELECTRONICS) 17196ca9a99aSMatthias Ringwald || (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_ATMEL_CORPORATION)){ 172053860077SMatthias Ringwald hci_stack->substate = HCI_INIT_SEND_RESET_ST_WARM_BOOT; 172153860077SMatthias Ringwald return; 172253860077SMatthias Ringwald } 172353860077SMatthias Ringwald // skipping st warm boot 172453860077SMatthias Ringwald hci_stack->substate = HCI_INIT_READ_BD_ADDR; 172553860077SMatthias Ringwald return; 172653860077SMatthias Ringwald case HCI_INIT_W4_SEND_RESET_ST_WARM_BOOT: 172753860077SMatthias Ringwald hci_stack->substate = HCI_INIT_READ_BD_ADDR; 172853860077SMatthias Ringwald return; 172906b9e820SMatthias Ringwald #endif 173053860077SMatthias Ringwald case HCI_INIT_W4_READ_BD_ADDR: 173153860077SMatthias Ringwald // only read buffer size if supported 173253860077SMatthias Ringwald if (hci_stack->local_supported_commands[0] & 0x01) { 173353860077SMatthias Ringwald hci_stack->substate = HCI_INIT_READ_BUFFER_SIZE; 173453860077SMatthias Ringwald return; 173553860077SMatthias Ringwald } 173653860077SMatthias Ringwald // skipping read buffer size 173753860077SMatthias Ringwald hci_stack->substate = HCI_INIT_READ_LOCAL_SUPPORTED_FEATURES; 1738a828a756SMatthias Ringwald return; 173974b323a9SMatthias Ringwald case HCI_INIT_W4_SET_EVENT_MASK: 17406155b3d3S[email protected] // skip Classic init commands for LE only chipsets 17416155b3d3S[email protected] if (!hci_classic_supported()){ 17422c68f164SMatthias Ringwald #ifdef ENABLE_BLE 17436155b3d3S[email protected] if (hci_le_supported()){ 174474b323a9SMatthias Ringwald hci_stack->substate = HCI_INIT_LE_READ_BUFFER_SIZE; // skip all classic command 174574b323a9SMatthias Ringwald return; 17462c68f164SMatthias Ringwald } 17472c68f164SMatthias Ringwald #endif 17486155b3d3S[email protected] log_error("Neither BR/EDR nor LE supported"); 1749a650ba4dSMatthias Ringwald hci_init_done(); 175074b323a9SMatthias Ringwald return; 17516155b3d3S[email protected] } 175215a95bd5SMatthias Ringwald if (!gap_ssp_supported()){ 17535c363727SMatthias Ringwald hci_stack->substate = HCI_INIT_WRITE_PAGE_TIMEOUT; 175474b323a9SMatthias Ringwald return; 17556155b3d3S[email protected] } 17566155b3d3S[email protected] break; 1757903ea03aSMatthias Ringwald #ifdef ENABLE_BLE 1758a828a756SMatthias Ringwald case HCI_INIT_W4_LE_READ_BUFFER_SIZE: 1759a828a756SMatthias Ringwald // skip write le host if not supported (e.g. on LE only EM9301) 1760a828a756SMatthias Ringwald if (hci_stack->local_supported_commands[0] & 0x02) break; 1761daabb8b8SMatthias Ringwald hci_stack->substate = HCI_INIT_LE_SET_EVENT_MASK; 1762daabb8b8SMatthias Ringwald return; 1763daabb8b8SMatthias Ringwald 1764b435e062SMatthias Ringwald #ifdef ENABLE_LE_DATA_LENGTH_EXTENSION 1765b435e062SMatthias Ringwald case HCI_INIT_W4_WRITE_LE_HOST_SUPPORTED: 17666fab74dbSMatthias Ringwald log_info("Supported commands %x", hci_stack->local_supported_commands[0] & 0x30); 1767b435e062SMatthias Ringwald if ((hci_stack->local_supported_commands[0] & 0x30) == 0x30){ 176880d7d618SMatthias Ringwald hci_stack->substate = HCI_INIT_LE_SET_EVENT_MASK; 1769b435e062SMatthias Ringwald return; 1770b435e062SMatthias Ringwald } 1771b435e062SMatthias Ringwald // explicit fall through to reduce repetitions 1772b435e062SMatthias Ringwald 1773b435e062SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 1774b435e062SMatthias Ringwald hci_stack->substate = HCI_INIT_READ_WHITE_LIST_SIZE; 1775903ea03aSMatthias Ringwald #else 1776903ea03aSMatthias Ringwald hci_init_done(); 1777903ea03aSMatthias Ringwald #endif 1778a828a756SMatthias Ringwald return; 177906337f4fSMatthias Ringwald #endif /* ENABLE_LE_DATA_LENGTH_EXTENSION */ 178006337f4fSMatthias Ringwald 178106337f4fSMatthias Ringwald #endif /* ENABLE_BLE */ 1782b435e062SMatthias Ringwald 178371c4de7aSMatthias Ringwald #ifdef ENABLE_SCO_OVER_HCI 1784729ed62eSMatthias Ringwald case HCI_INIT_W4_WRITE_SCAN_ENABLE: 17853905afbfSMatthias Ringwald // skip write synchronous flow control if not supported 17863905afbfSMatthias Ringwald if (hci_stack->local_supported_commands[0] & 0x04) break; 17873905afbfSMatthias Ringwald hci_stack->substate = HCI_INIT_W4_WRITE_SYNCHRONOUS_FLOW_CONTROL_ENABLE; 17883905afbfSMatthias Ringwald // explicit fall through to reduce repetitions 17893905afbfSMatthias Ringwald 1790729ed62eSMatthias Ringwald case HCI_INIT_W4_WRITE_SYNCHRONOUS_FLOW_CONTROL_ENABLE: 17913905afbfSMatthias Ringwald // skip write default erroneous data reporting if not supported 17923905afbfSMatthias Ringwald if (hci_stack->local_supported_commands[0] & 0x08) break; 17933905afbfSMatthias Ringwald hci_stack->substate = HCI_INIT_W4_WRITE_DEFAULT_ERRONEOUS_DATA_REPORTING; 17943905afbfSMatthias Ringwald // explicit fall through to reduce repetitions 17953905afbfSMatthias Ringwald 1796f064e0bbSMatthias Ringwald case HCI_INIT_W4_WRITE_DEFAULT_ERRONEOUS_DATA_REPORTING: 1797a42798c3SMatthias Ringwald // skip bcm set sco pcm config on non-Broadcom chipsets 179861f37892SMatthias Ringwald if (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_BROADCOM_CORPORATION) break; 1799a42798c3SMatthias Ringwald hci_stack->substate = HCI_INIT_W4_BCM_WRITE_SCO_PCM_INT; 1800a42798c3SMatthias Ringwald // explicit fall through to reduce repetitions 1801a42798c3SMatthias Ringwald 1802a42798c3SMatthias Ringwald case HCI_INIT_W4_BCM_WRITE_SCO_PCM_INT: 1803729ed62eSMatthias Ringwald if (!hci_le_supported()){ 1804729ed62eSMatthias Ringwald // SKIP LE init for Classic only configuration 1805a650ba4dSMatthias Ringwald hci_init_done(); 1806729ed62eSMatthias Ringwald return; 1807729ed62eSMatthias Ringwald } 1808729ed62eSMatthias Ringwald break; 1809f3b012f9SMatthias Ringwald 1810f3b012f9SMatthias Ringwald #else /* !ENABLE_SCO_OVER_HCI */ 1811f3b012f9SMatthias Ringwald 181274b323a9SMatthias Ringwald case HCI_INIT_W4_WRITE_SCAN_ENABLE: 1813f3b012f9SMatthias Ringwald #ifdef ENABLE_BLE 1814f3b012f9SMatthias Ringwald if (hci_le_supported()){ 1815f3b012f9SMatthias Ringwald hci_stack->substate = HCI_INIT_LE_READ_BUFFER_SIZE; 181674b323a9SMatthias Ringwald return; 18176155b3d3S[email protected] } 1818729ed62eSMatthias Ringwald #endif 1819f3b012f9SMatthias Ringwald // SKIP LE init for Classic only configuration 1820f3b012f9SMatthias Ringwald hci_init_done(); 1821f3b012f9SMatthias Ringwald return; 1822f3b012f9SMatthias Ringwald #endif /* ENABLE_SCO_OVER_HCI */ 1823f3b012f9SMatthias Ringwald 1824a4e96e78SMatthias Ringwald // avoid compile error due to duplicate cases: HCI_INIT_W4_BCM_WRITE_SCO_PCM_INT == HCI_INIT_DONE-1 1825a4e96e78SMatthias Ringwald #if defined(ENABLE_BLE) || defined(ENABLE_LE_DATA_LENGTH_EXTENSION) || defined(ENABLE_LE_CENTRAL) 1826a650ba4dSMatthias Ringwald // Response to command before init done state -> init done 1827a650ba4dSMatthias Ringwald case (HCI_INIT_DONE-1): 1828a650ba4dSMatthias Ringwald hci_init_done(); 1829a650ba4dSMatthias Ringwald return; 1830a4e96e78SMatthias Ringwald #endif 1831a650ba4dSMatthias Ringwald 18326155b3d3S[email protected] default: 183374b323a9SMatthias Ringwald break; 18346155b3d3S[email protected] } 183555975f88SMatthias Ringwald hci_initializing_next_state(); 18366155b3d3S[email protected] } 18376155b3d3S[email protected] 18380bbba85bSMatthias Ringwald static void hci_handle_connection_failed(hci_connection_t * conn, uint8_t status){ 1839229331c6SMatthias Ringwald log_info("Outgoing connection to %s failed", bd_addr_to_str(conn->address)); 18400bbba85bSMatthias Ringwald bd_addr_t bd_address; 18410bbba85bSMatthias Ringwald memcpy(&bd_address, conn->address, 6); 18420bbba85bSMatthias Ringwald 18436bc9fa5eSMatthias Ringwald #ifdef ENABLE_CLASSIC 18446bc9fa5eSMatthias Ringwald // cache needed data 18456bc9fa5eSMatthias Ringwald int notify_dedicated_bonding_failed = conn->bonding_flags & BONDING_DEDICATED; 18466bc9fa5eSMatthias Ringwald #endif 18476bc9fa5eSMatthias Ringwald 18480bbba85bSMatthias Ringwald // connection failed, remove entry 18490bbba85bSMatthias Ringwald btstack_linked_list_remove(&hci_stack->connections, (btstack_linked_item_t *) conn); 18500bbba85bSMatthias Ringwald btstack_memory_hci_connection_free( conn ); 18510bbba85bSMatthias Ringwald 18526bc9fa5eSMatthias Ringwald #ifdef ENABLE_CLASSIC 18530bbba85bSMatthias Ringwald // notify client if dedicated bonding 18540bbba85bSMatthias Ringwald if (notify_dedicated_bonding_failed){ 18550bbba85bSMatthias Ringwald log_info("hci notify_dedicated_bonding_failed"); 18560bbba85bSMatthias Ringwald hci_emit_dedicated_bonding_result(bd_address, status); 18570bbba85bSMatthias Ringwald } 18580bbba85bSMatthias Ringwald 18590bbba85bSMatthias Ringwald // if authentication error, also delete link key 18600bbba85bSMatthias Ringwald if (status == ERROR_CODE_AUTHENTICATION_FAILURE) { 18610bbba85bSMatthias Ringwald gap_drop_link_key_for_bd_addr(bd_address); 18620bbba85bSMatthias Ringwald } 18636bc9fa5eSMatthias Ringwald #endif 18640bbba85bSMatthias Ringwald } 18650bbba85bSMatthias Ringwald 186616833f0aSmatthias.ringwald static void event_handler(uint8_t *packet, int size){ 1867e76a89eeS[email protected] 1868e76a89eeS[email protected] uint16_t event_length = packet[1]; 1869e76a89eeS[email protected] 1870e76a89eeS[email protected] // assert packet is complete 1871e76a89eeS[email protected] if (size != event_length + 2){ 18723dce6128SMatthias Ringwald log_error("event_handler called with packet of wrong size %d, expected %u => dropping packet", size, event_length + 2); 1873e76a89eeS[email protected] return; 1874e76a89eeS[email protected] } 1875e76a89eeS[email protected] 18761281a47eSmatthias.ringwald bd_addr_t addr; 187796a45072S[email protected] bd_addr_type_t addr_type; 1878fe1ed1b8Smatthias.ringwald hci_con_handle_t handle; 18791f7b95a1Smatthias.ringwald hci_connection_t * conn; 188056cf178bSmatthias.ringwald int i; 1881c57fa566SMatthias Ringwald int create_connection_cmd; 1882c57fa566SMatthias Ringwald 18830014e02cSMatthias Ringwald #ifdef ENABLE_CLASSIC 18840014e02cSMatthias Ringwald uint8_t link_type; 18850014e02cSMatthias Ringwald #endif 188635454696SMatthias Ringwald 18870e2df43fSMatthias Ringwald // log_info("HCI:EVENT:%02x", hci_event_packet_get_type(packet)); 18885909f7f2Smatthias.ringwald 18890e2df43fSMatthias Ringwald switch (hci_event_packet_get_type(packet)) { 189022909952Smatthias.ringwald 18916772a24cSmatthias.ringwald case HCI_EVENT_COMMAND_COMPLETE: 18926bef4003SMatthias Ringwald // get num cmd packets - limit to 1 to reduce complexity 18936bef4003SMatthias Ringwald hci_stack->num_cmd_packets = packet[2] ? 1 : 0; 18947ec5eeaaSmatthias.ringwald 18959e263bd7SMatthias Ringwald if (HCI_EVENT_IS_COMMAND_COMPLETE(packet, hci_read_local_name)){ 189606b9e820SMatthias Ringwald if (packet[5]) break; 18979e263bd7SMatthias Ringwald // terminate, name 248 chars 18989e263bd7SMatthias Ringwald packet[6+248] = 0; 18999e263bd7SMatthias Ringwald log_info("local name: %s", &packet[6]); 19009e263bd7SMatthias Ringwald } 1901073bd0faSMatthias Ringwald if (HCI_EVENT_IS_COMMAND_COMPLETE(packet, hci_read_buffer_size)){ 19021d279b20Smatthias.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" 1903429122ccSMatthias Ringwald if (hci_stack->state == HCI_STATE_INITIALIZING){ 1904429122ccSMatthias Ringwald uint16_t acl_len = little_endian_read_16(packet, 6); 1905429122ccSMatthias Ringwald uint16_t sco_len = packet[8]; 1906429122ccSMatthias Ringwald 1907429122ccSMatthias Ringwald // determine usable ACL/SCO payload size 1908429122ccSMatthias Ringwald hci_stack->acl_data_packet_length = btstack_min(acl_len, HCI_ACL_PAYLOAD_SIZE); 1909429122ccSMatthias Ringwald hci_stack->sco_data_packet_length = btstack_min(sco_len, HCI_ACL_PAYLOAD_SIZE); 1910429122ccSMatthias Ringwald 1911f8fbdce0SMatthias Ringwald hci_stack->acl_packets_total_num = little_endian_read_16(packet, 9); 1912f8fbdce0SMatthias Ringwald hci_stack->sco_packets_total_num = little_endian_read_16(packet, 11); 1913a8b12447S[email protected] 1914429122ccSMatthias Ringwald log_info("hci_read_buffer_size: ACL size module %u -> used %u, count %u / SCO size %u, count %u", 1915429122ccSMatthias Ringwald acl_len, hci_stack->acl_data_packet_length, hci_stack->acl_packets_total_num, 19161a06f663S[email protected] hci_stack->sco_data_packet_length, hci_stack->sco_packets_total_num); 1917e2edc0c3Smatthias.ringwald } 191856cf178bSmatthias.ringwald } 1919a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE 1920073bd0faSMatthias Ringwald if (HCI_EVENT_IS_COMMAND_COMPLETE(packet, hci_le_read_buffer_size)){ 1921f8fbdce0SMatthias Ringwald hci_stack->le_data_packets_length = little_endian_read_16(packet, 6); 1922ee303eddS[email protected] hci_stack->le_acl_packets_total_num = packet[8]; 19236c26b087S[email protected] // determine usable ACL payload size 19246c26b087S[email protected] if (HCI_ACL_PAYLOAD_SIZE < hci_stack->le_data_packets_length){ 19256c26b087S[email protected] hci_stack->le_data_packets_length = HCI_ACL_PAYLOAD_SIZE; 19266c26b087S[email protected] } 19279da54300S[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); 192865a46ef3S[email protected] } 1929b435e062SMatthias Ringwald #endif 1930b435e062SMatthias Ringwald #ifdef ENABLE_LE_DATA_LENGTH_EXTENSION 1931dcd678baSMatthias Ringwald if (HCI_EVENT_IS_COMMAND_COMPLETE(packet, hci_le_read_maximum_data_length)){ 1932dcd678baSMatthias Ringwald hci_stack->le_supported_max_tx_octets = little_endian_read_16(packet, 6); 1933dcd678baSMatthias Ringwald hci_stack->le_supported_max_tx_time = little_endian_read_16(packet, 8); 1934dcd678baSMatthias 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); 1935dcd678baSMatthias Ringwald } 1936b435e062SMatthias Ringwald #endif 1937d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 1938073bd0faSMatthias Ringwald if (HCI_EVENT_IS_COMMAND_COMPLETE(packet, hci_le_read_white_list_size)){ 1939e691bb38SMatthias Ringwald hci_stack->le_whitelist_capacity = packet[6]; 194015d0a15bSMatthias Ringwald log_info("hci_le_read_white_list_size: size %u", hci_stack->le_whitelist_capacity); 19413b6d4121SMatthias Ringwald } 194265a46ef3S[email protected] #endif 1943073bd0faSMatthias Ringwald if (HCI_EVENT_IS_COMMAND_COMPLETE(packet, hci_read_bd_addr)) { 1944724d70a2SMatthias Ringwald reverse_bd_addr(&packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE + 1], 1945724d70a2SMatthias Ringwald hci_stack->local_bd_addr); 19469da54300S[email protected] log_info("Local Address, Status: 0x%02x: Addr: %s", 19473a9fb326S[email protected] packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE], bd_addr_to_str(hci_stack->local_bd_addr)); 194833373e40SMatthias Ringwald #ifdef ENABLE_CLASSIC 19491624665aSMatthias Ringwald if (hci_stack->link_key_db){ 19501624665aSMatthias Ringwald hci_stack->link_key_db->set_local_bd_addr(hci_stack->local_bd_addr); 19511624665aSMatthias Ringwald } 195233373e40SMatthias Ringwald #endif 1953188981d2Smatthias.ringwald } 195435454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 1955073bd0faSMatthias Ringwald if (HCI_EVENT_IS_COMMAND_COMPLETE(packet, hci_write_scan_enable)){ 19563a9fb326S[email protected] hci_emit_discoverable_enabled(hci_stack->discoverable); 1957381fbed8Smatthias.ringwald } 1958f5875de5SMatthias Ringwald if (HCI_EVENT_IS_COMMAND_COMPLETE(packet, hci_inquiry_cancel)){ 1959f5875de5SMatthias Ringwald if (hci_stack->inquiry_state == GAP_INQUIRY_STATE_W4_CANCELLED){ 1960f5875de5SMatthias Ringwald hci_stack->inquiry_state = GAP_INQUIRY_STATE_IDLE; 1961f5875de5SMatthias Ringwald uint8_t event[] = { GAP_EVENT_INQUIRY_COMPLETE, 1, 0}; 1962f5875de5SMatthias Ringwald hci_emit_event(event, sizeof(event), 1); 1963f5875de5SMatthias Ringwald } 1964f5875de5SMatthias Ringwald } 196535454696SMatthias Ringwald #endif 196635454696SMatthias Ringwald 196765389bfcS[email protected] // Note: HCI init checks 1968073bd0faSMatthias Ringwald if (HCI_EVENT_IS_COMMAND_COMPLETE(packet, hci_read_local_supported_features)){ 19693a9fb326S[email protected] memcpy(hci_stack->local_supported_features, &packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1], 8); 197065389bfcS[email protected] 197135454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 1972a5a23fc2S[email protected] // determine usable ACL packet types based on host buffer size and supported features 1973a5a23fc2S[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]); 19748b96126aSMatthias Ringwald log_info("Packet types %04x, eSCO %u", hci_stack->packet_types, hci_extended_sco_link_supported()); 197535454696SMatthias Ringwald #endif 1976f5d8d141S[email protected] // Classic/LE 1977f5d8d141S[email protected] log_info("BR/EDR support %u, LE support %u", hci_classic_supported(), hci_le_supported()); 1978559e517eS[email protected] } 1979073bd0faSMatthias Ringwald if (HCI_EVENT_IS_COMMAND_COMPLETE(packet, hci_read_local_version_information)){ 1980f8fbdce0SMatthias Ringwald // hci_stack->hci_version = little_endian_read_16(packet, 4); 1981f8fbdce0SMatthias Ringwald // hci_stack->hci_revision = little_endian_read_16(packet, 6); 1982c21d89f3SMatthias Ringwald uint16_t manufacturer = little_endian_read_16(packet, 10); 1983c21d89f3SMatthias Ringwald // map Cypress to Broadcom 1984c21d89f3SMatthias Ringwald if (manufacturer == BLUETOOTH_COMPANY_ID_CYPRESS_SEMICONDUCTOR){ 1985c21d89f3SMatthias Ringwald log_info("Treat Cypress as Broadcom"); 1986c21d89f3SMatthias Ringwald manufacturer = BLUETOOTH_COMPANY_ID_BROADCOM_CORPORATION; 1987c21d89f3SMatthias Ringwald little_endian_store_16(packet, 10, manufacturer); 1988c21d89f3SMatthias Ringwald } 1989c21d89f3SMatthias Ringwald hci_stack->manufacturer = manufacturer; 1990f8fbdce0SMatthias Ringwald // hci_stack->lmp_version = little_endian_read_16(packet, 8); 1991f8fbdce0SMatthias Ringwald // hci_stack->lmp_subversion = little_endian_read_16(packet, 12); 19924696bddbSMatthias Ringwald log_info("Manufacturer: 0x%04x", hci_stack->manufacturer); 19934696bddbSMatthias Ringwald } 1994073bd0faSMatthias Ringwald if (HCI_EVENT_IS_COMMAND_COMPLETE(packet, hci_read_local_supported_commands)){ 1995a828a756SMatthias Ringwald hci_stack->local_supported_commands[0] = 1996cd542ed6SMatthias Ringwald (packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1+14] & 0x80) >> 7 | // bit 0 = Octet 14, bit 7 / Read Buffer Size 1997cd542ed6SMatthias Ringwald (packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1+24] & 0x40) >> 5 | // bit 1 = Octet 24, bit 6 / Write Le Host Supported 1998cd542ed6SMatthias Ringwald (packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1+10] & 0x10) >> 2 | // bit 2 = Octet 10, bit 4 / Write Synchronous Flow Control Enable 1999cd542ed6SMatthias Ringwald (packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1+18] & 0x08) | // bit 3 = Octet 18, bit 3 / Write Default Erroneous Data Reporting 2000cd542ed6SMatthias Ringwald (packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1+34] & 0x01) << 4 | // bit 4 = Octet 34, bit 0 / LE Write Suggested Default Data Length 2001cd542ed6SMatthias Ringwald (packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1+35] & 0x08) << 2 | // bit 5 = Octet 35, bit 3 / LE Read Maximum Data Length 2002cd542ed6SMatthias Ringwald (packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1+35] & 0x20) << 1; // bit 6 = Octet 35, bit 5 / LE Set Default PHY 20033905afbfSMatthias Ringwald log_info("Local supported commands summary 0x%02x", hci_stack->local_supported_commands[0]); 2004a828a756SMatthias Ringwald } 2005e8c8828eSMatthias Ringwald #ifdef ENABLE_CLASSIC 2006073bd0faSMatthias Ringwald if (HCI_EVENT_IS_COMMAND_COMPLETE(packet, hci_write_synchronous_flow_control_enable)){ 20075b9b590fSMatthias Ringwald if (packet[5] == 0){ 20085b9b590fSMatthias Ringwald hci_stack->synchronous_flow_control_enabled = 1; 20095b9b590fSMatthias Ringwald } 20105b9b590fSMatthias Ringwald } 2011573897a0SMatthias Ringwald if (HCI_EVENT_IS_COMMAND_COMPLETE(packet, hci_read_encryption_key_size)){ 2012573897a0SMatthias Ringwald uint8_t status = packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE]; 2013573897a0SMatthias Ringwald handle = little_endian_read_16(packet, OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1); 2014573897a0SMatthias Ringwald conn = hci_connection_for_handle(handle); 2015573897a0SMatthias Ringwald if (!conn) break; 2016573897a0SMatthias Ringwald if (status == 0){ 2017573897a0SMatthias Ringwald uint8_t key_size = packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+3]; 2018573897a0SMatthias Ringwald log_info("Handle %x04x key Size: %u", handle, key_size); 2019573897a0SMatthias Ringwald conn->encryption_key_size = key_size; 2020170fafaeSMatthias Ringwald } else { 2021170fafaeSMatthias Ringwald log_info("Read Encryption Key Size failed -> assuming insecure connection with key size of 1"); 2022170fafaeSMatthias Ringwald conn->encryption_key_size = 1; 2023573897a0SMatthias Ringwald } 2024573897a0SMatthias Ringwald conn->authentication_flags |= CONNECTION_ENCRYPTED; 2025573897a0SMatthias Ringwald hci_emit_security_level(handle, gap_security_level_for_connection(conn)); 2026573897a0SMatthias Ringwald } 2027e8c8828eSMatthias Ringwald #endif 202856cf178bSmatthias.ringwald break; 202956cf178bSmatthias.ringwald 20307ec5eeaaSmatthias.ringwald case HCI_EVENT_COMMAND_STATUS: 20316bef4003SMatthias Ringwald // get num cmd packets - limit to 1 to reduce complexity 20326bef4003SMatthias Ringwald hci_stack->num_cmd_packets = packet[3] ? 1 : 0; 2033229331c6SMatthias Ringwald 2034229331c6SMatthias Ringwald // check command status to detected failed outgoing connections 2035c57fa566SMatthias Ringwald create_connection_cmd = 0; 2036c57fa566SMatthias Ringwald #ifdef ENABLE_CLASSIC 2037c57fa566SMatthias Ringwald if (HCI_EVENT_IS_COMMAND_STATUS(packet, hci_create_connection)){ 2038c57fa566SMatthias Ringwald create_connection_cmd = 1; 2039c57fa566SMatthias Ringwald } 2040c57fa566SMatthias Ringwald #endif 2041c57fa566SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 2042c57fa566SMatthias Ringwald if (HCI_EVENT_IS_COMMAND_STATUS(packet, hci_le_create_connection)){ 2043c57fa566SMatthias Ringwald create_connection_cmd = 1; 2044c57fa566SMatthias Ringwald } 2045c57fa566SMatthias Ringwald #endif 2046c57fa566SMatthias Ringwald if (create_connection_cmd) { 2047229331c6SMatthias Ringwald uint8_t status = hci_event_command_status_get_status(packet); 2048229331c6SMatthias Ringwald conn = hci_connection_for_bd_addr_and_type(hci_stack->outgoing_addr, hci_stack->outgoing_addr_type); 2049229331c6SMatthias 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), hci_stack->outgoing_addr_type); 2050229331c6SMatthias Ringwald 2051229331c6SMatthias Ringwald // reset outgoing address info 2052229331c6SMatthias Ringwald memset(hci_stack->outgoing_addr, 0, 6); 2053229331c6SMatthias Ringwald hci_stack->outgoing_addr_type = BD_ADDR_TYPE_UNKNOWN; 2054229331c6SMatthias Ringwald 2055229331c6SMatthias Ringwald // error => outgoing connection failed 2056229331c6SMatthias Ringwald if ((conn != NULL) && (status != 0)){ 2057229331c6SMatthias Ringwald hci_handle_connection_failed(conn, status); 2058229331c6SMatthias Ringwald } 2059229331c6SMatthias Ringwald } 20607ec5eeaaSmatthias.ringwald break; 20617ec5eeaaSmatthias.ringwald 20622e440c8aS[email protected] case HCI_EVENT_NUMBER_OF_COMPLETED_PACKETS:{ 20632e440c8aS[email protected] int offset = 3; 206456cf178bSmatthias.ringwald for (i=0; i<packet[2];i++){ 206580117cebSMatthias Ringwald handle = little_endian_read_16(packet, offset) & 0x0fff; 20662e440c8aS[email protected] offset += 2; 2067f8fbdce0SMatthias Ringwald uint16_t num_packets = little_endian_read_16(packet, offset); 20682e440c8aS[email protected] offset += 2; 20692e440c8aS[email protected] 20705061f3afS[email protected] conn = hci_connection_for_handle(handle); 207156cf178bSmatthias.ringwald if (!conn){ 20729da54300S[email protected] log_error("hci_number_completed_packet lists unused con handle %u", handle); 207356cf178bSmatthias.ringwald continue; 207456cf178bSmatthias.ringwald } 207523bed257S[email protected] 2076ce41473eSMatthias Ringwald if (conn->num_packets_sent >= num_packets){ 2077ce41473eSMatthias Ringwald conn->num_packets_sent -= num_packets; 2078e35edcc1S[email protected] } else { 2079ce41473eSMatthias Ringwald log_error("hci_number_completed_packets, more packet slots freed then sent."); 2080ce41473eSMatthias Ringwald conn->num_packets_sent = 0; 2081e35edcc1S[email protected] } 2082ce41473eSMatthias Ringwald // log_info("hci_number_completed_packet %u processed for handle %u, outstanding %u", num_packets, handle, conn->num_packets_sent); 2083760b20efSMatthias Ringwald 2084760b20efSMatthias Ringwald #ifdef ENABLE_CLASSIC 2085760b20efSMatthias Ringwald // For SCO, we do the can_send_now_check here 2086760b20efSMatthias Ringwald hci_notify_if_sco_can_send_now(); 2087760b20efSMatthias Ringwald #endif 208856cf178bSmatthias.ringwald } 20896772a24cSmatthias.ringwald break; 20902e440c8aS[email protected] } 209135454696SMatthias Ringwald 209235454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 2093f5875de5SMatthias Ringwald case HCI_EVENT_INQUIRY_COMPLETE: 2094f5875de5SMatthias Ringwald if (hci_stack->inquiry_state == GAP_INQUIRY_STATE_ACTIVE){ 2095f5875de5SMatthias Ringwald hci_stack->inquiry_state = GAP_INQUIRY_STATE_IDLE; 2096f5875de5SMatthias Ringwald uint8_t event[] = { GAP_EVENT_INQUIRY_COMPLETE, 1, 0}; 2097f5875de5SMatthias Ringwald hci_emit_event(event, sizeof(event), 1); 2098f5875de5SMatthias Ringwald } 2099f5875de5SMatthias Ringwald break; 2100b7f1ee76SMatthias Ringwald case HCI_EVENT_REMOTE_NAME_REQUEST_COMPLETE: 2101b7f1ee76SMatthias Ringwald if (hci_stack->remote_name_state == GAP_REMOTE_NAME_STATE_W4_COMPLETE){ 2102b7f1ee76SMatthias Ringwald hci_stack->remote_name_state = GAP_REMOTE_NAME_STATE_IDLE; 2103b7f1ee76SMatthias Ringwald } 2104b7f1ee76SMatthias Ringwald break; 21051f7b95a1Smatthias.ringwald case HCI_EVENT_CONNECTION_REQUEST: 2106724d70a2SMatthias Ringwald reverse_bd_addr(&packet[2], addr); 210737eaa4cfSmatthias.ringwald // TODO: eval COD 8-10 21082d00edd4Smatthias.ringwald link_type = packet[11]; 21099da54300S[email protected] log_info("Connection_incoming: %s, type %u", bd_addr_to_str(addr), link_type); 2110e35edcc1S[email protected] addr_type = link_type == 1 ? BD_ADDR_TYPE_CLASSIC : BD_ADDR_TYPE_SCO; 21112e77e513S[email protected] conn = hci_connection_for_bd_addr_and_type(addr, addr_type); 21121f7b95a1Smatthias.ringwald if (!conn) { 21135293c072S[email protected] conn = create_connection_for_bd_addr_and_type(addr, addr_type); 21141f7b95a1Smatthias.ringwald } 2115ce4c8fabSmatthias.ringwald if (!conn) { 2116ce4c8fabSmatthias.ringwald // CONNECTION REJECTED DUE TO LIMITED RESOURCES (0X0D) 21173a9fb326S[email protected] hci_stack->decline_reason = 0x0d; 2118058e3d6bSMatthias Ringwald bd_addr_copy(hci_stack->decline_addr, addr); 2119ce4c8fabSmatthias.ringwald break; 2120ce4c8fabSmatthias.ringwald } 21215cf766e8SMatthias Ringwald conn->role = HCI_ROLE_SLAVE; 212232ab9390Smatthias.ringwald conn->state = RECEIVED_CONNECTION_REQUEST; 2123f3a16b9aSMatthias Ringwald // store info about eSCO 2124f3a16b9aSMatthias Ringwald if (link_type == 0x02){ 2125f3a16b9aSMatthias Ringwald conn->remote_supported_feature_eSCO = 1; 2126f3a16b9aSMatthias Ringwald } 212732ab9390Smatthias.ringwald hci_run(); 21281f7b95a1Smatthias.ringwald break; 21291f7b95a1Smatthias.ringwald 21306772a24cSmatthias.ringwald case HCI_EVENT_CONNECTION_COMPLETE: 2131fe1ed1b8Smatthias.ringwald // Connection management 2132724d70a2SMatthias Ringwald reverse_bd_addr(&packet[5], addr); 21339da54300S[email protected] log_info("Connection_complete (status=%u) %s", packet[2], bd_addr_to_str(addr)); 213496a45072S[email protected] addr_type = BD_ADDR_TYPE_CLASSIC; 21352e77e513S[email protected] conn = hci_connection_for_bd_addr_and_type(addr, addr_type); 2136fe1ed1b8Smatthias.ringwald if (conn) { 2137b448a0e7Smatthias.ringwald if (!packet[2]){ 2138c8e4258aSmatthias.ringwald conn->state = OPEN; 2139f8fbdce0SMatthias Ringwald conn->con_handle = little_endian_read_16(packet, 3); 2140ad83dc6aS[email protected] conn->bonding_flags |= BONDING_REQUEST_REMOTE_FEATURES; 2141ee091cf1Smatthias.ringwald 2142c785ef68Smatthias.ringwald // restart timer 2143528a4a3bSMatthias Ringwald btstack_run_loop_set_timer(&conn->timeout, HCI_CONNECTION_TIMEOUT_MS); 2144528a4a3bSMatthias Ringwald btstack_run_loop_add_timer(&conn->timeout); 2145c785ef68Smatthias.ringwald 21469da54300S[email protected] log_info("New connection: handle %u, %s", conn->con_handle, bd_addr_to_str(conn->address)); 214743bfb1bdSmatthias.ringwald 214843bfb1bdSmatthias.ringwald hci_emit_nr_connections_changed(); 2149b448a0e7Smatthias.ringwald } else { 21500bbba85bSMatthias Ringwald // connection failed 21510bbba85bSMatthias Ringwald hci_handle_connection_failed(conn, packet[2]); 2152fe1ed1b8Smatthias.ringwald } 2153fe1ed1b8Smatthias.ringwald } 21546772a24cSmatthias.ringwald break; 2155fe1ed1b8Smatthias.ringwald 215644d0e3d5S[email protected] case HCI_EVENT_SYNCHRONOUS_CONNECTION_COMPLETE: 2157724d70a2SMatthias Ringwald reverse_bd_addr(&packet[5], addr); 215844d0e3d5S[email protected] log_info("Synchronous Connection Complete (status=%u) %s", packet[2], bd_addr_to_str(addr)); 21591a06f663S[email protected] if (packet[2]){ 216044d0e3d5S[email protected] // connection failed 216144d0e3d5S[email protected] break; 216244d0e3d5S[email protected] } 21632e77e513S[email protected] conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_SCO); 2164e35edcc1S[email protected] if (!conn) { 2165e35edcc1S[email protected] conn = create_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_SCO); 2166e35edcc1S[email protected] } 2167e35edcc1S[email protected] if (!conn) { 2168e35edcc1S[email protected] break; 2169e35edcc1S[email protected] } 21701a06f663S[email protected] conn->state = OPEN; 2171f8fbdce0SMatthias Ringwald conn->con_handle = little_endian_read_16(packet, 3); 2172ee752bb8SMatthias Ringwald 2173ee752bb8SMatthias Ringwald #ifdef ENABLE_SCO_OVER_HCI 2174ee752bb8SMatthias Ringwald // update SCO 2175ee752bb8SMatthias Ringwald if (conn->address_type == BD_ADDR_TYPE_SCO && hci_stack->hci_transport && hci_stack->hci_transport->set_sco_config){ 2176ee752bb8SMatthias Ringwald hci_stack->hci_transport->set_sco_config(hci_stack->sco_voice_setting_active, hci_number_sco_connections()); 2177ee752bb8SMatthias Ringwald } 2178f234b250SMatthias Ringwald // trigger can send now 2179f234b250SMatthias Ringwald if (hci_have_usb_transport()){ 2180f234b250SMatthias Ringwald hci_stack->sco_can_send_now = 1; 2181f234b250SMatthias Ringwald } 2182ee752bb8SMatthias Ringwald #endif 218344d0e3d5S[email protected] break; 218444d0e3d5S[email protected] 2185afd4e962S[email protected] case HCI_EVENT_READ_REMOTE_SUPPORTED_FEATURES_COMPLETE: 2186f8fbdce0SMatthias Ringwald handle = little_endian_read_16(packet, 3); 2187afd4e962S[email protected] conn = hci_connection_for_handle(handle); 2188afd4e962S[email protected] if (!conn) break; 2189afd4e962S[email protected] if (!packet[2]){ 2190afd4e962S[email protected] uint8_t * features = &packet[5]; 2191afd4e962S[email protected] if (features[6] & (1 << 3)){ 2192afd4e962S[email protected] conn->bonding_flags |= BONDING_REMOTE_SUPPORTS_SSP; 2193afd4e962S[email protected] } 219498a2fd1cSMatthias Ringwald if (features[3] & (1<<7)){ 219598a2fd1cSMatthias Ringwald conn->remote_supported_feature_eSCO = 1; 219698a2fd1cSMatthias Ringwald } 2197afd4e962S[email protected] } 2198afd4e962S[email protected] conn->bonding_flags |= BONDING_RECEIVED_REMOTE_FEATURES; 219998a2fd1cSMatthias Ringwald log_info("HCI_EVENT_READ_REMOTE_SUPPORTED_FEATURES_COMPLETE, bonding flags %x, eSCO %u", conn->bonding_flags, conn->remote_supported_feature_eSCO); 2200ad83dc6aS[email protected] if (conn->bonding_flags & BONDING_DEDICATED){ 2201ad83dc6aS[email protected] conn->bonding_flags |= BONDING_SEND_AUTHENTICATE_REQUEST; 2202ad83dc6aS[email protected] } 2203afd4e962S[email protected] break; 2204afd4e962S[email protected] 22057fde4af9Smatthias.ringwald case HCI_EVENT_LINK_KEY_REQUEST: 22069da54300S[email protected] log_info("HCI_EVENT_LINK_KEY_REQUEST"); 22077fde4af9Smatthias.ringwald hci_add_connection_flags_for_flipped_bd_addr(&packet[2], RECV_LINK_KEY_REQUEST); 220874d716b5S[email protected] // non-bondable mode: link key negative reply will be sent by HANDLE_LINK_KEY_REQUEST 2209a98592bcSMatthias Ringwald if (hci_stack->bondable && !hci_stack->link_key_db) break; 221032ab9390Smatthias.ringwald hci_add_connection_flags_for_flipped_bd_addr(&packet[2], HANDLE_LINK_KEY_REQUEST); 221164472d52Smatthias.ringwald hci_run(); 2212d9a327f9Smatthias.ringwald // request handled by hci_run() as HANDLE_LINK_KEY_REQUEST gets set 221329d53098Smatthias.ringwald return; 22147fde4af9Smatthias.ringwald 22159ab95c90S[email protected] case HCI_EVENT_LINK_KEY_NOTIFICATION: { 2216724d70a2SMatthias Ringwald reverse_bd_addr(&packet[2], addr); 22172e77e513S[email protected] conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_CLASSIC); 22189ab95c90S[email protected] if (!conn) break; 22199ab95c90S[email protected] conn->authentication_flags |= RECV_LINK_KEY_NOTIFICATION; 22207bdc6798S[email protected] link_key_type_t link_key_type = (link_key_type_t)packet[24]; 22219ab95c90S[email protected] // Change Connection Encryption keeps link key type 22229ab95c90S[email protected] if (link_key_type != CHANGED_COMBINATION_KEY){ 22239ab95c90S[email protected] conn->link_key_type = link_key_type; 22249ab95c90S[email protected] } 222555597469SMatthias Ringwald gap_store_link_key_for_bd_addr(addr, &packet[8], conn->link_key_type); 222629d53098Smatthias.ringwald // still forward event to allow dismiss of pairing dialog 22277fde4af9Smatthias.ringwald break; 22289ab95c90S[email protected] } 22297fde4af9Smatthias.ringwald 22307fde4af9Smatthias.ringwald case HCI_EVENT_PIN_CODE_REQUEST: 22316724cd9eS[email protected] hci_add_connection_flags_for_flipped_bd_addr(&packet[2], LEGACY_PAIRING_ACTIVE); 22324c57c146S[email protected] // non-bondable mode: pin code negative reply will be sent 22333a9fb326S[email protected] if (!hci_stack->bondable){ 2234899283eaS[email protected] hci_add_connection_flags_for_flipped_bd_addr(&packet[2], DENY_PIN_CODE_REQUEST); 2235f8fb5f6eS[email protected] hci_run(); 2236f8fb5f6eS[email protected] return; 22374c57c146S[email protected] } 2238d9a327f9Smatthias.ringwald // PIN CODE REQUEST means the link key request didn't succee -> delete stored link key 2239a98592bcSMatthias Ringwald if (!hci_stack->link_key_db) break; 2240a6ef64baSMilanka Ringwald hci_event_pin_code_request_get_bd_addr(packet, addr); 2241a98592bcSMatthias Ringwald hci_stack->link_key_db->delete_link_key(addr); 22427fde4af9Smatthias.ringwald break; 22437fde4af9Smatthias.ringwald 22441d6b20aeS[email protected] case HCI_EVENT_IO_CAPABILITY_REQUEST: 22451d6b20aeS[email protected] hci_add_connection_flags_for_flipped_bd_addr(&packet[2], RECV_IO_CAPABILITIES_REQUEST); 2246dbe1a790S[email protected] hci_add_connection_flags_for_flipped_bd_addr(&packet[2], SEND_IO_CAPABILITIES_REPLY); 2247dbe1a790S[email protected] break; 2248dbe1a790S[email protected] 2249dbe1a790S[email protected] case HCI_EVENT_USER_CONFIRMATION_REQUEST: 22506724cd9eS[email protected] hci_add_connection_flags_for_flipped_bd_addr(&packet[2], SSP_PAIRING_ACTIVE); 22513a9fb326S[email protected] if (!hci_stack->ssp_auto_accept) break; 2252dbe1a790S[email protected] hci_add_connection_flags_for_flipped_bd_addr(&packet[2], SEND_USER_CONFIRM_REPLY); 2253dbe1a790S[email protected] break; 2254dbe1a790S[email protected] 2255dbe1a790S[email protected] case HCI_EVENT_USER_PASSKEY_REQUEST: 22566724cd9eS[email protected] hci_add_connection_flags_for_flipped_bd_addr(&packet[2], SSP_PAIRING_ACTIVE); 22573a9fb326S[email protected] if (!hci_stack->ssp_auto_accept) break; 2258dbe1a790S[email protected] hci_add_connection_flags_for_flipped_bd_addr(&packet[2], SEND_USER_PASSKEY_REPLY); 22591d6b20aeS[email protected] break; 22603dce6128SMatthias Ringwald case HCI_EVENT_MODE_CHANGE: 22613dce6128SMatthias Ringwald handle = hci_event_mode_change_get_handle(packet); 22623dce6128SMatthias Ringwald conn = hci_connection_for_handle(handle); 22633dce6128SMatthias Ringwald if (!conn) break; 22643dce6128SMatthias Ringwald conn->connection_mode = hci_event_mode_change_get_mode(packet); 22653dce6128SMatthias Ringwald log_info("HCI_EVENT_MODE_CHANGE, handle 0x%04x, mode %u", handle, conn->connection_mode); 22663dce6128SMatthias Ringwald break; 226735454696SMatthias Ringwald #endif 22681d6b20aeS[email protected] 2269f0944df2S[email protected] case HCI_EVENT_ENCRYPTION_CHANGE: 2270f8fbdce0SMatthias Ringwald handle = little_endian_read_16(packet, 3); 2271f0944df2S[email protected] conn = hci_connection_for_handle(handle); 2272f0944df2S[email protected] if (!conn) break; 2273ad83dc6aS[email protected] if (packet[2] == 0) { 2274f0944df2S[email protected] if (packet[5]){ 2275573897a0SMatthias Ringwald if (hci_is_le_connection(conn)){ 2276573897a0SMatthias Ringwald // For LE, we accept connection as encrypted 2277f0944df2S[email protected] conn->authentication_flags |= CONNECTION_ENCRYPTED; 2278573897a0SMatthias Ringwald } 2279573897a0SMatthias Ringwald #ifdef ENABLE_CLASSIC 2280573897a0SMatthias Ringwald else { 2281573897a0SMatthias Ringwald // For Classic, we need to validate encryption key size first 2282573897a0SMatthias Ringwald conn->bonding_flags |= BONDING_SEND_READ_ENCRYPTION_KEY_SIZE; 2283573897a0SMatthias Ringwald } 2284573897a0SMatthias Ringwald #endif 2285f0944df2S[email protected] } else { 2286536f9994S[email protected] conn->authentication_flags &= ~CONNECTION_ENCRYPTED; 2287f0944df2S[email protected] } 2288ad83dc6aS[email protected] } 2289573897a0SMatthias Ringwald 2290f0944df2S[email protected] break; 2291f0944df2S[email protected] 229235454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 22931eb2563eS[email protected] case HCI_EVENT_AUTHENTICATION_COMPLETE_EVENT: 2294f8fbdce0SMatthias Ringwald handle = little_endian_read_16(packet, 3); 22951eb2563eS[email protected] conn = hci_connection_for_handle(handle); 22961eb2563eS[email protected] if (!conn) break; 2297ad83dc6aS[email protected] 2298ad83dc6aS[email protected] // dedicated bonding: send result and disconnect 2299ad83dc6aS[email protected] if (conn->bonding_flags & BONDING_DEDICATED){ 2300ad83dc6aS[email protected] conn->bonding_flags &= ~BONDING_DEDICATED; 2301ad83dc6aS[email protected] conn->bonding_flags |= BONDING_DISCONNECT_DEDICATED_DONE; 23021bd5283dS[email protected] conn->bonding_status = packet[2]; 2303ad83dc6aS[email protected] break; 2304ad83dc6aS[email protected] } 2305ad83dc6aS[email protected] 2306b5cb6874S[email protected] if (packet[2] == 0 && gap_security_level_for_link_key_type(conn->link_key_type) >= conn->requested_security_level){ 23071eb2563eS[email protected] // link key sufficient for requested security 23081eb2563eS[email protected] conn->bonding_flags |= BONDING_SEND_ENCRYPTION_REQUEST; 2309ad83dc6aS[email protected] break; 2310ad83dc6aS[email protected] } 23111eb2563eS[email protected] // not enough 23121eb2563eS[email protected] hci_emit_security_level(handle, gap_security_level_for_connection(conn)); 23131eb2563eS[email protected] break; 231435454696SMatthias Ringwald #endif 231534d2123cS[email protected] 231686805605S[email protected] // HCI_EVENT_DISCONNECTION_COMPLETE 2317ccda6e14S[email protected] // has been split, to first notify stack before shutting connection down 2318ccda6e14S[email protected] // see end of function, too. 2319a4f30ec0S[email protected] case HCI_EVENT_DISCONNECTION_COMPLETE: 2320a4f30ec0S[email protected] if (packet[2]) break; // status != 0 2321f8fbdce0SMatthias Ringwald handle = little_endian_read_16(packet, 3); 232281d2bdb2SMatthias Ringwald // drop outgoing ACL fragments if it is for closed connection and release buffer if tx not active 2323c6a37cfdSMatthias Ringwald if (hci_stack->acl_fragmentation_total_size > 0) { 2324c6a37cfdSMatthias Ringwald if (handle == READ_ACL_CONNECTION_HANDLE(hci_stack->hci_packet_buffer)){ 232581d2bdb2SMatthias Ringwald int release_buffer = hci_stack->acl_fragmentation_tx_active == 0; 232681d2bdb2SMatthias Ringwald log_info("drop fragmented ACL data for closed connection, release buffer %u", release_buffer); 2327c6a37cfdSMatthias Ringwald hci_stack->acl_fragmentation_total_size = 0; 2328c6a37cfdSMatthias Ringwald hci_stack->acl_fragmentation_pos = 0; 232981d2bdb2SMatthias Ringwald if (release_buffer){ 233081d2bdb2SMatthias Ringwald hci_release_packet_buffer(); 233181d2bdb2SMatthias Ringwald } 2332c6a37cfdSMatthias Ringwald } 2333c6a37cfdSMatthias Ringwald } 233435454696SMatthias Ringwald 23359a2e4658SMatthias Ringwald // re-enable advertisements for le connections if active 2336c6a37cfdSMatthias Ringwald conn = hci_connection_for_handle(handle); 2337c6a37cfdSMatthias Ringwald if (!conn) break; 2338a70e17d4SMatthias Ringwald conn->state = RECEIVED_DISCONNECTION_COMPLETE; 233935454696SMatthias Ringwald #ifdef ENABLE_BLE 2340d70217a2SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 23412b6ab3e6SMatthias Ringwald if (hci_is_le_connection(conn)){ 23422b6ab3e6SMatthias Ringwald hci_reenable_advertisements_if_needed(); 23439a2e4658SMatthias Ringwald } 234435454696SMatthias Ringwald #endif 2345d70217a2SMatthias Ringwald #endif 2346ccda6e14S[email protected] break; 23476772a24cSmatthias.ringwald 2348c68bdf90Smatthias.ringwald case HCI_EVENT_HARDWARE_ERROR: 2349313e5f9cSMatthias Ringwald log_error("Hardware Error: 0x%02x", packet[2]); 2350d23838ecSMatthias Ringwald if (hci_stack->hardware_error_callback){ 2351c2e1fa60SMatthias Ringwald (*hci_stack->hardware_error_callback)(packet[2]); 23527586ee35S[email protected] } else { 23537586ee35S[email protected] // if no special requests, just reboot stack 23547586ee35S[email protected] hci_power_control_off(); 23557586ee35S[email protected] hci_power_control_on(); 2356c68bdf90Smatthias.ringwald } 2357c68bdf90Smatthias.ringwald break; 2358c68bdf90Smatthias.ringwald 23590e6f3837SMatthias Ringwald #ifdef ENABLE_CLASSIC 23605cf766e8SMatthias Ringwald case HCI_EVENT_ROLE_CHANGE: 23615cf766e8SMatthias Ringwald if (packet[2]) break; // status != 0 2362c4c88f1bSJakob Krantz reverse_bd_addr(&packet[3], addr); 2363c4c88f1bSJakob Krantz addr_type = BD_ADDR_TYPE_CLASSIC; 2364c4c88f1bSJakob Krantz conn = hci_connection_for_bd_addr_and_type(addr, addr_type); 2365c4c88f1bSJakob Krantz if (!conn) break; 23665cf766e8SMatthias Ringwald conn->role = packet[9]; 23675cf766e8SMatthias Ringwald break; 23680e6f3837SMatthias Ringwald #endif 23695cf766e8SMatthias Ringwald 237063fa3374SMatthias Ringwald case HCI_EVENT_TRANSPORT_PACKET_SENT: 2371d051460cS[email protected] // release packet buffer only for asynchronous transport and if there are not further fragements 23724fa24b5fS[email protected] if (hci_transport_synchronous()) { 237363fa3374SMatthias Ringwald log_error("Synchronous HCI Transport shouldn't send HCI_EVENT_TRANSPORT_PACKET_SENT"); 23744fa24b5fS[email protected] return; // instead of break: to avoid re-entering hci_run() 23754fa24b5fS[email protected] } 237681d2bdb2SMatthias Ringwald hci_stack->acl_fragmentation_tx_active = 0; 2377d051460cS[email protected] if (hci_stack->acl_fragmentation_total_size) break; 2378d051460cS[email protected] hci_release_packet_buffer(); 2379701e3307SMatthias Ringwald 238063fa3374SMatthias Ringwald // L2CAP receives this event via the hci_emit_event below 238163fa3374SMatthias Ringwald 238235454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 238363fa3374SMatthias Ringwald // For SCO, we do the can_send_now_check here 2384701e3307SMatthias Ringwald hci_notify_if_sco_can_send_now(); 238535454696SMatthias Ringwald #endif 23866b4af23dS[email protected] break; 23876b4af23dS[email protected] 238835454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 238963fa3374SMatthias Ringwald case HCI_EVENT_SCO_CAN_SEND_NOW: 239063fa3374SMatthias Ringwald // For SCO, we do the can_send_now_check here 2391f234b250SMatthias Ringwald hci_stack->sco_can_send_now = 1; 239263fa3374SMatthias Ringwald hci_notify_if_sco_can_send_now(); 239363fa3374SMatthias Ringwald return; 23941cfb383eSMatthias Ringwald 23951cfb383eSMatthias Ringwald // explode inquriy results for easier consumption 23961cfb383eSMatthias Ringwald case HCI_EVENT_INQUIRY_RESULT: 23971cfb383eSMatthias Ringwald case HCI_EVENT_INQUIRY_RESULT_WITH_RSSI: 23981cfb383eSMatthias Ringwald case HCI_EVENT_EXTENDED_INQUIRY_RESPONSE: 23991cfb383eSMatthias Ringwald gap_inquiry_explode(packet); 24001cfb383eSMatthias Ringwald break; 240135454696SMatthias Ringwald #endif 240263fa3374SMatthias Ringwald 2403a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE 24045909f7f2Smatthias.ringwald case HCI_EVENT_LE_META: 24055909f7f2Smatthias.ringwald switch (packet[2]){ 2406d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 240757c9da5bS[email protected] case HCI_SUBEVENT_LE_ADVERTISING_REPORT: 24084f4e0224SMatthias Ringwald // log_info("advertising report received"); 24096fab74dbSMatthias Ringwald if (!hci_stack->le_scanning_enabled) break; 241057c9da5bS[email protected] le_handle_advertisement_report(packet, size); 24117bdc6798S[email protected] break; 2412d70217a2SMatthias Ringwald #endif 24135909f7f2Smatthias.ringwald case HCI_SUBEVENT_LE_CONNECTION_COMPLETE: 24145909f7f2Smatthias.ringwald // Connection management 2415724d70a2SMatthias Ringwald reverse_bd_addr(&packet[8], addr); 24167bdc6798S[email protected] addr_type = (bd_addr_type_t)packet[7]; 24179da54300S[email protected] log_info("LE Connection_complete (status=%u) type %u, %s", packet[3], addr_type, bd_addr_to_str(addr)); 24182e77e513S[email protected] conn = hci_connection_for_bd_addr_and_type(addr, addr_type); 24199c77c9dbSMatthias Ringwald 2420d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 242142ff5ba1SMatthias Ringwald // if auto-connect, remove from whitelist in both roles 242242ff5ba1SMatthias Ringwald if (hci_stack->le_connecting_state == LE_CONNECTING_WHITELIST){ 242342ff5ba1SMatthias Ringwald hci_remove_from_whitelist(addr_type, addr); 242442ff5ba1SMatthias Ringwald } 242542ff5ba1SMatthias Ringwald // handle error: error is reported only to the initiator -> outgoing connection 24265909f7f2Smatthias.ringwald if (packet[3]){ 24279c77c9dbSMatthias Ringwald 24289c77c9dbSMatthias Ringwald // handle cancelled outgoing connection 24299c77c9dbSMatthias Ringwald // "If the cancellation was successful then, after the Command Complete event for the LE_Create_Connection_Cancel command, 24309c77c9dbSMatthias Ringwald // either an LE Connection Complete or an LE Enhanced Connection Complete event shall be generated. 24319c77c9dbSMatthias Ringwald // In either case, the event shall be sent with the error code Unknown Connection Identifier (0x02)." 24329c77c9dbSMatthias Ringwald if (packet[3] == ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER){ 24339c77c9dbSMatthias Ringwald conn = gap_get_outgoing_connection(); 24349c77c9dbSMatthias Ringwald } 24359c77c9dbSMatthias Ringwald 243642ff5ba1SMatthias Ringwald // outgoing connection establishment is done 243742ff5ba1SMatthias Ringwald hci_stack->le_connecting_state = LE_CONNECTING_IDLE; 243842ff5ba1SMatthias Ringwald // remove entry 24395909f7f2Smatthias.ringwald if (conn){ 2440665d90f2SMatthias Ringwald btstack_linked_list_remove(&hci_stack->connections, (btstack_linked_item_t *) conn); 24415909f7f2Smatthias.ringwald btstack_memory_hci_connection_free( conn ); 24425909f7f2Smatthias.ringwald } 24435909f7f2Smatthias.ringwald break; 24445909f7f2Smatthias.ringwald } 2445d70217a2SMatthias Ringwald #endif 244642ff5ba1SMatthias Ringwald // on success, both hosts receive connection complete event 24475cf766e8SMatthias Ringwald if (packet[6] == HCI_ROLE_MASTER){ 2448d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 244942ff5ba1SMatthias Ringwald // if we're master, it was an outgoing connection and we're done with it 245042ff5ba1SMatthias Ringwald hci_stack->le_connecting_state = LE_CONNECTING_IDLE; 2451d70217a2SMatthias Ringwald #endif 245242ff5ba1SMatthias Ringwald } else { 2453d70217a2SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 245442ff5ba1SMatthias Ringwald // if we're slave, it was an incoming connection, advertisements have stopped 2455171293d3SMatthias Ringwald hci_stack->le_advertisements_active = 0; 2456d70217a2SMatthias Ringwald #endif 245742ff5ba1SMatthias Ringwald } 2458171293d3SMatthias Ringwald // LE connections are auto-accepted, so just create a connection if there isn't one already 245942ff5ba1SMatthias Ringwald if (!conn){ 246096a45072S[email protected] conn = create_connection_for_bd_addr_and_type(addr, addr_type); 24615909f7f2Smatthias.ringwald } 246242ff5ba1SMatthias Ringwald // no memory, sorry. 24635909f7f2Smatthias.ringwald if (!conn){ 24645909f7f2Smatthias.ringwald break; 24655909f7f2Smatthias.ringwald } 24665909f7f2Smatthias.ringwald 24675909f7f2Smatthias.ringwald conn->state = OPEN; 24685cf766e8SMatthias Ringwald conn->role = packet[6]; 2469c9db5c21SMilanka Ringwald conn->con_handle = hci_subevent_le_connection_complete_get_connection_handle(packet); 2470c9db5c21SMilanka Ringwald conn->le_connection_interval = hci_subevent_le_connection_complete_get_conn_interval(packet); 24715909f7f2Smatthias.ringwald 24722b6ab3e6SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 24732b6ab3e6SMatthias Ringwald if (packet[6] == HCI_ROLE_SLAVE){ 24742b6ab3e6SMatthias Ringwald hci_reenable_advertisements_if_needed(); 24752b6ab3e6SMatthias Ringwald } 24762b6ab3e6SMatthias Ringwald #endif 24772b6ab3e6SMatthias Ringwald 24785909f7f2Smatthias.ringwald // TODO: store - role, peer address type, conn_interval, conn_latency, supervision timeout, master clock 24795909f7f2Smatthias.ringwald 24805909f7f2Smatthias.ringwald // restart timer 2481528a4a3bSMatthias Ringwald // btstack_run_loop_set_timer(&conn->timeout, HCI_CONNECTION_TIMEOUT_MS); 2482528a4a3bSMatthias Ringwald // btstack_run_loop_add_timer(&conn->timeout); 24835909f7f2Smatthias.ringwald 24849da54300S[email protected] log_info("New connection: handle %u, %s", conn->con_handle, bd_addr_to_str(conn->address)); 24855909f7f2Smatthias.ringwald 24865909f7f2Smatthias.ringwald hci_emit_nr_connections_changed(); 24875909f7f2Smatthias.ringwald break; 24885909f7f2Smatthias.ringwald 2489f8fbdce0SMatthias Ringwald // log_info("LE buffer size: %u, count %u", little_endian_read_16(packet,6), packet[8]); 2490c9db5c21SMilanka Ringwald case HCI_SUBEVENT_LE_CONNECTION_UPDATE_COMPLETE: 2491c9db5c21SMilanka Ringwald handle = hci_subevent_le_connection_update_complete_get_connection_handle(packet); 2492c9db5c21SMilanka Ringwald conn = hci_connection_for_handle(handle); 2493c9db5c21SMilanka Ringwald if (!conn) break; 2494c9db5c21SMilanka Ringwald conn->le_connection_interval = hci_subevent_le_connection_update_complete_get_conn_interval(packet); 2495c9db5c21SMilanka Ringwald break; 249665a46ef3S[email protected] 249773cd8a2aSMatthias Ringwald case HCI_SUBEVENT_LE_REMOTE_CONNECTION_PARAMETER_REQUEST: 249873cd8a2aSMatthias Ringwald // connection 249973cd8a2aSMatthias Ringwald handle = hci_subevent_le_remote_connection_parameter_request_get_connection_handle(packet); 250073cd8a2aSMatthias Ringwald conn = hci_connection_for_handle(handle); 250173cd8a2aSMatthias Ringwald if (conn) { 250273cd8a2aSMatthias Ringwald // read arguments 250373cd8a2aSMatthias Ringwald uint16_t le_conn_interval_min = hci_subevent_le_remote_connection_parameter_request_get_interval_min(packet); 250473cd8a2aSMatthias Ringwald uint16_t le_conn_interval_max = hci_subevent_le_remote_connection_parameter_request_get_interval_max(packet); 250573cd8a2aSMatthias Ringwald uint16_t le_conn_latency = hci_subevent_le_remote_connection_parameter_request_get_latency(packet); 250673cd8a2aSMatthias Ringwald uint16_t le_supervision_timeout = hci_subevent_le_remote_connection_parameter_request_get_timeout(packet); 250773cd8a2aSMatthias Ringwald 250873cd8a2aSMatthias Ringwald // validate against current connection parameter range 250973cd8a2aSMatthias Ringwald le_connection_parameter_range_t existing_range; 251073cd8a2aSMatthias Ringwald gap_get_connection_parameter_range(&existing_range); 251173cd8a2aSMatthias 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); 251273cd8a2aSMatthias Ringwald if (update_parameter){ 251373cd8a2aSMatthias Ringwald conn->le_con_parameter_update_state = CON_PARAMETER_UPDATE_REPLY; 251473cd8a2aSMatthias Ringwald conn->le_conn_interval_min = le_conn_interval_min; 251573cd8a2aSMatthias Ringwald conn->le_conn_interval_max = le_conn_interval_max; 251673cd8a2aSMatthias Ringwald conn->le_conn_latency = le_conn_latency; 251773cd8a2aSMatthias Ringwald conn->le_supervision_timeout = le_supervision_timeout; 251873cd8a2aSMatthias Ringwald } else { 251973cd8a2aSMatthias Ringwald conn->le_con_parameter_update_state = CON_PARAMETER_UPDATE_DENY; 252073cd8a2aSMatthias Ringwald } 252173cd8a2aSMatthias Ringwald } 252273cd8a2aSMatthias Ringwald break; 25235909f7f2Smatthias.ringwald default: 25245909f7f2Smatthias.ringwald break; 25255909f7f2Smatthias.ringwald } 25265909f7f2Smatthias.ringwald break; 25275909f7f2Smatthias.ringwald #endif 25280b36101dSMatthias Ringwald case HCI_EVENT_VENDOR_SPECIFIC: 25290b36101dSMatthias Ringwald // Vendor specific commands often create vendor specific event instead of num completed packets 25300b36101dSMatthias Ringwald // To avoid getting stuck as num_cmds_packets is zero, reset it to 1 for controllers with this behaviour 25310b36101dSMatthias Ringwald switch (hci_stack->manufacturer){ 25320b36101dSMatthias Ringwald case BLUETOOTH_COMPANY_ID_CAMBRIDGE_SILICON_RADIO: 25330b36101dSMatthias Ringwald hci_stack->num_cmd_packets = 1; 25340b36101dSMatthias Ringwald break; 25350b36101dSMatthias Ringwald default: 25360b36101dSMatthias Ringwald break; 25370b36101dSMatthias Ringwald } 25380b36101dSMatthias Ringwald break; 25396772a24cSmatthias.ringwald default: 25406772a24cSmatthias.ringwald break; 2541fe1ed1b8Smatthias.ringwald } 2542fe1ed1b8Smatthias.ringwald 25433429f56bSmatthias.ringwald // handle BT initialization 25443a9fb326S[email protected] if (hci_stack->state == HCI_STATE_INITIALIZING){ 25456155b3d3S[email protected] hci_initializing_event_handler(packet, size); 2546c9af4d3fS[email protected] } 254722909952Smatthias.ringwald 254889db417bSmatthias.ringwald // help with BT sleep 25493a9fb326S[email protected] if (hci_stack->state == HCI_STATE_FALLING_ASLEEP 255074b323a9SMatthias Ringwald && hci_stack->substate == HCI_FALLING_ASLEEP_W4_WRITE_SCAN_ENABLE 2551073bd0faSMatthias Ringwald && HCI_EVENT_IS_COMMAND_COMPLETE(packet, hci_write_scan_enable)){ 255255975f88SMatthias Ringwald hci_initializing_next_state(); 255389db417bSmatthias.ringwald } 255489db417bSmatthias.ringwald 255586805605S[email protected] // notify upper stack 2556d6b06661SMatthias Ringwald hci_emit_event(packet, size, 0); // don't dump, already happened in packet handler 255794ab26f8Smatthias.ringwald 255886805605S[email protected] // moved here to give upper stack a chance to close down everything with hci_connection_t intact 25590e2df43fSMatthias Ringwald if (hci_event_packet_get_type(packet) == HCI_EVENT_DISCONNECTION_COMPLETE){ 256086805605S[email protected] if (!packet[2]){ 2561f8fbdce0SMatthias Ringwald handle = little_endian_read_16(packet, 3); 256205ae8de3SMatthias Ringwald hci_connection_t * aConn = hci_connection_for_handle(handle); 256305ae8de3SMatthias Ringwald if (aConn) { 256405ae8de3SMatthias Ringwald uint8_t status = aConn->bonding_status; 256505ae8de3SMatthias Ringwald uint16_t flags = aConn->bonding_flags; 256686805605S[email protected] bd_addr_t bd_address; 256705ae8de3SMatthias Ringwald memcpy(&bd_address, aConn->address, 6); 256805ae8de3SMatthias Ringwald hci_shutdown_connection(aConn); 2569bb820044S[email protected] // connection struct is gone, don't access anymore 2570bb820044S[email protected] if (flags & BONDING_EMIT_COMPLETE_ON_DISCONNECT){ 257186805605S[email protected] hci_emit_dedicated_bonding_result(bd_address, status); 257286805605S[email protected] } 257386805605S[email protected] } 257486805605S[email protected] } 257586805605S[email protected] } 257686805605S[email protected] 257794ab26f8Smatthias.ringwald // execute main loop 257894ab26f8Smatthias.ringwald hci_run(); 257916833f0aSmatthias.ringwald } 258016833f0aSmatthias.ringwald 258135454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 25826f28d2eeSMatthias Ringwald 25836f28d2eeSMatthias Ringwald static void sco_tx_timeout_handler(btstack_timer_source_t * ts); 25846f28d2eeSMatthias Ringwald static void sco_schedule_tx(hci_connection_t * conn); 25856f28d2eeSMatthias Ringwald 25866f28d2eeSMatthias Ringwald static void sco_tx_timeout_handler(btstack_timer_source_t * ts){ 258759c33575SMatthias Ringwald log_debug("SCO TX Timeout"); 25885a6b2dbdSMatthias Ringwald hci_con_handle_t con_handle = (hci_con_handle_t) (uintptr_t) btstack_run_loop_get_timer_context(ts); 25896f28d2eeSMatthias Ringwald hci_connection_t * conn = hci_connection_for_handle(con_handle); 25906f28d2eeSMatthias Ringwald if (!conn) return; 25916f28d2eeSMatthias Ringwald 2592afaddd67SMatthias Ringwald // trigger send 2593afaddd67SMatthias Ringwald conn->sco_tx_ready = 1; 2594e4157653SMatthias Ringwald // extra packet if CVSD but SCO buffer is too short 2595e4157653SMatthias Ringwald if (((hci_stack->sco_voice_setting_active & 0x03) != 0x03) && hci_stack->sco_data_packet_length < 123){ 2596e4157653SMatthias Ringwald conn->sco_tx_ready++; 2597e4157653SMatthias Ringwald } 2598afaddd67SMatthias Ringwald hci_notify_if_sco_can_send_now(); 25996f28d2eeSMatthias Ringwald } 26006f28d2eeSMatthias Ringwald 260159c33575SMatthias Ringwald 260259c33575SMatthias Ringwald #define SCO_TX_AFTER_RX_MS (6) 260359c33575SMatthias Ringwald 26046f28d2eeSMatthias Ringwald static void sco_schedule_tx(hci_connection_t * conn){ 260559c33575SMatthias Ringwald 26066f28d2eeSMatthias Ringwald uint32_t now = btstack_run_loop_get_time_ms(); 260759c33575SMatthias Ringwald uint32_t sco_tx_ms = conn->sco_rx_ms + SCO_TX_AFTER_RX_MS; 260859c33575SMatthias Ringwald int time_delta_ms = sco_tx_ms - now; 260959c33575SMatthias Ringwald 261059c33575SMatthias Ringwald btstack_timer_source_t * timer = (conn->sco_rx_count & 1) ? &conn->timeout : &conn->timeout_sco; 261159c33575SMatthias Ringwald 261259c33575SMatthias Ringwald // log_error("SCO TX at %u in %u", (int) sco_tx_ms, time_delta_ms); 261359c33575SMatthias Ringwald btstack_run_loop_set_timer(timer, time_delta_ms); 261459c33575SMatthias Ringwald btstack_run_loop_set_timer_context(timer, (void *) (uintptr_t) conn->con_handle); 261559c33575SMatthias Ringwald btstack_run_loop_set_timer_handler(timer, &sco_tx_timeout_handler); 261659c33575SMatthias Ringwald btstack_run_loop_add_timer(timer); 26176f28d2eeSMatthias Ringwald } 26186f28d2eeSMatthias Ringwald 2619c91d150bS[email protected] static void sco_handler(uint8_t * packet, uint16_t size){ 26200b3f95dfSMatthias Ringwald // lookup connection struct 26212b838201SMatthias Ringwald hci_con_handle_t con_handle = READ_SCO_CONNECTION_HANDLE(packet); 26222b838201SMatthias Ringwald hci_connection_t * conn = hci_connection_for_handle(con_handle); 26230b3f95dfSMatthias Ringwald if (!conn) return; 26240b3f95dfSMatthias Ringwald 2625760b20efSMatthias Ringwald // CSR 8811 prefixes 60 byte SCO packet in transparent mode with 20 zero bytes -> skip first 20 payload bytes 2626760b20efSMatthias Ringwald if (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_CAMBRIDGE_SILICON_RADIO){ 262750299413SMatthias Ringwald if (size == 83 && ((hci_stack->sco_voice_setting_active & 0x03) == 0x03)){ 2628760b20efSMatthias Ringwald packet[2] = 0x3c; 2629760b20efSMatthias Ringwald memmove(&packet[3], &packet[23], 63); 2630760b20efSMatthias Ringwald size = 63; 26310b3f95dfSMatthias Ringwald } 26320b3f95dfSMatthias Ringwald } 2633760b20efSMatthias Ringwald 2634f234b250SMatthias Ringwald if (hci_have_usb_transport()){ 2635f234b250SMatthias Ringwald // Nothing to do 2636f234b250SMatthias Ringwald } else { 263749205f5dSMatthias 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); 2638760b20efSMatthias Ringwald if (hci_stack->synchronous_flow_control_enabled == 0){ 26396f28d2eeSMatthias Ringwald uint32_t now = btstack_run_loop_get_time_ms(); 264059c33575SMatthias Ringwald 264159c33575SMatthias Ringwald if (!conn->sco_rx_valid){ 264259c33575SMatthias Ringwald // ignore first 10 packets 26436f28d2eeSMatthias Ringwald conn->sco_rx_count++; 264459c33575SMatthias Ringwald // log_debug("sco rx count %u", conn->sco_rx_count); 264559c33575SMatthias Ringwald if (conn->sco_rx_count == 10) { 264659c33575SMatthias Ringwald // use first timestamp as is and pretent it just started 26476f28d2eeSMatthias Ringwald conn->sco_rx_ms = now; 26486f28d2eeSMatthias Ringwald conn->sco_rx_valid = 1; 264959c33575SMatthias Ringwald conn->sco_rx_count = 0; 265059c33575SMatthias Ringwald sco_schedule_tx(conn); 265159c33575SMatthias Ringwald } 265259c33575SMatthias Ringwald } else { 265359c33575SMatthias Ringwald // track expected arrival timme 265459c33575SMatthias Ringwald conn->sco_rx_count++; 265559c33575SMatthias Ringwald conn->sco_rx_ms += 7; 265659c33575SMatthias Ringwald int delta = (int32_t) (now - conn->sco_rx_ms); 265759c33575SMatthias Ringwald if (delta > 0){ 265859c33575SMatthias Ringwald conn->sco_rx_ms++; 265959c33575SMatthias Ringwald } 266059c33575SMatthias Ringwald // log_debug("sco rx %u", conn->sco_rx_ms); 26616f28d2eeSMatthias Ringwald sco_schedule_tx(conn); 26626f28d2eeSMatthias Ringwald } 2663760b20efSMatthias Ringwald } 2664f234b250SMatthias Ringwald } 26650b3f95dfSMatthias Ringwald // deliver to app 26660b3f95dfSMatthias Ringwald if (hci_stack->sco_packet_handler) { 26670b3f95dfSMatthias Ringwald hci_stack->sco_packet_handler(HCI_SCO_DATA_PACKET, 0, packet, size); 26680b3f95dfSMatthias Ringwald } 26690b3f95dfSMatthias Ringwald 26700b3f95dfSMatthias Ringwald #ifdef ENABLE_HCI_CONTROLLER_TO_HOST_FLOW_CONTROL 26712b838201SMatthias Ringwald conn->num_packets_completed++; 26722b838201SMatthias Ringwald hci_stack->host_completed_packets = 1; 26732b838201SMatthias Ringwald hci_run(); 26742b838201SMatthias Ringwald #endif 2675c91d150bS[email protected] } 267635454696SMatthias Ringwald #endif 2677c91d150bS[email protected] 26780a57e69fSmatthias.ringwald static void packet_handler(uint8_t packet_type, uint8_t *packet, uint16_t size){ 26795bb5bc3eS[email protected] hci_dump_packet(packet_type, 1, packet, size); 268010e830c9Smatthias.ringwald switch (packet_type) { 268110e830c9Smatthias.ringwald case HCI_EVENT_PACKET: 268210e830c9Smatthias.ringwald event_handler(packet, size); 268310e830c9Smatthias.ringwald break; 268410e830c9Smatthias.ringwald case HCI_ACL_DATA_PACKET: 268510e830c9Smatthias.ringwald acl_handler(packet, size); 268610e830c9Smatthias.ringwald break; 268735454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 2688c91d150bS[email protected] case HCI_SCO_DATA_PACKET: 2689c91d150bS[email protected] sco_handler(packet, size); 2690202c8a4cSMatthias Ringwald break; 269135454696SMatthias Ringwald #endif 269210e830c9Smatthias.ringwald default: 269310e830c9Smatthias.ringwald break; 269410e830c9Smatthias.ringwald } 269510e830c9Smatthias.ringwald } 269610e830c9Smatthias.ringwald 2697d6b06661SMatthias Ringwald /** 2698d6b06661SMatthias Ringwald * @brief Add event packet handler. 2699d6b06661SMatthias Ringwald */ 2700d6b06661SMatthias Ringwald void hci_add_event_handler(btstack_packet_callback_registration_t * callback_handler){ 2701d6b06661SMatthias Ringwald btstack_linked_list_add_tail(&hci_stack->event_handlers, (btstack_linked_item_t*) callback_handler); 2702d6b06661SMatthias Ringwald } 2703d6b06661SMatthias Ringwald 2704d6b06661SMatthias Ringwald 2705fcadd0caSmatthias.ringwald /** Register HCI packet handlers */ 27063d50b4baSMatthias Ringwald void hci_register_acl_packet_handler(btstack_packet_handler_t handler){ 2707fb37a842SMatthias Ringwald hci_stack->acl_packet_handler = handler; 270816833f0aSmatthias.ringwald } 270916833f0aSmatthias.ringwald 271035454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 27118abbe8b5SMatthias Ringwald /** 27128abbe8b5SMatthias Ringwald * @brief Registers a packet handler for SCO data. Used for HSP and HFP profiles. 27138abbe8b5SMatthias Ringwald */ 27143d50b4baSMatthias Ringwald void hci_register_sco_packet_handler(btstack_packet_handler_t handler){ 27158abbe8b5SMatthias Ringwald hci_stack->sco_packet_handler = handler; 27168abbe8b5SMatthias Ringwald } 271735454696SMatthias Ringwald #endif 27188abbe8b5SMatthias Ringwald 271971de195eSMatthias Ringwald static void hci_state_reset(void){ 2720595bdbfbS[email protected] // no connections yet 2721595bdbfbS[email protected] hci_stack->connections = NULL; 272274308b23Smatthias.ringwald 272374308b23Smatthias.ringwald // keep discoverable/connectable as this has been requested by the client(s) 272474308b23Smatthias.ringwald // hci_stack->discoverable = 0; 272574308b23Smatthias.ringwald // hci_stack->connectable = 0; 272674308b23Smatthias.ringwald // hci_stack->bondable = 1; 2727b95a5a35SMatthias Ringwald // hci_stack->own_addr_type = 0; 2728595bdbfbS[email protected] 272944935e40S[email protected] // buffer is free 273044935e40S[email protected] hci_stack->hci_packet_buffer_reserved = 0; 273144935e40S[email protected] 2732595bdbfbS[email protected] // no pending cmds 2733595bdbfbS[email protected] hci_stack->decline_reason = 0; 2734595bdbfbS[email protected] hci_stack->new_scan_enable_value = 0xff; 2735595bdbfbS[email protected] 2736595bdbfbS[email protected] // LE 2737b95a5a35SMatthias Ringwald #ifdef ENABLE_BLE 2738b95a5a35SMatthias Ringwald memset(hci_stack->le_random_address, 0, 6); 2739b95a5a35SMatthias Ringwald hci_stack->le_random_address_set = 0; 2740d70217a2SMatthias Ringwald #endif 2741d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 27426fab74dbSMatthias Ringwald hci_stack->le_scanning_active = 0; 2743e2602ea2Smatthias.ringwald hci_stack->le_scan_type = 0xff; 2744b04dfa37SMatthias Ringwald hci_stack->le_connecting_state = LE_CONNECTING_IDLE; 2745e83201bcSMatthias Ringwald hci_stack->le_whitelist = 0; 2746e83201bcSMatthias Ringwald hci_stack->le_whitelist_capacity = 0; 2747d70217a2SMatthias Ringwald #endif 2748595bdbfbS[email protected] } 2749595bdbfbS[email protected] 275035454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 27512d5e09d6SMatthias Ringwald /** 27522d5e09d6SMatthias Ringwald * @brief Configure Bluetooth hardware control. Has to be called before power on. 27532d5e09d6SMatthias Ringwald */ 27542d5e09d6SMatthias Ringwald void hci_set_link_key_db(btstack_link_key_db_t const * link_key_db){ 27552d5e09d6SMatthias Ringwald // store and open remote device db 27562d5e09d6SMatthias Ringwald hci_stack->link_key_db = link_key_db; 27572d5e09d6SMatthias Ringwald if (hci_stack->link_key_db) { 27582d5e09d6SMatthias Ringwald hci_stack->link_key_db->open(); 27592d5e09d6SMatthias Ringwald } 27602d5e09d6SMatthias Ringwald } 276135454696SMatthias Ringwald #endif 27622d5e09d6SMatthias Ringwald 27632d5e09d6SMatthias Ringwald void hci_init(const hci_transport_t *transport, const void *config){ 2764475c8125Smatthias.ringwald 27653a9fb326S[email protected] #ifdef HAVE_MALLOC 27663a9fb326S[email protected] if (!hci_stack) { 27673a9fb326S[email protected] hci_stack = (hci_stack_t*) malloc(sizeof(hci_stack_t)); 27683a9fb326S[email protected] } 27693a9fb326S[email protected] #else 27703a9fb326S[email protected] hci_stack = &hci_stack_static; 27713a9fb326S[email protected] #endif 277266fb9560S[email protected] memset(hci_stack, 0, sizeof(hci_stack_t)); 27733a9fb326S[email protected] 2774475c8125Smatthias.ringwald // reference to use transport layer implementation 27753a9fb326S[email protected] hci_stack->hci_transport = transport; 2776475c8125Smatthias.ringwald 277711e23e5fSmatthias.ringwald // reference to used config 27783a9fb326S[email protected] hci_stack->config = config; 277911e23e5fSmatthias.ringwald 278026a9b6daSMatthias Ringwald // setup pointer for outgoing packet buffer 278126a9b6daSMatthias Ringwald hci_stack->hci_packet_buffer = &hci_stack->hci_packet_buffer_data[HCI_OUTGOING_PRE_BUFFER_SIZE]; 278226a9b6daSMatthias Ringwald 27838fcba05dSmatthias.ringwald // max acl payload size defined in config.h 27843a9fb326S[email protected] hci_stack->acl_data_packet_length = HCI_ACL_PAYLOAD_SIZE; 27858fcba05dSmatthias.ringwald 278616833f0aSmatthias.ringwald // register packet handlers with transport 278710e830c9Smatthias.ringwald transport->register_packet_handler(&packet_handler); 2788f5454fc6Smatthias.ringwald 27893a9fb326S[email protected] hci_stack->state = HCI_STATE_OFF; 2790e2386ba1S[email protected] 2791e2386ba1S[email protected] // class of device 27923a9fb326S[email protected] hci_stack->class_of_device = 0x007a020c; // Smartphone 2793a45d6b9fS[email protected] 2794f20168b8Smatthias.ringwald // bondable by default 2795f20168b8Smatthias.ringwald hci_stack->bondable = 1; 2796f20168b8Smatthias.ringwald 2797e9f343c8SMatthias Ringwald #ifdef ENABLE_CLASSIC 279863168530SMatthias Ringwald // classic name 279963168530SMatthias Ringwald hci_stack->local_name = default_classic_name; 2800c4c88f1bSJakob Krantz 2801c4c88f1bSJakob Krantz // Master slave policy 2802c4c88f1bSJakob Krantz hci_stack->master_slave_policy = 1; 2803170fafaeSMatthias Ringwald 2804170fafaeSMatthias Ringwald // Errata-11838 mandates 7 bytes for GAP Security Level 1-3, we use 16 as default 2805170fafaeSMatthias Ringwald hci_stack->gap_required_encyrption_key_size = 16; 2806e9f343c8SMatthias Ringwald #endif 280763168530SMatthias Ringwald 280863048403S[email protected] // Secure Simple Pairing default: enable, no I/O capabilities, general bonding, mitm not required, auto accept 28093a9fb326S[email protected] hci_stack->ssp_enable = 1; 28103a9fb326S[email protected] hci_stack->ssp_io_capability = SSP_IO_CAPABILITY_NO_INPUT_NO_OUTPUT; 28113a9fb326S[email protected] hci_stack->ssp_authentication_requirement = SSP_IO_AUTHREQ_MITM_PROTECTION_NOT_REQUIRED_GENERAL_BONDING; 28123a9fb326S[email protected] hci_stack->ssp_auto_accept = 1; 281369a97523S[email protected] 2814fac2e2feSMatthias Ringwald // voice setting - signed 16 bit pcm data with CVSD over the air 2815fac2e2feSMatthias Ringwald hci_stack->sco_voice_setting = 0x60; 2816d950d659SMatthias Ringwald 2817831711daSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 2818831711daSMatthias Ringwald // connection parameter to use for outgoing connections 2819cbe54ab2SJakob Krantz hci_stack->le_connection_scan_interval = 0x0060; // 60ms 2820cbe54ab2SJakob Krantz hci_stack->le_connection_scan_window = 0x0030; // 30ms 2821831711daSMatthias Ringwald hci_stack->le_connection_interval_min = 0x0008; // 10 ms 2822831711daSMatthias Ringwald hci_stack->le_connection_interval_max = 0x0018; // 30 ms 2823831711daSMatthias Ringwald hci_stack->le_connection_latency = 4; // 4 2824831711daSMatthias Ringwald hci_stack->le_supervision_timeout = 0x0048; // 720 ms 2825831711daSMatthias Ringwald hci_stack->le_minimum_ce_length = 2; // 1.25 ms 2826831711daSMatthias Ringwald hci_stack->le_maximum_ce_length = 0x0030; // 30 ms 28277261e5d8SMatthias Ringwald 28287261e5d8SMatthias Ringwald // default LE Scanning 28297261e5d8SMatthias Ringwald hci_stack->le_scan_interval = 0x1e0; 28307261e5d8SMatthias Ringwald hci_stack->le_scan_window = 0x30; 2831831711daSMatthias Ringwald #endif 2832831711daSMatthias Ringwald 28332b6ab3e6SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 28342b6ab3e6SMatthias Ringwald hci_stack->le_max_number_peripheral_connections = 1; // only single connection as peripheral 28352b6ab3e6SMatthias Ringwald #endif 28362b6ab3e6SMatthias Ringwald 2837831711daSMatthias Ringwald // connection parameter range used to answer connection parameter update requests in l2cap 2838831711daSMatthias Ringwald hci_stack->le_connection_parameter_range.le_conn_interval_min = 6; 2839831711daSMatthias Ringwald hci_stack->le_connection_parameter_range.le_conn_interval_max = 3200; 2840831711daSMatthias Ringwald hci_stack->le_connection_parameter_range.le_conn_latency_min = 0; 2841831711daSMatthias Ringwald hci_stack->le_connection_parameter_range.le_conn_latency_max = 500; 2842831711daSMatthias Ringwald hci_stack->le_connection_parameter_range.le_supervision_timeout_min = 10; 2843831711daSMatthias Ringwald hci_stack->le_connection_parameter_range.le_supervision_timeout_max = 3200; 2844831711daSMatthias Ringwald 2845595bdbfbS[email protected] hci_state_reset(); 2846475c8125Smatthias.ringwald } 2847475c8125Smatthias.ringwald 28483fb36a29SMatthias Ringwald /** 28493fb36a29SMatthias Ringwald * @brief Configure Bluetooth chipset driver. Has to be called before power on, or right after receiving the local version information 28503fb36a29SMatthias Ringwald */ 28513fb36a29SMatthias Ringwald void hci_set_chipset(const btstack_chipset_t *chipset_driver){ 28523fb36a29SMatthias Ringwald hci_stack->chipset = chipset_driver; 28533fb36a29SMatthias Ringwald 28543fb36a29SMatthias Ringwald // reset chipset driver - init is also called on power_up 28553fb36a29SMatthias Ringwald if (hci_stack->chipset && hci_stack->chipset->init){ 28563fb36a29SMatthias Ringwald hci_stack->chipset->init(hci_stack->config); 28573fb36a29SMatthias Ringwald } 28583fb36a29SMatthias Ringwald } 28593fb36a29SMatthias Ringwald 2860fb55bd0aSMatthias Ringwald /** 2861d0b87befSMatthias Ringwald * @brief Configure Bluetooth hardware control. Has to be called after hci_init() but before power on. 2862fb55bd0aSMatthias Ringwald */ 2863fb55bd0aSMatthias Ringwald void hci_set_control(const btstack_control_t *hardware_control){ 2864fb55bd0aSMatthias Ringwald // references to used control implementation 2865fb55bd0aSMatthias Ringwald hci_stack->control = hardware_control; 2866d0b87befSMatthias Ringwald // init with transport config 2867d0b87befSMatthias Ringwald hardware_control->init(hci_stack->config); 2868fb55bd0aSMatthias Ringwald } 2869fb55bd0aSMatthias Ringwald 287071de195eSMatthias Ringwald void hci_close(void){ 2871404843c1Smatthias.ringwald // close remote device db 2872a98592bcSMatthias Ringwald if (hci_stack->link_key_db) { 2873a98592bcSMatthias Ringwald hci_stack->link_key_db->close(); 2874404843c1Smatthias.ringwald } 28757224be7eSMatthias Ringwald 28767224be7eSMatthias Ringwald btstack_linked_list_iterator_t lit; 28777224be7eSMatthias Ringwald btstack_linked_list_iterator_init(&lit, &hci_stack->connections); 28787224be7eSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&lit)){ 28797224be7eSMatthias Ringwald // cancel all l2cap connections by emitting dicsconnection complete before shutdown (free) connection 28807224be7eSMatthias Ringwald hci_connection_t * connection = (hci_connection_t*) btstack_linked_list_iterator_next(&lit); 28817224be7eSMatthias Ringwald hci_emit_disconnection_complete(connection->con_handle, 0x16); // terminated by local host 28827224be7eSMatthias Ringwald hci_shutdown_connection(connection); 2883f5454fc6Smatthias.ringwald } 28847224be7eSMatthias Ringwald 2885f5454fc6Smatthias.ringwald hci_power_control(HCI_POWER_OFF); 28863a9fb326S[email protected] 28873a9fb326S[email protected] #ifdef HAVE_MALLOC 28883a9fb326S[email protected] free(hci_stack); 28893a9fb326S[email protected] #endif 28903a9fb326S[email protected] hci_stack = NULL; 2891404843c1Smatthias.ringwald } 2892404843c1Smatthias.ringwald 289335454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 2894170fafaeSMatthias Ringwald void gap_set_required_encryption_key_size(uint8_t encryption_key_size){ 2895170fafaeSMatthias Ringwald // validate ranage and set 2896170fafaeSMatthias Ringwald if (encryption_key_size < 7) return; 2897170fafaeSMatthias Ringwald if (encryption_key_size > 16) return; 2898170fafaeSMatthias Ringwald hci_stack->gap_required_encyrption_key_size = encryption_key_size; 2899170fafaeSMatthias Ringwald } 2900170fafaeSMatthias Ringwald #endif 2901170fafaeSMatthias Ringwald 2902170fafaeSMatthias Ringwald #ifdef ENABLE_CLASSIC 290360b9e82fSMatthias Ringwald void gap_set_class_of_device(uint32_t class_of_device){ 29049e61646fS[email protected] hci_stack->class_of_device = class_of_device; 29059e61646fS[email protected] } 290676f27cffSMatthias Ringwald 2907c33e56d3SMatthias Ringwald void gap_set_default_link_policy_settings(uint16_t default_link_policy_settings){ 2908c33e56d3SMatthias Ringwald hci_stack->default_link_policy_settings = default_link_policy_settings; 2909c33e56d3SMatthias Ringwald } 2910c33e56d3SMatthias Ringwald 291176f27cffSMatthias Ringwald void hci_disable_l2cap_timeout_check(void){ 291276f27cffSMatthias Ringwald disable_l2cap_timeouts = 1; 291376f27cffSMatthias Ringwald } 291435454696SMatthias Ringwald #endif 29159e61646fS[email protected] 291676f27cffSMatthias Ringwald #if !defined(HAVE_PLATFORM_IPHONE_OS) && !defined (HAVE_HOST_CONTROLLER_API) 2917f456b2d0S[email protected] // Set Public BD ADDR - passed on to Bluetooth chipset if supported in bt_control_h 2918f456b2d0S[email protected] void hci_set_bd_addr(bd_addr_t addr){ 2919f456b2d0S[email protected] memcpy(hci_stack->custom_bd_addr, addr, 6); 2920f456b2d0S[email protected] hci_stack->custom_bd_addr_set = 1; 2921f456b2d0S[email protected] } 292276f27cffSMatthias Ringwald #endif 2923f456b2d0S[email protected] 29248d213e1aSmatthias.ringwald // State-Module-Driver overview 29258d213e1aSmatthias.ringwald // state module low-level 29268d213e1aSmatthias.ringwald // HCI_STATE_OFF off close 29278d213e1aSmatthias.ringwald // HCI_STATE_INITIALIZING, on open 29288d213e1aSmatthias.ringwald // HCI_STATE_WORKING, on open 29298d213e1aSmatthias.ringwald // HCI_STATE_HALTING, on open 2930d661ed19Smatthias.ringwald // HCI_STATE_SLEEPING, off/sleep close 2931d661ed19Smatthias.ringwald // HCI_STATE_FALLING_ASLEEP on open 2932c7e0c5f6Smatthias.ringwald 293340d1c7a4Smatthias.ringwald static int hci_power_control_on(void){ 29347301ad89Smatthias.ringwald 2935038bc64cSmatthias.ringwald // power on 2936f9a30166Smatthias.ringwald int err = 0; 29373a9fb326S[email protected] if (hci_stack->control && hci_stack->control->on){ 2938d0b87befSMatthias Ringwald err = (*hci_stack->control->on)(); 2939f9a30166Smatthias.ringwald } 2940038bc64cSmatthias.ringwald if (err){ 29419da54300S[email protected] log_error( "POWER_ON failed"); 2942038bc64cSmatthias.ringwald hci_emit_hci_open_failed(); 2943038bc64cSmatthias.ringwald return err; 2944038bc64cSmatthias.ringwald } 2945038bc64cSmatthias.ringwald 294624b3c629SMatthias Ringwald // int chipset driver 29473fb36a29SMatthias Ringwald if (hci_stack->chipset && hci_stack->chipset->init){ 29483fb36a29SMatthias Ringwald hci_stack->chipset->init(hci_stack->config); 29493fb36a29SMatthias Ringwald } 29503fb36a29SMatthias Ringwald 295124b3c629SMatthias Ringwald // init transport 295224b3c629SMatthias Ringwald if (hci_stack->hci_transport->init){ 295324b3c629SMatthias Ringwald hci_stack->hci_transport->init(hci_stack->config); 295424b3c629SMatthias Ringwald } 295524b3c629SMatthias Ringwald 295624b3c629SMatthias Ringwald // open transport 295724b3c629SMatthias Ringwald err = hci_stack->hci_transport->open(); 2958038bc64cSmatthias.ringwald if (err){ 29599da54300S[email protected] log_error( "HCI_INIT failed, turning Bluetooth off again"); 29603a9fb326S[email protected] if (hci_stack->control && hci_stack->control->off){ 2961d0b87befSMatthias Ringwald (*hci_stack->control->off)(); 2962f9a30166Smatthias.ringwald } 2963038bc64cSmatthias.ringwald hci_emit_hci_open_failed(); 2964038bc64cSmatthias.ringwald return err; 2965038bc64cSmatthias.ringwald } 29668d213e1aSmatthias.ringwald return 0; 29678d213e1aSmatthias.ringwald } 2968038bc64cSmatthias.ringwald 296940d1c7a4Smatthias.ringwald static void hci_power_control_off(void){ 29708d213e1aSmatthias.ringwald 29719da54300S[email protected] log_info("hci_power_control_off"); 29729418f9c9Smatthias.ringwald 29738d213e1aSmatthias.ringwald // close low-level device 297424b3c629SMatthias Ringwald hci_stack->hci_transport->close(); 29758d213e1aSmatthias.ringwald 29769da54300S[email protected] log_info("hci_power_control_off - hci_transport closed"); 29779418f9c9Smatthias.ringwald 29788d213e1aSmatthias.ringwald // power off 29793a9fb326S[email protected] if (hci_stack->control && hci_stack->control->off){ 2980d0b87befSMatthias Ringwald (*hci_stack->control->off)(); 29818d213e1aSmatthias.ringwald } 29829418f9c9Smatthias.ringwald 29839da54300S[email protected] log_info("hci_power_control_off - control closed"); 29849418f9c9Smatthias.ringwald 29853a9fb326S[email protected] hci_stack->state = HCI_STATE_OFF; 298672ea5239Smatthias.ringwald } 298772ea5239Smatthias.ringwald 298840d1c7a4Smatthias.ringwald static void hci_power_control_sleep(void){ 298972ea5239Smatthias.ringwald 29909da54300S[email protected] log_info("hci_power_control_sleep"); 29913144bce4Smatthias.ringwald 2992b429b9b7Smatthias.ringwald #if 0 2993b429b9b7Smatthias.ringwald // don't close serial port during sleep 2994b429b9b7Smatthias.ringwald 299572ea5239Smatthias.ringwald // close low-level device 29963a9fb326S[email protected] hci_stack->hci_transport->close(hci_stack->config); 2997b429b9b7Smatthias.ringwald #endif 299872ea5239Smatthias.ringwald 299972ea5239Smatthias.ringwald // sleep mode 30003a9fb326S[email protected] if (hci_stack->control && hci_stack->control->sleep){ 3001d0b87befSMatthias Ringwald (*hci_stack->control->sleep)(); 300272ea5239Smatthias.ringwald } 3003b429b9b7Smatthias.ringwald 30043a9fb326S[email protected] hci_stack->state = HCI_STATE_SLEEPING; 30058d213e1aSmatthias.ringwald } 30068d213e1aSmatthias.ringwald 300740d1c7a4Smatthias.ringwald static int hci_power_control_wake(void){ 3008b429b9b7Smatthias.ringwald 30099da54300S[email protected] log_info("hci_power_control_wake"); 3010b429b9b7Smatthias.ringwald 3011b429b9b7Smatthias.ringwald // wake on 30123a9fb326S[email protected] if (hci_stack->control && hci_stack->control->wake){ 3013d0b87befSMatthias Ringwald (*hci_stack->control->wake)(); 3014b429b9b7Smatthias.ringwald } 3015b429b9b7Smatthias.ringwald 3016b429b9b7Smatthias.ringwald #if 0 3017b429b9b7Smatthias.ringwald // open low-level device 30183a9fb326S[email protected] int err = hci_stack->hci_transport->open(hci_stack->config); 3019b429b9b7Smatthias.ringwald if (err){ 30209da54300S[email protected] log_error( "HCI_INIT failed, turning Bluetooth off again"); 30213a9fb326S[email protected] if (hci_stack->control && hci_stack->control->off){ 3022d0b87befSMatthias Ringwald (*hci_stack->control->off)(); 3023b429b9b7Smatthias.ringwald } 3024b429b9b7Smatthias.ringwald hci_emit_hci_open_failed(); 3025b429b9b7Smatthias.ringwald return err; 3026b429b9b7Smatthias.ringwald } 3027b429b9b7Smatthias.ringwald #endif 3028b429b9b7Smatthias.ringwald 3029b429b9b7Smatthias.ringwald return 0; 3030b429b9b7Smatthias.ringwald } 3031b429b9b7Smatthias.ringwald 303244935e40S[email protected] static void hci_power_transition_to_initializing(void){ 303344935e40S[email protected] // set up state machine 303444935e40S[email protected] hci_stack->num_cmd_packets = 1; // assume that one cmd can be sent 303544935e40S[email protected] hci_stack->hci_packet_buffer_reserved = 0; 303644935e40S[email protected] hci_stack->state = HCI_STATE_INITIALIZING; 30375c363727SMatthias Ringwald hci_stack->substate = HCI_INIT_SEND_RESET; 303844935e40S[email protected] } 3039b429b9b7Smatthias.ringwald 30408d213e1aSmatthias.ringwald int hci_power_control(HCI_POWER_MODE power_mode){ 3041d661ed19Smatthias.ringwald 3042f04a0c31SMatthias Ringwald log_info("hci_power_control: %d, current mode %u", power_mode, hci_stack->state); 3043d661ed19Smatthias.ringwald 30448d213e1aSmatthias.ringwald int err = 0; 30453a9fb326S[email protected] switch (hci_stack->state){ 30468d213e1aSmatthias.ringwald 30478d213e1aSmatthias.ringwald case HCI_STATE_OFF: 30488d213e1aSmatthias.ringwald switch (power_mode){ 30498d213e1aSmatthias.ringwald case HCI_POWER_ON: 30508d213e1aSmatthias.ringwald err = hci_power_control_on(); 305197b61c7bS[email protected] if (err) { 3052f04a0c31SMatthias Ringwald log_error("hci_power_control_on() error %d", err); 305397b61c7bS[email protected] return err; 305497b61c7bS[email protected] } 305544935e40S[email protected] hci_power_transition_to_initializing(); 30568d213e1aSmatthias.ringwald break; 30578d213e1aSmatthias.ringwald case HCI_POWER_OFF: 30588d213e1aSmatthias.ringwald // do nothing 30598d213e1aSmatthias.ringwald break; 30608d213e1aSmatthias.ringwald case HCI_POWER_SLEEP: 3061b546ac54Smatthias.ringwald // do nothing (with SLEEP == OFF) 30628d213e1aSmatthias.ringwald break; 30638d213e1aSmatthias.ringwald } 30648d213e1aSmatthias.ringwald break; 30657301ad89Smatthias.ringwald 30668d213e1aSmatthias.ringwald case HCI_STATE_INITIALIZING: 30678d213e1aSmatthias.ringwald switch (power_mode){ 30688d213e1aSmatthias.ringwald case HCI_POWER_ON: 30698d213e1aSmatthias.ringwald // do nothing 30708d213e1aSmatthias.ringwald break; 30718d213e1aSmatthias.ringwald case HCI_POWER_OFF: 30728d213e1aSmatthias.ringwald // no connections yet, just turn it off 30738d213e1aSmatthias.ringwald hci_power_control_off(); 30748d213e1aSmatthias.ringwald break; 30758d213e1aSmatthias.ringwald case HCI_POWER_SLEEP: 3076b546ac54Smatthias.ringwald // no connections yet, just turn it off 307772ea5239Smatthias.ringwald hci_power_control_sleep(); 30788d213e1aSmatthias.ringwald break; 30798d213e1aSmatthias.ringwald } 30808d213e1aSmatthias.ringwald break; 30817301ad89Smatthias.ringwald 30828d213e1aSmatthias.ringwald case HCI_STATE_WORKING: 30838d213e1aSmatthias.ringwald switch (power_mode){ 30848d213e1aSmatthias.ringwald case HCI_POWER_ON: 30858d213e1aSmatthias.ringwald // do nothing 30868d213e1aSmatthias.ringwald break; 30878d213e1aSmatthias.ringwald case HCI_POWER_OFF: 3088c7e0c5f6Smatthias.ringwald // see hci_run 30893a9fb326S[email protected] hci_stack->state = HCI_STATE_HALTING; 3090beceeddeSMatthias Ringwald hci_stack->substate = HCI_HALTING_DISCONNECT_ALL_NO_TIMER; 30918d213e1aSmatthias.ringwald break; 30928d213e1aSmatthias.ringwald case HCI_POWER_SLEEP: 3093b546ac54Smatthias.ringwald // see hci_run 30943a9fb326S[email protected] hci_stack->state = HCI_STATE_FALLING_ASLEEP; 309574b323a9SMatthias Ringwald hci_stack->substate = HCI_FALLING_ASLEEP_DISCONNECT; 30968d213e1aSmatthias.ringwald break; 30978d213e1aSmatthias.ringwald } 30988d213e1aSmatthias.ringwald break; 30997301ad89Smatthias.ringwald 31008d213e1aSmatthias.ringwald case HCI_STATE_HALTING: 31018d213e1aSmatthias.ringwald switch (power_mode){ 31028d213e1aSmatthias.ringwald case HCI_POWER_ON: 310344935e40S[email protected] hci_power_transition_to_initializing(); 31048d213e1aSmatthias.ringwald break; 31058d213e1aSmatthias.ringwald case HCI_POWER_OFF: 31068d213e1aSmatthias.ringwald // do nothing 31078d213e1aSmatthias.ringwald break; 31088d213e1aSmatthias.ringwald case HCI_POWER_SLEEP: 3109b546ac54Smatthias.ringwald // see hci_run 31103a9fb326S[email protected] hci_stack->state = HCI_STATE_FALLING_ASLEEP; 311174b323a9SMatthias Ringwald hci_stack->substate = HCI_FALLING_ASLEEP_DISCONNECT; 31128d213e1aSmatthias.ringwald break; 31138d213e1aSmatthias.ringwald } 31148d213e1aSmatthias.ringwald break; 31158d213e1aSmatthias.ringwald 31168d213e1aSmatthias.ringwald case HCI_STATE_FALLING_ASLEEP: 31178d213e1aSmatthias.ringwald switch (power_mode){ 31188d213e1aSmatthias.ringwald case HCI_POWER_ON: 311928171530Smatthias.ringwald 3120423a3e49SMatthias Ringwald #ifdef HAVE_PLATFORM_IPHONE_OS 312128171530Smatthias.ringwald // nothing to do, if H4 supports power management 3122d0b87befSMatthias Ringwald if (btstack_control_iphone_power_management_enabled()){ 31233a9fb326S[email protected] hci_stack->state = HCI_STATE_INITIALIZING; 312474b323a9SMatthias Ringwald hci_stack->substate = HCI_INIT_WRITE_SCAN_ENABLE; // init after sleep 312528171530Smatthias.ringwald break; 312628171530Smatthias.ringwald } 312728171530Smatthias.ringwald #endif 312844935e40S[email protected] hci_power_transition_to_initializing(); 31298d213e1aSmatthias.ringwald break; 31308d213e1aSmatthias.ringwald case HCI_POWER_OFF: 3131b546ac54Smatthias.ringwald // see hci_run 31323a9fb326S[email protected] hci_stack->state = HCI_STATE_HALTING; 3133beceeddeSMatthias Ringwald hci_stack->substate = HCI_HALTING_DISCONNECT_ALL_NO_TIMER; 31348d213e1aSmatthias.ringwald break; 31358d213e1aSmatthias.ringwald case HCI_POWER_SLEEP: 3136b546ac54Smatthias.ringwald // do nothing 31378d213e1aSmatthias.ringwald break; 31388d213e1aSmatthias.ringwald } 31398d213e1aSmatthias.ringwald break; 31408d213e1aSmatthias.ringwald 31418d213e1aSmatthias.ringwald case HCI_STATE_SLEEPING: 31428d213e1aSmatthias.ringwald switch (power_mode){ 31438d213e1aSmatthias.ringwald case HCI_POWER_ON: 314428171530Smatthias.ringwald 3145423a3e49SMatthias Ringwald #ifdef HAVE_PLATFORM_IPHONE_OS 314628171530Smatthias.ringwald // nothing to do, if H4 supports power management 3147d0b87befSMatthias Ringwald if (btstack_control_iphone_power_management_enabled()){ 31483a9fb326S[email protected] hci_stack->state = HCI_STATE_INITIALIZING; 31495c363727SMatthias Ringwald hci_stack->substate = HCI_INIT_AFTER_SLEEP; 3150758b46ceSmatthias.ringwald hci_update_scan_enable(); 315128171530Smatthias.ringwald break; 315228171530Smatthias.ringwald } 315328171530Smatthias.ringwald #endif 31543144bce4Smatthias.ringwald err = hci_power_control_wake(); 31553144bce4Smatthias.ringwald if (err) return err; 315644935e40S[email protected] hci_power_transition_to_initializing(); 31578d213e1aSmatthias.ringwald break; 31588d213e1aSmatthias.ringwald case HCI_POWER_OFF: 31593a9fb326S[email protected] hci_stack->state = HCI_STATE_HALTING; 3160beceeddeSMatthias Ringwald hci_stack->substate = HCI_HALTING_DISCONNECT_ALL_NO_TIMER; 31618d213e1aSmatthias.ringwald break; 31628d213e1aSmatthias.ringwald case HCI_POWER_SLEEP: 3163b546ac54Smatthias.ringwald // do nothing 31648d213e1aSmatthias.ringwald break; 31658d213e1aSmatthias.ringwald } 31668d213e1aSmatthias.ringwald break; 316711e23e5fSmatthias.ringwald } 316868d92d03Smatthias.ringwald 3169038bc64cSmatthias.ringwald // create internal event 3170ee8bf225Smatthias.ringwald hci_emit_state(); 3171ee8bf225Smatthias.ringwald 317268d92d03Smatthias.ringwald // trigger next/first action 317368d92d03Smatthias.ringwald hci_run(); 317468d92d03Smatthias.ringwald 3175475c8125Smatthias.ringwald return 0; 3176475c8125Smatthias.ringwald } 3177475c8125Smatthias.ringwald 317835454696SMatthias Ringwald 317935454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 318035454696SMatthias Ringwald 3181758b46ceSmatthias.ringwald static void hci_update_scan_enable(void){ 3182758b46ceSmatthias.ringwald // 2 = page scan, 1 = inq scan 31833a9fb326S[email protected] hci_stack->new_scan_enable_value = hci_stack->connectable << 1 | hci_stack->discoverable; 3184758b46ceSmatthias.ringwald hci_run(); 3185758b46ceSmatthias.ringwald } 3186758b46ceSmatthias.ringwald 318715a95bd5SMatthias Ringwald void gap_discoverable_control(uint8_t enable){ 3188381fbed8Smatthias.ringwald if (enable) enable = 1; // normalize argument 3189381fbed8Smatthias.ringwald 31903a9fb326S[email protected] if (hci_stack->discoverable == enable){ 31913a9fb326S[email protected] hci_emit_discoverable_enabled(hci_stack->discoverable); 3192381fbed8Smatthias.ringwald return; 3193381fbed8Smatthias.ringwald } 3194381fbed8Smatthias.ringwald 31953a9fb326S[email protected] hci_stack->discoverable = enable; 3196758b46ceSmatthias.ringwald hci_update_scan_enable(); 3197758b46ceSmatthias.ringwald } 3198b031bebbSmatthias.ringwald 319915a95bd5SMatthias Ringwald void gap_connectable_control(uint8_t enable){ 3200758b46ceSmatthias.ringwald if (enable) enable = 1; // normalize argument 3201758b46ceSmatthias.ringwald 3202758b46ceSmatthias.ringwald // don't emit event 32033a9fb326S[email protected] if (hci_stack->connectable == enable) return; 3204758b46ceSmatthias.ringwald 32053a9fb326S[email protected] hci_stack->connectable = enable; 3206758b46ceSmatthias.ringwald hci_update_scan_enable(); 3207381fbed8Smatthias.ringwald } 320835454696SMatthias Ringwald #endif 3209381fbed8Smatthias.ringwald 321015a95bd5SMatthias Ringwald void gap_local_bd_addr(bd_addr_t address_buffer){ 3211690bd0baS[email protected] memcpy(address_buffer, hci_stack->local_bd_addr, 6); 32125061f3afS[email protected] } 32135061f3afS[email protected] 32142b838201SMatthias Ringwald #ifdef ENABLE_HCI_CONTROLLER_TO_HOST_FLOW_CONTROL 32152b838201SMatthias Ringwald static void hci_host_num_completed_packets(void){ 32162b838201SMatthias Ringwald 32172b838201SMatthias Ringwald // create packet manually as arrays are not supported and num_commands should not get reduced 32182b838201SMatthias Ringwald hci_reserve_packet_buffer(); 32192b838201SMatthias Ringwald uint8_t * packet = hci_get_outgoing_packet_buffer(); 32202b838201SMatthias Ringwald 32212b838201SMatthias Ringwald uint16_t size = 0; 32222b838201SMatthias Ringwald uint16_t num_handles = 0; 32232b838201SMatthias Ringwald packet[size++] = 0x35; 32242b838201SMatthias Ringwald packet[size++] = 0x0c; 32252b838201SMatthias Ringwald size++; // skip param len 32262b838201SMatthias Ringwald size++; // skip num handles 32272b838201SMatthias Ringwald 32282b838201SMatthias Ringwald // add { handle, packets } entries 32292b838201SMatthias Ringwald btstack_linked_item_t * it; 32302b838201SMatthias Ringwald for (it = (btstack_linked_item_t *) hci_stack->connections; it ; it = it->next){ 32312b838201SMatthias Ringwald hci_connection_t * connection = (hci_connection_t *) it; 32322b838201SMatthias Ringwald if (connection->num_packets_completed){ 32332b838201SMatthias Ringwald little_endian_store_16(packet, size, connection->con_handle); 32342b838201SMatthias Ringwald size += 2; 32352b838201SMatthias Ringwald little_endian_store_16(packet, size, connection->num_packets_completed); 32362b838201SMatthias Ringwald size += 2; 32372b838201SMatthias Ringwald // 32382b838201SMatthias Ringwald num_handles++; 32392b838201SMatthias Ringwald connection->num_packets_completed = 0; 32402b838201SMatthias Ringwald } 32412b838201SMatthias Ringwald } 32422b838201SMatthias Ringwald 32432b838201SMatthias Ringwald packet[2] = size - 3; 32442b838201SMatthias Ringwald packet[3] = num_handles; 32452b838201SMatthias Ringwald 32462b838201SMatthias Ringwald hci_stack->host_completed_packets = 0; 32472b838201SMatthias Ringwald 32482b838201SMatthias Ringwald hci_dump_packet(HCI_COMMAND_DATA_PACKET, 0, packet, size); 32492b838201SMatthias Ringwald hci_stack->hci_transport->send_packet(HCI_COMMAND_DATA_PACKET, packet, size); 32502b838201SMatthias Ringwald 32512b838201SMatthias Ringwald // release packet buffer for synchronous transport implementations 32522b838201SMatthias Ringwald if (hci_transport_synchronous()){ 3253e2d22487SMatthias Ringwald hci_release_packet_buffer(); 3254068b8592SMatthias Ringwald hci_emit_transport_packet_sent(); 32552b838201SMatthias Ringwald } 32562b838201SMatthias Ringwald } 32572b838201SMatthias Ringwald #endif 32582b838201SMatthias Ringwald 325926fe9592SMatthias Ringwald static void hci_halting_timeout_handler(btstack_timer_source_t * ds){ 326026fe9592SMatthias Ringwald UNUSED(ds); 326126fe9592SMatthias Ringwald hci_stack->substate = HCI_HALTING_CLOSE; 3262beceeddeSMatthias Ringwald // allow packet handlers to defer final shutdown 3263beceeddeSMatthias Ringwald hci_emit_state(); 326426fe9592SMatthias Ringwald hci_run(); 326526fe9592SMatthias Ringwald } 326626fe9592SMatthias Ringwald 326795d71764SMatthias Ringwald static void hci_run(void){ 32688a485f27Smatthias.ringwald 3269db8bc6ffSMatthias Ringwald // log_info("hci_run: entered"); 3270665d90f2SMatthias Ringwald btstack_linked_item_t * it; 327132ab9390Smatthias.ringwald 3272b5d8b22bS[email protected] // send continuation fragments first, as they block the prepared packet buffer 3273b5d8b22bS[email protected] if (hci_stack->acl_fragmentation_total_size > 0) { 3274b5d8b22bS[email protected] hci_con_handle_t con_handle = READ_ACL_CONNECTION_HANDLE(hci_stack->hci_packet_buffer); 3275b5d8b22bS[email protected] hci_connection_t *connection = hci_connection_for_handle(con_handle); 3276b5d8b22bS[email protected] if (connection) { 327728a0332dSMatthias Ringwald if (hci_can_send_prepared_acl_packet_now(con_handle)){ 3278b5d8b22bS[email protected] hci_send_acl_packet_fragments(connection); 3279b5d8b22bS[email protected] return; 3280b5d8b22bS[email protected] } 328128a0332dSMatthias Ringwald } else { 3282b5d8b22bS[email protected] // connection gone -> discard further fragments 328328a0332dSMatthias Ringwald log_info("hci_run: fragmented ACL packet no connection -> discard fragment"); 3284b5d8b22bS[email protected] hci_stack->acl_fragmentation_total_size = 0; 3285b5d8b22bS[email protected] hci_stack->acl_fragmentation_pos = 0; 3286b5d8b22bS[email protected] } 3287b5d8b22bS[email protected] } 3288b5d8b22bS[email protected] 32892b838201SMatthias Ringwald #ifdef ENABLE_HCI_CONTROLLER_TO_HOST_FLOW_CONTROL 32902b838201SMatthias Ringwald // send host num completed packets next as they don't require num_cmd_packets > 0 32912b838201SMatthias Ringwald if (!hci_can_send_comand_packet_transport()) return; 32922b838201SMatthias Ringwald if (hci_stack->host_completed_packets){ 32932b838201SMatthias Ringwald hci_host_num_completed_packets(); 32942b838201SMatthias Ringwald return; 32952b838201SMatthias Ringwald } 32962b838201SMatthias Ringwald #endif 32972b838201SMatthias Ringwald 3298d94d3cafS[email protected] if (!hci_can_send_command_packet_now()) return; 3299ce4c8fabSmatthias.ringwald 3300b031bebbSmatthias.ringwald // global/non-connection oriented commands 3301b031bebbSmatthias.ringwald 330235454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 3303b031bebbSmatthias.ringwald // decline incoming connections 33043a9fb326S[email protected] if (hci_stack->decline_reason){ 33053a9fb326S[email protected] uint8_t reason = hci_stack->decline_reason; 33063a9fb326S[email protected] hci_stack->decline_reason = 0; 33073a9fb326S[email protected] hci_send_cmd(&hci_reject_connection_request, hci_stack->decline_addr, reason); 3308dbe1a790S[email protected] return; 3309ce4c8fabSmatthias.ringwald } 3310b031bebbSmatthias.ringwald // send scan enable 33113a9fb326S[email protected] if (hci_stack->state == HCI_STATE_WORKING && hci_stack->new_scan_enable_value != 0xff && hci_classic_supported()){ 33123a9fb326S[email protected] hci_send_cmd(&hci_write_scan_enable, hci_stack->new_scan_enable_value); 33133a9fb326S[email protected] hci_stack->new_scan_enable_value = 0xff; 3314dbe1a790S[email protected] return; 3315b031bebbSmatthias.ringwald } 3316f5875de5SMatthias Ringwald // start/stop inquiry 3317f5875de5SMatthias Ringwald if (hci_stack->inquiry_state >= GAP_INQUIRY_DURATION_MIN && hci_stack->inquiry_state <= GAP_INQUIRY_DURATION_MAX){ 3318f5875de5SMatthias Ringwald uint8_t duration = hci_stack->inquiry_state; 3319f5875de5SMatthias Ringwald hci_stack->inquiry_state = GAP_INQUIRY_STATE_ACTIVE; 33208aee7be2SMilanka Ringwald hci_send_cmd(&hci_inquiry, GAP_IAC_GENERAL_INQUIRY, duration, 0); 3321f5875de5SMatthias Ringwald return; 3322f5875de5SMatthias Ringwald } 3323f5875de5SMatthias Ringwald if (hci_stack->inquiry_state == GAP_INQUIRY_STATE_W2_CANCEL){ 3324f5875de5SMatthias Ringwald hci_stack->inquiry_state = GAP_INQUIRY_STATE_W4_CANCELLED; 3325f5875de5SMatthias Ringwald hci_send_cmd(&hci_inquiry_cancel); 3326f5875de5SMatthias Ringwald return; 3327f5875de5SMatthias Ringwald } 3328b7f1ee76SMatthias Ringwald // remote name request 3329b7f1ee76SMatthias Ringwald if (hci_stack->remote_name_state == GAP_REMOTE_NAME_STATE_W2_SEND){ 3330b7f1ee76SMatthias Ringwald hci_stack->remote_name_state = GAP_REMOTE_NAME_STATE_W4_COMPLETE; 3331b7f1ee76SMatthias Ringwald hci_send_cmd(&hci_remote_name_request, hci_stack->remote_name_addr, 3332ee8a36c8SMatthias Ringwald hci_stack->remote_name_page_scan_repetition_mode, 0, hci_stack->remote_name_clock_offset); 33330e55bd69SMatthias Ringwald return; 3334b7f1ee76SMatthias Ringwald } 33350a51f88bSMatthias Ringwald // pairing 33360a51f88bSMatthias Ringwald if (hci_stack->gap_pairing_state != GAP_PAIRING_STATE_IDLE){ 33370a51f88bSMatthias Ringwald uint8_t state = hci_stack->gap_pairing_state; 33380a51f88bSMatthias Ringwald hci_stack->gap_pairing_state = GAP_PAIRING_STATE_IDLE; 33390a51f88bSMatthias Ringwald switch (state){ 33400a51f88bSMatthias Ringwald case GAP_PAIRING_STATE_SEND_PIN: 3341d504181aSMatthias Ringwald hci_send_cmd(&hci_pin_code_request_reply, hci_stack->gap_pairing_addr, strlen(hci_stack->gap_pairing_input.gap_pairing_pin), hci_stack->gap_pairing_input.gap_pairing_pin); 33420a51f88bSMatthias Ringwald break; 33430a51f88bSMatthias Ringwald case GAP_PAIRING_STATE_SEND_PIN_NEGATIVE: 33440a51f88bSMatthias Ringwald hci_send_cmd(&hci_pin_code_request_negative_reply, hci_stack->gap_pairing_addr); 33450a51f88bSMatthias Ringwald break; 33460a51f88bSMatthias Ringwald case GAP_PAIRING_STATE_SEND_PASSKEY: 3347d504181aSMatthias Ringwald hci_send_cmd(&hci_user_passkey_request_reply, hci_stack->gap_pairing_addr, hci_stack->gap_pairing_input.gap_pairing_passkey); 33480a51f88bSMatthias Ringwald break; 33490a51f88bSMatthias Ringwald case GAP_PAIRING_STATE_SEND_PASSKEY_NEGATIVE: 33500a51f88bSMatthias Ringwald hci_send_cmd(&hci_user_passkey_request_negative_reply, hci_stack->gap_pairing_addr); 33510a51f88bSMatthias Ringwald break; 33520a51f88bSMatthias Ringwald case GAP_PAIRING_STATE_SEND_CONFIRMATION: 33530a51f88bSMatthias Ringwald hci_send_cmd(&hci_user_confirmation_request_reply, hci_stack->gap_pairing_addr); 33540a51f88bSMatthias Ringwald break; 33550a51f88bSMatthias Ringwald case GAP_PAIRING_STATE_SEND_CONFIRMATION_NEGATIVE: 33560a51f88bSMatthias Ringwald hci_send_cmd(&hci_user_confirmation_request_negative_reply, hci_stack->gap_pairing_addr); 33570a51f88bSMatthias Ringwald break; 33580a51f88bSMatthias Ringwald default: 33590a51f88bSMatthias Ringwald break; 33600a51f88bSMatthias Ringwald } 33610a51f88bSMatthias Ringwald return; 33620a51f88bSMatthias Ringwald } 336335454696SMatthias Ringwald #endif 3364b031bebbSmatthias.ringwald 3365a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE 3366b95a5a35SMatthias Ringwald // advertisements, active scanning, and creating connections requires randaom address to be set if using private address 3367b95a5a35SMatthias Ringwald if ((hci_stack->state == HCI_STATE_WORKING) 3368b95a5a35SMatthias Ringwald && (hci_stack->le_own_addr_type == BD_ADDR_TYPE_LE_PUBLIC || hci_stack->le_random_address_set)){ 3369d70217a2SMatthias Ringwald 3370d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 337145c102fdSMatthias Ringwald // handle le scan 33726fab74dbSMatthias Ringwald if ((hci_stack->le_scanning_enabled != hci_stack->le_scanning_active)){ 33736fab74dbSMatthias Ringwald hci_stack->le_scanning_active = hci_stack->le_scanning_enabled; 33746fab74dbSMatthias Ringwald hci_send_cmd(&hci_le_set_scan_enable, hci_stack->le_scanning_enabled, 0); 33757bdc6798S[email protected] return; 33767bdc6798S[email protected] } 3377e2602ea2Smatthias.ringwald if (hci_stack->le_scan_type != 0xff){ 3378e2602ea2Smatthias.ringwald // defaults: active scanning, accept all advertisement packets 3379e2602ea2Smatthias.ringwald int scan_type = hci_stack->le_scan_type; 3380e2602ea2Smatthias.ringwald hci_stack->le_scan_type = 0xff; 3381b95a5a35SMatthias Ringwald hci_send_cmd(&hci_le_set_scan_parameters, scan_type, hci_stack->le_scan_interval, hci_stack->le_scan_window, hci_stack->le_own_addr_type, 0); 3382e2602ea2Smatthias.ringwald return; 3383e2602ea2Smatthias.ringwald } 3384d70217a2SMatthias Ringwald #endif 3385d70217a2SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 338645c102fdSMatthias Ringwald // le advertisement control 33879a2e4658SMatthias Ringwald if (hci_stack->le_advertisements_todo){ 33889a2e4658SMatthias Ringwald log_info("hci_run: gap_le: adv todo: %x", hci_stack->le_advertisements_todo ); 33899a2e4658SMatthias Ringwald } 339045c102fdSMatthias Ringwald if (hci_stack->le_advertisements_todo & LE_ADVERTISEMENT_TASKS_DISABLE){ 339145c102fdSMatthias Ringwald hci_stack->le_advertisements_todo &= ~LE_ADVERTISEMENT_TASKS_DISABLE; 339245c102fdSMatthias Ringwald hci_send_cmd(&hci_le_set_advertise_enable, 0); 339345c102fdSMatthias Ringwald return; 339445c102fdSMatthias Ringwald } 339545c102fdSMatthias Ringwald if (hci_stack->le_advertisements_todo & LE_ADVERTISEMENT_TASKS_SET_PARAMS){ 339645c102fdSMatthias Ringwald hci_stack->le_advertisements_todo &= ~LE_ADVERTISEMENT_TASKS_SET_PARAMS; 339745c102fdSMatthias Ringwald hci_send_cmd(&hci_le_set_advertising_parameters, 339845c102fdSMatthias Ringwald hci_stack->le_advertisements_interval_min, 339945c102fdSMatthias Ringwald hci_stack->le_advertisements_interval_max, 340045c102fdSMatthias Ringwald hci_stack->le_advertisements_type, 3401b95a5a35SMatthias Ringwald hci_stack->le_own_addr_type, 340245c102fdSMatthias Ringwald hci_stack->le_advertisements_direct_address_type, 340345c102fdSMatthias Ringwald hci_stack->le_advertisements_direct_address, 340445c102fdSMatthias Ringwald hci_stack->le_advertisements_channel_map, 340545c102fdSMatthias Ringwald hci_stack->le_advertisements_filter_policy); 340645c102fdSMatthias Ringwald return; 340745c102fdSMatthias Ringwald } 3408501f56b3SMatthias Ringwald if (hci_stack->le_advertisements_todo & LE_ADVERTISEMENT_TASKS_SET_ADV_DATA){ 3409501f56b3SMatthias Ringwald hci_stack->le_advertisements_todo &= ~LE_ADVERTISEMENT_TASKS_SET_ADV_DATA; 34107a85e4f5SMatthias Ringwald uint8_t adv_data_clean[31]; 34117a85e4f5SMatthias Ringwald memset(adv_data_clean, 0, sizeof(adv_data_clean)); 34127a85e4f5SMatthias Ringwald memcpy(adv_data_clean, hci_stack->le_advertisements_data, hci_stack->le_advertisements_data_len); 3413f868b059SMatthias Ringwald hci_replace_bd_addr_placeholder(adv_data_clean, hci_stack->le_advertisements_data_len); 34147a85e4f5SMatthias Ringwald hci_send_cmd(&hci_le_set_advertising_data, hci_stack->le_advertisements_data_len, adv_data_clean); 341545c102fdSMatthias Ringwald return; 341645c102fdSMatthias Ringwald } 3417501f56b3SMatthias Ringwald if (hci_stack->le_advertisements_todo & LE_ADVERTISEMENT_TASKS_SET_SCAN_DATA){ 3418501f56b3SMatthias Ringwald hci_stack->le_advertisements_todo &= ~LE_ADVERTISEMENT_TASKS_SET_SCAN_DATA; 3419f868b059SMatthias Ringwald uint8_t scan_data_clean[31]; 3420f868b059SMatthias Ringwald memset(scan_data_clean, 0, sizeof(scan_data_clean)); 34218cdc9940SMatthias Ringwald memcpy(scan_data_clean, hci_stack->le_scan_response_data, hci_stack->le_scan_response_data_len); 3422f868b059SMatthias Ringwald hci_replace_bd_addr_placeholder(scan_data_clean, hci_stack->le_scan_response_data_len); 3423214bfd60SMatthias Ringwald hci_send_cmd(&hci_le_set_scan_response_data, hci_stack->le_scan_response_data_len, scan_data_clean); 3424501f56b3SMatthias Ringwald return; 3425501f56b3SMatthias Ringwald } 3426b95a5a35SMatthias Ringwald if (hci_stack->le_advertisements_todo & LE_ADVERTISEMENT_TASKS_ENABLE){ 342745c102fdSMatthias Ringwald hci_stack->le_advertisements_todo &= ~LE_ADVERTISEMENT_TASKS_ENABLE; 342845c102fdSMatthias Ringwald hci_send_cmd(&hci_le_set_advertise_enable, 1); 342945c102fdSMatthias Ringwald return; 343045c102fdSMatthias Ringwald } 3431d70217a2SMatthias Ringwald #endif 34329956955bSMatthias Ringwald 3433d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 34349956955bSMatthias Ringwald // 34359956955bSMatthias Ringwald // LE Whitelist Management 34369956955bSMatthias Ringwald // 34379956955bSMatthias Ringwald 34389956955bSMatthias Ringwald // check if whitelist needs modification 3439665d90f2SMatthias Ringwald btstack_linked_list_iterator_t lit; 34409956955bSMatthias Ringwald int modification_pending = 0; 3441665d90f2SMatthias Ringwald btstack_linked_list_iterator_init(&lit, &hci_stack->le_whitelist); 3442665d90f2SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&lit)){ 3443665d90f2SMatthias Ringwald whitelist_entry_t * entry = (whitelist_entry_t*) btstack_linked_list_iterator_next(&lit); 34449956955bSMatthias Ringwald if (entry->state & (LE_WHITELIST_REMOVE_FROM_CONTROLLER | LE_WHITELIST_ADD_TO_CONTROLLER)){ 34459956955bSMatthias Ringwald modification_pending = 1; 34469956955bSMatthias Ringwald break; 34479956955bSMatthias Ringwald } 34489956955bSMatthias Ringwald } 344991915b0bSMatthias Ringwald 34509956955bSMatthias Ringwald if (modification_pending){ 345191915b0bSMatthias Ringwald // stop connnecting if modification pending 34529956955bSMatthias Ringwald if (hci_stack->le_connecting_state != LE_CONNECTING_IDLE){ 34539956955bSMatthias Ringwald hci_send_cmd(&hci_le_create_connection_cancel); 34549956955bSMatthias Ringwald return; 34559956955bSMatthias Ringwald } 34569956955bSMatthias Ringwald 34579956955bSMatthias Ringwald // add/remove entries 3458665d90f2SMatthias Ringwald btstack_linked_list_iterator_init(&lit, &hci_stack->le_whitelist); 3459665d90f2SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&lit)){ 3460665d90f2SMatthias Ringwald whitelist_entry_t * entry = (whitelist_entry_t*) btstack_linked_list_iterator_next(&lit); 34619956955bSMatthias Ringwald if (entry->state & LE_WHITELIST_ADD_TO_CONTROLLER){ 34629956955bSMatthias Ringwald entry->state = LE_WHITELIST_ON_CONTROLLER; 34639956955bSMatthias Ringwald hci_send_cmd(&hci_le_add_device_to_white_list, entry->address_type, entry->address); 34649956955bSMatthias Ringwald return; 34659956955bSMatthias Ringwald 34669956955bSMatthias Ringwald } 34679956955bSMatthias Ringwald if (entry->state & LE_WHITELIST_REMOVE_FROM_CONTROLLER){ 34689ecbe201SMatthias Ringwald bd_addr_t address; 34699ecbe201SMatthias Ringwald bd_addr_type_t address_type = entry->address_type; 34709ecbe201SMatthias Ringwald memcpy(address, entry->address, 6); 3471665d90f2SMatthias Ringwald btstack_linked_list_remove(&hci_stack->le_whitelist, (btstack_linked_item_t *) entry); 34729956955bSMatthias Ringwald btstack_memory_whitelist_entry_free(entry); 34739ecbe201SMatthias Ringwald hci_send_cmd(&hci_le_remove_device_from_white_list, address_type, address); 34749956955bSMatthias Ringwald return; 34759956955bSMatthias Ringwald } 34769956955bSMatthias Ringwald } 347791915b0bSMatthias Ringwald } 34789956955bSMatthias Ringwald 34799956955bSMatthias Ringwald // start connecting 348091915b0bSMatthias Ringwald if ( hci_stack->le_connecting_state == LE_CONNECTING_IDLE && 3481665d90f2SMatthias Ringwald !btstack_linked_list_empty(&hci_stack->le_whitelist)){ 34829956955bSMatthias Ringwald bd_addr_t null_addr; 34839956955bSMatthias Ringwald memset(null_addr, 0, 6); 34849956955bSMatthias Ringwald hci_send_cmd(&hci_le_create_connection, 3485cbe54ab2SJakob Krantz hci_stack->le_connection_scan_interval, // scan interval: 60 ms 3486cbe54ab2SJakob Krantz hci_stack->le_connection_scan_window, // scan interval: 30 ms 34879956955bSMatthias Ringwald 1, // use whitelist 34889956955bSMatthias Ringwald 0, // peer address type 34899956955bSMatthias Ringwald null_addr, // peer bd addr 3490b95a5a35SMatthias Ringwald hci_stack->le_own_addr_type, // our addr type: 349173044eb2SMatthias Ringwald hci_stack->le_connection_interval_min, // conn interval min 349273044eb2SMatthias Ringwald hci_stack->le_connection_interval_max, // conn interval max 349373044eb2SMatthias Ringwald hci_stack->le_connection_latency, // conn latency 349473044eb2SMatthias Ringwald hci_stack->le_supervision_timeout, // conn latency 349573044eb2SMatthias Ringwald hci_stack->le_minimum_ce_length, // min ce length 349673044eb2SMatthias Ringwald hci_stack->le_maximum_ce_length // max ce length 34979956955bSMatthias Ringwald ); 34989956955bSMatthias Ringwald return; 34999956955bSMatthias Ringwald } 3500d70217a2SMatthias Ringwald #endif 35017bdc6798S[email protected] } 3502b2f949feS[email protected] #endif 35037bdc6798S[email protected] 350432ab9390Smatthias.ringwald // send pending HCI commands 3505665d90f2SMatthias Ringwald for (it = (btstack_linked_item_t *) hci_stack->connections; it ; it = it->next){ 350605ae8de3SMatthias Ringwald hci_connection_t * connection = (hci_connection_t *) it; 350732ab9390Smatthias.ringwald 35080bf6344aS[email protected] switch(connection->state){ 35090bf6344aS[email protected] case SEND_CREATE_CONNECTION: 35104f3229d8S[email protected] switch(connection->address_type){ 351135454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 35124f3229d8S[email protected] case BD_ADDR_TYPE_CLASSIC: 35139da54300S[email protected] log_info("sending hci_create_connection"); 3514ad83dc6aS[email protected] hci_send_cmd(&hci_create_connection, connection->address, hci_usable_acl_packet_types(), 0, 0, 0, 1); 35154f3229d8S[email protected] break; 351635454696SMatthias Ringwald #endif 35174f3229d8S[email protected] default: 3518a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE 3519d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 3520229331c6SMatthias Ringwald // track outgoing connection 3521229331c6SMatthias Ringwald hci_stack->outgoing_addr_type = connection->address_type; 3522229331c6SMatthias Ringwald memcpy(hci_stack->outgoing_addr, connection->address, 6); 35239da54300S[email protected] log_info("sending hci_le_create_connection"); 35244f3229d8S[email protected] hci_send_cmd(&hci_le_create_connection, 3525cbe54ab2SJakob Krantz hci_stack->le_connection_scan_interval, // conn scan interval 3526cbe54ab2SJakob Krantz hci_stack->le_connection_scan_window, // conn scan windows 35274f3229d8S[email protected] 0, // don't use whitelist 35284f3229d8S[email protected] connection->address_type, // peer address type 35294f3229d8S[email protected] connection->address, // peer bd addr 3530b95a5a35SMatthias Ringwald hci_stack->le_own_addr_type, // our addr type: 353173044eb2SMatthias Ringwald hci_stack->le_connection_interval_min, // conn interval min 353273044eb2SMatthias Ringwald hci_stack->le_connection_interval_max, // conn interval max 353373044eb2SMatthias Ringwald hci_stack->le_connection_latency, // conn latency 353473044eb2SMatthias Ringwald hci_stack->le_supervision_timeout, // conn latency 353573044eb2SMatthias Ringwald hci_stack->le_minimum_ce_length, // min ce length 353673044eb2SMatthias Ringwald hci_stack->le_maximum_ce_length // max ce length 35374f3229d8S[email protected] ); 35384f3229d8S[email protected] connection->state = SENT_CREATE_CONNECTION; 3539b2f949feS[email protected] #endif 3540d70217a2SMatthias Ringwald #endif 35414f3229d8S[email protected] break; 35424f3229d8S[email protected] } 3543ad83dc6aS[email protected] return; 3544ad83dc6aS[email protected] 354535454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 35460bf6344aS[email protected] case RECEIVED_CONNECTION_REQUEST: 35475cf766e8SMatthias Ringwald connection->role = HCI_ROLE_SLAVE; 3548e35edcc1S[email protected] if (connection->address_type == BD_ADDR_TYPE_CLASSIC){ 3549895f6685SMilanka Ringwald log_info("sending hci_accept_connection_request, remote eSCO %u", connection->remote_supported_feature_eSCO); 3550895f6685SMilanka Ringwald connection->state = ACCEPTED_CONNECTION_REQUEST; 3551c4c88f1bSJakob Krantz hci_send_cmd(&hci_accept_connection_request, connection->address, hci_stack->master_slave_policy); 3552e35edcc1S[email protected] } 3553dbe1a790S[email protected] return; 355435454696SMatthias Ringwald #endif 35550bf6344aS[email protected] 3556a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE 3557d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 35580bf6344aS[email protected] case SEND_CANCEL_CONNECTION: 35590bf6344aS[email protected] connection->state = SENT_CANCEL_CONNECTION; 35600bf6344aS[email protected] hci_send_cmd(&hci_le_create_connection_cancel); 35610bf6344aS[email protected] return; 3562a6725849S[email protected] #endif 3563d70217a2SMatthias Ringwald #endif 35640bf6344aS[email protected] case SEND_DISCONNECT: 35650bf6344aS[email protected] connection->state = SENT_DISCONNECT; 35667851196eSmatthias.ringwald hci_send_cmd(&hci_disconnect, connection->con_handle, 0x13); // remote closed connection 35670bf6344aS[email protected] return; 35680bf6344aS[email protected] 35690bf6344aS[email protected] default: 35700bf6344aS[email protected] break; 3571c7e0c5f6Smatthias.ringwald } 3572c7e0c5f6Smatthias.ringwald 3573cabf004eSMatthias Ringwald // no further commands if connection is about to get shut down 3574cabf004eSMatthias Ringwald if (connection->state == SENT_DISCONNECT) continue; 3575cabf004eSMatthias Ringwald 357635454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 357732ab9390Smatthias.ringwald if (connection->authentication_flags & HANDLE_LINK_KEY_REQUEST){ 35789da54300S[email protected] log_info("responding to link key request"); 357934d2123cS[email protected] connectionClearAuthenticationFlags(connection, HANDLE_LINK_KEY_REQUEST); 358032ab9390Smatthias.ringwald link_key_t link_key; 3581c77e8838S[email protected] link_key_type_t link_key_type; 3582a98592bcSMatthias Ringwald if ( hci_stack->link_key_db 3583a98592bcSMatthias Ringwald && hci_stack->link_key_db->get_link_key(connection->address, link_key, &link_key_type) 358434d2123cS[email protected] && gap_security_level_for_link_key_type(link_key_type) >= connection->requested_security_level){ 35859ab95c90S[email protected] connection->link_key_type = link_key_type; 358632ab9390Smatthias.ringwald hci_send_cmd(&hci_link_key_request_reply, connection->address, &link_key); 358732ab9390Smatthias.ringwald } else { 358832ab9390Smatthias.ringwald hci_send_cmd(&hci_link_key_request_negative_reply, connection->address); 358932ab9390Smatthias.ringwald } 3590dbe1a790S[email protected] return; 359132ab9390Smatthias.ringwald } 35921d6b20aeS[email protected] 3593899283eaS[email protected] if (connection->authentication_flags & DENY_PIN_CODE_REQUEST){ 35949da54300S[email protected] log_info("denying to pin request"); 3595899283eaS[email protected] connectionClearAuthenticationFlags(connection, DENY_PIN_CODE_REQUEST); 359634d2123cS[email protected] hci_send_cmd(&hci_pin_code_request_negative_reply, connection->address); 35974c57c146S[email protected] return; 35984c57c146S[email protected] } 35994c57c146S[email protected] 3600dbe1a790S[email protected] if (connection->authentication_flags & SEND_IO_CAPABILITIES_REPLY){ 360134d2123cS[email protected] connectionClearAuthenticationFlags(connection, SEND_IO_CAPABILITIES_REPLY); 360282d8f825S[email protected] log_info("IO Capability Request received, stack bondable %u, io cap %u", hci_stack->bondable, hci_stack->ssp_io_capability); 360382d8f825S[email protected] if (hci_stack->bondable && (hci_stack->ssp_io_capability != SSP_IO_CAPABILITY_UNKNOWN)){ 3604106d6d11S[email protected] // tweak authentication requirements 36053a9fb326S[email protected] uint8_t authreq = hci_stack->ssp_authentication_requirement; 3606106d6d11S[email protected] if (connection->bonding_flags & BONDING_DEDICATED){ 36079faad3abS[email protected] authreq = SSP_IO_AUTHREQ_MITM_PROTECTION_NOT_REQUIRED_DEDICATED_BONDING; 36089faad3abS[email protected] } 36099faad3abS[email protected] if (gap_mitm_protection_required_for_security_level(connection->requested_security_level)){ 36109faad3abS[email protected] authreq |= 1; 3611106d6d11S[email protected] } 36123a9fb326S[email protected] hci_send_cmd(&hci_io_capability_request_reply, &connection->address, hci_stack->ssp_io_capability, NULL, authreq); 3613f8fb5f6eS[email protected] } else { 3614f8fb5f6eS[email protected] hci_send_cmd(&hci_io_capability_request_negative_reply, &connection->address, ERROR_CODE_PAIRING_NOT_ALLOWED); 3615f8fb5f6eS[email protected] } 3616dbe1a790S[email protected] return; 361732ab9390Smatthias.ringwald } 361832ab9390Smatthias.ringwald 3619dbe1a790S[email protected] if (connection->authentication_flags & SEND_USER_CONFIRM_REPLY){ 3620dbe1a790S[email protected] connectionClearAuthenticationFlags(connection, SEND_USER_CONFIRM_REPLY); 362134d2123cS[email protected] hci_send_cmd(&hci_user_confirmation_request_reply, &connection->address); 3622dbe1a790S[email protected] return; 3623dbe1a790S[email protected] } 3624dbe1a790S[email protected] 3625dbe1a790S[email protected] if (connection->authentication_flags & SEND_USER_PASSKEY_REPLY){ 3626dbe1a790S[email protected] connectionClearAuthenticationFlags(connection, SEND_USER_PASSKEY_REPLY); 362734d2123cS[email protected] hci_send_cmd(&hci_user_passkey_request_reply, &connection->address, 000000); 3628dbe1a790S[email protected] return; 3629dbe1a790S[email protected] } 3630afd4e962S[email protected] 3631afd4e962S[email protected] if (connection->bonding_flags & BONDING_REQUEST_REMOTE_FEATURES){ 3632afd4e962S[email protected] connection->bonding_flags &= ~BONDING_REQUEST_REMOTE_FEATURES; 363334d2123cS[email protected] hci_send_cmd(&hci_read_remote_supported_features_command, connection->con_handle); 36342bd8b7e7S[email protected] return; 36352bd8b7e7S[email protected] } 36362bd8b7e7S[email protected] 3637ad83dc6aS[email protected] if (connection->bonding_flags & BONDING_DISCONNECT_DEDICATED_DONE){ 3638ad83dc6aS[email protected] connection->bonding_flags &= ~BONDING_DISCONNECT_DEDICATED_DONE; 36391bd5283dS[email protected] connection->bonding_flags |= BONDING_EMIT_COMPLETE_ON_DISCONNECT; 364052d34f98S[email protected] hci_send_cmd(&hci_disconnect, connection->con_handle, 0x13); // authentication done 3641ad83dc6aS[email protected] return; 3642ad83dc6aS[email protected] } 364376f27cffSMatthias Ringwald 364434d2123cS[email protected] if (connection->bonding_flags & BONDING_SEND_AUTHENTICATE_REQUEST){ 364534d2123cS[email protected] connection->bonding_flags &= ~BONDING_SEND_AUTHENTICATE_REQUEST; 364634d2123cS[email protected] hci_send_cmd(&hci_authentication_requested, connection->con_handle); 36472bd8b7e7S[email protected] return; 3648afd4e962S[email protected] } 364976f27cffSMatthias Ringwald 3650dce78009S[email protected] if (connection->bonding_flags & BONDING_SEND_ENCRYPTION_REQUEST){ 3651dce78009S[email protected] connection->bonding_flags &= ~BONDING_SEND_ENCRYPTION_REQUEST; 3652dce78009S[email protected] hci_send_cmd(&hci_set_connection_encryption, connection->con_handle, 1); 3653dce78009S[email protected] return; 3654dce78009S[email protected] } 3655573897a0SMatthias Ringwald if (connection->bonding_flags & BONDING_SEND_READ_ENCRYPTION_KEY_SIZE){ 3656573897a0SMatthias Ringwald connection->bonding_flags &= ~BONDING_SEND_READ_ENCRYPTION_KEY_SIZE; 3657573897a0SMatthias Ringwald hci_send_cmd(&hci_read_encryption_key_size, connection->con_handle, 1); 3658573897a0SMatthias Ringwald return; 3659573897a0SMatthias Ringwald } 366076f27cffSMatthias Ringwald #endif 366176f27cffSMatthias Ringwald 366276f27cffSMatthias Ringwald if (connection->bonding_flags & BONDING_DISCONNECT_SECURITY_BLOCK){ 366376f27cffSMatthias Ringwald connection->bonding_flags &= ~BONDING_DISCONNECT_SECURITY_BLOCK; 366476f27cffSMatthias Ringwald hci_send_cmd(&hci_disconnect, connection->con_handle, 0x0005); // authentication failure 366576f27cffSMatthias Ringwald return; 366676f27cffSMatthias Ringwald } 3667da886c03S[email protected] 36686cdc2862SMatthias Ringwald #ifdef ENABLE_CLASSIC 3669f8ee3071SMatthias Ringwald uint16_t sniff_min_interval; 3670f8ee3071SMatthias Ringwald switch (connection->sniff_min_interval){ 3671f8ee3071SMatthias Ringwald case 0: 3672f8ee3071SMatthias Ringwald break; 3673f8ee3071SMatthias Ringwald case 0xffff: 3674f8ee3071SMatthias Ringwald connection->sniff_min_interval = 0; 3675f8ee3071SMatthias Ringwald hci_send_cmd(&hci_exit_sniff_mode, connection->con_handle); 3676f8ee3071SMatthias Ringwald return; 3677f8ee3071SMatthias Ringwald default: 3678f8ee3071SMatthias Ringwald sniff_min_interval = connection->sniff_min_interval; 3679f8ee3071SMatthias Ringwald connection->sniff_min_interval = 0; 3680f8ee3071SMatthias Ringwald hci_send_cmd(&hci_sniff_mode, connection->con_handle, connection->sniff_max_interval, sniff_min_interval, connection->sniff_attempt, connection->sniff_timeout); 3681e705510cSMatthias Ringwald return; 3682f8ee3071SMatthias Ringwald } 36836cdc2862SMatthias Ringwald #endif 3684f8ee3071SMatthias Ringwald 3685a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE 368673cd8a2aSMatthias Ringwald switch (connection->le_con_parameter_update_state){ 368773cd8a2aSMatthias Ringwald // response to L2CAP CON PARAMETER UPDATE REQUEST 368873cd8a2aSMatthias Ringwald case CON_PARAMETER_UPDATE_CHANGE_HCI_CON_PARAMETERS: 3689da886c03S[email protected] connection->le_con_parameter_update_state = CON_PARAMETER_UPDATE_NONE; 369073cd8a2aSMatthias Ringwald hci_send_cmd(&hci_le_connection_update, connection->con_handle, connection->le_conn_interval_min, 3691c37a3166S[email protected] connection->le_conn_interval_max, connection->le_conn_latency, connection->le_supervision_timeout, 3692c37a3166S[email protected] 0x0000, 0xffff); 3693e705510cSMatthias Ringwald return; 369473cd8a2aSMatthias Ringwald case CON_PARAMETER_UPDATE_REPLY: 369573cd8a2aSMatthias Ringwald connection->le_con_parameter_update_state = CON_PARAMETER_UPDATE_NONE; 369673cd8a2aSMatthias Ringwald hci_send_cmd(&hci_le_remote_connection_parameter_request_reply, connection->con_handle, connection->le_conn_interval_min, 369773cd8a2aSMatthias Ringwald connection->le_conn_interval_max, connection->le_conn_latency, connection->le_supervision_timeout, 369873cd8a2aSMatthias Ringwald 0x0000, 0xffff); 3699e705510cSMatthias Ringwald return; 370073cd8a2aSMatthias Ringwald case CON_PARAMETER_UPDATE_NEGATIVE_REPLY: 370173cd8a2aSMatthias Ringwald connection->le_con_parameter_update_state = CON_PARAMETER_UPDATE_NONE; 370273cd8a2aSMatthias Ringwald hci_send_cmd(&hci_le_remote_connection_parameter_request_negative_reply, ERROR_CODE_UNSUPPORTED_LMP_PARAMETER_VALUE_UNSUPPORTED_LL_PARAMETER_VALUE); 3703e705510cSMatthias Ringwald return; 370473cd8a2aSMatthias Ringwald default: 370573cd8a2aSMatthias Ringwald break; 3706c37a3166S[email protected] } 3707b90f6e0aSMatthias Ringwald if (connection->le_phy_update_all_phys != 0xff){ 3708b90f6e0aSMatthias Ringwald uint8_t all_phys = connection->le_phy_update_all_phys; 3709b90f6e0aSMatthias Ringwald connection->le_phy_update_all_phys = 0xff; 3710b90f6e0aSMatthias 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); 3711b90f6e0aSMatthias Ringwald return; 3712b90f6e0aSMatthias Ringwald } 3713c37a3166S[email protected] #endif 3714dbe1a790S[email protected] } 3715c7e0c5f6Smatthias.ringwald 371605ae8de3SMatthias Ringwald hci_connection_t * connection; 37173a9fb326S[email protected] switch (hci_stack->state){ 37183429f56bSmatthias.ringwald case HCI_STATE_INITIALIZING: 371974b323a9SMatthias Ringwald hci_initializing_run(); 37203429f56bSmatthias.ringwald break; 3721c7e0c5f6Smatthias.ringwald 3722c7e0c5f6Smatthias.ringwald case HCI_STATE_HALTING: 3723c7e0c5f6Smatthias.ringwald 372426fe9592SMatthias Ringwald log_info("HCI_STATE_HALTING, substate %x\n", hci_stack->substate); 372526fe9592SMatthias Ringwald switch (hci_stack->substate){ 3726beceeddeSMatthias Ringwald case HCI_HALTING_DISCONNECT_ALL_NO_TIMER: 3727beceeddeSMatthias Ringwald case HCI_HALTING_DISCONNECT_ALL_TIMER: 3728beceeddeSMatthias Ringwald 3729a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE 3730d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 3731beceeddeSMatthias Ringwald // free whitelist entries 37329956955bSMatthias Ringwald { 3733665d90f2SMatthias Ringwald btstack_linked_list_iterator_t lit; 3734665d90f2SMatthias Ringwald btstack_linked_list_iterator_init(&lit, &hci_stack->le_whitelist); 3735665d90f2SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&lit)){ 3736665d90f2SMatthias Ringwald whitelist_entry_t * entry = (whitelist_entry_t*) btstack_linked_list_iterator_next(&lit); 3737665d90f2SMatthias Ringwald btstack_linked_list_remove(&hci_stack->le_whitelist, (btstack_linked_item_t *) entry); 37389956955bSMatthias Ringwald btstack_memory_whitelist_entry_free(entry); 37399956955bSMatthias Ringwald } 37409956955bSMatthias Ringwald } 37419956955bSMatthias Ringwald #endif 3742d70217a2SMatthias Ringwald #endif 3743c7e0c5f6Smatthias.ringwald // close all open connections 37443a9fb326S[email protected] connection = (hci_connection_t *) hci_stack->connections; 3745c7e0c5f6Smatthias.ringwald if (connection){ 3746711e6c80SMatthias Ringwald hci_con_handle_t con_handle = (uint16_t) connection->con_handle; 3747d94d3cafS[email protected] if (!hci_can_send_command_packet_now()) return; 374832ab9390Smatthias.ringwald 37498fca890eSMatthias Ringwald // check state 37508fca890eSMatthias Ringwald if (connection->state == SENT_DISCONNECT) return; 37518fca890eSMatthias Ringwald connection->state = SENT_DISCONNECT; 37528fca890eSMatthias Ringwald 37538837e9efSMatthias Ringwald log_info("HCI_STATE_HALTING, connection %p, handle %u", connection, con_handle); 3754c7e0c5f6Smatthias.ringwald 37558837e9efSMatthias Ringwald // cancel all l2cap connections right away instead of waiting for disconnection complete event ... 37568837e9efSMatthias Ringwald hci_emit_disconnection_complete(con_handle, 0x16); // terminated by local host 37578837e9efSMatthias Ringwald 37588837e9efSMatthias Ringwald // ... which would be ignored anyway as we shutdown (free) the connection now 3759c7e0c5f6Smatthias.ringwald hci_shutdown_connection(connection); 37608837e9efSMatthias Ringwald 37618837e9efSMatthias Ringwald // finally, send the disconnect command 37628837e9efSMatthias Ringwald hci_send_cmd(&hci_disconnect, con_handle, 0x13); // remote closed connection 3763c7e0c5f6Smatthias.ringwald return; 3764c7e0c5f6Smatthias.ringwald } 376526fe9592SMatthias Ringwald 3766beceeddeSMatthias Ringwald if (hci_stack->substate == HCI_HALTING_DISCONNECT_ALL_TIMER){ 3767beceeddeSMatthias Ringwald // no connections left, wait a bit to assert that btstack_cyrpto isn't waiting for an HCI event 3768beceeddeSMatthias Ringwald log_info("HCI_STATE_HALTING: wait 50 ms"); 376926fe9592SMatthias Ringwald hci_stack->substate = HCI_HALTING_W4_TIMER; 3770beceeddeSMatthias Ringwald btstack_run_loop_set_timer(&hci_stack->timeout, 50); 377126fe9592SMatthias Ringwald btstack_run_loop_set_timer_handler(&hci_stack->timeout, hci_halting_timeout_handler); 377226fe9592SMatthias Ringwald btstack_run_loop_add_timer(&hci_stack->timeout); 377326fe9592SMatthias Ringwald break; 3774beceeddeSMatthias Ringwald } 377526fe9592SMatthias Ringwald 3776beceeddeSMatthias Ringwald /* explicit fall-through */ 377726fe9592SMatthias Ringwald 377826fe9592SMatthias Ringwald case HCI_HALTING_CLOSE: 37799da54300S[email protected] log_info("HCI_STATE_HALTING, calling off"); 3780c7e0c5f6Smatthias.ringwald 378172ea5239Smatthias.ringwald // switch mode 3782c7e0c5f6Smatthias.ringwald hci_power_control_off(); 37839418f9c9Smatthias.ringwald 37849da54300S[email protected] log_info("HCI_STATE_HALTING, emitting state"); 378572ea5239Smatthias.ringwald hci_emit_state(); 37869da54300S[email protected] log_info("HCI_STATE_HALTING, done"); 378772ea5239Smatthias.ringwald break; 3788beceeddeSMatthias Ringwald 3789beceeddeSMatthias Ringwald case HCI_HALTING_W4_TIMER: 3790beceeddeSMatthias Ringwald // keep waiting 3791beceeddeSMatthias Ringwald 3792beceeddeSMatthias Ringwald break; 379326fe9592SMatthias Ringwald default: 379426fe9592SMatthias Ringwald break; 379526fe9592SMatthias Ringwald } 379626fe9592SMatthias Ringwald 379726fe9592SMatthias Ringwald break; 3798c7e0c5f6Smatthias.ringwald 379972ea5239Smatthias.ringwald case HCI_STATE_FALLING_ASLEEP: 38003a9fb326S[email protected] switch(hci_stack->substate) { 380174b323a9SMatthias Ringwald case HCI_FALLING_ASLEEP_DISCONNECT: 38029da54300S[email protected] log_info("HCI_STATE_FALLING_ASLEEP"); 380372ea5239Smatthias.ringwald // close all open connections 38043a9fb326S[email protected] connection = (hci_connection_t *) hci_stack->connections; 380566da7044Smatthias.ringwald 3806423a3e49SMatthias Ringwald #ifdef HAVE_PLATFORM_IPHONE_OS 380766da7044Smatthias.ringwald // don't close connections, if H4 supports power management 3808d0b87befSMatthias Ringwald if (btstack_control_iphone_power_management_enabled()){ 380966da7044Smatthias.ringwald connection = NULL; 381066da7044Smatthias.ringwald } 381166da7044Smatthias.ringwald #endif 381272ea5239Smatthias.ringwald if (connection){ 381332ab9390Smatthias.ringwald 381472ea5239Smatthias.ringwald // send disconnect 3815d94d3cafS[email protected] if (!hci_can_send_command_packet_now()) return; 381632ab9390Smatthias.ringwald 38179da54300S[email protected] log_info("HCI_STATE_FALLING_ASLEEP, connection %p, handle %u", connection, (uint16_t)connection->con_handle); 38186ad890d3Smatthias.ringwald hci_send_cmd(&hci_disconnect, connection->con_handle, 0x13); // remote closed connection 381972ea5239Smatthias.ringwald 382072ea5239Smatthias.ringwald // send disconnected event right away - causes higher layer connections to get closed, too. 382172ea5239Smatthias.ringwald hci_shutdown_connection(connection); 382272ea5239Smatthias.ringwald return; 382372ea5239Smatthias.ringwald } 382472ea5239Smatthias.ringwald 382592368cd3S[email protected] if (hci_classic_supported()){ 382689db417bSmatthias.ringwald // disable page and inquiry scan 3827d94d3cafS[email protected] if (!hci_can_send_command_packet_now()) return; 382832ab9390Smatthias.ringwald 38299da54300S[email protected] log_info("HCI_STATE_HALTING, disabling inq scans"); 38303a9fb326S[email protected] hci_send_cmd(&hci_write_scan_enable, hci_stack->connectable << 1); // drop inquiry scan but keep page scan 383189db417bSmatthias.ringwald 383289db417bSmatthias.ringwald // continue in next sub state 383374b323a9SMatthias Ringwald hci_stack->substate = HCI_FALLING_ASLEEP_W4_WRITE_SCAN_ENABLE; 383489db417bSmatthias.ringwald break; 383592368cd3S[email protected] } 3836202c8a4cSMatthias Ringwald // no break - fall through for ble-only chips 383792368cd3S[email protected] 383874b323a9SMatthias Ringwald case HCI_FALLING_ASLEEP_COMPLETE: 38399da54300S[email protected] log_info("HCI_STATE_HALTING, calling sleep"); 3840423a3e49SMatthias Ringwald #ifdef HAVE_PLATFORM_IPHONE_OS 384128171530Smatthias.ringwald // don't actually go to sleep, if H4 supports power management 3842d0b87befSMatthias Ringwald if (btstack_control_iphone_power_management_enabled()){ 384328171530Smatthias.ringwald // SLEEP MODE reached 38443a9fb326S[email protected] hci_stack->state = HCI_STATE_SLEEPING; 384528171530Smatthias.ringwald hci_emit_state(); 384628171530Smatthias.ringwald break; 384728171530Smatthias.ringwald } 384828171530Smatthias.ringwald #endif 384972ea5239Smatthias.ringwald // switch mode 38503a9fb326S[email protected] hci_power_control_sleep(); // changes hci_stack->state to SLEEP 3851c7e0c5f6Smatthias.ringwald hci_emit_state(); 385228171530Smatthias.ringwald break; 385328171530Smatthias.ringwald 385489db417bSmatthias.ringwald default: 385589db417bSmatthias.ringwald break; 385689db417bSmatthias.ringwald } 3857c7e0c5f6Smatthias.ringwald break; 3858c7e0c5f6Smatthias.ringwald 38593429f56bSmatthias.ringwald default: 38603429f56bSmatthias.ringwald break; 38611f504dbdSmatthias.ringwald } 38623429f56bSmatthias.ringwald } 386316833f0aSmatthias.ringwald 386431452debSmatthias.ringwald int hci_send_cmd_packet(uint8_t *packet, int size){ 386535454696SMatthias Ringwald // house-keeping 386635454696SMatthias Ringwald 386735454696SMatthias Ringwald if (IS_COMMAND(packet, hci_write_loopback_mode)){ 386835454696SMatthias Ringwald hci_stack->loopback_mode = packet[3]; 386935454696SMatthias Ringwald } 387035454696SMatthias Ringwald 387135454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 3872c8e4258aSmatthias.ringwald bd_addr_t addr; 3873c8e4258aSmatthias.ringwald hci_connection_t * conn; 3874c8e4258aSmatthias.ringwald 3875c8e4258aSmatthias.ringwald // create_connection? 3876c8e4258aSmatthias.ringwald if (IS_COMMAND(packet, hci_create_connection)){ 3877724d70a2SMatthias Ringwald reverse_bd_addr(&packet[3], addr); 38789da54300S[email protected] log_info("Create_connection to %s", bd_addr_to_str(addr)); 3879c8e4258aSmatthias.ringwald 38802e77e513S[email protected] conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_CLASSIC); 3881ad83dc6aS[email protected] if (!conn){ 388296a45072S[email protected] conn = create_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_CLASSIC); 388317f1ba2aSmatthias.ringwald if (!conn){ 388417f1ba2aSmatthias.ringwald // notify client that alloc failed 38852deddeceSMatthias Ringwald hci_emit_connection_complete(addr, 0, BTSTACK_MEMORY_ALLOC_FAILED); 3886f5e5741dSMatthias Ringwald return -1; // packet not sent to controller 388717f1ba2aSmatthias.ringwald } 3888ad83dc6aS[email protected] conn->state = SEND_CREATE_CONNECTION; 3889ad83dc6aS[email protected] } 3890ad83dc6aS[email protected] log_info("conn state %u", conn->state); 3891ad83dc6aS[email protected] switch (conn->state){ 3892ad83dc6aS[email protected] // if connection active exists 3893ad83dc6aS[email protected] case OPEN: 3894f5e5741dSMatthias Ringwald // and OPEN, emit connection complete command 3895274dad91SMatthias Ringwald hci_emit_connection_complete(addr, conn->con_handle, 0); 3896f5e5741dSMatthias Ringwald return -1; // packet not sent to controller 3897ad83dc6aS[email protected] case SEND_CREATE_CONNECTION: 3898532f91a5SMatthias Ringwald // connection created by hci, e.g. dedicated bonding, but not executed yet, let's do it now 3899532f91a5SMatthias Ringwald break; 3900ad83dc6aS[email protected] default: 3901ad83dc6aS[email protected] // otherwise, just ignore as it is already in the open process 3902f5e5741dSMatthias Ringwald return -1; // packet not sent to controller 3903ad83dc6aS[email protected] } 3904c8e4258aSmatthias.ringwald conn->state = SENT_CREATE_CONNECTION; 3905229331c6SMatthias Ringwald 3906229331c6SMatthias Ringwald // track outgoing connection 3907229331c6SMatthias Ringwald hci_stack->outgoing_addr_type = BD_ADDR_TYPE_CLASSIC; 3908229331c6SMatthias Ringwald memcpy(hci_stack->outgoing_addr, addr, 6); 3909c8e4258aSmatthias.ringwald } 391035454696SMatthias Ringwald 39117fde4af9Smatthias.ringwald if (IS_COMMAND(packet, hci_link_key_request_reply)){ 39127fde4af9Smatthias.ringwald hci_add_connection_flags_for_flipped_bd_addr(&packet[3], SENT_LINK_KEY_REPLY); 39137fde4af9Smatthias.ringwald } 39147fde4af9Smatthias.ringwald if (IS_COMMAND(packet, hci_link_key_request_negative_reply)){ 39157fde4af9Smatthias.ringwald hci_add_connection_flags_for_flipped_bd_addr(&packet[3], SENT_LINK_KEY_NEGATIVE_REQUEST); 39167fde4af9Smatthias.ringwald } 39177fde4af9Smatthias.ringwald 39188ef73945Smatthias.ringwald if (IS_COMMAND(packet, hci_delete_stored_link_key)){ 3919a98592bcSMatthias Ringwald if (hci_stack->link_key_db){ 3920724d70a2SMatthias Ringwald reverse_bd_addr(&packet[3], addr); 3921a98592bcSMatthias Ringwald hci_stack->link_key_db->delete_link_key(addr); 39228ef73945Smatthias.ringwald } 39238ef73945Smatthias.ringwald } 3924c8e4258aSmatthias.ringwald 39256724cd9eS[email protected] if (IS_COMMAND(packet, hci_pin_code_request_negative_reply) 39266724cd9eS[email protected] || IS_COMMAND(packet, hci_pin_code_request_reply)){ 3927724d70a2SMatthias Ringwald reverse_bd_addr(&packet[3], addr); 39282e77e513S[email protected] conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_CLASSIC); 39296724cd9eS[email protected] if (conn){ 39306724cd9eS[email protected] connectionClearAuthenticationFlags(conn, LEGACY_PAIRING_ACTIVE); 39316724cd9eS[email protected] } 39326724cd9eS[email protected] } 39336724cd9eS[email protected] 39346724cd9eS[email protected] if (IS_COMMAND(packet, hci_user_confirmation_request_negative_reply) 39356724cd9eS[email protected] || IS_COMMAND(packet, hci_user_confirmation_request_reply) 39366724cd9eS[email protected] || IS_COMMAND(packet, hci_user_passkey_request_negative_reply) 39376724cd9eS[email protected] || IS_COMMAND(packet, hci_user_passkey_request_reply)) { 3938724d70a2SMatthias Ringwald reverse_bd_addr(&packet[3], addr); 39392e77e513S[email protected] conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_CLASSIC); 39406724cd9eS[email protected] if (conn){ 39416724cd9eS[email protected] connectionClearAuthenticationFlags(conn, SSP_PAIRING_ACTIVE); 39426724cd9eS[email protected] } 39436724cd9eS[email protected] } 3944ee752bb8SMatthias Ringwald 3945ee752bb8SMatthias Ringwald #ifdef ENABLE_SCO_OVER_HCI 3946ee752bb8SMatthias Ringwald // setup_synchronous_connection? Voice setting at offset 22 3947ee752bb8SMatthias Ringwald if (IS_COMMAND(packet, hci_setup_synchronous_connection)){ 3948ee752bb8SMatthias Ringwald // TODO: compare to current setting if sco connection already active 3949ee752bb8SMatthias Ringwald hci_stack->sco_voice_setting_active = little_endian_read_16(packet, 15); 3950ee752bb8SMatthias Ringwald } 3951ee752bb8SMatthias Ringwald // accept_synchronus_connection? Voice setting at offset 18 3952ee752bb8SMatthias Ringwald if (IS_COMMAND(packet, hci_accept_synchronous_connection)){ 3953ee752bb8SMatthias Ringwald // TODO: compare to current setting if sco connection already active 3954ee752bb8SMatthias Ringwald hci_stack->sco_voice_setting_active = little_endian_read_16(packet, 19); 3955ee752bb8SMatthias Ringwald } 3956ee752bb8SMatthias Ringwald #endif 395735454696SMatthias Ringwald #endif 39584b3e1e19SMatthias Ringwald 3959a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE 3960d70217a2SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 396169a97523S[email protected] if (IS_COMMAND(packet, hci_le_set_random_address)){ 3962b95a5a35SMatthias Ringwald hci_stack->le_random_address_set = 1; 3963b95a5a35SMatthias Ringwald reverse_bd_addr(&packet[3], hci_stack->le_random_address); 3964d70217a2SMatthias Ringwald } 3965171293d3SMatthias Ringwald if (IS_COMMAND(packet, hci_le_set_advertise_enable)){ 3966171293d3SMatthias Ringwald hci_stack->le_advertisements_active = packet[3]; 3967171293d3SMatthias Ringwald } 3968d70217a2SMatthias Ringwald #endif 3969d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 3970b04dfa37SMatthias Ringwald if (IS_COMMAND(packet, hci_le_create_connection)){ 3971b04dfa37SMatthias Ringwald // white list used? 3972b04dfa37SMatthias Ringwald uint8_t initiator_filter_policy = packet[7]; 3973b04dfa37SMatthias Ringwald switch (initiator_filter_policy){ 3974b04dfa37SMatthias Ringwald case 0: 3975b04dfa37SMatthias Ringwald // whitelist not used 3976b04dfa37SMatthias Ringwald hci_stack->le_connecting_state = LE_CONNECTING_DIRECT; 3977b04dfa37SMatthias Ringwald break; 3978b04dfa37SMatthias Ringwald case 1: 3979b04dfa37SMatthias Ringwald hci_stack->le_connecting_state = LE_CONNECTING_WHITELIST; 3980b04dfa37SMatthias Ringwald break; 3981b04dfa37SMatthias Ringwald default: 3982b04dfa37SMatthias Ringwald log_error("Invalid initiator_filter_policy in LE Create Connection %u", initiator_filter_policy); 3983b04dfa37SMatthias Ringwald break; 3984b04dfa37SMatthias Ringwald } 3985b04dfa37SMatthias Ringwald } 3986b04dfa37SMatthias Ringwald if (IS_COMMAND(packet, hci_le_create_connection_cancel)){ 3987b04dfa37SMatthias Ringwald hci_stack->le_connecting_state = LE_CONNECTING_IDLE; 3988b04dfa37SMatthias Ringwald } 398969a97523S[email protected] #endif 3990d70217a2SMatthias Ringwald #endif 399169a97523S[email protected] 39923a9fb326S[email protected] hci_stack->num_cmd_packets--; 39935bb5bc3eS[email protected] 39945bb5bc3eS[email protected] hci_dump_packet(HCI_COMMAND_DATA_PACKET, 0, packet, size); 3995bfea0222SMatthias Ringwald return hci_stack->hci_transport->send_packet(HCI_COMMAND_DATA_PACKET, packet, size); 399631452debSmatthias.ringwald } 39978adf0ddaSmatthias.ringwald 39982bd8b7e7S[email protected] // disconnect because of security block 39992bd8b7e7S[email protected] void hci_disconnect_security_block(hci_con_handle_t con_handle){ 40002bd8b7e7S[email protected] hci_connection_t * connection = hci_connection_for_handle(con_handle); 40012bd8b7e7S[email protected] if (!connection) return; 40022bd8b7e7S[email protected] connection->bonding_flags |= BONDING_DISCONNECT_SECURITY_BLOCK; 40032bd8b7e7S[email protected] } 40042bd8b7e7S[email protected] 40052bd8b7e7S[email protected] 4006dbe1a790S[email protected] // Configure Secure Simple Pairing 4007dbe1a790S[email protected] 400835454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 400935454696SMatthias Ringwald 4010dbe1a790S[email protected] // enable will enable SSP during init 401115a95bd5SMatthias Ringwald void gap_ssp_set_enable(int enable){ 40123a9fb326S[email protected] hci_stack->ssp_enable = enable; 4013dbe1a790S[email protected] } 4014dbe1a790S[email protected] 401595d71764SMatthias Ringwald static int hci_local_ssp_activated(void){ 401615a95bd5SMatthias Ringwald return gap_ssp_supported() && hci_stack->ssp_enable; 40172bd8b7e7S[email protected] } 40182bd8b7e7S[email protected] 4019dbe1a790S[email protected] // if set, BTstack will respond to io capability request using authentication requirement 402015a95bd5SMatthias Ringwald void gap_ssp_set_io_capability(int io_capability){ 40213a9fb326S[email protected] hci_stack->ssp_io_capability = io_capability; 4022dbe1a790S[email protected] } 402315a95bd5SMatthias Ringwald void gap_ssp_set_authentication_requirement(int authentication_requirement){ 40243a9fb326S[email protected] hci_stack->ssp_authentication_requirement = authentication_requirement; 4025dbe1a790S[email protected] } 4026dbe1a790S[email protected] 4027dbe1a790S[email protected] // if set, BTstack will confirm a numberic comparion and enter '000000' if requested 402815a95bd5SMatthias Ringwald void gap_ssp_set_auto_accept(int auto_accept){ 40293a9fb326S[email protected] hci_stack->ssp_auto_accept = auto_accept; 4030dbe1a790S[email protected] } 403135454696SMatthias Ringwald #endif 4032dbe1a790S[email protected] 403394be1a66SMatthias Ringwald // va_list part of hci_send_cmd 403494be1a66SMatthias Ringwald int hci_send_cmd_va_arg(const hci_cmd_t *cmd, va_list argptr){ 4035d94d3cafS[email protected] if (!hci_can_send_command_packet_now()){ 40369d14b626S[email protected] log_error("hci_send_cmd called but cannot send packet now"); 40379d14b626S[email protected] return 0; 40389d14b626S[email protected] } 40399d14b626S[email protected] 40405127cc62S[email protected] // for HCI INITIALIZATION 40419da54300S[email protected] // log_info("hci_send_cmd: opcode %04x", cmd->opcode); 40425127cc62S[email protected] hci_stack->last_cmd_opcode = cmd->opcode; 40435127cc62S[email protected] 40449d14b626S[email protected] hci_reserve_packet_buffer(); 40459d14b626S[email protected] uint8_t * packet = hci_stack->hci_packet_buffer; 404694be1a66SMatthias Ringwald uint16_t size = hci_cmd_create_from_template(packet, cmd, argptr); 4047bfea0222SMatthias Ringwald int err = hci_send_cmd_packet(packet, size); 4048bfea0222SMatthias Ringwald 4049bfea0222SMatthias Ringwald // release packet buffer for synchronous transport implementations 4050bfea0222SMatthias Ringwald if (hci_transport_synchronous()){ 4051e2d22487SMatthias Ringwald hci_release_packet_buffer(); 4052068b8592SMatthias Ringwald hci_emit_transport_packet_sent(); 4053bfea0222SMatthias Ringwald } 4054bfea0222SMatthias Ringwald 4055bfea0222SMatthias Ringwald return err; 405694be1a66SMatthias Ringwald } 40579d14b626S[email protected] 405894be1a66SMatthias Ringwald /** 405994be1a66SMatthias Ringwald * pre: numcmds >= 0 - it's allowed to send a command to the controller 406094be1a66SMatthias Ringwald */ 406194be1a66SMatthias Ringwald int hci_send_cmd(const hci_cmd_t *cmd, ...){ 40621cd208adSmatthias.ringwald va_list argptr; 40631cd208adSmatthias.ringwald va_start(argptr, cmd); 406494be1a66SMatthias Ringwald int res = hci_send_cmd_va_arg(cmd, argptr); 40651cd208adSmatthias.ringwald va_end(argptr); 406694be1a66SMatthias Ringwald return res; 406793b8dc03Smatthias.ringwald } 4068c8e4258aSmatthias.ringwald 4069ee091cf1Smatthias.ringwald // Create various non-HCI events. 4070ee091cf1Smatthias.ringwald // TODO: generalize, use table similar to hci_create_command 4071ee091cf1Smatthias.ringwald 4072d6b06661SMatthias Ringwald static void hci_emit_event(uint8_t * event, uint16_t size, int dump){ 4073fb37a842SMatthias Ringwald // dump packet 4074d6b06661SMatthias Ringwald if (dump) { 4075300c1ba4SMatthias Ringwald hci_dump_packet( HCI_EVENT_PACKET, 0, event, size); 4076d6b06661SMatthias Ringwald } 40771ef6bb52SMatthias Ringwald 4078fb37a842SMatthias Ringwald // dispatch to all event handlers 40791ef6bb52SMatthias Ringwald btstack_linked_list_iterator_t it; 40801ef6bb52SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->event_handlers); 40811ef6bb52SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 40821ef6bb52SMatthias Ringwald btstack_packet_callback_registration_t * entry = (btstack_packet_callback_registration_t*) btstack_linked_list_iterator_next(&it); 4083d9a7306aSMatthias Ringwald entry->callback(HCI_EVENT_PACKET, 0, event, size); 40841ef6bb52SMatthias Ringwald } 4085d6b06661SMatthias Ringwald } 4086d6b06661SMatthias Ringwald 4087d6b06661SMatthias Ringwald static void hci_emit_acl_packet(uint8_t * packet, uint16_t size){ 4088fb37a842SMatthias Ringwald if (!hci_stack->acl_packet_handler) return; 40893d50b4baSMatthias Ringwald hci_stack->acl_packet_handler(HCI_ACL_DATA_PACKET, 0, packet, size); 4090d6b06661SMatthias Ringwald } 4091d6b06661SMatthias Ringwald 409235454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 4093701e3307SMatthias Ringwald static void hci_notify_if_sco_can_send_now(void){ 40943bc639ceSMatthias Ringwald // notify SCO sender if waiting 4095701e3307SMatthias Ringwald if (!hci_stack->sco_waiting_for_can_send_now) return; 4096701e3307SMatthias Ringwald if (hci_can_send_sco_packet_now()){ 40973bc639ceSMatthias Ringwald hci_stack->sco_waiting_for_can_send_now = 0; 4098701e3307SMatthias Ringwald uint8_t event[2] = { HCI_EVENT_SCO_CAN_SEND_NOW, 0 }; 4099701e3307SMatthias Ringwald hci_dump_packet(HCI_EVENT_PACKET, 1, event, sizeof(event)); 41003d50b4baSMatthias Ringwald hci_stack->sco_packet_handler(HCI_EVENT_PACKET, 0, event, sizeof(event)); 41013bc639ceSMatthias Ringwald } 41023bc639ceSMatthias Ringwald } 41031cfb383eSMatthias Ringwald 41041cfb383eSMatthias Ringwald // parsing end emitting has been merged to reduce code size 41051cfb383eSMatthias Ringwald static void gap_inquiry_explode(uint8_t * packet){ 4106e4f5dd75SMatthias Ringwald uint8_t event[19+GAP_INQUIRY_MAX_NAME_LEN]; 41071cfb383eSMatthias Ringwald 41081cfb383eSMatthias Ringwald uint8_t * eir_data; 41091cfb383eSMatthias Ringwald ad_context_t context; 41101cfb383eSMatthias Ringwald const uint8_t * name; 41111cfb383eSMatthias Ringwald uint8_t name_len; 41121cfb383eSMatthias Ringwald 41131cfb383eSMatthias Ringwald int event_type = hci_event_packet_get_type(packet); 41141cfb383eSMatthias Ringwald int num_reserved_fields = event_type == HCI_EVENT_INQUIRY_RESULT ? 2 : 1; // 2 for old event, 1 otherwise 41151cfb383eSMatthias Ringwald int num_responses = hci_event_inquiry_result_get_num_responses(packet); 41161cfb383eSMatthias Ringwald 41171cfb383eSMatthias Ringwald // event[1] is set at the end 41181cfb383eSMatthias Ringwald int i; 41191cfb383eSMatthias Ringwald for (i=0; i<num_responses;i++){ 41201cfb383eSMatthias Ringwald memset(event, 0, sizeof(event)); 41211cfb383eSMatthias Ringwald event[0] = GAP_EVENT_INQUIRY_RESULT; 41221cfb383eSMatthias Ringwald uint8_t event_size = 18; // if name is not set by EIR 41231cfb383eSMatthias Ringwald 41241cfb383eSMatthias Ringwald memcpy(&event[2], &packet[3 + i*6], 6); // bd_addr 41251cfb383eSMatthias Ringwald event[8] = packet[3 + num_responses*(6) + i*1]; // page_scan_repetition_mode 41261cfb383eSMatthias Ringwald memcpy(&event[9], &packet[3 + num_responses*(6+1+num_reserved_fields) + i*3], 3); // class of device 41271cfb383eSMatthias Ringwald memcpy(&event[12], &packet[3 + num_responses*(6+1+num_reserved_fields+3) + i*2], 2); // clock offset 41281cfb383eSMatthias Ringwald 41291cfb383eSMatthias Ringwald switch (event_type){ 41301cfb383eSMatthias Ringwald case HCI_EVENT_INQUIRY_RESULT: 41311cfb383eSMatthias Ringwald // 14,15,16,17 = 0, size 18 41321cfb383eSMatthias Ringwald break; 41331cfb383eSMatthias Ringwald case HCI_EVENT_INQUIRY_RESULT_WITH_RSSI: 41341cfb383eSMatthias Ringwald event[14] = 1; 41351cfb383eSMatthias Ringwald event[15] = packet [3 + num_responses*(6+1+num_reserved_fields+3+2) + i*1]; // rssi 41361cfb383eSMatthias Ringwald // 16,17 = 0, size 18 41371cfb383eSMatthias Ringwald break; 41381cfb383eSMatthias Ringwald case HCI_EVENT_EXTENDED_INQUIRY_RESPONSE: 41391cfb383eSMatthias Ringwald event[14] = 1; 41401cfb383eSMatthias Ringwald event[15] = packet [3 + num_responses*(6+1+num_reserved_fields+3+2) + i*1]; // rssi 41411cfb383eSMatthias Ringwald // for EIR packets, there is only one reponse in it 41421cfb383eSMatthias Ringwald eir_data = &packet[3 + (6+1+num_reserved_fields+3+2+1)]; 41431cfb383eSMatthias Ringwald name = NULL; 41441cfb383eSMatthias Ringwald // EIR data is 240 bytes in EIR event 41451cfb383eSMatthias Ringwald for (ad_iterator_init(&context, 240, eir_data) ; ad_iterator_has_more(&context) ; ad_iterator_next(&context)){ 41461cfb383eSMatthias Ringwald uint8_t data_type = ad_iterator_get_data_type(&context); 41471cfb383eSMatthias Ringwald uint8_t data_size = ad_iterator_get_data_len(&context); 41481cfb383eSMatthias Ringwald const uint8_t * data = ad_iterator_get_data(&context); 41491cfb383eSMatthias Ringwald // Prefer Complete Local Name over Shortend Local Name 41501cfb383eSMatthias Ringwald switch (data_type){ 41511cfb383eSMatthias Ringwald case BLUETOOTH_DATA_TYPE_SHORTENED_LOCAL_NAME: 41521cfb383eSMatthias Ringwald if (name) continue; 41531cfb383eSMatthias Ringwald /* explicit fall-through */ 41541cfb383eSMatthias Ringwald case BLUETOOTH_DATA_TYPE_COMPLETE_LOCAL_NAME: 41551cfb383eSMatthias Ringwald name = data; 41561cfb383eSMatthias Ringwald name_len = data_size; 41571cfb383eSMatthias Ringwald break; 41581cfb383eSMatthias Ringwald default: 41591cfb383eSMatthias Ringwald break; 41601cfb383eSMatthias Ringwald } 41611cfb383eSMatthias Ringwald } 41621cfb383eSMatthias Ringwald if (name){ 41631cfb383eSMatthias Ringwald event[16] = 1; 41641cfb383eSMatthias Ringwald // truncate name if needed 41651cfb383eSMatthias Ringwald int len = btstack_min(name_len, GAP_INQUIRY_MAX_NAME_LEN); 41661cfb383eSMatthias Ringwald event[17] = len; 41671cfb383eSMatthias Ringwald memcpy(&event[18], name, len); 41681cfb383eSMatthias Ringwald event_size += len; 41691cfb383eSMatthias Ringwald } 41701cfb383eSMatthias Ringwald break; 41711cfb383eSMatthias Ringwald } 41721cfb383eSMatthias Ringwald event[1] = event_size - 2; 41731cfb383eSMatthias Ringwald hci_emit_event(event, event_size, 1); 41741cfb383eSMatthias Ringwald } 41751cfb383eSMatthias Ringwald } 417635454696SMatthias Ringwald #endif 41773bc639ceSMatthias Ringwald 417871de195eSMatthias Ringwald void hci_emit_state(void){ 41793a9fb326S[email protected] log_info("BTSTACK_EVENT_STATE %u", hci_stack->state); 4180425d1371Smatthias.ringwald uint8_t event[3]; 418180d52d6bSmatthias.ringwald event[0] = BTSTACK_EVENT_STATE; 4182425d1371Smatthias.ringwald event[1] = sizeof(event) - 2; 41833a9fb326S[email protected] event[2] = hci_stack->state; 4184d6b06661SMatthias Ringwald hci_emit_event(event, sizeof(event), 1); 4185c8e4258aSmatthias.ringwald } 4186c8e4258aSmatthias.ringwald 418735454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 41882deddeceSMatthias Ringwald static void hci_emit_connection_complete(bd_addr_t address, hci_con_handle_t con_handle, uint8_t status){ 4189425d1371Smatthias.ringwald uint8_t event[13]; 4190c8e4258aSmatthias.ringwald event[0] = HCI_EVENT_CONNECTION_COMPLETE; 4191425d1371Smatthias.ringwald event[1] = sizeof(event) - 2; 419217f1ba2aSmatthias.ringwald event[2] = status; 41932deddeceSMatthias Ringwald little_endian_store_16(event, 3, con_handle); 41942deddeceSMatthias Ringwald reverse_bd_addr(address, &event[5]); 4195c8e4258aSmatthias.ringwald event[11] = 1; // ACL connection 4196c8e4258aSmatthias.ringwald event[12] = 0; // encryption disabled 4197d6b06661SMatthias Ringwald hci_emit_event(event, sizeof(event), 1); 4198c8e4258aSmatthias.ringwald } 419952db98b2SMatthias Ringwald static void hci_emit_l2cap_check_timeout(hci_connection_t *conn){ 420052db98b2SMatthias Ringwald if (disable_l2cap_timeouts) return; 420152db98b2SMatthias Ringwald log_info("L2CAP_EVENT_TIMEOUT_CHECK"); 420252db98b2SMatthias Ringwald uint8_t event[4]; 420352db98b2SMatthias Ringwald event[0] = L2CAP_EVENT_TIMEOUT_CHECK; 420452db98b2SMatthias Ringwald event[1] = sizeof(event) - 2; 420552db98b2SMatthias Ringwald little_endian_store_16(event, 2, conn->con_handle); 420652db98b2SMatthias Ringwald hci_emit_event(event, sizeof(event), 1); 420752db98b2SMatthias Ringwald } 420835454696SMatthias Ringwald #endif 4209c8e4258aSmatthias.ringwald 421035454696SMatthias Ringwald #ifdef ENABLE_BLE 4211d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 4212fc64f94aSMatthias Ringwald static void hci_emit_le_connection_complete(uint8_t address_type, bd_addr_t address, hci_con_handle_t con_handle, uint8_t status){ 42134f3229d8S[email protected] uint8_t event[21]; 42144f3229d8S[email protected] event[0] = HCI_EVENT_LE_META; 42154f3229d8S[email protected] event[1] = sizeof(event) - 2; 42164f3229d8S[email protected] event[2] = HCI_SUBEVENT_LE_CONNECTION_COMPLETE; 42174f3229d8S[email protected] event[3] = status; 4218fc64f94aSMatthias Ringwald little_endian_store_16(event, 4, con_handle); 42194f3229d8S[email protected] event[6] = 0; // TODO: role 42206e2e9a6bS[email protected] event[7] = address_type; 4221724d70a2SMatthias Ringwald reverse_bd_addr(address, &event[8]); 4222f8fbdce0SMatthias Ringwald little_endian_store_16(event, 14, 0); // interval 4223f8fbdce0SMatthias Ringwald little_endian_store_16(event, 16, 0); // latency 4224f8fbdce0SMatthias Ringwald little_endian_store_16(event, 18, 0); // supervision timeout 42254f3229d8S[email protected] event[20] = 0; // master clock accuracy 4226d6b06661SMatthias Ringwald hci_emit_event(event, sizeof(event), 1); 42274f3229d8S[email protected] } 422835454696SMatthias Ringwald #endif 4229d70217a2SMatthias Ringwald #endif 42304f3229d8S[email protected] 4231fd43c0e0SMatthias Ringwald static void hci_emit_transport_packet_sent(void){ 4232fd43c0e0SMatthias Ringwald // notify upper stack that it might be possible to send again 4233fd43c0e0SMatthias Ringwald uint8_t event[] = { HCI_EVENT_TRANSPORT_PACKET_SENT, 0}; 4234fd43c0e0SMatthias Ringwald hci_emit_event(&event[0], sizeof(event), 0); // don't dump 4235fd43c0e0SMatthias Ringwald } 4236fd43c0e0SMatthias Ringwald 4237fc64f94aSMatthias Ringwald static void hci_emit_disconnection_complete(hci_con_handle_t con_handle, uint8_t reason){ 4238425d1371Smatthias.ringwald uint8_t event[6]; 42393c4d4b90Smatthias.ringwald event[0] = HCI_EVENT_DISCONNECTION_COMPLETE; 4240e518c4b8Smatthias.ringwald event[1] = sizeof(event) - 2; 42413c4d4b90Smatthias.ringwald event[2] = 0; // status = OK 4242fc64f94aSMatthias Ringwald little_endian_store_16(event, 3, con_handle); 42433c4d4b90Smatthias.ringwald event[5] = reason; 4244d6b06661SMatthias Ringwald hci_emit_event(event, sizeof(event), 1); 42453c4d4b90Smatthias.ringwald } 42463c4d4b90Smatthias.ringwald 4247b83d5eabSMatthias Ringwald static void hci_emit_nr_connections_changed(void){ 4248e0abb8e7S[email protected] log_info("BTSTACK_EVENT_NR_CONNECTIONS_CHANGED %u", nr_hci_connections()); 4249425d1371Smatthias.ringwald uint8_t event[3]; 425080d52d6bSmatthias.ringwald event[0] = BTSTACK_EVENT_NR_CONNECTIONS_CHANGED; 4251425d1371Smatthias.ringwald event[1] = sizeof(event) - 2; 425243bfb1bdSmatthias.ringwald event[2] = nr_hci_connections(); 4253d6b06661SMatthias Ringwald hci_emit_event(event, sizeof(event), 1); 425443bfb1bdSmatthias.ringwald } 4255038bc64cSmatthias.ringwald 4256b83d5eabSMatthias Ringwald static void hci_emit_hci_open_failed(void){ 4257e0abb8e7S[email protected] log_info("BTSTACK_EVENT_POWERON_FAILED"); 4258425d1371Smatthias.ringwald uint8_t event[2]; 425980d52d6bSmatthias.ringwald event[0] = BTSTACK_EVENT_POWERON_FAILED; 4260425d1371Smatthias.ringwald event[1] = sizeof(event) - 2; 4261d6b06661SMatthias Ringwald hci_emit_event(event, sizeof(event), 1); 4262038bc64cSmatthias.ringwald } 42631b0e3922Smatthias.ringwald 426435454696SMatthias Ringwald static void hci_emit_dedicated_bonding_result(bd_addr_t address, uint8_t status){ 426535454696SMatthias Ringwald log_info("hci_emit_dedicated_bonding_result %u ", status); 426635454696SMatthias Ringwald uint8_t event[9]; 426735454696SMatthias Ringwald int pos = 0; 426835454696SMatthias Ringwald event[pos++] = GAP_EVENT_DEDICATED_BONDING_COMPLETED; 426935454696SMatthias Ringwald event[pos++] = sizeof(event) - 2; 427035454696SMatthias Ringwald event[pos++] = status; 427135454696SMatthias Ringwald reverse_bd_addr(address, &event[pos]); 4272d6b06661SMatthias Ringwald hci_emit_event(event, sizeof(event), 1); 4273381fbed8Smatthias.ringwald } 4274458bf4e8S[email protected] 427535454696SMatthias Ringwald 427635454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 427735454696SMatthias Ringwald 4278b83d5eabSMatthias Ringwald static void hci_emit_security_level(hci_con_handle_t con_handle, gap_security_level_t level){ 4279df3354fcS[email protected] log_info("hci_emit_security_level %u for handle %x", level, con_handle); 4280a00031e2S[email protected] uint8_t event[5]; 4281e00caf9cS[email protected] int pos = 0; 42825611a760SMatthias Ringwald event[pos++] = GAP_EVENT_SECURITY_LEVEL; 4283e00caf9cS[email protected] event[pos++] = sizeof(event) - 2; 4284f8fbdce0SMatthias Ringwald little_endian_store_16(event, 2, con_handle); 4285e00caf9cS[email protected] pos += 2; 4286e00caf9cS[email protected] event[pos++] = level; 4287d6b06661SMatthias Ringwald hci_emit_event(event, sizeof(event), 1); 4288e00caf9cS[email protected] } 4289e00caf9cS[email protected] 429035454696SMatthias Ringwald static gap_security_level_t gap_security_level_for_connection(hci_connection_t * connection){ 429135454696SMatthias Ringwald if (!connection) return LEVEL_0; 429235454696SMatthias Ringwald if ((connection->authentication_flags & CONNECTION_ENCRYPTED) == 0) return LEVEL_0; 4293170fafaeSMatthias Ringwald if (connection->encryption_key_size < hci_stack->gap_required_encyrption_key_size) return LEVEL_0; 42944051b7ffSMatthias Ringwald gap_security_level_t security_level = gap_security_level_for_link_key_type(connection->link_key_type); 4295170fafaeSMatthias Ringwald // LEVEL 4 always requires 128 bit encrytion key size 4296170fafaeSMatthias Ringwald if (security_level == LEVEL_4 && connection->encryption_key_size < 16){ 4297170fafaeSMatthias Ringwald security_level = LEVEL_3; 4298170fafaeSMatthias Ringwald } 4299170fafaeSMatthias Ringwald return security_level; 430035454696SMatthias Ringwald } 430135454696SMatthias Ringwald 430235454696SMatthias Ringwald static void hci_emit_discoverable_enabled(uint8_t enabled){ 430335454696SMatthias Ringwald log_info("BTSTACK_EVENT_DISCOVERABLE_ENABLED %u", enabled); 430435454696SMatthias Ringwald uint8_t event[3]; 430535454696SMatthias Ringwald event[0] = BTSTACK_EVENT_DISCOVERABLE_ENABLED; 430635454696SMatthias Ringwald event[1] = sizeof(event) - 2; 430735454696SMatthias Ringwald event[2] = enabled; 4308d6b06661SMatthias Ringwald hci_emit_event(event, sizeof(event), 1); 4309ad83dc6aS[email protected] } 4310ad83dc6aS[email protected] 431198a2fd1cSMatthias Ringwald // query if remote side supports eSCO 4312073bd0faSMatthias Ringwald int hci_remote_esco_supported(hci_con_handle_t con_handle){ 431398a2fd1cSMatthias Ringwald hci_connection_t * connection = hci_connection_for_handle(con_handle); 431498a2fd1cSMatthias Ringwald if (!connection) return 0; 431598a2fd1cSMatthias Ringwald return connection->remote_supported_feature_eSCO; 431698a2fd1cSMatthias Ringwald } 431798a2fd1cSMatthias Ringwald 43182bd8b7e7S[email protected] // query if remote side supports SSP 43192bd8b7e7S[email protected] int hci_remote_ssp_supported(hci_con_handle_t con_handle){ 43202bd8b7e7S[email protected] hci_connection_t * connection = hci_connection_for_handle(con_handle); 43212bd8b7e7S[email protected] if (!connection) return 0; 43222bd8b7e7S[email protected] return (connection->bonding_flags & BONDING_REMOTE_SUPPORTS_SSP) ? 1 : 0; 43232bd8b7e7S[email protected] } 43242bd8b7e7S[email protected] 432515a95bd5SMatthias Ringwald int gap_ssp_supported_on_both_sides(hci_con_handle_t handle){ 4326df3354fcS[email protected] return hci_local_ssp_activated() && hci_remote_ssp_supported(handle); 4327df3354fcS[email protected] } 4328df3354fcS[email protected] 4329458bf4e8S[email protected] // GAP API 4330458bf4e8S[email protected] /** 4331458bf4e8S[email protected] * @bbrief enable/disable bonding. default is enabled 4332458bf4e8S[email protected] * @praram enabled 4333458bf4e8S[email protected] */ 43344c57c146S[email protected] void gap_set_bondable_mode(int enable){ 43353a9fb326S[email protected] hci_stack->bondable = enable ? 1 : 0; 4336458bf4e8S[email protected] } 43374ef6443cSMatthias Ringwald /** 43384ef6443cSMatthias Ringwald * @brief Get bondable mode. 43394ef6443cSMatthias Ringwald * @return 1 if bondable 43404ef6443cSMatthias Ringwald */ 43414ef6443cSMatthias Ringwald int gap_get_bondable_mode(void){ 43424ef6443cSMatthias Ringwald return hci_stack->bondable; 43434ef6443cSMatthias Ringwald } 4344cb230b9dS[email protected] 4345cb230b9dS[email protected] /** 434634d2123cS[email protected] * @brief map link keys to security levels 4347cb230b9dS[email protected] */ 434834d2123cS[email protected] gap_security_level_t gap_security_level_for_link_key_type(link_key_type_t link_key_type){ 434934d2123cS[email protected] switch (link_key_type){ 43503c68dfa9S[email protected] case AUTHENTICATED_COMBINATION_KEY_GENERATED_FROM_P256: 43513c68dfa9S[email protected] return LEVEL_4; 43523c68dfa9S[email protected] case COMBINATION_KEY: 43533c68dfa9S[email protected] case AUTHENTICATED_COMBINATION_KEY_GENERATED_FROM_P192: 43543c68dfa9S[email protected] return LEVEL_3; 43553c68dfa9S[email protected] default: 43563c68dfa9S[email protected] return LEVEL_2; 43573c68dfa9S[email protected] } 4358cb230b9dS[email protected] } 4359cb230b9dS[email protected] 43608b35e16aSMatthias Ringwald /** 43618b35e16aSMatthias Ringwald * @brief map link keys to secure connection yes/no 43628b35e16aSMatthias Ringwald */ 43638b35e16aSMatthias Ringwald int gap_secure_connection_for_link_key_type(link_key_type_t link_key_type){ 43648b35e16aSMatthias Ringwald switch (link_key_type){ 43658b35e16aSMatthias Ringwald case AUTHENTICATED_COMBINATION_KEY_GENERATED_FROM_P256: 43668b35e16aSMatthias Ringwald case UNAUTHENTICATED_COMBINATION_KEY_GENERATED_FROM_P256: 43678b35e16aSMatthias Ringwald return 1; 43688b35e16aSMatthias Ringwald default: 43698b35e16aSMatthias Ringwald return 0; 43708b35e16aSMatthias Ringwald } 43718b35e16aSMatthias Ringwald } 43728b35e16aSMatthias Ringwald 43738b35e16aSMatthias Ringwald /** 43748b35e16aSMatthias Ringwald * @brief map link keys to authenticated 43758b35e16aSMatthias Ringwald */ 43768b35e16aSMatthias Ringwald int gap_authenticated_for_link_key_type(link_key_type_t link_key_type){ 43778b35e16aSMatthias Ringwald switch (link_key_type){ 43788b35e16aSMatthias Ringwald case AUTHENTICATED_COMBINATION_KEY_GENERATED_FROM_P256: 43798b35e16aSMatthias Ringwald case AUTHENTICATED_COMBINATION_KEY_GENERATED_FROM_P192: 43808b35e16aSMatthias Ringwald return 1; 43818b35e16aSMatthias Ringwald default: 43828b35e16aSMatthias Ringwald return 0; 43838b35e16aSMatthias Ringwald } 43848b35e16aSMatthias Ringwald } 43858b35e16aSMatthias Ringwald 4386106d6d11S[email protected] int gap_mitm_protection_required_for_security_level(gap_security_level_t level){ 43875127cc62S[email protected] log_info("gap_mitm_protection_required_for_security_level %u", level); 4388106d6d11S[email protected] return level > LEVEL_2; 4389106d6d11S[email protected] } 4390106d6d11S[email protected] 439134d2123cS[email protected] /** 439234d2123cS[email protected] * @brief get current security level 439334d2123cS[email protected] */ 439434d2123cS[email protected] gap_security_level_t gap_security_level(hci_con_handle_t con_handle){ 439534d2123cS[email protected] hci_connection_t * connection = hci_connection_for_handle(con_handle); 439634d2123cS[email protected] if (!connection) return LEVEL_0; 439734d2123cS[email protected] return gap_security_level_for_connection(connection); 439834d2123cS[email protected] } 439934d2123cS[email protected] 4400cb230b9dS[email protected] /** 4401cb230b9dS[email protected] * @brief request connection to device to 4402cb230b9dS[email protected] * @result GAP_AUTHENTICATION_RESULT 4403cb230b9dS[email protected] */ 440434d2123cS[email protected] void gap_request_security_level(hci_con_handle_t con_handle, gap_security_level_t requested_level){ 440534d2123cS[email protected] hci_connection_t * connection = hci_connection_for_handle(con_handle); 440634d2123cS[email protected] if (!connection){ 4407a00031e2S[email protected] hci_emit_security_level(con_handle, LEVEL_0); 440834d2123cS[email protected] return; 440934d2123cS[email protected] } 441034d2123cS[email protected] gap_security_level_t current_level = gap_security_level(con_handle); 441183d08d7cSMatthias Ringwald log_info("gap_request_security_level requested level %u, planned level %u, current level %u", 441283d08d7cSMatthias Ringwald requested_level, connection->requested_security_level, current_level); 441383d08d7cSMatthias Ringwald 441483d08d7cSMatthias Ringwald // assumption: earlier requested security higher than current level => security request is active 441583d08d7cSMatthias Ringwald if (current_level < connection->requested_security_level){ 441683d08d7cSMatthias Ringwald if (connection->requested_security_level < requested_level){ 441783d08d7cSMatthias Ringwald // increase requested level as new level is higher 441883d08d7cSMatthias Ringwald 441983d08d7cSMatthias Ringwald // TODO: handle re-authentication when done 442083d08d7cSMatthias Ringwald 442183d08d7cSMatthias Ringwald connection->requested_security_level = requested_level; 442283d08d7cSMatthias Ringwald } 442383d08d7cSMatthias Ringwald return; 442483d08d7cSMatthias Ringwald } 442583d08d7cSMatthias Ringwald 442683d08d7cSMatthias Ringwald // no request active, notify if security sufficient 442783d08d7cSMatthias Ringwald if (requested_level <= current_level){ 4428a00031e2S[email protected] hci_emit_security_level(con_handle, current_level); 442934d2123cS[email protected] return; 443034d2123cS[email protected] } 4431a00031e2S[email protected] 443283d08d7cSMatthias Ringwald // start pairing to increase security level 443334d2123cS[email protected] connection->requested_security_level = requested_level; 4434a00031e2S[email protected] 443525bf5872S[email protected] #if 0 443625bf5872S[email protected] // sending encryption request without a link key results in an error. 443725bf5872S[email protected] // TODO: figure out how to use it properly 443825bf5872S[email protected] 4439fb8ba0dbS[email protected] // would enabling ecnryption suffice (>= LEVEL_2)? 4440a98592bcSMatthias Ringwald if (hci_stack->link_key_db){ 4441a00031e2S[email protected] link_key_type_t link_key_type; 4442a00031e2S[email protected] link_key_t link_key; 4443a98592bcSMatthias Ringwald if (hci_stack->link_key_db->get_link_key( &connection->address, &link_key, &link_key_type)){ 4444a00031e2S[email protected] if (gap_security_level_for_link_key_type(link_key_type) >= requested_level){ 4445a00031e2S[email protected] connection->bonding_flags |= BONDING_SEND_ENCRYPTION_REQUEST; 4446a00031e2S[email protected] return; 4447a00031e2S[email protected] } 4448a00031e2S[email protected] } 4449a00031e2S[email protected] } 445025bf5872S[email protected] #endif 4451a00031e2S[email protected] 445283d08d7cSMatthias Ringwald // start to authenticate connection 44531eb2563eS[email protected] connection->bonding_flags |= BONDING_SEND_AUTHENTICATE_REQUEST; 4454e80b2cf9S[email protected] hci_run(); 4455e00caf9cS[email protected] } 4456ad83dc6aS[email protected] 4457ad83dc6aS[email protected] /** 4458ad83dc6aS[email protected] * @brief start dedicated bonding with device. disconnect after bonding 4459ad83dc6aS[email protected] * @param device 4460ad83dc6aS[email protected] * @param request MITM protection 4461ad83dc6aS[email protected] * @result GAP_DEDICATED_BONDING_COMPLETE 4462ad83dc6aS[email protected] */ 4463ad83dc6aS[email protected] int gap_dedicated_bonding(bd_addr_t device, int mitm_protection_required){ 4464ad83dc6aS[email protected] 4465ad83dc6aS[email protected] // create connection state machine 446696a45072S[email protected] hci_connection_t * connection = create_connection_for_bd_addr_and_type(device, BD_ADDR_TYPE_CLASSIC); 4467ad83dc6aS[email protected] 4468ad83dc6aS[email protected] if (!connection){ 4469ad83dc6aS[email protected] return BTSTACK_MEMORY_ALLOC_FAILED; 4470ad83dc6aS[email protected] } 4471ad83dc6aS[email protected] 4472ad83dc6aS[email protected] // delete linkn key 447315a95bd5SMatthias Ringwald gap_drop_link_key_for_bd_addr(device); 4474ad83dc6aS[email protected] 4475ad83dc6aS[email protected] // configure LEVEL_2/3, dedicated bonding 4476ad83dc6aS[email protected] connection->state = SEND_CREATE_CONNECTION; 4477ad83dc6aS[email protected] connection->requested_security_level = mitm_protection_required ? LEVEL_3 : LEVEL_2; 4478f04a0c31SMatthias Ringwald log_info("gap_dedicated_bonding, mitm %d -> level %u", mitm_protection_required, connection->requested_security_level); 4479ad83dc6aS[email protected] connection->bonding_flags = BONDING_DEDICATED; 4480ad83dc6aS[email protected] 4481ad83dc6aS[email protected] // wait for GAP Security Result and send GAP Dedicated Bonding complete 4482ad83dc6aS[email protected] 4483ad83dc6aS[email protected] // handle: connnection failure (connection complete != ok) 4484ad83dc6aS[email protected] // handle: authentication failure 4485ad83dc6aS[email protected] // handle: disconnect on done 4486ad83dc6aS[email protected] 4487ad83dc6aS[email protected] hci_run(); 4488ad83dc6aS[email protected] 4489ad83dc6aS[email protected] return 0; 4490ad83dc6aS[email protected] } 449135454696SMatthias Ringwald #endif 44928e618f72S[email protected] 44938e618f72S[email protected] void gap_set_local_name(const char * local_name){ 44948e618f72S[email protected] hci_stack->local_name = local_name; 44958e618f72S[email protected] } 44968e618f72S[email protected] 449735454696SMatthias Ringwald 449835454696SMatthias Ringwald #ifdef ENABLE_BLE 449935454696SMatthias Ringwald 4500d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 4501d8e8f12aSMatthias Ringwald void gap_start_scan(void){ 45026fab74dbSMatthias Ringwald hci_stack->le_scanning_enabled = 1; 45037bdc6798S[email protected] hci_run(); 45047bdc6798S[email protected] } 45058e618f72S[email protected] 4506d8e8f12aSMatthias Ringwald void gap_stop_scan(void){ 45076fab74dbSMatthias Ringwald hci_stack->le_scanning_enabled = 0; 45087bdc6798S[email protected] hci_run(); 45097bdc6798S[email protected] } 45104f3229d8S[email protected] 4511d8e8f12aSMatthias Ringwald void gap_set_scan_parameters(uint8_t scan_type, uint16_t scan_interval, uint16_t scan_window){ 4512ef11999fSmatthias.ringwald hci_stack->le_scan_type = scan_type; 4513ef11999fSmatthias.ringwald hci_stack->le_scan_interval = scan_interval; 4514ef11999fSmatthias.ringwald hci_stack->le_scan_window = scan_window; 4515ef11999fSmatthias.ringwald hci_run(); 4516ef11999fSmatthias.ringwald } 45174f3229d8S[email protected] 4518d8e8f12aSMatthias Ringwald uint8_t gap_connect(bd_addr_t addr, bd_addr_type_t addr_type){ 45194f3229d8S[email protected] hci_connection_t * conn = hci_connection_for_bd_addr_and_type(addr, addr_type); 45204f3229d8S[email protected] if (!conn){ 4521d8e8f12aSMatthias Ringwald log_info("gap_connect: no connection exists yet, creating context"); 45222e77e513S[email protected] conn = create_connection_for_bd_addr_and_type(addr, addr_type); 45234f3229d8S[email protected] if (!conn){ 45244f3229d8S[email protected] // notify client that alloc failed 45256e2e9a6bS[email protected] hci_emit_le_connection_complete(addr_type, addr, 0, BTSTACK_MEMORY_ALLOC_FAILED); 4526d8e8f12aSMatthias Ringwald log_info("gap_connect: failed to alloc hci_connection_t"); 4527472a5742SMatthias Ringwald return GATT_CLIENT_NOT_CONNECTED; // don't sent packet to controller 45284f3229d8S[email protected] } 45294f3229d8S[email protected] conn->state = SEND_CREATE_CONNECTION; 4530d8e8f12aSMatthias Ringwald log_info("gap_connect: send create connection next"); 4531564fca32S[email protected] hci_run(); 4532616edd56SMatthias Ringwald return 0; 45334f3229d8S[email protected] } 45340bf6344aS[email protected] 45350bf6344aS[email protected] if (!hci_is_le_connection(conn) || 45360bf6344aS[email protected] conn->state == SEND_CREATE_CONNECTION || 45370bf6344aS[email protected] conn->state == SENT_CREATE_CONNECTION) { 45382e77e513S[email protected] hci_emit_le_connection_complete(conn->address_type, conn->address, 0, ERROR_CODE_COMMAND_DISALLOWED); 4539d8e8f12aSMatthias Ringwald log_error("gap_connect: classic connection or connect is already being created"); 4540616edd56SMatthias Ringwald return GATT_CLIENT_IN_WRONG_STATE; 45410bf6344aS[email protected] } 45420bf6344aS[email protected] 4543d8e8f12aSMatthias Ringwald log_info("gap_connect: context exists with state %u", conn->state); 45442e77e513S[email protected] hci_emit_le_connection_complete(conn->address_type, conn->address, conn->con_handle, 0); 45454f3229d8S[email protected] hci_run(); 4546616edd56SMatthias Ringwald return 0; 45474f3229d8S[email protected] } 45484f3229d8S[email protected] 45497851196eSmatthias.ringwald // @assumption: only a single outgoing LE Connection exists 4550d8e8f12aSMatthias Ringwald static hci_connection_t * gap_get_outgoing_connection(void){ 4551665d90f2SMatthias Ringwald btstack_linked_item_t *it; 4552665d90f2SMatthias Ringwald for (it = (btstack_linked_item_t *) hci_stack->connections; it ; it = it->next){ 45530bf6344aS[email protected] hci_connection_t * conn = (hci_connection_t *) it; 45540bf6344aS[email protected] if (!hci_is_le_connection(conn)) continue; 45550bf6344aS[email protected] switch (conn->state){ 4556a6725849S[email protected] case SEND_CREATE_CONNECTION: 45577851196eSmatthias.ringwald case SENT_CREATE_CONNECTION: 45589c77c9dbSMatthias Ringwald case SENT_CANCEL_CONNECTION: 45597851196eSmatthias.ringwald return conn; 45607851196eSmatthias.ringwald default: 45617851196eSmatthias.ringwald break; 45627851196eSmatthias.ringwald }; 45637851196eSmatthias.ringwald } 45647851196eSmatthias.ringwald return NULL; 45657851196eSmatthias.ringwald } 45667851196eSmatthias.ringwald 4567d8e8f12aSMatthias Ringwald uint8_t gap_connect_cancel(void){ 4568d8e8f12aSMatthias Ringwald hci_connection_t * conn = gap_get_outgoing_connection(); 4569616edd56SMatthias Ringwald if (!conn) return 0; 45707851196eSmatthias.ringwald switch (conn->state){ 45717851196eSmatthias.ringwald case SEND_CREATE_CONNECTION: 45727851196eSmatthias.ringwald // skip sending create connection and emit event instead 45732e77e513S[email protected] hci_emit_le_connection_complete(conn->address_type, conn->address, 0, ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER); 4574665d90f2SMatthias Ringwald btstack_linked_list_remove(&hci_stack->connections, (btstack_linked_item_t *) conn); 45757851196eSmatthias.ringwald btstack_memory_hci_connection_free( conn ); 45760bf6344aS[email protected] break; 4577a6725849S[email protected] case SENT_CREATE_CONNECTION: 45787851196eSmatthias.ringwald // request to send cancel connection 45790bf6344aS[email protected] conn->state = SEND_CANCEL_CONNECTION; 45800bf6344aS[email protected] hci_run(); 45810bf6344aS[email protected] break; 45820bf6344aS[email protected] default: 45830bf6344aS[email protected] break; 45840bf6344aS[email protected] } 4585616edd56SMatthias Ringwald return 0; 4586e31f89a7S[email protected] } 4587d70217a2SMatthias Ringwald #endif 45884f3229d8S[email protected] 458913e645d2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 4590c37a3166S[email protected] /** 45916012052bSMatthias Ringwald * @brief Set connection parameters for outgoing connections 4592cbe54ab2SJakob Krantz * @param conn_scan_interval (unit: 0.625 msec), default: 60 ms 4593cbe54ab2SJakob Krantz * @param conn_scan_window (unit: 0.625 msec), default: 30 ms 45946012052bSMatthias Ringwald * @param conn_interval_min (unit: 1.25ms), default: 10 ms 45956012052bSMatthias Ringwald * @param conn_interval_max (unit: 1.25ms), default: 30 ms 45966012052bSMatthias Ringwald * @param conn_latency, default: 4 45976012052bSMatthias Ringwald * @param supervision_timeout (unit: 10ms), default: 720 ms 45986012052bSMatthias Ringwald * @param min_ce_length (unit: 0.625ms), default: 10 ms 45996012052bSMatthias Ringwald * @param max_ce_length (unit: 0.625ms), default: 30 ms 46006012052bSMatthias Ringwald */ 46016012052bSMatthias Ringwald 4602cbe54ab2SJakob Krantz void gap_set_connection_parameters(uint16_t conn_scan_interval, uint16_t conn_scan_window, 4603cbe54ab2SJakob Krantz uint16_t conn_interval_min, uint16_t conn_interval_max, uint16_t conn_latency, 4604cbe54ab2SJakob Krantz uint16_t supervision_timeout, uint16_t min_ce_length, uint16_t max_ce_length){ 4605cbe54ab2SJakob Krantz hci_stack->le_connection_scan_interval = conn_scan_interval; 4606cbe54ab2SJakob Krantz hci_stack->le_connection_scan_window = conn_scan_window; 46076012052bSMatthias Ringwald hci_stack->le_connection_interval_min = conn_interval_min; 46086012052bSMatthias Ringwald hci_stack->le_connection_interval_max = conn_interval_max; 46096012052bSMatthias Ringwald hci_stack->le_connection_latency = conn_latency; 46106012052bSMatthias Ringwald hci_stack->le_supervision_timeout = supervision_timeout; 46116012052bSMatthias Ringwald hci_stack->le_minimum_ce_length = min_ce_length; 46126012052bSMatthias Ringwald hci_stack->le_maximum_ce_length = max_ce_length; 46136012052bSMatthias Ringwald } 461413e645d2SMatthias Ringwald #endif 46156012052bSMatthias Ringwald 46166012052bSMatthias Ringwald /** 4617c37a3166S[email protected] * @brief Updates the connection parameters for a given LE connection 4618c37a3166S[email protected] * @param handle 4619c37a3166S[email protected] * @param conn_interval_min (unit: 1.25ms) 4620c37a3166S[email protected] * @param conn_interval_max (unit: 1.25ms) 4621c37a3166S[email protected] * @param conn_latency 4622c37a3166S[email protected] * @param supervision_timeout (unit: 10ms) 4623c37a3166S[email protected] * @returns 0 if ok 4624c37a3166S[email protected] */ 4625c37a3166S[email protected] int gap_update_connection_parameters(hci_con_handle_t con_handle, uint16_t conn_interval_min, 4626c37a3166S[email protected] uint16_t conn_interval_max, uint16_t conn_latency, uint16_t supervision_timeout){ 4627c37a3166S[email protected] hci_connection_t * connection = hci_connection_for_handle(con_handle); 4628c37a3166S[email protected] if (!connection) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 4629c37a3166S[email protected] connection->le_conn_interval_min = conn_interval_min; 4630c37a3166S[email protected] connection->le_conn_interval_max = conn_interval_max; 4631c37a3166S[email protected] connection->le_conn_latency = conn_latency; 4632c37a3166S[email protected] connection->le_supervision_timeout = supervision_timeout; 463384cf6d83SMatthias Ringwald connection->le_con_parameter_update_state = CON_PARAMETER_UPDATE_CHANGE_HCI_CON_PARAMETERS; 4634cfc59f1bSMatthias Ringwald hci_run(); 4635c37a3166S[email protected] return 0; 4636c37a3166S[email protected] } 4637c37a3166S[email protected] 463845c102fdSMatthias Ringwald /** 4639b68d7bc3SMatthias Ringwald * @brief Request an update of the connection parameter for a given LE connection 4640b68d7bc3SMatthias Ringwald * @param handle 4641b68d7bc3SMatthias Ringwald * @param conn_interval_min (unit: 1.25ms) 4642b68d7bc3SMatthias Ringwald * @param conn_interval_max (unit: 1.25ms) 4643b68d7bc3SMatthias Ringwald * @param conn_latency 4644b68d7bc3SMatthias Ringwald * @param supervision_timeout (unit: 10ms) 4645b68d7bc3SMatthias Ringwald * @returns 0 if ok 4646b68d7bc3SMatthias Ringwald */ 4647b68d7bc3SMatthias Ringwald int gap_request_connection_parameter_update(hci_con_handle_t con_handle, uint16_t conn_interval_min, 4648b68d7bc3SMatthias Ringwald uint16_t conn_interval_max, uint16_t conn_latency, uint16_t supervision_timeout){ 4649b68d7bc3SMatthias Ringwald hci_connection_t * connection = hci_connection_for_handle(con_handle); 4650b68d7bc3SMatthias Ringwald if (!connection) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 4651b68d7bc3SMatthias Ringwald connection->le_conn_interval_min = conn_interval_min; 4652b68d7bc3SMatthias Ringwald connection->le_conn_interval_max = conn_interval_max; 4653b68d7bc3SMatthias Ringwald connection->le_conn_latency = conn_latency; 4654b68d7bc3SMatthias Ringwald connection->le_supervision_timeout = supervision_timeout; 4655b68d7bc3SMatthias Ringwald connection->le_con_parameter_update_state = CON_PARAMETER_UPDATE_SEND_REQUEST; 4656b68d7bc3SMatthias Ringwald hci_run(); 4657b68d7bc3SMatthias Ringwald return 0; 4658b68d7bc3SMatthias Ringwald } 4659b68d7bc3SMatthias Ringwald 4660d70217a2SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 4661d70217a2SMatthias Ringwald 4662501f56b3SMatthias Ringwald static void gap_advertisments_changed(void){ 4663501f56b3SMatthias Ringwald // disable advertisements before updating adv, scan data, or adv params 4664501f56b3SMatthias Ringwald if (hci_stack->le_advertisements_active){ 4665501f56b3SMatthias Ringwald hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_DISABLE | LE_ADVERTISEMENT_TASKS_ENABLE; 4666501f56b3SMatthias Ringwald } 4667501f56b3SMatthias Ringwald hci_run(); 4668501f56b3SMatthias Ringwald } 4669501f56b3SMatthias Ringwald 4670b68d7bc3SMatthias Ringwald /** 467145c102fdSMatthias Ringwald * @brief Set Advertisement Data 467245c102fdSMatthias Ringwald * @param advertising_data_length 467345c102fdSMatthias Ringwald * @param advertising_data (max 31 octets) 467445c102fdSMatthias Ringwald * @note data is not copied, pointer has to stay valid 467545c102fdSMatthias Ringwald */ 467645c102fdSMatthias Ringwald void gap_advertisements_set_data(uint8_t advertising_data_length, uint8_t * advertising_data){ 467745c102fdSMatthias Ringwald hci_stack->le_advertisements_data_len = advertising_data_length; 467845c102fdSMatthias Ringwald hci_stack->le_advertisements_data = advertising_data; 4679501f56b3SMatthias Ringwald hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_SET_ADV_DATA; 4680501f56b3SMatthias Ringwald gap_advertisments_changed(); 468145c102fdSMatthias Ringwald } 4682501f56b3SMatthias Ringwald 4683501f56b3SMatthias Ringwald /** 4684501f56b3SMatthias Ringwald * @brief Set Scan Response Data 4685501f56b3SMatthias Ringwald * @param advertising_data_length 4686501f56b3SMatthias Ringwald * @param advertising_data (max 31 octets) 4687501f56b3SMatthias Ringwald * @note data is not copied, pointer has to stay valid 4688501f56b3SMatthias Ringwald */ 4689501f56b3SMatthias Ringwald void gap_scan_response_set_data(uint8_t scan_response_data_length, uint8_t * scan_response_data){ 4690501f56b3SMatthias Ringwald hci_stack->le_scan_response_data_len = scan_response_data_length; 4691501f56b3SMatthias Ringwald hci_stack->le_scan_response_data = scan_response_data; 4692501f56b3SMatthias Ringwald hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_SET_SCAN_DATA; 4693501f56b3SMatthias Ringwald gap_advertisments_changed(); 469445c102fdSMatthias Ringwald } 469545c102fdSMatthias Ringwald 469645c102fdSMatthias Ringwald /** 469745c102fdSMatthias Ringwald * @brief Set Advertisement Parameters 469845c102fdSMatthias Ringwald * @param adv_int_min 469945c102fdSMatthias Ringwald * @param adv_int_max 470045c102fdSMatthias Ringwald * @param adv_type 470145c102fdSMatthias Ringwald * @param direct_address_type 470245c102fdSMatthias Ringwald * @param direct_address 470345c102fdSMatthias Ringwald * @param channel_map 470445c102fdSMatthias Ringwald * @param filter_policy 470545c102fdSMatthias Ringwald * 470645c102fdSMatthias Ringwald * @note internal use. use gap_advertisements_set_params from gap_le.h instead. 470745c102fdSMatthias Ringwald */ 470845c102fdSMatthias Ringwald void hci_le_advertisements_set_params(uint16_t adv_int_min, uint16_t adv_int_max, uint8_t adv_type, 4709b95a5a35SMatthias Ringwald uint8_t direct_address_typ, bd_addr_t direct_address, 471045c102fdSMatthias Ringwald uint8_t channel_map, uint8_t filter_policy) { 471145c102fdSMatthias Ringwald 471245c102fdSMatthias Ringwald hci_stack->le_advertisements_interval_min = adv_int_min; 471345c102fdSMatthias Ringwald hci_stack->le_advertisements_interval_max = adv_int_max; 471445c102fdSMatthias Ringwald hci_stack->le_advertisements_type = adv_type; 471545c102fdSMatthias Ringwald hci_stack->le_advertisements_direct_address_type = direct_address_typ; 471645c102fdSMatthias Ringwald hci_stack->le_advertisements_channel_map = channel_map; 471745c102fdSMatthias Ringwald hci_stack->le_advertisements_filter_policy = filter_policy; 471845c102fdSMatthias Ringwald memcpy(hci_stack->le_advertisements_direct_address, direct_address, 6); 471945c102fdSMatthias Ringwald 472045c102fdSMatthias Ringwald hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_SET_PARAMS; 4721501f56b3SMatthias Ringwald gap_advertisments_changed(); 472245c102fdSMatthias Ringwald } 472345c102fdSMatthias Ringwald 472445c102fdSMatthias Ringwald /** 472545c102fdSMatthias Ringwald * @brief Enable/Disable Advertisements 472645c102fdSMatthias Ringwald * @param enabled 472745c102fdSMatthias Ringwald */ 472845c102fdSMatthias Ringwald void gap_advertisements_enable(int enabled){ 472945c102fdSMatthias Ringwald hci_stack->le_advertisements_enabled = enabled; 473045c102fdSMatthias Ringwald if (enabled && !hci_stack->le_advertisements_active){ 473145c102fdSMatthias Ringwald hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_ENABLE; 473245c102fdSMatthias Ringwald } 473345c102fdSMatthias Ringwald if (!enabled && hci_stack->le_advertisements_active){ 473445c102fdSMatthias Ringwald hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_DISABLE; 473545c102fdSMatthias Ringwald } 4736cfc59f1bSMatthias Ringwald hci_run(); 473745c102fdSMatthias Ringwald } 473845c102fdSMatthias Ringwald 473935454696SMatthias Ringwald #endif 474006e5cf96SMatthias Ringwald 474106e5cf96SMatthias Ringwald void hci_le_set_own_address_type(uint8_t own_address_type){ 474206e5cf96SMatthias Ringwald log_info("hci_le_set_own_address_type: old %u, new %u", hci_stack->le_own_addr_type, own_address_type); 474306e5cf96SMatthias Ringwald if (own_address_type == hci_stack->le_own_addr_type) return; 474406e5cf96SMatthias Ringwald hci_stack->le_own_addr_type = own_address_type; 474506e5cf96SMatthias Ringwald 474664068776SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL 474706e5cf96SMatthias Ringwald // update advertisement parameters, too 474806e5cf96SMatthias Ringwald hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_SET_PARAMS; 474906e5cf96SMatthias Ringwald gap_advertisments_changed(); 475064068776SMatthias Ringwald #endif 475164068776SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 475206e5cf96SMatthias Ringwald // note: we don't update scan parameters or modify ongoing connection attempts 475364068776SMatthias Ringwald #endif 475406e5cf96SMatthias Ringwald } 475506e5cf96SMatthias Ringwald 4756d70217a2SMatthias Ringwald #endif 475745c102fdSMatthias Ringwald 4758616edd56SMatthias Ringwald uint8_t gap_disconnect(hci_con_handle_t handle){ 47595917a5c5S[email protected] hci_connection_t * conn = hci_connection_for_handle(handle); 47605917a5c5S[email protected] if (!conn){ 47617851196eSmatthias.ringwald hci_emit_disconnection_complete(handle, 0); 4762616edd56SMatthias Ringwald return 0; 47635917a5c5S[email protected] } 47647fd7aa6fSMatthias Ringwald // ignore if already disconnected 47657fd7aa6fSMatthias Ringwald if (conn->state == RECEIVED_DISCONNECTION_COMPLETE){ 47667fd7aa6fSMatthias Ringwald return 0; 47677fd7aa6fSMatthias Ringwald } 47685917a5c5S[email protected] conn->state = SEND_DISCONNECT; 47695917a5c5S[email protected] hci_run(); 4770616edd56SMatthias Ringwald return 0; 47714f3229d8S[email protected] } 477204a6ef8cSmatthias.ringwald 4773a1bf5ae7SMatthias Ringwald /** 4774a1bf5ae7SMatthias Ringwald * @brief Get connection type 4775a1bf5ae7SMatthias Ringwald * @param con_handle 4776a1bf5ae7SMatthias Ringwald * @result connection_type 4777a1bf5ae7SMatthias Ringwald */ 4778a1bf5ae7SMatthias Ringwald gap_connection_type_t gap_get_connection_type(hci_con_handle_t connection_handle){ 4779a1bf5ae7SMatthias Ringwald hci_connection_t * conn = hci_connection_for_handle(connection_handle); 4780a1bf5ae7SMatthias Ringwald if (!conn) return GAP_CONNECTION_INVALID; 4781a1bf5ae7SMatthias Ringwald switch (conn->address_type){ 4782a1bf5ae7SMatthias Ringwald case BD_ADDR_TYPE_LE_PUBLIC: 4783a1bf5ae7SMatthias Ringwald case BD_ADDR_TYPE_LE_RANDOM: 4784a1bf5ae7SMatthias Ringwald return GAP_CONNECTION_LE; 4785a1bf5ae7SMatthias Ringwald case BD_ADDR_TYPE_SCO: 4786a1bf5ae7SMatthias Ringwald return GAP_CONNECTION_SCO; 4787a1bf5ae7SMatthias Ringwald case BD_ADDR_TYPE_CLASSIC: 4788a1bf5ae7SMatthias Ringwald return GAP_CONNECTION_ACL; 4789a1bf5ae7SMatthias Ringwald default: 4790a1bf5ae7SMatthias Ringwald return GAP_CONNECTION_INVALID; 4791a1bf5ae7SMatthias Ringwald } 4792a1bf5ae7SMatthias Ringwald } 4793a1bf5ae7SMatthias Ringwald 4794a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE 47954f551432SMatthias Ringwald 4796b90f6e0aSMatthias Ringwald uint8_t gap_le_set_phy(hci_con_handle_t connection_handle, uint8_t all_phys, uint8_t tx_phys, uint8_t rx_phys, uint8_t phy_options){ 4797b90f6e0aSMatthias Ringwald hci_connection_t * conn = hci_connection_for_handle(connection_handle); 4798b90f6e0aSMatthias Ringwald if (!conn) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 4799b90f6e0aSMatthias Ringwald 4800b90f6e0aSMatthias Ringwald conn->le_phy_update_all_phys = all_phys; 4801b90f6e0aSMatthias Ringwald conn->le_phy_update_tx_phys = tx_phys; 4802b90f6e0aSMatthias Ringwald conn->le_phy_update_rx_phys = rx_phys; 4803b90f6e0aSMatthias Ringwald conn->le_phy_update_phy_options = phy_options; 4804b90f6e0aSMatthias Ringwald 4805b90f6e0aSMatthias Ringwald hci_run(); 4806b90f6e0aSMatthias Ringwald 4807b90f6e0aSMatthias Ringwald return 0; 4808b90f6e0aSMatthias Ringwald } 4809b90f6e0aSMatthias Ringwald 4810d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL 4811d23838ecSMatthias Ringwald /** 4812ac9c45e0SMatthias Ringwald * @brief Auto Connection Establishment - Start Connecting to device 4813ac9c45e0SMatthias Ringwald * @param address_typ 4814ac9c45e0SMatthias Ringwald * @param address 4815ac9c45e0SMatthias Ringwald * @returns 0 if ok 4816ac9c45e0SMatthias Ringwald */ 48174f551432SMatthias Ringwald int gap_auto_connection_start(bd_addr_type_t address_type, bd_addr_t address){ 4818e83201bcSMatthias Ringwald // check capacity 4819665d90f2SMatthias Ringwald int num_entries = btstack_linked_list_count(&hci_stack->le_whitelist); 482091915b0bSMatthias Ringwald if (num_entries >= hci_stack->le_whitelist_capacity) return ERROR_CODE_MEMORY_CAPACITY_EXCEEDED; 4821e83201bcSMatthias Ringwald whitelist_entry_t * entry = btstack_memory_whitelist_entry_get(); 4822e83201bcSMatthias Ringwald if (!entry) return BTSTACK_MEMORY_ALLOC_FAILED; 4823e83201bcSMatthias Ringwald entry->address_type = address_type; 4824e83201bcSMatthias Ringwald memcpy(entry->address, address, 6); 4825e83201bcSMatthias Ringwald entry->state = LE_WHITELIST_ADD_TO_CONTROLLER; 4826665d90f2SMatthias Ringwald btstack_linked_list_add(&hci_stack->le_whitelist, (btstack_linked_item_t*) entry); 4827e83201bcSMatthias Ringwald hci_run(); 4828e83201bcSMatthias Ringwald return 0; 4829ac9c45e0SMatthias Ringwald } 4830ac9c45e0SMatthias Ringwald 483142ff5ba1SMatthias Ringwald static void hci_remove_from_whitelist(bd_addr_type_t address_type, bd_addr_t address){ 4832665d90f2SMatthias Ringwald btstack_linked_list_iterator_t it; 4833665d90f2SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->le_whitelist); 4834665d90f2SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 4835665d90f2SMatthias Ringwald whitelist_entry_t * entry = (whitelist_entry_t*) btstack_linked_list_iterator_next(&it); 4836e83201bcSMatthias Ringwald if (entry->address_type != address_type) continue; 4837e83201bcSMatthias Ringwald if (memcmp(entry->address, address, 6) != 0) continue; 4838e83201bcSMatthias Ringwald if (entry->state & LE_WHITELIST_ON_CONTROLLER){ 4839e83201bcSMatthias Ringwald // remove from controller if already present 4840e83201bcSMatthias Ringwald entry->state |= LE_WHITELIST_REMOVE_FROM_CONTROLLER; 4841e83201bcSMatthias Ringwald continue; 4842e83201bcSMatthias Ringwald } 4843e83201bcSMatthias Ringwald // direclty remove entry from whitelist 4844665d90f2SMatthias Ringwald btstack_linked_list_iterator_remove(&it); 4845e83201bcSMatthias Ringwald btstack_memory_whitelist_entry_free(entry); 4846e83201bcSMatthias Ringwald } 484742ff5ba1SMatthias Ringwald } 484842ff5ba1SMatthias Ringwald 484942ff5ba1SMatthias Ringwald /** 485042ff5ba1SMatthias Ringwald * @brief Auto Connection Establishment - Stop Connecting to device 485142ff5ba1SMatthias Ringwald * @param address_typ 485242ff5ba1SMatthias Ringwald * @param address 485342ff5ba1SMatthias Ringwald * @returns 0 if ok 485442ff5ba1SMatthias Ringwald */ 485542ff5ba1SMatthias Ringwald int gap_auto_connection_stop(bd_addr_type_t address_type, bd_addr_t address){ 485642ff5ba1SMatthias Ringwald hci_remove_from_whitelist(address_type, address); 4857e83201bcSMatthias Ringwald hci_run(); 4858e83201bcSMatthias Ringwald return 0; 4859ac9c45e0SMatthias Ringwald } 4860ac9c45e0SMatthias Ringwald 4861ac9c45e0SMatthias Ringwald /** 4862ac9c45e0SMatthias Ringwald * @brief Auto Connection Establishment - Stop everything 4863ac9c45e0SMatthias Ringwald * @note Convenience function to stop all active auto connection attempts 4864ac9c45e0SMatthias Ringwald */ 4865ac9c45e0SMatthias Ringwald void gap_auto_connection_stop_all(void){ 4866665d90f2SMatthias Ringwald btstack_linked_list_iterator_t it; 4867665d90f2SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->le_whitelist); 4868665d90f2SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 4869665d90f2SMatthias Ringwald whitelist_entry_t * entry = (whitelist_entry_t*) btstack_linked_list_iterator_next(&it); 4870e83201bcSMatthias Ringwald if (entry->state & LE_WHITELIST_ON_CONTROLLER){ 4871e83201bcSMatthias Ringwald // remove from controller if already present 4872e83201bcSMatthias Ringwald entry->state |= LE_WHITELIST_REMOVE_FROM_CONTROLLER; 4873e83201bcSMatthias Ringwald continue; 4874e83201bcSMatthias Ringwald } 487591915b0bSMatthias Ringwald // directly remove entry from whitelist 4876665d90f2SMatthias Ringwald btstack_linked_list_iterator_remove(&it); 4877e83201bcSMatthias Ringwald btstack_memory_whitelist_entry_free(entry); 4878e83201bcSMatthias Ringwald } 4879e83201bcSMatthias Ringwald hci_run(); 4880ac9c45e0SMatthias Ringwald } 4881c9db5c21SMilanka Ringwald 4882c9db5c21SMilanka Ringwald uint16_t gap_le_connection_interval(hci_con_handle_t connection_handle){ 4883c9db5c21SMilanka Ringwald hci_connection_t * conn = hci_connection_for_handle(connection_handle); 4884c9db5c21SMilanka Ringwald if (!conn) return 0; 4885c9db5c21SMilanka Ringwald return conn->le_connection_interval; 4886c9db5c21SMilanka Ringwald } 4887d70217a2SMatthias Ringwald #endif 48884f551432SMatthias Ringwald #endif 48894f551432SMatthias Ringwald 489035454696SMatthias Ringwald #ifdef ENABLE_CLASSIC 4891ac9c45e0SMatthias Ringwald /** 4892ff00ed1cSMatthias Ringwald * @brief Set Extended Inquiry Response data 4893ff00ed1cSMatthias Ringwald * @param eir_data size 240 bytes, is not copied make sure memory is accessible during stack startup 4894ff00ed1cSMatthias Ringwald * @note has to be done before stack starts up 4895ff00ed1cSMatthias Ringwald */ 4896ff00ed1cSMatthias Ringwald void gap_set_extended_inquiry_response(const uint8_t * data){ 4897ff00ed1cSMatthias Ringwald hci_stack->eir_data = data; 4898ff00ed1cSMatthias Ringwald } 4899ff00ed1cSMatthias Ringwald 4900ff00ed1cSMatthias Ringwald /** 4901f5875de5SMatthias Ringwald * @brief Start GAP Classic Inquiry 4902f5875de5SMatthias Ringwald * @param duration in 1.28s units 4903f5875de5SMatthias Ringwald * @return 0 if ok 4904f5875de5SMatthias Ringwald * @events: GAP_EVENT_INQUIRY_RESULT, GAP_EVENT_INQUIRY_COMPLETE 4905f5875de5SMatthias Ringwald */ 4906f5875de5SMatthias Ringwald int gap_inquiry_start(uint8_t duration_in_1280ms_units){ 490799449554SMatthias Ringwald if (hci_stack->state != HCI_STATE_WORKING) return ERROR_CODE_COMMAND_DISALLOWED; 4908f5875de5SMatthias Ringwald if (hci_stack->inquiry_state != GAP_INQUIRY_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED; 4909f5875de5SMatthias Ringwald if (duration_in_1280ms_units < GAP_INQUIRY_DURATION_MIN || duration_in_1280ms_units > GAP_INQUIRY_DURATION_MAX){ 4910f5875de5SMatthias Ringwald return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS; 4911f5875de5SMatthias Ringwald } 4912f5875de5SMatthias Ringwald hci_stack->inquiry_state = duration_in_1280ms_units; 4913f5875de5SMatthias Ringwald hci_run(); 4914f5875de5SMatthias Ringwald return 0; 4915f5875de5SMatthias Ringwald } 4916f5875de5SMatthias Ringwald 4917f5875de5SMatthias Ringwald /** 4918f5875de5SMatthias Ringwald * @brief Stop GAP Classic Inquiry 4919f5875de5SMatthias Ringwald * @returns 0 if ok 4920f5875de5SMatthias Ringwald */ 4921f5875de5SMatthias Ringwald int gap_inquiry_stop(void){ 49222c123282SMatthias Ringwald if (hci_stack->inquiry_state >= GAP_INQUIRY_DURATION_MIN && hci_stack->inquiry_state <= GAP_INQUIRY_DURATION_MAX) { 4923f5875de5SMatthias Ringwald // emit inquiry complete event, before it even started 4924f5875de5SMatthias Ringwald uint8_t event[] = { GAP_EVENT_INQUIRY_COMPLETE, 1, 0}; 4925f5875de5SMatthias Ringwald hci_emit_event(event, sizeof(event), 1); 4926f5875de5SMatthias Ringwald return 0; 4927f5875de5SMatthias Ringwald } 4928f5875de5SMatthias Ringwald if (hci_stack->inquiry_state != GAP_INQUIRY_STATE_ACTIVE) return ERROR_CODE_COMMAND_DISALLOWED; 4929f5875de5SMatthias Ringwald hci_stack->inquiry_state = GAP_INQUIRY_STATE_W2_CANCEL; 4930f5875de5SMatthias Ringwald hci_run(); 4931f5875de5SMatthias Ringwald return 0; 4932f5875de5SMatthias Ringwald } 4933f5875de5SMatthias Ringwald 4934b7f1ee76SMatthias Ringwald 4935b7f1ee76SMatthias Ringwald /** 4936b7f1ee76SMatthias Ringwald * @brief Remote Name Request 4937b7f1ee76SMatthias Ringwald * @param addr 4938b7f1ee76SMatthias Ringwald * @param page_scan_repetition_mode 4939b7f1ee76SMatthias Ringwald * @param clock_offset only used when bit 15 is set 4940b7f1ee76SMatthias Ringwald * @events: HCI_EVENT_REMOTE_NAME_REQUEST_COMPLETE 4941b7f1ee76SMatthias Ringwald */ 4942b7f1ee76SMatthias Ringwald int gap_remote_name_request(bd_addr_t addr, uint8_t page_scan_repetition_mode, uint16_t clock_offset){ 4943b7f1ee76SMatthias Ringwald if (hci_stack->remote_name_state != GAP_REMOTE_NAME_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED; 4944b7f1ee76SMatthias Ringwald memcpy(hci_stack->remote_name_addr, addr, 6); 4945b7f1ee76SMatthias Ringwald hci_stack->remote_name_page_scan_repetition_mode = page_scan_repetition_mode; 4946b7f1ee76SMatthias Ringwald hci_stack->remote_name_clock_offset = clock_offset; 4947b7f1ee76SMatthias Ringwald hci_stack->remote_name_state = GAP_REMOTE_NAME_STATE_W2_SEND; 4948b7f1ee76SMatthias Ringwald hci_run(); 4949b7f1ee76SMatthias Ringwald return 0; 4950b7f1ee76SMatthias Ringwald } 4951b7f1ee76SMatthias Ringwald 49520a51f88bSMatthias Ringwald static int gap_pairing_set_state_and_run(bd_addr_t addr, uint8_t state){ 49530a51f88bSMatthias Ringwald hci_stack->gap_pairing_state = state; 49540a51f88bSMatthias Ringwald memcpy(hci_stack->gap_pairing_addr, addr, 6); 49550a51f88bSMatthias Ringwald hci_run(); 49560a51f88bSMatthias Ringwald return 0; 49570a51f88bSMatthias Ringwald } 49580a51f88bSMatthias Ringwald 49590a51f88bSMatthias Ringwald /** 49600a51f88bSMatthias Ringwald * @brief Legacy Pairing Pin Code Response 49610a51f88bSMatthias Ringwald * @param addr 49620a51f88bSMatthias Ringwald * @param pin 49630a51f88bSMatthias Ringwald * @return 0 if ok 49640a51f88bSMatthias Ringwald */ 49650a51f88bSMatthias Ringwald int gap_pin_code_response(bd_addr_t addr, const char * pin){ 4966cd74063aSMatthias Ringwald if (hci_stack->gap_pairing_state != GAP_PAIRING_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED; 4967d504181aSMatthias Ringwald hci_stack->gap_pairing_input.gap_pairing_pin = pin; 49680a51f88bSMatthias Ringwald return gap_pairing_set_state_and_run(addr, GAP_PAIRING_STATE_SEND_PIN); 49690a51f88bSMatthias Ringwald } 49700a51f88bSMatthias Ringwald 49710a51f88bSMatthias Ringwald /** 49720a51f88bSMatthias Ringwald * @brief Abort Legacy Pairing 49730a51f88bSMatthias Ringwald * @param addr 49740a51f88bSMatthias Ringwald * @param pin 49750a51f88bSMatthias Ringwald * @return 0 if ok 49760a51f88bSMatthias Ringwald */ 49770a51f88bSMatthias Ringwald int gap_pin_code_negative(bd_addr_t addr){ 4978cd74063aSMatthias Ringwald if (hci_stack->gap_pairing_state != GAP_PAIRING_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED; 49790a51f88bSMatthias Ringwald return gap_pairing_set_state_and_run(addr, GAP_PAIRING_STATE_SEND_PIN_NEGATIVE); 49800a51f88bSMatthias Ringwald } 49810a51f88bSMatthias Ringwald 49820a51f88bSMatthias Ringwald /** 49830a51f88bSMatthias Ringwald * @brief SSP Passkey Response 49840a51f88bSMatthias Ringwald * @param addr 49850a51f88bSMatthias Ringwald * @param passkey 49860a51f88bSMatthias Ringwald * @return 0 if ok 49870a51f88bSMatthias Ringwald */ 49880a51f88bSMatthias Ringwald int gap_ssp_passkey_response(bd_addr_t addr, uint32_t passkey){ 4989cd74063aSMatthias Ringwald if (hci_stack->gap_pairing_state != GAP_PAIRING_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED; 4990d504181aSMatthias Ringwald hci_stack->gap_pairing_input.gap_pairing_passkey = passkey; 49910a51f88bSMatthias Ringwald return gap_pairing_set_state_and_run(addr, GAP_PAIRING_STATE_SEND_PASSKEY); 49920a51f88bSMatthias Ringwald } 49930a51f88bSMatthias Ringwald 49940a51f88bSMatthias Ringwald /** 49950a51f88bSMatthias Ringwald * @brief Abort SSP Passkey Entry/Pairing 49960a51f88bSMatthias Ringwald * @param addr 49970a51f88bSMatthias Ringwald * @param pin 49980a51f88bSMatthias Ringwald * @return 0 if ok 49990a51f88bSMatthias Ringwald */ 50000a51f88bSMatthias Ringwald int gap_ssp_passkey_negative(bd_addr_t addr){ 5001cd74063aSMatthias Ringwald if (hci_stack->gap_pairing_state != GAP_PAIRING_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED; 50020a51f88bSMatthias Ringwald return gap_pairing_set_state_and_run(addr, GAP_PAIRING_STATE_SEND_PASSKEY_NEGATIVE); 50030a51f88bSMatthias Ringwald } 50040a51f88bSMatthias Ringwald 50050a51f88bSMatthias Ringwald /** 50060a51f88bSMatthias Ringwald * @brief Accept SSP Numeric Comparison 50070a51f88bSMatthias Ringwald * @param addr 50080a51f88bSMatthias Ringwald * @param passkey 50090a51f88bSMatthias Ringwald * @return 0 if ok 50100a51f88bSMatthias Ringwald */ 50110a51f88bSMatthias Ringwald int gap_ssp_confirmation_response(bd_addr_t addr){ 5012cd74063aSMatthias Ringwald if (hci_stack->gap_pairing_state != GAP_PAIRING_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED; 50130a51f88bSMatthias Ringwald return gap_pairing_set_state_and_run(addr, GAP_PAIRING_STATE_SEND_CONFIRMATION); 50140a51f88bSMatthias Ringwald } 50150a51f88bSMatthias Ringwald 50160a51f88bSMatthias Ringwald /** 50170a51f88bSMatthias Ringwald * @brief Abort SSP Numeric Comparison/Pairing 50180a51f88bSMatthias Ringwald * @param addr 50190a51f88bSMatthias Ringwald * @param pin 50200a51f88bSMatthias Ringwald * @return 0 if ok 50210a51f88bSMatthias Ringwald */ 50220a51f88bSMatthias Ringwald int gap_ssp_confirmation_negative(bd_addr_t addr){ 5023cd74063aSMatthias Ringwald if (hci_stack->gap_pairing_state != GAP_PAIRING_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED; 50240a51f88bSMatthias Ringwald return gap_pairing_set_state_and_run(addr, GAP_PAIRING_STATE_SEND_CONFIRMATION_NEGATIVE); 50250a51f88bSMatthias Ringwald } 50260a51f88bSMatthias Ringwald 5027f5875de5SMatthias Ringwald /** 5028f6858d14SMatthias Ringwald * @brief Set inquiry mode: standard, with RSSI, with RSSI + Extended Inquiry Results. Has to be called before power on. 5029f5875de5SMatthias Ringwald * @param inquiry_mode see bluetooth_defines.h 5030f6858d14SMatthias Ringwald */ 5031f6858d14SMatthias Ringwald void hci_set_inquiry_mode(inquiry_mode_t mode){ 5032f6858d14SMatthias Ringwald hci_stack->inquiry_mode = mode; 5033f6858d14SMatthias Ringwald } 5034f6858d14SMatthias Ringwald 5035f6858d14SMatthias Ringwald /** 5036d950d659SMatthias Ringwald * @brief Configure Voice Setting for use with SCO data in HSP/HFP 5037d950d659SMatthias Ringwald */ 5038d950d659SMatthias Ringwald void hci_set_sco_voice_setting(uint16_t voice_setting){ 5039d950d659SMatthias Ringwald hci_stack->sco_voice_setting = voice_setting; 5040d950d659SMatthias Ringwald } 5041d950d659SMatthias Ringwald 5042d950d659SMatthias Ringwald /** 5043d950d659SMatthias Ringwald * @brief Get SCO Voice Setting 5044d950d659SMatthias Ringwald * @return current voice setting 5045d950d659SMatthias Ringwald */ 50460cb5b971SMatthias Ringwald uint16_t hci_get_sco_voice_setting(void){ 5047d950d659SMatthias Ringwald return hci_stack->sco_voice_setting; 5048d950d659SMatthias Ringwald } 5049d950d659SMatthias Ringwald 50503139d098SMatthias Ringwald #ifdef ENABLE_CLASSIC 5051400ff5abSMatthias Ringwald static int hci_have_usb_transport(void){ 5052400ff5abSMatthias Ringwald if (!hci_stack->hci_transport) return 0; 5053400ff5abSMatthias Ringwald const char * transport_name = hci_stack->hci_transport->name; 5054400ff5abSMatthias Ringwald if (!transport_name) return 0; 5055400ff5abSMatthias Ringwald return (transport_name[0] == 'H') && (transport_name[1] == '2'); 5056400ff5abSMatthias Ringwald } 50573139d098SMatthias Ringwald #endif 5058400ff5abSMatthias Ringwald 5059b3aad8daSMatthias Ringwald /** @brief Get SCO packet length for current SCO Voice setting 5060b3aad8daSMatthias Ringwald * @note Using SCO packets of the exact length is required for USB transfer 5061b3aad8daSMatthias Ringwald * @return Length of SCO packets in bytes (not audio frames) 5062b3aad8daSMatthias Ringwald */ 5063b3aad8daSMatthias Ringwald int hci_get_sco_packet_length(void){ 5064a3069afeSMatthias Ringwald int sco_packet_length = 0; 5065a3069afeSMatthias Ringwald 5066a3069afeSMatthias Ringwald #ifdef ENABLE_CLASSIC 5067a3069afeSMatthias Ringwald #ifdef ENABLE_SCO_OVER_HCI 5068cf119f3bSMatthias Ringwald 50696f28d2eeSMatthias Ringwald // Transparent = mSBC => 1, CVSD with 16-bit samples requires twice as much bytes 50706f28d2eeSMatthias Ringwald int multiplier = ((hci_stack->sco_voice_setting_active & 0x03) == 0x03) ? 1 : 2; 5071cf119f3bSMatthias Ringwald 5072400ff5abSMatthias Ringwald if (hci_have_usb_transport()){ 5073400ff5abSMatthias Ringwald // see Core Spec for H2 USB Transfer. 5074cf119f3bSMatthias Ringwald // 3 byte SCO header + 24 bytes per connection 507552e46257SMatthias Ringwald int num_sco_connections = btstack_max(1, hci_number_sco_connections()); 507652e46257SMatthias Ringwald sco_packet_length = 3 + 24 * num_sco_connections * multiplier; 5077400ff5abSMatthias Ringwald } else { 5078400ff5abSMatthias Ringwald // 3 byte SCO header + SCO packet size over the air (60 bytes) 5079400ff5abSMatthias Ringwald sco_packet_length = 3 + 60 * multiplier; 5080d966a453SMatthias Ringwald // assert that it still fits inside an SCO buffer 5081d966a453SMatthias Ringwald if (sco_packet_length > hci_stack->sco_data_packet_length){ 5082d966a453SMatthias Ringwald sco_packet_length = 3 + 60; 5083d966a453SMatthias Ringwald } 5084400ff5abSMatthias Ringwald } 5085a3069afeSMatthias Ringwald #endif 5086a3069afeSMatthias Ringwald #endif 5087a3069afeSMatthias Ringwald return sco_packet_length; 5088b3aad8daSMatthias Ringwald } 5089b3aad8daSMatthias Ringwald 5090c4c88f1bSJakob Krantz /** 5091c4c88f1bSJakob Krantz * @brief Sets the master/slave policy 5092c4c88f1bSJakob Krantz * @param policy (0: attempt to become master, 1: let connecting device decide) 5093c4c88f1bSJakob Krantz */ 5094c4c88f1bSJakob Krantz void hci_set_master_slave_policy(uint8_t policy){ 5095c4c88f1bSJakob Krantz hci_stack->master_slave_policy = policy; 5096c4c88f1bSJakob Krantz } 5097c4c88f1bSJakob Krantz 5098c4c88f1bSJakob Krantz #endif 5099ec111c8bSMatthias Ringwald 5100ec111c8bSMatthias Ringwald HCI_STATE hci_get_state(void){ 5101ec111c8bSMatthias Ringwald return hci_stack->state; 5102ec111c8bSMatthias Ringwald } 5103ec111c8bSMatthias Ringwald 5104ec111c8bSMatthias Ringwald 5105d950d659SMatthias Ringwald /** 5106d23838ecSMatthias Ringwald * @brief Set callback for Bluetooth Hardware Error 5107d23838ecSMatthias Ringwald */ 5108c2e1fa60SMatthias Ringwald void hci_set_hardware_error_callback(void (*fn)(uint8_t error)){ 5109d23838ecSMatthias Ringwald hci_stack->hardware_error_callback = fn; 5110d23838ecSMatthias Ringwald } 5111d23838ecSMatthias Ringwald 511271de195eSMatthias Ringwald void hci_disconnect_all(void){ 5113665d90f2SMatthias Ringwald btstack_linked_list_iterator_t it; 5114665d90f2SMatthias Ringwald btstack_linked_list_iterator_init(&it, &hci_stack->connections); 5115665d90f2SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 5116665d90f2SMatthias Ringwald hci_connection_t * con = (hci_connection_t*) btstack_linked_list_iterator_next(&it); 511704a6ef8cSmatthias.ringwald if (con->state == SENT_DISCONNECT) continue; 511804a6ef8cSmatthias.ringwald con->state = SEND_DISCONNECT; 511904a6ef8cSmatthias.ringwald } 5120d31fba26S[email protected] hci_run(); 512104a6ef8cSmatthias.ringwald } 512233373e40SMatthias Ringwald 512333373e40SMatthias Ringwald uint16_t hci_get_manufacturer(void){ 512433373e40SMatthias Ringwald return hci_stack->manufacturer; 512533373e40SMatthias Ringwald } 51269c6e867eSMatthias Ringwald 51273e329ddfSandryblack #ifdef ENABLE_BLE 51283e329ddfSandryblack 51299c6e867eSMatthias Ringwald static sm_connection_t * sm_get_connection_for_handle(hci_con_handle_t con_handle){ 51309c6e867eSMatthias Ringwald hci_connection_t * hci_con = hci_connection_for_handle(con_handle); 51319c6e867eSMatthias Ringwald if (!hci_con) return NULL; 51329c6e867eSMatthias Ringwald return &hci_con->sm_connection; 51339c6e867eSMatthias Ringwald } 51349c6e867eSMatthias Ringwald 51359c6e867eSMatthias Ringwald // extracted from sm.c to allow enabling of l2cap le data channels without adding sm.c to the build 51369c6e867eSMatthias Ringwald // without sm.c default values from create_connection_for_bd_addr_and_type() resulg in non-encrypted, not-authenticated 51379c6e867eSMatthias Ringwald 51389c6e867eSMatthias Ringwald int gap_encryption_key_size(hci_con_handle_t con_handle){ 5139*c5fb5ca4SMatthias Ringwald hci_connection_t * hci_connection = hci_connection_for_handle(con_handle); 5140*c5fb5ca4SMatthias Ringwald if (hci_connection == NULL) return 0; 5141*c5fb5ca4SMatthias Ringwald if (hci_is_le_connection(hci_connection)){ 5142*c5fb5ca4SMatthias Ringwald sm_connection_t * sm_conn = &hci_connection->sm_connection; 5143*c5fb5ca4SMatthias Ringwald if (sm_conn->sm_connection_encrypted) { 51449c6e867eSMatthias Ringwald return sm_conn->sm_actual_encryption_key_size; 51459c6e867eSMatthias Ringwald } 5146*c5fb5ca4SMatthias Ringwald } 5147*c5fb5ca4SMatthias Ringwald #ifdef ENABLE_CLASSIC 5148*c5fb5ca4SMatthias Ringwald else { 5149*c5fb5ca4SMatthias Ringwald if ((hci_connection->authentication_flags & CONNECTION_ENCRYPTED)){ 5150*c5fb5ca4SMatthias Ringwald return hci_connection->encryption_key_size; 5151*c5fb5ca4SMatthias Ringwald } 5152*c5fb5ca4SMatthias Ringwald } 5153*c5fb5ca4SMatthias Ringwald #endif 5154*c5fb5ca4SMatthias Ringwald return 0; 5155*c5fb5ca4SMatthias Ringwald } 51569c6e867eSMatthias Ringwald 51579c6e867eSMatthias Ringwald int gap_authenticated(hci_con_handle_t con_handle){ 5158*c5fb5ca4SMatthias Ringwald hci_connection_t * hci_connection = hci_connection_for_handle(con_handle); 5159*c5fb5ca4SMatthias Ringwald if (hci_connection == NULL) return 0; 51605f3981bfSMatthias Ringwald 5161*c5fb5ca4SMatthias Ringwald switch (hci_connection->address_type){ 51625f3981bfSMatthias Ringwald case BD_ADDR_TYPE_LE_PUBLIC: 51635f3981bfSMatthias Ringwald case BD_ADDR_TYPE_LE_RANDOM: 5164*c5fb5ca4SMatthias Ringwald if (hci_connection->sm_connection.sm_connection_encrypted == 0) return 0; // unencrypted connection cannot be authenticated 5165*c5fb5ca4SMatthias Ringwald return hci_connection->sm_connection.sm_connection_authenticated; 516659a1a47aSMatthias Ringwald #ifdef ENABLE_CLASSIC 51675f3981bfSMatthias Ringwald case BD_ADDR_TYPE_SCO: 51685f3981bfSMatthias Ringwald case BD_ADDR_TYPE_CLASSIC: 5169*c5fb5ca4SMatthias Ringwald return gap_authenticated_for_link_key_type(hci_connection->link_key_type); 517059a1a47aSMatthias Ringwald #endif 51715f3981bfSMatthias Ringwald default: 51725f3981bfSMatthias Ringwald return 0; 51735f3981bfSMatthias Ringwald } 51749c6e867eSMatthias Ringwald } 51759c6e867eSMatthias Ringwald 5176f1dfbe18SMatthias Ringwald int gap_secure_connection(hci_con_handle_t con_handle){ 5177*c5fb5ca4SMatthias Ringwald hci_connection_t * hci_connection = hci_connection_for_handle(con_handle); 5178*c5fb5ca4SMatthias Ringwald if (hci_connection == NULL) return 0; 51798b35e16aSMatthias Ringwald 5180*c5fb5ca4SMatthias Ringwald switch (hci_connection->address_type){ 51818b35e16aSMatthias Ringwald case BD_ADDR_TYPE_LE_PUBLIC: 51828b35e16aSMatthias Ringwald case BD_ADDR_TYPE_LE_RANDOM: 5183*c5fb5ca4SMatthias Ringwald if (hci_connection->sm_connection.sm_connection_encrypted == 0) return 0; // unencrypted connection cannot be authenticated 5184*c5fb5ca4SMatthias Ringwald return hci_connection->sm_connection.sm_connection_sc; 518559a1a47aSMatthias Ringwald #ifdef ENABLE_CLASSIC 51868b35e16aSMatthias Ringwald case BD_ADDR_TYPE_SCO: 51878b35e16aSMatthias Ringwald case BD_ADDR_TYPE_CLASSIC: 5188*c5fb5ca4SMatthias Ringwald return gap_secure_connection_for_link_key_type(hci_connection->link_key_type); 518959a1a47aSMatthias Ringwald #endif 51908b35e16aSMatthias Ringwald default: 51918b35e16aSMatthias Ringwald return 0; 51928b35e16aSMatthias Ringwald } 5193f1dfbe18SMatthias Ringwald } 5194f1dfbe18SMatthias Ringwald 51959c6e867eSMatthias Ringwald authorization_state_t gap_authorization_state(hci_con_handle_t con_handle){ 51969c6e867eSMatthias Ringwald sm_connection_t * sm_conn = sm_get_connection_for_handle(con_handle); 51979c6e867eSMatthias Ringwald if (!sm_conn) return AUTHORIZATION_UNKNOWN; // wrong connection 51989c6e867eSMatthias Ringwald if (!sm_conn->sm_connection_encrypted) return AUTHORIZATION_UNKNOWN; // unencrypted connection cannot be authorized 51999c6e867eSMatthias Ringwald if (!sm_conn->sm_connection_authenticated) return AUTHORIZATION_UNKNOWN; // unauthenticatd connection cannot be authorized 52009c6e867eSMatthias Ringwald return sm_conn->sm_connection_authorization_state; 52019c6e867eSMatthias Ringwald } 52029c6e867eSMatthias Ringwald #endif 5203f8ee3071SMatthias Ringwald 5204f8ee3071SMatthias Ringwald #ifdef ENABLE_CLASSIC 5205f8ee3071SMatthias 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){ 5206f8ee3071SMatthias Ringwald hci_connection_t * conn = hci_connection_for_handle(con_handle); 5207f8ee3071SMatthias Ringwald if (!conn) return GAP_CONNECTION_INVALID; 5208f8ee3071SMatthias Ringwald conn->sniff_min_interval = sniff_min_interval; 5209f8ee3071SMatthias Ringwald conn->sniff_max_interval = sniff_max_interval; 5210f8ee3071SMatthias Ringwald conn->sniff_attempt = sniff_attempt; 5211f8ee3071SMatthias Ringwald conn->sniff_timeout = sniff_timeout; 5212f8ee3071SMatthias Ringwald hci_run(); 5213f8ee3071SMatthias Ringwald return 0; 5214f8ee3071SMatthias Ringwald } 5215f8ee3071SMatthias Ringwald 5216f8ee3071SMatthias Ringwald /** 5217f8ee3071SMatthias Ringwald * @brief Exit Sniff mode 5218f8ee3071SMatthias Ringwald * @param con_handle 5219f8ee3071SMatthias Ringwald @ @return 0 if ok 5220f8ee3071SMatthias Ringwald */ 5221f8ee3071SMatthias Ringwald uint8_t gap_sniff_mode_exit(hci_con_handle_t con_handle){ 5222f8ee3071SMatthias Ringwald hci_connection_t * conn = hci_connection_for_handle(con_handle); 5223f8ee3071SMatthias Ringwald if (!conn) return GAP_CONNECTION_INVALID; 5224f8ee3071SMatthias Ringwald conn->sniff_min_interval = 0xffff; 5225f8ee3071SMatthias Ringwald hci_run(); 5226f8ee3071SMatthias Ringwald return 0; 5227f8ee3071SMatthias Ringwald } 5228f8ee3071SMatthias Ringwald #endif 5229beceeddeSMatthias Ringwald 5230beceeddeSMatthias Ringwald void hci_halting_defer(void){ 5231beceeddeSMatthias Ringwald if (hci_stack->state != HCI_STATE_HALTING) return; 5232beceeddeSMatthias Ringwald switch (hci_stack->substate){ 5233beceeddeSMatthias Ringwald case HCI_HALTING_DISCONNECT_ALL_NO_TIMER: 5234beceeddeSMatthias Ringwald case HCI_HALTING_CLOSE: 5235beceeddeSMatthias Ringwald hci_stack->substate = HCI_HALTING_DISCONNECT_ALL_TIMER; 5236beceeddeSMatthias Ringwald break; 5237beceeddeSMatthias Ringwald default: 5238beceeddeSMatthias Ringwald break; 5239beceeddeSMatthias Ringwald } 5240beceeddeSMatthias Ringwald } 5241