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