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