xref: /btstack/src/hci.c (revision 4e5d21eaa3354e3ff37bdd70d831b2777cacf8a6)
11f504dbdSmatthias.ringwald /*
2a0c35809S[email protected]  * Copyright (C) 2014 BlueKitchen GmbH
31713bceaSmatthias.ringwald  *
41713bceaSmatthias.ringwald  * Redistribution and use in source and binary forms, with or without
51713bceaSmatthias.ringwald  * modification, are permitted provided that the following conditions
61713bceaSmatthias.ringwald  * are met:
71713bceaSmatthias.ringwald  *
81713bceaSmatthias.ringwald  * 1. Redistributions of source code must retain the above copyright
91713bceaSmatthias.ringwald  *    notice, this list of conditions and the following disclaimer.
101713bceaSmatthias.ringwald  * 2. Redistributions in binary form must reproduce the above copyright
111713bceaSmatthias.ringwald  *    notice, this list of conditions and the following disclaimer in the
121713bceaSmatthias.ringwald  *    documentation and/or other materials provided with the distribution.
131713bceaSmatthias.ringwald  * 3. Neither the name of the copyright holders nor the names of
141713bceaSmatthias.ringwald  *    contributors may be used to endorse or promote products derived
151713bceaSmatthias.ringwald  *    from this software without specific prior written permission.
166b64433eSmatthias.ringwald  * 4. Any redistribution, use, or modification is done solely for
176b64433eSmatthias.ringwald  *    personal benefit and not for any commercial purpose or for
186b64433eSmatthias.ringwald  *    monetary gain.
191713bceaSmatthias.ringwald  *
20a0c35809S[email protected]  * THIS SOFTWARE IS PROVIDED BY BLUEKITCHEN GMBH AND CONTRIBUTORS
211713bceaSmatthias.ringwald  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
221713bceaSmatthias.ringwald  * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
231713bceaSmatthias.ringwald  * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL MATTHIAS
241713bceaSmatthias.ringwald  * RINGWALD OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
251713bceaSmatthias.ringwald  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
261713bceaSmatthias.ringwald  * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
271713bceaSmatthias.ringwald  * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
281713bceaSmatthias.ringwald  * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
291713bceaSmatthias.ringwald  * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF
301713bceaSmatthias.ringwald  * THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
311713bceaSmatthias.ringwald  * SUCH DAMAGE.
321713bceaSmatthias.ringwald  *
33a0c35809S[email protected]  * Please inquire about commercial licensing options at
34a0c35809S[email protected]  * [email protected]
356b64433eSmatthias.ringwald  *
361713bceaSmatthias.ringwald  */
371713bceaSmatthias.ringwald 
38e501bae0SMatthias Ringwald #define BTSTACK_FILE__ "hci.c"
39ab2c6ae4SMatthias Ringwald 
401713bceaSmatthias.ringwald /*
411f504dbdSmatthias.ringwald  *  hci.c
421f504dbdSmatthias.ringwald  *
431f504dbdSmatthias.ringwald  *  Created by Matthias Ringwald on 4/29/09.
441f504dbdSmatthias.ringwald  *
451f504dbdSmatthias.ringwald  */
461f504dbdSmatthias.ringwald 
477907f069SMatthias Ringwald #include "btstack_config.h"
4828171530Smatthias.ringwald 
497f2435e6Smatthias.ringwald 
5006b9e820SMatthias Ringwald #ifdef ENABLE_CLASSIC
51aec7654dSMatthias Ringwald #ifdef HAVE_EMBEDDED_TICK
528f2a52f4SMatthias Ringwald #include "btstack_run_loop_embedded.h"
53a484130cSMatthias Ringwald #endif
5406b9e820SMatthias Ringwald #endif
55a484130cSMatthias Ringwald 
564a3574a1SMatthias Ringwald #ifdef HAVE_PLATFORM_IPHONE_OS
57d0b87befSMatthias Ringwald #include "../port/ios/src/btstack_control_iphone.h"
584a3574a1SMatthias Ringwald #endif
594a3574a1SMatthias Ringwald 
60a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE
61472a5742SMatthias Ringwald #include "gap.h"
6221debf25SMatthias Ringwald #include "ble/le_device_db.h"
6345c102fdSMatthias Ringwald #endif
6445c102fdSMatthias Ringwald 
6593b8dc03Smatthias.ringwald #include <stdarg.h>
6693b8dc03Smatthias.ringwald #include <string.h>
675838a2edSMatthias Ringwald #include <inttypes.h>
687f2435e6Smatthias.ringwald 
6916ece135SMatthias Ringwald #include "btstack_debug.h"
700e2df43fSMatthias Ringwald #include "btstack_event.h"
714a3574a1SMatthias Ringwald #include "btstack_linked_list.h"
724a3574a1SMatthias Ringwald #include "btstack_memory.h"
7361f37892SMatthias Ringwald #include "bluetooth_company_id.h"
741cfb383eSMatthias Ringwald #include "bluetooth_data_types.h"
754a3574a1SMatthias Ringwald #include "gap.h"
764a3574a1SMatthias Ringwald #include "hci.h"
774a3574a1SMatthias Ringwald #include "hci_cmd.h"
78d8905019Smatthias.ringwald #include "hci_dump.h"
791cfb383eSMatthias Ringwald #include "ad_parser.h"
8093b8dc03Smatthias.ringwald 
812b838201SMatthias Ringwald #ifdef ENABLE_HCI_CONTROLLER_TO_HOST_FLOW_CONTROL
822b838201SMatthias Ringwald #ifndef HCI_HOST_ACL_PACKET_NUM
832b838201SMatthias Ringwald #error "ENABLE_HCI_CONTROLLER_TO_HOST_FLOW_CONTROL requires to define HCI_HOST_ACL_PACKET_NUM"
842b838201SMatthias Ringwald #endif
852b838201SMatthias Ringwald #ifndef HCI_HOST_ACL_PACKET_LEN
862b838201SMatthias Ringwald #error "ENABLE_HCI_CONTROLLER_TO_HOST_FLOW_CONTROL requires to define HCI_HOST_ACL_PACKET_LEN"
872b838201SMatthias Ringwald #endif
882b838201SMatthias Ringwald #ifndef HCI_HOST_SCO_PACKET_NUM
892b838201SMatthias Ringwald #error "ENABLE_HCI_CONTROLLER_TO_HOST_FLOW_CONTROL requires to define HCI_HOST_SCO_PACKET_NUM"
902b838201SMatthias Ringwald #endif
912b838201SMatthias Ringwald #ifndef HCI_HOST_SCO_PACKET_LEN
922b838201SMatthias Ringwald #error "ENABLE_HCI_CONTROLLER_TO_HOST_FLOW_CONTROL requires to define HCI_HOST_SCO_PACKET_LEN"
932b838201SMatthias Ringwald #endif
942b838201SMatthias Ringwald #endif
951b0e3922Smatthias.ringwald 
96aa81e641SMatthias Ringwald #if defined(ENABLE_SCO_OVER_HCI) && defined(ENABLE_SCO_OVER_PCM)
97aa81e641SMatthias Ringwald #error "SCO data can either be routed over HCI or over PCM, but not over both. Please only enable ENABLE_SCO_OVER_HCI or ENABLE_SCO_OVER_PCM."
98aa81e641SMatthias Ringwald #endif
99aa81e641SMatthias Ringwald 
1001e20a53eSMatthias Ringwald #if defined(ENABLE_SCO_OVER_HCI) && defined(HAVE_SCO_TRANSPORT)
1011e20a53eSMatthias Ringwald #error "SCO data can either be routed over HCI or over PCM, but not over both. Please only enable ENABLE_SCO_OVER_HCI or HAVE_SCO_TRANSPORT."
1021e20a53eSMatthias Ringwald #endif
1031e20a53eSMatthias Ringwald 
104169f8b28Smatthias.ringwald #define HCI_CONNECTION_TIMEOUT_MS 10000
10562473419SMatthias Ringwald 
10662473419SMatthias Ringwald #ifndef HCI_RESET_RESEND_TIMEOUT_MS
107659d758cSMatthias Ringwald #define HCI_RESET_RESEND_TIMEOUT_MS 200
10862473419SMatthias Ringwald #endif
109ee091cf1Smatthias.ringwald 
1101cfb383eSMatthias Ringwald // Names are arbitrarily shortened to 32 bytes if not requested otherwise
1111cfb383eSMatthias Ringwald #ifndef GAP_INQUIRY_MAX_NAME_LEN
1121cfb383eSMatthias Ringwald #define GAP_INQUIRY_MAX_NAME_LEN 32
1131cfb383eSMatthias Ringwald #endif
1141cfb383eSMatthias Ringwald 
115f5875de5SMatthias Ringwald // GAP inquiry state: 0 = off, 0x01 - 0x30 = requested duration, 0xfe = active, 0xff = stop requested
116f5875de5SMatthias Ringwald #define GAP_INQUIRY_DURATION_MIN       0x01
117f5875de5SMatthias Ringwald #define GAP_INQUIRY_DURATION_MAX       0x30
118beb3c81dSMatthias Ringwald #define GAP_INQUIRY_STATE_IDLE         0x00
119beb3c81dSMatthias Ringwald #define GAP_INQUIRY_STATE_W4_ACTIVE    0x80
120beb3c81dSMatthias Ringwald #define GAP_INQUIRY_STATE_ACTIVE       0x81
121beb3c81dSMatthias Ringwald #define GAP_INQUIRY_STATE_W2_CANCEL    0x82
122beb3c81dSMatthias Ringwald #define GAP_INQUIRY_STATE_W4_CANCELLED 0x83
123f5875de5SMatthias Ringwald 
124b7f1ee76SMatthias Ringwald // GAP Remote Name Request
125b7f1ee76SMatthias Ringwald #define GAP_REMOTE_NAME_STATE_IDLE 0
126b7f1ee76SMatthias Ringwald #define GAP_REMOTE_NAME_STATE_W2_SEND 1
127b7f1ee76SMatthias Ringwald #define GAP_REMOTE_NAME_STATE_W4_COMPLETE 2
128b7f1ee76SMatthias Ringwald 
1290a51f88bSMatthias Ringwald // GAP Pairing
1300a51f88bSMatthias Ringwald #define GAP_PAIRING_STATE_IDLE                       0
1310a51f88bSMatthias Ringwald #define GAP_PAIRING_STATE_SEND_PIN                   1
1320a51f88bSMatthias Ringwald #define GAP_PAIRING_STATE_SEND_PIN_NEGATIVE          2
1330a51f88bSMatthias Ringwald #define GAP_PAIRING_STATE_SEND_PASSKEY               3
1340a51f88bSMatthias Ringwald #define GAP_PAIRING_STATE_SEND_PASSKEY_NEGATIVE      4
1350a51f88bSMatthias Ringwald #define GAP_PAIRING_STATE_SEND_CONFIRMATION          5
1360a51f88bSMatthias Ringwald #define GAP_PAIRING_STATE_SEND_CONFIRMATION_NEGATIVE 6
1370a51f88bSMatthias Ringwald 
1380a51f88bSMatthias Ringwald 
139b83d5eabSMatthias Ringwald // prototypes
14035454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
141758b46ceSmatthias.ringwald static void hci_update_scan_enable(void);
14235454696SMatthias Ringwald static void hci_emit_discoverable_enabled(uint8_t enabled);
14335454696SMatthias Ringwald static int  hci_local_ssp_activated(void);
14435454696SMatthias Ringwald static int  hci_remote_ssp_supported(hci_con_handle_t con_handle);
14567aae551SMatthias Ringwald static bool hci_ssp_supported(hci_connection_t * connection);
14635454696SMatthias Ringwald static void hci_notify_if_sco_can_send_now(void);
14735454696SMatthias Ringwald static void hci_emit_connection_complete(bd_addr_t address, hci_con_handle_t con_handle, uint8_t status);
148a00031e2S[email protected] static gap_security_level_t gap_security_level_for_connection(hci_connection_t * connection);
14935454696SMatthias Ringwald static void hci_emit_security_level(hci_con_handle_t con_handle, gap_security_level_t level);
150ec820d77SMatthias Ringwald static void hci_connection_timeout_handler(btstack_timer_source_t *timer);
15196a45072S[email protected] static void hci_connection_timestamp(hci_connection_t *connection);
15252db98b2SMatthias Ringwald static void hci_emit_l2cap_check_timeout(hci_connection_t *conn);
1539784dac1SMatthias Ringwald static void gap_inquiry_explode(uint8_t *packet, uint16_t size);
15452db98b2SMatthias Ringwald #endif
1551cfb383eSMatthias Ringwald 
1567586ee35S[email protected] static int  hci_power_control_on(void);
1577586ee35S[email protected] static void hci_power_control_off(void);
1586da48142SSean Wilson static void hci_state_reset(void);
159fd43c0e0SMatthias Ringwald static void hci_emit_transport_packet_sent(void);
160fc64f94aSMatthias Ringwald static void hci_emit_disconnection_complete(hci_con_handle_t con_handle, uint8_t reason);
161b83d5eabSMatthias Ringwald static void hci_emit_nr_connections_changed(void);
162b83d5eabSMatthias Ringwald static void hci_emit_hci_open_failed(void);
163b83d5eabSMatthias Ringwald static void hci_emit_dedicated_bonding_result(bd_addr_t address, uint8_t status);
164b83d5eabSMatthias Ringwald static void hci_emit_event(uint8_t * event, uint16_t size, int dump);
165b83d5eabSMatthias Ringwald static void hci_emit_acl_packet(uint8_t * packet, uint16_t size);
16695d71764SMatthias Ringwald static void hci_run(void);
16795d71764SMatthias Ringwald static int  hci_is_le_connection(hci_connection_t * connection);
16895d71764SMatthias Ringwald static int  hci_number_free_acl_slots_for_connection_type( bd_addr_type_t address_type);
1696a5ffed8SMatthias Ringwald 
1706a5ffed8SMatthias Ringwald #ifdef ENABLE_CLASSIC
171f234b250SMatthias Ringwald static int hci_have_usb_transport(void);
1726a5ffed8SMatthias Ringwald #endif
1735d509858SMatthias Ringwald 
174a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE
175e8c8828eSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
17639677e66SMatthias Ringwald // called from test/ble_client/advertising_data_parser.c
177384b59deSMatthias Ringwald void le_handle_advertisement_report(uint8_t *packet, uint16_t size);
178667ba9d1SMatthias Ringwald static uint8_t hci_whitelist_remove(bd_addr_type_t address_type, const bd_addr_t address);
1799c77c9dbSMatthias Ringwald static hci_connection_t * gap_get_outgoing_connection(void);
1805d509858SMatthias Ringwald #endif
181d70217a2SMatthias Ringwald #endif
182758b46ceSmatthias.ringwald 
18306b35ec0Smatthias.ringwald // the STACK is here
1843a9fb326S[email protected] #ifndef HAVE_MALLOC
1853a9fb326S[email protected] static hci_stack_t   hci_stack_static;
1863a9fb326S[email protected] #endif
1873a9fb326S[email protected] static hci_stack_t * hci_stack = NULL;
18816833f0aSmatthias.ringwald 
1891c9e5e9dSMatthias Ringwald #ifdef ENABLE_CLASSIC
19063168530SMatthias Ringwald // default name
19163168530SMatthias Ringwald static const char * default_classic_name = "BTstack 00:00:00:00:00:00";
19263168530SMatthias Ringwald 
19366fb9560S[email protected] // test helper
19466fb9560S[email protected] static uint8_t disable_l2cap_timeouts = 0;
1951c9e5e9dSMatthias Ringwald #endif
19666fb9560S[email protected] 
19796a45072S[email protected] /**
19896a45072S[email protected]  * create connection for given address
19996a45072S[email protected]  *
20096a45072S[email protected]  * @return connection OR NULL, if no memory left
20196a45072S[email protected]  */
202667ba9d1SMatthias Ringwald static hci_connection_t * create_connection_for_bd_addr_and_type(const bd_addr_t addr, bd_addr_type_t addr_type){
2031a06f663S[email protected]     log_info("create_connection_for_addr %s, type %x", bd_addr_to_str(addr), addr_type);
204bb69aaaeS[email protected]     hci_connection_t * conn = btstack_memory_hci_connection_get();
20596a45072S[email protected]     if (!conn) return NULL;
206058e3d6bSMatthias Ringwald     bd_addr_copy(conn->address, addr);
2072dceb1d6SMatthias Ringwald     conn->role = HCI_ROLE_INVALID;
20896a45072S[email protected]     conn->address_type = addr_type;
20996a45072S[email protected]     conn->con_handle = 0xffff;
21096a45072S[email protected]     conn->authentication_flags = AUTH_FLAGS_NONE;
21196a45072S[email protected]     conn->bonding_flags = 0;
21296a45072S[email protected]     conn->requested_security_level = LEVEL_0;
21352db98b2SMatthias Ringwald #ifdef ENABLE_CLASSIC
21488a03c8dSMatthias Ringwald     conn->request_role = HCI_ROLE_INVALID;
215140c0557SMatthias Ringwald     conn->sniff_subrating_max_latency = 0xffff;
216278ff8a9SMatthias 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 
39480ca58a0Smatthias.ringwald int  hci_authentication_active_for_handle(hci_con_handle_t handle){
3955061f3afS[email protected]     hci_connection_t * conn = hci_connection_for_handle(handle);
39680ca58a0Smatthias.ringwald     if (!conn) return 0;
3976724cd9eS[email protected]     if (conn->authentication_flags & LEGACY_PAIRING_ACTIVE) return 1;
3986724cd9eS[email protected]     if (conn->authentication_flags & SSP_PAIRING_ACTIVE) return 1;
3996724cd9eS[email protected]     return 0;
40080ca58a0Smatthias.ringwald }
40180ca58a0Smatthias.ringwald 
40215a95bd5SMatthias Ringwald void gap_drop_link_key_for_bd_addr(bd_addr_t addr){
40355597469SMatthias Ringwald     if (!hci_stack->link_key_db) return;
4042bacf595SMatthias Ringwald     log_info("gap_drop_link_key_for_bd_addr: %s", bd_addr_to_str(addr));
405a98592bcSMatthias Ringwald     hci_stack->link_key_db->delete_link_key(addr);
406c12e46e7Smatthias.ringwald }
40755597469SMatthias Ringwald 
40855597469SMatthias Ringwald void gap_store_link_key_for_bd_addr(bd_addr_t addr, link_key_t link_key, link_key_type_t type){
40955597469SMatthias Ringwald     if (!hci_stack->link_key_db) return;
4102bacf595SMatthias Ringwald     log_info("gap_store_link_key_for_bd_addr: %s, type %u", bd_addr_to_str(addr), type);
41155597469SMatthias Ringwald     hci_stack->link_key_db->put_link_key(addr, link_key, type);
412c12e46e7Smatthias.ringwald }
4131b6fb31bSMatthias Ringwald 
414e8ad470fSMatthias Ringwald bool gap_get_link_key_for_bd_addr(bd_addr_t addr, link_key_t link_key, link_key_type_t * type){
415e8ad470fSMatthias Ringwald 	if (!hci_stack->link_key_db) return false;
41676b0318eSMatthias Ringwald 	int result = hci_stack->link_key_db->get_link_key(addr, link_key, type) != 0;
41776b0318eSMatthias Ringwald 	log_info("link key for %s available %u, type %u", bd_addr_to_str(addr), result, (int) *type);
41876b0318eSMatthias Ringwald 	return result;
419e8ad470fSMatthias Ringwald }
420e8ad470fSMatthias Ringwald 
421ceecb9d9SMatthias Ringwald void gap_delete_all_link_keys(void){
422ceecb9d9SMatthias Ringwald     bd_addr_t  addr;
423ceecb9d9SMatthias Ringwald     link_key_t link_key;
424ceecb9d9SMatthias Ringwald     link_key_type_t type;
425ceecb9d9SMatthias Ringwald     btstack_link_key_iterator_t it;
426ceecb9d9SMatthias Ringwald     int ok = gap_link_key_iterator_init(&it);
427ceecb9d9SMatthias Ringwald     if (!ok) {
428ceecb9d9SMatthias Ringwald         log_error("could not initialize iterator");
429ceecb9d9SMatthias Ringwald         return;
430ceecb9d9SMatthias Ringwald     }
431ceecb9d9SMatthias Ringwald     while (gap_link_key_iterator_get_next(&it, addr, link_key, &type)){
432ceecb9d9SMatthias Ringwald         gap_drop_link_key_for_bd_addr(addr);
433ceecb9d9SMatthias Ringwald     }
434ceecb9d9SMatthias Ringwald     gap_link_key_iterator_done(&it);
435ceecb9d9SMatthias Ringwald }
436ceecb9d9SMatthias Ringwald 
4371b6fb31bSMatthias Ringwald int gap_link_key_iterator_init(btstack_link_key_iterator_t * it){
4381b6fb31bSMatthias Ringwald     if (!hci_stack->link_key_db) return 0;
4391b6fb31bSMatthias Ringwald     if (!hci_stack->link_key_db->iterator_init) return 0;
4401b6fb31bSMatthias Ringwald     return hci_stack->link_key_db->iterator_init(it);
4411b6fb31bSMatthias Ringwald }
4421b6fb31bSMatthias 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){
4431b6fb31bSMatthias Ringwald     if (!hci_stack->link_key_db) return 0;
4441b6fb31bSMatthias Ringwald     return hci_stack->link_key_db->iterator_get_next(it, bd_addr, link_key, type);
4451b6fb31bSMatthias Ringwald }
4461b6fb31bSMatthias Ringwald void gap_link_key_iterator_done(btstack_link_key_iterator_t * it){
4471b6fb31bSMatthias Ringwald     if (!hci_stack->link_key_db) return;
4481b6fb31bSMatthias Ringwald     hci_stack->link_key_db->iterator_done(it);
4491b6fb31bSMatthias Ringwald }
45035454696SMatthias Ringwald #endif
451c12e46e7Smatthias.ringwald 
452eb8076ddSMatthias Ringwald static bool hci_is_le_connection_type(bd_addr_type_t address_type){
453eb8076ddSMatthias Ringwald     switch (address_type){
454ce41473eSMatthias Ringwald         case BD_ADDR_TYPE_LE_PUBLIC:
455ce41473eSMatthias Ringwald         case BD_ADDR_TYPE_LE_RANDOM:
456ce41473eSMatthias Ringwald         case BD_ADDR_TYPE_LE_PRIVAT_FALLBACK_PUBLIC:
457ce41473eSMatthias Ringwald         case BD_ADDR_TYPE_LE_PRIVAT_FALLBACK_RANDOM:
458eb8076ddSMatthias Ringwald             return true;
459ce41473eSMatthias Ringwald         default:
460eb8076ddSMatthias Ringwald             return false;
461ce41473eSMatthias Ringwald     }
4620bf6344aS[email protected] }
4630bf6344aS[email protected] 
464eb8076ddSMatthias Ringwald static int hci_is_le_connection(hci_connection_t * connection){
465eb8076ddSMatthias Ringwald     return hci_is_le_connection_type(connection->address_type);
466eb8076ddSMatthias Ringwald }
467eb8076ddSMatthias Ringwald 
4687fde4af9Smatthias.ringwald /**
46943bfb1bdSmatthias.ringwald  * count connections
47043bfb1bdSmatthias.ringwald  */
47140d1c7a4Smatthias.ringwald static int nr_hci_connections(void){
47256c253c9Smatthias.ringwald     int count = 0;
473665d90f2SMatthias Ringwald     btstack_linked_item_t *it;
474a0da043fSMatthias Ringwald     for (it = (btstack_linked_item_t *) hci_stack->connections; it != NULL ; it = it->next){
47515a27967SMatthias Ringwald         count++;
47615a27967SMatthias Ringwald     }
47743bfb1bdSmatthias.ringwald     return count;
47843bfb1bdSmatthias.ringwald }
479c8e4258aSmatthias.ringwald 
48095d71764SMatthias Ringwald static int hci_number_free_acl_slots_for_connection_type(bd_addr_type_t address_type){
481ee303eddS[email protected] 
482f04a0c31SMatthias Ringwald     unsigned int num_packets_sent_classic = 0;
483f04a0c31SMatthias Ringwald     unsigned int num_packets_sent_le = 0;
484ee303eddS[email protected] 
485665d90f2SMatthias Ringwald     btstack_linked_item_t *it;
486a0da043fSMatthias Ringwald     for (it = (btstack_linked_item_t *) hci_stack->connections; it != NULL; it = it->next){
487998906cdSmatthias.ringwald         hci_connection_t * connection = (hci_connection_t *) it;
488ce41473eSMatthias Ringwald         if (hci_is_le_connection(connection)){
489ce41473eSMatthias Ringwald             num_packets_sent_le += connection->num_packets_sent;
490ce41473eSMatthias Ringwald         }
491f16129ceSMatthias Ringwald         if (connection->address_type == BD_ADDR_TYPE_ACL){
492ce41473eSMatthias Ringwald             num_packets_sent_classic += connection->num_packets_sent;
493ee303eddS[email protected]         }
494ee303eddS[email protected]     }
495d999b54eSMatthias Ringwald     log_debug("ACL classic buffers: %u used of %u", num_packets_sent_classic, hci_stack->acl_packets_total_num);
496ee303eddS[email protected]     int free_slots_classic = hci_stack->acl_packets_total_num - num_packets_sent_classic;
497ee303eddS[email protected]     int free_slots_le = 0;
498ee303eddS[email protected] 
499ee303eddS[email protected]     if (free_slots_classic < 0){
5009da54300S[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);
501998906cdSmatthias.ringwald         return 0;
502998906cdSmatthias.ringwald     }
503ee303eddS[email protected] 
504ee303eddS[email protected]     if (hci_stack->le_acl_packets_total_num){
505ee303eddS[email protected]         // if we have LE slots, they are used
506ee303eddS[email protected]         free_slots_le = hci_stack->le_acl_packets_total_num - num_packets_sent_le;
507ee303eddS[email protected]         if (free_slots_le < 0){
5089da54300S[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);
509ee303eddS[email protected]             return 0;
510998906cdSmatthias.ringwald         }
511ee303eddS[email protected]     } else {
512ee303eddS[email protected]         // otherwise, classic slots are used for LE, too
513ee303eddS[email protected]         free_slots_classic -= num_packets_sent_le;
514ee303eddS[email protected]         if (free_slots_classic < 0){
5159da54300S[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);
516ee303eddS[email protected]             return 0;
517ee303eddS[email protected]         }
518ee303eddS[email protected]     }
519ee303eddS[email protected] 
520ee303eddS[email protected]     switch (address_type){
521ee303eddS[email protected]         case BD_ADDR_TYPE_UNKNOWN:
5222125de09SMatthias Ringwald             log_error("hci_number_free_acl_slots: unknown address type");
523ee303eddS[email protected]             return 0;
524ee303eddS[email protected] 
525f16129ceSMatthias Ringwald         case BD_ADDR_TYPE_ACL:
526ee303eddS[email protected]             return free_slots_classic;
527ee303eddS[email protected] 
528ee303eddS[email protected]         default:
529cb00d3aaS[email protected]            if (hci_stack->le_acl_packets_total_num){
530ee303eddS[email protected]                return free_slots_le;
531ee303eddS[email protected]            }
532cb00d3aaS[email protected]            return free_slots_classic;
533cb00d3aaS[email protected]     }
534998906cdSmatthias.ringwald }
535998906cdSmatthias.ringwald 
5362125de09SMatthias Ringwald int hci_number_free_acl_slots_for_handle(hci_con_handle_t con_handle){
5372125de09SMatthias Ringwald     // get connection type
5382125de09SMatthias Ringwald     hci_connection_t * connection = hci_connection_for_handle(con_handle);
5392125de09SMatthias Ringwald     if (!connection){
5402125de09SMatthias Ringwald         log_error("hci_number_free_acl_slots: handle 0x%04x not in connection list", con_handle);
5412125de09SMatthias Ringwald         return 0;
5422125de09SMatthias Ringwald     }
5432125de09SMatthias Ringwald     return hci_number_free_acl_slots_for_connection_type(connection->address_type);
5442125de09SMatthias Ringwald }
5452125de09SMatthias Ringwald 
54635454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
547701e3307SMatthias Ringwald static int hci_number_free_sco_slots(void){
548f04a0c31SMatthias Ringwald     unsigned int num_sco_packets_sent  = 0;
549665d90f2SMatthias Ringwald     btstack_linked_item_t *it;
550760b20efSMatthias Ringwald     if (hci_stack->synchronous_flow_control_enabled){
551760b20efSMatthias Ringwald         // explicit flow control
552665d90f2SMatthias Ringwald         for (it = (btstack_linked_item_t *) hci_stack->connections; it ; it = it->next){
553e35edcc1S[email protected]             hci_connection_t * connection = (hci_connection_t *) it;
554ce41473eSMatthias Ringwald             if (connection->address_type != BD_ADDR_TYPE_SCO) continue;
555ce41473eSMatthias Ringwald             num_sco_packets_sent += connection->num_packets_sent;
556e35edcc1S[email protected]         }
557e35edcc1S[email protected]         if (num_sco_packets_sent > hci_stack->sco_packets_total_num){
558701e3307SMatthias Ringwald             log_info("hci_number_free_sco_slots:packets (%u) > total packets (%u)", num_sco_packets_sent, hci_stack->sco_packets_total_num);
55944d0e3d5S[email protected]             return 0;
56044d0e3d5S[email protected]         }
561e35edcc1S[email protected]         return hci_stack->sco_packets_total_num - num_sco_packets_sent;
56249205f5dSMatthias Ringwald     } else {
56349205f5dSMatthias Ringwald         // implicit flow control -- TODO
5646f28d2eeSMatthias Ringwald         int num_ready = 0;
5656f28d2eeSMatthias Ringwald         for (it = (btstack_linked_item_t *) hci_stack->connections; it ; it = it->next){
5666f28d2eeSMatthias Ringwald             hci_connection_t * connection = (hci_connection_t *) it;
5676f28d2eeSMatthias Ringwald             if (connection->address_type != BD_ADDR_TYPE_SCO) continue;
5686f28d2eeSMatthias Ringwald             if (connection->sco_tx_ready == 0) continue;
5696f28d2eeSMatthias Ringwald             num_ready++;
57049205f5dSMatthias Ringwald         }
5716f28d2eeSMatthias Ringwald         return num_ready;
5726f28d2eeSMatthias Ringwald     }
573e35edcc1S[email protected] }
57435454696SMatthias Ringwald #endif
57544d0e3d5S[email protected] 
5762b838201SMatthias Ringwald // only used to send HCI Host Number Completed Packets
5772b838201SMatthias Ringwald static int hci_can_send_comand_packet_transport(void){
578ac928cc2S[email protected]     if (hci_stack->hci_packet_buffer_reserved) return 0;
579ac928cc2S[email protected] 
580ac928cc2S[email protected]     // check for async hci transport implementations
581ac928cc2S[email protected]     if (hci_stack->hci_transport->can_send_packet_now){
582ac928cc2S[email protected]         if (!hci_stack->hci_transport->can_send_packet_now(HCI_COMMAND_DATA_PACKET)){
583ac928cc2S[email protected]             return 0;
584ac928cc2S[email protected]         }
585ac928cc2S[email protected]     }
5862b838201SMatthias Ringwald     return 1;
5872b838201SMatthias Ringwald }
588ac928cc2S[email protected] 
5892b838201SMatthias Ringwald // new functions replacing hci_can_send_packet_now[_using_packet_buffer]
5902b838201SMatthias Ringwald int hci_can_send_command_packet_now(void){
5912b838201SMatthias Ringwald     if (hci_can_send_comand_packet_transport() == 0) return 0;
5924ea43905SMatthias Ringwald     return hci_stack->num_cmd_packets > 0u;
593ac928cc2S[email protected] }
594ac928cc2S[email protected] 
5959d04d3a7SMatthias Ringwald static int hci_transport_can_send_prepared_packet_now(uint8_t packet_type){
596ac928cc2S[email protected]     // check for async hci transport implementations
5979d04d3a7SMatthias Ringwald     if (!hci_stack->hci_transport->can_send_packet_now) return 1;
5989d04d3a7SMatthias Ringwald     return hci_stack->hci_transport->can_send_packet_now(packet_type);
599ac928cc2S[email protected] }
6009d04d3a7SMatthias Ringwald 
6019d04d3a7SMatthias Ringwald static int hci_can_send_prepared_acl_packet_for_address_type(bd_addr_type_t address_type){
6029d04d3a7SMatthias Ringwald     if (!hci_transport_can_send_prepared_packet_now(HCI_ACL_DATA_PACKET)) return 0;
6039d04d3a7SMatthias Ringwald     return hci_number_free_acl_slots_for_connection_type(address_type) > 0;
604ac928cc2S[email protected] }
6059d04d3a7SMatthias Ringwald 
6069d04d3a7SMatthias Ringwald int hci_can_send_acl_le_packet_now(void){
6079d04d3a7SMatthias Ringwald     if (hci_stack->hci_packet_buffer_reserved) return 0;
6089d04d3a7SMatthias Ringwald     return hci_can_send_prepared_acl_packet_for_address_type(BD_ADDR_TYPE_LE_PUBLIC);
6099d04d3a7SMatthias Ringwald }
6109d04d3a7SMatthias Ringwald 
6119d04d3a7SMatthias Ringwald int hci_can_send_prepared_acl_packet_now(hci_con_handle_t con_handle) {
6129d04d3a7SMatthias Ringwald     if (!hci_transport_can_send_prepared_packet_now(HCI_ACL_DATA_PACKET)) return 0;
613e79abdd6S[email protected]     return hci_number_free_acl_slots_for_handle(con_handle) > 0;
614ac928cc2S[email protected] }
615ac928cc2S[email protected] 
616ac928cc2S[email protected] int hci_can_send_acl_packet_now(hci_con_handle_t con_handle){
617ac928cc2S[email protected]     if (hci_stack->hci_packet_buffer_reserved) return 0;
618ac928cc2S[email protected]     return hci_can_send_prepared_acl_packet_now(con_handle);
6196b4af23dS[email protected] }
6206b4af23dS[email protected] 
62135454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
62235454696SMatthias Ringwald int hci_can_send_acl_classic_packet_now(void){
62335454696SMatthias Ringwald     if (hci_stack->hci_packet_buffer_reserved) return 0;
624f16129ceSMatthias Ringwald     return hci_can_send_prepared_acl_packet_for_address_type(BD_ADDR_TYPE_ACL);
62535454696SMatthias Ringwald }
62635454696SMatthias Ringwald 
627701e3307SMatthias Ringwald int hci_can_send_prepared_sco_packet_now(void){
628d057580eSMatthias Ringwald     if (!hci_transport_can_send_prepared_packet_now(HCI_SCO_DATA_PACKET)) return 0;
629f234b250SMatthias Ringwald     if (hci_have_usb_transport()){
630f234b250SMatthias Ringwald         return hci_stack->sco_can_send_now;
631f234b250SMatthias Ringwald     } else {
632701e3307SMatthias Ringwald         return hci_number_free_sco_slots() > 0;
63344d0e3d5S[email protected]     }
634f234b250SMatthias Ringwald }
63544d0e3d5S[email protected] 
636701e3307SMatthias Ringwald int hci_can_send_sco_packet_now(void){
637d057580eSMatthias Ringwald     if (hci_stack->hci_packet_buffer_reserved) return 0;
638701e3307SMatthias Ringwald     return hci_can_send_prepared_sco_packet_now();
63944d0e3d5S[email protected] }
64044d0e3d5S[email protected] 
641d057580eSMatthias Ringwald void hci_request_sco_can_send_now_event(void){
642d057580eSMatthias Ringwald     hci_stack->sco_waiting_for_can_send_now = 1;
643d057580eSMatthias Ringwald     hci_notify_if_sco_can_send_now();
644d057580eSMatthias Ringwald }
64535454696SMatthias Ringwald #endif
646d057580eSMatthias Ringwald 
64795d71764SMatthias Ringwald // used for internal checks in l2cap.c
648c8b9416aS[email protected] int hci_is_packet_buffer_reserved(void){
649c8b9416aS[email protected]     return hci_stack->hci_packet_buffer_reserved;
650c8b9416aS[email protected] }
651c8b9416aS[email protected] 
6526b4af23dS[email protected] // reserves outgoing packet buffer. @returns 1 if successful
6536b4af23dS[email protected] int hci_reserve_packet_buffer(void){
6549d14b626S[email protected]     if (hci_stack->hci_packet_buffer_reserved) {
6559d14b626S[email protected]         log_error("hci_reserve_packet_buffer called but buffer already reserved");
6569d14b626S[email protected]         return 0;
6579d14b626S[email protected]     }
6586b4af23dS[email protected]     hci_stack->hci_packet_buffer_reserved = 1;
6596b4af23dS[email protected]     return 1;
6606b4af23dS[email protected] }
6616b4af23dS[email protected] 
66268a0fcf7S[email protected] void hci_release_packet_buffer(void){
66368a0fcf7S[email protected]     hci_stack->hci_packet_buffer_reserved = 0;
66468a0fcf7S[email protected] }
66568a0fcf7S[email protected] 
6666b4af23dS[email protected] // assumption: synchronous implementations don't provide can_send_packet_now as they don't keep the buffer after the call
6677f02f414SMatthias Ringwald static int hci_transport_synchronous(void){
6686b4af23dS[email protected]     return hci_stack->hci_transport->can_send_packet_now == NULL;
6696b4af23dS[email protected] }
6706b4af23dS[email protected] 
671452cf3bbS[email protected] static int hci_send_acl_packet_fragments(hci_connection_t *connection){
672452cf3bbS[email protected] 
673452cf3bbS[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);
674452cf3bbS[email protected] 
675452cf3bbS[email protected]     // max ACL data packet length depends on connection type (LE vs. Classic) and available buffers
676452cf3bbS[email protected]     uint16_t max_acl_data_packet_length = hci_stack->acl_data_packet_length;
6774ea43905SMatthias Ringwald     if (hci_is_le_connection(connection) && (hci_stack->le_data_packets_length > 0u)){
678452cf3bbS[email protected]         max_acl_data_packet_length = hci_stack->le_data_packets_length;
679452cf3bbS[email protected]     }
680452cf3bbS[email protected] 
6810f3b27c5SMatthias Ringwald #ifdef ENABLE_LE_LIMIT_ACL_FRAGMENT_BY_MAX_OCTETS
682fcf88f47SMatthias Ringwald     if (hci_is_le_connection(connection) && (connection->le_max_tx_octets < max_acl_data_packet_length)){
6830f3b27c5SMatthias Ringwald         max_acl_data_packet_length = connection->le_max_tx_octets;
6840f3b27c5SMatthias Ringwald     }
6850f3b27c5SMatthias Ringwald #endif
686452cf3bbS[email protected] 
687d999b54eSMatthias Ringwald     log_debug("hci_send_acl_packet_fragments entered");
688d999b54eSMatthias Ringwald 
689452cf3bbS[email protected]     int err;
690452cf3bbS[email protected]     // multiple packets could be send on a synchronous HCI transport
691ff3cc4a5SMatthias Ringwald     while (true){
692452cf3bbS[email protected] 
693d999b54eSMatthias Ringwald         log_debug("hci_send_acl_packet_fragments loop entered");
694d999b54eSMatthias Ringwald 
695452cf3bbS[email protected]         // get current data
6964ea43905SMatthias Ringwald         const uint16_t acl_header_pos = hci_stack->acl_fragmentation_pos - 4u;
697452cf3bbS[email protected]         int current_acl_data_packet_length = hci_stack->acl_fragmentation_total_size - hci_stack->acl_fragmentation_pos;
6981979f09cSMatthias Ringwald         bool more_fragments = false;
699452cf3bbS[email protected] 
700452cf3bbS[email protected]         // if ACL packet is larger than Bluetooth packet buffer, only send max_acl_data_packet_length
701452cf3bbS[email protected]         if (current_acl_data_packet_length > max_acl_data_packet_length){
7021979f09cSMatthias Ringwald             more_fragments = true;
703452cf3bbS[email protected]             current_acl_data_packet_length = max_acl_data_packet_length;
704452cf3bbS[email protected]         }
705452cf3bbS[email protected] 
706452cf3bbS[email protected]         // copy handle_and_flags if not first fragment and update packet boundary flags to be 01 (continuing fragmnent)
7074ea43905SMatthias Ringwald         if (acl_header_pos > 0u){
708f8fbdce0SMatthias Ringwald             uint16_t handle_and_flags = little_endian_read_16(hci_stack->hci_packet_buffer, 0);
7094ea43905SMatthias Ringwald             handle_and_flags = (handle_and_flags & 0xcfffu) | (1u << 12u);
710f8fbdce0SMatthias Ringwald             little_endian_store_16(hci_stack->hci_packet_buffer, acl_header_pos, handle_and_flags);
711452cf3bbS[email protected]         }
712452cf3bbS[email protected] 
713452cf3bbS[email protected]         // update header len
7144ea43905SMatthias Ringwald         little_endian_store_16(hci_stack->hci_packet_buffer, acl_header_pos + 2u, current_acl_data_packet_length);
715452cf3bbS[email protected] 
716452cf3bbS[email protected]         // count packet
717ce41473eSMatthias Ringwald         connection->num_packets_sent++;
7181979f09cSMatthias Ringwald         log_debug("hci_send_acl_packet_fragments loop before send (more fragments %d)", (int) more_fragments);
719d999b54eSMatthias Ringwald 
720d999b54eSMatthias Ringwald         // update state for next fragment (if any) as "transport done" might be sent during send_packet already
721d999b54eSMatthias Ringwald         if (more_fragments){
722d999b54eSMatthias Ringwald             // update start of next fragment to send
723d999b54eSMatthias Ringwald             hci_stack->acl_fragmentation_pos += current_acl_data_packet_length;
724d999b54eSMatthias Ringwald         } else {
725d999b54eSMatthias Ringwald             // done
726d999b54eSMatthias Ringwald             hci_stack->acl_fragmentation_pos = 0;
727d999b54eSMatthias Ringwald             hci_stack->acl_fragmentation_total_size = 0;
728d999b54eSMatthias Ringwald         }
729452cf3bbS[email protected] 
730452cf3bbS[email protected]         // send packet
731452cf3bbS[email protected]         uint8_t * packet = &hci_stack->hci_packet_buffer[acl_header_pos];
732452cf3bbS[email protected]         const int size = current_acl_data_packet_length + 4;
7335bb5bc3eS[email protected]         hci_dump_packet(HCI_ACL_DATA_PACKET, 0, packet, size);
73481d2bdb2SMatthias Ringwald         hci_stack->acl_fragmentation_tx_active = 1;
735452cf3bbS[email protected]         err = hci_stack->hci_transport->send_packet(HCI_ACL_DATA_PACKET, packet, size);
736452cf3bbS[email protected] 
7371979f09cSMatthias Ringwald         log_debug("hci_send_acl_packet_fragments loop after send (more fragments %d)", (int) more_fragments);
738d999b54eSMatthias Ringwald 
739452cf3bbS[email protected]         // done yet?
740452cf3bbS[email protected]         if (!more_fragments) break;
741452cf3bbS[email protected] 
742452cf3bbS[email protected]         // can send more?
743452cf3bbS[email protected]         if (!hci_can_send_prepared_acl_packet_now(connection->con_handle)) return err;
744452cf3bbS[email protected]     }
745452cf3bbS[email protected] 
746d999b54eSMatthias Ringwald     log_debug("hci_send_acl_packet_fragments loop over");
747452cf3bbS[email protected] 
748d051460cS[email protected]     // release buffer now for synchronous transport
749203bace6S[email protected]     if (hci_transport_synchronous()){
75081d2bdb2SMatthias Ringwald         hci_stack->acl_fragmentation_tx_active = 0;
751452cf3bbS[email protected]         hci_release_packet_buffer();
752fd43c0e0SMatthias Ringwald         hci_emit_transport_packet_sent();
753452cf3bbS[email protected]     }
754452cf3bbS[email protected] 
755452cf3bbS[email protected]     return err;
756452cf3bbS[email protected] }
757452cf3bbS[email protected] 
758826f7347S[email protected] // pre: caller has reserved the packet buffer
759826f7347S[email protected] int hci_send_acl_packet_buffer(int size){
7607856c818Smatthias.ringwald 
761452cf3bbS[email protected]     // log_info("hci_send_acl_packet_buffer size %u", size);
762452cf3bbS[email protected] 
763826f7347S[email protected]     if (!hci_stack->hci_packet_buffer_reserved) {
764826f7347S[email protected]         log_error("hci_send_acl_packet_buffer called without reserving packet buffer");
765826f7347S[email protected]         return 0;
766826f7347S[email protected]     }
767826f7347S[email protected] 
768d713a683S[email protected]     uint8_t * packet = hci_stack->hci_packet_buffer;
769d713a683S[email protected]     hci_con_handle_t con_handle = READ_ACL_CONNECTION_HANDLE(packet);
770d713a683S[email protected] 
771826f7347S[email protected]     // check for free places on Bluetooth module
772d713a683S[email protected]     if (!hci_can_send_prepared_acl_packet_now(con_handle)) {
773826f7347S[email protected]         log_error("hci_send_acl_packet_buffer called but no free ACL buffers on controller");
77497b61c7bS[email protected]         hci_release_packet_buffer();
775068b8592SMatthias Ringwald         hci_emit_transport_packet_sent();
77697b61c7bS[email protected]         return BTSTACK_ACL_BUFFERS_FULL;
77797b61c7bS[email protected]     }
7786218e6f1Smatthias.ringwald 
7795061f3afS[email protected]     hci_connection_t *connection = hci_connection_for_handle( con_handle);
78097b61c7bS[email protected]     if (!connection) {
7815fa0b7cfS[email protected]         log_error("hci_send_acl_packet_buffer called but no connection for handle 0x%04x", con_handle);
78297b61c7bS[email protected]         hci_release_packet_buffer();
783068b8592SMatthias Ringwald         hci_emit_transport_packet_sent();
78497b61c7bS[email protected]         return 0;
78597b61c7bS[email protected]     }
78652db98b2SMatthias Ringwald 
78752db98b2SMatthias Ringwald #ifdef ENABLE_CLASSIC
78856cf178bSmatthias.ringwald     hci_connection_timestamp(connection);
78952db98b2SMatthias Ringwald #endif
79056cf178bSmatthias.ringwald 
791452cf3bbS[email protected]     // hci_dump_packet( HCI_ACL_DATA_PACKET, 0, packet, size);
7927856c818Smatthias.ringwald 
793452cf3bbS[email protected]     // setup data
794452cf3bbS[email protected]     hci_stack->acl_fragmentation_total_size = size;
795452cf3bbS[email protected]     hci_stack->acl_fragmentation_pos = 4;   // start of L2CAP packet
7966218e6f1Smatthias.ringwald 
797452cf3bbS[email protected]     return hci_send_acl_packet_fragments(connection);
798ee091cf1Smatthias.ringwald }
799ee091cf1Smatthias.ringwald 
80035454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
80144d0e3d5S[email protected] // pre: caller has reserved the packet buffer
80244d0e3d5S[email protected] int hci_send_sco_packet_buffer(int size){
80344d0e3d5S[email protected] 
80444d0e3d5S[email protected]     // log_info("hci_send_acl_packet_buffer size %u", size);
80544d0e3d5S[email protected] 
80644d0e3d5S[email protected]     if (!hci_stack->hci_packet_buffer_reserved) {
80744d0e3d5S[email protected]         log_error("hci_send_acl_packet_buffer called without reserving packet buffer");
80844d0e3d5S[email protected]         return 0;
80944d0e3d5S[email protected]     }
81044d0e3d5S[email protected] 
81144d0e3d5S[email protected]     uint8_t * packet = hci_stack->hci_packet_buffer;
8124b3e1e19SMatthias Ringwald 
8134b3e1e19SMatthias Ringwald     // skip checks in loopback mode
8144b3e1e19SMatthias Ringwald     if (!hci_stack->loopback_mode){
81544d0e3d5S[email protected]         hci_con_handle_t con_handle = READ_ACL_CONNECTION_HANDLE(packet);   // same for ACL and SCO
81644d0e3d5S[email protected] 
81744d0e3d5S[email protected]         // check for free places on Bluetooth module
818701e3307SMatthias Ringwald         if (!hci_can_send_prepared_sco_packet_now()) {
819cbf638a9SMatthias Ringwald             log_error("hci_send_sco_packet_buffer called but no free SCO buffers on controller");
82044d0e3d5S[email protected]             hci_release_packet_buffer();
821068b8592SMatthias Ringwald             hci_emit_transport_packet_sent();
82244d0e3d5S[email protected]             return BTSTACK_ACL_BUFFERS_FULL;
82344d0e3d5S[email protected]         }
82444d0e3d5S[email protected] 
825e35edcc1S[email protected]         // track send packet in connection struct
826e35edcc1S[email protected]         hci_connection_t *connection = hci_connection_for_handle( con_handle);
827e35edcc1S[email protected]         if (!connection) {
828e35edcc1S[email protected]             log_error("hci_send_sco_packet_buffer called but no connection for handle 0x%04x", con_handle);
829e35edcc1S[email protected]             hci_release_packet_buffer();
830068b8592SMatthias Ringwald             hci_emit_transport_packet_sent();
831e35edcc1S[email protected]             return 0;
832e35edcc1S[email protected]         }
833f234b250SMatthias Ringwald 
834f234b250SMatthias Ringwald         if (hci_have_usb_transport()){
835f234b250SMatthias Ringwald             // token used
836f234b250SMatthias Ringwald             hci_stack->sco_can_send_now = 0;
837f234b250SMatthias Ringwald         } else {
838760b20efSMatthias Ringwald             if (hci_stack->synchronous_flow_control_enabled){
839ce41473eSMatthias Ringwald                 connection->num_packets_sent++;
8406f28d2eeSMatthias Ringwald             } else {
841e4157653SMatthias Ringwald                 connection->sco_tx_ready--;
842760b20efSMatthias Ringwald             }
8434b3e1e19SMatthias Ringwald         }
844f234b250SMatthias Ringwald     }
84544d0e3d5S[email protected] 
84644d0e3d5S[email protected]     hci_dump_packet( HCI_SCO_DATA_PACKET, 0, packet, size);
847543e835cSMatthias Ringwald 
84843149fc9SMatthias Ringwald #ifdef HAVE_SCO_TRANSPORT
84943149fc9SMatthias Ringwald     hci_stack->sco_transport->send_packet(packet, size);
85043149fc9SMatthias Ringwald     hci_release_packet_buffer();
85143149fc9SMatthias Ringwald     hci_emit_transport_packet_sent();
85243149fc9SMatthias Ringwald 
85343149fc9SMatthias Ringwald     return 0;
85443149fc9SMatthias Ringwald #else
85543149fc9SMatthias Ringwald     int err = hci_stack->hci_transport->send_packet(HCI_SCO_DATA_PACKET, packet, size);
856543e835cSMatthias Ringwald     if (hci_transport_synchronous()){
857543e835cSMatthias Ringwald         hci_release_packet_buffer();
858fd43c0e0SMatthias Ringwald         hci_emit_transport_packet_sent();
859543e835cSMatthias Ringwald     }
860543e835cSMatthias Ringwald 
861543e835cSMatthias Ringwald     return err;
86243149fc9SMatthias Ringwald #endif
86344d0e3d5S[email protected] }
86435454696SMatthias Ringwald #endif
86544d0e3d5S[email protected] 
866c3b46f5aSMatthias Ringwald static void acl_handler(uint8_t *packet, uint16_t size){
867e76a89eeS[email protected] 
8687856c818Smatthias.ringwald     // get info
8697856c818Smatthias.ringwald     hci_con_handle_t con_handle = READ_ACL_CONNECTION_HANDLE(packet);
8705061f3afS[email protected]     hci_connection_t *conn      = hci_connection_for_handle(con_handle);
8717856c818Smatthias.ringwald     uint8_t  acl_flags          = READ_ACL_FLAGS(packet);
8727856c818Smatthias.ringwald     uint16_t acl_length         = READ_ACL_LENGTH(packet);
8737856c818Smatthias.ringwald 
8747856c818Smatthias.ringwald     // ignore non-registered handle
8757856c818Smatthias.ringwald     if (!conn){
876c3b46f5aSMatthias Ringwald         log_error("acl_handler called with non-registered handle %u!" , con_handle);
8777856c818Smatthias.ringwald         return;
8787856c818Smatthias.ringwald     }
8797856c818Smatthias.ringwald 
880e76a89eeS[email protected]     // assert packet is complete
8814ea43905SMatthias Ringwald     if ((acl_length + 4u) != size){
882c3b46f5aSMatthias Ringwald         log_error("acl_handler called with ACL packet of wrong size %d, expected %u => dropping packet", size, acl_length + 4);
883e76a89eeS[email protected]         return;
884e76a89eeS[email protected]     }
885e76a89eeS[email protected] 
88652db98b2SMatthias Ringwald #ifdef ENABLE_CLASSIC
8877856c818Smatthias.ringwald     // update idle timestamp
8887856c818Smatthias.ringwald     hci_connection_timestamp(conn);
88952db98b2SMatthias Ringwald #endif
8907856c818Smatthias.ringwald 
8912b838201SMatthias Ringwald #ifdef ENABLE_HCI_CONTROLLER_TO_HOST_FLOW_CONTROL
8922b838201SMatthias Ringwald     hci_stack->host_completed_packets = 1;
8932b838201SMatthias Ringwald     conn->num_packets_completed++;
8942b838201SMatthias Ringwald #endif
8952b838201SMatthias Ringwald 
8967856c818Smatthias.ringwald     // handle different packet types
8974ea43905SMatthias Ringwald     switch (acl_flags & 0x03u) {
8987856c818Smatthias.ringwald 
8997856c818Smatthias.ringwald         case 0x01: // continuation fragment
9007856c818Smatthias.ringwald 
9010ca847afS[email protected]             // sanity checks
9024ea43905SMatthias Ringwald             if (conn->acl_recombination_pos == 0u) {
9039da54300S[email protected]                 log_error( "ACL Cont Fragment but no first fragment for handle 0x%02x", con_handle);
9047856c818Smatthias.ringwald                 return;
9057856c818Smatthias.ringwald             }
9064ea43905SMatthias Ringwald             if ((conn->acl_recombination_pos + acl_length) > (4u + HCI_ACL_BUFFER_SIZE)){
9070ca847afS[email protected]                 log_error( "ACL Cont Fragment to large: combined packet %u > buffer size %u for handle 0x%02x",
9080ca847afS[email protected]                     conn->acl_recombination_pos + acl_length, 4 + HCI_ACL_BUFFER_SIZE, con_handle);
9090ca847afS[email protected]                 conn->acl_recombination_pos = 0;
9100ca847afS[email protected]                 return;
9110ca847afS[email protected]             }
9127856c818Smatthias.ringwald 
9137856c818Smatthias.ringwald             // append fragment payload (header already stored)
9146535961aSMatthias Ringwald             (void)memcpy(&conn->acl_recombination_buffer[HCI_INCOMING_PRE_BUFFER_SIZE + conn->acl_recombination_pos],
9156535961aSMatthias Ringwald                          &packet[4], acl_length);
9167856c818Smatthias.ringwald             conn->acl_recombination_pos += acl_length;
9177856c818Smatthias.ringwald 
9187856c818Smatthias.ringwald             // forward complete L2CAP packet if complete.
9194ea43905SMatthias Ringwald             if (conn->acl_recombination_pos >= (conn->acl_recombination_length + 4u + 4u)){ // pos already incl. ACL header
920d6b06661SMatthias Ringwald                 hci_emit_acl_packet(&conn->acl_recombination_buffer[HCI_INCOMING_PRE_BUFFER_SIZE], conn->acl_recombination_pos);
9217856c818Smatthias.ringwald                 // reset recombination buffer
9227856c818Smatthias.ringwald                 conn->acl_recombination_length = 0;
9237856c818Smatthias.ringwald                 conn->acl_recombination_pos = 0;
9247856c818Smatthias.ringwald             }
9257856c818Smatthias.ringwald             break;
9267856c818Smatthias.ringwald 
9277856c818Smatthias.ringwald         case 0x02: { // first fragment
9287856c818Smatthias.ringwald 
92923a77e1aS[email protected]             // sanity check
93023a77e1aS[email protected]             if (conn->acl_recombination_pos) {
93123a77e1aS[email protected]                 log_error( "ACL First Fragment but data in buffer for handle 0x%02x, dropping stale fragments", con_handle);
93223a77e1aS[email protected]                 conn->acl_recombination_pos = 0;
93323a77e1aS[email protected]             }
93423a77e1aS[email protected] 
9357856c818Smatthias.ringwald             // peek into L2CAP packet!
9367856c818Smatthias.ringwald             uint16_t l2cap_length = READ_L2CAP_LENGTH( packet );
9377856c818Smatthias.ringwald 
9387856c818Smatthias.ringwald             // compare fragment size to L2CAP packet size
9394ea43905SMatthias Ringwald             if (acl_length >= (l2cap_length + 4u)){
9407856c818Smatthias.ringwald                 // forward fragment as L2CAP packet
9414ea43905SMatthias Ringwald                 hci_emit_acl_packet(packet, acl_length + 4u);
9427856c818Smatthias.ringwald             } else {
9430ca847afS[email protected] 
9440ca847afS[email protected]                 if (acl_length > HCI_ACL_BUFFER_SIZE){
9450ca847afS[email protected]                     log_error( "ACL First Fragment to large: fragment %u > buffer size %u for handle 0x%02x",
9460ca847afS[email protected]                         4 + acl_length, 4 + HCI_ACL_BUFFER_SIZE, con_handle);
9470ca847afS[email protected]                     return;
9480ca847afS[email protected]                 }
9490ca847afS[email protected] 
9507856c818Smatthias.ringwald                 // store first fragment and tweak acl length for complete package
9516535961aSMatthias Ringwald                 (void)memcpy(&conn->acl_recombination_buffer[HCI_INCOMING_PRE_BUFFER_SIZE],
9524ea43905SMatthias Ringwald                              packet, acl_length + 4u);
9534ea43905SMatthias Ringwald                 conn->acl_recombination_pos    = acl_length + 4u;
9547856c818Smatthias.ringwald                 conn->acl_recombination_length = l2cap_length;
9554ea43905SMatthias Ringwald                 little_endian_store_16(conn->acl_recombination_buffer, HCI_INCOMING_PRE_BUFFER_SIZE + 2u, l2cap_length +4u);
9567856c818Smatthias.ringwald             }
9577856c818Smatthias.ringwald             break;
9587856c818Smatthias.ringwald 
9597856c818Smatthias.ringwald         }
9607856c818Smatthias.ringwald         default:
961c3b46f5aSMatthias Ringwald             log_error( "acl_handler called with invalid packet boundary flags %u", acl_flags & 0x03);
9627856c818Smatthias.ringwald             return;
9637856c818Smatthias.ringwald     }
96494ab26f8Smatthias.ringwald 
96594ab26f8Smatthias.ringwald     // execute main loop
96694ab26f8Smatthias.ringwald     hci_run();
96716833f0aSmatthias.ringwald }
96822909952Smatthias.ringwald 
96967a3e8ecSmatthias.ringwald static void hci_shutdown_connection(hci_connection_t *conn){
9709da54300S[email protected]     log_info("Connection closed: handle 0x%x, %s", conn->con_handle, bd_addr_to_str(conn->address));
9713c4d4b90Smatthias.ringwald 
972b3264428SMatthias Ringwald #ifdef ENABLE_CLASSIC
973cb70c5abSMatthias Ringwald #if defined(ENABLE_SCO_OVER_HCI) || defined(HAVE_SCO_TRANSPORT)
974cb70c5abSMatthias Ringwald     bd_addr_type_t addr_type = conn->address_type;
975cb70c5abSMatthias Ringwald #endif
976cb70c5abSMatthias Ringwald #ifdef HAVE_SCO_TRANSPORT
977cb70c5abSMatthias Ringwald     hci_con_handle_t con_handle = conn->con_handle;
978ee752bb8SMatthias Ringwald #endif
979b3264428SMatthias Ringwald #endif
980ee752bb8SMatthias Ringwald 
981528a4a3bSMatthias Ringwald     btstack_run_loop_remove_timer(&conn->timeout);
982c785ef68Smatthias.ringwald 
983665d90f2SMatthias Ringwald     btstack_linked_list_remove(&hci_stack->connections, (btstack_linked_item_t *) conn);
984a3b02b71Smatthias.ringwald     btstack_memory_hci_connection_free( conn );
9853c4d4b90Smatthias.ringwald 
9863c4d4b90Smatthias.ringwald     // now it's gone
987c7e0c5f6Smatthias.ringwald     hci_emit_nr_connections_changed();
988ee752bb8SMatthias Ringwald 
989b3264428SMatthias Ringwald #ifdef ENABLE_CLASSIC
990034e9b53SMatthias Ringwald #ifdef ENABLE_SCO_OVER_HCI
991ee752bb8SMatthias Ringwald     // update SCO
992cb70c5abSMatthias Ringwald     if ((addr_type == BD_ADDR_TYPE_SCO) && (hci_stack->hci_transport != NULL) && (hci_stack->hci_transport->set_sco_config != NULL)){
993ee752bb8SMatthias Ringwald         hci_stack->hci_transport->set_sco_config(hci_stack->sco_voice_setting_active, hci_number_sco_connections());
994ee752bb8SMatthias Ringwald     }
995034e9b53SMatthias Ringwald #endif
996cb70c5abSMatthias Ringwald #ifdef HAVE_SCO_TRANSPORT
997cb70c5abSMatthias Ringwald     if ((addr_type == BD_ADDR_TYPE_SCO) && (hci_stack->sco_transport != NULL)){
998cb70c5abSMatthias Ringwald         hci_stack->sco_transport->close(con_handle);
999cb70c5abSMatthias Ringwald     }
1000cb70c5abSMatthias Ringwald #endif
1001b3264428SMatthias Ringwald #endif
1002c7e0c5f6Smatthias.ringwald }
1003c7e0c5f6Smatthias.ringwald 
100435454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
100535454696SMatthias Ringwald 
10060c042179S[email protected] static const uint16_t packet_type_sizes[] = {
10078f8108aaSmatthias.ringwald     0, HCI_ACL_2DH1_SIZE, HCI_ACL_3DH1_SIZE, HCI_ACL_DM1_SIZE,
10088f8108aaSmatthias.ringwald     HCI_ACL_DH1_SIZE, 0, 0, 0,
10098f8108aaSmatthias.ringwald     HCI_ACL_2DH3_SIZE, HCI_ACL_3DH3_SIZE, HCI_ACL_DM3_SIZE, HCI_ACL_DH3_SIZE,
10108f8108aaSmatthias.ringwald     HCI_ACL_2DH5_SIZE, HCI_ACL_3DH5_SIZE, HCI_ACL_DM5_SIZE, HCI_ACL_DH5_SIZE
10118f8108aaSmatthias.ringwald };
101265389bfcS[email protected] static const uint8_t  packet_type_feature_requirement_bit[] = {
101365389bfcS[email protected]      0, // 3 slot packets
101465389bfcS[email protected]      1, // 5 slot packets
101565389bfcS[email protected]     25, // EDR 2 mpbs
101665389bfcS[email protected]     26, // EDR 3 mbps
101765389bfcS[email protected]     39, // 3 slot EDR packts
101865389bfcS[email protected]     40, // 5 slot EDR packet
101965389bfcS[email protected] };
102065389bfcS[email protected] static const uint16_t packet_type_feature_packet_mask[] = {
102165389bfcS[email protected]     0x0f00, // 3 slot packets
102265389bfcS[email protected]     0xf000, // 5 slot packets
102365389bfcS[email protected]     0x1102, // EDR 2 mpbs
102465389bfcS[email protected]     0x2204, // EDR 3 mbps
102565389bfcS[email protected]     0x0300, // 3 slot EDR packts
102665389bfcS[email protected]     0x3000, // 5 slot EDR packet
102765389bfcS[email protected] };
10288f8108aaSmatthias.ringwald 
102965389bfcS[email protected] static uint16_t hci_acl_packet_types_for_buffer_size_and_local_features(uint16_t buffer_size, uint8_t * local_supported_features){
103065389bfcS[email protected]     // enable packet types based on size
10318f8108aaSmatthias.ringwald     uint16_t packet_types = 0;
1032f16a69bbS[email protected]     unsigned int i;
10338f8108aaSmatthias.ringwald     for (i=0;i<16;i++){
10348f8108aaSmatthias.ringwald         if (packet_type_sizes[i] == 0) continue;
10358f8108aaSmatthias.ringwald         if (packet_type_sizes[i] <= buffer_size){
10368f8108aaSmatthias.ringwald             packet_types |= 1 << i;
10378f8108aaSmatthias.ringwald         }
10388f8108aaSmatthias.ringwald     }
103965389bfcS[email protected]     // disable packet types due to missing local supported features
104065389bfcS[email protected]     for (i=0;i<sizeof(packet_type_feature_requirement_bit);i++){
1041f04a0c31SMatthias Ringwald         unsigned int bit_idx = packet_type_feature_requirement_bit[i];
104265389bfcS[email protected]         int feature_set = (local_supported_features[bit_idx >> 3] & (1<<(bit_idx & 7))) != 0;
104365389bfcS[email protected]         if (feature_set) continue;
104465389bfcS[email protected]         log_info("Features bit %02u is not set, removing packet types 0x%04x", bit_idx, packet_type_feature_packet_mask[i]);
104565389bfcS[email protected]         packet_types &= ~packet_type_feature_packet_mask[i];
104665389bfcS[email protected]     }
10478f8108aaSmatthias.ringwald     // flip bits for "may not be used"
10488f8108aaSmatthias.ringwald     packet_types ^= 0x3306;
10498f8108aaSmatthias.ringwald     return packet_types;
10508f8108aaSmatthias.ringwald }
10518f8108aaSmatthias.ringwald 
10528f8108aaSmatthias.ringwald uint16_t hci_usable_acl_packet_types(void){
10533a9fb326S[email protected]     return hci_stack->packet_types;
10548f8108aaSmatthias.ringwald }
105535454696SMatthias Ringwald #endif
10568f8108aaSmatthias.ringwald 
1057facf93fdS[email protected] uint8_t* hci_get_outgoing_packet_buffer(void){
10587dc17943Smatthias.ringwald     // hci packet buffer is >= acl data packet length
10593a9fb326S[email protected]     return hci_stack->hci_packet_buffer;
10607dc17943Smatthias.ringwald }
10617dc17943Smatthias.ringwald 
1062f5d8d141S[email protected] uint16_t hci_max_acl_data_packet_length(void){
10633a9fb326S[email protected]     return hci_stack->acl_data_packet_length;
10647dc17943Smatthias.ringwald }
10657dc17943Smatthias.ringwald 
106606b9e820SMatthias Ringwald #ifdef ENABLE_CLASSIC
10673e68d23dSMatthias Ringwald int hci_extended_sco_link_supported(void){
10683e68d23dSMatthias Ringwald     // No. 31, byte 3, bit 7
10693e68d23dSMatthias Ringwald     return (hci_stack->local_supported_features[3] & (1 << 7)) != 0;
10703e68d23dSMatthias Ringwald }
107106b9e820SMatthias Ringwald #endif
10723e68d23dSMatthias Ringwald 
10736ac9a97eS[email protected] int hci_non_flushable_packet_boundary_flag_supported(void){
10746ac9a97eS[email protected]     // No. 54, byte 6, bit 6
10754ea43905SMatthias Ringwald     return (hci_stack->local_supported_features[6u] & (1u << 6u)) != 0u;
10766ac9a97eS[email protected] }
10776ac9a97eS[email protected] 
107815a95bd5SMatthias Ringwald static int gap_ssp_supported(void){
10796ac9a97eS[email protected]     // No. 51, byte 6, bit 3
10804ea43905SMatthias Ringwald     return (hci_stack->local_supported_features[6u] & (1u << 3u)) != 0u;
1081f5d8d141S[email protected] }
1082f5d8d141S[email protected] 
10837f02f414SMatthias Ringwald static int hci_classic_supported(void){
108435454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
10856ac9a97eS[email protected]     // No. 37, byte 4, bit 5, = No BR/EDR Support
10863a9fb326S[email protected]     return (hci_stack->local_supported_features[4] & (1 << 5)) == 0;
108735454696SMatthias Ringwald #else
108835454696SMatthias Ringwald     return 0;
108935454696SMatthias Ringwald #endif
1090f5d8d141S[email protected] }
1091f5d8d141S[email protected] 
10927f02f414SMatthias Ringwald static int hci_le_supported(void){
1093a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE
10946ac9a97eS[email protected]     // No. 37, byte 4, bit 6 = LE Supported (Controller)
10954ea43905SMatthias Ringwald     return (hci_stack->local_supported_features[4u] & (1u << 6u)) != 0u;
1096f5d8d141S[email protected] #else
1097f5d8d141S[email protected]     return 0;
1098f5d8d141S[email protected] #endif
1099f5d8d141S[email protected] }
1100f5d8d141S[email protected] 
1101b95a5a35SMatthias Ringwald #ifdef ENABLE_BLE
1102b95a5a35SMatthias Ringwald 
1103f5873674SMatthias Ringwald static void hci_get_own_address_for_addr_type(uint8_t own_addr_type, bd_addr_t own_addr){
11046bcfa632SMatthias Ringwald     if (own_addr_type == BD_ADDR_TYPE_LE_PUBLIC){
11056bcfa632SMatthias Ringwald         (void)memcpy(own_addr, hci_stack->local_bd_addr, 6);
110669a97523S[email protected]     } else {
11076bcfa632SMatthias Ringwald         (void)memcpy(own_addr, hci_stack->le_random_address, 6);
110869a97523S[email protected]     }
110969a97523S[email protected] }
111069a97523S[email protected] 
11116bcfa632SMatthias Ringwald void gap_le_get_own_address(uint8_t * addr_type, bd_addr_t addr){
11126bcfa632SMatthias Ringwald     *addr_type = hci_stack->le_own_addr_type;
11136bcfa632SMatthias Ringwald     hci_get_own_address_for_addr_type(hci_stack->le_own_addr_type, addr);
11146bcfa632SMatthias Ringwald }
11156bcfa632SMatthias Ringwald 
11166bcfa632SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
11176bcfa632SMatthias Ringwald void gap_le_get_own_advertisements_address(uint8_t * addr_type, bd_addr_t addr){
11186bcfa632SMatthias Ringwald     *addr_type = hci_stack->le_advertisements_own_addr_type;
11196bcfa632SMatthias Ringwald     hci_get_own_address_for_addr_type(hci_stack->le_advertisements_own_addr_type, addr);
11206bcfa632SMatthias Ringwald };
11216bcfa632SMatthias Ringwald #endif
11226bcfa632SMatthias Ringwald 
1123e8c8828eSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
11246bcfa632SMatthias Ringwald 
11256bcfa632SMatthias Ringwald /**
11266bcfa632SMatthias Ringwald  * @brief Get own addr type and address used for LE connections (Central)
11276bcfa632SMatthias Ringwald  */
11286bcfa632SMatthias Ringwald void gap_le_get_own_connection_address(uint8_t * addr_type, bd_addr_t addr){
11296bcfa632SMatthias Ringwald     *addr_type = hci_stack->le_connection_own_addr_type;
11306bcfa632SMatthias Ringwald     hci_get_own_address_for_addr_type(hci_stack->le_connection_own_addr_type, addr);
11316bcfa632SMatthias Ringwald }
11326bcfa632SMatthias Ringwald 
1133384b59deSMatthias Ringwald void le_handle_advertisement_report(uint8_t *packet, uint16_t size){
11349ec2630cSMatthias Ringwald 
1135d1dc057bS[email protected]     int offset = 3;
1136d1dc057bS[email protected]     int num_reports = packet[offset];
1137d1dc057bS[email protected]     offset += 1;
1138d1dc057bS[email protected] 
113957c9da5bS[email protected]     int i;
11404f4e0224SMatthias Ringwald     // log_info("HCI: handle adv report with num reports: %d", num_reports);
114103fbe9c6S[email protected]     uint8_t event[12 + LE_ADVERTISING_DATA_SIZE]; // use upper bound to avoid var size automatic var
1142a1df452eSMatthias Ringwald     for (i=0; (i<num_reports) && (offset < size);i++){
114333e6948bSMatthias Ringwald         // sanity checks on data_length:
114433e6948bSMatthias Ringwald         uint8_t data_length = packet[offset + 8];
114533e6948bSMatthias Ringwald         if (data_length > LE_ADVERTISING_DATA_SIZE) return;
11464ea43905SMatthias Ringwald         if ((offset + 9u + data_length + 1u) > size)    return;
114733e6948bSMatthias Ringwald         // setup event
11484ea43905SMatthias Ringwald         uint8_t event_size = 10u + data_length;
1149d1dc057bS[email protected]         int pos = 0;
1150045013feSMatthias Ringwald         event[pos++] = GAP_EVENT_ADVERTISING_REPORT;
115157c9da5bS[email protected]         event[pos++] = event_size;
11526535961aSMatthias Ringwald         (void)memcpy(&event[pos], &packet[offset], 1 + 1 + 6); // event type + address type + address
1153d1dc057bS[email protected]         offset += 8;
1154d1dc057bS[email protected]         pos += 8;
1155d1dc057bS[email protected]         event[pos++] = packet[offset + 1 + data_length]; // rssi
115633e6948bSMatthias Ringwald         event[pos++] = data_length;
115733e6948bSMatthias Ringwald         offset++;
11586535961aSMatthias Ringwald         (void)memcpy(&event[pos], &packet[offset], data_length);
115957c9da5bS[email protected]         pos +=    data_length;
11604ea43905SMatthias Ringwald         offset += data_length + 1u; // rssi
1161d6b06661SMatthias Ringwald         hci_emit_event(event, pos, 1);
116257c9da5bS[email protected]     }
116357c9da5bS[email protected] }
1164b2f949feS[email protected] #endif
1165e8c8828eSMatthias Ringwald #endif
116657c9da5bS[email protected] 
11672b6ab3e6SMatthias Ringwald #ifdef ENABLE_BLE
11682b6ab3e6SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
1169bbc366e6SMatthias Ringwald static void hci_update_advertisements_enabled_for_current_roles(void){
1170bbc366e6SMatthias Ringwald     if (hci_stack->le_advertisements_enabled){
11712b6ab3e6SMatthias Ringwald         // get number of active le slave connections
11722b6ab3e6SMatthias Ringwald         int num_slave_connections = 0;
11732b6ab3e6SMatthias Ringwald         btstack_linked_list_iterator_t it;
11742b6ab3e6SMatthias Ringwald         btstack_linked_list_iterator_init(&it, &hci_stack->connections);
11752b6ab3e6SMatthias Ringwald         while (btstack_linked_list_iterator_has_next(&it)){
11762b6ab3e6SMatthias Ringwald             hci_connection_t * con = (hci_connection_t*) btstack_linked_list_iterator_next(&it);
11772b6ab3e6SMatthias Ringwald             log_info("state %u, role %u, le_con %u", con->state, con->role, hci_is_le_connection(con));
11782b6ab3e6SMatthias Ringwald             if (con->state != OPEN) continue;
11792b6ab3e6SMatthias Ringwald             if (con->role  != HCI_ROLE_SLAVE) continue;
11802b6ab3e6SMatthias Ringwald             if (!hci_is_le_connection(con)) continue;
11812b6ab3e6SMatthias Ringwald             num_slave_connections++;
11822b6ab3e6SMatthias Ringwald         }
11832b6ab3e6SMatthias Ringwald         log_info("Num LE Peripheral roles: %u of %u", num_slave_connections, hci_stack->le_max_number_peripheral_connections);
1184bbc366e6SMatthias Ringwald         hci_stack->le_advertisements_enabled_for_current_roles = num_slave_connections < hci_stack->le_max_number_peripheral_connections;
1185bbc366e6SMatthias Ringwald     } else {
1186bbc366e6SMatthias Ringwald         hci_stack->le_advertisements_enabled_for_current_roles = false;
11872b6ab3e6SMatthias Ringwald     }
11882b6ab3e6SMatthias Ringwald }
11892b6ab3e6SMatthias Ringwald #endif
11902b6ab3e6SMatthias Ringwald #endif
11912b6ab3e6SMatthias Ringwald 
1192cd77dd38SMatthias Ringwald #if !defined(HAVE_PLATFORM_IPHONE_OS) && !defined (HAVE_HOST_CONTROLLER_API)
119306b9e820SMatthias Ringwald 
119496b53536SMatthias Ringwald static uint32_t hci_transport_uart_get_main_baud_rate(void){
119596b53536SMatthias Ringwald     if (!hci_stack->config) return 0;
11969796ebeaSMatthias Ringwald     uint32_t baud_rate = ((hci_transport_config_uart_t *)hci_stack->config)->baudrate_main;
119796b53536SMatthias Ringwald     // Limit baud rate for Broadcom chipsets to 3 mbps
1198a1df452eSMatthias Ringwald     if ((hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_BROADCOM_CORPORATION) && (baud_rate > 3000000)){
119996b53536SMatthias Ringwald         baud_rate = 3000000;
120096b53536SMatthias Ringwald     }
120196b53536SMatthias Ringwald     return baud_rate;
120296b53536SMatthias Ringwald }
120396b53536SMatthias Ringwald 
1204ec820d77SMatthias Ringwald static void hci_initialization_timeout_handler(btstack_timer_source_t * ds){
12059ec2630cSMatthias Ringwald     UNUSED(ds);
12069ec2630cSMatthias Ringwald 
12070305bdeaSMatthias Ringwald     switch (hci_stack->substate){
12080305bdeaSMatthias Ringwald         case HCI_INIT_W4_SEND_RESET:
12097b0d7667SMatthias Ringwald             log_info("Resend HCI Reset");
12100305bdeaSMatthias Ringwald             hci_stack->substate = HCI_INIT_SEND_RESET;
12117b0d7667SMatthias Ringwald             hci_stack->num_cmd_packets = 1;
12120305bdeaSMatthias Ringwald             hci_run();
12130305bdeaSMatthias Ringwald             break;
12149f007422SMatthias Ringwald         case HCI_INIT_W4_CUSTOM_INIT_CSR_WARM_BOOT_LINK_RESET:
12159f007422SMatthias Ringwald             log_info("Resend HCI Reset - CSR Warm Boot with Link Reset");
12169f007422SMatthias Ringwald             if (hci_stack->hci_transport->reset_link){
12179f007422SMatthias Ringwald                 hci_stack->hci_transport->reset_link();
12189f007422SMatthias Ringwald             }
1219cf373d3aSMatthias Ringwald 
1220cf373d3aSMatthias Ringwald             /* fall through */
1221cf373d3aSMatthias Ringwald 
1222e47e68c7SMatthias Ringwald         case HCI_INIT_W4_CUSTOM_INIT_CSR_WARM_BOOT:
1223e47e68c7SMatthias Ringwald             log_info("Resend HCI Reset - CSR Warm Boot");
1224e47e68c7SMatthias Ringwald             hci_stack->substate = HCI_INIT_SEND_RESET_CSR_WARM_BOOT;
1225e47e68c7SMatthias Ringwald             hci_stack->num_cmd_packets = 1;
1226e47e68c7SMatthias Ringwald             hci_run();
1227688c2635SMatthias Ringwald             break;
12287224be7eSMatthias Ringwald         case HCI_INIT_W4_SEND_BAUD_CHANGE:
12297224be7eSMatthias Ringwald             if (hci_stack->hci_transport->set_baudrate){
123096b53536SMatthias Ringwald                 uint32_t baud_rate = hci_transport_uart_get_main_baud_rate();
1231cd724cb7SMatthias Ringwald                 log_info("Local baud rate change to %" PRIu32 "(timeout handler)", baud_rate);
12327dd9d0ecSMatthias Ringwald                 hci_stack->hci_transport->set_baudrate(baud_rate);
12337224be7eSMatthias Ringwald             }
1234834bce8cSMatthias Ringwald             // For CSR, HCI Reset is sent on new baud rate. Don't forget to reset link for H5/BCSP
123561f37892SMatthias Ringwald             if (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_CAMBRIDGE_SILICON_RADIO){
1236834bce8cSMatthias Ringwald                 if (hci_stack->hci_transport->reset_link){
1237834bce8cSMatthias Ringwald                     log_info("Link Reset");
1238834bce8cSMatthias Ringwald                     hci_stack->hci_transport->reset_link();
1239834bce8cSMatthias Ringwald                 }
1240772a36d3SMatthias Ringwald                 hci_stack->substate = HCI_INIT_SEND_RESET_CSR_WARM_BOOT;
1241772a36d3SMatthias Ringwald                 hci_run();
1242772a36d3SMatthias Ringwald             }
12434696bddbSMatthias Ringwald             break;
1244559961d0SMatthias Ringwald         case HCI_INIT_W4_CUSTOM_INIT_BCM_DELAY:
1245559961d0SMatthias Ringwald             // otherwise continue
1246559961d0SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_READ_LOCAL_SUPPORTED_COMMANDS;
1247559961d0SMatthias Ringwald             hci_send_cmd(&hci_read_local_supported_commands);
1248559961d0SMatthias Ringwald             break;
12490305bdeaSMatthias Ringwald         default:
12500305bdeaSMatthias Ringwald             break;
12510305bdeaSMatthias Ringwald     }
12520305bdeaSMatthias Ringwald }
125306b9e820SMatthias Ringwald #endif
12540305bdeaSMatthias Ringwald 
125571de195eSMatthias Ringwald static void hci_initializing_next_state(void){
125674b323a9SMatthias Ringwald     hci_stack->substate = (hci_substate_t )( ((int) hci_stack->substate) + 1);
125774b323a9SMatthias Ringwald }
125874b323a9SMatthias Ringwald 
125974b323a9SMatthias Ringwald // assumption: hci_can_send_command_packet_now() == true
126071de195eSMatthias Ringwald static void hci_initializing_run(void){
1261148ca237SMatthias Ringwald     log_debug("hci_initializing_run: substate %u, can send %u", hci_stack->substate, hci_can_send_command_packet_now());
126274b323a9SMatthias Ringwald     switch (hci_stack->substate){
126374b323a9SMatthias Ringwald         case HCI_INIT_SEND_RESET:
126474b323a9SMatthias Ringwald             hci_state_reset();
1265a0cf2f3fSMatthias Ringwald 
126606b9e820SMatthias Ringwald #if !defined(HAVE_PLATFORM_IPHONE_OS) && !defined (HAVE_HOST_CONTROLLER_API)
12670305bdeaSMatthias Ringwald             // prepare reset if command complete not received in 100ms
1268659d758cSMatthias Ringwald             btstack_run_loop_set_timer(&hci_stack->timeout, HCI_RESET_RESEND_TIMEOUT_MS);
1269528a4a3bSMatthias Ringwald             btstack_run_loop_set_timer_handler(&hci_stack->timeout, hci_initialization_timeout_handler);
1270528a4a3bSMatthias Ringwald             btstack_run_loop_add_timer(&hci_stack->timeout);
1271a0cf2f3fSMatthias Ringwald #endif
12720305bdeaSMatthias Ringwald             // send command
127374b323a9SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_SEND_RESET;
12740305bdeaSMatthias Ringwald             hci_send_cmd(&hci_reset);
127574b323a9SMatthias Ringwald             break;
127676fcb19bSMatthias Ringwald         case HCI_INIT_SEND_READ_LOCAL_VERSION_INFORMATION:
127776fcb19bSMatthias Ringwald             hci_send_cmd(&hci_read_local_version_information);
127876fcb19bSMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_SEND_READ_LOCAL_VERSION_INFORMATION;
127976fcb19bSMatthias Ringwald             break;
1280e90bae01SMatthias Ringwald         case HCI_INIT_SEND_READ_LOCAL_NAME:
1281e90bae01SMatthias Ringwald             hci_send_cmd(&hci_read_local_name);
1282e90bae01SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_SEND_READ_LOCAL_NAME;
1283e90bae01SMatthias Ringwald             break;
128406b9e820SMatthias Ringwald 
128506b9e820SMatthias Ringwald #if !defined(HAVE_PLATFORM_IPHONE_OS) && !defined (HAVE_HOST_CONTROLLER_API)
1286e47e68c7SMatthias Ringwald         case HCI_INIT_SEND_RESET_CSR_WARM_BOOT:
1287e47e68c7SMatthias Ringwald             hci_state_reset();
1288e47e68c7SMatthias Ringwald             // prepare reset if command complete not received in 100ms
1289659d758cSMatthias Ringwald             btstack_run_loop_set_timer(&hci_stack->timeout, HCI_RESET_RESEND_TIMEOUT_MS);
1290528a4a3bSMatthias Ringwald             btstack_run_loop_set_timer_handler(&hci_stack->timeout, hci_initialization_timeout_handler);
1291528a4a3bSMatthias Ringwald             btstack_run_loop_add_timer(&hci_stack->timeout);
1292e47e68c7SMatthias Ringwald             // send command
1293e47e68c7SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_CUSTOM_INIT_CSR_WARM_BOOT;
1294e47e68c7SMatthias Ringwald             hci_send_cmd(&hci_reset);
1295e47e68c7SMatthias Ringwald             break;
12968d29070eSMatthias Ringwald         case HCI_INIT_SEND_RESET_ST_WARM_BOOT:
12978d29070eSMatthias Ringwald             hci_state_reset();
12988d29070eSMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_SEND_RESET_ST_WARM_BOOT;
12998d29070eSMatthias Ringwald             hci_send_cmd(&hci_reset);
13008d29070eSMatthias Ringwald             break;
1301fab26ab3SMatthias Ringwald         case HCI_INIT_SEND_BAUD_CHANGE: {
130296b53536SMatthias Ringwald             uint32_t baud_rate = hci_transport_uart_get_main_baud_rate();
13033fb36a29SMatthias Ringwald             hci_stack->chipset->set_baudrate_command(baud_rate, hci_stack->hci_packet_buffer);
1304f8fbdce0SMatthias Ringwald             hci_stack->last_cmd_opcode = little_endian_read_16(hci_stack->hci_packet_buffer, 0);
130574b323a9SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_SEND_BAUD_CHANGE;
13064ea43905SMatthias Ringwald             hci_send_cmd_packet(hci_stack->hci_packet_buffer, 3u + hci_stack->hci_packet_buffer[2u]);
13074696bddbSMatthias Ringwald             // STLC25000D: baudrate change happens within 0.5 s after command was send,
13084696bddbSMatthias Ringwald             // use timer to update baud rate after 100 ms (knowing exactly, when command was sent is non-trivial)
130961f37892SMatthias Ringwald             if (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_ST_MICROELECTRONICS){
1310659d758cSMatthias Ringwald                 btstack_run_loop_set_timer(&hci_stack->timeout, HCI_RESET_RESEND_TIMEOUT_MS);
1311528a4a3bSMatthias Ringwald                 btstack_run_loop_add_timer(&hci_stack->timeout);
13124696bddbSMatthias Ringwald             }
131374b323a9SMatthias Ringwald             break;
1314fab26ab3SMatthias Ringwald         }
1315fab26ab3SMatthias Ringwald         case HCI_INIT_SEND_BAUD_CHANGE_BCM: {
131696b53536SMatthias Ringwald             uint32_t baud_rate = hci_transport_uart_get_main_baud_rate();
13173fb36a29SMatthias Ringwald             hci_stack->chipset->set_baudrate_command(baud_rate, hci_stack->hci_packet_buffer);
1318f8fbdce0SMatthias Ringwald             hci_stack->last_cmd_opcode = little_endian_read_16(hci_stack->hci_packet_buffer, 0);
1319eb3a5314SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_SEND_BAUD_CHANGE_BCM;
13204ea43905SMatthias Ringwald             hci_send_cmd_packet(hci_stack->hci_packet_buffer, 3u + hci_stack->hci_packet_buffer[2u]);
1321eb3a5314SMatthias Ringwald             break;
1322fab26ab3SMatthias Ringwald         }
132374b323a9SMatthias Ringwald         case HCI_INIT_CUSTOM_INIT:
132474b323a9SMatthias Ringwald             // Custom initialization
13253fb36a29SMatthias Ringwald             if (hci_stack->chipset && hci_stack->chipset->next_command){
1326ae334e9eSMatthias Ringwald                 hci_stack->chipset_result = (*hci_stack->chipset->next_command)(hci_stack->hci_packet_buffer);
13271979f09cSMatthias Ringwald                 bool send_cmd = false;
1328ae334e9eSMatthias Ringwald                 switch (hci_stack->chipset_result){
1329f41911edSMatthias Ringwald                     case BTSTACK_CHIPSET_VALID_COMMAND:
13301979f09cSMatthias Ringwald                         send_cmd = true;
1331e47e68c7SMatthias Ringwald                         hci_stack->substate = HCI_INIT_W4_CUSTOM_INIT;
1332e47e68c7SMatthias Ringwald                         break;
1333f41911edSMatthias Ringwald                     case BTSTACK_CHIPSET_WARMSTART_REQUIRED:
13341979f09cSMatthias Ringwald                         send_cmd = true;
1335f41911edSMatthias Ringwald                         // CSR Warm Boot: Wait a bit, then send HCI Reset until HCI Command Complete
1336e47e68c7SMatthias Ringwald                         log_info("CSR Warm Boot");
1337659d758cSMatthias Ringwald                         btstack_run_loop_set_timer(&hci_stack->timeout, HCI_RESET_RESEND_TIMEOUT_MS);
1338528a4a3bSMatthias Ringwald                         btstack_run_loop_set_timer_handler(&hci_stack->timeout, hci_initialization_timeout_handler);
1339528a4a3bSMatthias Ringwald                         btstack_run_loop_add_timer(&hci_stack->timeout);
1340a1df452eSMatthias Ringwald                         if ((hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_CAMBRIDGE_SILICON_RADIO)
1341772a36d3SMatthias Ringwald                             && hci_stack->config
13423fb36a29SMatthias Ringwald                             && hci_stack->chipset
13433fb36a29SMatthias Ringwald                             // && hci_stack->chipset->set_baudrate_command -- there's no such command
1344772a36d3SMatthias Ringwald                             && hci_stack->hci_transport->set_baudrate
13452caefae9SMatthias Ringwald                             && hci_transport_uart_get_main_baud_rate()){
1346772a36d3SMatthias Ringwald                             hci_stack->substate = HCI_INIT_W4_SEND_BAUD_CHANGE;
1347772a36d3SMatthias Ringwald                         } else {
13489f007422SMatthias Ringwald                            hci_stack->substate = HCI_INIT_W4_CUSTOM_INIT_CSR_WARM_BOOT_LINK_RESET;
1349772a36d3SMatthias Ringwald                         }
1350e47e68c7SMatthias Ringwald                         break;
1351f41911edSMatthias Ringwald                     default:
1352f41911edSMatthias Ringwald                         break;
1353e47e68c7SMatthias Ringwald                 }
1354ee720f3aSMatthias Ringwald 
1355ee720f3aSMatthias Ringwald                 if (send_cmd){
13564ea43905SMatthias Ringwald                     int size = 3u + hci_stack->hci_packet_buffer[2u];
1357ee720f3aSMatthias Ringwald                     hci_stack->last_cmd_opcode = little_endian_read_16(hci_stack->hci_packet_buffer, 0);
1358ee720f3aSMatthias Ringwald                     hci_dump_packet(HCI_COMMAND_DATA_PACKET, 0, hci_stack->hci_packet_buffer, size);
13590305bdeaSMatthias Ringwald                     hci_stack->hci_transport->send_packet(HCI_COMMAND_DATA_PACKET, hci_stack->hci_packet_buffer, size);
136074b323a9SMatthias Ringwald                     break;
136174b323a9SMatthias Ringwald                 }
1362148ca237SMatthias Ringwald                 log_info("Init script done");
136392a0d36dSMatthias Ringwald 
1364559961d0SMatthias Ringwald                 // Init script download on Broadcom chipsets causes:
1365ae334e9eSMatthias Ringwald                 if ( (hci_stack->chipset_result != BTSTACK_CHIPSET_NO_INIT_SCRIPT) &&
1366a1df452eSMatthias Ringwald                    (  (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_BROADCOM_CORPORATION)
1367a1df452eSMatthias Ringwald                 ||    (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_EM_MICROELECTRONIC_MARIN_SA)) ){
1368e021ff1eSMatthias Ringwald 
1369559961d0SMatthias Ringwald                     // - baud rate to reset, restore UART baud rate if needed
137092a0d36dSMatthias Ringwald                     int need_baud_change = hci_stack->config
13713fb36a29SMatthias Ringwald                         && hci_stack->chipset
13723fb36a29SMatthias Ringwald                         && hci_stack->chipset->set_baudrate_command
137392a0d36dSMatthias Ringwald                         && hci_stack->hci_transport->set_baudrate
13749796ebeaSMatthias Ringwald                         && ((hci_transport_config_uart_t *)hci_stack->config)->baudrate_main;
137592a0d36dSMatthias Ringwald                     if (need_baud_change) {
13769796ebeaSMatthias Ringwald                         uint32_t baud_rate = ((hci_transport_config_uart_t *)hci_stack->config)->baudrate_init;
1377cd724cb7SMatthias Ringwald                         log_info("Local baud rate change to %" PRIu32 " after init script (bcm)", baud_rate);
137892a0d36dSMatthias Ringwald                         hci_stack->hci_transport->set_baudrate(baud_rate);
137992a0d36dSMatthias Ringwald                     }
1380559961d0SMatthias Ringwald 
1381f19b3c9eSMatthias Ringwald                     uint16_t bcm_delay_ms = 300;
1382f19b3c9eSMatthias Ringwald                     // - UART may or may not be disabled during update and Controller RTS may or may not be high during this time
1383f19b3c9eSMatthias Ringwald                     //   -> Work around: wait here.
1384f19b3c9eSMatthias Ringwald                     log_info("BCM delay (%u ms) after init script", bcm_delay_ms);
1385559961d0SMatthias Ringwald                     hci_stack->substate = HCI_INIT_W4_CUSTOM_INIT_BCM_DELAY;
1386f19b3c9eSMatthias Ringwald                     btstack_run_loop_set_timer(&hci_stack->timeout, bcm_delay_ms);
1387559961d0SMatthias Ringwald                     btstack_run_loop_set_timer_handler(&hci_stack->timeout, hci_initialization_timeout_handler);
1388559961d0SMatthias Ringwald                     btstack_run_loop_add_timer(&hci_stack->timeout);
1389559961d0SMatthias Ringwald                     break;
139092a0d36dSMatthias Ringwald                 }
139174b323a9SMatthias Ringwald             }
139274b323a9SMatthias Ringwald             // otherwise continue
1393a828a756SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_READ_LOCAL_SUPPORTED_COMMANDS;
1394a828a756SMatthias Ringwald             hci_send_cmd(&hci_read_local_supported_commands);
1395a828a756SMatthias Ringwald             break;
139653860077SMatthias Ringwald         case HCI_INIT_SET_BD_ADDR:
139753860077SMatthias Ringwald             log_info("Set Public BD ADDR to %s", bd_addr_to_str(hci_stack->custom_bd_addr));
13983fb36a29SMatthias Ringwald             hci_stack->chipset->set_bd_addr_command(hci_stack->custom_bd_addr, hci_stack->hci_packet_buffer);
1399f8fbdce0SMatthias Ringwald             hci_stack->last_cmd_opcode = little_endian_read_16(hci_stack->hci_packet_buffer, 0);
140053860077SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_SET_BD_ADDR;
14014ea43905SMatthias Ringwald             hci_send_cmd_packet(hci_stack->hci_packet_buffer, 3u + hci_stack->hci_packet_buffer[2u]);
140253860077SMatthias Ringwald             break;
140306b9e820SMatthias Ringwald #endif
140406b9e820SMatthias Ringwald 
140506b9e820SMatthias Ringwald         case HCI_INIT_READ_LOCAL_SUPPORTED_COMMANDS:
140606b9e820SMatthias Ringwald             log_info("Resend hci_read_local_supported_commands after CSR Warm Boot double reset");
140706b9e820SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_READ_LOCAL_SUPPORTED_COMMANDS;
140806b9e820SMatthias Ringwald             hci_send_cmd(&hci_read_local_supported_commands);
140906b9e820SMatthias Ringwald             break;
141053860077SMatthias Ringwald         case HCI_INIT_READ_BD_ADDR:
141153860077SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_READ_BD_ADDR;
141253860077SMatthias Ringwald             hci_send_cmd(&hci_read_bd_addr);
141353860077SMatthias Ringwald             break;
141474b323a9SMatthias Ringwald         case HCI_INIT_READ_BUFFER_SIZE:
141574b323a9SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_READ_BUFFER_SIZE;
14160305bdeaSMatthias Ringwald             hci_send_cmd(&hci_read_buffer_size);
141774b323a9SMatthias Ringwald             break;
141853860077SMatthias Ringwald         case HCI_INIT_READ_LOCAL_SUPPORTED_FEATURES:
141953860077SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_READ_LOCAL_SUPPORTED_FEATURES;
14200305bdeaSMatthias Ringwald             hci_send_cmd(&hci_read_local_supported_features);
142174b323a9SMatthias Ringwald             break;
14222b838201SMatthias Ringwald 
14232b838201SMatthias Ringwald #ifdef ENABLE_HCI_CONTROLLER_TO_HOST_FLOW_CONTROL
14242b838201SMatthias Ringwald         case HCI_INIT_SET_CONTROLLER_TO_HOST_FLOW_CONTROL:
14252b838201SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_SET_CONTROLLER_TO_HOST_FLOW_CONTROL;
14262b838201SMatthias Ringwald             hci_send_cmd(&hci_set_controller_to_host_flow_control, 3);  // ACL + SCO Flow Control
14272b838201SMatthias Ringwald             break;
14282b838201SMatthias Ringwald         case HCI_INIT_HOST_BUFFER_SIZE:
14292b838201SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_HOST_BUFFER_SIZE;
14302b838201SMatthias Ringwald             hci_send_cmd(&hci_host_buffer_size, HCI_HOST_ACL_PACKET_LEN, HCI_HOST_SCO_PACKET_LEN,
14312b838201SMatthias Ringwald                                                 HCI_HOST_ACL_PACKET_NUM, HCI_HOST_SCO_PACKET_NUM);
14322b838201SMatthias Ringwald             break;
14332b838201SMatthias Ringwald #endif
14342b838201SMatthias Ringwald 
143574b323a9SMatthias Ringwald         case HCI_INIT_SET_EVENT_MASK:
14360305bdeaSMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_SET_EVENT_MASK;
143774b323a9SMatthias Ringwald             if (hci_le_supported()){
14385ce1359eSMatthias Ringwald                 hci_send_cmd(&hci_set_event_mask,0xFFFFFFFFU, 0x3FFFFFFFU);
143974b323a9SMatthias Ringwald             } else {
144074b323a9SMatthias Ringwald                 // Kensington Bluetooth 2.1 USB Dongle (CSR Chipset) returns an error for 0xffff...
14415ce1359eSMatthias Ringwald                 hci_send_cmd(&hci_set_event_mask,0xFFFFFFFFU, 0x1FFFFFFFU);
144274b323a9SMatthias Ringwald             }
144374b323a9SMatthias Ringwald             break;
14442b838201SMatthias Ringwald 
144535454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
144674b323a9SMatthias Ringwald         case HCI_INIT_WRITE_SIMPLE_PAIRING_MODE:
144774b323a9SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_WRITE_SIMPLE_PAIRING_MODE;
14480305bdeaSMatthias Ringwald             hci_send_cmd(&hci_write_simple_pairing_mode, hci_stack->ssp_enable);
144974b323a9SMatthias Ringwald             break;
145074b323a9SMatthias Ringwald         case HCI_INIT_WRITE_PAGE_TIMEOUT:
145174b323a9SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_WRITE_PAGE_TIMEOUT;
14520305bdeaSMatthias Ringwald             hci_send_cmd(&hci_write_page_timeout, 0x6000);  // ca. 15 sec
145374b323a9SMatthias Ringwald             break;
1454c33e56d3SMatthias Ringwald         case HCI_INIT_WRITE_DEFAULT_LINK_POLICY_SETTING:
1455c33e56d3SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_WRITE_DEFAULT_LINK_POLICY_SETTING;
1456c33e56d3SMatthias Ringwald             hci_send_cmd(&hci_write_default_link_policy_setting, hci_stack->default_link_policy_settings);
1457c33e56d3SMatthias Ringwald             break;
145874b323a9SMatthias Ringwald         case HCI_INIT_WRITE_CLASS_OF_DEVICE:
145974b323a9SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_WRITE_CLASS_OF_DEVICE;
14600305bdeaSMatthias Ringwald             hci_send_cmd(&hci_write_class_of_device, hci_stack->class_of_device);
146174b323a9SMatthias Ringwald             break;
14621c2a62f5SMatthias Ringwald         case HCI_INIT_WRITE_LOCAL_NAME: {
14630305bdeaSMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_WRITE_LOCAL_NAME;
14641c2a62f5SMatthias Ringwald             hci_reserve_packet_buffer();
14651c2a62f5SMatthias Ringwald             uint8_t * packet = hci_stack->hci_packet_buffer;
14661c2a62f5SMatthias Ringwald             // construct HCI Command and send
14671c2a62f5SMatthias Ringwald             uint16_t opcode = hci_write_local_name.opcode;
14681c2a62f5SMatthias Ringwald             hci_stack->last_cmd_opcode = opcode;
14691c2a62f5SMatthias Ringwald             packet[0] = opcode & 0xff;
14701c2a62f5SMatthias Ringwald             packet[1] = opcode >> 8;
14711c2a62f5SMatthias Ringwald             packet[2] = DEVICE_NAME_LEN;
14721c2a62f5SMatthias Ringwald             memset(&packet[3], 0, DEVICE_NAME_LEN);
147379186815SMatthias Ringwald             uint16_t name_len = (uint16_t) strlen(hci_stack->local_name);
147479186815SMatthias Ringwald             uint16_t bytes_to_copy = btstack_min(name_len, DEVICE_NAME_LEN);
147579186815SMatthias Ringwald             // if shorter than DEVICE_NAME_LEN, it's implicitly NULL-terminated by memset call
147679186815SMatthias Ringwald             (void)memcpy(&packet[3], hci_stack->local_name, bytes_to_copy);
14771c2a62f5SMatthias Ringwald             // expand '00:00:00:00:00:00' in name with bd_addr
14783c9da642SMatthias Ringwald             btstack_replace_bd_addr_placeholder(&packet[3], bytes_to_copy, hci_stack->local_bd_addr);
14791c2a62f5SMatthias Ringwald             hci_send_cmd_packet(packet, HCI_CMD_HEADER_SIZE + DEVICE_NAME_LEN);
148074b323a9SMatthias Ringwald             break;
14811c2a62f5SMatthias Ringwald         }
148229af07f3SMatthias Ringwald         case HCI_INIT_WRITE_EIR_DATA: {
14838a114470SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_WRITE_EIR_DATA;
148429af07f3SMatthias Ringwald             hci_reserve_packet_buffer();
148529af07f3SMatthias Ringwald             uint8_t * packet = hci_stack->hci_packet_buffer;
148663873210SMatthias Ringwald             // construct HCI Command in-place and send
148729af07f3SMatthias Ringwald             uint16_t opcode = hci_write_extended_inquiry_response.opcode;
148829af07f3SMatthias Ringwald             hci_stack->last_cmd_opcode = opcode;
148963873210SMatthias Ringwald             uint16_t offset = 0;
149063873210SMatthias Ringwald             packet[offset++] = opcode & 0xff;
149163873210SMatthias Ringwald             packet[offset++] = opcode >> 8;
149263873210SMatthias Ringwald             packet[offset++] = 1 + EXTENDED_INQUIRY_RESPONSE_DATA_LEN;
149363873210SMatthias Ringwald             packet[offset++] = 0;  // FEC not required
149463873210SMatthias Ringwald             memset(&packet[offset], 0, EXTENDED_INQUIRY_RESPONSE_DATA_LEN);
1495ad0d1108SMatthias Ringwald             if (hci_stack->eir_data){
149663873210SMatthias Ringwald                 // copy items and expand '00:00:00:00:00:00' in name with bd_addr
149763873210SMatthias Ringwald                 ad_context_t context;
149863873210SMatthias Ringwald                 for (ad_iterator_init(&context, EXTENDED_INQUIRY_RESPONSE_DATA_LEN, hci_stack->eir_data) ; ad_iterator_has_more(&context) ; ad_iterator_next(&context)) {
149963873210SMatthias Ringwald                     uint8_t data_type   = ad_iterator_get_data_type(&context);
150063873210SMatthias Ringwald                     uint8_t size        = ad_iterator_get_data_len(&context);
150163873210SMatthias Ringwald                     const uint8_t *data = ad_iterator_get_data(&context);
150263873210SMatthias Ringwald                     // copy item
150363873210SMatthias Ringwald                     packet[offset++] = size + 1;
150463873210SMatthias Ringwald                     packet[offset++] = data_type;
150563873210SMatthias Ringwald                     memcpy(&packet[offset], data, size);
150663873210SMatthias Ringwald                     // update name item
150763873210SMatthias Ringwald                     if ((data_type == BLUETOOTH_DATA_TYPE_SHORTENED_LOCAL_NAME) || (data_type == BLUETOOTH_DATA_TYPE_COMPLETE_LOCAL_NAME)){
15083c9da642SMatthias Ringwald                         btstack_replace_bd_addr_placeholder(&packet[offset], size, hci_stack->local_bd_addr);
150963873210SMatthias Ringwald                     }
151063873210SMatthias Ringwald                     offset += size;
151163873210SMatthias Ringwald                 }
1512ad0d1108SMatthias Ringwald             } else {
151379186815SMatthias Ringwald                 uint16_t name_len = (uint16_t) strlen(hci_stack->local_name);
151479186815SMatthias Ringwald                 uint16_t bytes_to_copy = btstack_min(name_len, EXTENDED_INQUIRY_RESPONSE_DATA_LEN - 2);
151563873210SMatthias Ringwald                 packet[offset++] = bytes_to_copy + 1;
151663873210SMatthias Ringwald                 packet[offset++] = BLUETOOTH_DATA_TYPE_COMPLETE_LOCAL_NAME;
151779186815SMatthias Ringwald                 (void)memcpy(&packet[6], hci_stack->local_name, bytes_to_copy);
151829af07f3SMatthias Ringwald                 // expand '00:00:00:00:00:00' in name with bd_addr
15193c9da642SMatthias Ringwald                 btstack_replace_bd_addr_placeholder(&packet[offset], bytes_to_copy, hci_stack->local_bd_addr);
152063873210SMatthias Ringwald             }
1521a8c4e5adSMatthias Ringwald             hci_send_cmd_packet(packet, HCI_CMD_HEADER_SIZE + 1 + EXTENDED_INQUIRY_RESPONSE_DATA_LEN);
1522ff00ed1cSMatthias Ringwald             break;
152329af07f3SMatthias Ringwald         }
1524f6858d14SMatthias Ringwald         case HCI_INIT_WRITE_INQUIRY_MODE:
1525f6858d14SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_WRITE_INQUIRY_MODE;
15268a114470SMatthias Ringwald             hci_send_cmd(&hci_write_inquiry_mode, (int) hci_stack->inquiry_mode);
1527f6858d14SMatthias Ringwald             break;
15285d23aae8SMatthias Ringwald         case HCI_INIT_WRITE_SECURE_CONNECTIONS_HOST_ENABLE:
15295d23aae8SMatthias Ringwald             hci_send_cmd(&hci_write_secure_connections_host_support, 1);
1530c214d65bSMatthias Ringwald 			hci_stack->secure_connections_active = true;
15315d23aae8SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_WRITE_SECURE_CONNECTIONS_HOST_ENABLE;
15325d23aae8SMatthias Ringwald             break;
153374b323a9SMatthias Ringwald         case HCI_INIT_WRITE_SCAN_ENABLE:
153474b323a9SMatthias Ringwald             hci_send_cmd(&hci_write_scan_enable, (hci_stack->connectable << 1) | hci_stack->discoverable); // page scan
153574b323a9SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_WRITE_SCAN_ENABLE;
153674b323a9SMatthias Ringwald             break;
1537483c5078SMatthias Ringwald         // only sent if ENABLE_SCO_OVER_HCI is defined
1538729ed62eSMatthias Ringwald         case HCI_INIT_WRITE_SYNCHRONOUS_FLOW_CONTROL_ENABLE:
1539729ed62eSMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_WRITE_SYNCHRONOUS_FLOW_CONTROL_ENABLE;
1540729ed62eSMatthias Ringwald             hci_send_cmd(&hci_write_synchronous_flow_control_enable, 1); // SCO tracking enabled
1541729ed62eSMatthias Ringwald             break;
1542483c5078SMatthias Ringwald         case HCI_INIT_WRITE_DEFAULT_ERRONEOUS_DATA_REPORTING:
1543483c5078SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_WRITE_DEFAULT_ERRONEOUS_DATA_REPORTING;
1544483c5078SMatthias Ringwald             hci_send_cmd(&hci_write_default_erroneous_data_reporting, 1);
1545483c5078SMatthias Ringwald             break;
15468051253fSMatthias Ringwald         // only sent if manufacturer is Broadcom and ENABLE_SCO_OVER_HCI or ENABLE_SCO_OVER_PCM is defined
1547a42798c3SMatthias Ringwald         case HCI_INIT_BCM_WRITE_SCO_PCM_INT:
1548a42798c3SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_BCM_WRITE_SCO_PCM_INT;
15498051253fSMatthias Ringwald #ifdef ENABLE_SCO_OVER_HCI
1550a42798c3SMatthias Ringwald             log_info("BCM: Route SCO data via HCI transport");
1551a42798c3SMatthias Ringwald             hci_send_cmd(&hci_bcm_write_sco_pcm_int, 1, 0, 0, 0, 0);
15528051253fSMatthias Ringwald #endif
15538051253fSMatthias Ringwald #ifdef ENABLE_SCO_OVER_PCM
15548051253fSMatthias Ringwald             log_info("BCM: Route SCO data via PCM interface");
15551d2bbd54SMatthias Ringwald #ifdef ENABLE_BCM_PCM_WBS
15561d2bbd54SMatthias Ringwald             // 512 kHz bit clock for 2 channels x 16 bit x 8 kHz
15571d2bbd54SMatthias Ringwald             hci_send_cmd(&hci_bcm_write_sco_pcm_int, 0, 2, 0, 1, 1);
15581d2bbd54SMatthias Ringwald #else
15591d2bbd54SMatthias Ringwald             // 256 kHz bit clock for 2 channels x 16 bit x 8 kHz
15601d2bbd54SMatthias Ringwald             hci_send_cmd(&hci_bcm_write_sco_pcm_int, 0, 1, 0, 1, 1);
15611d2bbd54SMatthias Ringwald #endif
15628051253fSMatthias Ringwald #endif
1563a42798c3SMatthias Ringwald             break;
15644e821764SMatthias Ringwald #ifdef ENABLE_SCO_OVER_PCM
15654e821764SMatthias Ringwald         case HCI_INIT_BCM_WRITE_I2SPCM_INTERFACE_PARAM:
15664e821764SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_BCM_WRITE_I2SPCM_INTERFACE_PARAM;
15674e821764SMatthias Ringwald             log_info("BCM: Config PCM interface for I2S");
15681d2bbd54SMatthias Ringwald #ifdef ENABLE_BCM_PCM_WBS
15691d2bbd54SMatthias Ringwald             // 512 kHz bit clock for 2 channels x 16 bit x 8 kHz
15701d2bbd54SMatthias Ringwald             hci_send_cmd(&hci_bcm_write_i2spcm_interface_param, 1, 1, 0, 2);
15711d2bbd54SMatthias Ringwald #else
15721d2bbd54SMatthias Ringwald             // 256 kHz bit clock for 2 channels x 16 bit x 8 kHz
15731d2bbd54SMatthias Ringwald             hci_send_cmd(&hci_bcm_write_i2spcm_interface_param, 1, 1, 0, 1);
15741d2bbd54SMatthias Ringwald #endif
15754e821764SMatthias Ringwald             break;
157635454696SMatthias Ringwald #endif
15774e821764SMatthias Ringwald #endif
15784e821764SMatthias Ringwald 
1579a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE
158074b323a9SMatthias Ringwald         // LE INIT
158174b323a9SMatthias Ringwald         case HCI_INIT_LE_READ_BUFFER_SIZE:
158274b323a9SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_LE_READ_BUFFER_SIZE;
15830305bdeaSMatthias Ringwald             hci_send_cmd(&hci_le_read_buffer_size);
158474b323a9SMatthias Ringwald             break;
1585daabb8b8SMatthias Ringwald         case HCI_INIT_LE_SET_EVENT_MASK:
1586daabb8b8SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_LE_SET_EVENT_MASK;
1587729710c0SMatthias Ringwald             hci_send_cmd(&hci_le_set_event_mask, 0x809FF, 0x0); // bits 0-8, 11, 19
1588daabb8b8SMatthias Ringwald             break;
158974b323a9SMatthias Ringwald         case HCI_INIT_WRITE_LE_HOST_SUPPORTED:
159074b323a9SMatthias Ringwald             // LE Supported Host = 1, Simultaneous Host = 0
159174b323a9SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_WRITE_LE_HOST_SUPPORTED;
15920305bdeaSMatthias Ringwald             hci_send_cmd(&hci_write_le_host_supported, 1, 0);
159374b323a9SMatthias Ringwald             break;
1594b435e062SMatthias Ringwald #endif
1595b435e062SMatthias Ringwald 
1596b435e062SMatthias Ringwald #ifdef ENABLE_LE_DATA_LENGTH_EXTENSION
1597dcd678baSMatthias Ringwald         case HCI_INIT_LE_READ_MAX_DATA_LENGTH:
1598dcd678baSMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_LE_READ_MAX_DATA_LENGTH;
1599dcd678baSMatthias Ringwald             hci_send_cmd(&hci_le_read_maximum_data_length);
1600dcd678baSMatthias Ringwald             break;
1601dcd678baSMatthias Ringwald         case HCI_INIT_LE_WRITE_SUGGESTED_DATA_LENGTH:
1602dcd678baSMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_LE_WRITE_SUGGESTED_DATA_LENGTH;
1603b435e062SMatthias 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);
1604dcd678baSMatthias Ringwald             break;
1605b435e062SMatthias Ringwald #endif
1606b435e062SMatthias Ringwald 
1607b95a5a35SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
16083b6d4121SMatthias Ringwald         case HCI_INIT_READ_WHITE_LIST_SIZE:
16093b6d4121SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_READ_WHITE_LIST_SIZE;
16103b6d4121SMatthias Ringwald             hci_send_cmd(&hci_le_read_white_list_size);
16113b6d4121SMatthias Ringwald             break;
161274b323a9SMatthias Ringwald         case HCI_INIT_LE_SET_SCAN_PARAMETERS:
161374b323a9SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_LE_SET_SCAN_PARAMETERS;
16148b69e4c7SMatthias 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);
161574b323a9SMatthias Ringwald             break;
161674b323a9SMatthias Ringwald #endif
161774b323a9SMatthias Ringwald         default:
161874b323a9SMatthias Ringwald             return;
161974b323a9SMatthias Ringwald     }
162055975f88SMatthias Ringwald }
162155975f88SMatthias Ringwald 
1622a650ba4dSMatthias Ringwald static void hci_init_done(void){
1623a650ba4dSMatthias Ringwald     // done. tell the app
1624a650ba4dSMatthias Ringwald     log_info("hci_init_done -> HCI_STATE_WORKING");
1625a650ba4dSMatthias Ringwald     hci_stack->state = HCI_STATE_WORKING;
1626a650ba4dSMatthias Ringwald     hci_emit_state();
1627a650ba4dSMatthias Ringwald     hci_run();
1628a650ba4dSMatthias Ringwald }
1629a650ba4dSMatthias Ringwald 
163007fd2f31SMatthias Ringwald static bool hci_initializing_event_handler_command_completed(const uint8_t * packet){
163107fd2f31SMatthias Ringwald     bool command_completed = false;
16320e2df43fSMatthias Ringwald     if (hci_event_packet_get_type(packet) == HCI_EVENT_COMMAND_COMPLETE){
1633f8fbdce0SMatthias Ringwald         uint16_t opcode = little_endian_read_16(packet,3);
16346155b3d3S[email protected]         if (opcode == hci_stack->last_cmd_opcode){
163507fd2f31SMatthias Ringwald             command_completed = true;
1636148ca237SMatthias Ringwald             log_debug("Command complete for expected opcode %04x at substate %u", opcode, hci_stack->substate);
16376155b3d3S[email protected]         } else {
1638d58dd308SMatthias Ringwald             log_info("Command complete for different opcode %04x, expected %04x, at substate %u", opcode, hci_stack->last_cmd_opcode, hci_stack->substate);
16396155b3d3S[email protected]         }
16406155b3d3S[email protected]     }
16410f97eae7SMatthias Ringwald 
16420e2df43fSMatthias Ringwald     if (hci_event_packet_get_type(packet) == HCI_EVENT_COMMAND_STATUS){
16436155b3d3S[email protected]         uint8_t  status = packet[2];
1644f8fbdce0SMatthias Ringwald         uint16_t opcode = little_endian_read_16(packet,4);
16456155b3d3S[email protected]         if (opcode == hci_stack->last_cmd_opcode){
16466155b3d3S[email protected]             if (status){
164707fd2f31SMatthias Ringwald                 command_completed = true;
1648148ca237SMatthias Ringwald                 log_debug("Command status error 0x%02x for expected opcode %04x at substate %u", status, opcode, hci_stack->substate);
16496155b3d3S[email protected]             } else {
16506155b3d3S[email protected]                 log_info("Command status OK for expected opcode %04x, waiting for command complete", opcode);
16516155b3d3S[email protected]             }
16526155b3d3S[email protected]         } else {
1653148ca237SMatthias Ringwald             log_debug("Command status for opcode %04x, expected %04x", opcode, hci_stack->last_cmd_opcode);
16546155b3d3S[email protected]         }
16556155b3d3S[email protected]     }
165606b9e820SMatthias Ringwald #if !defined(HAVE_PLATFORM_IPHONE_OS) && !defined (HAVE_HOST_CONTROLLER_API)
1657e47e68c7SMatthias Ringwald     // Vendor == CSR
16580e588213SMatthias Ringwald     if ((hci_stack->substate == HCI_INIT_W4_CUSTOM_INIT) && (hci_event_packet_get_type(packet) == HCI_EVENT_VENDOR_SPECIFIC)){
1659e47e68c7SMatthias Ringwald         // TODO: track actual command
166007fd2f31SMatthias Ringwald         command_completed = true;
1661e47e68c7SMatthias Ringwald     }
1662a2481739S[email protected] 
16634e9daa6fSMatthias Ringwald     // Vendor == Toshiba
16640e588213SMatthias Ringwald     if ((hci_stack->substate == HCI_INIT_W4_SEND_BAUD_CHANGE) && (hci_event_packet_get_type(packet) == HCI_EVENT_VENDOR_SPECIFIC)){
16654e9daa6fSMatthias Ringwald         // TODO: track actual command
166607fd2f31SMatthias Ringwald         command_completed = true;
1667004902f1SMatthias Ringwald         // Fix: no HCI Command Complete received, so num_cmd_packets not reset
1668004902f1SMatthias Ringwald         hci_stack->num_cmd_packets = 1;
16694e9daa6fSMatthias Ringwald     }
167007fd2f31SMatthias Ringwald #endif
167107fd2f31SMatthias Ringwald 
167207fd2f31SMatthias Ringwald     return command_completed;
167307fd2f31SMatthias Ringwald }
167407fd2f31SMatthias Ringwald 
167507fd2f31SMatthias Ringwald static void hci_initializing_event_handler(const uint8_t * packet, uint16_t size){
167607fd2f31SMatthias Ringwald 
167707fd2f31SMatthias Ringwald     UNUSED(size);   // ok: less than 6 bytes are read from our buffer
167807fd2f31SMatthias Ringwald 
167907fd2f31SMatthias Ringwald     bool command_completed =  hci_initializing_event_handler_command_completed(packet);
168007fd2f31SMatthias Ringwald 
168107fd2f31SMatthias Ringwald #if !defined(HAVE_PLATFORM_IPHONE_OS) && !defined (HAVE_HOST_CONTROLLER_API)
16824e9daa6fSMatthias Ringwald 
16830f97eae7SMatthias Ringwald     // Late response (> 100 ms) for HCI Reset e.g. on Toshiba TC35661:
16840f97eae7SMatthias Ringwald     // Command complete for HCI Reset arrives after we've resent the HCI Reset command
16850f97eae7SMatthias Ringwald     //
16860f97eae7SMatthias Ringwald     // HCI Reset
16870f97eae7SMatthias Ringwald     // Timeout 100 ms
16880f97eae7SMatthias Ringwald     // HCI Reset
16890f97eae7SMatthias Ringwald     // Command Complete Reset
16900f97eae7SMatthias Ringwald     // HCI Read Local Version Information
16910f97eae7SMatthias Ringwald     // Command Complete Reset - but we expected Command Complete Read Local Version Information
16920f97eae7SMatthias Ringwald     // hang...
16930f97eae7SMatthias Ringwald     //
16940f97eae7SMatthias Ringwald     // Fix: Command Complete for HCI Reset in HCI_INIT_W4_SEND_READ_LOCAL_VERSION_INFORMATION trigger resend
16950f97eae7SMatthias Ringwald     if (!command_completed
1696a1df452eSMatthias Ringwald             && (hci_event_packet_get_type(packet) == HCI_EVENT_COMMAND_COMPLETE)
16970e588213SMatthias Ringwald             && (hci_stack->substate == HCI_INIT_W4_SEND_READ_LOCAL_VERSION_INFORMATION)){
16980f97eae7SMatthias Ringwald 
1699f8fbdce0SMatthias Ringwald         uint16_t opcode = little_endian_read_16(packet,3);
17000f97eae7SMatthias Ringwald         if (opcode == hci_reset.opcode){
17010f97eae7SMatthias Ringwald             hci_stack->substate = HCI_INIT_SEND_READ_LOCAL_VERSION_INFORMATION;
17020f97eae7SMatthias Ringwald             return;
17030f97eae7SMatthias Ringwald         }
17040f97eae7SMatthias Ringwald     }
17050f97eae7SMatthias Ringwald 
17069f007422SMatthias Ringwald     // CSR & H5
17079f007422SMatthias Ringwald     // Fix: Command Complete for HCI Reset in HCI_INIT_W4_SEND_READ_LOCAL_VERSION_INFORMATION trigger resend
17089f007422SMatthias Ringwald     if (!command_completed
1709a1df452eSMatthias Ringwald             && (hci_event_packet_get_type(packet) == HCI_EVENT_COMMAND_COMPLETE)
17100e588213SMatthias Ringwald             && (hci_stack->substate == HCI_INIT_W4_READ_LOCAL_SUPPORTED_COMMANDS)){
17119f007422SMatthias Ringwald 
17129f007422SMatthias Ringwald         uint16_t opcode = little_endian_read_16(packet,3);
17139f007422SMatthias Ringwald         if (opcode == hci_reset.opcode){
17149f007422SMatthias Ringwald             hci_stack->substate = HCI_INIT_READ_LOCAL_SUPPORTED_COMMANDS;
17159f007422SMatthias Ringwald             return;
17169f007422SMatthias Ringwald         }
17179f007422SMatthias Ringwald     }
17189f007422SMatthias Ringwald 
17199f007422SMatthias 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
17209f007422SMatthias Ringwald     // fix: Correct substate and behave as command below
17219f007422SMatthias Ringwald     if (command_completed){
17229f007422SMatthias Ringwald         switch (hci_stack->substate){
17239f007422SMatthias Ringwald             case HCI_INIT_SEND_RESET:
17249f007422SMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_SEND_RESET;
17259f007422SMatthias Ringwald                 break;
17269f007422SMatthias Ringwald             case HCI_INIT_SEND_RESET_CSR_WARM_BOOT:
17279f007422SMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_CUSTOM_INIT_CSR_WARM_BOOT;
17289f007422SMatthias Ringwald                 break;
17299f007422SMatthias Ringwald             default:
17309f007422SMatthias Ringwald                 break;
17319f007422SMatthias Ringwald         }
17329f007422SMatthias Ringwald     }
17330f97eae7SMatthias Ringwald 
173406b9e820SMatthias Ringwald #endif
17350f97eae7SMatthias Ringwald 
1736a2481739S[email protected]     if (!command_completed) return;
1737a2481739S[email protected] 
173807fd2f31SMatthias Ringwald     bool need_baud_change = false;
173907fd2f31SMatthias Ringwald     bool need_addr_change = false;
174006b9e820SMatthias Ringwald 
174106b9e820SMatthias Ringwald #if !defined(HAVE_PLATFORM_IPHONE_OS) && !defined (HAVE_HOST_CONTROLLER_API)
174206b9e820SMatthias Ringwald     need_baud_change = hci_stack->config
17433fb36a29SMatthias Ringwald                         && hci_stack->chipset
17443fb36a29SMatthias Ringwald                         && hci_stack->chipset->set_baudrate_command
1745db8bc6ffSMatthias Ringwald                         && hci_stack->hci_transport->set_baudrate
17469796ebeaSMatthias Ringwald                         && ((hci_transport_config_uart_t *)hci_stack->config)->baudrate_main;
1747db8bc6ffSMatthias Ringwald 
174806b9e820SMatthias Ringwald     need_addr_change = hci_stack->custom_bd_addr_set
17493fb36a29SMatthias Ringwald                         && hci_stack->chipset
17503fb36a29SMatthias Ringwald                         && hci_stack->chipset->set_bd_addr_command;
175106b9e820SMatthias Ringwald #endif
1752a80162e9SMatthias Ringwald 
17535c363727SMatthias Ringwald     switch(hci_stack->substate){
175406b9e820SMatthias Ringwald 
175506b9e820SMatthias Ringwald #if !defined(HAVE_PLATFORM_IPHONE_OS) && !defined (HAVE_HOST_CONTROLLER_API)
17569f007422SMatthias Ringwald         case HCI_INIT_SEND_RESET:
1757d58dd308SMatthias Ringwald             // on CSR with BCSP/H5, resend triggers resend of HCI Reset and leads to substate == HCI_INIT_SEND_RESET
17589f007422SMatthias Ringwald             // fix: just correct substate and behave as command below
17599f007422SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_SEND_RESET;
17609f007422SMatthias Ringwald             btstack_run_loop_remove_timer(&hci_stack->timeout);
17619f007422SMatthias Ringwald             break;
176274b323a9SMatthias Ringwald         case HCI_INIT_W4_SEND_RESET:
1763528a4a3bSMatthias Ringwald             btstack_run_loop_remove_timer(&hci_stack->timeout);
176476fcb19bSMatthias Ringwald             break;
1765e90bae01SMatthias Ringwald         case HCI_INIT_W4_SEND_READ_LOCAL_NAME:
176607fd2f31SMatthias Ringwald             log_info("Received local name, need baud change %d", (int) need_baud_change);
17672f48d920SMatthias Ringwald             if (need_baud_change){
17682f48d920SMatthias Ringwald                 hci_stack->substate = HCI_INIT_SEND_BAUD_CHANGE;
17692f48d920SMatthias Ringwald                 return;
17702f48d920SMatthias Ringwald             }
177153860077SMatthias Ringwald             // skip baud change
177274b323a9SMatthias Ringwald             hci_stack->substate = HCI_INIT_CUSTOM_INIT;
177374b323a9SMatthias Ringwald             return;
1774a80162e9SMatthias Ringwald         case HCI_INIT_W4_SEND_BAUD_CHANGE:
17754696bddbSMatthias Ringwald             // for STLC2500D, baud rate change already happened.
1776fab26ab3SMatthias Ringwald             // for others, baud rate gets changed now
177761f37892SMatthias Ringwald             if ((hci_stack->manufacturer != BLUETOOTH_COMPANY_ID_ST_MICROELECTRONICS) && need_baud_change){
177896b53536SMatthias Ringwald                 uint32_t baud_rate = hci_transport_uart_get_main_baud_rate();
1779cd724cb7SMatthias Ringwald                 log_info("Local baud rate change to %" PRIu32 "(w4_send_baud_change)", baud_rate);
1780fab26ab3SMatthias Ringwald                 hci_stack->hci_transport->set_baudrate(baud_rate);
17814696bddbSMatthias Ringwald             }
178274b323a9SMatthias Ringwald             hci_stack->substate = HCI_INIT_CUSTOM_INIT;
178374b323a9SMatthias Ringwald             return;
1784a80162e9SMatthias Ringwald         case HCI_INIT_W4_CUSTOM_INIT_CSR_WARM_BOOT:
1785528a4a3bSMatthias Ringwald             btstack_run_loop_remove_timer(&hci_stack->timeout);
1786a80162e9SMatthias Ringwald             hci_stack->substate = HCI_INIT_CUSTOM_INIT;
1787a80162e9SMatthias Ringwald             return;
178874b323a9SMatthias Ringwald         case HCI_INIT_W4_CUSTOM_INIT:
178974b323a9SMatthias Ringwald             // repeat custom init
179074b323a9SMatthias Ringwald             hci_stack->substate = HCI_INIT_CUSTOM_INIT;
179174b323a9SMatthias Ringwald             return;
179206b9e820SMatthias Ringwald #else
179306b9e820SMatthias Ringwald         case HCI_INIT_W4_SEND_RESET:
179406b9e820SMatthias Ringwald             hci_stack->substate = HCI_INIT_READ_LOCAL_SUPPORTED_COMMANDS;
179506b9e820SMatthias Ringwald             return ;
179606b9e820SMatthias Ringwald #endif
179706b9e820SMatthias Ringwald 
1798a828a756SMatthias Ringwald         case HCI_INIT_W4_READ_LOCAL_SUPPORTED_COMMANDS:
17990e588213SMatthias Ringwald             if (need_baud_change && (hci_stack->chipset_result != BTSTACK_CHIPSET_NO_INIT_SCRIPT) &&
1800efd3b327SMatthias Ringwald               ((hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_BROADCOM_CORPORATION) ||
1801efd3b327SMatthias Ringwald                (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_EM_MICROELECTRONIC_MARIN_SA))) {
1802eb3a5314SMatthias Ringwald                 hci_stack->substate = HCI_INIT_SEND_BAUD_CHANGE_BCM;
1803eb3a5314SMatthias Ringwald                 return;
1804eb3a5314SMatthias Ringwald             }
180553860077SMatthias Ringwald             if (need_addr_change){
180653860077SMatthias Ringwald                 hci_stack->substate = HCI_INIT_SET_BD_ADDR;
180753860077SMatthias Ringwald                 return;
180853860077SMatthias Ringwald             }
180953860077SMatthias Ringwald             hci_stack->substate = HCI_INIT_READ_BD_ADDR;
181053860077SMatthias Ringwald             return;
181106b9e820SMatthias Ringwald #if !defined(HAVE_PLATFORM_IPHONE_OS) && !defined (HAVE_HOST_CONTROLLER_API)
18127224be7eSMatthias Ringwald         case HCI_INIT_W4_SEND_BAUD_CHANGE_BCM:
18137224be7eSMatthias Ringwald             if (need_baud_change){
181496b53536SMatthias Ringwald                 uint32_t baud_rate = hci_transport_uart_get_main_baud_rate();
1815cd724cb7SMatthias Ringwald                 log_info("Local baud rate change to %" PRIu32 "(w4_send_baud_change_bcm))", baud_rate);
1816fab26ab3SMatthias Ringwald                 hci_stack->hci_transport->set_baudrate(baud_rate);
18177224be7eSMatthias Ringwald             }
1818eb3a5314SMatthias Ringwald             if (need_addr_change){
1819eb3a5314SMatthias Ringwald                 hci_stack->substate = HCI_INIT_SET_BD_ADDR;
1820eb3a5314SMatthias Ringwald                 return;
1821eb3a5314SMatthias Ringwald             }
1822eb3a5314SMatthias Ringwald             hci_stack->substate = HCI_INIT_READ_BD_ADDR;
1823eb3a5314SMatthias Ringwald             return;
182453860077SMatthias Ringwald         case HCI_INIT_W4_SET_BD_ADDR:
18256ca9a99aSMatthias Ringwald             // for STLC2500D + ATWILC3000, bd addr change only gets active after sending reset command
18266ca9a99aSMatthias Ringwald             if ((hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_ST_MICROELECTRONICS)
18276ca9a99aSMatthias Ringwald             ||  (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_ATMEL_CORPORATION)){
182853860077SMatthias Ringwald                 hci_stack->substate = HCI_INIT_SEND_RESET_ST_WARM_BOOT;
182953860077SMatthias Ringwald                 return;
183053860077SMatthias Ringwald             }
183153860077SMatthias Ringwald             // skipping st warm boot
183253860077SMatthias Ringwald             hci_stack->substate = HCI_INIT_READ_BD_ADDR;
183353860077SMatthias Ringwald             return;
183453860077SMatthias Ringwald         case HCI_INIT_W4_SEND_RESET_ST_WARM_BOOT:
183553860077SMatthias Ringwald             hci_stack->substate = HCI_INIT_READ_BD_ADDR;
183653860077SMatthias Ringwald             return;
183706b9e820SMatthias Ringwald #endif
183853860077SMatthias Ringwald         case HCI_INIT_W4_READ_BD_ADDR:
183953860077SMatthias Ringwald             // only read buffer size if supported
18404ea43905SMatthias Ringwald             if (hci_stack->local_supported_commands[0u] & 0x01u) {
184153860077SMatthias Ringwald                 hci_stack->substate = HCI_INIT_READ_BUFFER_SIZE;
184253860077SMatthias Ringwald                 return;
184353860077SMatthias Ringwald             }
184453860077SMatthias Ringwald             // skipping read buffer size
184553860077SMatthias Ringwald             hci_stack->substate = HCI_INIT_READ_LOCAL_SUPPORTED_FEATURES;
1846a828a756SMatthias Ringwald             return;
184774b323a9SMatthias Ringwald         case HCI_INIT_W4_SET_EVENT_MASK:
18486155b3d3S[email protected]             // skip Classic init commands for LE only chipsets
18496155b3d3S[email protected]             if (!hci_classic_supported()){
18502c68f164SMatthias Ringwald #ifdef ENABLE_BLE
18516155b3d3S[email protected]                 if (hci_le_supported()){
185274b323a9SMatthias Ringwald                     hci_stack->substate = HCI_INIT_LE_READ_BUFFER_SIZE; // skip all classic command
185374b323a9SMatthias Ringwald                     return;
18542c68f164SMatthias Ringwald                 }
18552c68f164SMatthias Ringwald #endif
18566155b3d3S[email protected]                 log_error("Neither BR/EDR nor LE supported");
1857a650ba4dSMatthias Ringwald                 hci_init_done();
185874b323a9SMatthias Ringwald                 return;
18596155b3d3S[email protected]             }
186015a95bd5SMatthias Ringwald             if (!gap_ssp_supported()){
18615c363727SMatthias Ringwald                 hci_stack->substate = HCI_INIT_WRITE_PAGE_TIMEOUT;
186274b323a9SMatthias Ringwald                 return;
18636155b3d3S[email protected]             }
18646155b3d3S[email protected]             break;
1865903ea03aSMatthias Ringwald #ifdef ENABLE_BLE
1866a828a756SMatthias Ringwald         case HCI_INIT_W4_LE_READ_BUFFER_SIZE:
1867a828a756SMatthias Ringwald             // skip write le host if not supported (e.g. on LE only EM9301)
18684ea43905SMatthias Ringwald             if (hci_stack->local_supported_commands[0u] & 0x02u) break;
1869daabb8b8SMatthias Ringwald             hci_stack->substate = HCI_INIT_LE_SET_EVENT_MASK;
1870daabb8b8SMatthias Ringwald             return;
1871daabb8b8SMatthias Ringwald 
1872b435e062SMatthias Ringwald #ifdef ENABLE_LE_DATA_LENGTH_EXTENSION
1873b435e062SMatthias Ringwald         case HCI_INIT_W4_WRITE_LE_HOST_SUPPORTED:
18746fab74dbSMatthias Ringwald             log_info("Supported commands %x", hci_stack->local_supported_commands[0] & 0x30);
18754ea43905SMatthias Ringwald             if ((hci_stack->local_supported_commands[0u] & 0x30u) == 0x30u){
187680d7d618SMatthias Ringwald                 hci_stack->substate = HCI_INIT_LE_SET_EVENT_MASK;
1877b435e062SMatthias Ringwald                 return;
1878b435e062SMatthias Ringwald             }
1879b435e062SMatthias Ringwald             // explicit fall through to reduce repetitions
1880b435e062SMatthias Ringwald 
1881b435e062SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
1882b435e062SMatthias Ringwald             hci_stack->substate = HCI_INIT_READ_WHITE_LIST_SIZE;
1883903ea03aSMatthias Ringwald #else
1884903ea03aSMatthias Ringwald             hci_init_done();
1885903ea03aSMatthias Ringwald #endif
1886a828a756SMatthias Ringwald             return;
188706337f4fSMatthias Ringwald #endif  /* ENABLE_LE_DATA_LENGTH_EXTENSION */
188806337f4fSMatthias Ringwald 
188906337f4fSMatthias Ringwald #endif  /* ENABLE_BLE */
1890b435e062SMatthias Ringwald 
18915d23aae8SMatthias Ringwald         case HCI_INIT_W4_WRITE_INQUIRY_MODE:
18925d23aae8SMatthias Ringwald             // skip write secure connections host support if not supported or disabled
18934ea43905SMatthias Ringwald             if (!hci_stack->secure_connections_enable || (hci_stack->local_supported_commands[1u] & 0x02u) == 0u) {
18945d23aae8SMatthias Ringwald                 hci_stack->substate = HCI_INIT_WRITE_SCAN_ENABLE;
18955d23aae8SMatthias Ringwald                 return;
18965d23aae8SMatthias Ringwald             }
18975d23aae8SMatthias Ringwald             break;
18985d23aae8SMatthias Ringwald 
189947bc3ebbSMatthias Ringwald #ifdef ENABLE_SCO_OVER_HCI
19003b65523cSMatthias Ringwald         case HCI_INIT_W4_WRITE_SCAN_ENABLE:
19013905afbfSMatthias Ringwald             // skip write synchronous flow control if not supported
19023905afbfSMatthias Ringwald             if (hci_stack->local_supported_commands[0] & 0x04) break;
19033905afbfSMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_WRITE_SYNCHRONOUS_FLOW_CONTROL_ENABLE;
1904cf373d3aSMatthias Ringwald 
1905cf373d3aSMatthias Ringwald             /* fall through */
19063905afbfSMatthias Ringwald 
1907729ed62eSMatthias Ringwald         case HCI_INIT_W4_WRITE_SYNCHRONOUS_FLOW_CONTROL_ENABLE:
19083905afbfSMatthias Ringwald             // skip write default erroneous data reporting if not supported
19093905afbfSMatthias Ringwald             if (hci_stack->local_supported_commands[0] & 0x08) break;
19103905afbfSMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_WRITE_DEFAULT_ERRONEOUS_DATA_REPORTING;
1911cf373d3aSMatthias Ringwald 
1912cf373d3aSMatthias Ringwald             /* fall through */
19133905afbfSMatthias Ringwald 
1914f064e0bbSMatthias Ringwald         case HCI_INIT_W4_WRITE_DEFAULT_ERRONEOUS_DATA_REPORTING:
1915a42798c3SMatthias Ringwald             // skip bcm set sco pcm config on non-Broadcom chipsets
191661f37892SMatthias Ringwald             if (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_BROADCOM_CORPORATION) break;
19170168d82eSMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_BCM_WRITE_I2SPCM_INTERFACE_PARAM;
1918cf373d3aSMatthias Ringwald 
1919cf373d3aSMatthias Ringwald             /* fall through */
1920a42798c3SMatthias Ringwald 
1921a42798c3SMatthias Ringwald         case HCI_INIT_W4_BCM_WRITE_SCO_PCM_INT:
1922729ed62eSMatthias Ringwald             if (!hci_le_supported()){
1923729ed62eSMatthias Ringwald                 // SKIP LE init for Classic only configuration
1924a650ba4dSMatthias Ringwald                 hci_init_done();
1925729ed62eSMatthias Ringwald                 return;
1926729ed62eSMatthias Ringwald             }
1927afe9bf34SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_BCM_WRITE_I2SPCM_INTERFACE_PARAM;
1928729ed62eSMatthias Ringwald             break;
1929f3b012f9SMatthias Ringwald 
1930f3b012f9SMatthias Ringwald #else /* !ENABLE_SCO_OVER_HCI */
1931f3b012f9SMatthias Ringwald 
193274b323a9SMatthias Ringwald         case HCI_INIT_W4_WRITE_SCAN_ENABLE:
19338051253fSMatthias Ringwald #ifdef ENABLE_SCO_OVER_PCM
19348051253fSMatthias Ringwald             if (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_BROADCOM_CORPORATION) {
19358051253fSMatthias Ringwald                 hci_stack->substate = HCI_INIT_BCM_WRITE_SCO_PCM_INT;
19368051253fSMatthias Ringwald                 return;
19378051253fSMatthias Ringwald             }
19388051253fSMatthias Ringwald #endif
19398051253fSMatthias Ringwald             /* fall through */
19408051253fSMatthias Ringwald 
19414e821764SMatthias Ringwald         case HCI_INIT_W4_BCM_WRITE_I2SPCM_INTERFACE_PARAM:
1942f3b012f9SMatthias Ringwald #ifdef ENABLE_BLE
1943f3b012f9SMatthias Ringwald             if (hci_le_supported()){
1944f3b012f9SMatthias Ringwald                 hci_stack->substate = HCI_INIT_LE_READ_BUFFER_SIZE;
194574b323a9SMatthias Ringwald                 return;
19466155b3d3S[email protected]             }
1947729ed62eSMatthias Ringwald #endif
1948f3b012f9SMatthias Ringwald             // SKIP LE init for Classic only configuration
1949f3b012f9SMatthias Ringwald             hci_init_done();
1950f3b012f9SMatthias Ringwald             return;
1951f3b012f9SMatthias Ringwald #endif /* ENABLE_SCO_OVER_HCI */
1952f3b012f9SMatthias Ringwald 
1953a4e96e78SMatthias Ringwald // avoid compile error due to duplicate cases: HCI_INIT_W4_BCM_WRITE_SCO_PCM_INT == HCI_INIT_DONE-1
1954a4e96e78SMatthias Ringwald #if defined(ENABLE_BLE) || defined(ENABLE_LE_DATA_LENGTH_EXTENSION) || defined(ENABLE_LE_CENTRAL)
1955a650ba4dSMatthias Ringwald         // Response to command before init done state -> init done
1956a650ba4dSMatthias Ringwald         case (HCI_INIT_DONE-1):
1957a650ba4dSMatthias Ringwald             hci_init_done();
1958a650ba4dSMatthias Ringwald             return;
1959a4e96e78SMatthias Ringwald #endif
1960a650ba4dSMatthias Ringwald 
19616155b3d3S[email protected]         default:
196274b323a9SMatthias Ringwald             break;
19636155b3d3S[email protected]     }
196455975f88SMatthias Ringwald     hci_initializing_next_state();
19656155b3d3S[email protected] }
19666155b3d3S[email protected] 
19670bbba85bSMatthias Ringwald static void hci_handle_connection_failed(hci_connection_t * conn, uint8_t status){
1968229331c6SMatthias Ringwald     log_info("Outgoing connection to %s failed", bd_addr_to_str(conn->address));
19690bbba85bSMatthias Ringwald     bd_addr_t bd_address;
19706535961aSMatthias Ringwald     (void)memcpy(&bd_address, conn->address, 6);
19710bbba85bSMatthias Ringwald 
19726bc9fa5eSMatthias Ringwald #ifdef ENABLE_CLASSIC
19736bc9fa5eSMatthias Ringwald     // cache needed data
19746bc9fa5eSMatthias Ringwald     int notify_dedicated_bonding_failed = conn->bonding_flags & BONDING_DEDICATED;
19756bc9fa5eSMatthias Ringwald #endif
19766bc9fa5eSMatthias Ringwald 
19770bbba85bSMatthias Ringwald     // connection failed, remove entry
19780bbba85bSMatthias Ringwald     btstack_linked_list_remove(&hci_stack->connections, (btstack_linked_item_t *) conn);
19790bbba85bSMatthias Ringwald     btstack_memory_hci_connection_free( conn );
19800bbba85bSMatthias Ringwald 
19816bc9fa5eSMatthias Ringwald #ifdef ENABLE_CLASSIC
19820bbba85bSMatthias Ringwald     // notify client if dedicated bonding
19830bbba85bSMatthias Ringwald     if (notify_dedicated_bonding_failed){
19840bbba85bSMatthias Ringwald         log_info("hci notify_dedicated_bonding_failed");
19850bbba85bSMatthias Ringwald         hci_emit_dedicated_bonding_result(bd_address, status);
19860bbba85bSMatthias Ringwald     }
19870bbba85bSMatthias Ringwald 
19880bbba85bSMatthias Ringwald     // if authentication error, also delete link key
19890bbba85bSMatthias Ringwald     if (status == ERROR_CODE_AUTHENTICATION_FAILURE) {
19900bbba85bSMatthias Ringwald         gap_drop_link_key_for_bd_addr(bd_address);
19910bbba85bSMatthias Ringwald     }
19921c79b5e3SMatthias Ringwald #else
19931c79b5e3SMatthias Ringwald     UNUSED(status);
19946bc9fa5eSMatthias Ringwald #endif
19950bbba85bSMatthias Ringwald }
19960bbba85bSMatthias Ringwald 
1997be500194SMatthias Ringwald #ifdef ENABLE_CLASSIC
19982f5c44baSMatthias Ringwald static void hci_handle_remote_features_page_0(hci_connection_t * conn, const uint8_t * features){
19992f5c44baSMatthias Ringwald     // SSP Controller
20002f5c44baSMatthias Ringwald     if (features[6] & (1 << 3)){
20012f5c44baSMatthias Ringwald         conn->bonding_flags |= BONDING_REMOTE_SUPPORTS_SSP_CONTROLLER;
20022f5c44baSMatthias Ringwald     }
20032f5c44baSMatthias Ringwald     // eSCO
20042f5c44baSMatthias Ringwald     if (features[3] & (1<<7)){
20052f5c44baSMatthias Ringwald         conn->remote_supported_features[0] |= 1;
20062f5c44baSMatthias Ringwald     }
20072f5c44baSMatthias Ringwald     // Extended features
20082f5c44baSMatthias Ringwald     if (features[7] & (1<<7)){
20092f5c44baSMatthias Ringwald         conn->remote_supported_features[0] |= 2;
20102f5c44baSMatthias Ringwald     }
20112f5c44baSMatthias Ringwald }
20122f5c44baSMatthias Ringwald 
20132f5c44baSMatthias Ringwald static void hci_handle_remote_features_page_1(hci_connection_t * conn, const uint8_t * features){
20142f5c44baSMatthias Ringwald     // SSP Host
20152f5c44baSMatthias Ringwald     if (features[0] & (1 << 0)){
20162f5c44baSMatthias Ringwald         conn->bonding_flags |= BONDING_REMOTE_SUPPORTS_SSP_HOST;
20172f5c44baSMatthias Ringwald     }
201850c51a77SMatthias Ringwald     // SC Host
201950c51a77SMatthias Ringwald     if (features[0] & (1 << 3)){
202050c51a77SMatthias Ringwald         conn->bonding_flags |= BONDING_REMOTE_SUPPORTS_SC_HOST;
202150c51a77SMatthias Ringwald     }
202250c51a77SMatthias Ringwald }
202350c51a77SMatthias Ringwald 
202450c51a77SMatthias Ringwald static void hci_handle_remote_features_page_2(hci_connection_t * conn, const uint8_t * features){
202550c51a77SMatthias Ringwald     // SC Controller
202650c51a77SMatthias Ringwald     if (features[1] & (1 << 0)){
202750c51a77SMatthias Ringwald         conn->bonding_flags |= BONDING_REMOTE_SUPPORTS_SC_CONTROLLER;
202850c51a77SMatthias Ringwald     }
20292f5c44baSMatthias Ringwald }
20302f5c44baSMatthias Ringwald 
2031de0df013SMatthias Ringwald static void hci_handle_remote_features_received(hci_connection_t * conn){
2032de0df013SMatthias Ringwald     conn->bonding_flags |= BONDING_RECEIVED_REMOTE_FEATURES;
203349bafb5eSMatthias Ringwald     log_info("Remote features %02x, bonding flags %x", conn->remote_supported_features[0], conn->bonding_flags);
2034de0df013SMatthias Ringwald     if (conn->bonding_flags & BONDING_DEDICATED){
2035de0df013SMatthias Ringwald         conn->bonding_flags |= BONDING_SEND_AUTHENTICATE_REQUEST;
2036de0df013SMatthias Ringwald     }
2037de0df013SMatthias Ringwald }
2038be500194SMatthias Ringwald #endif
2039de0df013SMatthias Ringwald 
204067c6c9dcSMatthias Ringwald static void handle_event_for_current_stack_state(const uint8_t * packet, uint16_t size) {
204167c6c9dcSMatthias Ringwald     // handle BT initialization
204267c6c9dcSMatthias Ringwald     if (hci_stack->state == HCI_STATE_INITIALIZING) {
204367c6c9dcSMatthias Ringwald         hci_initializing_event_handler(packet, size);
204467c6c9dcSMatthias Ringwald     }
204567c6c9dcSMatthias Ringwald 
204667c6c9dcSMatthias Ringwald     // help with BT sleep
204767c6c9dcSMatthias Ringwald     if ((hci_stack->state == HCI_STATE_FALLING_ASLEEP)
204867c6c9dcSMatthias Ringwald         && (hci_stack->substate == HCI_FALLING_ASLEEP_W4_WRITE_SCAN_ENABLE)
204967c6c9dcSMatthias Ringwald         && HCI_EVENT_IS_COMMAND_COMPLETE(packet, hci_write_scan_enable)) {
205067c6c9dcSMatthias Ringwald         hci_initializing_next_state();
205167c6c9dcSMatthias Ringwald     }
205267c6c9dcSMatthias Ringwald }
205367c6c9dcSMatthias Ringwald 
20549866fdc7SMatthias Ringwald #ifdef ENABLE_CLASSIC
20559866fdc7SMatthias Ringwald static void hci_handle_read_encryption_key_size_complete(hci_connection_t * conn, uint8_t encryption_key_size) {
20569866fdc7SMatthias Ringwald     conn->authentication_flags |= CONNECTION_ENCRYPTED;
20579866fdc7SMatthias Ringwald     conn->encryption_key_size = encryption_key_size;
2058abdad579SMatthias Ringwald 
2059abdad579SMatthias Ringwald     if ((conn->authentication_flags & CONNECTION_AUTHENTICATED) != 0) {
20601cf0a6c8SMatthias Ringwald         conn->requested_security_level = LEVEL_0;
20619866fdc7SMatthias Ringwald         hci_emit_security_level(conn->con_handle, gap_security_level_for_connection(conn));
2062abdad579SMatthias Ringwald         return;
2063abdad579SMatthias Ringwald     }
2064abdad579SMatthias Ringwald 
2065abdad579SMatthias Ringwald     // Request Authentication if not already done
2066abdad579SMatthias Ringwald     if ((conn->bonding_flags & BONDING_SENT_AUTHENTICATE_REQUEST) != 0) return;
2067abdad579SMatthias Ringwald     conn->bonding_flags |= BONDING_SEND_AUTHENTICATE_REQUEST;
20689866fdc7SMatthias Ringwald }
20699866fdc7SMatthias Ringwald #endif
20709866fdc7SMatthias Ringwald 
20714f781026SMatthias Ringwald static void handle_command_complete_event(uint8_t * packet, uint16_t size){
2072b08371a9SMilanka Ringwald     UNUSED(size);
2073e76a89eeS[email protected] 
20749cbd2215SMatthias Ringwald     uint16_t manufacturer;
20759cbd2215SMatthias Ringwald #ifdef ENABLE_CLASSIC
2076fe1ed1b8Smatthias.ringwald     hci_con_handle_t handle;
20771f7b95a1Smatthias.ringwald     hci_connection_t * conn;
2078645b7c25SMatthias Ringwald     uint8_t status;
20799cbd2215SMatthias Ringwald #endif
20806bef4003SMatthias Ringwald     // get num cmd packets - limit to 1 to reduce complexity
20816bef4003SMatthias Ringwald     hci_stack->num_cmd_packets = packet[2] ? 1 : 0;
20827ec5eeaaSmatthias.ringwald 
2083645b7c25SMatthias Ringwald     uint16_t opcode = hci_event_command_complete_get_command_opcode(packet);
2084645b7c25SMatthias Ringwald     switch (opcode){
2085645b7c25SMatthias Ringwald         case HCI_OPCODE_HCI_READ_LOCAL_NAME:
2086645b7c25SMatthias Ringwald             if (packet[5]) break;
20879e263bd7SMatthias Ringwald             // terminate, name 248 chars
20889e263bd7SMatthias Ringwald             packet[6+248] = 0;
20899e263bd7SMatthias Ringwald             log_info("local name: %s", &packet[6]);
2090645b7c25SMatthias Ringwald             break;
2091645b7c25SMatthias Ringwald         case HCI_OPCODE_HCI_READ_BUFFER_SIZE:
20921d279b20Smatthias.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"
2093c3b46f5aSMatthias Ringwald             if (hci_stack->state == HCI_STATE_INITIALIZING) {
2094429122ccSMatthias Ringwald                 uint16_t acl_len = little_endian_read_16(packet, 6);
2095429122ccSMatthias Ringwald                 uint16_t sco_len = packet[8];
2096429122ccSMatthias Ringwald 
2097429122ccSMatthias Ringwald                 // determine usable ACL/SCO payload size
2098429122ccSMatthias Ringwald                 hci_stack->acl_data_packet_length = btstack_min(acl_len, HCI_ACL_PAYLOAD_SIZE);
2099429122ccSMatthias Ringwald                 hci_stack->sco_data_packet_length = btstack_min(sco_len, HCI_ACL_PAYLOAD_SIZE);
2100429122ccSMatthias Ringwald 
2101f8fbdce0SMatthias Ringwald                 hci_stack->acl_packets_total_num = little_endian_read_16(packet, 9);
2102f8fbdce0SMatthias Ringwald                 hci_stack->sco_packets_total_num = little_endian_read_16(packet, 11);
2103a8b12447S[email protected] 
2104429122ccSMatthias Ringwald                 log_info("hci_read_buffer_size: ACL size module %u -> used %u, count %u / SCO size %u, count %u",
2105429122ccSMatthias Ringwald                          acl_len, hci_stack->acl_data_packet_length, hci_stack->acl_packets_total_num,
21061a06f663S[email protected]                          hci_stack->sco_data_packet_length, hci_stack->sco_packets_total_num);
2107c3b46f5aSMatthias Ringwald             }
2108645b7c25SMatthias Ringwald             break;
2109645b7c25SMatthias Ringwald         case HCI_OPCODE_HCI_READ_RSSI:
2110645b7c25SMatthias Ringwald             if (packet[5] == ERROR_CODE_SUCCESS){
2111891b9fc2SMatthias Ringwald                 uint8_t event[5];
2112891b9fc2SMatthias Ringwald                 event[0] = GAP_EVENT_RSSI_MEASUREMENT;
2113891b9fc2SMatthias Ringwald                 event[1] = 3;
21146535961aSMatthias Ringwald                 (void)memcpy(&event[2], &packet[6], 3);
2115891b9fc2SMatthias Ringwald                 hci_emit_event(event, sizeof(event), 1);
2116891b9fc2SMatthias Ringwald             }
2117645b7c25SMatthias Ringwald             break;
2118a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE
2119645b7c25SMatthias Ringwald         case HCI_OPCODE_HCI_LE_READ_BUFFER_SIZE:
2120f8fbdce0SMatthias Ringwald             hci_stack->le_data_packets_length = little_endian_read_16(packet, 6);
2121ee303eddS[email protected]             hci_stack->le_acl_packets_total_num = packet[8];
21226c26b087S[email protected]             // determine usable ACL payload size
21236c26b087S[email protected]             if (HCI_ACL_PAYLOAD_SIZE < hci_stack->le_data_packets_length){
21246c26b087S[email protected]                 hci_stack->le_data_packets_length = HCI_ACL_PAYLOAD_SIZE;
21256c26b087S[email protected]             }
21269da54300S[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);
2127645b7c25SMatthias Ringwald             break;
2128b435e062SMatthias Ringwald #endif
2129b435e062SMatthias Ringwald #ifdef ENABLE_LE_DATA_LENGTH_EXTENSION
2130645b7c25SMatthias Ringwald         case HCI_OPCODE_HCI_LE_READ_MAXIMUM_DATA_LENGTH:
2131dcd678baSMatthias Ringwald             hci_stack->le_supported_max_tx_octets = little_endian_read_16(packet, 6);
2132dcd678baSMatthias Ringwald             hci_stack->le_supported_max_tx_time = little_endian_read_16(packet, 8);
2133dcd678baSMatthias 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);
2134645b7c25SMatthias Ringwald             break;
2135b435e062SMatthias Ringwald #endif
2136d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
2137645b7c25SMatthias Ringwald         case HCI_OPCODE_HCI_LE_READ_WHITE_LIST_SIZE:
2138e691bb38SMatthias Ringwald             hci_stack->le_whitelist_capacity = packet[6];
213915d0a15bSMatthias Ringwald             log_info("hci_le_read_white_list_size: size %u", hci_stack->le_whitelist_capacity);
2140645b7c25SMatthias Ringwald             break;
214165a46ef3S[email protected] #endif
2142645b7c25SMatthias Ringwald         case HCI_OPCODE_HCI_READ_BD_ADDR:
2143645b7c25SMatthias Ringwald             reverse_bd_addr(&packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE + 1], hci_stack->local_bd_addr);
2144645b7c25SMatthias 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));
214533373e40SMatthias Ringwald #ifdef ENABLE_CLASSIC
21461624665aSMatthias Ringwald             if (hci_stack->link_key_db){
21471624665aSMatthias Ringwald                 hci_stack->link_key_db->set_local_bd_addr(hci_stack->local_bd_addr);
21481624665aSMatthias Ringwald             }
214933373e40SMatthias Ringwald #endif
2150645b7c25SMatthias Ringwald             break;
215135454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
2152645b7c25SMatthias Ringwald         case HCI_OPCODE_HCI_WRITE_SCAN_ENABLE:
21533a9fb326S[email protected]             hci_emit_discoverable_enabled(hci_stack->discoverable);
2154645b7c25SMatthias Ringwald             break;
2155645b7c25SMatthias Ringwald         case HCI_OPCODE_HCI_INQUIRY_CANCEL:
2156f5875de5SMatthias Ringwald             if (hci_stack->inquiry_state == GAP_INQUIRY_STATE_W4_CANCELLED){
2157f5875de5SMatthias Ringwald                 hci_stack->inquiry_state = GAP_INQUIRY_STATE_IDLE;
2158f5875de5SMatthias Ringwald                 uint8_t event[] = { GAP_EVENT_INQUIRY_COMPLETE, 1, 0};
2159f5875de5SMatthias Ringwald                 hci_emit_event(event, sizeof(event), 1);
2160f5875de5SMatthias Ringwald             }
2161645b7c25SMatthias Ringwald             break;
216235454696SMatthias Ringwald #endif
2163645b7c25SMatthias Ringwald         case HCI_OPCODE_HCI_READ_LOCAL_SUPPORTED_FEATURES:
21644f781026SMatthias Ringwald             (void)memcpy(hci_stack->local_supported_features, &packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE + 1], 8);
216565389bfcS[email protected] 
216635454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
2167a5a23fc2S[email protected]             // determine usable ACL packet types based on host buffer size and supported features
2168a5a23fc2S[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]);
21698b96126aSMatthias Ringwald             log_info("Packet types %04x, eSCO %u", hci_stack->packet_types, hci_extended_sco_link_supported());
217035454696SMatthias Ringwald #endif
2171f5d8d141S[email protected]             // Classic/LE
2172f5d8d141S[email protected]             log_info("BR/EDR support %u, LE support %u", hci_classic_supported(), hci_le_supported());
2173645b7c25SMatthias Ringwald             break;
2174645b7c25SMatthias Ringwald         case HCI_OPCODE_HCI_READ_LOCAL_VERSION_INFORMATION:
2175645b7c25SMatthias Ringwald             manufacturer = little_endian_read_16(packet, 10);
2176c21d89f3SMatthias Ringwald             // map Cypress to Broadcom
2177c21d89f3SMatthias Ringwald             if (manufacturer  == BLUETOOTH_COMPANY_ID_CYPRESS_SEMICONDUCTOR){
2178c21d89f3SMatthias Ringwald                 log_info("Treat Cypress as Broadcom");
2179c21d89f3SMatthias Ringwald                 manufacturer = BLUETOOTH_COMPANY_ID_BROADCOM_CORPORATION;
2180c21d89f3SMatthias Ringwald                 little_endian_store_16(packet, 10, manufacturer);
2181c21d89f3SMatthias Ringwald             }
2182c21d89f3SMatthias Ringwald             hci_stack->manufacturer = manufacturer;
21834696bddbSMatthias Ringwald             log_info("Manufacturer: 0x%04x", hci_stack->manufacturer);
2184645b7c25SMatthias Ringwald             break;
2185645b7c25SMatthias Ringwald         case HCI_OPCODE_HCI_READ_LOCAL_SUPPORTED_COMMANDS:
2186a828a756SMatthias Ringwald             hci_stack->local_supported_commands[0] =
21874ea43905SMatthias Ringwald                 ((packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1u+14u] & 0x80u) >> 7u) |  // bit  0 = Octet 14, bit 7 / Read Buffer Size
21884ea43905SMatthias Ringwald                 ((packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1u+24u] & 0x40u) >> 5u) |  // bit  1 = Octet 24, bit 6 / Write Le Host Supported
21894ea43905SMatthias Ringwald                 ((packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1u+10u] & 0x10u) >> 2u) |  // bit  2 = Octet 10, bit 4 / Write Synchronous Flow Control Enable
21904ea43905SMatthias Ringwald                 ((packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1u+18u] & 0x08u)     )  |  // bit  3 = Octet 18, bit 3 / Write Default Erroneous Data Reporting
21914ea43905SMatthias Ringwald                 ((packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1u+34u] & 0x01u) << 4u) |  // bit  4 = Octet 34, bit 0 / LE Write Suggested Default Data Length
21924ea43905SMatthias Ringwald                 ((packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1u+35u] & 0x08u) << 2u) |  // bit  5 = Octet 35, bit 3 / LE Read Maximum Data Length
21934ea43905SMatthias Ringwald                 ((packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1u+35u] & 0x20u) << 1u) |  // bit  6 = Octet 35, bit 5 / LE Set Default PHY
21944ea43905SMatthias Ringwald                 ((packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1u+20u] & 0x10u) << 3u);   // bit  7 = Octet 20, bit 4 / Read Encryption Key Size
21958d2d8af1SMatthias Ringwald             hci_stack->local_supported_commands[1] =
21964ea43905SMatthias Ringwald                 ((packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1u+ 2u] & 0x40u) >> 6u) |  // bit  8 = Octet  2, bit 6 / Read Remote Extended Features
219799b14827SMatthias Ringwald                 ((packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1u+32u] & 0x08u) >> 2u) |  // bit  9 = Octet 32, bit 3 / Write Secure Connections Host
2198f21849cbSMatthias Ringwald                 ((packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1u+35u] & 0x02u) << 1u) |  // bit 10 = Octet 35, bit 1 / LE Set Address Resolution Enable
2199f21849cbSMatthias Ringwald                 ((packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1u+32u] & 0x02u) << 2u) |  // bit 11 = Octet 32, bit 1 / Remote OOB Extended Data Request Reply
2200f21849cbSMatthias Ringwald                 ((packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1u+32u] & 0x40u) >> 2u);   // bit 12 = Octet 32, bit 6 / Read Local OOB Extended Data command
22018d2d8af1SMatthias Ringwald             log_info("Local supported commands summary %02x - %02x", hci_stack->local_supported_commands[0],  hci_stack->local_supported_commands[1]);
2202645b7c25SMatthias Ringwald             break;
2203e8c8828eSMatthias Ringwald #ifdef ENABLE_CLASSIC
2204645b7c25SMatthias Ringwald         case HCI_OPCODE_HCI_WRITE_SYNCHRONOUS_FLOW_CONTROL_ENABLE:
22054f781026SMatthias Ringwald             if (packet[5]) return;
22065b9b590fSMatthias Ringwald             hci_stack->synchronous_flow_control_enabled = 1;
2207645b7c25SMatthias Ringwald             break;
2208645b7c25SMatthias Ringwald         case HCI_OPCODE_HCI_READ_ENCRYPTION_KEY_SIZE:
2209645b7c25SMatthias Ringwald             status = packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE];
2210573897a0SMatthias Ringwald             handle = little_endian_read_16(packet, OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1);
2211573897a0SMatthias Ringwald             conn   = hci_connection_for_handle(handle);
2212c3b46f5aSMatthias Ringwald             if (conn != NULL) {
22139866fdc7SMatthias Ringwald                 uint8_t key_size = 0;
2214573897a0SMatthias Ringwald                 if (status == 0){
22159866fdc7SMatthias Ringwald                     key_size = packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+3];
22164a659b0eSMatthias Ringwald                     log_info("Handle %04x key Size: %u", handle, key_size);
2217170fafaeSMatthias Ringwald                 } else {
2218e9f98c4aSMatthias Ringwald                     key_size = 1;
22199866fdc7SMatthias Ringwald                     log_info("Read Encryption Key Size failed 0x%02x-> assuming insecure connection with key size of 1", status);
2220573897a0SMatthias Ringwald                 }
22219866fdc7SMatthias Ringwald                 hci_handle_read_encryption_key_size_complete(conn, key_size);
2222c3b46f5aSMatthias Ringwald             }
2223645b7c25SMatthias Ringwald             break;
222475a8e4faSMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB
222575a8e4faSMatthias Ringwald         case HCI_OPCODE_HCI_READ_LOCAL_OOB_DATA:
222675a8e4faSMatthias Ringwald         case HCI_OPCODE_HCI_READ_LOCAL_EXTENDED_OOB_DATA:{
222775a8e4faSMatthias Ringwald             uint8_t event[67];
222875a8e4faSMatthias Ringwald             event[0] = GAP_EVENT_LOCAL_OOB_DATA;
222975a8e4faSMatthias Ringwald             event[1] = 65;
223075a8e4faSMatthias Ringwald             (void)memset(&event[2], 0, 65);
223175a8e4faSMatthias Ringwald             if (packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE] == ERROR_CODE_SUCCESS){
223275a8e4faSMatthias Ringwald                 (void)memcpy(&event[3], &packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1], 32);
223375a8e4faSMatthias Ringwald                 if (opcode == HCI_OPCODE_HCI_READ_LOCAL_EXTENDED_OOB_DATA){
223475a8e4faSMatthias Ringwald                     event[2] = 3;
223575a8e4faSMatthias Ringwald                     (void)memcpy(&event[35], &packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+33], 32);
223675a8e4faSMatthias Ringwald                 } else {
223775a8e4faSMatthias Ringwald                     event[2] = 1;
223875a8e4faSMatthias Ringwald                 }
223975a8e4faSMatthias Ringwald             }
224075a8e4faSMatthias Ringwald             hci_emit_event(event, sizeof(event), 0);
224175a8e4faSMatthias Ringwald             break;
224275a8e4faSMatthias Ringwald         }
2243e8c8828eSMatthias Ringwald #endif
224475a8e4faSMatthias Ringwald #endif
22456f35bb46SMatthias Ringwald         default:
22466f35bb46SMatthias Ringwald             break;
22474f781026SMatthias Ringwald     }
2248645b7c25SMatthias Ringwald }
22494f781026SMatthias Ringwald 
22500ce3f217SMatthias Ringwald #ifdef ENABLE_BLE
22510ce3f217SMatthias Ringwald static void event_handle_le_connection_complete(const uint8_t * packet){
22520ce3f217SMatthias Ringwald 	bd_addr_t addr;
22530ce3f217SMatthias Ringwald 	bd_addr_type_t addr_type;
22540ce3f217SMatthias Ringwald 	hci_connection_t * conn;
22550ce3f217SMatthias Ringwald 
22560ce3f217SMatthias Ringwald 	// Connection management
22570ce3f217SMatthias Ringwald 	reverse_bd_addr(&packet[8], addr);
22580ce3f217SMatthias Ringwald 	addr_type = (bd_addr_type_t)packet[7];
22590ce3f217SMatthias Ringwald 	log_info("LE Connection_complete (status=%u) type %u, %s", packet[3], addr_type, bd_addr_to_str(addr));
22600ce3f217SMatthias Ringwald 	conn = hci_connection_for_bd_addr_and_type(addr, addr_type);
22610ce3f217SMatthias Ringwald 
22620ce3f217SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
22630ce3f217SMatthias Ringwald 	// handle error: error is reported only to the initiator -> outgoing connection
22640ce3f217SMatthias Ringwald 	if (packet[3]){
22650ce3f217SMatthias Ringwald 
22660ce3f217SMatthias Ringwald 		// handle cancelled outgoing connection
22670ce3f217SMatthias Ringwald 		// "If the cancellation was successful then, after the Command Complete event for the LE_Create_Connection_Cancel command,
22680ce3f217SMatthias Ringwald 		//  either an LE Connection Complete or an LE Enhanced Connection Complete event shall be generated.
22690ce3f217SMatthias Ringwald 		//  In either case, the event shall be sent with the error code Unknown Connection Identifier (0x02)."
22700ce3f217SMatthias Ringwald 		if (packet[3] == ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER){
22711f468175SMatthias Ringwald 		    // reset state
22720ce3f217SMatthias Ringwald             hci_stack->le_connecting_state   = LE_CONNECTING_IDLE;
22731f468175SMatthias Ringwald             hci_stack->le_connecting_request = LE_CONNECTING_IDLE;
22740ce3f217SMatthias Ringwald 			// get outgoing connection conn struct for direct connect
22750ce3f217SMatthias Ringwald 			conn = gap_get_outgoing_connection();
22760ce3f217SMatthias Ringwald 		}
22770ce3f217SMatthias Ringwald 
22780ce3f217SMatthias Ringwald 		// outgoing le connection establishment is done
22790ce3f217SMatthias Ringwald 		if (conn){
22800ce3f217SMatthias Ringwald 			// remove entry
22810ce3f217SMatthias Ringwald 			btstack_linked_list_remove(&hci_stack->connections, (btstack_linked_item_t *) conn);
22820ce3f217SMatthias Ringwald 			btstack_memory_hci_connection_free( conn );
22830ce3f217SMatthias Ringwald 		}
22840ce3f217SMatthias Ringwald 		return;
22850ce3f217SMatthias Ringwald 	}
22860ce3f217SMatthias Ringwald #endif
22870ce3f217SMatthias Ringwald 
22880ce3f217SMatthias Ringwald 	// on success, both hosts receive connection complete event
22890ce3f217SMatthias Ringwald 	if (packet[6] == HCI_ROLE_MASTER){
22900ce3f217SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
22910ce3f217SMatthias Ringwald 		// if we're master on an le connection, it was an outgoing connection and we're done with it
22920ce3f217SMatthias Ringwald 		// note: no hci_connection_t object exists yet for connect with whitelist
22930ce3f217SMatthias Ringwald 		if (hci_is_le_connection_type(addr_type)){
22940ce3f217SMatthias Ringwald 			hci_stack->le_connecting_state   = LE_CONNECTING_IDLE;
22950ce3f217SMatthias Ringwald 			hci_stack->le_connecting_request = LE_CONNECTING_IDLE;
22960ce3f217SMatthias Ringwald 		}
22970ce3f217SMatthias Ringwald #endif
22980ce3f217SMatthias Ringwald 	} else {
22990ce3f217SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
23000ce3f217SMatthias Ringwald 		// if we're slave, it was an incoming connection, advertisements have stopped
23010ce3f217SMatthias Ringwald 		hci_stack->le_advertisements_active = false;
23020ce3f217SMatthias Ringwald #endif
23030ce3f217SMatthias Ringwald 	}
23040ce3f217SMatthias Ringwald 
23050ce3f217SMatthias Ringwald 	// LE connections are auto-accepted, so just create a connection if there isn't one already
23060ce3f217SMatthias Ringwald 	if (!conn){
23070ce3f217SMatthias Ringwald 		conn = create_connection_for_bd_addr_and_type(addr, addr_type);
23080ce3f217SMatthias Ringwald 	}
23090ce3f217SMatthias Ringwald 
23100ce3f217SMatthias Ringwald 	// no memory, sorry.
23110ce3f217SMatthias Ringwald 	if (!conn){
23120ce3f217SMatthias Ringwald 		return;
23130ce3f217SMatthias Ringwald 	}
23140ce3f217SMatthias Ringwald 
23150ce3f217SMatthias Ringwald 	conn->state = OPEN;
23160ce3f217SMatthias Ringwald 	conn->role  = packet[6];
23170ce3f217SMatthias Ringwald 	conn->con_handle             = hci_subevent_le_connection_complete_get_connection_handle(packet);
23180ce3f217SMatthias Ringwald 	conn->le_connection_interval = hci_subevent_le_connection_complete_get_conn_interval(packet);
23190ce3f217SMatthias Ringwald 
23200ce3f217SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
23210ce3f217SMatthias Ringwald 	if (packet[6] == HCI_ROLE_SLAVE){
23220ce3f217SMatthias Ringwald 		hci_update_advertisements_enabled_for_current_roles();
23230ce3f217SMatthias Ringwald 	}
23240ce3f217SMatthias Ringwald #endif
23250ce3f217SMatthias Ringwald 
2326dde9ff1eSMatthias Ringwald     // init unenhanced att bearer mtu
2327dde9ff1eSMatthias Ringwald     conn->att_connection.mtu = ATT_DEFAULT_MTU;
2328dde9ff1eSMatthias Ringwald     conn->att_connection.mtu_exchanged = false;
2329dde9ff1eSMatthias Ringwald 
23300ce3f217SMatthias Ringwald     // TODO: store - role, peer address type, conn_interval, conn_latency, supervision timeout, master clock
23310ce3f217SMatthias Ringwald 
23320ce3f217SMatthias Ringwald 	// restart timer
23330ce3f217SMatthias Ringwald 	// btstack_run_loop_set_timer(&conn->timeout, HCI_CONNECTION_TIMEOUT_MS);
23340ce3f217SMatthias Ringwald 	// btstack_run_loop_add_timer(&conn->timeout);
23350ce3f217SMatthias Ringwald 
23360ce3f217SMatthias Ringwald 	log_info("New connection: handle %u, %s", conn->con_handle, bd_addr_to_str(conn->address));
23370ce3f217SMatthias Ringwald 
23380ce3f217SMatthias Ringwald 	hci_emit_nr_connections_changed();
23390ce3f217SMatthias Ringwald }
23400ce3f217SMatthias Ringwald #endif
23410ce3f217SMatthias Ringwald 
234217c6fe5cSMatthias Ringwald #ifdef ENABLE_CLASSIC
234317c6fe5cSMatthias 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){
234417c6fe5cSMatthias Ringwald     if (io_cap_local == SSP_IO_CAPABILITY_UNKNOWN) return false;
234517c6fe5cSMatthias Ringwald     // LEVEL_4 is tested by l2cap
234617c6fe5cSMatthias Ringwald     // LEVEL 3 requires MITM protection -> check io capabilities
234717c6fe5cSMatthias Ringwald     if (level >= LEVEL_3){
234817c6fe5cSMatthias Ringwald         if (io_cap_remote  >= SSP_IO_CAPABILITY_NO_INPUT_NO_OUTPUT) return false;
234917c6fe5cSMatthias Ringwald         if (io_cap_local   >= SSP_IO_CAPABILITY_NO_INPUT_NO_OUTPUT) return false;
235017c6fe5cSMatthias Ringwald         if ((io_cap_remote == SSP_IO_CAPABILITY_KEYBOARD_ONLY) && (io_cap_local ==  SSP_IO_CAPABILITY_KEYBOARD_ONLY)) return false;
235117c6fe5cSMatthias Ringwald     }
235217c6fe5cSMatthias Ringwald     // LEVEL 2 requires SSP, which is a given
235317c6fe5cSMatthias Ringwald     return true;
235417c6fe5cSMatthias Ringwald }
235517c6fe5cSMatthias Ringwald 
235617c6fe5cSMatthias Ringwald static bool hci_ssp_validate_possible_security_level(bd_addr_t addr){
235717c6fe5cSMatthias Ringwald     hci_connection_t * conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL);
235817c6fe5cSMatthias Ringwald     if (!conn) return false;
235917c6fe5cSMatthias Ringwald     // abort pairing, if requested security level cannot be met
236017c6fe5cSMatthias Ringwald     if (hci_ssp_security_level_possible_for_io_cap(conn->requested_security_level, hci_stack->ssp_io_capability, conn->io_cap_response_io)) {
236117c6fe5cSMatthias Ringwald         // inlined hci_add_connection_flags_for_flipped_bd_addr
236217c6fe5cSMatthias Ringwald         connectionSetAuthenticationFlags(conn, SSP_PAIRING_ACTIVE);
236317c6fe5cSMatthias Ringwald         hci_connection_timestamp(conn);
236417c6fe5cSMatthias Ringwald         return true;
236517c6fe5cSMatthias Ringwald     } else {
236617c6fe5cSMatthias Ringwald         log_info("Level %u cannot be reached", conn->requested_security_level);
236717c6fe5cSMatthias Ringwald         conn->bonding_flags |= BONDING_DISCONNECT_SECURITY_BLOCK;
236817c6fe5cSMatthias Ringwald         return false;
236917c6fe5cSMatthias Ringwald     };
237017c6fe5cSMatthias Ringwald }
237117c6fe5cSMatthias Ringwald 
237217c6fe5cSMatthias Ringwald #endif
237317c6fe5cSMatthias Ringwald 
2374c3b46f5aSMatthias Ringwald static void event_handler(uint8_t *packet, uint16_t size){
23754f781026SMatthias Ringwald 
23764f781026SMatthias Ringwald     uint16_t event_length = packet[1];
23774f781026SMatthias Ringwald 
23784f781026SMatthias Ringwald     // assert packet is complete
23794ea43905SMatthias Ringwald     if (size != (event_length + 2u)){
23804f781026SMatthias Ringwald         log_error("event_handler called with packet of wrong size %d, expected %u => dropping packet", size, event_length + 2);
23814f781026SMatthias Ringwald         return;
23824f781026SMatthias Ringwald     }
23834f781026SMatthias Ringwald 
23844f781026SMatthias Ringwald     bd_addr_type_t addr_type;
23854f781026SMatthias Ringwald     hci_con_handle_t handle;
23864f781026SMatthias Ringwald     hci_connection_t * conn;
23874f781026SMatthias Ringwald     int i;
23884f781026SMatthias Ringwald     int create_connection_cmd;
23894f781026SMatthias Ringwald 
23904f781026SMatthias Ringwald #ifdef ENABLE_CLASSIC
23915e91d96cSMatthias Ringwald     hci_link_type_t link_type;
239248f33f37SMatthias Ringwald     bd_addr_t addr;
23934f781026SMatthias Ringwald #endif
23944f781026SMatthias Ringwald 
23954f781026SMatthias Ringwald     // log_info("HCI:EVENT:%02x", hci_event_packet_get_type(packet));
23964f781026SMatthias Ringwald 
23974f781026SMatthias Ringwald     switch (hci_event_packet_get_type(packet)) {
23984f781026SMatthias Ringwald 
23994f781026SMatthias Ringwald         case HCI_EVENT_COMMAND_COMPLETE:
24004f781026SMatthias Ringwald             handle_command_complete_event(packet, size);
240156cf178bSmatthias.ringwald             break;
240256cf178bSmatthias.ringwald 
24037ec5eeaaSmatthias.ringwald         case HCI_EVENT_COMMAND_STATUS:
24046bef4003SMatthias Ringwald             // get num cmd packets - limit to 1 to reduce complexity
24056bef4003SMatthias Ringwald             hci_stack->num_cmd_packets = packet[3] ? 1 : 0;
2406229331c6SMatthias Ringwald 
2407229331c6SMatthias Ringwald             // check command status to detected failed outgoing connections
2408c57fa566SMatthias Ringwald             create_connection_cmd = 0;
2409c57fa566SMatthias Ringwald #ifdef ENABLE_CLASSIC
2410c57fa566SMatthias Ringwald             if (HCI_EVENT_IS_COMMAND_STATUS(packet, hci_create_connection)){
2411c57fa566SMatthias Ringwald                 create_connection_cmd = 1;
2412c57fa566SMatthias Ringwald             }
2413c57fa566SMatthias Ringwald #endif
2414c57fa566SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
2415c57fa566SMatthias Ringwald             if (HCI_EVENT_IS_COMMAND_STATUS(packet, hci_le_create_connection)){
2416c57fa566SMatthias Ringwald                 create_connection_cmd = 1;
2417c57fa566SMatthias Ringwald             }
2418c57fa566SMatthias Ringwald #endif
2419c57fa566SMatthias Ringwald             if (create_connection_cmd) {
2420229331c6SMatthias Ringwald                 uint8_t status = hci_event_command_status_get_status(packet);
24218da98cbeSMatthias Ringwald                 addr_type = hci_stack->outgoing_addr_type;
24226ea9315cSMatthias Ringwald                 conn = hci_connection_for_bd_addr_and_type(hci_stack->outgoing_addr, addr_type);
24236ea9315cSMatthias 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);
2424229331c6SMatthias Ringwald 
2425229331c6SMatthias Ringwald                 // reset outgoing address info
2426229331c6SMatthias Ringwald                 memset(hci_stack->outgoing_addr, 0, 6);
2427229331c6SMatthias Ringwald                 hci_stack->outgoing_addr_type = BD_ADDR_TYPE_UNKNOWN;
2428229331c6SMatthias Ringwald 
24296ea9315cSMatthias Ringwald                 // on error
24306ea9315cSMatthias Ringwald                 if (status != ERROR_CODE_SUCCESS){
2431f75e06adSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
24326ea9315cSMatthias Ringwald                     if (hci_is_le_connection_type(addr_type)){
24336ea9315cSMatthias Ringwald                         hci_stack->le_connecting_state = LE_CONNECTING_IDLE;
2434f7e6a692SMatthias Ringwald                         hci_stack->le_connecting_request = LE_CONNECTING_IDLE;
24356ea9315cSMatthias Ringwald                     }
2436f75e06adSMatthias Ringwald #endif
2437229331c6SMatthias Ringwald                     // error => outgoing connection failed
24386ea9315cSMatthias Ringwald                     if (conn != NULL){
2439229331c6SMatthias Ringwald                         hci_handle_connection_failed(conn, status);
2440229331c6SMatthias Ringwald                     }
2441229331c6SMatthias Ringwald                 }
24426ea9315cSMatthias Ringwald             }
2443beb3c81dSMatthias Ringwald 
2444beb3c81dSMatthias Ringwald #ifdef ENABLE_CLASSIC
2445beb3c81dSMatthias Ringwald             if (HCI_EVENT_IS_COMMAND_STATUS(packet, hci_inquiry)) {
2446beb3c81dSMatthias Ringwald                 uint8_t status = hci_event_command_status_get_status(packet);
2447beb3c81dSMatthias Ringwald                 log_info("command status (inquiry), status %x", status);
2448beb3c81dSMatthias Ringwald                 if (status == ERROR_CODE_SUCCESS) {
2449beb3c81dSMatthias Ringwald                     hci_stack->inquiry_state = GAP_INQUIRY_STATE_ACTIVE;
2450beb3c81dSMatthias Ringwald                 } else {
2451beb3c81dSMatthias Ringwald                     hci_stack->inquiry_state = GAP_INQUIRY_STATE_IDLE;
2452beb3c81dSMatthias Ringwald                 }
2453beb3c81dSMatthias Ringwald             }
2454beb3c81dSMatthias Ringwald #endif
24557ec5eeaaSmatthias.ringwald             break;
24567ec5eeaaSmatthias.ringwald 
24572e440c8aS[email protected]         case HCI_EVENT_NUMBER_OF_COMPLETED_PACKETS:{
24589784dac1SMatthias Ringwald             if (size < 3) return;
24599784dac1SMatthias Ringwald             uint16_t num_handles = packet[2];
24604ea43905SMatthias Ringwald             if (size != (3u + num_handles * 4u)) return;
24619784dac1SMatthias Ringwald             uint16_t offset = 3;
24629784dac1SMatthias Ringwald             for (i=0; i<num_handles;i++){
24634ea43905SMatthias Ringwald                 handle = little_endian_read_16(packet, offset) & 0x0fffu;
24644ea43905SMatthias Ringwald                 offset += 2u;
2465f8fbdce0SMatthias Ringwald                 uint16_t num_packets = little_endian_read_16(packet, offset);
24664ea43905SMatthias Ringwald                 offset += 2u;
24672e440c8aS[email protected] 
24685061f3afS[email protected]                 conn = hci_connection_for_handle(handle);
246956cf178bSmatthias.ringwald                 if (!conn){
24709da54300S[email protected]                     log_error("hci_number_completed_packet lists unused con handle %u", handle);
247156cf178bSmatthias.ringwald                     continue;
247256cf178bSmatthias.ringwald                 }
247323bed257S[email protected] 
2474ce41473eSMatthias Ringwald                 if (conn->num_packets_sent >= num_packets){
2475ce41473eSMatthias Ringwald                     conn->num_packets_sent -= num_packets;
2476e35edcc1S[email protected]                 } else {
2477ce41473eSMatthias Ringwald                     log_error("hci_number_completed_packets, more packet slots freed then sent.");
2478ce41473eSMatthias Ringwald                     conn->num_packets_sent = 0;
2479e35edcc1S[email protected]                 }
2480ce41473eSMatthias Ringwald                 // log_info("hci_number_completed_packet %u processed for handle %u, outstanding %u", num_packets, handle, conn->num_packets_sent);
2481760b20efSMatthias Ringwald 
2482760b20efSMatthias Ringwald #ifdef ENABLE_CLASSIC
2483760b20efSMatthias Ringwald                 // For SCO, we do the can_send_now_check here
2484760b20efSMatthias Ringwald                 hci_notify_if_sco_can_send_now();
2485760b20efSMatthias Ringwald #endif
248656cf178bSmatthias.ringwald             }
24876772a24cSmatthias.ringwald             break;
24882e440c8aS[email protected]         }
248935454696SMatthias Ringwald 
249035454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
2491f5875de5SMatthias Ringwald         case HCI_EVENT_INQUIRY_COMPLETE:
2492f5875de5SMatthias Ringwald             if (hci_stack->inquiry_state == GAP_INQUIRY_STATE_ACTIVE){
2493f5875de5SMatthias Ringwald                 hci_stack->inquiry_state = GAP_INQUIRY_STATE_IDLE;
2494f5875de5SMatthias Ringwald                 uint8_t event[] = { GAP_EVENT_INQUIRY_COMPLETE, 1, 0};
2495f5875de5SMatthias Ringwald                 hci_emit_event(event, sizeof(event), 1);
2496f5875de5SMatthias Ringwald             }
2497f5875de5SMatthias Ringwald             break;
2498b7f1ee76SMatthias Ringwald         case HCI_EVENT_REMOTE_NAME_REQUEST_COMPLETE:
2499b7f1ee76SMatthias Ringwald             if (hci_stack->remote_name_state == GAP_REMOTE_NAME_STATE_W4_COMPLETE){
2500b7f1ee76SMatthias Ringwald                 hci_stack->remote_name_state = GAP_REMOTE_NAME_STATE_IDLE;
2501b7f1ee76SMatthias Ringwald             }
2502b7f1ee76SMatthias Ringwald             break;
25031f7b95a1Smatthias.ringwald         case HCI_EVENT_CONNECTION_REQUEST:
2504724d70a2SMatthias Ringwald             reverse_bd_addr(&packet[2], addr);
25055e91d96cSMatthias Ringwald             link_type = (hci_link_type_t) packet[11];
250607e010b6SMilanka Ringwald             if (hci_stack->gap_classic_accept_callback != NULL){
25075e91d96cSMatthias Ringwald                 if ((*hci_stack->gap_classic_accept_callback)(addr, link_type) == 0){
25084536712cSMilanka Ringwald                     hci_stack->decline_reason = ERROR_CODE_CONNECTION_REJECTED_DUE_TO_UNACCEPTABLE_BD_ADDR;
250907e010b6SMilanka Ringwald                     bd_addr_copy(hci_stack->decline_addr, addr);
251007e010b6SMilanka Ringwald                     break;
251107e010b6SMilanka Ringwald                 }
251207e010b6SMilanka Ringwald             }
251307e010b6SMilanka Ringwald 
251437eaa4cfSmatthias.ringwald             // TODO: eval COD 8-10
25155e91d96cSMatthias Ringwald             log_info("Connection_incoming: %s, type %u", bd_addr_to_str(addr), (unsigned int) link_type);
25165e91d96cSMatthias Ringwald             addr_type = (link_type == HCI_LINK_TYPE_ACL) ? BD_ADDR_TYPE_ACL : BD_ADDR_TYPE_SCO;
25172e77e513S[email protected]             conn = hci_connection_for_bd_addr_and_type(addr, addr_type);
25181f7b95a1Smatthias.ringwald             if (!conn) {
25195293c072S[email protected]                 conn = create_connection_for_bd_addr_and_type(addr, addr_type);
25201f7b95a1Smatthias.ringwald             }
2521ce4c8fabSmatthias.ringwald             if (!conn) {
2522ce4c8fabSmatthias.ringwald                 // CONNECTION REJECTED DUE TO LIMITED RESOURCES (0X0D)
25234536712cSMilanka Ringwald                 hci_stack->decline_reason = ERROR_CODE_CONNECTION_REJECTED_DUE_TO_LIMITED_RESOURCES;
2524058e3d6bSMatthias Ringwald                 bd_addr_copy(hci_stack->decline_addr, addr);
2525ce4c8fabSmatthias.ringwald                 break;
2526ce4c8fabSmatthias.ringwald             }
25275cf766e8SMatthias Ringwald             conn->role  = HCI_ROLE_SLAVE;
252832ab9390Smatthias.ringwald             conn->state = RECEIVED_CONNECTION_REQUEST;
2529f3a16b9aSMatthias Ringwald             // store info about eSCO
25305e91d96cSMatthias Ringwald             if (link_type == HCI_LINK_TYPE_ESCO){
253176ccfb2aSMatthias Ringwald                 conn->remote_supported_features[0] |= 1;
2532f3a16b9aSMatthias Ringwald             }
253332ab9390Smatthias.ringwald             hci_run();
25341f7b95a1Smatthias.ringwald             break;
25351f7b95a1Smatthias.ringwald 
25366772a24cSmatthias.ringwald         case HCI_EVENT_CONNECTION_COMPLETE:
2537fe1ed1b8Smatthias.ringwald             // Connection management
2538724d70a2SMatthias Ringwald             reverse_bd_addr(&packet[5], addr);
25399da54300S[email protected]             log_info("Connection_complete (status=%u) %s", packet[2], bd_addr_to_str(addr));
2540f16129ceSMatthias Ringwald             addr_type = BD_ADDR_TYPE_ACL;
25412e77e513S[email protected]             conn = hci_connection_for_bd_addr_and_type(addr, addr_type);
2542fe1ed1b8Smatthias.ringwald             if (conn) {
2543b448a0e7Smatthias.ringwald                 if (!packet[2]){
2544c8e4258aSmatthias.ringwald                     conn->state = OPEN;
2545f8fbdce0SMatthias Ringwald                     conn->con_handle = little_endian_read_16(packet, 3);
25466909f064SMatthias Ringwald 
25476909f064SMatthias Ringwald                     // queue get remote feature
2548ba018746SMatthias Ringwald                     conn->bonding_flags |= BONDING_REQUEST_REMOTE_FEATURES_PAGE_0;
2549ee091cf1Smatthias.ringwald 
2550e6c51921SMatthias Ringwald                     // queue set supervision timeout if we're master
2551d821984bSMatthias Ringwald                     if ((hci_stack->link_supervision_timeout != HCI_LINK_SUPERVISION_TIMEOUT_DEFAULT) && (conn->role == HCI_ROLE_MASTER)){
25526909f064SMatthias Ringwald                         connectionSetAuthenticationFlags(conn, WRITE_SUPERVISION_TIMEOUT);
25536909f064SMatthias Ringwald                     }
25546909f064SMatthias Ringwald 
2555c785ef68Smatthias.ringwald                     // restart timer
2556528a4a3bSMatthias Ringwald                     btstack_run_loop_set_timer(&conn->timeout, HCI_CONNECTION_TIMEOUT_MS);
2557528a4a3bSMatthias Ringwald                     btstack_run_loop_add_timer(&conn->timeout);
2558c785ef68Smatthias.ringwald 
25599da54300S[email protected]                     log_info("New connection: handle %u, %s", conn->con_handle, bd_addr_to_str(conn->address));
256043bfb1bdSmatthias.ringwald 
256143bfb1bdSmatthias.ringwald                     hci_emit_nr_connections_changed();
2562b448a0e7Smatthias.ringwald                 } else {
25630bbba85bSMatthias Ringwald                     // connection failed
25640bbba85bSMatthias Ringwald                     hci_handle_connection_failed(conn, packet[2]);
2565fe1ed1b8Smatthias.ringwald                 }
2566fe1ed1b8Smatthias.ringwald             }
25676772a24cSmatthias.ringwald             break;
2568fe1ed1b8Smatthias.ringwald 
256944d0e3d5S[email protected]         case HCI_EVENT_SYNCHRONOUS_CONNECTION_COMPLETE:
2570724d70a2SMatthias Ringwald             reverse_bd_addr(&packet[5], addr);
257144d0e3d5S[email protected]             log_info("Synchronous Connection Complete (status=%u) %s", packet[2], bd_addr_to_str(addr));
25721a06f663S[email protected]             if (packet[2]){
257344d0e3d5S[email protected]                 // connection failed
257444d0e3d5S[email protected]                 break;
257544d0e3d5S[email protected]             }
25762e77e513S[email protected]             conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_SCO);
2577e35edcc1S[email protected]             if (!conn) {
2578e35edcc1S[email protected]                 conn = create_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_SCO);
2579e35edcc1S[email protected]             }
2580e35edcc1S[email protected]             if (!conn) {
2581e35edcc1S[email protected]                 break;
2582e35edcc1S[email protected]             }
25831a06f663S[email protected]             conn->state = OPEN;
2584f8fbdce0SMatthias Ringwald             conn->con_handle = little_endian_read_16(packet, 3);
2585ee752bb8SMatthias Ringwald 
2586ee752bb8SMatthias Ringwald #ifdef ENABLE_SCO_OVER_HCI
2587ee752bb8SMatthias Ringwald             // update SCO
2588ee752bb8SMatthias Ringwald             if (conn->address_type == BD_ADDR_TYPE_SCO && hci_stack->hci_transport && hci_stack->hci_transport->set_sco_config){
2589ee752bb8SMatthias Ringwald                 hci_stack->hci_transport->set_sco_config(hci_stack->sco_voice_setting_active, hci_number_sco_connections());
2590ee752bb8SMatthias Ringwald             }
2591f234b250SMatthias Ringwald             // trigger can send now
2592f234b250SMatthias Ringwald             if (hci_have_usb_transport()){
2593f234b250SMatthias Ringwald                 hci_stack->sco_can_send_now = 1;
2594f234b250SMatthias Ringwald             }
2595ee752bb8SMatthias Ringwald #endif
2596cb70c5abSMatthias Ringwald #ifdef HAVE_SCO_TRANSPORT
2597cb70c5abSMatthias Ringwald             // configure sco transport
2598cb70c5abSMatthias Ringwald             if (hci_stack->sco_transport != NULL){
2599cb70c5abSMatthias Ringwald                 sco_format_t sco_format = ((hci_stack->sco_voice_setting_active & 0x03) == 0x03) ? SCO_FORMAT_8_BIT : SCO_FORMAT_16_BIT;
2600cb70c5abSMatthias Ringwald                 hci_stack->sco_transport->open(conn->con_handle, sco_format);
2601cb70c5abSMatthias Ringwald             }
2602cb70c5abSMatthias Ringwald #endif
260344d0e3d5S[email protected]             break;
260444d0e3d5S[email protected] 
2605afd4e962S[email protected]         case HCI_EVENT_READ_REMOTE_SUPPORTED_FEATURES_COMPLETE:
2606f8fbdce0SMatthias Ringwald             handle = little_endian_read_16(packet, 3);
2607afd4e962S[email protected]             conn = hci_connection_for_handle(handle);
2608afd4e962S[email protected]             if (!conn) break;
2609afd4e962S[email protected]             if (!packet[2]){
26102f5c44baSMatthias Ringwald                 const uint8_t * features = &packet[5];
26112f5c44baSMatthias Ringwald                 hci_handle_remote_features_page_0(conn, features);
26122f5c44baSMatthias Ringwald 
26135ccef624SMatthias Ringwald                 // read extended features if possible
26145ccef624SMatthias Ringwald                 if (((hci_stack->local_supported_commands[1] & 1) != 0) && ((conn->remote_supported_features[0] & 2) != 0)) {
26155ccef624SMatthias Ringwald                     conn->bonding_flags |= BONDING_REQUEST_REMOTE_FEATURES_PAGE_1;
26165ccef624SMatthias Ringwald                     break;
26175ccef624SMatthias Ringwald                 }
26185ccef624SMatthias Ringwald             }
26195ccef624SMatthias Ringwald             hci_handle_remote_features_received(conn);
26205ccef624SMatthias Ringwald             break;
26215ccef624SMatthias Ringwald 
26225ccef624SMatthias Ringwald         case HCI_EVENT_READ_REMOTE_EXTENDED_FEATURES_COMPLETE:
26235ccef624SMatthias Ringwald             handle = little_endian_read_16(packet, 3);
26245ccef624SMatthias Ringwald             conn = hci_connection_for_handle(handle);
26255ccef624SMatthias Ringwald             if (!conn) break;
26265ccef624SMatthias Ringwald             // status = ok, page = 1
262750c51a77SMatthias Ringwald             if (!packet[2]) {
262850c51a77SMatthias Ringwald                 uint8_t page_number = packet[5];
262950c51a77SMatthias Ringwald                 uint8_t maximum_page_number = packet[6];
26305ccef624SMatthias Ringwald                 const uint8_t * features = &packet[7];
263150c51a77SMatthias Ringwald                 bool done = false;
263250c51a77SMatthias Ringwald                 switch (page_number){
263350c51a77SMatthias Ringwald                     case 1:
26342f5c44baSMatthias Ringwald                         hci_handle_remote_features_page_1(conn, features);
263550c51a77SMatthias Ringwald                         if (maximum_page_number >= 2){
263650c51a77SMatthias Ringwald                             // get Secure Connections (Controller) from Page 2 if available
263750c51a77SMatthias Ringwald                             conn->bonding_flags |= BONDING_REQUEST_REMOTE_FEATURES_PAGE_2;
263850c51a77SMatthias Ringwald                         } else {
263950c51a77SMatthias Ringwald                             // otherwise, assume SC (Controller) == SC (Host)
264050c51a77SMatthias Ringwald                             if ((conn->bonding_flags & BONDING_REMOTE_SUPPORTS_SC_HOST) != 0){
264150c51a77SMatthias Ringwald                                 conn->bonding_flags |= BONDING_REMOTE_SUPPORTS_SC_CONTROLLER;
264250c51a77SMatthias Ringwald                             }
264350c51a77SMatthias Ringwald                             done = true;
264450c51a77SMatthias Ringwald                         }
264550c51a77SMatthias Ringwald                         break;
264650c51a77SMatthias Ringwald                     case 2:
264750c51a77SMatthias Ringwald                         hci_handle_remote_features_page_2(conn, features);
264850c51a77SMatthias Ringwald                         done = true;
264950c51a77SMatthias Ringwald                         break;
265050c51a77SMatthias Ringwald                     default:
265150c51a77SMatthias Ringwald                         break;
265250c51a77SMatthias Ringwald                 }
265350c51a77SMatthias Ringwald                 if (!done) break;
2654afd4e962S[email protected]             }
2655de0df013SMatthias Ringwald             hci_handle_remote_features_received(conn);
2656afd4e962S[email protected]             break;
2657afd4e962S[email protected] 
26587fde4af9Smatthias.ringwald         case HCI_EVENT_LINK_KEY_REQUEST:
26599da54300S[email protected]             log_info("HCI_EVENT_LINK_KEY_REQUEST");
26607fde4af9Smatthias.ringwald             hci_add_connection_flags_for_flipped_bd_addr(&packet[2], RECV_LINK_KEY_REQUEST);
2661608f51bbSMatthias Ringwald             // request handled by hci_run()
266232ab9390Smatthias.ringwald             hci_add_connection_flags_for_flipped_bd_addr(&packet[2], HANDLE_LINK_KEY_REQUEST);
2663608f51bbSMatthias Ringwald             break;
26647fde4af9Smatthias.ringwald 
26659ab95c90S[email protected]         case HCI_EVENT_LINK_KEY_NOTIFICATION: {
2666724d70a2SMatthias Ringwald             reverse_bd_addr(&packet[2], addr);
2667f16129ceSMatthias Ringwald             conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL);
26689ab95c90S[email protected]             if (!conn) break;
26699ab95c90S[email protected]             conn->authentication_flags |= RECV_LINK_KEY_NOTIFICATION;
26707bdc6798S[email protected]             link_key_type_t link_key_type = (link_key_type_t)packet[24];
26719ab95c90S[email protected]             // Change Connection Encryption keeps link key type
26729ab95c90S[email protected]             if (link_key_type != CHANGED_COMBINATION_KEY){
26739ab95c90S[email protected]                 conn->link_key_type = link_key_type;
26749ab95c90S[email protected]             }
2675e9f98c4aSMatthias Ringwald             // cache link key. link keys stored in little-endian format for legacy reasons
2676e9f98c4aSMatthias Ringwald             memcpy(&conn->link_key, &packet[8], 16);
2677e9f98c4aSMatthias Ringwald 
2678bec5f683SMatthias Ringwald             // only store link key:
2679bec5f683SMatthias Ringwald             // - if bondable enabled
2680bec5f683SMatthias Ringwald             if (hci_stack->bondable == false) break;
26816edaed7fSMatthias Ringwald             // - if security level sufficient
26826edaed7fSMatthias Ringwald             if (gap_security_level_for_link_key_type(link_key_type) < conn->requested_security_level) break;
2683bec5f683SMatthias Ringwald             // - for SSP, also check if remote side requested bonding as well
2684bec5f683SMatthias Ringwald             if (conn->link_key_type != COMBINATION_KEY){
2685532454f9SMatthias Ringwald                 bool remote_bonding = conn->io_cap_response_auth_req >= SSP_IO_AUTHREQ_MITM_PROTECTION_NOT_REQUIRED_DEDICATED_BONDING;
2686532454f9SMatthias Ringwald                 if (!remote_bonding){
2687bec5f683SMatthias Ringwald                     break;
2688bec5f683SMatthias Ringwald                 }
2689bec5f683SMatthias Ringwald             }
269055597469SMatthias Ringwald             gap_store_link_key_for_bd_addr(addr, &packet[8], conn->link_key_type);
26917fde4af9Smatthias.ringwald             break;
26929ab95c90S[email protected]         }
26937fde4af9Smatthias.ringwald 
26947fde4af9Smatthias.ringwald         case HCI_EVENT_PIN_CODE_REQUEST:
26956724cd9eS[email protected]             hci_add_connection_flags_for_flipped_bd_addr(&packet[2], LEGACY_PAIRING_ACTIVE);
26964c57c146S[email protected]             // non-bondable mode: pin code negative reply will be sent
26973a9fb326S[email protected]             if (!hci_stack->bondable){
2698899283eaS[email protected]                 hci_add_connection_flags_for_flipped_bd_addr(&packet[2], DENY_PIN_CODE_REQUEST);
2699f8fb5f6eS[email protected]                 hci_run();
2700f8fb5f6eS[email protected]                 return;
27014c57c146S[email protected]             }
2702d9a327f9Smatthias.ringwald             // PIN CODE REQUEST means the link key request didn't succee -> delete stored link key
2703a98592bcSMatthias Ringwald             if (!hci_stack->link_key_db) break;
2704a6ef64baSMilanka Ringwald             hci_event_pin_code_request_get_bd_addr(packet, addr);
2705a98592bcSMatthias Ringwald             hci_stack->link_key_db->delete_link_key(addr);
27067fde4af9Smatthias.ringwald             break;
27077fde4af9Smatthias.ringwald 
270850d7398cSMatthias Ringwald         case HCI_EVENT_IO_CAPABILITY_RESPONSE:
270950d7398cSMatthias Ringwald             hci_event_io_capability_response_get_bd_addr(packet, addr);
271050d7398cSMatthias Ringwald             conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL);
271150d7398cSMatthias Ringwald             if (!conn) break;
27122ff4272dSMatthias Ringwald             hci_add_connection_flags_for_flipped_bd_addr(&packet[2], RECV_IO_CAPABILITIES_RESPONSE);
271350d7398cSMatthias Ringwald             conn->io_cap_response_auth_req = hci_event_io_capability_response_get_authentication_requirements(packet);
2714e276e383SMatthias Ringwald             conn->io_cap_response_io       = hci_event_io_capability_response_get_io_capability(packet);
271550d7398cSMatthias Ringwald             break;
271650d7398cSMatthias Ringwald 
27171d6b20aeS[email protected]         case HCI_EVENT_IO_CAPABILITY_REQUEST:
27181d6b20aeS[email protected]             hci_add_connection_flags_for_flipped_bd_addr(&packet[2], RECV_IO_CAPABILITIES_REQUEST);
271911b03efaSMatthias Ringwald             log_info("IO Capability Request received, stack bondable %u, io cap %u", hci_stack->bondable, hci_stack->ssp_io_capability);
272044565b0cSMatthias Ringwald #ifndef ENABLE_EXPLICIT_IO_CAPABILITIES_REPLY
27218dbd6159SMatthias Ringwald             if (hci_stack->ssp_io_capability != SSP_IO_CAPABILITY_UNKNOWN){
2722dbe1a790S[email protected]                 hci_add_connection_flags_for_flipped_bd_addr(&packet[2], SEND_IO_CAPABILITIES_REPLY);
272311b03efaSMatthias Ringwald             } else {
272411b03efaSMatthias Ringwald                 hci_add_connection_flags_for_flipped_bd_addr(&packet[2], SEND_IO_CAPABILITIES_NEGATIVE_REPLY);
272511b03efaSMatthias Ringwald             }
272644565b0cSMatthias Ringwald #endif
2727dbe1a790S[email protected]             break;
2728dbe1a790S[email protected] 
27291849becdSMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB
27301849becdSMatthias Ringwald         case HCI_EVENT_REMOTE_OOB_DATA_REQUEST:
27311849becdSMatthias Ringwald             hci_add_connection_flags_for_flipped_bd_addr(&packet[2], SSP_PAIRING_ACTIVE);
27321849becdSMatthias Ringwald             hci_add_connection_flags_for_flipped_bd_addr(&packet[2], SEND_REMOTE_OOB_DATA_REPLY);
27331849becdSMatthias Ringwald             break;
27341849becdSMatthias Ringwald #endif
27351849becdSMatthias Ringwald 
2736dbe1a790S[email protected]         case HCI_EVENT_USER_CONFIRMATION_REQUEST:
273717c6fe5cSMatthias Ringwald             hci_event_user_confirmation_request_get_bd_addr(packet, addr);
273817c6fe5cSMatthias Ringwald             if (hci_ssp_validate_possible_security_level(addr) == false) break;
27393a9fb326S[email protected]             if (!hci_stack->ssp_auto_accept) break;
2740dbe1a790S[email protected]             hci_add_connection_flags_for_flipped_bd_addr(&packet[2], SEND_USER_CONFIRM_REPLY);
2741dbe1a790S[email protected]             break;
2742dbe1a790S[email protected] 
2743dbe1a790S[email protected]         case HCI_EVENT_USER_PASSKEY_REQUEST:
274417c6fe5cSMatthias Ringwald             hci_event_user_passkey_request_get_bd_addr(packet, addr);
274517c6fe5cSMatthias Ringwald             if (hci_ssp_validate_possible_security_level(addr) == false) break;
27463a9fb326S[email protected]             if (!hci_stack->ssp_auto_accept) break;
2747dbe1a790S[email protected]             hci_add_connection_flags_for_flipped_bd_addr(&packet[2], SEND_USER_PASSKEY_REPLY);
27481d6b20aeS[email protected]             break;
27491849becdSMatthias Ringwald 
27503dce6128SMatthias Ringwald         case HCI_EVENT_MODE_CHANGE:
27513dce6128SMatthias Ringwald             handle = hci_event_mode_change_get_handle(packet);
27523dce6128SMatthias Ringwald             conn = hci_connection_for_handle(handle);
27533dce6128SMatthias Ringwald             if (!conn) break;
27543dce6128SMatthias Ringwald             conn->connection_mode = hci_event_mode_change_get_mode(packet);
27553dce6128SMatthias Ringwald             log_info("HCI_EVENT_MODE_CHANGE, handle 0x%04x, mode %u", handle, conn->connection_mode);
27563dce6128SMatthias Ringwald             break;
275735454696SMatthias Ringwald #endif
27581d6b20aeS[email protected] 
2759f0944df2S[email protected]         case HCI_EVENT_ENCRYPTION_CHANGE:
2760254b78eeSMatthias Ringwald             handle = hci_event_encryption_change_get_connection_handle(packet);
2761f0944df2S[email protected]             conn = hci_connection_for_handle(handle);
2762f0944df2S[email protected]             if (!conn) break;
27634ea43905SMatthias Ringwald             if (hci_event_encryption_change_get_status(packet) == 0u) {
2764254b78eeSMatthias Ringwald                 uint8_t encryption_enabled = hci_event_encryption_change_get_encryption_enabled(packet);
2765254b78eeSMatthias Ringwald                 if (encryption_enabled){
2766573897a0SMatthias Ringwald                     if (hci_is_le_connection(conn)){
2767573897a0SMatthias Ringwald                         // For LE, we accept connection as encrypted
2768f0944df2S[email protected]                         conn->authentication_flags |= CONNECTION_ENCRYPTED;
2769573897a0SMatthias Ringwald                     }
2770573897a0SMatthias Ringwald #ifdef ENABLE_CLASSIC
2771573897a0SMatthias Ringwald                     else {
2772fcaf38b9SMatthias Ringwald 
2773fcaf38b9SMatthias Ringwald                         // dedicated bonding: send result and disconnect
2774fcaf38b9SMatthias Ringwald                         if (conn->bonding_flags & BONDING_DEDICATED){
2775fcaf38b9SMatthias Ringwald                             conn->bonding_flags &= ~BONDING_DEDICATED;
2776fcaf38b9SMatthias Ringwald                             conn->bonding_flags |= BONDING_DISCONNECT_DEDICATED_DONE;
2777fcaf38b9SMatthias Ringwald                             conn->bonding_status = packet[2];
2778fcaf38b9SMatthias Ringwald                             break;
2779fcaf38b9SMatthias Ringwald                         }
2780fcaf38b9SMatthias Ringwald 
2781254b78eeSMatthias Ringwald                         // Detect Secure Connection -> Legacy Connection Downgrade Attack (BIAS)
2782254b78eeSMatthias Ringwald                         bool sc_used_during_pairing = gap_secure_connection_for_link_key_type(conn->link_key_type) != 0;
2783254b78eeSMatthias Ringwald                         bool connected_uses_aes_ccm = encryption_enabled == 2;
2784edc1ac20SMatthias Ringwald                         if (hci_stack->secure_connections_active && sc_used_during_pairing && !connected_uses_aes_ccm){
2785254b78eeSMatthias Ringwald                             log_info("SC during pairing, but only E0 now -> abort");
27869ece71c2SMatthias Ringwald                             conn->bonding_flags |= BONDING_DISCONNECT_SECURITY_BLOCK;
2787254b78eeSMatthias Ringwald                             break;
2788254b78eeSMatthias Ringwald                         }
2789254b78eeSMatthias Ringwald 
27906e058d3fSMatthias Ringwald                         if ((hci_stack->local_supported_commands[0] & 0x80) != 0){
27916e058d3fSMatthias Ringwald                             // For Classic, we need to validate encryption key size first, if possible (== supported by Controller)
2792573897a0SMatthias Ringwald                             conn->bonding_flags |= BONDING_SEND_READ_ENCRYPTION_KEY_SIZE;
27936e058d3fSMatthias Ringwald                         } else {
27946e058d3fSMatthias Ringwald                             // if not, pretend everything is perfect
27959866fdc7SMatthias Ringwald                             hci_handle_read_encryption_key_size_complete(conn, 16);
27966e058d3fSMatthias Ringwald                         }
2797573897a0SMatthias Ringwald                     }
2798573897a0SMatthias Ringwald #endif
2799f0944df2S[email protected]                 } else {
2800536f9994S[email protected]                     conn->authentication_flags &= ~CONNECTION_ENCRYPTED;
2801f0944df2S[email protected]                 }
2802ad83dc6aS[email protected]             }
2803573897a0SMatthias Ringwald 
2804f0944df2S[email protected]             break;
2805f0944df2S[email protected] 
280635454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
28071eb2563eS[email protected]         case HCI_EVENT_AUTHENTICATION_COMPLETE_EVENT:
2808abdad579SMatthias Ringwald             handle = hci_event_authentication_complete_get_connection_handle(packet);
28091eb2563eS[email protected]             conn = hci_connection_for_handle(handle);
28101eb2563eS[email protected]             if (!conn) break;
2811ad83dc6aS[email protected] 
2812dbd5dcc3SMatthias Ringwald             // clear authentication active flag
2813dbd5dcc3SMatthias Ringwald             conn->bonding_flags &= ~BONDING_SENT_AUTHENTICATE_REQUEST;
2814dbd5dcc3SMatthias Ringwald 
2815abdad579SMatthias Ringwald             // authenticated only if auth status == 0
2816abdad579SMatthias Ringwald             if (hci_event_authentication_complete_get_status(packet) == 0){
2817abdad579SMatthias Ringwald                 // authenticated
2818abdad579SMatthias Ringwald                 conn->authentication_flags |= CONNECTION_AUTHENTICATED;
2819abdad579SMatthias Ringwald 
2820131ef17aSMatthias Ringwald                 // If not already encrypted, start encryption
2821131ef17aSMatthias Ringwald                 if ((conn->authentication_flags & CONNECTION_ENCRYPTED) == 0){
28221eb2563eS[email protected]                     conn->bonding_flags |= BONDING_SEND_ENCRYPTION_REQUEST;
2823ad83dc6aS[email protected]                     break;
2824ad83dc6aS[email protected]                 }
2825abdad579SMatthias Ringwald             }
2826abdad579SMatthias Ringwald 
2827abdad579SMatthias Ringwald             // emit updated security level
28281cf0a6c8SMatthias Ringwald             conn->requested_security_level = LEVEL_0;
28291eb2563eS[email protected]             hci_emit_security_level(handle, gap_security_level_for_connection(conn));
28301eb2563eS[email protected]             break;
283135454696SMatthias Ringwald #endif
283234d2123cS[email protected] 
283386805605S[email protected]         // HCI_EVENT_DISCONNECTION_COMPLETE
2834ccda6e14S[email protected]         // has been split, to first notify stack before shutting connection down
2835ccda6e14S[email protected]         // see end of function, too.
2836a4f30ec0S[email protected]         case HCI_EVENT_DISCONNECTION_COMPLETE:
2837a4f30ec0S[email protected]             if (packet[2]) break;   // status != 0
2838f8fbdce0SMatthias Ringwald             handle = little_endian_read_16(packet, 3);
283981d2bdb2SMatthias Ringwald             // drop outgoing ACL fragments if it is for closed connection and release buffer if tx not active
28404ea43905SMatthias Ringwald             if (hci_stack->acl_fragmentation_total_size > 0u) {
2841c6a37cfdSMatthias Ringwald                 if (handle == READ_ACL_CONNECTION_HANDLE(hci_stack->hci_packet_buffer)){
28424ea43905SMatthias Ringwald                     int release_buffer = hci_stack->acl_fragmentation_tx_active == 0u;
284381d2bdb2SMatthias Ringwald                     log_info("drop fragmented ACL data for closed connection, release buffer %u", release_buffer);
2844c6a37cfdSMatthias Ringwald                     hci_stack->acl_fragmentation_total_size = 0;
2845c6a37cfdSMatthias Ringwald                     hci_stack->acl_fragmentation_pos = 0;
284681d2bdb2SMatthias Ringwald                     if (release_buffer){
284781d2bdb2SMatthias Ringwald                         hci_release_packet_buffer();
284881d2bdb2SMatthias Ringwald                     }
2849c6a37cfdSMatthias Ringwald                 }
2850c6a37cfdSMatthias Ringwald             }
285135454696SMatthias Ringwald 
2852c6a37cfdSMatthias Ringwald             conn = hci_connection_for_handle(handle);
2853c6a37cfdSMatthias Ringwald             if (!conn) break;
2854046ec007SMatthias Ringwald             // mark connection for shutdown
2855a70e17d4SMatthias Ringwald             conn->state = RECEIVED_DISCONNECTION_COMPLETE;
2856046ec007SMatthias Ringwald 
2857046ec007SMatthias Ringwald             // emit dedicatd bonding event
2858046ec007SMatthias Ringwald             if (conn->bonding_flags & BONDING_EMIT_COMPLETE_ON_DISCONNECT){
2859046ec007SMatthias Ringwald                 hci_emit_dedicated_bonding_result(conn->address, conn->bonding_status);
2860046ec007SMatthias Ringwald             }
2861046ec007SMatthias Ringwald 
286235454696SMatthias Ringwald #ifdef ENABLE_BLE
2863d70217a2SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
2864046ec007SMatthias Ringwald             // re-enable advertisements for le connections if active
28652b6ab3e6SMatthias Ringwald             if (hci_is_le_connection(conn)){
2866bbc366e6SMatthias Ringwald                 hci_update_advertisements_enabled_for_current_roles();
28679a2e4658SMatthias Ringwald             }
286835454696SMatthias Ringwald #endif
2869d70217a2SMatthias Ringwald #endif
2870ccda6e14S[email protected]             break;
28716772a24cSmatthias.ringwald 
2872c68bdf90Smatthias.ringwald         case HCI_EVENT_HARDWARE_ERROR:
2873313e5f9cSMatthias Ringwald             log_error("Hardware Error: 0x%02x", packet[2]);
2874d23838ecSMatthias Ringwald             if (hci_stack->hardware_error_callback){
2875c2e1fa60SMatthias Ringwald                 (*hci_stack->hardware_error_callback)(packet[2]);
28767586ee35S[email protected]             } else {
28777586ee35S[email protected]                 // if no special requests, just reboot stack
28787586ee35S[email protected]                 hci_power_control_off();
28797586ee35S[email protected]                 hci_power_control_on();
2880c68bdf90Smatthias.ringwald             }
2881c68bdf90Smatthias.ringwald             break;
2882c68bdf90Smatthias.ringwald 
28830e6f3837SMatthias Ringwald #ifdef ENABLE_CLASSIC
28845cf766e8SMatthias Ringwald         case HCI_EVENT_ROLE_CHANGE:
28855cf766e8SMatthias Ringwald             if (packet[2]) break;   // status != 0
2886c4c88f1bSJakob Krantz             reverse_bd_addr(&packet[3], addr);
2887f16129ceSMatthias Ringwald             addr_type = BD_ADDR_TYPE_ACL;
2888c4c88f1bSJakob Krantz             conn = hci_connection_for_bd_addr_and_type(addr, addr_type);
2889c4c88f1bSJakob Krantz             if (!conn) break;
28905cf766e8SMatthias Ringwald             conn->role = packet[9];
28915cf766e8SMatthias Ringwald             break;
28920e6f3837SMatthias Ringwald #endif
28935cf766e8SMatthias Ringwald 
289463fa3374SMatthias Ringwald         case HCI_EVENT_TRANSPORT_PACKET_SENT:
2895d051460cS[email protected]             // release packet buffer only for asynchronous transport and if there are not further fragements
28964fa24b5fS[email protected]             if (hci_transport_synchronous()) {
289763fa3374SMatthias Ringwald                 log_error("Synchronous HCI Transport shouldn't send HCI_EVENT_TRANSPORT_PACKET_SENT");
28984fa24b5fS[email protected]                 return; // instead of break: to avoid re-entering hci_run()
28994fa24b5fS[email protected]             }
290081d2bdb2SMatthias Ringwald             hci_stack->acl_fragmentation_tx_active = 0;
2901d051460cS[email protected]             if (hci_stack->acl_fragmentation_total_size) break;
2902d051460cS[email protected]             hci_release_packet_buffer();
2903701e3307SMatthias Ringwald 
290463fa3374SMatthias Ringwald             // L2CAP receives this event via the hci_emit_event below
290563fa3374SMatthias Ringwald 
290635454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
290763fa3374SMatthias Ringwald             // For SCO, we do the can_send_now_check here
2908701e3307SMatthias Ringwald             hci_notify_if_sco_can_send_now();
290935454696SMatthias Ringwald #endif
29106b4af23dS[email protected]             break;
29116b4af23dS[email protected] 
291235454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
291363fa3374SMatthias Ringwald         case HCI_EVENT_SCO_CAN_SEND_NOW:
291463fa3374SMatthias Ringwald             // For SCO, we do the can_send_now_check here
2915f234b250SMatthias Ringwald             hci_stack->sco_can_send_now = 1;
291663fa3374SMatthias Ringwald             hci_notify_if_sco_can_send_now();
291763fa3374SMatthias Ringwald             return;
29181cfb383eSMatthias Ringwald 
29191cfb383eSMatthias Ringwald         // explode inquriy results for easier consumption
29201cfb383eSMatthias Ringwald         case HCI_EVENT_INQUIRY_RESULT:
29211cfb383eSMatthias Ringwald         case HCI_EVENT_INQUIRY_RESULT_WITH_RSSI:
29221cfb383eSMatthias Ringwald         case HCI_EVENT_EXTENDED_INQUIRY_RESPONSE:
29239784dac1SMatthias Ringwald             gap_inquiry_explode(packet, size);
29241cfb383eSMatthias Ringwald             break;
292535454696SMatthias Ringwald #endif
292663fa3374SMatthias Ringwald 
2927a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE
29285909f7f2Smatthias.ringwald         case HCI_EVENT_LE_META:
29295909f7f2Smatthias.ringwald             switch (packet[2]){
2930d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
293157c9da5bS[email protected]                 case HCI_SUBEVENT_LE_ADVERTISING_REPORT:
29324f4e0224SMatthias Ringwald                     // log_info("advertising report received");
29336fab74dbSMatthias Ringwald                     if (!hci_stack->le_scanning_enabled) break;
293457c9da5bS[email protected]                     le_handle_advertisement_report(packet, size);
29357bdc6798S[email protected]                     break;
2936d70217a2SMatthias Ringwald #endif
29375909f7f2Smatthias.ringwald                 case HCI_SUBEVENT_LE_CONNECTION_COMPLETE:
29380ce3f217SMatthias Ringwald 					event_handle_le_connection_complete(packet);
29395909f7f2Smatthias.ringwald                     break;
29405909f7f2Smatthias.ringwald 
2941f8fbdce0SMatthias Ringwald                 // log_info("LE buffer size: %u, count %u", little_endian_read_16(packet,6), packet[8]);
2942c9db5c21SMilanka Ringwald                 case HCI_SUBEVENT_LE_CONNECTION_UPDATE_COMPLETE:
2943c9db5c21SMilanka Ringwald                     handle = hci_subevent_le_connection_update_complete_get_connection_handle(packet);
2944c9db5c21SMilanka Ringwald                     conn = hci_connection_for_handle(handle);
2945c9db5c21SMilanka Ringwald                     if (!conn) break;
2946c9db5c21SMilanka Ringwald                     conn->le_connection_interval = hci_subevent_le_connection_update_complete_get_conn_interval(packet);
2947c9db5c21SMilanka Ringwald                     break;
294865a46ef3S[email protected] 
294973cd8a2aSMatthias Ringwald                 case HCI_SUBEVENT_LE_REMOTE_CONNECTION_PARAMETER_REQUEST:
295073cd8a2aSMatthias Ringwald                     // connection
295173cd8a2aSMatthias Ringwald                     handle = hci_subevent_le_remote_connection_parameter_request_get_connection_handle(packet);
295273cd8a2aSMatthias Ringwald                     conn = hci_connection_for_handle(handle);
295373cd8a2aSMatthias Ringwald                     if (conn) {
295473cd8a2aSMatthias Ringwald                         // read arguments
295573cd8a2aSMatthias Ringwald                         uint16_t le_conn_interval_min   = hci_subevent_le_remote_connection_parameter_request_get_interval_min(packet);
295673cd8a2aSMatthias Ringwald                         uint16_t le_conn_interval_max   = hci_subevent_le_remote_connection_parameter_request_get_interval_max(packet);
295773cd8a2aSMatthias Ringwald                         uint16_t le_conn_latency        = hci_subevent_le_remote_connection_parameter_request_get_latency(packet);
295873cd8a2aSMatthias Ringwald                         uint16_t le_supervision_timeout = hci_subevent_le_remote_connection_parameter_request_get_timeout(packet);
295973cd8a2aSMatthias Ringwald 
296073cd8a2aSMatthias Ringwald                         // validate against current connection parameter range
296173cd8a2aSMatthias Ringwald                         le_connection_parameter_range_t existing_range;
296273cd8a2aSMatthias Ringwald                         gap_get_connection_parameter_range(&existing_range);
296373cd8a2aSMatthias 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);
296473cd8a2aSMatthias Ringwald                         if (update_parameter){
296573cd8a2aSMatthias Ringwald                             conn->le_con_parameter_update_state = CON_PARAMETER_UPDATE_REPLY;
296673cd8a2aSMatthias Ringwald                             conn->le_conn_interval_min = le_conn_interval_min;
296773cd8a2aSMatthias Ringwald                             conn->le_conn_interval_max = le_conn_interval_max;
296873cd8a2aSMatthias Ringwald                             conn->le_conn_latency = le_conn_latency;
296973cd8a2aSMatthias Ringwald                             conn->le_supervision_timeout = le_supervision_timeout;
297073cd8a2aSMatthias Ringwald                         } else {
2971c3898ca4SMatthias Ringwald                             conn->le_con_parameter_update_state = CON_PARAMETER_UPDATE_NEGATIVE_REPLY;
297273cd8a2aSMatthias Ringwald                         }
297373cd8a2aSMatthias Ringwald                     }
297473cd8a2aSMatthias Ringwald                     break;
29750f3b27c5SMatthias Ringwald #ifdef ENABLE_LE_LIMIT_ACL_FRAGMENT_BY_MAX_OCTETS
29760f3b27c5SMatthias Ringwald                 case HCI_SUBEVENT_LE_DATA_LENGTH_CHANGE:
29770f3b27c5SMatthias Ringwald                     handle = hci_subevent_le_data_length_change_get_connection_handle(packet);
29780f3b27c5SMatthias Ringwald                     conn = hci_connection_for_handle(handle);
29790f3b27c5SMatthias Ringwald                     if (conn) {
29800f3b27c5SMatthias Ringwald                         conn->le_max_tx_octets = hci_subevent_le_data_length_change_get_max_tx_octets(packet);
29810f3b27c5SMatthias Ringwald                     }
29820f3b27c5SMatthias Ringwald                     break;
29830f3b27c5SMatthias Ringwald #endif
29845909f7f2Smatthias.ringwald                 default:
29855909f7f2Smatthias.ringwald                     break;
29865909f7f2Smatthias.ringwald             }
29875909f7f2Smatthias.ringwald             break;
29885909f7f2Smatthias.ringwald #endif
29890b36101dSMatthias Ringwald         case HCI_EVENT_VENDOR_SPECIFIC:
29900b36101dSMatthias Ringwald             // Vendor specific commands often create vendor specific event instead of num completed packets
29910b36101dSMatthias Ringwald             // To avoid getting stuck as num_cmds_packets is zero, reset it to 1 for controllers with this behaviour
29920b36101dSMatthias Ringwald             switch (hci_stack->manufacturer){
29930b36101dSMatthias Ringwald                 case BLUETOOTH_COMPANY_ID_CAMBRIDGE_SILICON_RADIO:
29940b36101dSMatthias Ringwald                     hci_stack->num_cmd_packets = 1;
29950b36101dSMatthias Ringwald                     break;
29960b36101dSMatthias Ringwald                 default:
29970b36101dSMatthias Ringwald                     break;
29980b36101dSMatthias Ringwald             }
29990b36101dSMatthias Ringwald             break;
30006772a24cSmatthias.ringwald         default:
30016772a24cSmatthias.ringwald             break;
3002fe1ed1b8Smatthias.ringwald     }
3003fe1ed1b8Smatthias.ringwald 
300467c6c9dcSMatthias Ringwald     handle_event_for_current_stack_state(packet, size);
300589db417bSmatthias.ringwald 
300686805605S[email protected]     // notify upper stack
3007d6b06661SMatthias Ringwald 	hci_emit_event(packet, size, 0);   // don't dump, already happened in packet handler
300894ab26f8Smatthias.ringwald 
300986805605S[email protected]     // moved here to give upper stack a chance to close down everything with hci_connection_t intact
3010797b2a3fSMatthias Ringwald     if ((hci_event_packet_get_type(packet) == HCI_EVENT_DISCONNECTION_COMPLETE) && (packet[2] == 0)){
3011f8fbdce0SMatthias Ringwald 		handle = little_endian_read_16(packet, 3);
301205ae8de3SMatthias Ringwald 		hci_connection_t * aConn = hci_connection_for_handle(handle);
3013046ec007SMatthias Ringwald 		// discard connection if app did not trigger a reconnect in the event handler
3014797b2a3fSMatthias Ringwald 		if (aConn && aConn->state == RECEIVED_DISCONNECTION_COMPLETE){
301505ae8de3SMatthias Ringwald 			hci_shutdown_connection(aConn);
3016b0136355SMatthias Ringwald 		}
301786805605S[email protected]     }
301886805605S[email protected] 
301994ab26f8Smatthias.ringwald 	// execute main loop
302094ab26f8Smatthias.ringwald 	hci_run();
302116833f0aSmatthias.ringwald }
302216833f0aSmatthias.ringwald 
302335454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
30246f28d2eeSMatthias Ringwald 
30256be3cf7fSMatthias Ringwald #ifdef ENABLE_SCO_OVER_HCI
30266f28d2eeSMatthias Ringwald static void sco_tx_timeout_handler(btstack_timer_source_t * ts);
30276f28d2eeSMatthias Ringwald static void sco_schedule_tx(hci_connection_t * conn);
30286f28d2eeSMatthias Ringwald 
30296f28d2eeSMatthias Ringwald static void sco_tx_timeout_handler(btstack_timer_source_t * ts){
303059c33575SMatthias Ringwald     log_debug("SCO TX Timeout");
30315a6b2dbdSMatthias Ringwald     hci_con_handle_t con_handle = (hci_con_handle_t) (uintptr_t) btstack_run_loop_get_timer_context(ts);
30326f28d2eeSMatthias Ringwald     hci_connection_t * conn = hci_connection_for_handle(con_handle);
30336f28d2eeSMatthias Ringwald     if (!conn) return;
30346f28d2eeSMatthias Ringwald 
3035afaddd67SMatthias Ringwald     // trigger send
3036afaddd67SMatthias Ringwald     conn->sco_tx_ready = 1;
3037e4157653SMatthias Ringwald     // extra packet if CVSD but SCO buffer is too short
3038a1df452eSMatthias Ringwald     if (((hci_stack->sco_voice_setting_active & 0x03) != 0x03) && (hci_stack->sco_data_packet_length < 123)){
3039e4157653SMatthias Ringwald         conn->sco_tx_ready++;
3040e4157653SMatthias Ringwald     }
3041afaddd67SMatthias Ringwald     hci_notify_if_sco_can_send_now();
30426f28d2eeSMatthias Ringwald }
30436f28d2eeSMatthias Ringwald 
304459c33575SMatthias Ringwald 
304559c33575SMatthias Ringwald #define SCO_TX_AFTER_RX_MS (6)
304659c33575SMatthias Ringwald 
30476f28d2eeSMatthias Ringwald static void sco_schedule_tx(hci_connection_t * conn){
304859c33575SMatthias Ringwald 
30496f28d2eeSMatthias Ringwald     uint32_t now = btstack_run_loop_get_time_ms();
305059c33575SMatthias Ringwald     uint32_t sco_tx_ms = conn->sco_rx_ms + SCO_TX_AFTER_RX_MS;
305159c33575SMatthias Ringwald     int time_delta_ms = sco_tx_ms - now;
305259c33575SMatthias Ringwald 
305359c33575SMatthias Ringwald     btstack_timer_source_t * timer = (conn->sco_rx_count & 1) ? &conn->timeout : &conn->timeout_sco;
305459c33575SMatthias Ringwald 
305559c33575SMatthias Ringwald     // log_error("SCO TX at %u in %u", (int) sco_tx_ms, time_delta_ms);
305659c33575SMatthias Ringwald     btstack_run_loop_set_timer(timer, time_delta_ms);
305759c33575SMatthias Ringwald     btstack_run_loop_set_timer_context(timer, (void *) (uintptr_t) conn->con_handle);
305859c33575SMatthias Ringwald     btstack_run_loop_set_timer_handler(timer, &sco_tx_timeout_handler);
305959c33575SMatthias Ringwald     btstack_run_loop_add_timer(timer);
30606f28d2eeSMatthias Ringwald }
30616be3cf7fSMatthias Ringwald #endif
30626f28d2eeSMatthias Ringwald 
3063c91d150bS[email protected] static void sco_handler(uint8_t * packet, uint16_t size){
30640b3f95dfSMatthias Ringwald     // lookup connection struct
30652b838201SMatthias Ringwald     hci_con_handle_t con_handle = READ_SCO_CONNECTION_HANDLE(packet);
30662b838201SMatthias Ringwald     hci_connection_t * conn     = hci_connection_for_handle(con_handle);
30670b3f95dfSMatthias Ringwald     if (!conn) return;
30680b3f95dfSMatthias Ringwald 
30696be3cf7fSMatthias Ringwald #ifdef ENABLE_SCO_OVER_HCI
3070760b20efSMatthias Ringwald     // CSR 8811 prefixes 60 byte SCO packet in transparent mode with 20 zero bytes -> skip first 20 payload bytes
3071760b20efSMatthias Ringwald     if (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_CAMBRIDGE_SILICON_RADIO){
3072a1df452eSMatthias Ringwald         if ((size == 83) && ((hci_stack->sco_voice_setting_active & 0x03) == 0x03)){
3073760b20efSMatthias Ringwald             packet[2] = 0x3c;
3074760b20efSMatthias Ringwald             memmove(&packet[3], &packet[23], 63);
3075760b20efSMatthias Ringwald             size = 63;
30760b3f95dfSMatthias Ringwald         }
30770b3f95dfSMatthias Ringwald     }
3078760b20efSMatthias Ringwald 
3079f234b250SMatthias Ringwald     if (hci_have_usb_transport()){
3080f234b250SMatthias Ringwald         // Nothing to do
3081f234b250SMatthias Ringwald     } else {
308249205f5dSMatthias 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);
3083760b20efSMatthias Ringwald         if (hci_stack->synchronous_flow_control_enabled == 0){
30846f28d2eeSMatthias Ringwald             uint32_t now = btstack_run_loop_get_time_ms();
308559c33575SMatthias Ringwald 
308659c33575SMatthias Ringwald             if (!conn->sco_rx_valid){
308759c33575SMatthias Ringwald                 // ignore first 10 packets
30886f28d2eeSMatthias Ringwald                 conn->sco_rx_count++;
308959c33575SMatthias Ringwald                 // log_debug("sco rx count %u", conn->sco_rx_count);
309059c33575SMatthias Ringwald                 if (conn->sco_rx_count == 10) {
309159c33575SMatthias Ringwald                     // use first timestamp as is and pretent it just started
30926f28d2eeSMatthias Ringwald                     conn->sco_rx_ms = now;
30936f28d2eeSMatthias Ringwald                     conn->sco_rx_valid = 1;
309459c33575SMatthias Ringwald                     conn->sco_rx_count = 0;
309559c33575SMatthias Ringwald                     sco_schedule_tx(conn);
309659c33575SMatthias Ringwald                 }
309759c33575SMatthias Ringwald             } else {
309859c33575SMatthias Ringwald                 // track expected arrival timme
309959c33575SMatthias Ringwald                 conn->sco_rx_count++;
310059c33575SMatthias Ringwald                 conn->sco_rx_ms += 7;
310159c33575SMatthias Ringwald                 int delta = (int32_t) (now - conn->sco_rx_ms);
310259c33575SMatthias Ringwald                 if (delta > 0){
310359c33575SMatthias Ringwald                     conn->sco_rx_ms++;
310459c33575SMatthias Ringwald                 }
310559c33575SMatthias Ringwald                 // log_debug("sco rx %u", conn->sco_rx_ms);
31066f28d2eeSMatthias Ringwald                 sco_schedule_tx(conn);
31076f28d2eeSMatthias Ringwald             }
3108760b20efSMatthias Ringwald         }
3109f234b250SMatthias Ringwald     }
31106be3cf7fSMatthias Ringwald #endif
31116be3cf7fSMatthias Ringwald 
31120b3f95dfSMatthias Ringwald     // deliver to app
31130b3f95dfSMatthias Ringwald     if (hci_stack->sco_packet_handler) {
31140b3f95dfSMatthias Ringwald         hci_stack->sco_packet_handler(HCI_SCO_DATA_PACKET, 0, packet, size);
31150b3f95dfSMatthias Ringwald     }
31160b3f95dfSMatthias Ringwald 
3117ed325439SMatthias Ringwald #ifdef HAVE_SCO_TRANSPORT
3118ed325439SMatthias Ringwald     // We can send one packet for each received packet
3119ed325439SMatthias Ringwald     conn->sco_tx_ready++;
3120ed325439SMatthias Ringwald     hci_notify_if_sco_can_send_now();
3121ed325439SMatthias Ringwald #endif
3122ed325439SMatthias Ringwald 
31230b3f95dfSMatthias Ringwald #ifdef ENABLE_HCI_CONTROLLER_TO_HOST_FLOW_CONTROL
31242b838201SMatthias Ringwald     conn->num_packets_completed++;
31252b838201SMatthias Ringwald     hci_stack->host_completed_packets = 1;
31262b838201SMatthias Ringwald     hci_run();
31272b838201SMatthias Ringwald #endif
3128c91d150bS[email protected] }
312935454696SMatthias Ringwald #endif
3130c91d150bS[email protected] 
31310a57e69fSmatthias.ringwald static void packet_handler(uint8_t packet_type, uint8_t *packet, uint16_t size){
31325bb5bc3eS[email protected]     hci_dump_packet(packet_type, 1, packet, size);
313310e830c9Smatthias.ringwald     switch (packet_type) {
313410e830c9Smatthias.ringwald         case HCI_EVENT_PACKET:
313510e830c9Smatthias.ringwald             event_handler(packet, size);
313610e830c9Smatthias.ringwald             break;
313710e830c9Smatthias.ringwald         case HCI_ACL_DATA_PACKET:
313810e830c9Smatthias.ringwald             acl_handler(packet, size);
313910e830c9Smatthias.ringwald             break;
314035454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
3141c91d150bS[email protected]         case HCI_SCO_DATA_PACKET:
3142c91d150bS[email protected]             sco_handler(packet, size);
3143202c8a4cSMatthias Ringwald             break;
314435454696SMatthias Ringwald #endif
314510e830c9Smatthias.ringwald         default:
314610e830c9Smatthias.ringwald             break;
314710e830c9Smatthias.ringwald     }
314810e830c9Smatthias.ringwald }
314910e830c9Smatthias.ringwald 
3150d6b06661SMatthias Ringwald /**
3151d6b06661SMatthias Ringwald  * @brief Add event packet handler.
3152d6b06661SMatthias Ringwald  */
3153d6b06661SMatthias Ringwald void hci_add_event_handler(btstack_packet_callback_registration_t * callback_handler){
3154d6b06661SMatthias Ringwald     btstack_linked_list_add_tail(&hci_stack->event_handlers, (btstack_linked_item_t*) callback_handler);
3155d6b06661SMatthias Ringwald }
3156d6b06661SMatthias Ringwald 
3157d6b06661SMatthias Ringwald 
3158fcadd0caSmatthias.ringwald /** Register HCI packet handlers */
31593d50b4baSMatthias Ringwald void hci_register_acl_packet_handler(btstack_packet_handler_t handler){
3160fb37a842SMatthias Ringwald     hci_stack->acl_packet_handler = handler;
316116833f0aSmatthias.ringwald }
316216833f0aSmatthias.ringwald 
316335454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
31648abbe8b5SMatthias Ringwald /**
31658abbe8b5SMatthias Ringwald  * @brief Registers a packet handler for SCO data. Used for HSP and HFP profiles.
31668abbe8b5SMatthias Ringwald  */
31673d50b4baSMatthias Ringwald void hci_register_sco_packet_handler(btstack_packet_handler_t handler){
31688abbe8b5SMatthias Ringwald     hci_stack->sco_packet_handler = handler;
31698abbe8b5SMatthias Ringwald }
317035454696SMatthias Ringwald #endif
31718abbe8b5SMatthias Ringwald 
317271de195eSMatthias Ringwald static void hci_state_reset(void){
3173595bdbfbS[email protected]     // no connections yet
3174595bdbfbS[email protected]     hci_stack->connections = NULL;
317574308b23Smatthias.ringwald 
317674308b23Smatthias.ringwald     // keep discoverable/connectable as this has been requested by the client(s)
317774308b23Smatthias.ringwald     // hci_stack->discoverable = 0;
317874308b23Smatthias.ringwald     // hci_stack->connectable = 0;
317974308b23Smatthias.ringwald     // hci_stack->bondable = 1;
3180b95a5a35SMatthias Ringwald     // hci_stack->own_addr_type = 0;
3181595bdbfbS[email protected] 
318244935e40S[email protected]     // buffer is free
318344935e40S[email protected]     hci_stack->hci_packet_buffer_reserved = 0;
318444935e40S[email protected] 
3185595bdbfbS[email protected]     // no pending cmds
3186595bdbfbS[email protected]     hci_stack->decline_reason = 0;
3187595bdbfbS[email protected]     hci_stack->new_scan_enable_value = 0xff;
3188595bdbfbS[email protected] 
3189c214d65bSMatthias Ringwald     hci_stack->secure_connections_active = false;
3190c214d65bSMatthias Ringwald 
3191bea424a5SMatthias Ringwald #ifdef ENABLE_CLASSIC
3192bea424a5SMatthias Ringwald     hci_stack->new_page_scan_interval = 0xffff;
3193bea424a5SMatthias Ringwald     hci_stack->new_page_scan_window = 0xffff;
3194bea424a5SMatthias Ringwald     hci_stack->new_page_scan_type = 0xff;
3195496bb884SMatthias Ringwald     hci_stack->inquiry_lap = GAP_IAC_GENERAL_INQUIRY;
3196bea424a5SMatthias Ringwald #endif
3197bea424a5SMatthias Ringwald 
3198cf01e888SMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB
3199cf01e888SMatthias Ringwald     hci_stack->classic_read_local_oob_data = true;
3200cf01e888SMatthias Ringwald #endif
3201cf01e888SMatthias Ringwald 
3202595bdbfbS[email protected]     // LE
3203b95a5a35SMatthias Ringwald #ifdef ENABLE_BLE
3204b95a5a35SMatthias Ringwald     memset(hci_stack->le_random_address, 0, 6);
3205b95a5a35SMatthias Ringwald     hci_stack->le_random_address_set = 0;
3206d70217a2SMatthias Ringwald #endif
3207d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
3208a61834b6SMatthias Ringwald     hci_stack->le_scanning_active  = false;
3209b04dfa37SMatthias Ringwald     hci_stack->le_connecting_state = LE_CONNECTING_IDLE;
3210d5b1a89eSMatthias Ringwald     hci_stack->le_connecting_request = LE_CONNECTING_IDLE;
3211e83201bcSMatthias Ringwald     hci_stack->le_whitelist_capacity = 0;
3212d70217a2SMatthias Ringwald #endif
3213a61834b6SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
3214a61834b6SMatthias Ringwald     hci_stack->le_advertisements_active = false;
3215a61834b6SMatthias Ringwald     if ((hci_stack->le_advertisements_todo & LE_ADVERTISEMENT_TASKS_PARAMS_SET) != 0){
3216a61834b6SMatthias Ringwald         hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_SET_PARAMS;
3217a61834b6SMatthias Ringwald     }
3218a61834b6SMatthias Ringwald     if (hci_stack->le_advertisements_data != NULL){
3219a61834b6SMatthias Ringwald         hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_SET_ADV_DATA;
3220a61834b6SMatthias Ringwald     }
3221a61834b6SMatthias Ringwald #endif
3222595bdbfbS[email protected] }
3223595bdbfbS[email protected] 
322435454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
32252d5e09d6SMatthias Ringwald /**
32262d5e09d6SMatthias Ringwald  * @brief Configure Bluetooth hardware control. Has to be called before power on.
32272d5e09d6SMatthias Ringwald  */
32282d5e09d6SMatthias Ringwald void hci_set_link_key_db(btstack_link_key_db_t const * link_key_db){
32292d5e09d6SMatthias Ringwald     // store and open remote device db
32302d5e09d6SMatthias Ringwald     hci_stack->link_key_db = link_key_db;
32312d5e09d6SMatthias Ringwald     if (hci_stack->link_key_db) {
32322d5e09d6SMatthias Ringwald         hci_stack->link_key_db->open();
32332d5e09d6SMatthias Ringwald     }
32342d5e09d6SMatthias Ringwald }
323535454696SMatthias Ringwald #endif
32362d5e09d6SMatthias Ringwald 
32372d5e09d6SMatthias Ringwald void hci_init(const hci_transport_t *transport, const void *config){
3238475c8125Smatthias.ringwald 
32393a9fb326S[email protected] #ifdef HAVE_MALLOC
32403a9fb326S[email protected]     if (!hci_stack) {
32413a9fb326S[email protected]         hci_stack = (hci_stack_t*) malloc(sizeof(hci_stack_t));
32423a9fb326S[email protected]     }
32433a9fb326S[email protected] #else
32443a9fb326S[email protected]     hci_stack = &hci_stack_static;
32453a9fb326S[email protected] #endif
324666fb9560S[email protected]     memset(hci_stack, 0, sizeof(hci_stack_t));
32473a9fb326S[email protected] 
3248475c8125Smatthias.ringwald     // reference to use transport layer implementation
32493a9fb326S[email protected]     hci_stack->hci_transport = transport;
3250475c8125Smatthias.ringwald 
325111e23e5fSmatthias.ringwald     // reference to used config
32523a9fb326S[email protected]     hci_stack->config = config;
325311e23e5fSmatthias.ringwald 
325426a9b6daSMatthias Ringwald     // setup pointer for outgoing packet buffer
325526a9b6daSMatthias Ringwald     hci_stack->hci_packet_buffer = &hci_stack->hci_packet_buffer_data[HCI_OUTGOING_PRE_BUFFER_SIZE];
325626a9b6daSMatthias Ringwald 
32578fcba05dSmatthias.ringwald     // max acl payload size defined in config.h
32583a9fb326S[email protected]     hci_stack->acl_data_packet_length = HCI_ACL_PAYLOAD_SIZE;
32598fcba05dSmatthias.ringwald 
326016833f0aSmatthias.ringwald     // register packet handlers with transport
326110e830c9Smatthias.ringwald     transport->register_packet_handler(&packet_handler);
3262f5454fc6Smatthias.ringwald 
32633a9fb326S[email protected]     hci_stack->state = HCI_STATE_OFF;
3264e2386ba1S[email protected] 
3265e2386ba1S[email protected]     // class of device
32663a9fb326S[email protected]     hci_stack->class_of_device = 0x007a020c; // Smartphone
3267a45d6b9fS[email protected] 
3268f20168b8Smatthias.ringwald     // bondable by default
3269f20168b8Smatthias.ringwald     hci_stack->bondable = 1;
3270f20168b8Smatthias.ringwald 
3271e9f343c8SMatthias Ringwald #ifdef ENABLE_CLASSIC
327263168530SMatthias Ringwald     // classic name
327363168530SMatthias Ringwald     hci_stack->local_name = default_classic_name;
3274c4c88f1bSJakob Krantz 
3275c4c88f1bSJakob Krantz     // Master slave policy
3276c4c88f1bSJakob Krantz     hci_stack->master_slave_policy = 1;
3277170fafaeSMatthias Ringwald 
3278b4eb4420SMatthias Ringwald     // Allow Role Switch
3279b4eb4420SMatthias Ringwald     hci_stack->allow_role_switch = 1;
3280b4eb4420SMatthias Ringwald 
328178315a58SMatthias Ringwald     // Default / minimum security level = 2
328278315a58SMatthias Ringwald     hci_stack->gap_security_level = LEVEL_2;
328378315a58SMatthias Ringwald 
32845dbec6b3SMatthias Ringwald     // Default Security Mode 4
32855dbec6b3SMatthias Ringwald     hci_stack->gap_security_mode = GAP_SECURITY_MODE_4;
32865dbec6b3SMatthias Ringwald 
3287cd345294SMatthias Ringwald     // Errata-11838 mandates 7 bytes for GAP Security Level 1-3
3288cd345294SMatthias Ringwald     hci_stack->gap_required_encyrption_key_size = 7;
3289d821984bSMatthias Ringwald 
3290d821984bSMatthias Ringwald     // Link Supervision Timeout
3291d821984bSMatthias Ringwald     hci_stack->link_supervision_timeout = HCI_LINK_SUPERVISION_TIMEOUT_DEFAULT;
3292d821984bSMatthias Ringwald 
3293e9f343c8SMatthias Ringwald #endif
329463168530SMatthias Ringwald 
329563048403S[email protected]     // Secure Simple Pairing default: enable, no I/O capabilities, general bonding, mitm not required, auto accept
32963a9fb326S[email protected]     hci_stack->ssp_enable = 1;
32973a9fb326S[email protected]     hci_stack->ssp_io_capability = SSP_IO_CAPABILITY_NO_INPUT_NO_OUTPUT;
32983a9fb326S[email protected]     hci_stack->ssp_authentication_requirement = SSP_IO_AUTHREQ_MITM_PROTECTION_NOT_REQUIRED_GENERAL_BONDING;
32993a9fb326S[email protected]     hci_stack->ssp_auto_accept = 1;
330069a97523S[email protected] 
33015d23aae8SMatthias Ringwald     // Secure Connections: enable (requires support from Controller)
33025d23aae8SMatthias Ringwald     hci_stack->secure_connections_enable = true;
33035d23aae8SMatthias Ringwald 
3304fac2e2feSMatthias Ringwald     // voice setting - signed 16 bit pcm data with CVSD over the air
3305fac2e2feSMatthias Ringwald     hci_stack->sco_voice_setting = 0x60;
3306d950d659SMatthias Ringwald 
3307831711daSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
3308831711daSMatthias Ringwald     // connection parameter to use for outgoing connections
3309cbe54ab2SJakob Krantz     hci_stack->le_connection_scan_interval = 0x0060;   // 60ms
3310cbe54ab2SJakob Krantz     hci_stack->le_connection_scan_window  = 0x0030;    // 30ms
3311831711daSMatthias Ringwald     hci_stack->le_connection_interval_min = 0x0008;    // 10 ms
3312831711daSMatthias Ringwald     hci_stack->le_connection_interval_max = 0x0018;    // 30 ms
3313831711daSMatthias Ringwald     hci_stack->le_connection_latency      = 4;         // 4
3314831711daSMatthias Ringwald     hci_stack->le_supervision_timeout     = 0x0048;    // 720 ms
3315831711daSMatthias Ringwald     hci_stack->le_minimum_ce_length       = 2;         // 1.25 ms
3316831711daSMatthias Ringwald     hci_stack->le_maximum_ce_length       = 0x0030;    // 30 ms
33177261e5d8SMatthias Ringwald 
33187261e5d8SMatthias Ringwald     // default LE Scanning
33198b69e4c7SMatthias Ringwald     hci_stack->le_scan_type     =   0x1; // active
33208b69e4c7SMatthias Ringwald     hci_stack->le_scan_interval = 0x1e0; // 300 ms
33218b69e4c7SMatthias Ringwald     hci_stack->le_scan_window   =  0x30; //  30 ms
3322831711daSMatthias Ringwald #endif
3323831711daSMatthias Ringwald 
33242b6ab3e6SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
33252b6ab3e6SMatthias Ringwald     hci_stack->le_max_number_peripheral_connections = 1; // only single connection as peripheral
33262b6ab3e6SMatthias Ringwald #endif
33272b6ab3e6SMatthias Ringwald 
3328831711daSMatthias Ringwald     // connection parameter range used to answer connection parameter update requests in l2cap
3329831711daSMatthias Ringwald     hci_stack->le_connection_parameter_range.le_conn_interval_min =          6;
3330831711daSMatthias Ringwald     hci_stack->le_connection_parameter_range.le_conn_interval_max =       3200;
3331831711daSMatthias Ringwald     hci_stack->le_connection_parameter_range.le_conn_latency_min =           0;
3332831711daSMatthias Ringwald     hci_stack->le_connection_parameter_range.le_conn_latency_max =         500;
3333831711daSMatthias Ringwald     hci_stack->le_connection_parameter_range.le_supervision_timeout_min =   10;
3334831711daSMatthias Ringwald     hci_stack->le_connection_parameter_range.le_supervision_timeout_max = 3200;
3335831711daSMatthias Ringwald 
3336595bdbfbS[email protected]     hci_state_reset();
3337475c8125Smatthias.ringwald }
3338475c8125Smatthias.ringwald 
33394688f216SMatthias Ringwald void hci_deinit(void){
33404688f216SMatthias Ringwald #ifdef HAVE_MALLOC
33414688f216SMatthias Ringwald     if (hci_stack) {
33424688f216SMatthias Ringwald         free(hci_stack);
33434688f216SMatthias Ringwald     }
33444688f216SMatthias Ringwald #endif
33454688f216SMatthias Ringwald     hci_stack = NULL;
3346b5bbcbf4SMatthias Ringwald 
3347b5bbcbf4SMatthias Ringwald #ifdef ENABLE_CLASSIC
33484688f216SMatthias Ringwald     disable_l2cap_timeouts = 0;
3349b5bbcbf4SMatthias Ringwald #endif
33504688f216SMatthias Ringwald }
33514688f216SMatthias Ringwald 
33523fb36a29SMatthias Ringwald /**
33533fb36a29SMatthias Ringwald  * @brief Configure Bluetooth chipset driver. Has to be called before power on, or right after receiving the local version information
33543fb36a29SMatthias Ringwald  */
33553fb36a29SMatthias Ringwald void hci_set_chipset(const btstack_chipset_t *chipset_driver){
33563fb36a29SMatthias Ringwald     hci_stack->chipset = chipset_driver;
33573fb36a29SMatthias Ringwald 
33583fb36a29SMatthias Ringwald     // reset chipset driver - init is also called on power_up
33593fb36a29SMatthias Ringwald     if (hci_stack->chipset && hci_stack->chipset->init){
33603fb36a29SMatthias Ringwald         hci_stack->chipset->init(hci_stack->config);
33613fb36a29SMatthias Ringwald     }
33623fb36a29SMatthias Ringwald }
33633fb36a29SMatthias Ringwald 
3364fb55bd0aSMatthias Ringwald /**
3365d0b87befSMatthias Ringwald  * @brief Configure Bluetooth hardware control. Has to be called after hci_init() but before power on.
3366fb55bd0aSMatthias Ringwald  */
3367fb55bd0aSMatthias Ringwald void hci_set_control(const btstack_control_t *hardware_control){
3368fb55bd0aSMatthias Ringwald     // references to used control implementation
3369fb55bd0aSMatthias Ringwald     hci_stack->control = hardware_control;
3370d0b87befSMatthias Ringwald     // init with transport config
3371d0b87befSMatthias Ringwald     hardware_control->init(hci_stack->config);
3372fb55bd0aSMatthias Ringwald }
3373fb55bd0aSMatthias Ringwald 
337471de195eSMatthias Ringwald void hci_close(void){
3375e6d6524dSMatthias Ringwald 
3376e6d6524dSMatthias Ringwald #ifdef ENABLE_CLASSIC
3377404843c1Smatthias.ringwald     // close remote device db
3378a98592bcSMatthias Ringwald     if (hci_stack->link_key_db) {
3379a98592bcSMatthias Ringwald         hci_stack->link_key_db->close();
3380404843c1Smatthias.ringwald     }
3381e6d6524dSMatthias Ringwald #endif
33827224be7eSMatthias Ringwald 
33837224be7eSMatthias Ringwald     btstack_linked_list_iterator_t lit;
33847224be7eSMatthias Ringwald     btstack_linked_list_iterator_init(&lit, &hci_stack->connections);
33857224be7eSMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&lit)){
33867224be7eSMatthias Ringwald         // cancel all l2cap connections by emitting dicsconnection complete before shutdown (free) connection
33877224be7eSMatthias Ringwald         hci_connection_t * connection = (hci_connection_t*) btstack_linked_list_iterator_next(&lit);
33887224be7eSMatthias Ringwald         hci_emit_disconnection_complete(connection->con_handle, 0x16); // terminated by local host
33897224be7eSMatthias Ringwald         hci_shutdown_connection(connection);
3390f5454fc6Smatthias.ringwald     }
33917224be7eSMatthias Ringwald 
3392f5454fc6Smatthias.ringwald     hci_power_control(HCI_POWER_OFF);
33933a9fb326S[email protected] 
33943a9fb326S[email protected] #ifdef HAVE_MALLOC
33953a9fb326S[email protected]     free(hci_stack);
33963a9fb326S[email protected] #endif
33973a9fb326S[email protected]     hci_stack = NULL;
3398404843c1Smatthias.ringwald }
3399404843c1Smatthias.ringwald 
3400cb70c5abSMatthias Ringwald #ifdef HAVE_SCO_TRANSPORT
3401cb70c5abSMatthias Ringwald void hci_set_sco_transport(const btstack_sco_transport_t *sco_transport){
3402cb70c5abSMatthias Ringwald     hci_stack->sco_transport = sco_transport;
3403cb70c5abSMatthias Ringwald     sco_transport->register_packet_handler(&packet_handler);
3404cb70c5abSMatthias Ringwald }
3405cb70c5abSMatthias Ringwald #endif
3406cb70c5abSMatthias Ringwald 
340735454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
3408170fafaeSMatthias Ringwald void gap_set_required_encryption_key_size(uint8_t encryption_key_size){
3409170fafaeSMatthias Ringwald     // validate ranage and set
3410170fafaeSMatthias Ringwald     if (encryption_key_size < 7)  return;
3411170fafaeSMatthias Ringwald     if (encryption_key_size > 16) return;
3412170fafaeSMatthias Ringwald     hci_stack->gap_required_encyrption_key_size = encryption_key_size;
3413170fafaeSMatthias Ringwald }
341478315a58SMatthias Ringwald 
3415137715ebSMatthias Ringwald uint8_t gap_set_security_mode(gap_security_mode_t security_mode){
3416137715ebSMatthias Ringwald     if ((security_mode == GAP_SECURITY_MODE_4) || (security_mode == GAP_SECURITY_MODE_2)){
34175dbec6b3SMatthias Ringwald         hci_stack->gap_security_mode = security_mode;
3418137715ebSMatthias Ringwald         return ERROR_CODE_SUCCESS;
3419137715ebSMatthias Ringwald     } else {
3420137715ebSMatthias Ringwald         return ERROR_CODE_UNSUPPORTED_FEATURE_OR_PARAMETER_VALUE;
3421137715ebSMatthias Ringwald     }
34225dbec6b3SMatthias Ringwald }
34235dbec6b3SMatthias Ringwald 
34245dbec6b3SMatthias Ringwald gap_security_mode_t gap_get_security_mode(void){
34255dbec6b3SMatthias Ringwald     return hci_stack->gap_security_mode;
34265dbec6b3SMatthias Ringwald }
34275dbec6b3SMatthias Ringwald 
342878315a58SMatthias Ringwald void gap_set_security_level(gap_security_level_t security_level){
342978315a58SMatthias Ringwald     hci_stack->gap_security_level = security_level;
343078315a58SMatthias Ringwald }
343178315a58SMatthias Ringwald 
343278315a58SMatthias Ringwald gap_security_level_t gap_get_security_level(void){
343378315a58SMatthias Ringwald     return hci_stack->gap_security_level;
343478315a58SMatthias Ringwald }
343530cdf3c6SMatthias Ringwald 
343630cdf3c6SMatthias Ringwald void gap_set_secure_connections_only_mode(bool enable){
343730cdf3c6SMatthias Ringwald     hci_stack->gap_secure_connections_only_mode = enable;
343830cdf3c6SMatthias Ringwald }
343930cdf3c6SMatthias Ringwald 
344030cdf3c6SMatthias Ringwald bool gap_get_secure_connections_only_mode(void){
344130cdf3c6SMatthias Ringwald     return hci_stack->gap_secure_connections_only_mode;
344230cdf3c6SMatthias Ringwald }
3443170fafaeSMatthias Ringwald #endif
3444170fafaeSMatthias Ringwald 
3445170fafaeSMatthias Ringwald #ifdef ENABLE_CLASSIC
344660b9e82fSMatthias Ringwald void gap_set_class_of_device(uint32_t class_of_device){
34479e61646fS[email protected]     hci_stack->class_of_device = class_of_device;
34489e61646fS[email protected] }
344976f27cffSMatthias Ringwald 
3450c33e56d3SMatthias Ringwald void gap_set_default_link_policy_settings(uint16_t default_link_policy_settings){
3451c33e56d3SMatthias Ringwald     hci_stack->default_link_policy_settings = default_link_policy_settings;
3452c33e56d3SMatthias Ringwald }
3453c33e56d3SMatthias Ringwald 
3454b4eb4420SMatthias Ringwald void gap_set_allow_role_switch(bool allow_role_switch){
3455b4eb4420SMatthias Ringwald     hci_stack->allow_role_switch = allow_role_switch ? 1 : 0;
3456b4eb4420SMatthias Ringwald }
3457b4eb4420SMatthias Ringwald 
3458b4eb4420SMatthias Ringwald uint8_t hci_get_allow_role_switch(void){
3459b4eb4420SMatthias Ringwald     return  hci_stack->allow_role_switch;
3460b4eb4420SMatthias Ringwald }
3461b4eb4420SMatthias Ringwald 
34620c3eb48dSMatthias Ringwald void gap_set_link_supervision_timeout(uint16_t link_supervision_timeout){
34630c3eb48dSMatthias Ringwald     hci_stack->link_supervision_timeout = link_supervision_timeout;
34640c3eb48dSMatthias Ringwald }
34650c3eb48dSMatthias Ringwald 
346676f27cffSMatthias Ringwald void hci_disable_l2cap_timeout_check(void){
346776f27cffSMatthias Ringwald     disable_l2cap_timeouts = 1;
346876f27cffSMatthias Ringwald }
346935454696SMatthias Ringwald #endif
34709e61646fS[email protected] 
347176f27cffSMatthias Ringwald #if !defined(HAVE_PLATFORM_IPHONE_OS) && !defined (HAVE_HOST_CONTROLLER_API)
3472f456b2d0S[email protected] // Set Public BD ADDR - passed on to Bluetooth chipset if supported in bt_control_h
3473f456b2d0S[email protected] void hci_set_bd_addr(bd_addr_t addr){
34746535961aSMatthias Ringwald     (void)memcpy(hci_stack->custom_bd_addr, addr, 6);
3475f456b2d0S[email protected]     hci_stack->custom_bd_addr_set = 1;
3476f456b2d0S[email protected] }
347776f27cffSMatthias Ringwald #endif
3478f456b2d0S[email protected] 
34798d213e1aSmatthias.ringwald // State-Module-Driver overview
34808d213e1aSmatthias.ringwald // state                    module  low-level
34818d213e1aSmatthias.ringwald // HCI_STATE_OFF             off      close
34828d213e1aSmatthias.ringwald // HCI_STATE_INITIALIZING,   on       open
34838d213e1aSmatthias.ringwald // HCI_STATE_WORKING,        on       open
34848d213e1aSmatthias.ringwald // HCI_STATE_HALTING,        on       open
3485d661ed19Smatthias.ringwald // HCI_STATE_SLEEPING,    off/sleep   close
3486d661ed19Smatthias.ringwald // HCI_STATE_FALLING_ASLEEP  on       open
3487c7e0c5f6Smatthias.ringwald 
348840d1c7a4Smatthias.ringwald static int hci_power_control_on(void){
34897301ad89Smatthias.ringwald 
3490038bc64cSmatthias.ringwald     // power on
3491f9a30166Smatthias.ringwald     int err = 0;
34923a9fb326S[email protected]     if (hci_stack->control && hci_stack->control->on){
3493d0b87befSMatthias Ringwald         err = (*hci_stack->control->on)();
3494f9a30166Smatthias.ringwald     }
3495038bc64cSmatthias.ringwald     if (err){
34969da54300S[email protected]         log_error( "POWER_ON failed");
3497038bc64cSmatthias.ringwald         hci_emit_hci_open_failed();
3498038bc64cSmatthias.ringwald         return err;
3499038bc64cSmatthias.ringwald     }
3500038bc64cSmatthias.ringwald 
350124b3c629SMatthias Ringwald     // int chipset driver
35023fb36a29SMatthias Ringwald     if (hci_stack->chipset && hci_stack->chipset->init){
35033fb36a29SMatthias Ringwald         hci_stack->chipset->init(hci_stack->config);
35043fb36a29SMatthias Ringwald     }
35053fb36a29SMatthias Ringwald 
350624b3c629SMatthias Ringwald     // init transport
350724b3c629SMatthias Ringwald     if (hci_stack->hci_transport->init){
350824b3c629SMatthias Ringwald         hci_stack->hci_transport->init(hci_stack->config);
350924b3c629SMatthias Ringwald     }
351024b3c629SMatthias Ringwald 
351124b3c629SMatthias Ringwald     // open transport
351224b3c629SMatthias Ringwald     err = hci_stack->hci_transport->open();
3513038bc64cSmatthias.ringwald     if (err){
35149da54300S[email protected]         log_error( "HCI_INIT failed, turning Bluetooth off again");
35153a9fb326S[email protected]         if (hci_stack->control && hci_stack->control->off){
3516d0b87befSMatthias Ringwald             (*hci_stack->control->off)();
3517f9a30166Smatthias.ringwald         }
3518038bc64cSmatthias.ringwald         hci_emit_hci_open_failed();
3519038bc64cSmatthias.ringwald         return err;
3520038bc64cSmatthias.ringwald     }
35218d213e1aSmatthias.ringwald     return 0;
35228d213e1aSmatthias.ringwald }
3523038bc64cSmatthias.ringwald 
352440d1c7a4Smatthias.ringwald static void hci_power_control_off(void){
35258d213e1aSmatthias.ringwald 
35269da54300S[email protected]     log_info("hci_power_control_off");
35279418f9c9Smatthias.ringwald 
35288d213e1aSmatthias.ringwald     // close low-level device
352924b3c629SMatthias Ringwald     hci_stack->hci_transport->close();
35308d213e1aSmatthias.ringwald 
35319da54300S[email protected]     log_info("hci_power_control_off - hci_transport closed");
35329418f9c9Smatthias.ringwald 
35338d213e1aSmatthias.ringwald     // power off
35343a9fb326S[email protected]     if (hci_stack->control && hci_stack->control->off){
3535d0b87befSMatthias Ringwald         (*hci_stack->control->off)();
35368d213e1aSmatthias.ringwald     }
35379418f9c9Smatthias.ringwald 
35389da54300S[email protected]     log_info("hci_power_control_off - control closed");
35399418f9c9Smatthias.ringwald 
35403a9fb326S[email protected]     hci_stack->state = HCI_STATE_OFF;
354172ea5239Smatthias.ringwald }
354272ea5239Smatthias.ringwald 
354340d1c7a4Smatthias.ringwald static void hci_power_control_sleep(void){
354472ea5239Smatthias.ringwald 
35459da54300S[email protected]     log_info("hci_power_control_sleep");
35463144bce4Smatthias.ringwald 
3547b429b9b7Smatthias.ringwald #if 0
3548b429b9b7Smatthias.ringwald     // don't close serial port during sleep
3549b429b9b7Smatthias.ringwald 
355072ea5239Smatthias.ringwald     // close low-level device
35513a9fb326S[email protected]     hci_stack->hci_transport->close(hci_stack->config);
3552b429b9b7Smatthias.ringwald #endif
355372ea5239Smatthias.ringwald 
355472ea5239Smatthias.ringwald     // sleep mode
35553a9fb326S[email protected]     if (hci_stack->control && hci_stack->control->sleep){
3556d0b87befSMatthias Ringwald         (*hci_stack->control->sleep)();
355772ea5239Smatthias.ringwald     }
3558b429b9b7Smatthias.ringwald 
35593a9fb326S[email protected]     hci_stack->state = HCI_STATE_SLEEPING;
35608d213e1aSmatthias.ringwald }
35618d213e1aSmatthias.ringwald 
356240d1c7a4Smatthias.ringwald static int hci_power_control_wake(void){
3563b429b9b7Smatthias.ringwald 
35649da54300S[email protected]     log_info("hci_power_control_wake");
3565b429b9b7Smatthias.ringwald 
3566b429b9b7Smatthias.ringwald     // wake on
35673a9fb326S[email protected]     if (hci_stack->control && hci_stack->control->wake){
3568d0b87befSMatthias Ringwald         (*hci_stack->control->wake)();
3569b429b9b7Smatthias.ringwald     }
3570b429b9b7Smatthias.ringwald 
3571b429b9b7Smatthias.ringwald #if 0
3572b429b9b7Smatthias.ringwald     // open low-level device
35733a9fb326S[email protected]     int err = hci_stack->hci_transport->open(hci_stack->config);
3574b429b9b7Smatthias.ringwald     if (err){
35759da54300S[email protected]         log_error( "HCI_INIT failed, turning Bluetooth off again");
35763a9fb326S[email protected]         if (hci_stack->control && hci_stack->control->off){
3577d0b87befSMatthias Ringwald             (*hci_stack->control->off)();
3578b429b9b7Smatthias.ringwald         }
3579b429b9b7Smatthias.ringwald         hci_emit_hci_open_failed();
3580b429b9b7Smatthias.ringwald         return err;
3581b429b9b7Smatthias.ringwald     }
3582b429b9b7Smatthias.ringwald #endif
3583b429b9b7Smatthias.ringwald 
3584b429b9b7Smatthias.ringwald     return 0;
3585b429b9b7Smatthias.ringwald }
3586b429b9b7Smatthias.ringwald 
358744935e40S[email protected] static void hci_power_transition_to_initializing(void){
358844935e40S[email protected]     // set up state machine
358944935e40S[email protected]     hci_stack->num_cmd_packets = 1; // assume that one cmd can be sent
359044935e40S[email protected]     hci_stack->hci_packet_buffer_reserved = 0;
359144935e40S[email protected]     hci_stack->state = HCI_STATE_INITIALIZING;
35925c363727SMatthias Ringwald     hci_stack->substate = HCI_INIT_SEND_RESET;
359344935e40S[email protected] }
3594b429b9b7Smatthias.ringwald 
359542bd3d77SMatthias Ringwald // returns error
359642bd3d77SMatthias Ringwald static int hci_power_control_state_off(HCI_POWER_MODE power_mode){
359742bd3d77SMatthias Ringwald     int err;
35988d213e1aSmatthias.ringwald     switch (power_mode){
35998d213e1aSmatthias.ringwald         case HCI_POWER_ON:
36008d213e1aSmatthias.ringwald             err = hci_power_control_on();
360142bd3d77SMatthias Ringwald             if (err != 0) {
3602f04a0c31SMatthias Ringwald                 log_error("hci_power_control_on() error %d", err);
360397b61c7bS[email protected]                 return err;
360497b61c7bS[email protected]             }
360544935e40S[email protected]             hci_power_transition_to_initializing();
36068d213e1aSmatthias.ringwald             break;
36078d213e1aSmatthias.ringwald         case HCI_POWER_OFF:
36088d213e1aSmatthias.ringwald             // do nothing
36098d213e1aSmatthias.ringwald             break;
36108d213e1aSmatthias.ringwald         case HCI_POWER_SLEEP:
3611b546ac54Smatthias.ringwald             // do nothing (with SLEEP == OFF)
36128d213e1aSmatthias.ringwald             break;
36137bbeb3adSMilanka Ringwald         default:
36147bbeb3adSMilanka Ringwald             btstack_assert(false);
36157bbeb3adSMilanka Ringwald             break;
36168d213e1aSmatthias.ringwald     }
361742bd3d77SMatthias Ringwald     return ERROR_CODE_SUCCESS;
361842bd3d77SMatthias Ringwald }
36197301ad89Smatthias.ringwald 
362042bd3d77SMatthias Ringwald static int hci_power_control_state_initializing(HCI_POWER_MODE power_mode){
36218d213e1aSmatthias.ringwald     switch (power_mode){
36228d213e1aSmatthias.ringwald         case HCI_POWER_ON:
36238d213e1aSmatthias.ringwald             // do nothing
36248d213e1aSmatthias.ringwald             break;
36258d213e1aSmatthias.ringwald         case HCI_POWER_OFF:
36268d213e1aSmatthias.ringwald             // no connections yet, just turn it off
36278d213e1aSmatthias.ringwald             hci_power_control_off();
36288d213e1aSmatthias.ringwald             break;
36298d213e1aSmatthias.ringwald         case HCI_POWER_SLEEP:
3630b546ac54Smatthias.ringwald             // no connections yet, just turn it off
363172ea5239Smatthias.ringwald             hci_power_control_sleep();
36328d213e1aSmatthias.ringwald             break;
36337bbeb3adSMilanka Ringwald         default:
36347bbeb3adSMilanka Ringwald             btstack_assert(false);
36357bbeb3adSMilanka Ringwald             break;
36368d213e1aSmatthias.ringwald     }
363742bd3d77SMatthias Ringwald     return ERROR_CODE_SUCCESS;
363842bd3d77SMatthias Ringwald }
36397301ad89Smatthias.ringwald 
364042bd3d77SMatthias Ringwald static int hci_power_control_state_working(HCI_POWER_MODE power_mode) {
36418d213e1aSmatthias.ringwald     switch (power_mode){
36428d213e1aSmatthias.ringwald         case HCI_POWER_ON:
36438d213e1aSmatthias.ringwald             // do nothing
36448d213e1aSmatthias.ringwald             break;
36458d213e1aSmatthias.ringwald         case HCI_POWER_OFF:
3646c7e0c5f6Smatthias.ringwald             // see hci_run
36473a9fb326S[email protected]             hci_stack->state = HCI_STATE_HALTING;
3648beceeddeSMatthias Ringwald             hci_stack->substate = HCI_HALTING_DISCONNECT_ALL_NO_TIMER;
36498d213e1aSmatthias.ringwald             break;
36508d213e1aSmatthias.ringwald         case HCI_POWER_SLEEP:
3651b546ac54Smatthias.ringwald             // see hci_run
36523a9fb326S[email protected]             hci_stack->state = HCI_STATE_FALLING_ASLEEP;
365374b323a9SMatthias Ringwald             hci_stack->substate = HCI_FALLING_ASLEEP_DISCONNECT;
36548d213e1aSmatthias.ringwald             break;
36557bbeb3adSMilanka Ringwald         default:
36567bbeb3adSMilanka Ringwald             btstack_assert(false);
36577bbeb3adSMilanka Ringwald             break;
36588d213e1aSmatthias.ringwald     }
365942bd3d77SMatthias Ringwald     return ERROR_CODE_SUCCESS;
366042bd3d77SMatthias Ringwald }
36617301ad89Smatthias.ringwald 
366242bd3d77SMatthias Ringwald static int hci_power_control_state_halting(HCI_POWER_MODE power_mode) {
36638d213e1aSmatthias.ringwald     switch (power_mode){
36648d213e1aSmatthias.ringwald         case HCI_POWER_ON:
366544935e40S[email protected]             hci_power_transition_to_initializing();
36668d213e1aSmatthias.ringwald             break;
36678d213e1aSmatthias.ringwald         case HCI_POWER_OFF:
36688d213e1aSmatthias.ringwald             // do nothing
36698d213e1aSmatthias.ringwald             break;
36708d213e1aSmatthias.ringwald         case HCI_POWER_SLEEP:
3671b546ac54Smatthias.ringwald             // see hci_run
36723a9fb326S[email protected]             hci_stack->state = HCI_STATE_FALLING_ASLEEP;
367374b323a9SMatthias Ringwald             hci_stack->substate = HCI_FALLING_ASLEEP_DISCONNECT;
36748d213e1aSmatthias.ringwald             break;
36757bbeb3adSMilanka Ringwald         default:
36767bbeb3adSMilanka Ringwald             btstack_assert(false);
36777bbeb3adSMilanka Ringwald             break;
36788d213e1aSmatthias.ringwald     }
367900278272SMatthias Ringwald     return ERROR_CODE_SUCCESS;
368042bd3d77SMatthias Ringwald }
36818d213e1aSmatthias.ringwald 
368242bd3d77SMatthias Ringwald static int hci_power_control_state_falling_asleep(HCI_POWER_MODE power_mode) {
36838d213e1aSmatthias.ringwald     switch (power_mode){
36848d213e1aSmatthias.ringwald         case HCI_POWER_ON:
368528171530Smatthias.ringwald 
3686423a3e49SMatthias Ringwald #ifdef HAVE_PLATFORM_IPHONE_OS
368728171530Smatthias.ringwald             // nothing to do, if H4 supports power management
3688d0b87befSMatthias Ringwald                     if (btstack_control_iphone_power_management_enabled()){
36893a9fb326S[email protected]                         hci_stack->state = HCI_STATE_INITIALIZING;
369074b323a9SMatthias Ringwald                         hci_stack->substate = HCI_INIT_WRITE_SCAN_ENABLE;   // init after sleep
369128171530Smatthias.ringwald                         break;
369228171530Smatthias.ringwald                     }
369328171530Smatthias.ringwald #endif
369444935e40S[email protected]             hci_power_transition_to_initializing();
36958d213e1aSmatthias.ringwald             break;
36968d213e1aSmatthias.ringwald         case HCI_POWER_OFF:
3697b546ac54Smatthias.ringwald             // see hci_run
36983a9fb326S[email protected]             hci_stack->state = HCI_STATE_HALTING;
3699beceeddeSMatthias Ringwald             hci_stack->substate = HCI_HALTING_DISCONNECT_ALL_NO_TIMER;
37008d213e1aSmatthias.ringwald             break;
37018d213e1aSmatthias.ringwald         case HCI_POWER_SLEEP:
3702b546ac54Smatthias.ringwald             // do nothing
37038d213e1aSmatthias.ringwald             break;
37047bbeb3adSMilanka Ringwald         default:
37057bbeb3adSMilanka Ringwald             btstack_assert(false);
37067bbeb3adSMilanka Ringwald             break;
37078d213e1aSmatthias.ringwald     }
370842bd3d77SMatthias Ringwald     return ERROR_CODE_SUCCESS;
370942bd3d77SMatthias Ringwald }
37108d213e1aSmatthias.ringwald 
371142bd3d77SMatthias Ringwald static int hci_power_control_state_sleeping(HCI_POWER_MODE power_mode) {
371242bd3d77SMatthias Ringwald     int err;
37138d213e1aSmatthias.ringwald     switch (power_mode){
37148d213e1aSmatthias.ringwald         case HCI_POWER_ON:
3715423a3e49SMatthias Ringwald #ifdef HAVE_PLATFORM_IPHONE_OS
371628171530Smatthias.ringwald             // nothing to do, if H4 supports power management
3717d0b87befSMatthias Ringwald                     if (btstack_control_iphone_power_management_enabled()){
37183a9fb326S[email protected]                         hci_stack->state = HCI_STATE_INITIALIZING;
37195c363727SMatthias Ringwald                         hci_stack->substate = HCI_INIT_AFTER_SLEEP;
3720758b46ceSmatthias.ringwald                         hci_update_scan_enable();
372128171530Smatthias.ringwald                         break;
372228171530Smatthias.ringwald                     }
372328171530Smatthias.ringwald #endif
37243144bce4Smatthias.ringwald             err = hci_power_control_wake();
37253144bce4Smatthias.ringwald             if (err) return err;
372644935e40S[email protected]             hci_power_transition_to_initializing();
37278d213e1aSmatthias.ringwald             break;
37288d213e1aSmatthias.ringwald         case HCI_POWER_OFF:
37293a9fb326S[email protected]             hci_stack->state = HCI_STATE_HALTING;
3730beceeddeSMatthias Ringwald             hci_stack->substate = HCI_HALTING_DISCONNECT_ALL_NO_TIMER;
37318d213e1aSmatthias.ringwald             break;
37328d213e1aSmatthias.ringwald         case HCI_POWER_SLEEP:
3733b546ac54Smatthias.ringwald             // do nothing
37348d213e1aSmatthias.ringwald             break;
37357bbeb3adSMilanka Ringwald         default:
37367bbeb3adSMilanka Ringwald             btstack_assert(false);
37377bbeb3adSMilanka Ringwald             break;
37388d213e1aSmatthias.ringwald     }
373942bd3d77SMatthias Ringwald     return ERROR_CODE_SUCCESS;
374042bd3d77SMatthias Ringwald }
37417bbeb3adSMilanka Ringwald 
374242bd3d77SMatthias Ringwald int hci_power_control(HCI_POWER_MODE power_mode){
374342bd3d77SMatthias Ringwald     log_info("hci_power_control: %d, current mode %u", power_mode, hci_stack->state);
374424f87726SMatthias Ringwald     int err = 0;
374542bd3d77SMatthias Ringwald     switch (hci_stack->state){
374642bd3d77SMatthias Ringwald         case HCI_STATE_OFF:
374742bd3d77SMatthias Ringwald             err = hci_power_control_state_off(power_mode);
374842bd3d77SMatthias Ringwald             break;
374942bd3d77SMatthias Ringwald         case HCI_STATE_INITIALIZING:
375042bd3d77SMatthias Ringwald             err = hci_power_control_state_initializing(power_mode);
375142bd3d77SMatthias Ringwald             break;
375242bd3d77SMatthias Ringwald         case HCI_STATE_WORKING:
375342bd3d77SMatthias Ringwald             err = hci_power_control_state_working(power_mode);
375442bd3d77SMatthias Ringwald             break;
375542bd3d77SMatthias Ringwald         case HCI_STATE_HALTING:
375642bd3d77SMatthias Ringwald             err = hci_power_control_state_halting(power_mode);
375742bd3d77SMatthias Ringwald             break;
375842bd3d77SMatthias Ringwald         case HCI_STATE_FALLING_ASLEEP:
375942bd3d77SMatthias Ringwald             err = hci_power_control_state_falling_asleep(power_mode);
376042bd3d77SMatthias Ringwald             break;
376142bd3d77SMatthias Ringwald         case HCI_STATE_SLEEPING:
376242bd3d77SMatthias Ringwald             err = hci_power_control_state_sleeping(power_mode);
376342bd3d77SMatthias Ringwald             break;
37647bbeb3adSMilanka Ringwald         default:
37657bbeb3adSMilanka Ringwald             btstack_assert(false);
37667bbeb3adSMilanka Ringwald             break;
376711e23e5fSmatthias.ringwald     }
376824f87726SMatthias Ringwald     if (err != 0){
376942bd3d77SMatthias Ringwald         return err;
377042bd3d77SMatthias Ringwald     }
377168d92d03Smatthias.ringwald 
3772038bc64cSmatthias.ringwald     // create internal event
3773ee8bf225Smatthias.ringwald 	hci_emit_state();
3774ee8bf225Smatthias.ringwald 
377568d92d03Smatthias.ringwald 	// trigger next/first action
377668d92d03Smatthias.ringwald 	hci_run();
377768d92d03Smatthias.ringwald 
3778475c8125Smatthias.ringwald     return 0;
3779475c8125Smatthias.ringwald }
3780475c8125Smatthias.ringwald 
378135454696SMatthias Ringwald 
378235454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
378335454696SMatthias Ringwald 
3784758b46ceSmatthias.ringwald static void hci_update_scan_enable(void){
3785758b46ceSmatthias.ringwald     // 2 = page scan, 1 = inq scan
3786a1df452eSMatthias Ringwald     hci_stack->new_scan_enable_value  = (hci_stack->connectable << 1) | hci_stack->discoverable;
3787758b46ceSmatthias.ringwald     hci_run();
3788758b46ceSmatthias.ringwald }
3789758b46ceSmatthias.ringwald 
379015a95bd5SMatthias Ringwald void gap_discoverable_control(uint8_t enable){
3791381fbed8Smatthias.ringwald     if (enable) enable = 1; // normalize argument
3792381fbed8Smatthias.ringwald 
37933a9fb326S[email protected]     if (hci_stack->discoverable == enable){
37943a9fb326S[email protected]         hci_emit_discoverable_enabled(hci_stack->discoverable);
3795381fbed8Smatthias.ringwald         return;
3796381fbed8Smatthias.ringwald     }
3797381fbed8Smatthias.ringwald 
37983a9fb326S[email protected]     hci_stack->discoverable = enable;
3799758b46ceSmatthias.ringwald     hci_update_scan_enable();
3800758b46ceSmatthias.ringwald }
3801b031bebbSmatthias.ringwald 
380215a95bd5SMatthias Ringwald void gap_connectable_control(uint8_t enable){
3803758b46ceSmatthias.ringwald     if (enable) enable = 1; // normalize argument
3804758b46ceSmatthias.ringwald 
3805758b46ceSmatthias.ringwald     // don't emit event
38063a9fb326S[email protected]     if (hci_stack->connectable == enable) return;
3807758b46ceSmatthias.ringwald 
38083a9fb326S[email protected]     hci_stack->connectable = enable;
3809758b46ceSmatthias.ringwald     hci_update_scan_enable();
3810381fbed8Smatthias.ringwald }
381135454696SMatthias Ringwald #endif
3812381fbed8Smatthias.ringwald 
381315a95bd5SMatthias Ringwald void gap_local_bd_addr(bd_addr_t address_buffer){
38146535961aSMatthias Ringwald     (void)memcpy(address_buffer, hci_stack->local_bd_addr, 6);
38155061f3afS[email protected] }
38165061f3afS[email protected] 
38172b838201SMatthias Ringwald #ifdef ENABLE_HCI_CONTROLLER_TO_HOST_FLOW_CONTROL
38182b838201SMatthias Ringwald static void hci_host_num_completed_packets(void){
38192b838201SMatthias Ringwald 
38202b838201SMatthias Ringwald     // create packet manually as arrays are not supported and num_commands should not get reduced
38212b838201SMatthias Ringwald     hci_reserve_packet_buffer();
38222b838201SMatthias Ringwald     uint8_t * packet = hci_get_outgoing_packet_buffer();
38232b838201SMatthias Ringwald 
38242b838201SMatthias Ringwald     uint16_t size = 0;
38252b838201SMatthias Ringwald     uint16_t num_handles = 0;
38262b838201SMatthias Ringwald     packet[size++] = 0x35;
38272b838201SMatthias Ringwald     packet[size++] = 0x0c;
38282b838201SMatthias Ringwald     size++;  // skip param len
38292b838201SMatthias Ringwald     size++;  // skip num handles
38302b838201SMatthias Ringwald 
38312b838201SMatthias Ringwald     // add { handle, packets } entries
38322b838201SMatthias Ringwald     btstack_linked_item_t * it;
38332b838201SMatthias Ringwald     for (it = (btstack_linked_item_t *) hci_stack->connections; it ; it = it->next){
38342b838201SMatthias Ringwald         hci_connection_t * connection = (hci_connection_t *) it;
38352b838201SMatthias Ringwald         if (connection->num_packets_completed){
38362b838201SMatthias Ringwald             little_endian_store_16(packet, size, connection->con_handle);
38372b838201SMatthias Ringwald             size += 2;
38382b838201SMatthias Ringwald             little_endian_store_16(packet, size, connection->num_packets_completed);
38392b838201SMatthias Ringwald             size += 2;
38402b838201SMatthias Ringwald             //
38412b838201SMatthias Ringwald             num_handles++;
38422b838201SMatthias Ringwald             connection->num_packets_completed = 0;
38432b838201SMatthias Ringwald         }
38442b838201SMatthias Ringwald     }
38452b838201SMatthias Ringwald 
38462b838201SMatthias Ringwald     packet[2] = size - 3;
38472b838201SMatthias Ringwald     packet[3] = num_handles;
38482b838201SMatthias Ringwald 
38492b838201SMatthias Ringwald     hci_stack->host_completed_packets = 0;
38502b838201SMatthias Ringwald 
38512b838201SMatthias Ringwald     hci_dump_packet(HCI_COMMAND_DATA_PACKET, 0, packet, size);
38522b838201SMatthias Ringwald     hci_stack->hci_transport->send_packet(HCI_COMMAND_DATA_PACKET, packet, size);
38532b838201SMatthias Ringwald 
38542b838201SMatthias Ringwald     // release packet buffer for synchronous transport implementations
38552b838201SMatthias Ringwald     if (hci_transport_synchronous()){
3856e2d22487SMatthias Ringwald         hci_release_packet_buffer();
3857068b8592SMatthias Ringwald         hci_emit_transport_packet_sent();
38582b838201SMatthias Ringwald     }
38592b838201SMatthias Ringwald }
38602b838201SMatthias Ringwald #endif
38612b838201SMatthias Ringwald 
386226fe9592SMatthias Ringwald static void hci_halting_timeout_handler(btstack_timer_source_t * ds){
386326fe9592SMatthias Ringwald     UNUSED(ds);
386426fe9592SMatthias Ringwald     hci_stack->substate = HCI_HALTING_CLOSE;
3865beceeddeSMatthias Ringwald     // allow packet handlers to defer final shutdown
3866beceeddeSMatthias Ringwald     hci_emit_state();
386726fe9592SMatthias Ringwald     hci_run();
386826fe9592SMatthias Ringwald }
386926fe9592SMatthias Ringwald 
3870f30077b7SMatthias Ringwald static bool hci_run_acl_fragments(void){
38714ea43905SMatthias Ringwald     if (hci_stack->acl_fragmentation_total_size > 0u) {
3872b5d8b22bS[email protected]         hci_con_handle_t con_handle = READ_ACL_CONNECTION_HANDLE(hci_stack->hci_packet_buffer);
3873b5d8b22bS[email protected]         hci_connection_t *connection = hci_connection_for_handle(con_handle);
3874b5d8b22bS[email protected]         if (connection) {
387528a0332dSMatthias Ringwald             if (hci_can_send_prepared_acl_packet_now(con_handle)){
3876b5d8b22bS[email protected]                 hci_send_acl_packet_fragments(connection);
3877f30077b7SMatthias Ringwald                 return true;
3878b5d8b22bS[email protected]             }
387928a0332dSMatthias Ringwald         } else {
3880b5d8b22bS[email protected]             // connection gone -> discard further fragments
388128a0332dSMatthias Ringwald             log_info("hci_run: fragmented ACL packet no connection -> discard fragment");
3882b5d8b22bS[email protected]             hci_stack->acl_fragmentation_total_size = 0;
3883b5d8b22bS[email protected]             hci_stack->acl_fragmentation_pos = 0;
3884b5d8b22bS[email protected]         }
3885b5d8b22bS[email protected]     }
3886f30077b7SMatthias Ringwald     return false;
38872b838201SMatthias Ringwald }
3888b031bebbSmatthias.ringwald 
388935454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
3890f30077b7SMatthias Ringwald static bool hci_run_general_gap_classic(void){
3891f30077b7SMatthias Ringwald 
3892b031bebbSmatthias.ringwald     // decline incoming connections
38933a9fb326S[email protected]     if (hci_stack->decline_reason){
38943a9fb326S[email protected]         uint8_t reason = hci_stack->decline_reason;
38953a9fb326S[email protected]         hci_stack->decline_reason = 0;
38963a9fb326S[email protected]         hci_send_cmd(&hci_reject_connection_request, hci_stack->decline_addr, reason);
3897f30077b7SMatthias Ringwald         return true;
3898ce4c8fabSmatthias.ringwald     }
3899bea424a5SMatthias Ringwald     // write page scan activity
3900bea424a5SMatthias Ringwald     if ((hci_stack->state == HCI_STATE_WORKING) && (hci_stack->new_page_scan_interval != 0xffff) && hci_classic_supported()){
3901bea424a5SMatthias Ringwald         hci_send_cmd(&hci_write_page_scan_activity, hci_stack->new_page_scan_interval, hci_stack->new_page_scan_window);
3902bea424a5SMatthias Ringwald         hci_stack->new_page_scan_interval = 0xffff;
3903bea424a5SMatthias Ringwald         hci_stack->new_page_scan_window = 0xffff;
3904bea424a5SMatthias Ringwald         return true;
3905bea424a5SMatthias Ringwald     }
3906bea424a5SMatthias Ringwald     // write page scan type
3907bea424a5SMatthias Ringwald     if ((hci_stack->state == HCI_STATE_WORKING) && (hci_stack->new_page_scan_type != 0xff) && hci_classic_supported()){
3908bea424a5SMatthias Ringwald         hci_send_cmd(&hci_write_page_scan_type, hci_stack->new_page_scan_type);
3909bea424a5SMatthias Ringwald         hci_stack->new_page_scan_type = 0xff;
3910bea424a5SMatthias Ringwald         return true;
3911bea424a5SMatthias Ringwald     }
3912b031bebbSmatthias.ringwald     // send scan enable
39130e588213SMatthias Ringwald     if ((hci_stack->state == HCI_STATE_WORKING) && (hci_stack->new_scan_enable_value != 0xff) && hci_classic_supported()){
39143a9fb326S[email protected]         hci_send_cmd(&hci_write_scan_enable, hci_stack->new_scan_enable_value);
39153a9fb326S[email protected]         hci_stack->new_scan_enable_value = 0xff;
3916f30077b7SMatthias Ringwald         return true;
3917b031bebbSmatthias.ringwald     }
3918f5875de5SMatthias Ringwald     // start/stop inquiry
3919a1df452eSMatthias Ringwald     if ((hci_stack->inquiry_state >= GAP_INQUIRY_DURATION_MIN) && (hci_stack->inquiry_state <= GAP_INQUIRY_DURATION_MAX)){
3920f5875de5SMatthias Ringwald         uint8_t duration = hci_stack->inquiry_state;
3921beb3c81dSMatthias Ringwald         hci_stack->inquiry_state = GAP_INQUIRY_STATE_W4_ACTIVE;
3922496bb884SMatthias Ringwald         hci_send_cmd(&hci_inquiry, hci_stack->inquiry_lap, duration, 0);
3923f30077b7SMatthias Ringwald         return true;
3924f5875de5SMatthias Ringwald     }
3925f5875de5SMatthias Ringwald     if (hci_stack->inquiry_state == GAP_INQUIRY_STATE_W2_CANCEL){
3926f5875de5SMatthias Ringwald         hci_stack->inquiry_state = GAP_INQUIRY_STATE_W4_CANCELLED;
3927f5875de5SMatthias Ringwald         hci_send_cmd(&hci_inquiry_cancel);
3928f30077b7SMatthias Ringwald         return true;
3929f5875de5SMatthias Ringwald     }
3930b7f1ee76SMatthias Ringwald     // remote name request
3931b7f1ee76SMatthias Ringwald     if (hci_stack->remote_name_state == GAP_REMOTE_NAME_STATE_W2_SEND){
3932b7f1ee76SMatthias Ringwald         hci_stack->remote_name_state = GAP_REMOTE_NAME_STATE_W4_COMPLETE;
3933b7f1ee76SMatthias Ringwald         hci_send_cmd(&hci_remote_name_request, hci_stack->remote_name_addr,
3934ee8a36c8SMatthias Ringwald                      hci_stack->remote_name_page_scan_repetition_mode, 0, hci_stack->remote_name_clock_offset);
3935f30077b7SMatthias Ringwald         return true;
3936b7f1ee76SMatthias Ringwald     }
3937cf01e888SMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB
3938cf01e888SMatthias Ringwald     // Local OOB data
3939cf01e888SMatthias Ringwald     if ((hci_stack->state == HCI_STATE_WORKING) && hci_stack->classic_read_local_oob_data){
3940cf01e888SMatthias Ringwald         hci_stack->classic_read_local_oob_data = false;
3941cf01e888SMatthias Ringwald         if (hci_stack->local_supported_commands[1] & 0x10u){
3942cf01e888SMatthias Ringwald             hci_send_cmd(&hci_read_local_extended_oob_data);
3943cf01e888SMatthias Ringwald         } else {
3944cf01e888SMatthias Ringwald             hci_send_cmd(&hci_read_local_oob_data);
3945cf01e888SMatthias Ringwald         }
3946cf01e888SMatthias Ringwald     }
3947cf01e888SMatthias Ringwald #endif
39480a51f88bSMatthias Ringwald     // pairing
39490a51f88bSMatthias Ringwald     if (hci_stack->gap_pairing_state != GAP_PAIRING_STATE_IDLE){
39500a51f88bSMatthias Ringwald         uint8_t state = hci_stack->gap_pairing_state;
39510a51f88bSMatthias Ringwald         hci_stack->gap_pairing_state = GAP_PAIRING_STATE_IDLE;
39523f659ee4SMilanka Ringwald         uint8_t pin_code[16];
39530a51f88bSMatthias Ringwald         switch (state){
39540a51f88bSMatthias Ringwald             case GAP_PAIRING_STATE_SEND_PIN:
39553f659ee4SMilanka Ringwald                 memset(pin_code, 0, 16);
39563f659ee4SMilanka Ringwald                 memcpy(pin_code, hci_stack->gap_pairing_input.gap_pairing_pin, hci_stack->gap_pairing_pin_len);
39573f659ee4SMilanka Ringwald                 hci_send_cmd(&hci_pin_code_request_reply, hci_stack->gap_pairing_addr, hci_stack->gap_pairing_pin_len, pin_code);
39580a51f88bSMatthias Ringwald                 break;
39590a51f88bSMatthias Ringwald             case GAP_PAIRING_STATE_SEND_PIN_NEGATIVE:
39600a51f88bSMatthias Ringwald                 hci_send_cmd(&hci_pin_code_request_negative_reply, hci_stack->gap_pairing_addr);
39610a51f88bSMatthias Ringwald                 break;
39620a51f88bSMatthias Ringwald             case GAP_PAIRING_STATE_SEND_PASSKEY:
3963d504181aSMatthias Ringwald                 hci_send_cmd(&hci_user_passkey_request_reply, hci_stack->gap_pairing_addr, hci_stack->gap_pairing_input.gap_pairing_passkey);
39640a51f88bSMatthias Ringwald                 break;
39650a51f88bSMatthias Ringwald             case GAP_PAIRING_STATE_SEND_PASSKEY_NEGATIVE:
39660a51f88bSMatthias Ringwald                 hci_send_cmd(&hci_user_passkey_request_negative_reply, hci_stack->gap_pairing_addr);
39670a51f88bSMatthias Ringwald                 break;
39680a51f88bSMatthias Ringwald             case GAP_PAIRING_STATE_SEND_CONFIRMATION:
39690a51f88bSMatthias Ringwald                 hci_send_cmd(&hci_user_confirmation_request_reply, hci_stack->gap_pairing_addr);
39700a51f88bSMatthias Ringwald                 break;
39710a51f88bSMatthias Ringwald             case GAP_PAIRING_STATE_SEND_CONFIRMATION_NEGATIVE:
39720a51f88bSMatthias Ringwald                 hci_send_cmd(&hci_user_confirmation_request_negative_reply, hci_stack->gap_pairing_addr);
39730a51f88bSMatthias Ringwald                 break;
39740a51f88bSMatthias Ringwald             default:
39750a51f88bSMatthias Ringwald                 break;
39760a51f88bSMatthias Ringwald         }
3977f30077b7SMatthias Ringwald         return true;
3978f30077b7SMatthias Ringwald     }
3979f30077b7SMatthias Ringwald     return false;
39800a51f88bSMatthias Ringwald }
398135454696SMatthias Ringwald #endif
3982b031bebbSmatthias.ringwald 
3983a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE
3984f30077b7SMatthias Ringwald static bool hci_run_general_gap_le(void){
3985f30077b7SMatthias Ringwald 
3986f30077b7SMatthias Ringwald     // advertisements, active scanning, and creating connections requires random address to be set if using private address
3987f30077b7SMatthias Ringwald 
3988f30077b7SMatthias Ringwald     if (hci_stack->state != HCI_STATE_WORKING) return false;
39894ea43905SMatthias Ringwald     if ( (hci_stack->le_own_addr_type != BD_ADDR_TYPE_LE_PUBLIC) && (hci_stack->le_random_address_set == 0u) ) return false;
3990d70217a2SMatthias Ringwald 
3991a41310b7SMatthias Ringwald 
3992a41310b7SMatthias Ringwald     // Phase 1: collect what to stop
3993a41310b7SMatthias Ringwald 
3994a41310b7SMatthias Ringwald     bool scanning_stop = false;
3995a41310b7SMatthias Ringwald     bool connecting_stop = false;
3996a41310b7SMatthias Ringwald     bool advertising_stop = false;
3997a41310b7SMatthias Ringwald 
3998a41310b7SMatthias Ringwald #ifndef ENABLE_LE_CENTRAL
3999a41310b7SMatthias Ringwald     UNUSED(scanning_stop);
40000abd9f64SMatthias Ringwald     UNUSED(connecting_stop);
4001a41310b7SMatthias Ringwald #endif
4002a41310b7SMatthias Ringwald #ifndef ENABLE_LE_PERIPHERAL
4003a41310b7SMatthias Ringwald     UNUSED(advertising_stop);
4004a41310b7SMatthias Ringwald #endif
4005a41310b7SMatthias Ringwald 
400629c24bebSMatthias Ringwald     // check if whitelist needs modification
400729c24bebSMatthias Ringwald     bool whitelist_modification_pending = false;
400829c24bebSMatthias Ringwald     btstack_linked_list_iterator_t lit;
400929c24bebSMatthias Ringwald     btstack_linked_list_iterator_init(&lit, &hci_stack->le_whitelist);
401029c24bebSMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&lit)){
401129c24bebSMatthias Ringwald         whitelist_entry_t * entry = (whitelist_entry_t*) btstack_linked_list_iterator_next(&lit);
401229c24bebSMatthias Ringwald         if (entry->state & (LE_WHITELIST_REMOVE_FROM_CONTROLLER | LE_WHITELIST_ADD_TO_CONTROLLER)){
401329c24bebSMatthias Ringwald             whitelist_modification_pending = true;
401429c24bebSMatthias Ringwald             break;
401529c24bebSMatthias Ringwald         }
401629c24bebSMatthias Ringwald     }
401721debf25SMatthias Ringwald     // check if resolving list needs modification
401821debf25SMatthias Ringwald     bool resolving_list_modification_pending = false;
401921debf25SMatthias Ringwald #ifdef ENABLE_LE_PRIVACY_ADDRESS_RESOLUTION
4020ea151974SMatthias Ringwald     bool resolving_list_supported = (hci_stack->local_supported_commands[1] & (1 << 2)) != 0;
4021ea151974SMatthias Ringwald 	if (resolving_list_supported && hci_stack->le_resolving_list_state != LE_RESOLVING_LIST_DONE){
402221debf25SMatthias Ringwald         resolving_list_modification_pending = true;
402321debf25SMatthias Ringwald     }
402421debf25SMatthias Ringwald #endif
402529c24bebSMatthias Ringwald 
4026d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
4027fde725feSMatthias Ringwald     // scanning control
40283251a108SMatthias Ringwald     if (hci_stack->le_scanning_active) {
402929c24bebSMatthias Ringwald         // stop if:
403029c24bebSMatthias Ringwald         // - parameter change required
403129c24bebSMatthias Ringwald         // - it's disabled
403229c24bebSMatthias Ringwald         // - whitelist change required but used for scanning
403321debf25SMatthias Ringwald         // - resolving list modified
403429c24bebSMatthias Ringwald         bool scanning_uses_whitelist = (hci_stack->le_scan_filter_policy & 1) == 1;
403521debf25SMatthias Ringwald         if ((hci_stack->le_scanning_param_update) ||
403621debf25SMatthias Ringwald             !hci_stack->le_scanning_enabled ||
403721debf25SMatthias Ringwald             scanning_uses_whitelist ||
403821debf25SMatthias Ringwald             resolving_list_modification_pending){
403921debf25SMatthias Ringwald 
40402d5c2a27SMatthias Ringwald             scanning_stop = true;
4041fde725feSMatthias Ringwald         }
4042fde725feSMatthias Ringwald     }
404329c24bebSMatthias Ringwald #endif
4044fde725feSMatthias Ringwald 
404529c24bebSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
404629c24bebSMatthias Ringwald     // connecting control
4047f496d06eSMatthias Ringwald     bool connecting_with_whitelist;
4048f496d06eSMatthias Ringwald     switch (hci_stack->le_connecting_state){
4049f496d06eSMatthias Ringwald         case LE_CONNECTING_DIRECT:
4050f496d06eSMatthias Ringwald         case LE_CONNECTING_WHITELIST:
4051af64f147SMatthias Ringwald             // stop connecting if:
4052af64f147SMatthias Ringwald             // - connecting uses white and whitelist modification pending
4053af64f147SMatthias Ringwald             // - if it got disabled
405421debf25SMatthias Ringwald             // - resolving list modified
4055f496d06eSMatthias Ringwald             connecting_with_whitelist = hci_stack->le_connecting_state == LE_CONNECTING_WHITELIST;
4056f496d06eSMatthias Ringwald             if ((connecting_with_whitelist && whitelist_modification_pending) ||
405721debf25SMatthias Ringwald                 (hci_stack->le_connecting_request == LE_CONNECTING_IDLE) ||
405821debf25SMatthias Ringwald                 resolving_list_modification_pending) {
405921debf25SMatthias Ringwald 
406029c24bebSMatthias Ringwald                 connecting_stop = true;
406129c24bebSMatthias Ringwald             }
4062f496d06eSMatthias Ringwald             break;
4063f496d06eSMatthias Ringwald         default:
4064f496d06eSMatthias Ringwald             break;
406529c24bebSMatthias Ringwald     }
4066d70217a2SMatthias Ringwald #endif
406729c24bebSMatthias Ringwald 
4068d70217a2SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
406945c102fdSMatthias Ringwald     // le advertisement control
4070bbc366e6SMatthias Ringwald     if (hci_stack->le_advertisements_active){
407129c24bebSMatthias Ringwald         // stop if:
407229c24bebSMatthias Ringwald         // - parameter change required
407329c24bebSMatthias Ringwald         // - it's disabled
4074ba44ad41SMatthias Ringwald         // - whitelist change required but used for advertisement filter policy
407521debf25SMatthias Ringwald         // - resolving list modified
4076a61834b6SMatthias Ringwald         bool advertising_uses_whitelist = hci_stack->le_advertisements_filter_policy != 0;
4077*4e5d21eaSMatthias Ringwald         bool advertising_change = (hci_stack->le_advertisements_todo & LE_ADVERTISEMENT_TASKS_SET_PARAMS) != 0;
4078a61834b6SMatthias Ringwald         if (advertising_change ||
4079a61834b6SMatthias Ringwald             (hci_stack->le_advertisements_enabled_for_current_roles == 0) ||
408021debf25SMatthias Ringwald             (advertising_uses_whitelist & whitelist_modification_pending) ||
408121debf25SMatthias Ringwald             resolving_list_modification_pending) {
408221debf25SMatthias Ringwald 
4083fde725feSMatthias Ringwald             advertising_stop = true;
4084fde725feSMatthias Ringwald         }
4085fde725feSMatthias Ringwald     }
4086a41310b7SMatthias Ringwald #endif
4087fde725feSMatthias Ringwald 
4088a41310b7SMatthias Ringwald 
4089a41310b7SMatthias Ringwald     // Phase 2: stop everything that should be off during modifications
4090a41310b7SMatthias Ringwald 
4091a41310b7SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
4092a41310b7SMatthias Ringwald     if (scanning_stop){
40935226d7f2SMatthias Ringwald         hci_stack->le_scanning_active = false;
4094a41310b7SMatthias Ringwald         hci_send_cmd(&hci_le_set_scan_enable, 0, 0);
4095a41310b7SMatthias Ringwald         return true;
4096a41310b7SMatthias Ringwald     }
4097a41310b7SMatthias Ringwald #endif
4098a41310b7SMatthias Ringwald 
4099a41310b7SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
4100a41310b7SMatthias Ringwald     if (connecting_stop){
4101a41310b7SMatthias Ringwald         hci_send_cmd(&hci_le_create_connection_cancel);
4102a41310b7SMatthias Ringwald         return true;
4103a41310b7SMatthias Ringwald     }
4104a41310b7SMatthias Ringwald #endif
4105a41310b7SMatthias Ringwald 
4106a41310b7SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
4107fde725feSMatthias Ringwald     if (advertising_stop){
41085226d7f2SMatthias Ringwald         hci_stack->le_advertisements_active = false;
410945c102fdSMatthias Ringwald         hci_send_cmd(&hci_le_set_advertise_enable, 0);
4110f30077b7SMatthias Ringwald         return true;
411145c102fdSMatthias Ringwald     }
4112a41310b7SMatthias Ringwald #endif
4113fde725feSMatthias Ringwald 
4114a41310b7SMatthias Ringwald     // Phase 3: modify
4115a41310b7SMatthias Ringwald 
4116a41310b7SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
4117a41310b7SMatthias Ringwald     if (hci_stack->le_scanning_param_update){
4118a41310b7SMatthias Ringwald         hci_stack->le_scanning_param_update = false;
4119a41310b7SMatthias Ringwald         hci_send_cmd(&hci_le_set_scan_parameters, hci_stack->le_scan_type, hci_stack->le_scan_interval, hci_stack->le_scan_window,
4120a41310b7SMatthias Ringwald                      hci_stack->le_own_addr_type, hci_stack->le_scan_filter_policy);
4121a41310b7SMatthias Ringwald         return true;
4122a41310b7SMatthias Ringwald     }
4123a41310b7SMatthias Ringwald #endif
4124a41310b7SMatthias Ringwald 
4125a41310b7SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
412645c102fdSMatthias Ringwald     if (hci_stack->le_advertisements_todo & LE_ADVERTISEMENT_TASKS_SET_PARAMS){
412745c102fdSMatthias Ringwald         hci_stack->le_advertisements_todo &= ~LE_ADVERTISEMENT_TASKS_SET_PARAMS;
41286bcfa632SMatthias Ringwald         hci_stack->le_advertisements_own_addr_type = hci_stack->le_own_addr_type;
412945c102fdSMatthias Ringwald         hci_send_cmd(&hci_le_set_advertising_parameters,
413045c102fdSMatthias Ringwald                      hci_stack->le_advertisements_interval_min,
413145c102fdSMatthias Ringwald                      hci_stack->le_advertisements_interval_max,
413245c102fdSMatthias Ringwald                      hci_stack->le_advertisements_type,
41336bcfa632SMatthias Ringwald                      hci_stack->le_advertisements_own_addr_type,
413445c102fdSMatthias Ringwald                      hci_stack->le_advertisements_direct_address_type,
413545c102fdSMatthias Ringwald                      hci_stack->le_advertisements_direct_address,
413645c102fdSMatthias Ringwald                      hci_stack->le_advertisements_channel_map,
413745c102fdSMatthias Ringwald                      hci_stack->le_advertisements_filter_policy);
4138f30077b7SMatthias Ringwald         return true;
413945c102fdSMatthias Ringwald     }
4140501f56b3SMatthias Ringwald     if (hci_stack->le_advertisements_todo & LE_ADVERTISEMENT_TASKS_SET_ADV_DATA){
4141501f56b3SMatthias Ringwald         hci_stack->le_advertisements_todo &= ~LE_ADVERTISEMENT_TASKS_SET_ADV_DATA;
41427a85e4f5SMatthias Ringwald         uint8_t adv_data_clean[31];
41437a85e4f5SMatthias Ringwald         memset(adv_data_clean, 0, sizeof(adv_data_clean));
41446535961aSMatthias Ringwald         (void)memcpy(adv_data_clean, hci_stack->le_advertisements_data,
41456535961aSMatthias Ringwald                      hci_stack->le_advertisements_data_len);
41463c9da642SMatthias Ringwald         btstack_replace_bd_addr_placeholder(adv_data_clean, hci_stack->le_advertisements_data_len, hci_stack->local_bd_addr);
41477a85e4f5SMatthias Ringwald         hci_send_cmd(&hci_le_set_advertising_data, hci_stack->le_advertisements_data_len, adv_data_clean);
4148f30077b7SMatthias Ringwald         return true;
414945c102fdSMatthias Ringwald     }
4150501f56b3SMatthias Ringwald     if (hci_stack->le_advertisements_todo & LE_ADVERTISEMENT_TASKS_SET_SCAN_DATA){
4151501f56b3SMatthias Ringwald         hci_stack->le_advertisements_todo &= ~LE_ADVERTISEMENT_TASKS_SET_SCAN_DATA;
4152f868b059SMatthias Ringwald         uint8_t scan_data_clean[31];
4153f868b059SMatthias Ringwald         memset(scan_data_clean, 0, sizeof(scan_data_clean));
41546535961aSMatthias Ringwald         (void)memcpy(scan_data_clean, hci_stack->le_scan_response_data,
41556535961aSMatthias Ringwald                      hci_stack->le_scan_response_data_len);
41563c9da642SMatthias Ringwald         btstack_replace_bd_addr_placeholder(scan_data_clean, hci_stack->le_scan_response_data_len, hci_stack->local_bd_addr);
4157214bfd60SMatthias Ringwald         hci_send_cmd(&hci_le_set_scan_response_data, hci_stack->le_scan_response_data_len, scan_data_clean);
4158f30077b7SMatthias Ringwald         return true;
4159501f56b3SMatthias Ringwald     }
4160d70217a2SMatthias Ringwald #endif
41619956955bSMatthias Ringwald 
416213eb2a2eSMatthias Ringwald 
4163057ab60cSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
4164a41310b7SMatthias Ringwald     // if connect with whitelist was active and is not cancelled yet, wait until next time
4165a41310b7SMatthias Ringwald     if (hci_stack->le_connecting_state == LE_CONNECTING_CANCEL) return false;
4166057ab60cSMatthias Ringwald #endif
4167057ab60cSMatthias Ringwald 
4168a41310b7SMatthias Ringwald     // LE Whitelist Management
4169a41310b7SMatthias Ringwald     if (whitelist_modification_pending){
41709956955bSMatthias Ringwald         // add/remove entries
4171665d90f2SMatthias Ringwald         btstack_linked_list_iterator_init(&lit, &hci_stack->le_whitelist);
4172665d90f2SMatthias Ringwald         while (btstack_linked_list_iterator_has_next(&lit)){
4173665d90f2SMatthias Ringwald             whitelist_entry_t * entry = (whitelist_entry_t*) btstack_linked_list_iterator_next(&lit);
4174453459ddSMatthias Ringwald 			if (entry->state & LE_WHITELIST_REMOVE_FROM_CONTROLLER){
4175453459ddSMatthias Ringwald 				entry->state &= ~LE_WHITELIST_REMOVE_FROM_CONTROLLER;
4176453459ddSMatthias Ringwald 				hci_send_cmd(&hci_le_remove_device_from_white_list, entry->address_type, entry->address);
4177453459ddSMatthias Ringwald 				return true;
4178453459ddSMatthias Ringwald 			}
41799956955bSMatthias Ringwald             if (entry->state & LE_WHITELIST_ADD_TO_CONTROLLER){
4180453459ddSMatthias Ringwald 				entry->state &= ~LE_WHITELIST_ADD_TO_CONTROLLER;
4181453459ddSMatthias Ringwald                 entry->state |= LE_WHITELIST_ON_CONTROLLER;
41829956955bSMatthias Ringwald                 hci_send_cmd(&hci_le_add_device_to_white_list, entry->address_type, entry->address);
4183f30077b7SMatthias Ringwald                 return true;
41849956955bSMatthias Ringwald             }
4185453459ddSMatthias Ringwald             if ((entry->state & LE_WHITELIST_ON_CONTROLLER) == 0){
4186665d90f2SMatthias Ringwald 				btstack_linked_list_remove(&hci_stack->le_whitelist, (btstack_linked_item_t *) entry);
41879956955bSMatthias Ringwald 				btstack_memory_whitelist_entry_free(entry);
41889956955bSMatthias Ringwald             }
41899956955bSMatthias Ringwald         }
419091915b0bSMatthias Ringwald     }
41919956955bSMatthias Ringwald 
419221debf25SMatthias Ringwald #ifdef ENABLE_LE_PRIVACY_ADDRESS_RESOLUTION
419321debf25SMatthias Ringwald     // LE Resolving List Management
4194ea151974SMatthias Ringwald     if (resolving_list_supported) {
419521debf25SMatthias Ringwald 		uint16_t i;
419621debf25SMatthias Ringwald 		switch (hci_stack->le_resolving_list_state) {
419721debf25SMatthias Ringwald 			case LE_RESOLVING_LIST_SEND_ENABLE_ADDRESS_RESOLUTION:
419821debf25SMatthias Ringwald 				hci_stack->le_resolving_list_state = LE_RESOLVING_LIST_READ_SIZE;
419921debf25SMatthias Ringwald 				hci_send_cmd(&hci_le_set_address_resolution_enabled, 1);
420021debf25SMatthias Ringwald 				return true;
420121debf25SMatthias Ringwald 			case LE_RESOLVING_LIST_READ_SIZE:
420221debf25SMatthias Ringwald 				hci_stack->le_resolving_list_state = LE_RESOLVING_LIST_SEND_CLEAR;
420321debf25SMatthias Ringwald 				hci_send_cmd(&hci_le_read_resolving_list_size);
420421debf25SMatthias Ringwald 				return true;
420521debf25SMatthias Ringwald 			case LE_RESOLVING_LIST_SEND_CLEAR:
420602b02cffSMatthias Ringwald 				hci_stack->le_resolving_list_state = LE_RESOLVING_LIST_REMOVE_ENTRIES;
4207ea151974SMatthias Ringwald 				(void) memset(hci_stack->le_resolving_list_add_entries, 0xff,
4208ea151974SMatthias Ringwald 							  sizeof(hci_stack->le_resolving_list_add_entries));
4209ea151974SMatthias Ringwald 				(void) memset(hci_stack->le_resolving_list_remove_entries, 0,
4210ea151974SMatthias Ringwald 							  sizeof(hci_stack->le_resolving_list_remove_entries));
421121debf25SMatthias Ringwald 				hci_send_cmd(&hci_le_clear_resolving_list);
421221debf25SMatthias Ringwald 				return true;
421302b02cffSMatthias Ringwald 			case LE_RESOLVING_LIST_REMOVE_ENTRIES:
421402b02cffSMatthias Ringwald 				for (i = 0; i < MAX_NUM_RESOLVING_LIST_ENTRIES && i < le_device_db_max_count(); i++) {
421502b02cffSMatthias Ringwald 					uint8_t offset = i >> 3;
421602b02cffSMatthias Ringwald 					uint8_t mask = 1 << (i & 7);
421702b02cffSMatthias Ringwald 					if ((hci_stack->le_resolving_list_remove_entries[offset] & mask) == 0) continue;
421802b02cffSMatthias Ringwald 					hci_stack->le_resolving_list_remove_entries[offset] &= ~mask;
421902b02cffSMatthias Ringwald 					bd_addr_t peer_identity_addreses;
422002b02cffSMatthias Ringwald 					int peer_identity_addr_type = (int) BD_ADDR_TYPE_UNKNOWN;
422102b02cffSMatthias Ringwald 					sm_key_t peer_irk;
422202b02cffSMatthias Ringwald 					le_device_db_info(i, &peer_identity_addr_type, peer_identity_addreses, peer_irk);
422302b02cffSMatthias Ringwald 					if (peer_identity_addr_type == BD_ADDR_TYPE_UNKNOWN) continue;
4224f5228c62SMatthias Ringwald 
4225f5228c62SMatthias Ringwald #ifdef ENABLE_LE_WHITELIST_TOUCH_AFTER_RESOLVING_LIST_UPDATE
4226f5228c62SMatthias Ringwald 					// trigger whitelist entry 'update' (work around for controller bug)
4227f5228c62SMatthias Ringwald 					btstack_linked_list_iterator_init(&lit, &hci_stack->le_whitelist);
4228f5228c62SMatthias Ringwald 					while (btstack_linked_list_iterator_has_next(&lit)) {
4229f5228c62SMatthias Ringwald 						whitelist_entry_t *entry = (whitelist_entry_t *) btstack_linked_list_iterator_next(&lit);
4230f5228c62SMatthias Ringwald 						if (entry->address_type != peer_identity_addr_type) continue;
4231f5228c62SMatthias Ringwald 						if (memcmp(entry->address, peer_identity_addreses, 6) != 0) continue;
4232f5228c62SMatthias Ringwald 						log_info("trigger whitelist update %s", bd_addr_to_str(peer_identity_addreses));
4233f5228c62SMatthias Ringwald 						entry->state |= LE_WHITELIST_REMOVE_FROM_CONTROLLER | LE_WHITELIST_ADD_TO_CONTROLLER;
4234f5228c62SMatthias Ringwald 					}
4235f5228c62SMatthias Ringwald #endif
4236f5228c62SMatthias Ringwald 
4237ea151974SMatthias Ringwald 					hci_send_cmd(&hci_le_remove_device_from_resolving_list, peer_identity_addr_type,
4238ea151974SMatthias Ringwald 								 peer_identity_addreses);
423902b02cffSMatthias Ringwald 					return true;
424002b02cffSMatthias Ringwald 				}
424102b02cffSMatthias Ringwald 
424202b02cffSMatthias Ringwald 				hci_stack->le_resolving_list_state = LE_RESOLVING_LIST_ADD_ENTRIES;
424302b02cffSMatthias Ringwald 
424402b02cffSMatthias Ringwald 				/* fall through */
424502b02cffSMatthias Ringwald 
424621debf25SMatthias Ringwald 			case LE_RESOLVING_LIST_ADD_ENTRIES:
424721debf25SMatthias Ringwald 				for (i = 0; i < MAX_NUM_RESOLVING_LIST_ENTRIES && i < le_device_db_max_count(); i++) {
424821debf25SMatthias Ringwald 					uint8_t offset = i >> 3;
424921debf25SMatthias Ringwald 					uint8_t mask = 1 << (i & 7);
425002b02cffSMatthias Ringwald 					if ((hci_stack->le_resolving_list_add_entries[offset] & mask) == 0) continue;
425102b02cffSMatthias Ringwald 					hci_stack->le_resolving_list_add_entries[offset] &= ~mask;
425221debf25SMatthias Ringwald 					bd_addr_t peer_identity_addreses;
425321debf25SMatthias Ringwald 					int peer_identity_addr_type = (int) BD_ADDR_TYPE_UNKNOWN;
425421debf25SMatthias Ringwald 					sm_key_t peer_irk;
425521debf25SMatthias Ringwald 					le_device_db_info(i, &peer_identity_addr_type, peer_identity_addreses, peer_irk);
425621debf25SMatthias Ringwald 					if (peer_identity_addr_type == BD_ADDR_TYPE_UNKNOWN) continue;
425721debf25SMatthias Ringwald 					const uint8_t *local_irk = gap_get_persistent_irk();
425821debf25SMatthias Ringwald 					// command uses format specifier 'P' that stores 16-byte value without flip
425921debf25SMatthias Ringwald 					uint8_t local_irk_flipped[16];
426021debf25SMatthias Ringwald 					uint8_t peer_irk_flipped[16];
426121debf25SMatthias Ringwald 					reverse_128(local_irk, local_irk_flipped);
426221debf25SMatthias Ringwald 					reverse_128(peer_irk, peer_irk_flipped);
4263ea151974SMatthias Ringwald 					hci_send_cmd(&hci_le_add_device_to_resolving_list, peer_identity_addr_type, peer_identity_addreses,
4264ea151974SMatthias Ringwald 								 peer_irk_flipped, local_irk_flipped);
426521debf25SMatthias Ringwald 					return true;
426621debf25SMatthias Ringwald 				}
426702b02cffSMatthias Ringwald 				hci_stack->le_resolving_list_state = LE_RESOLVING_LIST_DONE;
426821debf25SMatthias Ringwald 				break;
426902b02cffSMatthias Ringwald 
427021debf25SMatthias Ringwald 			default:
427121debf25SMatthias Ringwald 				break;
427221debf25SMatthias Ringwald 		}
4273ea151974SMatthias Ringwald 	}
427421debf25SMatthias Ringwald     hci_stack->le_resolving_list_state = LE_RESOLVING_LIST_DONE;
427521debf25SMatthias Ringwald #endif
4276a41310b7SMatthias Ringwald 
4277a41310b7SMatthias Ringwald     // Phase 4: restore state
427829c24bebSMatthias Ringwald 
427929c24bebSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
4280af64f147SMatthias Ringwald     // re-start scanning
428129c24bebSMatthias Ringwald     if ((hci_stack->le_scanning_enabled && !hci_stack->le_scanning_active)){
428229c24bebSMatthias Ringwald         hci_stack->le_scanning_active = true;
428329c24bebSMatthias Ringwald         hci_send_cmd(&hci_le_set_scan_enable, 1, 0);
428429c24bebSMatthias Ringwald         return true;
428529c24bebSMatthias Ringwald     }
428629c24bebSMatthias Ringwald #endif
428729c24bebSMatthias Ringwald 
428813eb2a2eSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
4289af64f147SMatthias Ringwald     // re-start connecting
4290af64f147SMatthias Ringwald     if ( (hci_stack->le_connecting_state == LE_CONNECTING_IDLE) && (hci_stack->le_connecting_request == LE_CONNECTING_WHITELIST)){
42919956955bSMatthias Ringwald         bd_addr_t null_addr;
42929956955bSMatthias Ringwald         memset(null_addr, 0, 6);
42936bcfa632SMatthias Ringwald         hci_stack->le_connection_own_addr_type =  hci_stack->le_own_addr_type;
42946bcfa632SMatthias Ringwald         hci_get_own_address_for_addr_type(hci_stack->le_connection_own_addr_type, hci_stack->le_connection_own_address);
42959956955bSMatthias Ringwald         hci_send_cmd(&hci_le_create_connection,
4296cbe54ab2SJakob Krantz                      hci_stack->le_connection_scan_interval,    // scan interval: 60 ms
4297cbe54ab2SJakob Krantz                      hci_stack->le_connection_scan_window,    // scan interval: 30 ms
42989956955bSMatthias Ringwald                      1,         // use whitelist
42999956955bSMatthias Ringwald                      0,         // peer address type
43009956955bSMatthias Ringwald                      null_addr, // peer bd addr
43016bcfa632SMatthias Ringwald                      hci_stack->le_connection_own_addr_type,   // our addr type:
430273044eb2SMatthias Ringwald                      hci_stack->le_connection_interval_min,    // conn interval min
430373044eb2SMatthias Ringwald                      hci_stack->le_connection_interval_max,    // conn interval max
430473044eb2SMatthias Ringwald                      hci_stack->le_connection_latency,         // conn latency
430573044eb2SMatthias Ringwald                      hci_stack->le_supervision_timeout,        // conn latency
430673044eb2SMatthias Ringwald                      hci_stack->le_minimum_ce_length,          // min ce length
430773044eb2SMatthias Ringwald                      hci_stack->le_maximum_ce_length           // max ce length
43089956955bSMatthias Ringwald         );
4309f30077b7SMatthias Ringwald         return true;
43109956955bSMatthias Ringwald     }
4311d70217a2SMatthias Ringwald #endif
4312a41310b7SMatthias Ringwald 
4313a41310b7SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
4314a41310b7SMatthias Ringwald     // re-start advertising
43158978dcf1SMatthias Ringwald     if (hci_stack->le_advertisements_enabled_for_current_roles && !hci_stack->le_advertisements_active){
4316a41310b7SMatthias Ringwald         // check if advertisements should be enabled given
43175226d7f2SMatthias Ringwald         hci_stack->le_advertisements_active = true;
43186bcfa632SMatthias Ringwald         hci_get_own_address_for_addr_type(hci_stack->le_connection_own_addr_type, hci_stack->le_advertisements_own_address);
4319a41310b7SMatthias Ringwald         hci_send_cmd(&hci_le_set_advertise_enable, 1);
4320a41310b7SMatthias Ringwald         return true;
4321a41310b7SMatthias Ringwald     }
4322a41310b7SMatthias Ringwald #endif
4323a41310b7SMatthias Ringwald 
4324f30077b7SMatthias Ringwald     return false;
43257bdc6798S[email protected] }
4326b2f949feS[email protected] #endif
43277bdc6798S[email protected] 
432888a03c8dSMatthias Ringwald static bool hci_run_general_pending_commands(void){
4329f30077b7SMatthias Ringwald     btstack_linked_item_t * it;
4330a0da043fSMatthias Ringwald     for (it = (btstack_linked_item_t *) hci_stack->connections; it != NULL; it = it->next){
433105ae8de3SMatthias Ringwald         hci_connection_t * connection = (hci_connection_t *) it;
433232ab9390Smatthias.ringwald 
43330bf6344aS[email protected]         switch(connection->state){
43340bf6344aS[email protected]             case SEND_CREATE_CONNECTION:
43354f3229d8S[email protected]                 switch(connection->address_type){
433635454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
4337f16129ceSMatthias Ringwald                     case BD_ADDR_TYPE_ACL:
43389da54300S[email protected]                         log_info("sending hci_create_connection");
4339b4eb4420SMatthias Ringwald                         hci_send_cmd(&hci_create_connection, connection->address, hci_usable_acl_packet_types(), 0, 0, 0, hci_stack->allow_role_switch);
43404f3229d8S[email protected]                         break;
434135454696SMatthias Ringwald #endif
43424f3229d8S[email protected]                     default:
4343a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE
4344d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
43459da54300S[email protected]                         log_info("sending hci_le_create_connection");
43466bcfa632SMatthias Ringwald                         hci_stack->le_connection_own_addr_type =  hci_stack->le_own_addr_type;
43476bcfa632SMatthias Ringwald                         hci_get_own_address_for_addr_type(hci_stack->le_connection_own_addr_type, hci_stack->le_connection_own_address);
43484f3229d8S[email protected]                         hci_send_cmd(&hci_le_create_connection,
4349cbe54ab2SJakob Krantz                                      hci_stack->le_connection_scan_interval,    // conn scan interval
4350cbe54ab2SJakob Krantz                                      hci_stack->le_connection_scan_window,      // conn scan windows
43514f3229d8S[email protected]                                      0,         // don't use whitelist
43524f3229d8S[email protected]                                      connection->address_type, // peer address type
43534f3229d8S[email protected]                                      connection->address,      // peer bd addr
43546bcfa632SMatthias Ringwald                                      hci_stack->le_connection_own_addr_type,   // our addr type:
435573044eb2SMatthias Ringwald                                      hci_stack->le_connection_interval_min,    // conn interval min
435673044eb2SMatthias Ringwald                                      hci_stack->le_connection_interval_max,    // conn interval max
435773044eb2SMatthias Ringwald                                      hci_stack->le_connection_latency,         // conn latency
435873044eb2SMatthias Ringwald                                      hci_stack->le_supervision_timeout,        // conn latency
435973044eb2SMatthias Ringwald                                      hci_stack->le_minimum_ce_length,          // min ce length
436073044eb2SMatthias Ringwald                                      hci_stack->le_maximum_ce_length          // max ce length
43614f3229d8S[email protected]                         );
43624f3229d8S[email protected]                         connection->state = SENT_CREATE_CONNECTION;
4363b2f949feS[email protected] #endif
4364d70217a2SMatthias Ringwald #endif
43654f3229d8S[email protected]                         break;
43664f3229d8S[email protected]                 }
4367f30077b7SMatthias Ringwald                 return true;
4368ad83dc6aS[email protected] 
436935454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
43700bf6344aS[email protected]             case RECEIVED_CONNECTION_REQUEST:
43715cf766e8SMatthias Ringwald                 connection->role  = HCI_ROLE_SLAVE;
4372f16129ceSMatthias Ringwald                 if (connection->address_type == BD_ADDR_TYPE_ACL){
437376ccfb2aSMatthias Ringwald                     log_info("sending hci_accept_connection_request");
4374895f6685SMilanka Ringwald                     connection->state = ACCEPTED_CONNECTION_REQUEST;
4375c4c88f1bSJakob Krantz                     hci_send_cmd(&hci_accept_connection_request, connection->address, hci_stack->master_slave_policy);
4376e35edcc1S[email protected]                 }
4377f30077b7SMatthias Ringwald                 return true;
437835454696SMatthias Ringwald #endif
43790bf6344aS[email protected] 
4380a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE
4381d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
43820bf6344aS[email protected]             case SEND_CANCEL_CONNECTION:
43830bf6344aS[email protected]                 connection->state = SENT_CANCEL_CONNECTION;
43840bf6344aS[email protected]                 hci_send_cmd(&hci_le_create_connection_cancel);
4385f30077b7SMatthias Ringwald                 return true;
4386a6725849S[email protected] #endif
4387d70217a2SMatthias Ringwald #endif
43880bf6344aS[email protected]             case SEND_DISCONNECT:
43890bf6344aS[email protected]                 connection->state = SENT_DISCONNECT;
43906ef3696aSMatthias Ringwald                 hci_send_cmd(&hci_disconnect, connection->con_handle, ERROR_CODE_REMOTE_USER_TERMINATED_CONNECTION);
4391f30077b7SMatthias Ringwald                 return true;
43920bf6344aS[email protected] 
43930bf6344aS[email protected]             default:
43940bf6344aS[email protected]                 break;
4395c7e0c5f6Smatthias.ringwald         }
4396c7e0c5f6Smatthias.ringwald 
4397cabf004eSMatthias Ringwald         // no further commands if connection is about to get shut down
4398cabf004eSMatthias Ringwald         if (connection->state == SENT_DISCONNECT) continue;
4399cabf004eSMatthias Ringwald 
4400891b9fc2SMatthias Ringwald         if (connection->authentication_flags & READ_RSSI){
4401891b9fc2SMatthias Ringwald             connectionClearAuthenticationFlags(connection, READ_RSSI);
4402891b9fc2SMatthias Ringwald             hci_send_cmd(&hci_read_rssi, connection->con_handle);
4403f30077b7SMatthias Ringwald             return true;
4404891b9fc2SMatthias Ringwald         }
4405891b9fc2SMatthias Ringwald 
440694418890SMatthias Ringwald #ifdef ENABLE_CLASSIC
440794418890SMatthias Ringwald 
44086909f064SMatthias Ringwald         if (connection->authentication_flags & WRITE_SUPERVISION_TIMEOUT){
44096909f064SMatthias Ringwald             connectionClearAuthenticationFlags(connection, WRITE_SUPERVISION_TIMEOUT);
44106909f064SMatthias Ringwald             hci_send_cmd(&hci_write_link_supervision_timeout, connection->con_handle, hci_stack->link_supervision_timeout);
4411f30077b7SMatthias Ringwald             return true;
44126909f064SMatthias Ringwald         }
44136909f064SMatthias Ringwald 
4414ad20f0c8SMatthias Ringwald         // Handling link key request requires remote supported features
4415ad20f0c8SMatthias Ringwald         if ( ((connection->authentication_flags & HANDLE_LINK_KEY_REQUEST) != 0) && ((connection->bonding_flags & BONDING_RECEIVED_REMOTE_FEATURES) != 0)){
4416608f51bbSMatthias Ringwald             log_info("responding to link key request, have link key db: %u", hci_stack->link_key_db != NULL);
441734d2123cS[email protected]             connectionClearAuthenticationFlags(connection, HANDLE_LINK_KEY_REQUEST);
441830e72d78SMatthias Ringwald 
4419e9f98c4aSMatthias Ringwald             // lookup link key using cached key first
4420e9f98c4aSMatthias Ringwald             bool have_link_key = connection->link_key_type != INVALID_LINK_KEY;
4421e9f98c4aSMatthias Ringwald             if (!have_link_key && (hci_stack->link_key_db != NULL)){
4422e9f98c4aSMatthias Ringwald                 have_link_key = hci_stack->link_key_db->get_link_key(connection->address, connection->link_key, &connection->link_key_type);
4423e9f98c4aSMatthias Ringwald             }
442430e72d78SMatthias Ringwald 
442530e72d78SMatthias Ringwald             const uint16_t sc_enabled_mask = BONDING_REMOTE_SUPPORTS_SC_HOST | BONDING_REMOTE_SUPPORTS_SC_CONTROLLER;
442630e72d78SMatthias Ringwald             bool sc_enabled_remote = (connection->bonding_flags & sc_enabled_mask) == sc_enabled_mask;
4427e9f98c4aSMatthias Ringwald             bool sc_downgrade = have_link_key && (gap_secure_connection_for_link_key_type(connection->link_key_type) == 1) && !sc_enabled_remote;
442830e72d78SMatthias Ringwald             if (sc_downgrade){
442930e72d78SMatthias Ringwald                 log_info("Link key based on SC, but remote does not support SC -> disconnect");
443030e72d78SMatthias Ringwald                 connection->state = SENT_DISCONNECT;
443130e72d78SMatthias Ringwald                 hci_send_cmd(&hci_disconnect, connection->con_handle, ERROR_CODE_AUTHENTICATION_FAILURE);
443230e72d78SMatthias Ringwald                 return true;
443330e72d78SMatthias Ringwald             }
443430e72d78SMatthias Ringwald 
4435e9f98c4aSMatthias Ringwald             bool security_level_sufficient = have_link_key && (gap_security_level_for_link_key_type(connection->link_key_type) >= connection->requested_security_level);
443630e72d78SMatthias Ringwald             if (have_link_key && security_level_sufficient){
4437e9f98c4aSMatthias Ringwald                 hci_send_cmd(&hci_link_key_request_reply, connection->address, &connection->link_key);
443832ab9390Smatthias.ringwald             } else {
443932ab9390Smatthias.ringwald                 hci_send_cmd(&hci_link_key_request_negative_reply, connection->address);
444032ab9390Smatthias.ringwald             }
4441f30077b7SMatthias Ringwald             return true;
444232ab9390Smatthias.ringwald         }
44431d6b20aeS[email protected] 
4444899283eaS[email protected]         if (connection->authentication_flags & DENY_PIN_CODE_REQUEST){
44459da54300S[email protected]             log_info("denying to pin request");
4446899283eaS[email protected]             connectionClearAuthenticationFlags(connection, DENY_PIN_CODE_REQUEST);
444734d2123cS[email protected]             hci_send_cmd(&hci_pin_code_request_negative_reply, connection->address);
4448f30077b7SMatthias Ringwald             return true;
44494c57c146S[email protected]         }
44504c57c146S[email protected] 
4451dbe1a790S[email protected]         if (connection->authentication_flags & SEND_IO_CAPABILITIES_REPLY){
445234d2123cS[email protected]             connectionClearAuthenticationFlags(connection, SEND_IO_CAPABILITIES_REPLY);
4453a8d20135SMatthias Ringwald             // set authentication requirements:
4454a8d20135SMatthias Ringwald             // - MITM = ssp_authentication_requirement (USER) | requested_security_level (dynamic)
4455532454f9SMatthias Ringwald             // - BONDING MODE: dedicated if requested, bondable otherwise. Drop bondable if not set for remote
4456a8d20135SMatthias Ringwald             uint8_t authreq = hci_stack->ssp_authentication_requirement & 1;
44579faad3abS[email protected]             if (gap_mitm_protection_required_for_security_level(connection->requested_security_level)){
44589faad3abS[email protected]                 authreq |= 1;
4459106d6d11S[email protected]             }
4460532454f9SMatthias Ringwald             bool bonding = hci_stack->bondable;
4461532454f9SMatthias Ringwald             if (connection->authentication_flags & RECV_IO_CAPABILITIES_RESPONSE){
4462532454f9SMatthias Ringwald                 // if we have received IO Cap Response, we're in responder role
4463532454f9SMatthias Ringwald                 bool remote_bonding = connection->io_cap_response_auth_req >= SSP_IO_AUTHREQ_MITM_PROTECTION_NOT_REQUIRED_DEDICATED_BONDING;
4464532454f9SMatthias Ringwald                 if (bonding && !remote_bonding){
4465532454f9SMatthias Ringwald                     log_info("Remote not bonding, dropping local flag");
4466532454f9SMatthias Ringwald                     bonding = false;
4467532454f9SMatthias Ringwald                 }
4468532454f9SMatthias Ringwald             }
4469532454f9SMatthias Ringwald             if (bonding){
4470a8d20135SMatthias Ringwald                 if (connection->bonding_flags & BONDING_DEDICATED){
4471a8d20135SMatthias Ringwald                     authreq |= SSP_IO_AUTHREQ_MITM_PROTECTION_NOT_REQUIRED_DEDICATED_BONDING;
4472532454f9SMatthias Ringwald                 } else {
4473a8d20135SMatthias Ringwald                     authreq |= SSP_IO_AUTHREQ_MITM_PROTECTION_NOT_REQUIRED_GENERAL_BONDING;
4474a8d20135SMatthias Ringwald                 }
4475532454f9SMatthias Ringwald             }
44761849becdSMatthias Ringwald             uint8_t have_oob_data = 0;
44771849becdSMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB
44781849becdSMatthias Ringwald             if (connection->classic_oob_c_192 != NULL){
44791849becdSMatthias Ringwald                     have_oob_data |= 1;
44801849becdSMatthias Ringwald             }
44811849becdSMatthias Ringwald             if (connection->classic_oob_c_256 != NULL){
44821849becdSMatthias Ringwald                 have_oob_data |= 2;
44831849becdSMatthias Ringwald             }
44841849becdSMatthias Ringwald #endif
44851849becdSMatthias Ringwald             hci_send_cmd(&hci_io_capability_request_reply, &connection->address, hci_stack->ssp_io_capability, have_oob_data, authreq);
448611b03efaSMatthias Ringwald             return true;
4487f8fb5f6eS[email protected]         }
448811b03efaSMatthias Ringwald 
448911b03efaSMatthias Ringwald         if (connection->authentication_flags & SEND_IO_CAPABILITIES_NEGATIVE_REPLY) {
449011b03efaSMatthias Ringwald             connectionClearAuthenticationFlags(connection, SEND_IO_CAPABILITIES_NEGATIVE_REPLY);
449111b03efaSMatthias Ringwald             hci_send_cmd(&hci_io_capability_request_negative_reply, &connection->address, ERROR_CODE_PAIRING_NOT_ALLOWED);
4492f30077b7SMatthias Ringwald             return true;
449332ab9390Smatthias.ringwald         }
449432ab9390Smatthias.ringwald 
44951849becdSMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB
44961849becdSMatthias Ringwald         if (connection->authentication_flags & SEND_REMOTE_OOB_DATA_REPLY){
44971849becdSMatthias Ringwald             connectionClearAuthenticationFlags(connection, SEND_REMOTE_OOB_DATA_REPLY);
44981849becdSMatthias Ringwald             const uint8_t zero[16] = { 0 };
44991849becdSMatthias Ringwald             const uint8_t * r_192 = zero;
45001849becdSMatthias Ringwald             const uint8_t * c_192 = zero;
45011849becdSMatthias Ringwald             const uint8_t * r_256 = zero;
45021849becdSMatthias Ringwald             const uint8_t * c_256 = zero;
45031849becdSMatthias Ringwald             // verify P-256 OOB
45041849becdSMatthias Ringwald             if ((connection->classic_oob_c_256 != NULL) && ((hci_stack->local_supported_commands[1] & 0x08u) != 0)) {
45051849becdSMatthias Ringwald                 c_256 = connection->classic_oob_c_256;
45061849becdSMatthias Ringwald                 if (connection->classic_oob_r_256 != NULL) {
45071849becdSMatthias Ringwald                     r_256 = connection->classic_oob_r_256;
45081849becdSMatthias Ringwald                 }
45091849becdSMatthias Ringwald             }
45101849becdSMatthias Ringwald             // verify P-192 OOB
45111849becdSMatthias Ringwald             if ((connection->classic_oob_c_192 != NULL)) {
45121849becdSMatthias Ringwald                 c_192 = connection->classic_oob_c_192;
45131849becdSMatthias Ringwald                 if (connection->classic_oob_r_192 != NULL) {
45141849becdSMatthias Ringwald                     r_192 = connection->classic_oob_r_192;
45151849becdSMatthias Ringwald                 }
45161849becdSMatthias Ringwald             }
45171849becdSMatthias Ringwald             // Reply
45181849becdSMatthias Ringwald             if (c_256 != zero) {
45191849becdSMatthias Ringwald                 hci_send_cmd(&hci_remote_oob_extended_data_request_reply, &connection->address, c_192, r_192, c_256, r_256);
45201849becdSMatthias Ringwald             } else if (c_192 != zero){
45211849becdSMatthias Ringwald                 hci_send_cmd(&hci_remote_oob_data_request_reply, &connection->address, c_192, r_192);
45221849becdSMatthias Ringwald             } else {
45231849becdSMatthias Ringwald                 hci_send_cmd(&hci_remote_oob_data_request_negative_reply, &connection->address);
45241849becdSMatthias Ringwald             }
45251849becdSMatthias Ringwald             return true;
45261849becdSMatthias Ringwald         }
45271849becdSMatthias Ringwald #endif
45281849becdSMatthias Ringwald 
4529dbe1a790S[email protected]         if (connection->authentication_flags & SEND_USER_CONFIRM_REPLY){
4530dbe1a790S[email protected]             connectionClearAuthenticationFlags(connection, SEND_USER_CONFIRM_REPLY);
453134d2123cS[email protected]             hci_send_cmd(&hci_user_confirmation_request_reply, &connection->address);
4532f30077b7SMatthias Ringwald             return true;
4533dbe1a790S[email protected]         }
4534dbe1a790S[email protected] 
4535dbe1a790S[email protected]         if (connection->authentication_flags & SEND_USER_PASSKEY_REPLY){
4536dbe1a790S[email protected]             connectionClearAuthenticationFlags(connection, SEND_USER_PASSKEY_REPLY);
453734d2123cS[email protected]             hci_send_cmd(&hci_user_passkey_request_reply, &connection->address, 000000);
4538f30077b7SMatthias Ringwald             return true;
4539dbe1a790S[email protected]         }
4540afd4e962S[email protected] 
4541ba018746SMatthias Ringwald         if (connection->bonding_flags & BONDING_REQUEST_REMOTE_FEATURES_PAGE_0){
4542ba018746SMatthias Ringwald             connection->bonding_flags &= ~BONDING_REQUEST_REMOTE_FEATURES_PAGE_0;
454334d2123cS[email protected]             hci_send_cmd(&hci_read_remote_supported_features_command, connection->con_handle);
4544f30077b7SMatthias Ringwald             return true;
45452bd8b7e7S[email protected]         }
45462bd8b7e7S[email protected] 
45475ccef624SMatthias Ringwald         if (connection->bonding_flags & BONDING_REQUEST_REMOTE_FEATURES_PAGE_1){
45485ccef624SMatthias Ringwald             connection->bonding_flags &= ~BONDING_REQUEST_REMOTE_FEATURES_PAGE_1;
45495ccef624SMatthias Ringwald             hci_send_cmd(&hci_read_remote_extended_features_command, connection->con_handle, 1);
45505ccef624SMatthias Ringwald             return true;
45515ccef624SMatthias Ringwald         }
45525ccef624SMatthias Ringwald 
455382721f83SMatthias Ringwald         if (connection->bonding_flags & BONDING_REQUEST_REMOTE_FEATURES_PAGE_2){
455482721f83SMatthias Ringwald             connection->bonding_flags &= ~BONDING_REQUEST_REMOTE_FEATURES_PAGE_2;
455582721f83SMatthias Ringwald             hci_send_cmd(&hci_read_remote_extended_features_command, connection->con_handle, 2);
455682721f83SMatthias Ringwald             return true;
455782721f83SMatthias Ringwald         }
455882721f83SMatthias Ringwald 
4559ad83dc6aS[email protected]         if (connection->bonding_flags & BONDING_DISCONNECT_DEDICATED_DONE){
4560ad83dc6aS[email protected]             connection->bonding_flags &= ~BONDING_DISCONNECT_DEDICATED_DONE;
45611bd5283dS[email protected]             connection->bonding_flags |= BONDING_EMIT_COMPLETE_ON_DISCONNECT;
45626ef3696aSMatthias Ringwald             connection->state = SENT_DISCONNECT;
45636ef3696aSMatthias Ringwald             hci_send_cmd(&hci_disconnect, connection->con_handle, ERROR_CODE_REMOTE_USER_TERMINATED_CONNECTION);
4564f30077b7SMatthias Ringwald             return true;
4565ad83dc6aS[email protected]         }
456676f27cffSMatthias Ringwald 
456734d2123cS[email protected]         if (connection->bonding_flags & BONDING_SEND_AUTHENTICATE_REQUEST){
456834d2123cS[email protected]             connection->bonding_flags &= ~BONDING_SEND_AUTHENTICATE_REQUEST;
4569abdad579SMatthias Ringwald             connection->bonding_flags |= BONDING_SENT_AUTHENTICATE_REQUEST;
457034d2123cS[email protected]             hci_send_cmd(&hci_authentication_requested, connection->con_handle);
4571f30077b7SMatthias Ringwald             return true;
4572afd4e962S[email protected]         }
457376f27cffSMatthias Ringwald 
4574dce78009S[email protected]         if (connection->bonding_flags & BONDING_SEND_ENCRYPTION_REQUEST){
4575dce78009S[email protected]             connection->bonding_flags &= ~BONDING_SEND_ENCRYPTION_REQUEST;
4576dce78009S[email protected]             hci_send_cmd(&hci_set_connection_encryption, connection->con_handle, 1);
4577f30077b7SMatthias Ringwald             return true;
4578dce78009S[email protected]         }
4579573897a0SMatthias Ringwald         if (connection->bonding_flags & BONDING_SEND_READ_ENCRYPTION_KEY_SIZE){
4580573897a0SMatthias Ringwald             connection->bonding_flags &= ~BONDING_SEND_READ_ENCRYPTION_KEY_SIZE;
4581573897a0SMatthias Ringwald             hci_send_cmd(&hci_read_encryption_key_size, connection->con_handle, 1);
4582f30077b7SMatthias Ringwald             return true;
4583573897a0SMatthias Ringwald         }
458476f27cffSMatthias Ringwald #endif
458576f27cffSMatthias Ringwald 
458676f27cffSMatthias Ringwald         if (connection->bonding_flags & BONDING_DISCONNECT_SECURITY_BLOCK){
458776f27cffSMatthias Ringwald             connection->bonding_flags &= ~BONDING_DISCONNECT_SECURITY_BLOCK;
45886ef3696aSMatthias Ringwald             if (connection->state != SENT_DISCONNECT){
45896ef3696aSMatthias Ringwald                 connection->state = SENT_DISCONNECT;
45906ef3696aSMatthias Ringwald                 hci_send_cmd(&hci_disconnect, connection->con_handle, ERROR_CODE_AUTHENTICATION_FAILURE);
4591f30077b7SMatthias Ringwald                 return true;
459276f27cffSMatthias Ringwald             }
45936ef3696aSMatthias Ringwald         }
4594da886c03S[email protected] 
45956cdc2862SMatthias Ringwald #ifdef ENABLE_CLASSIC
4596f8ee3071SMatthias Ringwald         uint16_t sniff_min_interval;
4597f8ee3071SMatthias Ringwald         switch (connection->sniff_min_interval){
4598f8ee3071SMatthias Ringwald             case 0:
4599f8ee3071SMatthias Ringwald                 break;
4600f8ee3071SMatthias Ringwald             case 0xffff:
4601f8ee3071SMatthias Ringwald                 connection->sniff_min_interval = 0;
4602f8ee3071SMatthias Ringwald                 hci_send_cmd(&hci_exit_sniff_mode, connection->con_handle);
4603f30077b7SMatthias Ringwald                 return true;
4604f8ee3071SMatthias Ringwald             default:
4605f8ee3071SMatthias Ringwald                 sniff_min_interval = connection->sniff_min_interval;
4606f8ee3071SMatthias Ringwald                 connection->sniff_min_interval = 0;
4607f8ee3071SMatthias Ringwald                 hci_send_cmd(&hci_sniff_mode, connection->con_handle, connection->sniff_max_interval, sniff_min_interval, connection->sniff_attempt, connection->sniff_timeout);
4608f30077b7SMatthias Ringwald                 return true;
4609f8ee3071SMatthias Ringwald         }
461088a03c8dSMatthias Ringwald 
4611140c0557SMatthias Ringwald         if (connection->sniff_subrating_max_latency != 0xffff){
4612140c0557SMatthias Ringwald             uint16_t max_latency = connection->sniff_subrating_max_latency;
4613140c0557SMatthias Ringwald             connection->sniff_subrating_max_latency = 0;
4614140c0557SMatthias Ringwald             hci_send_cmd(&hci_sniff_subrating, connection->con_handle, max_latency, connection->sniff_subrating_min_remote_timeout, connection->sniff_subrating_min_local_timeout);
4615140c0557SMatthias Ringwald             return true;
4616140c0557SMatthias Ringwald         }
4617140c0557SMatthias Ringwald 
4618278ff8a9SMatthias Ringwald         if (connection->qos_service_type != HCI_SERVICE_TyPE_INVALID){
4619278ff8a9SMatthias Ringwald             uint8_t service_type = (uint8_t) connection->qos_service_type;
4620278ff8a9SMatthias Ringwald             connection->qos_service_type = HCI_SERVICE_TyPE_INVALID;
4621278ff8a9SMatthias 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);
4622278ff8a9SMatthias Ringwald             return true;
4623278ff8a9SMatthias Ringwald         }
4624278ff8a9SMatthias Ringwald 
462588a03c8dSMatthias Ringwald         if (connection->request_role != HCI_ROLE_INVALID){
462688a03c8dSMatthias Ringwald             hci_role_t role = connection->request_role;
462788a03c8dSMatthias Ringwald             connection->request_role = HCI_ROLE_INVALID;
462888a03c8dSMatthias Ringwald             hci_send_cmd(&hci_switch_role_command, connection->address, role);
462988a03c8dSMatthias Ringwald             return true;
463088a03c8dSMatthias Ringwald         }
46316cdc2862SMatthias Ringwald #endif
4632f8ee3071SMatthias Ringwald 
4633a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE
463473cd8a2aSMatthias Ringwald         switch (connection->le_con_parameter_update_state){
463573cd8a2aSMatthias Ringwald             // response to L2CAP CON PARAMETER UPDATE REQUEST
463673cd8a2aSMatthias Ringwald             case CON_PARAMETER_UPDATE_CHANGE_HCI_CON_PARAMETERS:
4637da886c03S[email protected]                 connection->le_con_parameter_update_state = CON_PARAMETER_UPDATE_NONE;
463873cd8a2aSMatthias Ringwald                 hci_send_cmd(&hci_le_connection_update, connection->con_handle, connection->le_conn_interval_min,
4639c37a3166S[email protected]                              connection->le_conn_interval_max, connection->le_conn_latency, connection->le_supervision_timeout,
4640c37a3166S[email protected]                              0x0000, 0xffff);
4641f30077b7SMatthias Ringwald                 return true;
464273cd8a2aSMatthias Ringwald             case CON_PARAMETER_UPDATE_REPLY:
464373cd8a2aSMatthias Ringwald                 connection->le_con_parameter_update_state = CON_PARAMETER_UPDATE_NONE;
464473cd8a2aSMatthias Ringwald                 hci_send_cmd(&hci_le_remote_connection_parameter_request_reply, connection->con_handle, connection->le_conn_interval_min,
464573cd8a2aSMatthias Ringwald                              connection->le_conn_interval_max, connection->le_conn_latency, connection->le_supervision_timeout,
464673cd8a2aSMatthias Ringwald                              0x0000, 0xffff);
4647f30077b7SMatthias Ringwald                 return true;
464873cd8a2aSMatthias Ringwald             case CON_PARAMETER_UPDATE_NEGATIVE_REPLY:
464973cd8a2aSMatthias Ringwald                 connection->le_con_parameter_update_state = CON_PARAMETER_UPDATE_NONE;
465073cd8a2aSMatthias Ringwald                 hci_send_cmd(&hci_le_remote_connection_parameter_request_negative_reply, ERROR_CODE_UNSUPPORTED_LMP_PARAMETER_VALUE_UNSUPPORTED_LL_PARAMETER_VALUE);
4651f30077b7SMatthias Ringwald                 return true;
465273cd8a2aSMatthias Ringwald             default:
465373cd8a2aSMatthias Ringwald                 break;
4654c37a3166S[email protected]         }
46554ea43905SMatthias Ringwald         if (connection->le_phy_update_all_phys != 0xffu){
4656b90f6e0aSMatthias Ringwald             uint8_t all_phys = connection->le_phy_update_all_phys;
4657b90f6e0aSMatthias Ringwald             connection->le_phy_update_all_phys = 0xff;
4658b90f6e0aSMatthias 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);
4659f30077b7SMatthias Ringwald             return true;
4660b90f6e0aSMatthias Ringwald         }
4661c37a3166S[email protected] #endif
4662dbe1a790S[email protected]     }
4663f30077b7SMatthias Ringwald     return false;
4664f30077b7SMatthias Ringwald }
4665c7e0c5f6Smatthias.ringwald 
4666f30077b7SMatthias Ringwald static void hci_run(void){
4667f30077b7SMatthias Ringwald 
4668f30077b7SMatthias Ringwald     bool done;
4669f30077b7SMatthias Ringwald 
4670f30077b7SMatthias Ringwald     // send continuation fragments first, as they block the prepared packet buffer
4671f30077b7SMatthias Ringwald     done = hci_run_acl_fragments();
4672f30077b7SMatthias Ringwald     if (done) return;
4673f30077b7SMatthias Ringwald 
4674f30077b7SMatthias Ringwald #ifdef ENABLE_HCI_CONTROLLER_TO_HOST_FLOW_CONTROL
4675f30077b7SMatthias Ringwald     // send host num completed packets next as they don't require num_cmd_packets > 0
4676f30077b7SMatthias Ringwald     if (!hci_can_send_comand_packet_transport()) return;
4677f30077b7SMatthias Ringwald     if (hci_stack->host_completed_packets){
4678f30077b7SMatthias Ringwald         hci_host_num_completed_packets();
4679f30077b7SMatthias Ringwald         return;
4680f30077b7SMatthias Ringwald     }
4681f30077b7SMatthias Ringwald #endif
4682f30077b7SMatthias Ringwald 
4683f30077b7SMatthias Ringwald     if (!hci_can_send_command_packet_now()) return;
4684f30077b7SMatthias Ringwald 
4685f30077b7SMatthias Ringwald     // global/non-connection oriented commands
4686f30077b7SMatthias Ringwald 
4687f30077b7SMatthias Ringwald 
4688f30077b7SMatthias Ringwald #ifdef ENABLE_CLASSIC
4689f30077b7SMatthias Ringwald     // general gap classic
4690f30077b7SMatthias Ringwald     done = hci_run_general_gap_classic();
4691f30077b7SMatthias Ringwald     if (done) return;
4692f30077b7SMatthias Ringwald #endif
4693f30077b7SMatthias Ringwald 
4694f30077b7SMatthias Ringwald #ifdef ENABLE_BLE
4695f30077b7SMatthias Ringwald     // general gap le
4696f30077b7SMatthias Ringwald     done = hci_run_general_gap_le();
4697f30077b7SMatthias Ringwald     if (done) return;
4698f30077b7SMatthias Ringwald #endif
4699f30077b7SMatthias Ringwald 
4700f30077b7SMatthias Ringwald     // send pending HCI commands
470188a03c8dSMatthias Ringwald     done = hci_run_general_pending_commands();
4702f30077b7SMatthias Ringwald     if (done) return;
4703f30077b7SMatthias Ringwald 
4704f30077b7SMatthias Ringwald     // stack state sub statemachines
470505ae8de3SMatthias Ringwald     hci_connection_t * connection;
47063a9fb326S[email protected]     switch (hci_stack->state){
47073429f56bSmatthias.ringwald         case HCI_STATE_INITIALIZING:
470874b323a9SMatthias Ringwald             hci_initializing_run();
47093429f56bSmatthias.ringwald             break;
4710c7e0c5f6Smatthias.ringwald 
4711c7e0c5f6Smatthias.ringwald         case HCI_STATE_HALTING:
4712c7e0c5f6Smatthias.ringwald 
471326fe9592SMatthias Ringwald             log_info("HCI_STATE_HALTING, substate %x\n", hci_stack->substate);
471426fe9592SMatthias Ringwald             switch (hci_stack->substate){
4715beceeddeSMatthias Ringwald                 case HCI_HALTING_DISCONNECT_ALL_NO_TIMER:
4716beceeddeSMatthias Ringwald                 case HCI_HALTING_DISCONNECT_ALL_TIMER:
4717beceeddeSMatthias Ringwald 
4718a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE
4719d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
4720beceeddeSMatthias Ringwald                     // free whitelist entries
47219956955bSMatthias Ringwald                     {
4722665d90f2SMatthias Ringwald                         btstack_linked_list_iterator_t lit;
4723665d90f2SMatthias Ringwald                         btstack_linked_list_iterator_init(&lit, &hci_stack->le_whitelist);
4724665d90f2SMatthias Ringwald                         while (btstack_linked_list_iterator_has_next(&lit)){
4725665d90f2SMatthias Ringwald                             whitelist_entry_t * entry = (whitelist_entry_t*) btstack_linked_list_iterator_next(&lit);
4726665d90f2SMatthias Ringwald                             btstack_linked_list_remove(&hci_stack->le_whitelist, (btstack_linked_item_t *) entry);
47279956955bSMatthias Ringwald                             btstack_memory_whitelist_entry_free(entry);
47289956955bSMatthias Ringwald                         }
47299956955bSMatthias Ringwald                     }
47309956955bSMatthias Ringwald #endif
4731d70217a2SMatthias Ringwald #endif
4732c7e0c5f6Smatthias.ringwald                     // close all open connections
47333a9fb326S[email protected]                     connection =  (hci_connection_t *) hci_stack->connections;
4734c7e0c5f6Smatthias.ringwald                     if (connection){
4735711e6c80SMatthias Ringwald                         hci_con_handle_t con_handle = (uint16_t) connection->con_handle;
4736d94d3cafS[email protected]                         if (!hci_can_send_command_packet_now()) return;
473732ab9390Smatthias.ringwald 
47388fca890eSMatthias Ringwald                         // check state
47398fca890eSMatthias Ringwald                         if (connection->state == SENT_DISCONNECT) return;
47408fca890eSMatthias Ringwald                         connection->state = SENT_DISCONNECT;
47418fca890eSMatthias Ringwald 
47428837e9efSMatthias Ringwald                         log_info("HCI_STATE_HALTING, connection %p, handle %u", connection, con_handle);
4743c7e0c5f6Smatthias.ringwald 
47448837e9efSMatthias Ringwald                         // cancel all l2cap connections right away instead of waiting for disconnection complete event ...
47458837e9efSMatthias Ringwald                         hci_emit_disconnection_complete(con_handle, 0x16); // terminated by local host
47468837e9efSMatthias Ringwald 
47478837e9efSMatthias Ringwald                         // ... which would be ignored anyway as we shutdown (free) the connection now
4748c7e0c5f6Smatthias.ringwald                         hci_shutdown_connection(connection);
47498837e9efSMatthias Ringwald 
47508837e9efSMatthias Ringwald                         // finally, send the disconnect command
47516ef3696aSMatthias Ringwald                         hci_send_cmd(&hci_disconnect, con_handle, ERROR_CODE_REMOTE_USER_TERMINATED_CONNECTION);
4752c7e0c5f6Smatthias.ringwald                         return;
4753c7e0c5f6Smatthias.ringwald                     }
475426fe9592SMatthias Ringwald 
4755beceeddeSMatthias Ringwald                     if (hci_stack->substate == HCI_HALTING_DISCONNECT_ALL_TIMER){
4756beceeddeSMatthias Ringwald                         // no connections left, wait a bit to assert that btstack_cyrpto isn't waiting for an HCI event
4757beceeddeSMatthias Ringwald                         log_info("HCI_STATE_HALTING: wait 50 ms");
475826fe9592SMatthias Ringwald                         hci_stack->substate = HCI_HALTING_W4_TIMER;
4759beceeddeSMatthias Ringwald                         btstack_run_loop_set_timer(&hci_stack->timeout, 50);
476026fe9592SMatthias Ringwald                         btstack_run_loop_set_timer_handler(&hci_stack->timeout, hci_halting_timeout_handler);
476126fe9592SMatthias Ringwald                         btstack_run_loop_add_timer(&hci_stack->timeout);
476226fe9592SMatthias Ringwald                         break;
4763beceeddeSMatthias Ringwald                     }
476426fe9592SMatthias Ringwald 
4765cf373d3aSMatthias Ringwald                     /* fall through */
476626fe9592SMatthias Ringwald 
476726fe9592SMatthias Ringwald                 case HCI_HALTING_CLOSE:
47689da54300S[email protected]                     log_info("HCI_STATE_HALTING, calling off");
4769c7e0c5f6Smatthias.ringwald 
477072ea5239Smatthias.ringwald                     // switch mode
4771c7e0c5f6Smatthias.ringwald                     hci_power_control_off();
47729418f9c9Smatthias.ringwald 
47739da54300S[email protected]                     log_info("HCI_STATE_HALTING, emitting state");
477472ea5239Smatthias.ringwald                     hci_emit_state();
47759da54300S[email protected]                     log_info("HCI_STATE_HALTING, done");
477672ea5239Smatthias.ringwald                     break;
4777beceeddeSMatthias Ringwald 
4778beceeddeSMatthias Ringwald                 case HCI_HALTING_W4_TIMER:
4779beceeddeSMatthias Ringwald                     // keep waiting
4780beceeddeSMatthias Ringwald 
4781beceeddeSMatthias Ringwald                     break;
478226fe9592SMatthias Ringwald                 default:
478326fe9592SMatthias Ringwald                     break;
478426fe9592SMatthias Ringwald             }
478526fe9592SMatthias Ringwald 
478626fe9592SMatthias Ringwald             break;
4787c7e0c5f6Smatthias.ringwald 
478872ea5239Smatthias.ringwald         case HCI_STATE_FALLING_ASLEEP:
47893a9fb326S[email protected]             switch(hci_stack->substate) {
479074b323a9SMatthias Ringwald                 case HCI_FALLING_ASLEEP_DISCONNECT:
47919da54300S[email protected]                     log_info("HCI_STATE_FALLING_ASLEEP");
479272ea5239Smatthias.ringwald                     // close all open connections
47933a9fb326S[email protected]                     connection =  (hci_connection_t *) hci_stack->connections;
479466da7044Smatthias.ringwald 
4795423a3e49SMatthias Ringwald #ifdef HAVE_PLATFORM_IPHONE_OS
479666da7044Smatthias.ringwald                     // don't close connections, if H4 supports power management
4797d0b87befSMatthias Ringwald                     if (btstack_control_iphone_power_management_enabled()){
479866da7044Smatthias.ringwald                         connection = NULL;
479966da7044Smatthias.ringwald                     }
480066da7044Smatthias.ringwald #endif
480172ea5239Smatthias.ringwald                     if (connection){
480232ab9390Smatthias.ringwald 
480372ea5239Smatthias.ringwald                         // send disconnect
4804d94d3cafS[email protected]                         if (!hci_can_send_command_packet_now()) return;
480532ab9390Smatthias.ringwald 
48069da54300S[email protected]                         log_info("HCI_STATE_FALLING_ASLEEP, connection %p, handle %u", connection, (uint16_t)connection->con_handle);
48076ef3696aSMatthias Ringwald                         hci_send_cmd(&hci_disconnect, connection->con_handle, ERROR_CODE_REMOTE_USER_TERMINATED_CONNECTION);
480872ea5239Smatthias.ringwald 
480972ea5239Smatthias.ringwald                         // send disconnected event right away - causes higher layer connections to get closed, too.
481072ea5239Smatthias.ringwald                         hci_shutdown_connection(connection);
481172ea5239Smatthias.ringwald                         return;
481272ea5239Smatthias.ringwald                     }
481372ea5239Smatthias.ringwald 
481492368cd3S[email protected]                     if (hci_classic_supported()){
481589db417bSmatthias.ringwald                         // disable page and inquiry scan
4816d94d3cafS[email protected]                         if (!hci_can_send_command_packet_now()) return;
481732ab9390Smatthias.ringwald 
48189da54300S[email protected]                         log_info("HCI_STATE_HALTING, disabling inq scans");
48193a9fb326S[email protected]                         hci_send_cmd(&hci_write_scan_enable, hci_stack->connectable << 1); // drop inquiry scan but keep page scan
482089db417bSmatthias.ringwald 
482189db417bSmatthias.ringwald                         // continue in next sub state
482274b323a9SMatthias Ringwald                         hci_stack->substate = HCI_FALLING_ASLEEP_W4_WRITE_SCAN_ENABLE;
482389db417bSmatthias.ringwald                         break;
482492368cd3S[email protected]                     }
4825cf373d3aSMatthias Ringwald 
4826cf373d3aSMatthias Ringwald                     /* fall through */
482792368cd3S[email protected] 
482874b323a9SMatthias Ringwald                 case HCI_FALLING_ASLEEP_COMPLETE:
48299da54300S[email protected]                     log_info("HCI_STATE_HALTING, calling sleep");
4830423a3e49SMatthias Ringwald #ifdef HAVE_PLATFORM_IPHONE_OS
483128171530Smatthias.ringwald                     // don't actually go to sleep, if H4 supports power management
4832d0b87befSMatthias Ringwald                     if (btstack_control_iphone_power_management_enabled()){
483328171530Smatthias.ringwald                         // SLEEP MODE reached
48343a9fb326S[email protected]                         hci_stack->state = HCI_STATE_SLEEPING;
483528171530Smatthias.ringwald                         hci_emit_state();
483628171530Smatthias.ringwald                         break;
483728171530Smatthias.ringwald                     }
483828171530Smatthias.ringwald #endif
483972ea5239Smatthias.ringwald                     // switch mode
48403a9fb326S[email protected]                     hci_power_control_sleep();  // changes hci_stack->state to SLEEP
4841c7e0c5f6Smatthias.ringwald                     hci_emit_state();
484228171530Smatthias.ringwald                     break;
484328171530Smatthias.ringwald 
484489db417bSmatthias.ringwald                 default:
484589db417bSmatthias.ringwald                     break;
484689db417bSmatthias.ringwald             }
4847c7e0c5f6Smatthias.ringwald             break;
4848c7e0c5f6Smatthias.ringwald 
48493429f56bSmatthias.ringwald         default:
48503429f56bSmatthias.ringwald             break;
48511f504dbdSmatthias.ringwald     }
48523429f56bSmatthias.ringwald }
485316833f0aSmatthias.ringwald 
485431452debSmatthias.ringwald int hci_send_cmd_packet(uint8_t *packet, int size){
485535454696SMatthias Ringwald     // house-keeping
485635454696SMatthias Ringwald 
485735454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
4858c8e4258aSmatthias.ringwald     bd_addr_t addr;
4859c8e4258aSmatthias.ringwald     hci_connection_t * conn;
4860c123d999SMatthias Ringwald #endif
4861c123d999SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
48626f35bb46SMatthias Ringwald     uint8_t initiator_filter_policy;
48639cbd2215SMatthias Ringwald #endif
4864c8e4258aSmatthias.ringwald 
48656f35bb46SMatthias Ringwald     uint16_t opcode = little_endian_read_16(packet, 0);
48666f35bb46SMatthias Ringwald     switch (opcode) {
48679cbd2215SMatthias Ringwald         case HCI_OPCODE_HCI_WRITE_LOOPBACK_MODE:
48689cbd2215SMatthias Ringwald             hci_stack->loopback_mode = packet[3];
48699cbd2215SMatthias Ringwald             break;
48709cbd2215SMatthias Ringwald 
48719cbd2215SMatthias Ringwald #ifdef ENABLE_CLASSIC
48726f35bb46SMatthias Ringwald         case HCI_OPCODE_HCI_CREATE_CONNECTION:
4873724d70a2SMatthias Ringwald             reverse_bd_addr(&packet[3], addr);
48749da54300S[email protected]             log_info("Create_connection to %s", bd_addr_to_str(addr));
4875c8e4258aSmatthias.ringwald 
4876f16129ceSMatthias Ringwald             conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL);
4877ad83dc6aS[email protected]             if (!conn) {
4878f16129ceSMatthias Ringwald                 conn = create_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL);
487917f1ba2aSmatthias.ringwald                 if (!conn) {
488017f1ba2aSmatthias.ringwald                     // notify client that alloc failed
48812deddeceSMatthias Ringwald                     hci_emit_connection_complete(addr, 0, BTSTACK_MEMORY_ALLOC_FAILED);
4882f5e5741dSMatthias Ringwald                     return -1; // packet not sent to controller
488317f1ba2aSmatthias.ringwald                 }
4884ad83dc6aS[email protected]                 conn->state = SEND_CREATE_CONNECTION;
4885f3e2cd2aSMatthias Ringwald                 conn->role  = HCI_ROLE_MASTER;
4886ad83dc6aS[email protected]             }
4887ad83dc6aS[email protected]             log_info("conn state %u", conn->state);
4888ad83dc6aS[email protected]             switch (conn->state) {
4889ad83dc6aS[email protected]                 // if connection active exists
4890ad83dc6aS[email protected]                 case OPEN:
4891f5e5741dSMatthias Ringwald                     // and OPEN, emit connection complete command
4892274dad91SMatthias Ringwald                     hci_emit_connection_complete(addr, conn->con_handle, 0);
4893f5e5741dSMatthias Ringwald                     return -1; // packet not sent to controller
4894672e36abSMatthias Ringwald                 case RECEIVED_DISCONNECTION_COMPLETE:
4895672e36abSMatthias Ringwald                     // create connection triggered in disconnect complete event, let's do it now
4896672e36abSMatthias Ringwald                     break;
4897ad83dc6aS[email protected]                 case SEND_CREATE_CONNECTION:
4898532f91a5SMatthias Ringwald                     // connection created by hci, e.g. dedicated bonding, but not executed yet, let's do it now
4899532f91a5SMatthias Ringwald                     break;
4900ad83dc6aS[email protected]                 default:
4901ad83dc6aS[email protected]                     // otherwise, just ignore as it is already in the open process
4902f5e5741dSMatthias Ringwald                     return -1; // packet not sent to controller
4903ad83dc6aS[email protected]             }
4904c8e4258aSmatthias.ringwald             conn->state = SENT_CREATE_CONNECTION;
4905229331c6SMatthias Ringwald 
4906229331c6SMatthias Ringwald             // track outgoing connection
4907f16129ceSMatthias Ringwald             hci_stack->outgoing_addr_type = BD_ADDR_TYPE_ACL;
49086535961aSMatthias Ringwald             (void) memcpy(hci_stack->outgoing_addr, addr, 6);
49096f35bb46SMatthias Ringwald             break;
49106f35bb46SMatthias Ringwald         case HCI_OPCODE_HCI_LINK_KEY_REQUEST_REPLY:
49117fde4af9Smatthias.ringwald             hci_add_connection_flags_for_flipped_bd_addr(&packet[3], SENT_LINK_KEY_REPLY);
49126f35bb46SMatthias Ringwald             break;
49136f35bb46SMatthias Ringwald         case HCI_OPCODE_HCI_LINK_KEY_REQUEST_NEGATIVE_REPLY:
49147fde4af9Smatthias.ringwald             hci_add_connection_flags_for_flipped_bd_addr(&packet[3], SENT_LINK_KEY_NEGATIVE_REQUEST);
49156f35bb46SMatthias Ringwald             break;
49166f35bb46SMatthias Ringwald         case HCI_OPCODE_HCI_DELETE_STORED_LINK_KEY:
4917a98592bcSMatthias Ringwald             if (hci_stack->link_key_db) {
4918724d70a2SMatthias Ringwald                 reverse_bd_addr(&packet[3], addr);
4919a98592bcSMatthias Ringwald                 hci_stack->link_key_db->delete_link_key(addr);
49208ef73945Smatthias.ringwald             }
49216f35bb46SMatthias Ringwald             break;
49226f35bb46SMatthias Ringwald         case HCI_OPCODE_HCI_PIN_CODE_REQUEST_NEGATIVE_REPLY:
49236f35bb46SMatthias Ringwald         case HCI_OPCODE_HCI_PIN_CODE_REQUEST_REPLY:
4924724d70a2SMatthias Ringwald             reverse_bd_addr(&packet[3], addr);
4925f16129ceSMatthias Ringwald             conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL);
49266724cd9eS[email protected]             if (conn) {
49276724cd9eS[email protected]                 connectionClearAuthenticationFlags(conn, LEGACY_PAIRING_ACTIVE);
49286724cd9eS[email protected]             }
49296f35bb46SMatthias Ringwald             break;
49306f35bb46SMatthias Ringwald         case HCI_OPCODE_HCI_USER_CONFIRMATION_REQUEST_NEGATIVE_REPLY:
49316f35bb46SMatthias Ringwald         case HCI_OPCODE_HCI_USER_CONFIRMATION_REQUEST_REPLY:
49326f35bb46SMatthias Ringwald         case HCI_OPCODE_HCI_USER_PASSKEY_REQUEST_NEGATIVE_REPLY:
49336f35bb46SMatthias Ringwald         case HCI_OPCODE_HCI_USER_PASSKEY_REQUEST_REPLY:
4934724d70a2SMatthias Ringwald             reverse_bd_addr(&packet[3], addr);
4935f16129ceSMatthias Ringwald             conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL);
49366724cd9eS[email protected]             if (conn) {
49376724cd9eS[email protected]                 connectionClearAuthenticationFlags(conn, SSP_PAIRING_ACTIVE);
49386724cd9eS[email protected]             }
49396f35bb46SMatthias Ringwald             break;
4940ee752bb8SMatthias Ringwald 
49415b7087c7SMatthias Ringwald #if defined (ENABLE_SCO_OVER_HCI) || defined (HAVE_SCO_TRANSPORT)
49426f35bb46SMatthias Ringwald         case HCI_OPCODE_HCI_SETUP_SYNCHRONOUS_CONNECTION:
4943ee752bb8SMatthias Ringwald             // setup_synchronous_connection? Voice setting at offset 22
4944ee752bb8SMatthias Ringwald             // TODO: compare to current setting if sco connection already active
4945ee752bb8SMatthias Ringwald             hci_stack->sco_voice_setting_active = little_endian_read_16(packet, 15);
49466f35bb46SMatthias Ringwald             break;
49476f35bb46SMatthias Ringwald         case HCI_OPCODE_HCI_ACCEPT_SYNCHRONOUS_CONNECTION:
4948ee752bb8SMatthias Ringwald             // accept_synchronus_connection? Voice setting at offset 18
4949ee752bb8SMatthias Ringwald             // TODO: compare to current setting if sco connection already active
4950ee752bb8SMatthias Ringwald             hci_stack->sco_voice_setting_active = little_endian_read_16(packet, 19);
49516f35bb46SMatthias Ringwald             break;
4952ee752bb8SMatthias Ringwald #endif
495335454696SMatthias Ringwald #endif
49544b3e1e19SMatthias Ringwald 
4955a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE
49566f35bb46SMatthias Ringwald         case HCI_OPCODE_HCI_LE_SET_RANDOM_ADDRESS:
4957b95a5a35SMatthias Ringwald             hci_stack->le_random_address_set = 1;
4958b95a5a35SMatthias Ringwald             reverse_bd_addr(&packet[3], hci_stack->le_random_address);
49596f35bb46SMatthias Ringwald             break;
49607e8d8b1dSMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
49616f35bb46SMatthias Ringwald         case HCI_OPCODE_HCI_LE_SET_ADVERTISE_ENABLE:
49625226d7f2SMatthias Ringwald             hci_stack->le_advertisements_active = packet[3] != 0;
49636f35bb46SMatthias Ringwald             break;
4964d70217a2SMatthias Ringwald #endif
4965d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
49666f35bb46SMatthias Ringwald         case HCI_OPCODE_HCI_LE_CREATE_CONNECTION:
4967b04dfa37SMatthias Ringwald             // white list used?
49686f35bb46SMatthias Ringwald             initiator_filter_policy = packet[7];
4969b04dfa37SMatthias Ringwald             switch (initiator_filter_policy) {
4970b04dfa37SMatthias Ringwald                 case 0:
4971b04dfa37SMatthias Ringwald                     // whitelist not used
4972b04dfa37SMatthias Ringwald                     hci_stack->le_connecting_state = LE_CONNECTING_DIRECT;
4973b04dfa37SMatthias Ringwald                     break;
4974b04dfa37SMatthias Ringwald                 case 1:
4975b04dfa37SMatthias Ringwald                     hci_stack->le_connecting_state = LE_CONNECTING_WHITELIST;
4976b04dfa37SMatthias Ringwald                     break;
4977b04dfa37SMatthias Ringwald                 default:
4978b04dfa37SMatthias Ringwald                     log_error("Invalid initiator_filter_policy in LE Create Connection %u", initiator_filter_policy);
4979b04dfa37SMatthias Ringwald                     break;
4980b04dfa37SMatthias Ringwald             }
4981c163146eSMatthias Ringwald             // track outgoing connection
498205002aecSMatthias Ringwald             hci_stack->outgoing_addr_type = (bd_addr_type_t) packet[8]; // peer addres type
4983c163146eSMatthias Ringwald             reverse_bd_addr( &packet[9], hci_stack->outgoing_addr); // peer address
49846f35bb46SMatthias Ringwald             break;
49856f35bb46SMatthias Ringwald         case HCI_OPCODE_HCI_LE_CREATE_CONNECTION_CANCEL:
49866ea9315cSMatthias Ringwald             hci_stack->le_connecting_state = LE_CONNECTING_CANCEL;
49876f35bb46SMatthias Ringwald             break;
49889cbd2215SMatthias Ringwald #endif
49899cbd2215SMatthias Ringwald #endif
49906f35bb46SMatthias Ringwald         default:
49916f35bb46SMatthias Ringwald             break;
4992b04dfa37SMatthias Ringwald     }
499369a97523S[email protected] 
49943a9fb326S[email protected]     hci_stack->num_cmd_packets--;
49955bb5bc3eS[email protected] 
49965bb5bc3eS[email protected]     hci_dump_packet(HCI_COMMAND_DATA_PACKET, 0, packet, size);
4997bfea0222SMatthias Ringwald     return hci_stack->hci_transport->send_packet(HCI_COMMAND_DATA_PACKET, packet, size);
499831452debSmatthias.ringwald }
49998adf0ddaSmatthias.ringwald 
50002bd8b7e7S[email protected] // disconnect because of security block
50012bd8b7e7S[email protected] void hci_disconnect_security_block(hci_con_handle_t con_handle){
50022bd8b7e7S[email protected]     hci_connection_t * connection = hci_connection_for_handle(con_handle);
50032bd8b7e7S[email protected]     if (!connection) return;
50042bd8b7e7S[email protected]     connection->bonding_flags |= BONDING_DISCONNECT_SECURITY_BLOCK;
50052bd8b7e7S[email protected] }
50062bd8b7e7S[email protected] 
50072bd8b7e7S[email protected] 
5008dbe1a790S[email protected] // Configure Secure Simple Pairing
5009dbe1a790S[email protected] 
501035454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
501135454696SMatthias Ringwald 
5012dbe1a790S[email protected] // enable will enable SSP during init
501315a95bd5SMatthias Ringwald void gap_ssp_set_enable(int enable){
50143a9fb326S[email protected]     hci_stack->ssp_enable = enable;
5015dbe1a790S[email protected] }
5016dbe1a790S[email protected] 
501795d71764SMatthias Ringwald static int hci_local_ssp_activated(void){
501815a95bd5SMatthias Ringwald     return gap_ssp_supported() && hci_stack->ssp_enable;
50192bd8b7e7S[email protected] }
50202bd8b7e7S[email protected] 
5021dbe1a790S[email protected] // if set, BTstack will respond to io capability request using authentication requirement
502215a95bd5SMatthias Ringwald void gap_ssp_set_io_capability(int io_capability){
50233a9fb326S[email protected]     hci_stack->ssp_io_capability = io_capability;
5024dbe1a790S[email protected] }
502515a95bd5SMatthias Ringwald void gap_ssp_set_authentication_requirement(int authentication_requirement){
50263a9fb326S[email protected]     hci_stack->ssp_authentication_requirement = authentication_requirement;
5027dbe1a790S[email protected] }
5028dbe1a790S[email protected] 
5029dbe1a790S[email protected] // if set, BTstack will confirm a numberic comparion and enter '000000' if requested
503015a95bd5SMatthias Ringwald void gap_ssp_set_auto_accept(int auto_accept){
50313a9fb326S[email protected]     hci_stack->ssp_auto_accept = auto_accept;
5032dbe1a790S[email protected] }
50335d23aae8SMatthias Ringwald 
50345d23aae8SMatthias Ringwald void gap_secure_connections_enable(bool enable){
50355d23aae8SMatthias Ringwald     hci_stack->secure_connections_enable = enable;
50365d23aae8SMatthias Ringwald }
50375d23aae8SMatthias Ringwald 
503835454696SMatthias Ringwald #endif
5039dbe1a790S[email protected] 
504094be1a66SMatthias Ringwald // va_list part of hci_send_cmd
504194be1a66SMatthias Ringwald int hci_send_cmd_va_arg(const hci_cmd_t * cmd, va_list argptr){
5042d94d3cafS[email protected]     if (!hci_can_send_command_packet_now()){
50439d14b626S[email protected]         log_error("hci_send_cmd called but cannot send packet now");
50449d14b626S[email protected]         return 0;
50459d14b626S[email protected]     }
50469d14b626S[email protected] 
50475127cc62S[email protected]     // for HCI INITIALIZATION
50489da54300S[email protected]     // log_info("hci_send_cmd: opcode %04x", cmd->opcode);
50495127cc62S[email protected]     hci_stack->last_cmd_opcode = cmd->opcode;
50505127cc62S[email protected] 
50519d14b626S[email protected]     hci_reserve_packet_buffer();
50529d14b626S[email protected]     uint8_t * packet = hci_stack->hci_packet_buffer;
505394be1a66SMatthias Ringwald     uint16_t size = hci_cmd_create_from_template(packet, cmd, argptr);
5054bfea0222SMatthias Ringwald     int err = hci_send_cmd_packet(packet, size);
5055bfea0222SMatthias Ringwald 
5056593702caSMatthias Ringwald     // release packet buffer on error or for synchronous transport implementations
5057593702caSMatthias Ringwald     if ((err < 0) || hci_transport_synchronous()){
5058e2d22487SMatthias Ringwald         hci_release_packet_buffer();
5059068b8592SMatthias Ringwald         hci_emit_transport_packet_sent();
5060bfea0222SMatthias Ringwald     }
5061bfea0222SMatthias Ringwald 
5062bfea0222SMatthias Ringwald     return err;
506394be1a66SMatthias Ringwald }
50649d14b626S[email protected] 
506594be1a66SMatthias Ringwald /**
506694be1a66SMatthias Ringwald  * pre: numcmds >= 0 - it's allowed to send a command to the controller
506794be1a66SMatthias Ringwald  */
506894be1a66SMatthias Ringwald int hci_send_cmd(const hci_cmd_t * cmd, ...){
50691cd208adSmatthias.ringwald     va_list argptr;
50701cd208adSmatthias.ringwald     va_start(argptr, cmd);
507194be1a66SMatthias Ringwald     int res = hci_send_cmd_va_arg(cmd, argptr);
50721cd208adSmatthias.ringwald     va_end(argptr);
507394be1a66SMatthias Ringwald     return res;
507493b8dc03Smatthias.ringwald }
5075c8e4258aSmatthias.ringwald 
5076ee091cf1Smatthias.ringwald // Create various non-HCI events.
5077ee091cf1Smatthias.ringwald // TODO: generalize, use table similar to hci_create_command
5078ee091cf1Smatthias.ringwald 
5079d6b06661SMatthias Ringwald static void hci_emit_event(uint8_t * event, uint16_t size, int dump){
5080fb37a842SMatthias Ringwald     // dump packet
5081d6b06661SMatthias Ringwald     if (dump) {
5082300c1ba4SMatthias Ringwald         hci_dump_packet( HCI_EVENT_PACKET, 0, event, size);
5083d6b06661SMatthias Ringwald     }
50841ef6bb52SMatthias Ringwald 
5085fb37a842SMatthias Ringwald     // dispatch to all event handlers
50861ef6bb52SMatthias Ringwald     btstack_linked_list_iterator_t it;
50871ef6bb52SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->event_handlers);
50881ef6bb52SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
50891ef6bb52SMatthias Ringwald         btstack_packet_callback_registration_t * entry = (btstack_packet_callback_registration_t*) btstack_linked_list_iterator_next(&it);
5090d9a7306aSMatthias Ringwald         entry->callback(HCI_EVENT_PACKET, 0, event, size);
50911ef6bb52SMatthias Ringwald     }
5092d6b06661SMatthias Ringwald }
5093d6b06661SMatthias Ringwald 
5094d6b06661SMatthias Ringwald static void hci_emit_acl_packet(uint8_t * packet, uint16_t size){
5095fb37a842SMatthias Ringwald     if (!hci_stack->acl_packet_handler) return;
50963d50b4baSMatthias Ringwald     hci_stack->acl_packet_handler(HCI_ACL_DATA_PACKET, 0, packet, size);
5097d6b06661SMatthias Ringwald }
5098d6b06661SMatthias Ringwald 
509935454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
5100701e3307SMatthias Ringwald static void hci_notify_if_sco_can_send_now(void){
51013bc639ceSMatthias Ringwald     // notify SCO sender if waiting
5102701e3307SMatthias Ringwald     if (!hci_stack->sco_waiting_for_can_send_now) return;
5103701e3307SMatthias Ringwald     if (hci_can_send_sco_packet_now()){
51043bc639ceSMatthias Ringwald         hci_stack->sco_waiting_for_can_send_now = 0;
5105701e3307SMatthias Ringwald         uint8_t event[2] = { HCI_EVENT_SCO_CAN_SEND_NOW, 0 };
5106701e3307SMatthias Ringwald         hci_dump_packet(HCI_EVENT_PACKET, 1, event, sizeof(event));
51073d50b4baSMatthias Ringwald         hci_stack->sco_packet_handler(HCI_EVENT_PACKET, 0, event, sizeof(event));
51083bc639ceSMatthias Ringwald     }
51093bc639ceSMatthias Ringwald }
51101cfb383eSMatthias Ringwald 
51111cfb383eSMatthias Ringwald // parsing end emitting has been merged to reduce code size
51129784dac1SMatthias Ringwald static void gap_inquiry_explode(uint8_t *packet, uint16_t size) {
5113ac9136ccSMatthias Ringwald     uint8_t event[28+GAP_INQUIRY_MAX_NAME_LEN];
51141cfb383eSMatthias Ringwald 
51151cfb383eSMatthias Ringwald     uint8_t * eir_data;
51161cfb383eSMatthias Ringwald     ad_context_t context;
51171cfb383eSMatthias Ringwald     const uint8_t * name;
51181cfb383eSMatthias Ringwald     uint8_t         name_len;
51191cfb383eSMatthias Ringwald 
51209784dac1SMatthias Ringwald     if (size < 3) return;
51219784dac1SMatthias Ringwald 
51221cfb383eSMatthias Ringwald     int event_type = hci_event_packet_get_type(packet);
5123a1df452eSMatthias Ringwald     int num_reserved_fields = (event_type == HCI_EVENT_INQUIRY_RESULT) ? 2 : 1;    // 2 for old event, 1 otherwise
51241cfb383eSMatthias Ringwald     int num_responses       = hci_event_inquiry_result_get_num_responses(packet);
51251cfb383eSMatthias Ringwald 
51269784dac1SMatthias Ringwald     switch (event_type){
51279784dac1SMatthias Ringwald         case HCI_EVENT_INQUIRY_RESULT:
51289784dac1SMatthias Ringwald         case HCI_EVENT_INQUIRY_RESULT_WITH_RSSI:
51299784dac1SMatthias Ringwald             if (size != (3 + (num_responses * 14))) return;
51309784dac1SMatthias Ringwald             break;
51319784dac1SMatthias Ringwald         case HCI_EVENT_EXTENDED_INQUIRY_RESPONSE:
51329784dac1SMatthias Ringwald             if (size != 257) return;
51339784dac1SMatthias Ringwald             if (num_responses != 1) return;
51349784dac1SMatthias Ringwald             break;
51359784dac1SMatthias Ringwald         default:
51369784dac1SMatthias Ringwald             return;
51379784dac1SMatthias Ringwald     }
51389784dac1SMatthias Ringwald 
51391cfb383eSMatthias Ringwald     // event[1] is set at the end
51401cfb383eSMatthias Ringwald     int i;
51411cfb383eSMatthias Ringwald     for (i=0; i<num_responses;i++){
51421cfb383eSMatthias Ringwald         memset(event, 0, sizeof(event));
51431cfb383eSMatthias Ringwald         event[0] = GAP_EVENT_INQUIRY_RESULT;
51441cfb383eSMatthias Ringwald         uint8_t event_size = 18;    // if name is not set by EIR
51451cfb383eSMatthias Ringwald 
51466535961aSMatthias Ringwald         (void)memcpy(&event[2], &packet[3 + (i * 6)], 6); // bd_addr
51470e588213SMatthias Ringwald         event[8] =          packet[3 + (num_responses*(6))                         + (i*1)];     // page_scan_repetition_mode
51486535961aSMatthias Ringwald         (void)memcpy(&event[9],
51496535961aSMatthias Ringwald                      &packet[3 + (num_responses * (6 + 1 + num_reserved_fields)) + (i * 3)],
51506535961aSMatthias Ringwald                      3); // class of device
51516535961aSMatthias Ringwald         (void)memcpy(&event[12],
51526535961aSMatthias Ringwald                      &packet[3 + (num_responses * (6 + 1 + num_reserved_fields + 3)) + (i * 2)],
51536535961aSMatthias Ringwald                      2); // clock offset
51541cfb383eSMatthias Ringwald 
51551cfb383eSMatthias Ringwald         switch (event_type){
51561cfb383eSMatthias Ringwald             case HCI_EVENT_INQUIRY_RESULT:
51571cfb383eSMatthias Ringwald                 // 14,15,16,17 = 0, size 18
51581cfb383eSMatthias Ringwald                 break;
51591cfb383eSMatthias Ringwald             case HCI_EVENT_INQUIRY_RESULT_WITH_RSSI:
51601cfb383eSMatthias Ringwald                 event[14] = 1;
5161a1df452eSMatthias Ringwald                 event[15] = packet [3 + (num_responses*(6+1+num_reserved_fields+3+2)) + (i*1)]; // rssi
51621cfb383eSMatthias Ringwald                 // 16,17 = 0, size 18
51631cfb383eSMatthias Ringwald                 break;
51641cfb383eSMatthias Ringwald             case HCI_EVENT_EXTENDED_INQUIRY_RESPONSE:
51651cfb383eSMatthias Ringwald                 event[14] = 1;
5166a1df452eSMatthias Ringwald                 event[15] = packet [3 + (num_responses*(6+1+num_reserved_fields+3+2)) + (i*1)]; // rssi
516779186815SMatthias Ringwald                 // EIR packets only contain a single inquiry response
51681cfb383eSMatthias Ringwald                 eir_data = &packet[3 + (6+1+num_reserved_fields+3+2+1)];
51691cfb383eSMatthias Ringwald                 name = NULL;
5170a8c4e5adSMatthias Ringwald                 // Iterate over EIR data
5171a8c4e5adSMatthias Ringwald                 for (ad_iterator_init(&context, EXTENDED_INQUIRY_RESPONSE_DATA_LEN, eir_data) ; ad_iterator_has_more(&context) ; ad_iterator_next(&context)){
51721cfb383eSMatthias Ringwald                     uint8_t data_type    = ad_iterator_get_data_type(&context);
51731cfb383eSMatthias Ringwald                     uint8_t data_size    = ad_iterator_get_data_len(&context);
51741cfb383eSMatthias Ringwald                     const uint8_t * data = ad_iterator_get_data(&context);
5175ac9136ccSMatthias Ringwald                     // Prefer Complete Local Name over Shortened Local Name
51761cfb383eSMatthias Ringwald                     switch (data_type){
51771cfb383eSMatthias Ringwald                         case BLUETOOTH_DATA_TYPE_SHORTENED_LOCAL_NAME:
51781cfb383eSMatthias Ringwald                             if (name) continue;
5179cf373d3aSMatthias Ringwald                             /* fall through */
51801cfb383eSMatthias Ringwald                         case BLUETOOTH_DATA_TYPE_COMPLETE_LOCAL_NAME:
51811cfb383eSMatthias Ringwald                             name = data;
51821cfb383eSMatthias Ringwald                             name_len = data_size;
51831cfb383eSMatthias Ringwald                             break;
5184ac9136ccSMatthias Ringwald                         case BLUETOOTH_DATA_TYPE_DEVICE_ID:
5185ac9136ccSMatthias Ringwald                             if (data_size != 8) break;
5186ac9136ccSMatthias Ringwald                             event[16] = 1;
51873c0c7fefSMatthias Ringwald                             memcpy(&event[17], data, 8);
5188ac9136ccSMatthias Ringwald                             break;
51891cfb383eSMatthias Ringwald                         default:
51901cfb383eSMatthias Ringwald                             break;
51911cfb383eSMatthias Ringwald                     }
51921cfb383eSMatthias Ringwald                 }
51931cfb383eSMatthias Ringwald                 if (name){
5194ac9136ccSMatthias Ringwald                     event[25] = 1;
51951cfb383eSMatthias Ringwald                     // truncate name if needed
51961cfb383eSMatthias Ringwald                     int len = btstack_min(name_len, GAP_INQUIRY_MAX_NAME_LEN);
5197ac9136ccSMatthias Ringwald                     event[26] = len;
5198ac9136ccSMatthias Ringwald                     (void)memcpy(&event[27], name, len);
51991cfb383eSMatthias Ringwald                     event_size += len;
52001cfb383eSMatthias Ringwald                 }
52011cfb383eSMatthias Ringwald                 break;
52027bbeb3adSMilanka Ringwald             default:
52037bbeb3adSMilanka Ringwald                 return;
52041cfb383eSMatthias Ringwald         }
52051cfb383eSMatthias Ringwald         event[1] = event_size - 2;
52061cfb383eSMatthias Ringwald         hci_emit_event(event, event_size, 1);
52071cfb383eSMatthias Ringwald     }
52081cfb383eSMatthias Ringwald }
520935454696SMatthias Ringwald #endif
52103bc639ceSMatthias Ringwald 
521171de195eSMatthias Ringwald void hci_emit_state(void){
52123a9fb326S[email protected]     log_info("BTSTACK_EVENT_STATE %u", hci_stack->state);
5213425d1371Smatthias.ringwald     uint8_t event[3];
521480d52d6bSmatthias.ringwald     event[0] = BTSTACK_EVENT_STATE;
52154ea43905SMatthias Ringwald     event[1] = sizeof(event) - 2u;
52163a9fb326S[email protected]     event[2] = hci_stack->state;
5217d6b06661SMatthias Ringwald     hci_emit_event(event, sizeof(event), 1);
5218c8e4258aSmatthias.ringwald }
5219c8e4258aSmatthias.ringwald 
522035454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
52212deddeceSMatthias Ringwald static void hci_emit_connection_complete(bd_addr_t address, hci_con_handle_t con_handle, uint8_t status){
5222425d1371Smatthias.ringwald     uint8_t event[13];
5223c8e4258aSmatthias.ringwald     event[0] = HCI_EVENT_CONNECTION_COMPLETE;
5224425d1371Smatthias.ringwald     event[1] = sizeof(event) - 2;
522517f1ba2aSmatthias.ringwald     event[2] = status;
52262deddeceSMatthias Ringwald     little_endian_store_16(event, 3, con_handle);
52272deddeceSMatthias Ringwald     reverse_bd_addr(address, &event[5]);
5228c8e4258aSmatthias.ringwald     event[11] = 1; // ACL connection
5229c8e4258aSmatthias.ringwald     event[12] = 0; // encryption disabled
5230d6b06661SMatthias Ringwald     hci_emit_event(event, sizeof(event), 1);
5231c8e4258aSmatthias.ringwald }
523252db98b2SMatthias Ringwald static void hci_emit_l2cap_check_timeout(hci_connection_t *conn){
523352db98b2SMatthias Ringwald     if (disable_l2cap_timeouts) return;
523452db98b2SMatthias Ringwald     log_info("L2CAP_EVENT_TIMEOUT_CHECK");
523552db98b2SMatthias Ringwald     uint8_t event[4];
523652db98b2SMatthias Ringwald     event[0] = L2CAP_EVENT_TIMEOUT_CHECK;
523752db98b2SMatthias Ringwald     event[1] = sizeof(event) - 2;
523852db98b2SMatthias Ringwald     little_endian_store_16(event, 2, conn->con_handle);
523952db98b2SMatthias Ringwald     hci_emit_event(event, sizeof(event), 1);
524052db98b2SMatthias Ringwald }
524135454696SMatthias Ringwald #endif
5242c8e4258aSmatthias.ringwald 
524335454696SMatthias Ringwald #ifdef ENABLE_BLE
5244d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
5245667ba9d1SMatthias 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){
52464f3229d8S[email protected]     uint8_t event[21];
52474f3229d8S[email protected]     event[0] = HCI_EVENT_LE_META;
52484ea43905SMatthias Ringwald     event[1] = sizeof(event) - 2u;
52494f3229d8S[email protected]     event[2] = HCI_SUBEVENT_LE_CONNECTION_COMPLETE;
52504f3229d8S[email protected]     event[3] = status;
5251fc64f94aSMatthias Ringwald     little_endian_store_16(event, 4, con_handle);
52524f3229d8S[email protected]     event[6] = 0; // TODO: role
52536e2e9a6bS[email protected]     event[7] = address_type;
5254724d70a2SMatthias Ringwald     reverse_bd_addr(address, &event[8]);
5255f8fbdce0SMatthias Ringwald     little_endian_store_16(event, 14, 0); // interval
5256f8fbdce0SMatthias Ringwald     little_endian_store_16(event, 16, 0); // latency
5257f8fbdce0SMatthias Ringwald     little_endian_store_16(event, 18, 0); // supervision timeout
52584f3229d8S[email protected]     event[20] = 0; // master clock accuracy
5259d6b06661SMatthias Ringwald     hci_emit_event(event, sizeof(event), 1);
52604f3229d8S[email protected] }
526135454696SMatthias Ringwald #endif
5262d70217a2SMatthias Ringwald #endif
52634f3229d8S[email protected] 
5264fd43c0e0SMatthias Ringwald static void hci_emit_transport_packet_sent(void){
5265fd43c0e0SMatthias Ringwald     // notify upper stack that it might be possible to send again
5266fd43c0e0SMatthias Ringwald     uint8_t event[] = { HCI_EVENT_TRANSPORT_PACKET_SENT, 0};
5267fd43c0e0SMatthias Ringwald     hci_emit_event(&event[0], sizeof(event), 0);  // don't dump
5268fd43c0e0SMatthias Ringwald }
5269fd43c0e0SMatthias Ringwald 
5270fc64f94aSMatthias Ringwald static void hci_emit_disconnection_complete(hci_con_handle_t con_handle, uint8_t reason){
5271425d1371Smatthias.ringwald     uint8_t event[6];
52723c4d4b90Smatthias.ringwald     event[0] = HCI_EVENT_DISCONNECTION_COMPLETE;
52734ea43905SMatthias Ringwald     event[1] = sizeof(event) - 2u;
52743c4d4b90Smatthias.ringwald     event[2] = 0; // status = OK
5275fc64f94aSMatthias Ringwald     little_endian_store_16(event, 3, con_handle);
52763c4d4b90Smatthias.ringwald     event[5] = reason;
5277d6b06661SMatthias Ringwald     hci_emit_event(event, sizeof(event), 1);
52783c4d4b90Smatthias.ringwald }
52793c4d4b90Smatthias.ringwald 
5280b83d5eabSMatthias Ringwald static void hci_emit_nr_connections_changed(void){
5281e0abb8e7S[email protected]     log_info("BTSTACK_EVENT_NR_CONNECTIONS_CHANGED %u", nr_hci_connections());
5282425d1371Smatthias.ringwald     uint8_t event[3];
528380d52d6bSmatthias.ringwald     event[0] = BTSTACK_EVENT_NR_CONNECTIONS_CHANGED;
52844ea43905SMatthias Ringwald     event[1] = sizeof(event) - 2u;
528543bfb1bdSmatthias.ringwald     event[2] = nr_hci_connections();
5286d6b06661SMatthias Ringwald     hci_emit_event(event, sizeof(event), 1);
528743bfb1bdSmatthias.ringwald }
5288038bc64cSmatthias.ringwald 
5289b83d5eabSMatthias Ringwald static void hci_emit_hci_open_failed(void){
5290e0abb8e7S[email protected]     log_info("BTSTACK_EVENT_POWERON_FAILED");
5291425d1371Smatthias.ringwald     uint8_t event[2];
529280d52d6bSmatthias.ringwald     event[0] = BTSTACK_EVENT_POWERON_FAILED;
52934ea43905SMatthias Ringwald     event[1] = sizeof(event) - 2u;
5294d6b06661SMatthias Ringwald     hci_emit_event(event, sizeof(event), 1);
5295038bc64cSmatthias.ringwald }
52961b0e3922Smatthias.ringwald 
529735454696SMatthias Ringwald static void hci_emit_dedicated_bonding_result(bd_addr_t address, uint8_t status){
529835454696SMatthias Ringwald     log_info("hci_emit_dedicated_bonding_result %u ", status);
529935454696SMatthias Ringwald     uint8_t event[9];
530035454696SMatthias Ringwald     int pos = 0;
530135454696SMatthias Ringwald     event[pos++] = GAP_EVENT_DEDICATED_BONDING_COMPLETED;
53024ea43905SMatthias Ringwald     event[pos++] = sizeof(event) - 2u;
530335454696SMatthias Ringwald     event[pos++] = status;
530435454696SMatthias Ringwald     reverse_bd_addr(address, &event[pos]);
5305d6b06661SMatthias Ringwald     hci_emit_event(event, sizeof(event), 1);
5306381fbed8Smatthias.ringwald }
5307458bf4e8S[email protected] 
530835454696SMatthias Ringwald 
530935454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
531035454696SMatthias Ringwald 
5311b83d5eabSMatthias Ringwald static void hci_emit_security_level(hci_con_handle_t con_handle, gap_security_level_t level){
5312df3354fcS[email protected]     log_info("hci_emit_security_level %u for handle %x", level, con_handle);
5313a00031e2S[email protected]     uint8_t event[5];
5314e00caf9cS[email protected]     int pos = 0;
53155611a760SMatthias Ringwald     event[pos++] = GAP_EVENT_SECURITY_LEVEL;
5316e00caf9cS[email protected]     event[pos++] = sizeof(event) - 2;
5317f8fbdce0SMatthias Ringwald     little_endian_store_16(event, 2, con_handle);
5318e00caf9cS[email protected]     pos += 2;
5319e00caf9cS[email protected]     event[pos++] = level;
5320d6b06661SMatthias Ringwald     hci_emit_event(event, sizeof(event), 1);
5321e00caf9cS[email protected] }
5322e00caf9cS[email protected] 
532335454696SMatthias Ringwald static gap_security_level_t gap_security_level_for_connection(hci_connection_t * connection){
532435454696SMatthias Ringwald     if (!connection) return LEVEL_0;
532535454696SMatthias Ringwald     if ((connection->authentication_flags & CONNECTION_ENCRYPTED) == 0) return LEVEL_0;
5326fcaf38b9SMatthias Ringwald     // BIAS: we only consider Authenticated if the connection is already encrypted, which requires that both sides have link key
5327abdad579SMatthias Ringwald     if ((connection->authentication_flags & CONNECTION_AUTHENTICATED) == 0) return LEVEL_0;
5328170fafaeSMatthias Ringwald     if (connection->encryption_key_size < hci_stack->gap_required_encyrption_key_size) return LEVEL_0;
53294051b7ffSMatthias Ringwald     gap_security_level_t security_level = gap_security_level_for_link_key_type(connection->link_key_type);
5330170fafaeSMatthias Ringwald     // LEVEL 4 always requires 128 bit encrytion key size
53310e588213SMatthias Ringwald     if ((security_level == LEVEL_4) && (connection->encryption_key_size < 16)){
5332170fafaeSMatthias Ringwald         security_level = LEVEL_3;
5333170fafaeSMatthias Ringwald     }
5334170fafaeSMatthias Ringwald     return security_level;
533535454696SMatthias Ringwald }
533635454696SMatthias Ringwald 
533735454696SMatthias Ringwald static void hci_emit_discoverable_enabled(uint8_t enabled){
533835454696SMatthias Ringwald     log_info("BTSTACK_EVENT_DISCOVERABLE_ENABLED %u", enabled);
533935454696SMatthias Ringwald     uint8_t event[3];
534035454696SMatthias Ringwald     event[0] = BTSTACK_EVENT_DISCOVERABLE_ENABLED;
534135454696SMatthias Ringwald     event[1] = sizeof(event) - 2;
534235454696SMatthias Ringwald     event[2] = enabled;
5343d6b06661SMatthias Ringwald     hci_emit_event(event, sizeof(event), 1);
5344ad83dc6aS[email protected] }
5345ad83dc6aS[email protected] 
534698a2fd1cSMatthias Ringwald // query if remote side supports eSCO
5347073bd0faSMatthias Ringwald int hci_remote_esco_supported(hci_con_handle_t con_handle){
534898a2fd1cSMatthias Ringwald     hci_connection_t * connection = hci_connection_for_handle(con_handle);
534998a2fd1cSMatthias Ringwald     if (!connection) return 0;
535076ccfb2aSMatthias Ringwald     return (connection->remote_supported_features[0] & 1) != 0;
535198a2fd1cSMatthias Ringwald }
535298a2fd1cSMatthias Ringwald 
535367aae551SMatthias Ringwald static bool hci_ssp_supported(hci_connection_t * connection){
535467aae551SMatthias Ringwald     const uint8_t mask = BONDING_REMOTE_SUPPORTS_SSP_CONTROLLER | BONDING_REMOTE_SUPPORTS_SSP_HOST;
535567aae551SMatthias Ringwald     return (connection->bonding_flags & mask) == mask;
535667aae551SMatthias Ringwald }
535767aae551SMatthias Ringwald 
53582bd8b7e7S[email protected] // query if remote side supports SSP
53592bd8b7e7S[email protected] int hci_remote_ssp_supported(hci_con_handle_t con_handle){
53602bd8b7e7S[email protected]     hci_connection_t * connection = hci_connection_for_handle(con_handle);
53612bd8b7e7S[email protected]     if (!connection) return 0;
536267aae551SMatthias Ringwald     return hci_ssp_supported(connection) ? 1 : 0;
53632bd8b7e7S[email protected] }
53642bd8b7e7S[email protected] 
536515a95bd5SMatthias Ringwald int gap_ssp_supported_on_both_sides(hci_con_handle_t handle){
5366df3354fcS[email protected]     return hci_local_ssp_activated() && hci_remote_ssp_supported(handle);
5367df3354fcS[email protected] }
5368df3354fcS[email protected] 
5369458bf4e8S[email protected] // GAP API
5370458bf4e8S[email protected] /**
5371458bf4e8S[email protected]  * @bbrief enable/disable bonding. default is enabled
5372458bf4e8S[email protected]  * @praram enabled
5373458bf4e8S[email protected]  */
53744c57c146S[email protected] void gap_set_bondable_mode(int enable){
53753a9fb326S[email protected]     hci_stack->bondable = enable ? 1 : 0;
5376458bf4e8S[email protected] }
53774ef6443cSMatthias Ringwald /**
53784ef6443cSMatthias Ringwald  * @brief Get bondable mode.
53794ef6443cSMatthias Ringwald  * @return 1 if bondable
53804ef6443cSMatthias Ringwald  */
53814ef6443cSMatthias Ringwald int gap_get_bondable_mode(void){
53824ef6443cSMatthias Ringwald     return hci_stack->bondable;
53834ef6443cSMatthias Ringwald }
5384cb230b9dS[email protected] 
5385cb230b9dS[email protected] /**
538634d2123cS[email protected]  * @brief map link keys to security levels
5387cb230b9dS[email protected]  */
538834d2123cS[email protected] gap_security_level_t gap_security_level_for_link_key_type(link_key_type_t link_key_type){
538934d2123cS[email protected]     switch (link_key_type){
53903c68dfa9S[email protected]         case AUTHENTICATED_COMBINATION_KEY_GENERATED_FROM_P256:
53913c68dfa9S[email protected]             return LEVEL_4;
53923c68dfa9S[email protected]         case COMBINATION_KEY:
53933c68dfa9S[email protected]         case AUTHENTICATED_COMBINATION_KEY_GENERATED_FROM_P192:
53943c68dfa9S[email protected]             return LEVEL_3;
53953c68dfa9S[email protected]         default:
53963c68dfa9S[email protected]             return LEVEL_2;
53973c68dfa9S[email protected]     }
5398cb230b9dS[email protected] }
5399cb230b9dS[email protected] 
54008b35e16aSMatthias Ringwald /**
54018b35e16aSMatthias Ringwald  * @brief map link keys to secure connection yes/no
54028b35e16aSMatthias Ringwald  */
54038b35e16aSMatthias Ringwald int gap_secure_connection_for_link_key_type(link_key_type_t link_key_type){
54048b35e16aSMatthias Ringwald     switch (link_key_type){
54058b35e16aSMatthias Ringwald         case AUTHENTICATED_COMBINATION_KEY_GENERATED_FROM_P256:
54068b35e16aSMatthias Ringwald         case UNAUTHENTICATED_COMBINATION_KEY_GENERATED_FROM_P256:
54078b35e16aSMatthias Ringwald             return 1;
54088b35e16aSMatthias Ringwald         default:
54098b35e16aSMatthias Ringwald             return 0;
54108b35e16aSMatthias Ringwald     }
54118b35e16aSMatthias Ringwald }
54128b35e16aSMatthias Ringwald 
54138b35e16aSMatthias Ringwald /**
54148b35e16aSMatthias Ringwald  * @brief map link keys to authenticated
54158b35e16aSMatthias Ringwald  */
54168b35e16aSMatthias Ringwald int gap_authenticated_for_link_key_type(link_key_type_t link_key_type){
54178b35e16aSMatthias Ringwald     switch (link_key_type){
54188b35e16aSMatthias Ringwald         case AUTHENTICATED_COMBINATION_KEY_GENERATED_FROM_P256:
54198b35e16aSMatthias Ringwald         case AUTHENTICATED_COMBINATION_KEY_GENERATED_FROM_P192:
54208b35e16aSMatthias Ringwald             return 1;
54218b35e16aSMatthias Ringwald         default:
54228b35e16aSMatthias Ringwald             return 0;
54238b35e16aSMatthias Ringwald     }
54248b35e16aSMatthias Ringwald }
54258b35e16aSMatthias Ringwald 
5426106d6d11S[email protected] int gap_mitm_protection_required_for_security_level(gap_security_level_t level){
54275127cc62S[email protected]     log_info("gap_mitm_protection_required_for_security_level %u", level);
5428106d6d11S[email protected]     return level > LEVEL_2;
5429106d6d11S[email protected] }
5430106d6d11S[email protected] 
543134d2123cS[email protected] /**
543234d2123cS[email protected]  * @brief get current security level
543334d2123cS[email protected]  */
543434d2123cS[email protected] gap_security_level_t gap_security_level(hci_con_handle_t con_handle){
543534d2123cS[email protected]     hci_connection_t * connection = hci_connection_for_handle(con_handle);
543634d2123cS[email protected]     if (!connection) return LEVEL_0;
543734d2123cS[email protected]     return gap_security_level_for_connection(connection);
543834d2123cS[email protected] }
543934d2123cS[email protected] 
5440cb230b9dS[email protected] /**
5441cb230b9dS[email protected]  * @brief request connection to device to
5442cb230b9dS[email protected]  * @result GAP_AUTHENTICATION_RESULT
5443cb230b9dS[email protected]  */
544434d2123cS[email protected] void gap_request_security_level(hci_con_handle_t con_handle, gap_security_level_t requested_level){
544534d2123cS[email protected]     hci_connection_t * connection = hci_connection_for_handle(con_handle);
544634d2123cS[email protected]     if (!connection){
5447a00031e2S[email protected]         hci_emit_security_level(con_handle, LEVEL_0);
544834d2123cS[email protected]         return;
544934d2123cS[email protected]     }
5450defbf200SMatthias Ringwald 
5451defbf200SMatthias Ringwald     btstack_assert(hci_is_le_connection(connection) == false);
5452defbf200SMatthias Ringwald 
545334d2123cS[email protected]     gap_security_level_t current_level = gap_security_level(con_handle);
545483d08d7cSMatthias Ringwald     log_info("gap_request_security_level requested level %u, planned level %u, current level %u",
545583d08d7cSMatthias Ringwald         requested_level, connection->requested_security_level, current_level);
545683d08d7cSMatthias Ringwald 
5457dbd5dcc3SMatthias Ringwald     // authentication active if authentication request was sent or planned level > 0
5458dbd5dcc3SMatthias Ringwald     bool authentication_active = ((connection->bonding_flags & BONDING_SENT_AUTHENTICATE_REQUEST) != 0) || (connection->requested_security_level > LEVEL_0);
5459dbd5dcc3SMatthias Ringwald     if (authentication_active){
54601cf0a6c8SMatthias Ringwald         // authentication already active
546183d08d7cSMatthias Ringwald         if (connection->requested_security_level < requested_level){
546283d08d7cSMatthias Ringwald             // increase requested level as new level is higher
546383d08d7cSMatthias Ringwald             // TODO: handle re-authentication when done
546483d08d7cSMatthias Ringwald             connection->requested_security_level = requested_level;
546583d08d7cSMatthias Ringwald         }
54661cf0a6c8SMatthias Ringwald     } else {
546783d08d7cSMatthias Ringwald         // no request active, notify if security sufficient
546883d08d7cSMatthias Ringwald         if (requested_level <= current_level){
5469a00031e2S[email protected]             hci_emit_security_level(con_handle, current_level);
547034d2123cS[email protected]             return;
547134d2123cS[email protected]         }
5472a00031e2S[email protected] 
5473e060c07dSMatthias Ringwald         // store request
547434d2123cS[email protected]         connection->requested_security_level = requested_level;
5475a00031e2S[email protected] 
54761cf0a6c8SMatthias Ringwald         // start to authenticate connection
54771eb2563eS[email protected]         connection->bonding_flags |= BONDING_SEND_AUTHENTICATE_REQUEST;
5478e80b2cf9S[email protected]         hci_run();
5479e00caf9cS[email protected]     }
54801cf0a6c8SMatthias Ringwald }
5481ad83dc6aS[email protected] 
5482ad83dc6aS[email protected] /**
5483ad83dc6aS[email protected]  * @brief start dedicated bonding with device. disconnect after bonding
5484ad83dc6aS[email protected]  * @param device
5485ad83dc6aS[email protected]  * @param request MITM protection
5486ad83dc6aS[email protected]  * @result GAP_DEDICATED_BONDING_COMPLETE
5487ad83dc6aS[email protected]  */
5488ad83dc6aS[email protected] int gap_dedicated_bonding(bd_addr_t device, int mitm_protection_required){
5489ad83dc6aS[email protected] 
5490ad83dc6aS[email protected]     // create connection state machine
5491f16129ceSMatthias Ringwald     hci_connection_t * connection = create_connection_for_bd_addr_and_type(device, BD_ADDR_TYPE_ACL);
5492ad83dc6aS[email protected] 
5493ad83dc6aS[email protected]     if (!connection){
5494ad83dc6aS[email protected]         return BTSTACK_MEMORY_ALLOC_FAILED;
5495ad83dc6aS[email protected]     }
5496ad83dc6aS[email protected] 
5497ad83dc6aS[email protected]     // delete linkn key
549815a95bd5SMatthias Ringwald     gap_drop_link_key_for_bd_addr(device);
5499ad83dc6aS[email protected] 
5500ad83dc6aS[email protected]     // configure LEVEL_2/3, dedicated bonding
5501ad83dc6aS[email protected]     connection->state = SEND_CREATE_CONNECTION;
5502ad83dc6aS[email protected]     connection->requested_security_level = mitm_protection_required ? LEVEL_3 : LEVEL_2;
5503f04a0c31SMatthias Ringwald     log_info("gap_dedicated_bonding, mitm %d -> level %u", mitm_protection_required, connection->requested_security_level);
5504ad83dc6aS[email protected]     connection->bonding_flags = BONDING_DEDICATED;
5505ad83dc6aS[email protected] 
5506ad83dc6aS[email protected]     // wait for GAP Security Result and send GAP Dedicated Bonding complete
5507ad83dc6aS[email protected] 
5508ad83dc6aS[email protected]     // handle: connnection failure (connection complete != ok)
5509ad83dc6aS[email protected]     // handle: authentication failure
5510ad83dc6aS[email protected]     // handle: disconnect on done
5511ad83dc6aS[email protected] 
5512ad83dc6aS[email protected]     hci_run();
5513ad83dc6aS[email protected] 
5514ad83dc6aS[email protected]     return 0;
5515ad83dc6aS[email protected] }
551635454696SMatthias Ringwald #endif
55178e618f72S[email protected] 
55188e618f72S[email protected] void gap_set_local_name(const char * local_name){
55198e618f72S[email protected]     hci_stack->local_name = local_name;
55208e618f72S[email protected] }
55218e618f72S[email protected] 
552235454696SMatthias Ringwald 
552335454696SMatthias Ringwald #ifdef ENABLE_BLE
552435454696SMatthias Ringwald 
5525d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
5526d8e8f12aSMatthias Ringwald void gap_start_scan(void){
5527fde725feSMatthias Ringwald     hci_stack->le_scanning_enabled = true;
55287bdc6798S[email protected]     hci_run();
55297bdc6798S[email protected] }
55308e618f72S[email protected] 
5531d8e8f12aSMatthias Ringwald void gap_stop_scan(void){
5532fde725feSMatthias Ringwald     hci_stack->le_scanning_enabled = false;
55337bdc6798S[email protected]     hci_run();
55347bdc6798S[email protected] }
55354f3229d8S[email protected] 
5536a7a719e9SMatthias Ringwald void gap_set_scan_params(uint8_t scan_type, uint16_t scan_interval, uint16_t scan_window, uint8_t scanning_filter_policy){
5537ef11999fSmatthias.ringwald     hci_stack->le_scan_type          = scan_type;
5538a7a719e9SMatthias Ringwald     hci_stack->le_scan_filter_policy = scanning_filter_policy;
5539ef11999fSmatthias.ringwald     hci_stack->le_scan_interval      = scan_interval;
5540ef11999fSmatthias.ringwald     hci_stack->le_scan_window        = scan_window;
55418b69e4c7SMatthias Ringwald     hci_stack->le_scanning_param_update = true;
5542ef11999fSmatthias.ringwald     hci_run();
5543ef11999fSmatthias.ringwald }
55444f3229d8S[email protected] 
5545a7a719e9SMatthias Ringwald void gap_set_scan_parameters(uint8_t scan_type, uint16_t scan_interval, uint16_t scan_window){
5546a7a719e9SMatthias Ringwald     gap_set_scan_params(scan_type, scan_interval, scan_window, 0);
5547a7a719e9SMatthias Ringwald }
5548a7a719e9SMatthias Ringwald 
5549667ba9d1SMatthias Ringwald uint8_t gap_connect(const bd_addr_t addr, bd_addr_type_t addr_type){
55504f3229d8S[email protected]     hci_connection_t * conn = hci_connection_for_bd_addr_and_type(addr, addr_type);
55514f3229d8S[email protected]     if (!conn){
5552d32b3f05SMatthias Ringwald         // disallow if le connection is already outgoing
5553d32b3f05SMatthias Ringwald         if (hci_is_le_connection_type(addr_type) && hci_stack->le_connecting_request != LE_CONNECTING_IDLE){
5554d32b3f05SMatthias Ringwald             log_error("le connection already active");
5555d32b3f05SMatthias Ringwald             return ERROR_CODE_COMMAND_DISALLOWED;
5556d32b3f05SMatthias Ringwald         }
5557d32b3f05SMatthias Ringwald 
5558d8e8f12aSMatthias Ringwald         log_info("gap_connect: no connection exists yet, creating context");
55592e77e513S[email protected]         conn = create_connection_for_bd_addr_and_type(addr, addr_type);
55604f3229d8S[email protected]         if (!conn){
55614f3229d8S[email protected]             // notify client that alloc failed
55626e2e9a6bS[email protected]             hci_emit_le_connection_complete(addr_type, addr, 0, BTSTACK_MEMORY_ALLOC_FAILED);
5563d8e8f12aSMatthias Ringwald             log_info("gap_connect: failed to alloc hci_connection_t");
5564472a5742SMatthias Ringwald             return GATT_CLIENT_NOT_CONNECTED; // don't sent packet to controller
55654f3229d8S[email protected]         }
5566d5b1a89eSMatthias Ringwald 
5567d5b1a89eSMatthias Ringwald         // set le connecting state
5568d5b1a89eSMatthias Ringwald         if (hci_is_le_connection_type(addr_type)){
5569d5b1a89eSMatthias Ringwald             hci_stack->le_connecting_request = LE_CONNECTING_DIRECT;
5570d5b1a89eSMatthias Ringwald         }
5571d5b1a89eSMatthias Ringwald 
55724f3229d8S[email protected]         conn->state = SEND_CREATE_CONNECTION;
5573d8e8f12aSMatthias Ringwald         log_info("gap_connect: send create connection next");
5574564fca32S[email protected]         hci_run();
5575b0136355SMatthias Ringwald         return ERROR_CODE_SUCCESS;
55764f3229d8S[email protected]     }
55770bf6344aS[email protected] 
55780bf6344aS[email protected]     if (!hci_is_le_connection(conn) ||
5579a1df452eSMatthias Ringwald         (conn->state == SEND_CREATE_CONNECTION) ||
55800e588213SMatthias Ringwald         (conn->state == SENT_CREATE_CONNECTION)) {
55812e77e513S[email protected]         hci_emit_le_connection_complete(conn->address_type, conn->address, 0, ERROR_CODE_COMMAND_DISALLOWED);
5582d8e8f12aSMatthias Ringwald         log_error("gap_connect: classic connection or connect is already being created");
5583616edd56SMatthias Ringwald         return GATT_CLIENT_IN_WRONG_STATE;
55840bf6344aS[email protected]     }
55850bf6344aS[email protected] 
5586b0136355SMatthias Ringwald     // check if connection was just disconnected
5587b0136355SMatthias Ringwald     if (conn->state == RECEIVED_DISCONNECTION_COMPLETE){
5588b0136355SMatthias Ringwald         log_info("gap_connect: send create connection (again)");
5589b0136355SMatthias Ringwald         conn->state = SEND_CREATE_CONNECTION;
5590b0136355SMatthias Ringwald         hci_run();
5591b0136355SMatthias Ringwald         return ERROR_CODE_SUCCESS;
5592b0136355SMatthias Ringwald     }
5593b0136355SMatthias Ringwald 
5594d8e8f12aSMatthias Ringwald     log_info("gap_connect: context exists with state %u", conn->state);
5595d5b1a89eSMatthias Ringwald     hci_emit_le_connection_complete(conn->address_type, conn->address, conn->con_handle, ERROR_CODE_SUCCESS);
55964f3229d8S[email protected]     hci_run();
5597b0136355SMatthias Ringwald     return ERROR_CODE_SUCCESS;
55984f3229d8S[email protected] }
55994f3229d8S[email protected] 
56007851196eSmatthias.ringwald // @assumption: only a single outgoing LE Connection exists
5601d8e8f12aSMatthias Ringwald static hci_connection_t * gap_get_outgoing_connection(void){
5602665d90f2SMatthias Ringwald     btstack_linked_item_t *it;
5603a0da043fSMatthias Ringwald     for (it = (btstack_linked_item_t *) hci_stack->connections; it != NULL; it = it->next){
56040bf6344aS[email protected]         hci_connection_t * conn = (hci_connection_t *) it;
56050bf6344aS[email protected]         if (!hci_is_le_connection(conn)) continue;
56060bf6344aS[email protected]         switch (conn->state){
5607a6725849S[email protected]             case SEND_CREATE_CONNECTION:
56087851196eSmatthias.ringwald             case SENT_CREATE_CONNECTION:
56099c77c9dbSMatthias Ringwald             case SENT_CANCEL_CONNECTION:
56107851196eSmatthias.ringwald                 return conn;
56117851196eSmatthias.ringwald             default:
56127851196eSmatthias.ringwald                 break;
56137851196eSmatthias.ringwald         };
56147851196eSmatthias.ringwald     }
56157851196eSmatthias.ringwald     return NULL;
56167851196eSmatthias.ringwald }
56177851196eSmatthias.ringwald 
5618d8e8f12aSMatthias Ringwald uint8_t gap_connect_cancel(void){
5619d8e8f12aSMatthias Ringwald     hci_connection_t * conn = gap_get_outgoing_connection();
5620616edd56SMatthias Ringwald     if (!conn) return 0;
56217851196eSmatthias.ringwald     switch (conn->state){
56227851196eSmatthias.ringwald         case SEND_CREATE_CONNECTION:
56237851196eSmatthias.ringwald             // skip sending create connection and emit event instead
562410f8f469SMatthias Ringwald             hci_stack->le_connecting_request = LE_CONNECTING_IDLE;
56252e77e513S[email protected]             hci_emit_le_connection_complete(conn->address_type, conn->address, 0, ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER);
5626665d90f2SMatthias Ringwald             btstack_linked_list_remove(&hci_stack->connections, (btstack_linked_item_t *) conn);
56277851196eSmatthias.ringwald             btstack_memory_hci_connection_free( conn );
56280bf6344aS[email protected]             break;
5629a6725849S[email protected]         case SENT_CREATE_CONNECTION:
56307851196eSmatthias.ringwald             // request to send cancel connection
56310bf6344aS[email protected]             conn->state = SEND_CANCEL_CONNECTION;
56320bf6344aS[email protected]             hci_run();
56330bf6344aS[email protected]             break;
56340bf6344aS[email protected]         default:
56350bf6344aS[email protected]             break;
56360bf6344aS[email protected]     }
5637616edd56SMatthias Ringwald     return 0;
5638e31f89a7S[email protected] }
5639d70217a2SMatthias Ringwald #endif
56404f3229d8S[email protected] 
564113e645d2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
5642c37a3166S[email protected] /**
56436012052bSMatthias Ringwald  * @brief Set connection parameters for outgoing connections
5644cbe54ab2SJakob Krantz  * @param conn_scan_interval (unit: 0.625 msec), default: 60 ms
5645cbe54ab2SJakob Krantz  * @param conn_scan_window (unit: 0.625 msec), default: 30 ms
56466012052bSMatthias Ringwald  * @param conn_interval_min (unit: 1.25ms), default: 10 ms
56476012052bSMatthias Ringwald  * @param conn_interval_max (unit: 1.25ms), default: 30 ms
56486012052bSMatthias Ringwald  * @param conn_latency, default: 4
56496012052bSMatthias Ringwald  * @param supervision_timeout (unit: 10ms), default: 720 ms
56506012052bSMatthias Ringwald  * @param min_ce_length (unit: 0.625ms), default: 10 ms
56516012052bSMatthias Ringwald  * @param max_ce_length (unit: 0.625ms), default: 30 ms
56526012052bSMatthias Ringwald  */
56536012052bSMatthias Ringwald 
5654cbe54ab2SJakob Krantz void gap_set_connection_parameters(uint16_t conn_scan_interval, uint16_t conn_scan_window,
5655cbe54ab2SJakob Krantz     uint16_t conn_interval_min, uint16_t conn_interval_max, uint16_t conn_latency,
5656cbe54ab2SJakob Krantz     uint16_t supervision_timeout, uint16_t min_ce_length, uint16_t max_ce_length){
5657cbe54ab2SJakob Krantz     hci_stack->le_connection_scan_interval = conn_scan_interval;
5658cbe54ab2SJakob Krantz     hci_stack->le_connection_scan_window = conn_scan_window;
56596012052bSMatthias Ringwald     hci_stack->le_connection_interval_min = conn_interval_min;
56606012052bSMatthias Ringwald     hci_stack->le_connection_interval_max = conn_interval_max;
56616012052bSMatthias Ringwald     hci_stack->le_connection_latency = conn_latency;
56626012052bSMatthias Ringwald     hci_stack->le_supervision_timeout = supervision_timeout;
56636012052bSMatthias Ringwald     hci_stack->le_minimum_ce_length = min_ce_length;
56646012052bSMatthias Ringwald     hci_stack->le_maximum_ce_length = max_ce_length;
56656012052bSMatthias Ringwald }
566613e645d2SMatthias Ringwald #endif
56676012052bSMatthias Ringwald 
56686012052bSMatthias Ringwald /**
5669c37a3166S[email protected]  * @brief Updates the connection parameters for a given LE connection
5670c37a3166S[email protected]  * @param handle
5671c37a3166S[email protected]  * @param conn_interval_min (unit: 1.25ms)
5672c37a3166S[email protected]  * @param conn_interval_max (unit: 1.25ms)
5673c37a3166S[email protected]  * @param conn_latency
5674c37a3166S[email protected]  * @param supervision_timeout (unit: 10ms)
5675c37a3166S[email protected]  * @returns 0 if ok
5676c37a3166S[email protected]  */
5677c37a3166S[email protected] int gap_update_connection_parameters(hci_con_handle_t con_handle, uint16_t conn_interval_min,
5678c37a3166S[email protected]     uint16_t conn_interval_max, uint16_t conn_latency, uint16_t supervision_timeout){
5679c37a3166S[email protected]     hci_connection_t * connection = hci_connection_for_handle(con_handle);
5680c37a3166S[email protected]     if (!connection) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
5681c37a3166S[email protected]     connection->le_conn_interval_min = conn_interval_min;
5682c37a3166S[email protected]     connection->le_conn_interval_max = conn_interval_max;
5683c37a3166S[email protected]     connection->le_conn_latency = conn_latency;
5684c37a3166S[email protected]     connection->le_supervision_timeout = supervision_timeout;
568584cf6d83SMatthias Ringwald     connection->le_con_parameter_update_state = CON_PARAMETER_UPDATE_CHANGE_HCI_CON_PARAMETERS;
5686cfc59f1bSMatthias Ringwald     hci_run();
5687c37a3166S[email protected]     return 0;
5688c37a3166S[email protected] }
5689c37a3166S[email protected] 
569045c102fdSMatthias Ringwald /**
5691b68d7bc3SMatthias Ringwald  * @brief Request an update of the connection parameter for a given LE connection
5692b68d7bc3SMatthias Ringwald  * @param handle
5693b68d7bc3SMatthias Ringwald  * @param conn_interval_min (unit: 1.25ms)
5694b68d7bc3SMatthias Ringwald  * @param conn_interval_max (unit: 1.25ms)
5695b68d7bc3SMatthias Ringwald  * @param conn_latency
5696b68d7bc3SMatthias Ringwald  * @param supervision_timeout (unit: 10ms)
5697b68d7bc3SMatthias Ringwald  * @returns 0 if ok
5698b68d7bc3SMatthias Ringwald  */
5699b68d7bc3SMatthias Ringwald int gap_request_connection_parameter_update(hci_con_handle_t con_handle, uint16_t conn_interval_min,
5700b68d7bc3SMatthias Ringwald     uint16_t conn_interval_max, uint16_t conn_latency, uint16_t supervision_timeout){
5701b68d7bc3SMatthias Ringwald     hci_connection_t * connection = hci_connection_for_handle(con_handle);
5702b68d7bc3SMatthias Ringwald     if (!connection) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
5703b68d7bc3SMatthias Ringwald     connection->le_conn_interval_min = conn_interval_min;
5704b68d7bc3SMatthias Ringwald     connection->le_conn_interval_max = conn_interval_max;
5705b68d7bc3SMatthias Ringwald     connection->le_conn_latency = conn_latency;
5706b68d7bc3SMatthias Ringwald     connection->le_supervision_timeout = supervision_timeout;
5707b68d7bc3SMatthias Ringwald     connection->le_con_parameter_update_state = CON_PARAMETER_UPDATE_SEND_REQUEST;
570809c9c963SMatthias Ringwald     uint8_t l2cap_trigger_run_event[2] = { L2CAP_EVENT_TRIGGER_RUN, 0};
570909c9c963SMatthias Ringwald     hci_emit_event(l2cap_trigger_run_event, sizeof(l2cap_trigger_run_event), 0);
5710b68d7bc3SMatthias Ringwald     return 0;
5711b68d7bc3SMatthias Ringwald }
5712b68d7bc3SMatthias Ringwald 
5713d70217a2SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
5714d70217a2SMatthias Ringwald 
5715b68d7bc3SMatthias Ringwald /**
571645c102fdSMatthias Ringwald  * @brief Set Advertisement Data
571745c102fdSMatthias Ringwald  * @param advertising_data_length
571845c102fdSMatthias Ringwald  * @param advertising_data (max 31 octets)
571945c102fdSMatthias Ringwald  * @note data is not copied, pointer has to stay valid
572045c102fdSMatthias Ringwald  */
572145c102fdSMatthias Ringwald void gap_advertisements_set_data(uint8_t advertising_data_length, uint8_t * advertising_data){
572245c102fdSMatthias Ringwald     hci_stack->le_advertisements_data_len = advertising_data_length;
572345c102fdSMatthias Ringwald     hci_stack->le_advertisements_data = advertising_data;
5724501f56b3SMatthias Ringwald     hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_SET_ADV_DATA;
5725bbc366e6SMatthias Ringwald     hci_run();
572645c102fdSMatthias Ringwald }
5727501f56b3SMatthias Ringwald 
5728501f56b3SMatthias Ringwald /**
5729501f56b3SMatthias Ringwald  * @brief Set Scan Response Data
5730501f56b3SMatthias Ringwald  * @param advertising_data_length
5731501f56b3SMatthias Ringwald  * @param advertising_data (max 31 octets)
5732501f56b3SMatthias Ringwald  * @note data is not copied, pointer has to stay valid
5733501f56b3SMatthias Ringwald  */
5734501f56b3SMatthias Ringwald void gap_scan_response_set_data(uint8_t scan_response_data_length, uint8_t * scan_response_data){
5735501f56b3SMatthias Ringwald     hci_stack->le_scan_response_data_len = scan_response_data_length;
5736501f56b3SMatthias Ringwald     hci_stack->le_scan_response_data = scan_response_data;
5737501f56b3SMatthias Ringwald     hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_SET_SCAN_DATA;
5738bbc366e6SMatthias Ringwald     hci_run();
573945c102fdSMatthias Ringwald }
574045c102fdSMatthias Ringwald 
574145c102fdSMatthias Ringwald /**
574245c102fdSMatthias Ringwald  * @brief Set Advertisement Parameters
574345c102fdSMatthias Ringwald  * @param adv_int_min
574445c102fdSMatthias Ringwald  * @param adv_int_max
574545c102fdSMatthias Ringwald  * @param adv_type
574645c102fdSMatthias Ringwald  * @param direct_address_type
574745c102fdSMatthias Ringwald  * @param direct_address
574845c102fdSMatthias Ringwald  * @param channel_map
574945c102fdSMatthias Ringwald  * @param filter_policy
575045c102fdSMatthias Ringwald  *
575145c102fdSMatthias Ringwald  * @note internal use. use gap_advertisements_set_params from gap_le.h instead.
575245c102fdSMatthias Ringwald  */
575345c102fdSMatthias Ringwald  void hci_le_advertisements_set_params(uint16_t adv_int_min, uint16_t adv_int_max, uint8_t adv_type,
5754b95a5a35SMatthias Ringwald     uint8_t direct_address_typ, bd_addr_t direct_address,
575545c102fdSMatthias Ringwald     uint8_t channel_map, uint8_t filter_policy) {
575645c102fdSMatthias Ringwald 
575745c102fdSMatthias Ringwald     hci_stack->le_advertisements_interval_min = adv_int_min;
575845c102fdSMatthias Ringwald     hci_stack->le_advertisements_interval_max = adv_int_max;
575945c102fdSMatthias Ringwald     hci_stack->le_advertisements_type = adv_type;
576045c102fdSMatthias Ringwald     hci_stack->le_advertisements_direct_address_type = direct_address_typ;
576145c102fdSMatthias Ringwald     hci_stack->le_advertisements_channel_map = channel_map;
576245c102fdSMatthias Ringwald     hci_stack->le_advertisements_filter_policy = filter_policy;
57636535961aSMatthias Ringwald     (void)memcpy(hci_stack->le_advertisements_direct_address, direct_address,
57646535961aSMatthias Ringwald                  6);
576545c102fdSMatthias Ringwald 
5766a61834b6SMatthias Ringwald     hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_SET_PARAMS | LE_ADVERTISEMENT_TASKS_PARAMS_SET;
5767bbc366e6SMatthias Ringwald     hci_run();
576845c102fdSMatthias Ringwald  }
576945c102fdSMatthias Ringwald 
577045c102fdSMatthias Ringwald /**
577145c102fdSMatthias Ringwald  * @brief Enable/Disable Advertisements
577245c102fdSMatthias Ringwald  * @param enabled
577345c102fdSMatthias Ringwald  */
577445c102fdSMatthias Ringwald void gap_advertisements_enable(int enabled){
57755226d7f2SMatthias Ringwald     hci_stack->le_advertisements_enabled = enabled != 0;
5776bbc366e6SMatthias Ringwald     hci_update_advertisements_enabled_for_current_roles();
5777cfc59f1bSMatthias Ringwald     hci_run();
577845c102fdSMatthias Ringwald }
577945c102fdSMatthias Ringwald 
578035454696SMatthias Ringwald #endif
578106e5cf96SMatthias Ringwald 
578206e5cf96SMatthias Ringwald void hci_le_set_own_address_type(uint8_t own_address_type){
578306e5cf96SMatthias Ringwald     log_info("hci_le_set_own_address_type: old %u, new %u", hci_stack->le_own_addr_type, own_address_type);
578406e5cf96SMatthias Ringwald     if (own_address_type == hci_stack->le_own_addr_type) return;
578506e5cf96SMatthias Ringwald     hci_stack->le_own_addr_type = own_address_type;
578606e5cf96SMatthias Ringwald 
578764068776SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
578806e5cf96SMatthias Ringwald     // update advertisement parameters, too
578906e5cf96SMatthias Ringwald     hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_SET_PARAMS;
5790bbc366e6SMatthias Ringwald     hci_run();
579164068776SMatthias Ringwald #endif
579264068776SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
579306e5cf96SMatthias Ringwald     // note: we don't update scan parameters or modify ongoing connection attempts
579464068776SMatthias Ringwald #endif
579506e5cf96SMatthias Ringwald }
579606e5cf96SMatthias Ringwald 
5797d70217a2SMatthias Ringwald #endif
579845c102fdSMatthias Ringwald 
5799616edd56SMatthias Ringwald uint8_t gap_disconnect(hci_con_handle_t handle){
58005917a5c5S[email protected]     hci_connection_t * conn = hci_connection_for_handle(handle);
58015917a5c5S[email protected]     if (!conn){
58027851196eSmatthias.ringwald         hci_emit_disconnection_complete(handle, 0);
5803616edd56SMatthias Ringwald         return 0;
58045917a5c5S[email protected]     }
58057fd7aa6fSMatthias Ringwald     // ignore if already disconnected
58067fd7aa6fSMatthias Ringwald     if (conn->state == RECEIVED_DISCONNECTION_COMPLETE){
58077fd7aa6fSMatthias Ringwald         return 0;
58087fd7aa6fSMatthias Ringwald     }
58095917a5c5S[email protected]     conn->state = SEND_DISCONNECT;
58105917a5c5S[email protected]     hci_run();
5811616edd56SMatthias Ringwald     return 0;
58124f3229d8S[email protected] }
581304a6ef8cSmatthias.ringwald 
5814228e430cSMatthias Ringwald int gap_read_rssi(hci_con_handle_t con_handle){
5815228e430cSMatthias Ringwald     hci_connection_t * hci_connection = hci_connection_for_handle(con_handle);
5816228e430cSMatthias Ringwald     if (hci_connection == NULL) return 0;
5817228e430cSMatthias Ringwald     connectionSetAuthenticationFlags(hci_connection, READ_RSSI);
5818228e430cSMatthias Ringwald     hci_run();
5819228e430cSMatthias Ringwald     return 1;
5820228e430cSMatthias Ringwald }
5821228e430cSMatthias Ringwald 
5822a1bf5ae7SMatthias Ringwald /**
5823a1bf5ae7SMatthias Ringwald  * @brief Get connection type
5824a1bf5ae7SMatthias Ringwald  * @param con_handle
5825a1bf5ae7SMatthias Ringwald  * @result connection_type
5826a1bf5ae7SMatthias Ringwald  */
5827a1bf5ae7SMatthias Ringwald gap_connection_type_t gap_get_connection_type(hci_con_handle_t connection_handle){
5828a1bf5ae7SMatthias Ringwald     hci_connection_t * conn = hci_connection_for_handle(connection_handle);
5829a1bf5ae7SMatthias Ringwald     if (!conn) return GAP_CONNECTION_INVALID;
5830a1bf5ae7SMatthias Ringwald     switch (conn->address_type){
5831a1bf5ae7SMatthias Ringwald         case BD_ADDR_TYPE_LE_PUBLIC:
5832a1bf5ae7SMatthias Ringwald         case BD_ADDR_TYPE_LE_RANDOM:
5833a1bf5ae7SMatthias Ringwald             return GAP_CONNECTION_LE;
5834a1bf5ae7SMatthias Ringwald         case BD_ADDR_TYPE_SCO:
5835a1bf5ae7SMatthias Ringwald             return GAP_CONNECTION_SCO;
5836f16129ceSMatthias Ringwald         case BD_ADDR_TYPE_ACL:
5837a1bf5ae7SMatthias Ringwald             return GAP_CONNECTION_ACL;
5838a1bf5ae7SMatthias Ringwald         default:
5839a1bf5ae7SMatthias Ringwald             return GAP_CONNECTION_INVALID;
5840a1bf5ae7SMatthias Ringwald     }
5841a1bf5ae7SMatthias Ringwald }
5842a1bf5ae7SMatthias Ringwald 
58432dceb1d6SMatthias Ringwald hci_role_t gap_get_role(hci_con_handle_t connection_handle){
58442dceb1d6SMatthias Ringwald     hci_connection_t * conn = hci_connection_for_handle(connection_handle);
58452dceb1d6SMatthias Ringwald     if (!conn) return HCI_ROLE_INVALID;
58462dceb1d6SMatthias Ringwald     return (hci_role_t) conn->role;
58472dceb1d6SMatthias Ringwald }
58482dceb1d6SMatthias Ringwald 
58492dceb1d6SMatthias Ringwald 
585044f858f3SMatthias Ringwald #ifdef ENABLE_CLASSIC
5851667ba9d1SMatthias Ringwald uint8_t gap_request_role(const bd_addr_t addr, hci_role_t role){
585288a03c8dSMatthias Ringwald     hci_connection_t * conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL);
585388a03c8dSMatthias Ringwald     if (!conn) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
585488a03c8dSMatthias Ringwald     conn->request_role = role;
585588a03c8dSMatthias Ringwald     hci_run();
5856d04a455eSMatthias Ringwald     return ERROR_CODE_SUCCESS;
585788a03c8dSMatthias Ringwald }
585844f858f3SMatthias Ringwald #endif
585988a03c8dSMatthias Ringwald 
5860a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE
58614f551432SMatthias Ringwald 
5862b45b7749SMilanka 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){
5863b45b7749SMilanka Ringwald     hci_connection_t * conn = hci_connection_for_handle(con_handle);
5864b90f6e0aSMatthias Ringwald     if (!conn) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
5865b90f6e0aSMatthias Ringwald 
5866b90f6e0aSMatthias Ringwald     conn->le_phy_update_all_phys    = all_phys;
5867b90f6e0aSMatthias Ringwald     conn->le_phy_update_tx_phys     = tx_phys;
5868b90f6e0aSMatthias Ringwald     conn->le_phy_update_rx_phys     = rx_phys;
5869b90f6e0aSMatthias Ringwald     conn->le_phy_update_phy_options = phy_options;
5870b90f6e0aSMatthias Ringwald 
5871b90f6e0aSMatthias Ringwald     hci_run();
5872b90f6e0aSMatthias Ringwald 
5873b90f6e0aSMatthias Ringwald     return 0;
5874b90f6e0aSMatthias Ringwald }
5875b90f6e0aSMatthias Ringwald 
5876667ba9d1SMatthias Ringwald static uint8_t hci_whitelist_add(bd_addr_type_t address_type, const bd_addr_t address){
58777a92a9dbSMatthias Ringwald     // check if already in list
58787a92a9dbSMatthias Ringwald     btstack_linked_list_iterator_t it;
58797a92a9dbSMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->le_whitelist);
58807a92a9dbSMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)) {
58817a92a9dbSMatthias Ringwald         whitelist_entry_t *entry = (whitelist_entry_t *) btstack_linked_list_iterator_next(&it);
58827a92a9dbSMatthias Ringwald         if (entry->address_type != address_type) {
58837a92a9dbSMatthias Ringwald             continue;
58847a92a9dbSMatthias Ringwald         }
58857a92a9dbSMatthias Ringwald         if (memcmp(entry->address, address, 6) != 0) {
58867a92a9dbSMatthias Ringwald             continue;
58877a92a9dbSMatthias Ringwald         }
5888287379ccSMatthias Ringwald 		// disallow if already scheduled to add
5889287379ccSMatthias Ringwald 		if ((entry->state & LE_WHITELIST_ADD_TO_CONTROLLER) != 0){
58907a92a9dbSMatthias Ringwald 			return ERROR_CODE_COMMAND_DISALLOWED;
58917a92a9dbSMatthias Ringwald 		}
5892287379ccSMatthias Ringwald 		// still on controller, but scheduled to remove -> re-add
5893287379ccSMatthias Ringwald 		entry->state |= LE_WHITELIST_ADD_TO_CONTROLLER;
5894287379ccSMatthias Ringwald 		return ERROR_CODE_SUCCESS;
5895287379ccSMatthias Ringwald     }
58967a92a9dbSMatthias Ringwald     // alloc and add to list
5897e83201bcSMatthias Ringwald     whitelist_entry_t * entry = btstack_memory_whitelist_entry_get();
5898e83201bcSMatthias Ringwald     if (!entry) return BTSTACK_MEMORY_ALLOC_FAILED;
5899e83201bcSMatthias Ringwald     entry->address_type = address_type;
59006535961aSMatthias Ringwald     (void)memcpy(entry->address, address, 6);
5901e83201bcSMatthias Ringwald     entry->state = LE_WHITELIST_ADD_TO_CONTROLLER;
5902665d90f2SMatthias Ringwald     btstack_linked_list_add(&hci_stack->le_whitelist, (btstack_linked_item_t*) entry);
5903226db5efSMatthias Ringwald     return ERROR_CODE_SUCCESS;
5904ac9c45e0SMatthias Ringwald }
5905ac9c45e0SMatthias Ringwald 
5906667ba9d1SMatthias Ringwald static uint8_t hci_whitelist_remove(bd_addr_type_t address_type, const bd_addr_t address){
5907665d90f2SMatthias Ringwald     btstack_linked_list_iterator_t it;
5908665d90f2SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->le_whitelist);
5909665d90f2SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
5910665d90f2SMatthias Ringwald         whitelist_entry_t * entry = (whitelist_entry_t*) btstack_linked_list_iterator_next(&it);
59117a92a9dbSMatthias Ringwald         if (entry->address_type != address_type) {
59127a92a9dbSMatthias Ringwald             continue;
59137a92a9dbSMatthias Ringwald         }
59147a92a9dbSMatthias Ringwald         if (memcmp(entry->address, address, 6) != 0) {
59157a92a9dbSMatthias Ringwald             continue;
59167a92a9dbSMatthias Ringwald         }
5917e83201bcSMatthias Ringwald         if (entry->state & LE_WHITELIST_ON_CONTROLLER){
5918e83201bcSMatthias Ringwald             // remove from controller if already present
5919e83201bcSMatthias Ringwald             entry->state |= LE_WHITELIST_REMOVE_FROM_CONTROLLER;
5920a3b69fdeSMatthias Ringwald         }  else {
5921226db5efSMatthias Ringwald             // directly remove entry from whitelist
5922665d90f2SMatthias Ringwald             btstack_linked_list_iterator_remove(&it);
5923e83201bcSMatthias Ringwald             btstack_memory_whitelist_entry_free(entry);
5924e83201bcSMatthias Ringwald         }
5925a3b69fdeSMatthias Ringwald         return ERROR_CODE_SUCCESS;
5926a3b69fdeSMatthias Ringwald     }
5927a3b69fdeSMatthias Ringwald     return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
592842ff5ba1SMatthias Ringwald }
592942ff5ba1SMatthias Ringwald 
5930226db5efSMatthias Ringwald static void hci_whitelist_clear(void){
5931665d90f2SMatthias Ringwald     btstack_linked_list_iterator_t it;
5932665d90f2SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->le_whitelist);
5933665d90f2SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
5934665d90f2SMatthias Ringwald         whitelist_entry_t * entry = (whitelist_entry_t*) btstack_linked_list_iterator_next(&it);
5935e83201bcSMatthias Ringwald         if (entry->state & LE_WHITELIST_ON_CONTROLLER){
5936e83201bcSMatthias Ringwald             // remove from controller if already present
5937e83201bcSMatthias Ringwald             entry->state |= LE_WHITELIST_REMOVE_FROM_CONTROLLER;
5938e83201bcSMatthias Ringwald             continue;
5939e83201bcSMatthias Ringwald         }
594091915b0bSMatthias Ringwald         // directly remove entry from whitelist
5941665d90f2SMatthias Ringwald         btstack_linked_list_iterator_remove(&it);
5942e83201bcSMatthias Ringwald         btstack_memory_whitelist_entry_free(entry);
5943e83201bcSMatthias Ringwald     }
5944226db5efSMatthias Ringwald }
5945226db5efSMatthias Ringwald 
5946a3b69fdeSMatthias Ringwald /**
5947a3b69fdeSMatthias Ringwald  * @brief Clear Whitelist
5948a3b69fdeSMatthias Ringwald  * @returns 0 if ok
5949a3b69fdeSMatthias Ringwald  */
5950a3b69fdeSMatthias Ringwald uint8_t gap_whitelist_clear(void){
5951a3b69fdeSMatthias Ringwald     hci_whitelist_clear();
5952a3b69fdeSMatthias Ringwald     hci_run();
5953a3b69fdeSMatthias Ringwald     return ERROR_CODE_SUCCESS;
5954a3b69fdeSMatthias Ringwald }
5955a3b69fdeSMatthias Ringwald 
5956a3b69fdeSMatthias Ringwald /**
5957a3b69fdeSMatthias Ringwald  * @brief Add Device to Whitelist
5958a3b69fdeSMatthias Ringwald  * @param address_typ
5959a3b69fdeSMatthias Ringwald  * @param address
5960a3b69fdeSMatthias Ringwald  * @returns 0 if ok
5961a3b69fdeSMatthias Ringwald  */
5962667ba9d1SMatthias Ringwald uint8_t gap_whitelist_add(bd_addr_type_t address_type, const bd_addr_t address){
5963a3b69fdeSMatthias Ringwald     uint8_t status = hci_whitelist_add(address_type, address);
5964a3b69fdeSMatthias Ringwald     if (status){
5965a3b69fdeSMatthias Ringwald         return status;
5966a3b69fdeSMatthias Ringwald     }
5967a3b69fdeSMatthias Ringwald     hci_run();
5968a3b69fdeSMatthias Ringwald     return ERROR_CODE_SUCCESS;
5969a3b69fdeSMatthias Ringwald }
5970a3b69fdeSMatthias Ringwald 
5971a3b69fdeSMatthias Ringwald /**
5972a3b69fdeSMatthias Ringwald  * @brief Remove Device from Whitelist
5973a3b69fdeSMatthias Ringwald  * @param address_typ
5974a3b69fdeSMatthias Ringwald  * @param address
5975a3b69fdeSMatthias Ringwald  * @returns 0 if ok
5976a3b69fdeSMatthias Ringwald  */
5977667ba9d1SMatthias Ringwald uint8_t gap_whitelist_remove(bd_addr_type_t address_type, const bd_addr_t address){
5978a3b69fdeSMatthias Ringwald     uint8_t status = hci_whitelist_remove(address_type, address);
5979a3b69fdeSMatthias Ringwald     if (status){
5980a3b69fdeSMatthias Ringwald         return status;
5981a3b69fdeSMatthias Ringwald     }
5982a3b69fdeSMatthias Ringwald     hci_run();
5983a3b69fdeSMatthias Ringwald     return ERROR_CODE_SUCCESS;
5984a3b69fdeSMatthias Ringwald }
5985a3b69fdeSMatthias Ringwald 
5986226db5efSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
5987226db5efSMatthias Ringwald /**
598895e257d9SMatthias Ringwald  *  @brief Connect with Whitelist
598995e257d9SMatthias Ringwald  *  @note Explicit whitelist management and this connect with whitelist replace deprecated gap_auto_connection_* functions
599095e257d9SMatthias Ringwald  *  @returns - if ok
599195e257d9SMatthias Ringwald  */
599295e257d9SMatthias Ringwald uint8_t gap_connect_with_whitelist(void){
599395e257d9SMatthias Ringwald     if (hci_stack->le_connecting_request != LE_CONNECTING_IDLE){
599495e257d9SMatthias Ringwald         return ERROR_CODE_COMMAND_DISALLOWED;
599595e257d9SMatthias Ringwald     }
599695e257d9SMatthias Ringwald     hci_stack->le_connecting_request = LE_CONNECTING_WHITELIST;
599795e257d9SMatthias Ringwald     hci_run();
599895e257d9SMatthias Ringwald     return ERROR_CODE_SUCCESS;
599995e257d9SMatthias Ringwald }
600095e257d9SMatthias Ringwald 
600195e257d9SMatthias Ringwald /**
6002226db5efSMatthias Ringwald  * @brief Auto Connection Establishment - Start Connecting to device
6003226db5efSMatthias Ringwald  * @param address_typ
6004226db5efSMatthias Ringwald  * @param address
6005226db5efSMatthias Ringwald  * @returns 0 if ok
6006226db5efSMatthias Ringwald  */
6007667ba9d1SMatthias Ringwald uint8_t gap_auto_connection_start(bd_addr_type_t address_type, const bd_addr_t address){
600895e257d9SMatthias Ringwald     if (hci_stack->le_connecting_request == LE_CONNECTING_DIRECT){
6009226db5efSMatthias Ringwald         return ERROR_CODE_COMMAND_DISALLOWED;
6010226db5efSMatthias Ringwald     }
6011226db5efSMatthias Ringwald 
6012226db5efSMatthias Ringwald     uint8_t status = hci_whitelist_add(address_type, address);
601363f2efc9SMatthias Ringwald     if (status == BTSTACK_MEMORY_ALLOC_FAILED) {
6014226db5efSMatthias Ringwald         return status;
6015226db5efSMatthias Ringwald     }
6016226db5efSMatthias Ringwald 
6017226db5efSMatthias Ringwald     hci_stack->le_connecting_request = LE_CONNECTING_WHITELIST;
6018226db5efSMatthias Ringwald 
6019226db5efSMatthias Ringwald     hci_run();
602095e257d9SMatthias Ringwald     return ERROR_CODE_SUCCESS;
6021226db5efSMatthias Ringwald }
6022226db5efSMatthias Ringwald 
6023226db5efSMatthias Ringwald /**
6024226db5efSMatthias Ringwald  * @brief Auto Connection Establishment - Stop Connecting to device
6025226db5efSMatthias Ringwald  * @param address_typ
6026226db5efSMatthias Ringwald  * @param address
6027226db5efSMatthias Ringwald  * @returns 0 if ok
6028226db5efSMatthias Ringwald  */
6029667ba9d1SMatthias Ringwald uint8_t gap_auto_connection_stop(bd_addr_type_t address_type, const bd_addr_t address){
603095e257d9SMatthias Ringwald     if (hci_stack->le_connecting_request == LE_CONNECTING_DIRECT){
603195e257d9SMatthias Ringwald         return ERROR_CODE_COMMAND_DISALLOWED;
603295e257d9SMatthias Ringwald     }
603395e257d9SMatthias Ringwald 
6034226db5efSMatthias Ringwald     hci_whitelist_remove(address_type, address);
603595e257d9SMatthias Ringwald     if (btstack_linked_list_empty(&hci_stack->le_whitelist)){
603695e257d9SMatthias Ringwald         hci_stack->le_connecting_request = LE_CONNECTING_IDLE;
603795e257d9SMatthias Ringwald     }
6038226db5efSMatthias Ringwald     hci_run();
6039226db5efSMatthias Ringwald     return 0;
6040226db5efSMatthias Ringwald }
6041226db5efSMatthias Ringwald 
6042226db5efSMatthias Ringwald /**
6043226db5efSMatthias Ringwald  * @brief Auto Connection Establishment - Stop everything
6044226db5efSMatthias Ringwald  * @note  Convenience function to stop all active auto connection attempts
6045226db5efSMatthias Ringwald  */
604695e257d9SMatthias Ringwald uint8_t gap_auto_connection_stop_all(void){
604795e257d9SMatthias Ringwald     if (hci_stack->le_connecting_request == LE_CONNECTING_DIRECT) {
604895e257d9SMatthias Ringwald         return ERROR_CODE_COMMAND_DISALLOWED;
604995e257d9SMatthias Ringwald     }
6050226db5efSMatthias Ringwald     hci_whitelist_clear();
6051226db5efSMatthias Ringwald     hci_stack->le_connecting_request = LE_CONNECTING_IDLE;
6052e83201bcSMatthias Ringwald     hci_run();
605395e257d9SMatthias Ringwald     return ERROR_CODE_SUCCESS;
6054ac9c45e0SMatthias Ringwald }
6055c9db5c21SMilanka Ringwald 
6056b45b7749SMilanka Ringwald uint16_t gap_le_connection_interval(hci_con_handle_t con_handle){
6057b45b7749SMilanka Ringwald     hci_connection_t * conn = hci_connection_for_handle(con_handle);
6058c9db5c21SMilanka Ringwald     if (!conn) return 0;
6059c9db5c21SMilanka Ringwald     return conn->le_connection_interval;
6060c9db5c21SMilanka Ringwald }
6061d70217a2SMatthias Ringwald #endif
60624f551432SMatthias Ringwald #endif
60634f551432SMatthias Ringwald 
606435454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
6065ac9c45e0SMatthias Ringwald /**
6066ff00ed1cSMatthias Ringwald  * @brief Set Extended Inquiry Response data
6067a8c4e5adSMatthias Ringwald  * @param eir_data size HCI_EXTENDED_INQUIRY_RESPONSE_DATA_LEN (240) bytes, is not copied make sure memory is accessible during stack startup
6068ff00ed1cSMatthias Ringwald  * @note has to be done before stack starts up
6069ff00ed1cSMatthias Ringwald  */
6070ff00ed1cSMatthias Ringwald void gap_set_extended_inquiry_response(const uint8_t * data){
6071ff00ed1cSMatthias Ringwald     hci_stack->eir_data = data;
6072ff00ed1cSMatthias Ringwald }
6073ff00ed1cSMatthias Ringwald 
6074ff00ed1cSMatthias Ringwald /**
6075f5875de5SMatthias Ringwald  * @brief Start GAP Classic Inquiry
6076f5875de5SMatthias Ringwald  * @param duration in 1.28s units
6077f5875de5SMatthias Ringwald  * @return 0 if ok
6078f5875de5SMatthias Ringwald  * @events: GAP_EVENT_INQUIRY_RESULT, GAP_EVENT_INQUIRY_COMPLETE
6079f5875de5SMatthias Ringwald  */
6080f5875de5SMatthias Ringwald int gap_inquiry_start(uint8_t duration_in_1280ms_units){
608199449554SMatthias Ringwald     if (hci_stack->state != HCI_STATE_WORKING) return ERROR_CODE_COMMAND_DISALLOWED;
6082f5875de5SMatthias Ringwald     if (hci_stack->inquiry_state != GAP_INQUIRY_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED;
6083a1df452eSMatthias Ringwald     if ((duration_in_1280ms_units < GAP_INQUIRY_DURATION_MIN) || (duration_in_1280ms_units > GAP_INQUIRY_DURATION_MAX)){
6084f5875de5SMatthias Ringwald         return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS;
6085f5875de5SMatthias Ringwald     }
6086f5875de5SMatthias Ringwald     hci_stack->inquiry_state = duration_in_1280ms_units;
6087f5875de5SMatthias Ringwald     hci_run();
6088f5875de5SMatthias Ringwald     return 0;
6089f5875de5SMatthias Ringwald }
6090f5875de5SMatthias Ringwald 
6091f5875de5SMatthias Ringwald /**
6092f5875de5SMatthias Ringwald  * @brief Stop GAP Classic Inquiry
6093f5875de5SMatthias Ringwald  * @returns 0 if ok
6094f5875de5SMatthias Ringwald  */
6095f5875de5SMatthias Ringwald int gap_inquiry_stop(void){
6096a1df452eSMatthias Ringwald     if ((hci_stack->inquiry_state >= GAP_INQUIRY_DURATION_MIN) && (hci_stack->inquiry_state <= GAP_INQUIRY_DURATION_MAX)) {
6097f5875de5SMatthias Ringwald         // emit inquiry complete event, before it even started
6098f5875de5SMatthias Ringwald         uint8_t event[] = { GAP_EVENT_INQUIRY_COMPLETE, 1, 0};
6099f5875de5SMatthias Ringwald         hci_emit_event(event, sizeof(event), 1);
6100f5875de5SMatthias Ringwald         return 0;
6101f5875de5SMatthias Ringwald     }
6102f5875de5SMatthias Ringwald     if (hci_stack->inquiry_state != GAP_INQUIRY_STATE_ACTIVE) return ERROR_CODE_COMMAND_DISALLOWED;
6103f5875de5SMatthias Ringwald     hci_stack->inquiry_state = GAP_INQUIRY_STATE_W2_CANCEL;
6104f5875de5SMatthias Ringwald     hci_run();
6105f5875de5SMatthias Ringwald     return 0;
6106f5875de5SMatthias Ringwald }
6107f5875de5SMatthias Ringwald 
6108496bb884SMatthias Ringwald void gap_inquiry_set_lap(uint32_t lap){
6109496bb884SMatthias Ringwald     hci_stack->inquiry_lap = lap;
6110496bb884SMatthias Ringwald }
6111496bb884SMatthias Ringwald 
6112b7f1ee76SMatthias Ringwald 
6113b7f1ee76SMatthias Ringwald /**
6114b7f1ee76SMatthias Ringwald  * @brief Remote Name Request
6115b7f1ee76SMatthias Ringwald  * @param addr
6116b7f1ee76SMatthias Ringwald  * @param page_scan_repetition_mode
6117b7f1ee76SMatthias Ringwald  * @param clock_offset only used when bit 15 is set
6118b7f1ee76SMatthias Ringwald  * @events: HCI_EVENT_REMOTE_NAME_REQUEST_COMPLETE
6119b7f1ee76SMatthias Ringwald  */
6120667ba9d1SMatthias Ringwald int gap_remote_name_request(const bd_addr_t addr, uint8_t page_scan_repetition_mode, uint16_t clock_offset){
6121b7f1ee76SMatthias Ringwald     if (hci_stack->remote_name_state != GAP_REMOTE_NAME_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED;
61226535961aSMatthias Ringwald     (void)memcpy(hci_stack->remote_name_addr, addr, 6);
6123b7f1ee76SMatthias Ringwald     hci_stack->remote_name_page_scan_repetition_mode = page_scan_repetition_mode;
6124b7f1ee76SMatthias Ringwald     hci_stack->remote_name_clock_offset = clock_offset;
6125b7f1ee76SMatthias Ringwald     hci_stack->remote_name_state = GAP_REMOTE_NAME_STATE_W2_SEND;
6126b7f1ee76SMatthias Ringwald     hci_run();
6127b7f1ee76SMatthias Ringwald     return 0;
6128b7f1ee76SMatthias Ringwald }
6129b7f1ee76SMatthias Ringwald 
6130667ba9d1SMatthias Ringwald static int gap_pairing_set_state_and_run(const bd_addr_t addr, uint8_t state){
61310a51f88bSMatthias Ringwald     hci_stack->gap_pairing_state = state;
61326535961aSMatthias Ringwald     (void)memcpy(hci_stack->gap_pairing_addr, addr, 6);
61330a51f88bSMatthias Ringwald     hci_run();
61340a51f88bSMatthias Ringwald     return 0;
61350a51f88bSMatthias Ringwald }
61360a51f88bSMatthias Ringwald 
61370a51f88bSMatthias Ringwald /**
6138aad97216SMatthias Ringwald  * @brief Legacy Pairing Pin Code Response for binary data / non-strings
6139aad97216SMatthias Ringwald  * @param addr
6140aad97216SMatthias Ringwald  * @param pin_data
6141aad97216SMatthias Ringwald  * @param pin_len
6142aad97216SMatthias Ringwald  * @return 0 if ok
6143aad97216SMatthias Ringwald  */
6144667ba9d1SMatthias Ringwald int gap_pin_code_response_binary(const bd_addr_t addr, const uint8_t * pin_data, uint8_t pin_len){
6145aad97216SMatthias Ringwald     if (hci_stack->gap_pairing_state != GAP_PAIRING_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED;
6146aad97216SMatthias Ringwald     hci_stack->gap_pairing_input.gap_pairing_pin = pin_data;
6147aad97216SMatthias Ringwald     hci_stack->gap_pairing_pin_len = pin_len;
6148aad97216SMatthias Ringwald     return gap_pairing_set_state_and_run(addr, GAP_PAIRING_STATE_SEND_PIN);
6149aad97216SMatthias Ringwald }
6150aad97216SMatthias Ringwald 
6151aad97216SMatthias Ringwald /**
61520a51f88bSMatthias Ringwald  * @brief Legacy Pairing Pin Code Response
61530a51f88bSMatthias Ringwald  * @param addr
61540a51f88bSMatthias Ringwald  * @param pin
61550a51f88bSMatthias Ringwald  * @return 0 if ok
61560a51f88bSMatthias Ringwald  */
6157667ba9d1SMatthias Ringwald int gap_pin_code_response(const bd_addr_t addr, const char * pin){
6158aad97216SMatthias Ringwald     return gap_pin_code_response_binary(addr, (const uint8_t*) pin, strlen(pin));
61590a51f88bSMatthias Ringwald }
61600a51f88bSMatthias Ringwald 
61610a51f88bSMatthias Ringwald /**
61620a51f88bSMatthias Ringwald  * @brief Abort Legacy Pairing
61630a51f88bSMatthias Ringwald  * @param addr
61640a51f88bSMatthias Ringwald  * @param pin
61650a51f88bSMatthias Ringwald  * @return 0 if ok
61660a51f88bSMatthias Ringwald  */
61670a51f88bSMatthias Ringwald int gap_pin_code_negative(bd_addr_t addr){
6168cd74063aSMatthias Ringwald     if (hci_stack->gap_pairing_state != GAP_PAIRING_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED;
61690a51f88bSMatthias Ringwald     return gap_pairing_set_state_and_run(addr, GAP_PAIRING_STATE_SEND_PIN_NEGATIVE);
61700a51f88bSMatthias Ringwald }
61710a51f88bSMatthias Ringwald 
61720a51f88bSMatthias Ringwald /**
61730a51f88bSMatthias Ringwald  * @brief SSP Passkey Response
61740a51f88bSMatthias Ringwald  * @param addr
61750a51f88bSMatthias Ringwald  * @param passkey
61760a51f88bSMatthias Ringwald  * @return 0 if ok
61770a51f88bSMatthias Ringwald  */
6178667ba9d1SMatthias Ringwald int gap_ssp_passkey_response(const bd_addr_t addr, uint32_t passkey){
6179cd74063aSMatthias Ringwald     if (hci_stack->gap_pairing_state != GAP_PAIRING_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED;
6180d504181aSMatthias Ringwald     hci_stack->gap_pairing_input.gap_pairing_passkey = passkey;
61810a51f88bSMatthias Ringwald     return gap_pairing_set_state_and_run(addr, GAP_PAIRING_STATE_SEND_PASSKEY);
61820a51f88bSMatthias Ringwald }
61830a51f88bSMatthias Ringwald 
61840a51f88bSMatthias Ringwald /**
61850a51f88bSMatthias Ringwald  * @brief Abort SSP Passkey Entry/Pairing
61860a51f88bSMatthias Ringwald  * @param addr
61870a51f88bSMatthias Ringwald  * @param pin
61880a51f88bSMatthias Ringwald  * @return 0 if ok
61890a51f88bSMatthias Ringwald  */
6190667ba9d1SMatthias Ringwald int gap_ssp_passkey_negative(const bd_addr_t addr){
6191cd74063aSMatthias Ringwald     if (hci_stack->gap_pairing_state != GAP_PAIRING_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED;
61920a51f88bSMatthias Ringwald     return gap_pairing_set_state_and_run(addr, GAP_PAIRING_STATE_SEND_PASSKEY_NEGATIVE);
61930a51f88bSMatthias Ringwald }
61940a51f88bSMatthias Ringwald 
61950a51f88bSMatthias Ringwald /**
61960a51f88bSMatthias Ringwald  * @brief Accept SSP Numeric Comparison
61970a51f88bSMatthias Ringwald  * @param addr
61980a51f88bSMatthias Ringwald  * @param passkey
61990a51f88bSMatthias Ringwald  * @return 0 if ok
62000a51f88bSMatthias Ringwald  */
6201667ba9d1SMatthias Ringwald int gap_ssp_confirmation_response(const bd_addr_t addr){
6202cd74063aSMatthias Ringwald     if (hci_stack->gap_pairing_state != GAP_PAIRING_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED;
62030a51f88bSMatthias Ringwald     return gap_pairing_set_state_and_run(addr, GAP_PAIRING_STATE_SEND_CONFIRMATION);
62040a51f88bSMatthias Ringwald }
62050a51f88bSMatthias Ringwald 
62060a51f88bSMatthias Ringwald /**
62070a51f88bSMatthias Ringwald  * @brief Abort SSP Numeric Comparison/Pairing
62080a51f88bSMatthias Ringwald  * @param addr
62090a51f88bSMatthias Ringwald  * @param pin
62100a51f88bSMatthias Ringwald  * @return 0 if ok
62110a51f88bSMatthias Ringwald  */
6212667ba9d1SMatthias Ringwald int gap_ssp_confirmation_negative(const bd_addr_t addr){
6213cd74063aSMatthias Ringwald     if (hci_stack->gap_pairing_state != GAP_PAIRING_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED;
62140a51f88bSMatthias Ringwald     return gap_pairing_set_state_and_run(addr, GAP_PAIRING_STATE_SEND_CONFIRMATION_NEGATIVE);
62150a51f88bSMatthias Ringwald }
62160a51f88bSMatthias Ringwald 
621744565b0cSMatthias Ringwald #ifdef ENABLE_EXPLICIT_IO_CAPABILITIES_REPLY
621844565b0cSMatthias Ringwald 
621944565b0cSMatthias Ringwald static uint8_t gap_set_auth_flag_and_run(const bd_addr_t addr, hci_authentication_flags_t flag){
622044565b0cSMatthias Ringwald     hci_connection_t * conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL);
622144565b0cSMatthias Ringwald     if (!conn) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
622244565b0cSMatthias Ringwald     connectionSetAuthenticationFlags(conn, flag);
622344565b0cSMatthias Ringwald     hci_run();
622444565b0cSMatthias Ringwald     return ERROR_CODE_SUCCESS;
622544565b0cSMatthias Ringwald }
622644565b0cSMatthias Ringwald 
622744565b0cSMatthias Ringwald uint8_t gap_ssp_io_capabilities_response(const bd_addr_t addr){
622844565b0cSMatthias Ringwald     return gap_set_auth_flag_and_run(addr, SEND_IO_CAPABILITIES_REPLY);
622944565b0cSMatthias Ringwald }
623044565b0cSMatthias Ringwald 
623144565b0cSMatthias Ringwald uint8_t gap_ssp_io_capabilities_negative(const bd_addr_t addr){
623244565b0cSMatthias Ringwald     return gap_set_auth_flag_and_run(addr, SEND_IO_CAPABILITIES_NEGATIVE_REPLY);
623344565b0cSMatthias Ringwald }
623444565b0cSMatthias Ringwald #endif
623544565b0cSMatthias Ringwald 
62361849becdSMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB
62371849becdSMatthias Ringwald /**
62381849becdSMatthias Ringwald  * @brief Report Remote OOB Data
62391849becdSMatthias Ringwald  * @param bd_addr
62401849becdSMatthias Ringwald  * @param c_192 Simple Pairing Hash C derived from P-192 public key
62411849becdSMatthias Ringwald  * @param r_192 Simple Pairing Randomizer derived from P-192 public key
62421849becdSMatthias Ringwald  * @param c_256 Simple Pairing Hash C derived from P-256 public key
62431849becdSMatthias Ringwald  * @param r_256 Simple Pairing Randomizer derived from P-256 public key
62441849becdSMatthias Ringwald  */
62451849becdSMatthias 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){
62461849becdSMatthias Ringwald     hci_connection_t * connection = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL);
62471849becdSMatthias Ringwald     if (connection == NULL) {
62481849becdSMatthias Ringwald         return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
62491849becdSMatthias Ringwald     }
62501849becdSMatthias Ringwald     connection->classic_oob_c_192 = c_192;
62511849becdSMatthias Ringwald     connection->classic_oob_r_192 = r_192;
62521849becdSMatthias Ringwald     connection->classic_oob_c_256 = c_256;
62531849becdSMatthias Ringwald     connection->classic_oob_r_256 = r_256;
62541849becdSMatthias Ringwald     return ERROR_CODE_SUCCESS;
62551849becdSMatthias Ringwald }
6256cf01e888SMatthias Ringwald /**
6257cf01e888SMatthias Ringwald  * @brief Generate new OOB data
6258cf01e888SMatthias Ringwald  * @note OOB data will be provided in GAP_EVENT_LOCAL_OOB_DATA and be used in future pairing procedures
6259cf01e888SMatthias Ringwald  */
6260cf01e888SMatthias Ringwald void gap_ssp_generate_oob_data(void){
6261cf01e888SMatthias Ringwald     hci_stack->classic_read_local_oob_data = true;
6262cf01e888SMatthias Ringwald     hci_run();
6263cf01e888SMatthias Ringwald }
6264cf01e888SMatthias Ringwald 
62651849becdSMatthias Ringwald #endif
62661849becdSMatthias Ringwald 
6267f5875de5SMatthias Ringwald /**
6268f6858d14SMatthias Ringwald  * @brief Set inquiry mode: standard, with RSSI, with RSSI + Extended Inquiry Results. Has to be called before power on.
6269f5875de5SMatthias Ringwald  * @param inquiry_mode see bluetooth_defines.h
6270f6858d14SMatthias Ringwald  */
6271b45b7749SMilanka Ringwald void hci_set_inquiry_mode(inquiry_mode_t inquiry_mode){
6272b45b7749SMilanka Ringwald     hci_stack->inquiry_mode = inquiry_mode;
6273f6858d14SMatthias Ringwald }
6274f6858d14SMatthias Ringwald 
6275f6858d14SMatthias Ringwald /**
6276d950d659SMatthias Ringwald  * @brief Configure Voice Setting for use with SCO data in HSP/HFP
6277d950d659SMatthias Ringwald  */
6278d950d659SMatthias Ringwald void hci_set_sco_voice_setting(uint16_t voice_setting){
6279d950d659SMatthias Ringwald     hci_stack->sco_voice_setting = voice_setting;
6280d950d659SMatthias Ringwald }
6281d950d659SMatthias Ringwald 
6282d950d659SMatthias Ringwald /**
6283d950d659SMatthias Ringwald  * @brief Get SCO Voice Setting
6284d950d659SMatthias Ringwald  * @return current voice setting
6285d950d659SMatthias Ringwald  */
62860cb5b971SMatthias Ringwald uint16_t hci_get_sco_voice_setting(void){
6287d950d659SMatthias Ringwald     return hci_stack->sco_voice_setting;
6288d950d659SMatthias Ringwald }
6289d950d659SMatthias Ringwald 
6290400ff5abSMatthias Ringwald static int hci_have_usb_transport(void){
6291400ff5abSMatthias Ringwald     if (!hci_stack->hci_transport) return 0;
6292400ff5abSMatthias Ringwald     const char * transport_name = hci_stack->hci_transport->name;
6293400ff5abSMatthias Ringwald     if (!transport_name) return 0;
6294400ff5abSMatthias Ringwald     return (transport_name[0] == 'H') && (transport_name[1] == '2');
6295400ff5abSMatthias Ringwald }
6296400ff5abSMatthias Ringwald 
6297b3aad8daSMatthias Ringwald /** @brief Get SCO packet length for current SCO Voice setting
6298b3aad8daSMatthias Ringwald  *  @note  Using SCO packets of the exact length is required for USB transfer
6299b3aad8daSMatthias Ringwald  *  @return Length of SCO packets in bytes (not audio frames)
6300b3aad8daSMatthias Ringwald  */
6301b3aad8daSMatthias Ringwald int hci_get_sco_packet_length(void){
6302a3069afeSMatthias Ringwald     int sco_packet_length = 0;
6303cf119f3bSMatthias Ringwald 
63041e20a53eSMatthias Ringwald #ifdef ENABLE_SCO_OVER_HCI
63056f28d2eeSMatthias Ringwald     // Transparent = mSBC => 1, CVSD with 16-bit samples requires twice as much bytes
63061431ce27SMatthias Ringwald     int multiplier = ((hci_stack->sco_voice_setting_active & 0x03) == 0x03) ? 1 : 2;
6307cf119f3bSMatthias Ringwald 
6308400ff5abSMatthias Ringwald     if (hci_have_usb_transport()){
6309400ff5abSMatthias Ringwald         // see Core Spec for H2 USB Transfer.
6310cf119f3bSMatthias Ringwald         // 3 byte SCO header + 24 bytes per connection
631152e46257SMatthias Ringwald         int num_sco_connections = btstack_max(1, hci_number_sco_connections());
631252e46257SMatthias Ringwald         sco_packet_length = 3 + 24 * num_sco_connections * multiplier;
6313400ff5abSMatthias Ringwald     } else {
6314400ff5abSMatthias Ringwald         // 3 byte SCO header + SCO packet size over the air (60 bytes)
6315400ff5abSMatthias Ringwald         sco_packet_length = 3 + 60 * multiplier;
6316d966a453SMatthias Ringwald         // assert that it still fits inside an SCO buffer
6317d966a453SMatthias Ringwald         if (sco_packet_length > hci_stack->sco_data_packet_length){
6318d966a453SMatthias Ringwald             sco_packet_length = 3 + 60;
6319d966a453SMatthias Ringwald         }
6320400ff5abSMatthias Ringwald     }
6321a3069afeSMatthias Ringwald #endif
63225b7087c7SMatthias Ringwald 
63235b7087c7SMatthias Ringwald #ifdef HAVE_SCO_TRANSPORT
63245b7087c7SMatthias Ringwald     // Transparent = mSBC => 1, CVSD with 16-bit samples requires twice as much bytes
63251e20a53eSMatthias Ringwald     int multiplier = ((hci_stack->sco_voice_setting_active & 0x03) == 0x03) ? 1 : 2;
63265b7087c7SMatthias Ringwald     sco_packet_length = 3 + 60 * multiplier;
63275b7087c7SMatthias Ringwald #endif
6328a3069afeSMatthias Ringwald     return sco_packet_length;
6329b3aad8daSMatthias Ringwald }
6330b3aad8daSMatthias Ringwald 
6331c4c88f1bSJakob Krantz /**
6332c4c88f1bSJakob Krantz * @brief Sets the master/slave policy
6333c4c88f1bSJakob Krantz * @param policy (0: attempt to become master, 1: let connecting device decide)
6334c4c88f1bSJakob Krantz */
6335c4c88f1bSJakob Krantz void hci_set_master_slave_policy(uint8_t policy){
6336c4c88f1bSJakob Krantz     hci_stack->master_slave_policy = policy;
6337c4c88f1bSJakob Krantz }
6338c4c88f1bSJakob Krantz 
6339c4c88f1bSJakob Krantz #endif
6340ec111c8bSMatthias Ringwald 
6341ec111c8bSMatthias Ringwald HCI_STATE hci_get_state(void){
6342ec111c8bSMatthias Ringwald     return hci_stack->state;
6343ec111c8bSMatthias Ringwald }
6344ec111c8bSMatthias Ringwald 
634507e010b6SMilanka Ringwald #ifdef ENABLE_CLASSIC
63465e91d96cSMatthias Ringwald void gap_register_classic_connection_filter(int (*accept_callback)(bd_addr_t addr, hci_link_type_t link_type)){
634707e010b6SMilanka Ringwald     hci_stack->gap_classic_accept_callback = accept_callback;
634807e010b6SMilanka Ringwald }
634907e010b6SMilanka Ringwald #endif
6350ec111c8bSMatthias Ringwald 
6351d950d659SMatthias Ringwald /**
6352d23838ecSMatthias Ringwald  * @brief Set callback for Bluetooth Hardware Error
6353d23838ecSMatthias Ringwald  */
6354c2e1fa60SMatthias Ringwald void hci_set_hardware_error_callback(void (*fn)(uint8_t error)){
6355d23838ecSMatthias Ringwald     hci_stack->hardware_error_callback = fn;
6356d23838ecSMatthias Ringwald }
6357d23838ecSMatthias Ringwald 
635871de195eSMatthias Ringwald void hci_disconnect_all(void){
6359665d90f2SMatthias Ringwald     btstack_linked_list_iterator_t it;
6360665d90f2SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->connections);
6361665d90f2SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
6362665d90f2SMatthias Ringwald         hci_connection_t * con = (hci_connection_t*) btstack_linked_list_iterator_next(&it);
636304a6ef8cSmatthias.ringwald         if (con->state == SENT_DISCONNECT) continue;
636404a6ef8cSmatthias.ringwald         con->state = SEND_DISCONNECT;
636504a6ef8cSmatthias.ringwald     }
6366d31fba26S[email protected]     hci_run();
636704a6ef8cSmatthias.ringwald }
636833373e40SMatthias Ringwald 
636933373e40SMatthias Ringwald uint16_t hci_get_manufacturer(void){
637033373e40SMatthias Ringwald     return hci_stack->manufacturer;
637133373e40SMatthias Ringwald }
63729c6e867eSMatthias Ringwald 
63733e329ddfSandryblack #ifdef ENABLE_BLE
63749c6e867eSMatthias Ringwald static sm_connection_t * sm_get_connection_for_handle(hci_con_handle_t con_handle){
63759c6e867eSMatthias Ringwald     hci_connection_t * hci_con = hci_connection_for_handle(con_handle);
63769c6e867eSMatthias Ringwald     if (!hci_con) return NULL;
63779c6e867eSMatthias Ringwald     return &hci_con->sm_connection;
63789c6e867eSMatthias Ringwald }
63799c6e867eSMatthias Ringwald 
63809c6e867eSMatthias Ringwald // extracted from sm.c to allow enabling of l2cap le data channels without adding sm.c to the build
63819c6e867eSMatthias Ringwald // without sm.c default values from create_connection_for_bd_addr_and_type() resulg in non-encrypted, not-authenticated
63826a79f6baSMatthias Ringwald #endif
63839c6e867eSMatthias Ringwald 
63849c6e867eSMatthias Ringwald int gap_encryption_key_size(hci_con_handle_t con_handle){
6385c5fb5ca4SMatthias Ringwald     hci_connection_t * hci_connection = hci_connection_for_handle(con_handle);
6386c5fb5ca4SMatthias Ringwald     if (hci_connection == NULL) return 0;
6387c5fb5ca4SMatthias Ringwald     if (hci_is_le_connection(hci_connection)){
63886a79f6baSMatthias Ringwald #ifdef ENABLE_BLE
6389c5fb5ca4SMatthias Ringwald         sm_connection_t * sm_conn = &hci_connection->sm_connection;
6390c5fb5ca4SMatthias Ringwald         if (sm_conn->sm_connection_encrypted) {
63919c6e867eSMatthias Ringwald             return sm_conn->sm_actual_encryption_key_size;
63929c6e867eSMatthias Ringwald         }
63936a79f6baSMatthias Ringwald #endif
63946a79f6baSMatthias Ringwald     } else {
6395c5fb5ca4SMatthias Ringwald #ifdef ENABLE_CLASSIC
6396c5fb5ca4SMatthias Ringwald         if ((hci_connection->authentication_flags & CONNECTION_ENCRYPTED)){
6397c5fb5ca4SMatthias Ringwald             return hci_connection->encryption_key_size;
6398c5fb5ca4SMatthias Ringwald         }
6399c5fb5ca4SMatthias Ringwald #endif
64006a79f6baSMatthias Ringwald     }
6401c5fb5ca4SMatthias Ringwald     return 0;
6402c5fb5ca4SMatthias Ringwald }
64039c6e867eSMatthias Ringwald 
64049c6e867eSMatthias Ringwald int gap_authenticated(hci_con_handle_t con_handle){
6405c5fb5ca4SMatthias Ringwald     hci_connection_t * hci_connection = hci_connection_for_handle(con_handle);
6406c5fb5ca4SMatthias Ringwald     if (hci_connection == NULL) return 0;
64075f3981bfSMatthias Ringwald 
6408c5fb5ca4SMatthias Ringwald     switch (hci_connection->address_type){
64096a79f6baSMatthias Ringwald #ifdef ENABLE_BLE
64105f3981bfSMatthias Ringwald         case BD_ADDR_TYPE_LE_PUBLIC:
64115f3981bfSMatthias Ringwald         case BD_ADDR_TYPE_LE_RANDOM:
6412c5fb5ca4SMatthias Ringwald             if (hci_connection->sm_connection.sm_connection_encrypted == 0) return 0; // unencrypted connection cannot be authenticated
6413c5fb5ca4SMatthias Ringwald             return hci_connection->sm_connection.sm_connection_authenticated;
64146a79f6baSMatthias Ringwald #endif
641559a1a47aSMatthias Ringwald #ifdef ENABLE_CLASSIC
64165f3981bfSMatthias Ringwald         case BD_ADDR_TYPE_SCO:
6417f16129ceSMatthias Ringwald         case BD_ADDR_TYPE_ACL:
6418c5fb5ca4SMatthias Ringwald             return gap_authenticated_for_link_key_type(hci_connection->link_key_type);
641959a1a47aSMatthias Ringwald #endif
64205f3981bfSMatthias Ringwald         default:
64215f3981bfSMatthias Ringwald             return 0;
64225f3981bfSMatthias Ringwald     }
64239c6e867eSMatthias Ringwald }
64249c6e867eSMatthias Ringwald 
6425f1dfbe18SMatthias Ringwald int gap_secure_connection(hci_con_handle_t con_handle){
6426c5fb5ca4SMatthias Ringwald     hci_connection_t * hci_connection = hci_connection_for_handle(con_handle);
6427c5fb5ca4SMatthias Ringwald     if (hci_connection == NULL) return 0;
64288b35e16aSMatthias Ringwald 
6429c5fb5ca4SMatthias Ringwald     switch (hci_connection->address_type){
64306a79f6baSMatthias Ringwald #ifdef ENABLE_BLE
64318b35e16aSMatthias Ringwald         case BD_ADDR_TYPE_LE_PUBLIC:
64328b35e16aSMatthias Ringwald         case BD_ADDR_TYPE_LE_RANDOM:
6433c5fb5ca4SMatthias Ringwald             if (hci_connection->sm_connection.sm_connection_encrypted == 0) return 0; // unencrypted connection cannot be authenticated
6434c5fb5ca4SMatthias Ringwald             return hci_connection->sm_connection.sm_connection_sc;
64356a79f6baSMatthias Ringwald #endif
643659a1a47aSMatthias Ringwald #ifdef ENABLE_CLASSIC
64378b35e16aSMatthias Ringwald         case BD_ADDR_TYPE_SCO:
6438f16129ceSMatthias Ringwald         case BD_ADDR_TYPE_ACL:
6439c5fb5ca4SMatthias Ringwald             return gap_secure_connection_for_link_key_type(hci_connection->link_key_type);
644059a1a47aSMatthias Ringwald #endif
64418b35e16aSMatthias Ringwald         default:
64428b35e16aSMatthias Ringwald             return 0;
64438b35e16aSMatthias Ringwald     }
6444f1dfbe18SMatthias Ringwald }
6445f1dfbe18SMatthias Ringwald 
64461e122704SMatthias Ringwald bool gap_bonded(hci_con_handle_t con_handle){
64471e122704SMatthias Ringwald 	hci_connection_t * hci_connection = hci_connection_for_handle(con_handle);
64481e122704SMatthias Ringwald 	if (hci_connection == NULL) return 0;
64491e122704SMatthias Ringwald 
645048f33f37SMatthias Ringwald #ifdef ENABLE_CLASSIC
64511e122704SMatthias Ringwald 	link_key_t link_key;
64521e122704SMatthias Ringwald 	link_key_type_t link_key_type;
645348f33f37SMatthias Ringwald #endif
64541e122704SMatthias Ringwald 	switch (hci_connection->address_type){
64556a79f6baSMatthias Ringwald #ifdef ENABLE_BLE
64561e122704SMatthias Ringwald 		case BD_ADDR_TYPE_LE_PUBLIC:
64571e122704SMatthias Ringwald 		case BD_ADDR_TYPE_LE_RANDOM:
64581e122704SMatthias Ringwald 			return hci_connection->sm_connection.sm_le_db_index >= 0;
64596a79f6baSMatthias Ringwald #endif
64601e122704SMatthias Ringwald #ifdef ENABLE_CLASSIC
64611e122704SMatthias Ringwald 		case BD_ADDR_TYPE_SCO:
64621e122704SMatthias Ringwald 		case BD_ADDR_TYPE_ACL:
64631e122704SMatthias Ringwald 			return hci_stack->link_key_db && hci_stack->link_key_db->get_link_key(hci_connection->address, link_key, &link_key_type);
64641e122704SMatthias Ringwald #endif
64651e122704SMatthias Ringwald 		default:
64661e122704SMatthias Ringwald 			return false;
64671e122704SMatthias Ringwald 	}
64681e122704SMatthias Ringwald }
64691e122704SMatthias Ringwald 
64706a79f6baSMatthias Ringwald #ifdef ENABLE_BLE
64719c6e867eSMatthias Ringwald authorization_state_t gap_authorization_state(hci_con_handle_t con_handle){
64729c6e867eSMatthias Ringwald     sm_connection_t * sm_conn = sm_get_connection_for_handle(con_handle);
64739c6e867eSMatthias Ringwald     if (!sm_conn) return AUTHORIZATION_UNKNOWN;     // wrong connection
64749c6e867eSMatthias Ringwald     if (!sm_conn->sm_connection_encrypted)               return AUTHORIZATION_UNKNOWN; // unencrypted connection cannot be authorized
64759c6e867eSMatthias Ringwald     if (!sm_conn->sm_connection_authenticated)           return AUTHORIZATION_UNKNOWN; // unauthenticatd connection cannot be authorized
64769c6e867eSMatthias Ringwald     return sm_conn->sm_connection_authorization_state;
64779c6e867eSMatthias Ringwald }
64789c6e867eSMatthias Ringwald #endif
6479f8ee3071SMatthias Ringwald 
6480f8ee3071SMatthias Ringwald #ifdef ENABLE_CLASSIC
6481f8ee3071SMatthias 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){
6482f8ee3071SMatthias Ringwald     hci_connection_t * conn = hci_connection_for_handle(con_handle);
6483f8ee3071SMatthias Ringwald     if (!conn) return GAP_CONNECTION_INVALID;
6484f8ee3071SMatthias Ringwald     conn->sniff_min_interval = sniff_min_interval;
6485f8ee3071SMatthias Ringwald     conn->sniff_max_interval = sniff_max_interval;
6486f8ee3071SMatthias Ringwald     conn->sniff_attempt = sniff_attempt;
6487f8ee3071SMatthias Ringwald     conn->sniff_timeout = sniff_timeout;
6488f8ee3071SMatthias Ringwald     hci_run();
6489f8ee3071SMatthias Ringwald     return 0;
6490f8ee3071SMatthias Ringwald }
6491f8ee3071SMatthias Ringwald 
6492f8ee3071SMatthias Ringwald /**
6493f8ee3071SMatthias Ringwald  * @brief Exit Sniff mode
6494f8ee3071SMatthias Ringwald  * @param con_handle
6495f8ee3071SMatthias Ringwald  @ @return 0 if ok
6496f8ee3071SMatthias Ringwald  */
6497f8ee3071SMatthias Ringwald uint8_t gap_sniff_mode_exit(hci_con_handle_t con_handle){
6498f8ee3071SMatthias Ringwald     hci_connection_t * conn = hci_connection_for_handle(con_handle);
6499f8ee3071SMatthias Ringwald     if (!conn) return GAP_CONNECTION_INVALID;
6500f8ee3071SMatthias Ringwald     conn->sniff_min_interval = 0xffff;
6501f8ee3071SMatthias Ringwald     hci_run();
6502f8ee3071SMatthias Ringwald     return 0;
6503f8ee3071SMatthias Ringwald }
6504bea424a5SMatthias Ringwald 
6505140c0557SMatthias 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){
6506140c0557SMatthias Ringwald     hci_connection_t * conn = hci_connection_for_handle(con_handle);
6507140c0557SMatthias Ringwald     if (!conn) return GAP_CONNECTION_INVALID;
6508140c0557SMatthias Ringwald     conn->sniff_subrating_max_latency = max_latency;
6509140c0557SMatthias Ringwald     conn->sniff_subrating_min_remote_timeout = min_remote_timeout;
6510140c0557SMatthias Ringwald     conn->sniff_subrating_min_local_timeout = min_local_timeout;
6511140c0557SMatthias Ringwald     hci_run();
6512dc8d5bd3SMatthias Ringwald     return ERROR_CODE_SUCCESS;
6513140c0557SMatthias Ringwald }
6514140c0557SMatthias Ringwald 
6515278ff8a9SMatthias 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){
6516278ff8a9SMatthias Ringwald     hci_connection_t * conn = hci_connection_for_handle(con_handle);
6517278ff8a9SMatthias Ringwald     if (!conn) return GAP_CONNECTION_INVALID;
6518278ff8a9SMatthias Ringwald     conn->qos_service_type = service_type;
6519278ff8a9SMatthias Ringwald     conn->qos_token_rate = token_rate;
6520278ff8a9SMatthias Ringwald     conn->qos_peak_bandwidth = peak_bandwidth;
6521278ff8a9SMatthias Ringwald     conn->qos_latency = latency;
6522278ff8a9SMatthias Ringwald     conn->qos_delay_variation = delay_variation;
6523278ff8a9SMatthias Ringwald     hci_run();
6524278ff8a9SMatthias Ringwald     return ERROR_CODE_SUCCESS;
6525278ff8a9SMatthias Ringwald }
6526278ff8a9SMatthias Ringwald 
6527bea424a5SMatthias Ringwald void gap_set_page_scan_activity(uint16_t page_scan_interval, uint16_t page_scan_window){
6528bea424a5SMatthias Ringwald     hci_stack->new_page_scan_interval = page_scan_interval;
6529bea424a5SMatthias Ringwald     hci_stack->new_page_scan_window = page_scan_window;
6530bea424a5SMatthias Ringwald     hci_run();
6531bea424a5SMatthias Ringwald }
6532bea424a5SMatthias Ringwald 
6533bea424a5SMatthias Ringwald void gap_set_page_scan_type(page_scan_type_t page_scan_type){
6534bea424a5SMatthias Ringwald     hci_stack->new_page_scan_type = (uint8_t) page_scan_type;
6535bea424a5SMatthias Ringwald     hci_run();
6536bea424a5SMatthias Ringwald }
6537bea424a5SMatthias Ringwald 
6538f8ee3071SMatthias Ringwald #endif
6539beceeddeSMatthias Ringwald 
6540beceeddeSMatthias Ringwald void hci_halting_defer(void){
6541beceeddeSMatthias Ringwald     if (hci_stack->state != HCI_STATE_HALTING) return;
6542beceeddeSMatthias Ringwald     switch (hci_stack->substate){
6543beceeddeSMatthias Ringwald         case HCI_HALTING_DISCONNECT_ALL_NO_TIMER:
6544beceeddeSMatthias Ringwald         case HCI_HALTING_CLOSE:
6545beceeddeSMatthias Ringwald             hci_stack->substate = HCI_HALTING_DISCONNECT_ALL_TIMER;
6546beceeddeSMatthias Ringwald             break;
6547beceeddeSMatthias Ringwald         default:
6548beceeddeSMatthias Ringwald             break;
6549beceeddeSMatthias Ringwald     }
6550beceeddeSMatthias Ringwald }
6551eddac615SMatthias Ringwald 
655221debf25SMatthias Ringwald #ifdef ENABLE_LE_PRIVACY_ADDRESS_RESOLUTION
655321debf25SMatthias Ringwald void hci_load_le_device_db_entry_into_resolving_list(uint16_t le_device_db_index){
655421debf25SMatthias Ringwald     if (le_device_db_index >= MAX_NUM_RESOLVING_LIST_ENTRIES) return;
655521debf25SMatthias Ringwald     if (le_device_db_index >= le_device_db_max_count()) return;
655621debf25SMatthias Ringwald     uint8_t offset = le_device_db_index >> 3;
655721debf25SMatthias Ringwald     uint8_t mask = 1 << (le_device_db_index & 7);
655802b02cffSMatthias Ringwald     hci_stack->le_resolving_list_add_entries[offset] |= mask;
655921debf25SMatthias Ringwald     if (hci_stack->le_resolving_list_state == LE_RESOLVING_LIST_DONE){
656002b02cffSMatthias Ringwald     	// note: go back to remove entries, otherwise, a remove + add will skip the add
656102b02cffSMatthias Ringwald         hci_stack->le_resolving_list_state = LE_RESOLVING_LIST_REMOVE_ENTRIES;
656202b02cffSMatthias Ringwald     }
656302b02cffSMatthias Ringwald }
656402b02cffSMatthias Ringwald 
656502b02cffSMatthias Ringwald void hci_remove_le_device_db_entry_from_resolving_list(uint16_t le_device_db_index){
656602b02cffSMatthias Ringwald 	if (le_device_db_index >= MAX_NUM_RESOLVING_LIST_ENTRIES) return;
656702b02cffSMatthias Ringwald 	if (le_device_db_index >= le_device_db_max_count()) return;
656802b02cffSMatthias Ringwald 	uint8_t offset = le_device_db_index >> 3;
656902b02cffSMatthias Ringwald 	uint8_t mask = 1 << (le_device_db_index & 7);
657002b02cffSMatthias Ringwald 	hci_stack->le_resolving_list_remove_entries[offset] |= mask;
657102b02cffSMatthias Ringwald 	if (hci_stack->le_resolving_list_state == LE_RESOLVING_LIST_DONE){
657202b02cffSMatthias Ringwald 		hci_stack->le_resolving_list_state = LE_RESOLVING_LIST_REMOVE_ENTRIES;
657321debf25SMatthias Ringwald 	}
657421debf25SMatthias Ringwald }
6575cf38a091SMatthias Ringwald 
6576cf38a091SMatthias Ringwald uint8_t gap_load_resolving_list_from_le_device_db(void){
6577cf38a091SMatthias Ringwald 	if ((hci_stack->local_supported_commands[1] & (1 << 2)) == 0) {
6578cf38a091SMatthias Ringwald 		return ERROR_CODE_UNSUPPORTED_FEATURE_OR_PARAMETER_VALUE;
6579cf38a091SMatthias Ringwald 	}
6580cf38a091SMatthias Ringwald 	if (hci_stack->le_resolving_list_state != LE_RESOLVING_LIST_SEND_ENABLE_ADDRESS_RESOLUTION){
6581cf38a091SMatthias Ringwald 		// restart le resolving list update
6582cf38a091SMatthias Ringwald 		hci_stack->le_resolving_list_state = LE_RESOLVING_LIST_READ_SIZE;
6583cf38a091SMatthias Ringwald 	}
6584cf38a091SMatthias Ringwald 	return ERROR_CODE_SUCCESS;
6585cf38a091SMatthias Ringwald }
658621debf25SMatthias Ringwald #endif
658721debf25SMatthias Ringwald 
6588eddac615SMatthias Ringwald #ifdef FUZZING_BUILD_MODE_UNSAFE_FOR_PRODUCTION
658918976c74SMatthias Ringwald void hci_setup_test_connections_fuzz(void){
659018976c74SMatthias Ringwald     hci_connection_t * conn;
659118976c74SMatthias Ringwald 
659218976c74SMatthias Ringwald     // default address: 66:55:44:33:00:01
659318976c74SMatthias Ringwald     bd_addr_t addr = { 0x66, 0x55, 0x44, 0x33, 0x00, 0x00};
659418976c74SMatthias Ringwald 
65957d33cb26SMilanka Ringwald     // setup Controller info
65967d33cb26SMilanka Ringwald     hci_stack->num_cmd_packets = 255;
65977d33cb26SMilanka Ringwald     hci_stack->acl_packets_total_num = 255;
65987d33cb26SMilanka Ringwald 
659918976c74SMatthias Ringwald     // setup incoming Classic ACL connection with con handle 0x0001, 66:55:44:33:22:01
660018976c74SMatthias Ringwald     addr[5] = 0x01;
660118976c74SMatthias Ringwald     conn = create_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL);
660218976c74SMatthias Ringwald     conn->con_handle = addr[5];
660318976c74SMatthias Ringwald     conn->role  = HCI_ROLE_SLAVE;
660418976c74SMatthias Ringwald     conn->state = RECEIVED_CONNECTION_REQUEST;
66057d33cb26SMilanka Ringwald     conn->sm_connection.sm_role = HCI_ROLE_SLAVE;
660618976c74SMatthias Ringwald 
660718976c74SMatthias Ringwald     // setup incoming Classic SCO connection with con handle 0x0002
660818976c74SMatthias Ringwald     addr[5] = 0x02;
660918976c74SMatthias Ringwald     conn = create_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_SCO);
661018976c74SMatthias Ringwald     conn->con_handle = addr[5];
661118976c74SMatthias Ringwald     conn->role  = HCI_ROLE_SLAVE;
661218976c74SMatthias Ringwald     conn->state = RECEIVED_CONNECTION_REQUEST;
66137d33cb26SMilanka Ringwald     conn->sm_connection.sm_role = HCI_ROLE_SLAVE;
661418976c74SMatthias Ringwald 
661518976c74SMatthias Ringwald     // setup ready Classic ACL connection with con handle 0x0003
661618976c74SMatthias Ringwald     addr[5] = 0x03;
661718976c74SMatthias Ringwald     conn = create_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL);
661818976c74SMatthias Ringwald     conn->con_handle = addr[5];
661918976c74SMatthias Ringwald     conn->role  = HCI_ROLE_SLAVE;
662018976c74SMatthias Ringwald     conn->state = OPEN;
66217d33cb26SMilanka Ringwald     conn->sm_connection.sm_role = HCI_ROLE_SLAVE;
662218976c74SMatthias Ringwald 
662318976c74SMatthias Ringwald     // setup ready Classic SCO connection with con handle 0x0004
662418976c74SMatthias Ringwald     addr[5] = 0x04;
662518976c74SMatthias Ringwald     conn = create_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_SCO);
662618976c74SMatthias Ringwald     conn->con_handle = addr[5];
662718976c74SMatthias Ringwald     conn->role  = HCI_ROLE_SLAVE;
662818976c74SMatthias Ringwald     conn->state = OPEN;
66297d33cb26SMilanka Ringwald     conn->sm_connection.sm_role = HCI_ROLE_SLAVE;
663018976c74SMatthias Ringwald 
663118976c74SMatthias Ringwald     // setup ready LE ACL connection with con handle 0x005 and public address
663218976c74SMatthias Ringwald     addr[5] = 0x05;
663318976c74SMatthias Ringwald     conn = create_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_LE_PUBLIC);
663418976c74SMatthias Ringwald     conn->con_handle = addr[5];
663518976c74SMatthias Ringwald     conn->role  = HCI_ROLE_SLAVE;
663618976c74SMatthias Ringwald     conn->state = OPEN;
66377d33cb26SMilanka Ringwald     conn->sm_connection.sm_role = HCI_ROLE_SLAVE;
66388046a24aSMatthias Ringwald     conn->sm_connection.sm_connection_encrypted = 1;
663918976c74SMatthias Ringwald }
664018976c74SMatthias Ringwald 
6641eddac615SMatthias Ringwald void hci_free_connections_fuzz(void){
6642eddac615SMatthias Ringwald     btstack_linked_list_iterator_t it;
6643eddac615SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->connections);
6644eddac615SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
6645eddac615SMatthias Ringwald         hci_connection_t * con = (hci_connection_t*) btstack_linked_list_iterator_next(&it);
6646eddac615SMatthias Ringwald         btstack_linked_list_iterator_remove(&it);
6647eddac615SMatthias Ringwald         btstack_memory_hci_connection_free(con);
6648eddac615SMatthias Ringwald     }
6649eddac615SMatthias Ringwald }
66501470db0cSMatthias Ringwald void hci_simulate_working_fuzz(void){
66511470db0cSMatthias Ringwald     hci_init_done();
66521470db0cSMatthias Ringwald     hci_stack->num_cmd_packets = 255;
66531470db0cSMatthias Ringwald }
6654eddac615SMatthias Ringwald #endif
6655