xref: /btstack/src/hci.c (revision 0bbba85b59ba97c4777ed14f3b52bf82c7150a7f)
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 
38ab2c6ae4SMatthias 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);
1565d509858SMatthias Ringwald 
157a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE
158e8c8828eSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
15939677e66SMatthias Ringwald // called from test/ble_client/advertising_data_parser.c
160384b59deSMatthias Ringwald void le_handle_advertisement_report(uint8_t *packet, uint16_t size);
16142ff5ba1SMatthias Ringwald static void hci_remove_from_whitelist(bd_addr_type_t address_type, bd_addr_t address);
1629c77c9dbSMatthias Ringwald static hci_connection_t * gap_get_outgoing_connection(void);
1635d509858SMatthias Ringwald #endif
164d70217a2SMatthias Ringwald #endif
165758b46ceSmatthias.ringwald 
16606b35ec0Smatthias.ringwald // the STACK is here
1673a9fb326S[email protected] #ifndef HAVE_MALLOC
1683a9fb326S[email protected] static hci_stack_t   hci_stack_static;
1693a9fb326S[email protected] #endif
1703a9fb326S[email protected] static hci_stack_t * hci_stack = NULL;
17116833f0aSmatthias.ringwald 
1721c9e5e9dSMatthias Ringwald #ifdef ENABLE_CLASSIC
17363168530SMatthias Ringwald // default name
17463168530SMatthias Ringwald static const char * default_classic_name = "BTstack 00:00:00:00:00:00";
17563168530SMatthias Ringwald 
17666fb9560S[email protected] // test helper
17766fb9560S[email protected] static uint8_t disable_l2cap_timeouts = 0;
1781c9e5e9dSMatthias Ringwald #endif
17966fb9560S[email protected] 
18096a45072S[email protected] /**
18196a45072S[email protected]  * create connection for given address
18296a45072S[email protected]  *
18396a45072S[email protected]  * @return connection OR NULL, if no memory left
18496a45072S[email protected]  */
18596a45072S[email protected] static hci_connection_t * create_connection_for_bd_addr_and_type(bd_addr_t addr, bd_addr_type_t addr_type){
1861a06f663S[email protected]     log_info("create_connection_for_addr %s, type %x", bd_addr_to_str(addr), addr_type);
187bb69aaaeS[email protected]     hci_connection_t * conn = btstack_memory_hci_connection_get();
18896a45072S[email protected]     if (!conn) return NULL;
189c91d150bS[email protected]     memset(conn, 0, sizeof(hci_connection_t));
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;
20396a45072S[email protected]     conn->num_acl_packets_sent = 0;
2041a06f663S[email protected]     conn->num_sco_packets_sent = 0;
205da886c03S[email protected]     conn->le_con_parameter_update_state = CON_PARAMETER_UPDATE_NONE;
206665d90f2SMatthias Ringwald     btstack_linked_list_add(&hci_stack->connections, (btstack_linked_item_t *) conn);
20796a45072S[email protected]     return conn;
20896a45072S[email protected] }
20966fb9560S[email protected] 
210da886c03S[email protected] 
211da886c03S[email protected] /**
212da886c03S[email protected]  * get le connection parameter range
213da886c03S[email protected] *
214da886c03S[email protected]  * @return le connection parameter range struct
215da886c03S[email protected]  */
2164ced4e8cSMatthias Ringwald void gap_get_connection_parameter_range(le_connection_parameter_range_t * range){
2174ced4e8cSMatthias Ringwald     *range = hci_stack->le_connection_parameter_range;
218da886c03S[email protected] }
219da886c03S[email protected] 
220da886c03S[email protected] /**
221da886c03S[email protected]  * set le connection parameter range
222da886c03S[email protected]  *
223da886c03S[email protected]  */
224da886c03S[email protected] 
2254ced4e8cSMatthias Ringwald void gap_set_connection_parameter_range(le_connection_parameter_range_t *range){
2264ced4e8cSMatthias Ringwald     hci_stack->le_connection_parameter_range = *range;
227da886c03S[email protected] }
228da886c03S[email protected] 
229da886c03S[email protected] /**
23073cd8a2aSMatthias Ringwald  * @brief Test if connection parameters are inside in existing rage
23173cd8a2aSMatthias Ringwald  * @param conn_interval_min (unit: 1.25ms)
23273cd8a2aSMatthias Ringwald  * @param conn_interval_max (unit: 1.25ms)
23373cd8a2aSMatthias Ringwald  * @param conn_latency
23473cd8a2aSMatthias Ringwald  * @param supervision_timeout (unit: 10ms)
23573cd8a2aSMatthias Ringwald  * @returns 1 if included
23673cd8a2aSMatthias Ringwald  */
23773cd8a2aSMatthias 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){
23873cd8a2aSMatthias Ringwald     if (le_conn_interval_min < existing_range->le_conn_interval_min) return 0;
23973cd8a2aSMatthias Ringwald     if (le_conn_interval_max > existing_range->le_conn_interval_max) return 0;
24073cd8a2aSMatthias Ringwald 
24173cd8a2aSMatthias Ringwald     if (le_conn_latency < existing_range->le_conn_latency_min) return 0;
24273cd8a2aSMatthias Ringwald     if (le_conn_latency > existing_range->le_conn_latency_max) return 0;
24373cd8a2aSMatthias Ringwald 
24473cd8a2aSMatthias Ringwald     if (le_supervision_timeout < existing_range->le_supervision_timeout_min) return 0;
24573cd8a2aSMatthias Ringwald     if (le_supervision_timeout > existing_range->le_supervision_timeout_max) return 0;
24673cd8a2aSMatthias Ringwald 
24773cd8a2aSMatthias Ringwald     return 1;
24873cd8a2aSMatthias Ringwald }
24973cd8a2aSMatthias Ringwald 
25073cd8a2aSMatthias Ringwald /**
2512b6ab3e6SMatthias Ringwald  * @brief Set max number of connections in LE Peripheral role (if Bluetooth Controller supports it)
2522b6ab3e6SMatthias Ringwald  * @note: default: 1
2532b6ab3e6SMatthias Ringwald  * @param max_peripheral_connections
2542b6ab3e6SMatthias Ringwald  */
255d4e4907bSMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
2562b6ab3e6SMatthias Ringwald void gap_set_max_number_peripheral_connections(int max_peripheral_connections){
2572b6ab3e6SMatthias Ringwald     hci_stack->le_max_number_peripheral_connections = max_peripheral_connections;
2582b6ab3e6SMatthias Ringwald }
259d4e4907bSMatthias Ringwald #endif
2602b6ab3e6SMatthias Ringwald 
2612b6ab3e6SMatthias Ringwald /**
262da886c03S[email protected]  * get hci connections iterator
263da886c03S[email protected]  *
264da886c03S[email protected]  * @return hci connections iterator
265da886c03S[email protected]  */
266da886c03S[email protected] 
267665d90f2SMatthias Ringwald void hci_connections_get_iterator(btstack_linked_list_iterator_t *it){
268665d90f2SMatthias Ringwald     btstack_linked_list_iterator_init(it, &hci_stack->connections);
269da886c03S[email protected] }
270da886c03S[email protected] 
27197addcc5Smatthias.ringwald /**
272ee091cf1Smatthias.ringwald  * get connection for a given handle
273ee091cf1Smatthias.ringwald  *
274ee091cf1Smatthias.ringwald  * @return connection OR NULL, if not found
275ee091cf1Smatthias.ringwald  */
2765061f3afS[email protected] hci_connection_t * hci_connection_for_handle(hci_con_handle_t con_handle){
277665d90f2SMatthias Ringwald     btstack_linked_list_iterator_t it;
278665d90f2SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->connections);
279665d90f2SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
280665d90f2SMatthias Ringwald         hci_connection_t * item = (hci_connection_t *) btstack_linked_list_iterator_next(&it);
2813ac2fe56S[email protected]         if ( item->con_handle == con_handle ) {
282da886c03S[email protected]             return item;
283ee091cf1Smatthias.ringwald         }
284ee091cf1Smatthias.ringwald     }
285ee091cf1Smatthias.ringwald     return NULL;
286ee091cf1Smatthias.ringwald }
287ee091cf1Smatthias.ringwald 
28896a45072S[email protected] /**
28996a45072S[email protected]  * get connection for given address
29096a45072S[email protected]  *
29196a45072S[email protected]  * @return connection OR NULL, if not found
29296a45072S[email protected]  */
2932e77e513S[email protected] hci_connection_t * hci_connection_for_bd_addr_and_type(bd_addr_t  addr, bd_addr_type_t addr_type){
294665d90f2SMatthias Ringwald     btstack_linked_list_iterator_t it;
295665d90f2SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->connections);
296665d90f2SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
297665d90f2SMatthias Ringwald         hci_connection_t * connection = (hci_connection_t *) btstack_linked_list_iterator_next(&it);
29896a45072S[email protected]         if (connection->address_type != addr_type)  continue;
29996a45072S[email protected]         if (memcmp(addr, connection->address, 6) != 0) continue;
30062bda3fbS[email protected]         return connection;
30162bda3fbS[email protected]     }
30262bda3fbS[email protected]     return NULL;
30362bda3fbS[email protected] }
30462bda3fbS[email protected] 
30552db98b2SMatthias Ringwald 
30652db98b2SMatthias Ringwald #ifdef ENABLE_CLASSIC
30752db98b2SMatthias Ringwald 
308ee752bb8SMatthias Ringwald #ifdef ENABLE_SCO_OVER_HCI
309ee752bb8SMatthias Ringwald static int hci_number_sco_connections(void){
310ee752bb8SMatthias Ringwald     int connections = 0;
311ee752bb8SMatthias Ringwald     btstack_linked_list_iterator_t it;
312ee752bb8SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->connections);
313ee752bb8SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
314ee752bb8SMatthias Ringwald         hci_connection_t * connection = (hci_connection_t *) btstack_linked_list_iterator_next(&it);
315ee752bb8SMatthias Ringwald         if (connection->address_type != BD_ADDR_TYPE_SCO) continue;
316ee752bb8SMatthias Ringwald         connections++;
317ee752bb8SMatthias Ringwald     }
318ee752bb8SMatthias Ringwald     return connections;
319ee752bb8SMatthias Ringwald }
320ee752bb8SMatthias Ringwald #endif
321ee752bb8SMatthias Ringwald 
322ec820d77SMatthias Ringwald static void hci_connection_timeout_handler(btstack_timer_source_t *timer){
32391a977e8SMatthias Ringwald     hci_connection_t * connection = (hci_connection_t *) btstack_run_loop_get_timer_context(timer);
324aec7654dSMatthias Ringwald #ifdef HAVE_EMBEDDED_TICK
325528a4a3bSMatthias Ringwald     if (btstack_run_loop_embedded_get_ticks() > connection->timestamp + btstack_run_loop_embedded_ticks_for_ms(HCI_CONNECTION_TIMEOUT_MS)){
326c785ef68Smatthias.ringwald         // connections might be timed out
327c785ef68Smatthias.ringwald         hci_emit_l2cap_check_timeout(connection);
328c785ef68Smatthias.ringwald     }
329f316a845SMatthias Ringwald #else
330528a4a3bSMatthias Ringwald     if (btstack_run_loop_get_time_ms() > connection->timestamp + HCI_CONNECTION_TIMEOUT_MS){
3315f26aadcSMatthias Ringwald         // connections might be timed out
3325f26aadcSMatthias Ringwald         hci_emit_l2cap_check_timeout(connection);
3335f26aadcSMatthias Ringwald     }
3345f26aadcSMatthias Ringwald #endif
335c785ef68Smatthias.ringwald }
336ee091cf1Smatthias.ringwald 
337ee091cf1Smatthias.ringwald static void hci_connection_timestamp(hci_connection_t *connection){
338aec7654dSMatthias Ringwald #ifdef HAVE_EMBEDDED_TICK
339528a4a3bSMatthias Ringwald     connection->timestamp = btstack_run_loop_embedded_get_ticks();
340f316a845SMatthias Ringwald #else
341528a4a3bSMatthias Ringwald     connection->timestamp = btstack_run_loop_get_time_ms();
3425f26aadcSMatthias Ringwald #endif
343ee091cf1Smatthias.ringwald }
344ee091cf1Smatthias.ringwald 
34528ca2b46S[email protected] inline static void connectionSetAuthenticationFlags(hci_connection_t * conn, hci_authentication_flags_t flags){
34628ca2b46S[email protected]     conn->authentication_flags = (hci_authentication_flags_t)(conn->authentication_flags | flags);
34728ca2b46S[email protected] }
34828ca2b46S[email protected] 
34935454696SMatthias Ringwald 
35028ca2b46S[email protected] inline static void connectionClearAuthenticationFlags(hci_connection_t * conn, hci_authentication_flags_t flags){
35128ca2b46S[email protected]     conn->authentication_flags = (hci_authentication_flags_t)(conn->authentication_flags & ~flags);
35228ca2b46S[email protected] }
35328ca2b46S[email protected] 
35443bfb1bdSmatthias.ringwald /**
35580ca58a0Smatthias.ringwald  * add authentication flags and reset timer
35696a45072S[email protected]  * @note: assumes classic connection
3572e77e513S[email protected]  * @note: bd_addr is passed in as litle endian uint8_t * as it is called from parsing packets
3587fde4af9Smatthias.ringwald  */
3597fde4af9Smatthias.ringwald static void hci_add_connection_flags_for_flipped_bd_addr(uint8_t *bd_addr, hci_authentication_flags_t flags){
3607fde4af9Smatthias.ringwald     bd_addr_t addr;
361724d70a2SMatthias Ringwald     reverse_bd_addr(bd_addr, addr);
3622e77e513S[email protected]     hci_connection_t * conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_CLASSIC);
3637fde4af9Smatthias.ringwald     if (conn) {
36428ca2b46S[email protected]         connectionSetAuthenticationFlags(conn, flags);
36580ca58a0Smatthias.ringwald         hci_connection_timestamp(conn);
3667fde4af9Smatthias.ringwald     }
3677fde4af9Smatthias.ringwald }
3687fde4af9Smatthias.ringwald 
36980ca58a0Smatthias.ringwald int  hci_authentication_active_for_handle(hci_con_handle_t handle){
3705061f3afS[email protected]     hci_connection_t * conn = hci_connection_for_handle(handle);
37180ca58a0Smatthias.ringwald     if (!conn) return 0;
3726724cd9eS[email protected]     if (conn->authentication_flags & LEGACY_PAIRING_ACTIVE) return 1;
3736724cd9eS[email protected]     if (conn->authentication_flags & SSP_PAIRING_ACTIVE) return 1;
3746724cd9eS[email protected]     return 0;
37580ca58a0Smatthias.ringwald }
37680ca58a0Smatthias.ringwald 
37715a95bd5SMatthias Ringwald void gap_drop_link_key_for_bd_addr(bd_addr_t addr){
37855597469SMatthias Ringwald     if (!hci_stack->link_key_db) return;
3792bacf595SMatthias Ringwald     log_info("gap_drop_link_key_for_bd_addr: %s", bd_addr_to_str(addr));
380a98592bcSMatthias Ringwald     hci_stack->link_key_db->delete_link_key(addr);
381c12e46e7Smatthias.ringwald }
38255597469SMatthias Ringwald 
38355597469SMatthias Ringwald void gap_store_link_key_for_bd_addr(bd_addr_t addr, link_key_t link_key, link_key_type_t type){
38455597469SMatthias Ringwald     if (!hci_stack->link_key_db) return;
3852bacf595SMatthias Ringwald     log_info("gap_store_link_key_for_bd_addr: %s, type %u", bd_addr_to_str(addr), type);
38655597469SMatthias Ringwald     hci_stack->link_key_db->put_link_key(addr, link_key, type);
387c12e46e7Smatthias.ringwald }
3881b6fb31bSMatthias Ringwald 
389ceecb9d9SMatthias Ringwald void gap_delete_all_link_keys(void){
390ceecb9d9SMatthias Ringwald     bd_addr_t  addr;
391ceecb9d9SMatthias Ringwald     link_key_t link_key;
392ceecb9d9SMatthias Ringwald     link_key_type_t type;
393ceecb9d9SMatthias Ringwald     btstack_link_key_iterator_t it;
394ceecb9d9SMatthias Ringwald     int ok = gap_link_key_iterator_init(&it);
395ceecb9d9SMatthias Ringwald     if (!ok) {
396ceecb9d9SMatthias Ringwald         log_error("could not initialize iterator");
397ceecb9d9SMatthias Ringwald         return;
398ceecb9d9SMatthias Ringwald     }
399ceecb9d9SMatthias Ringwald     while (gap_link_key_iterator_get_next(&it, addr, link_key, &type)){
400ceecb9d9SMatthias Ringwald         gap_drop_link_key_for_bd_addr(addr);
401ceecb9d9SMatthias Ringwald     }
402ceecb9d9SMatthias Ringwald     gap_link_key_iterator_done(&it);
403ceecb9d9SMatthias Ringwald }
404ceecb9d9SMatthias Ringwald 
4051b6fb31bSMatthias Ringwald int gap_link_key_iterator_init(btstack_link_key_iterator_t * it){
4061b6fb31bSMatthias Ringwald     if (!hci_stack->link_key_db) return 0;
4071b6fb31bSMatthias Ringwald     if (!hci_stack->link_key_db->iterator_init) return 0;
4081b6fb31bSMatthias Ringwald     return hci_stack->link_key_db->iterator_init(it);
4091b6fb31bSMatthias Ringwald }
4101b6fb31bSMatthias 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){
4111b6fb31bSMatthias Ringwald     if (!hci_stack->link_key_db) return 0;
4121b6fb31bSMatthias Ringwald     return hci_stack->link_key_db->iterator_get_next(it, bd_addr, link_key, type);
4131b6fb31bSMatthias Ringwald }
4141b6fb31bSMatthias Ringwald void gap_link_key_iterator_done(btstack_link_key_iterator_t * it){
4151b6fb31bSMatthias Ringwald     if (!hci_stack->link_key_db) return;
4161b6fb31bSMatthias Ringwald     hci_stack->link_key_db->iterator_done(it);
4171b6fb31bSMatthias Ringwald }
41835454696SMatthias Ringwald #endif
419c12e46e7Smatthias.ringwald 
42095d71764SMatthias Ringwald static int hci_is_le_connection(hci_connection_t * connection){
4210bf6344aS[email protected]     return  connection->address_type == BD_ADDR_TYPE_LE_PUBLIC ||
4220bf6344aS[email protected]     connection->address_type == BD_ADDR_TYPE_LE_RANDOM;
4230bf6344aS[email protected] }
4240bf6344aS[email protected] 
4257fde4af9Smatthias.ringwald /**
42643bfb1bdSmatthias.ringwald  * count connections
42743bfb1bdSmatthias.ringwald  */
42840d1c7a4Smatthias.ringwald static int nr_hci_connections(void){
42956c253c9Smatthias.ringwald     int count = 0;
430665d90f2SMatthias Ringwald     btstack_linked_item_t *it;
431665d90f2SMatthias Ringwald     for (it = (btstack_linked_item_t *) hci_stack->connections; it ; it = it->next, count++);
43243bfb1bdSmatthias.ringwald     return count;
43343bfb1bdSmatthias.ringwald }
434c8e4258aSmatthias.ringwald 
43595d71764SMatthias Ringwald static int hci_number_free_acl_slots_for_connection_type(bd_addr_type_t address_type){
436ee303eddS[email protected] 
437f04a0c31SMatthias Ringwald     unsigned int num_packets_sent_classic = 0;
438f04a0c31SMatthias Ringwald     unsigned int num_packets_sent_le = 0;
439ee303eddS[email protected] 
440665d90f2SMatthias Ringwald     btstack_linked_item_t *it;
441665d90f2SMatthias Ringwald     for (it = (btstack_linked_item_t *) hci_stack->connections; it ; it = it->next){
442998906cdSmatthias.ringwald         hci_connection_t * connection = (hci_connection_t *) it;
443ee303eddS[email protected]         if (connection->address_type == BD_ADDR_TYPE_CLASSIC){
444ee303eddS[email protected]             num_packets_sent_classic += connection->num_acl_packets_sent;
445ee303eddS[email protected]         } else {
446ee303eddS[email protected]             num_packets_sent_le += connection->num_acl_packets_sent;
447ee303eddS[email protected]         }
448ee303eddS[email protected]     }
449d999b54eSMatthias Ringwald     log_debug("ACL classic buffers: %u used of %u", num_packets_sent_classic, hci_stack->acl_packets_total_num);
450ee303eddS[email protected]     int free_slots_classic = hci_stack->acl_packets_total_num - num_packets_sent_classic;
451ee303eddS[email protected]     int free_slots_le = 0;
452ee303eddS[email protected] 
453ee303eddS[email protected]     if (free_slots_classic < 0){
4549da54300S[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);
455998906cdSmatthias.ringwald         return 0;
456998906cdSmatthias.ringwald     }
457ee303eddS[email protected] 
458ee303eddS[email protected]     if (hci_stack->le_acl_packets_total_num){
459ee303eddS[email protected]         // if we have LE slots, they are used
460ee303eddS[email protected]         free_slots_le = hci_stack->le_acl_packets_total_num - num_packets_sent_le;
461ee303eddS[email protected]         if (free_slots_le < 0){
4629da54300S[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);
463ee303eddS[email protected]             return 0;
464998906cdSmatthias.ringwald         }
465ee303eddS[email protected]     } else {
466ee303eddS[email protected]         // otherwise, classic slots are used for LE, too
467ee303eddS[email protected]         free_slots_classic -= num_packets_sent_le;
468ee303eddS[email protected]         if (free_slots_classic < 0){
4699da54300S[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);
470ee303eddS[email protected]             return 0;
471ee303eddS[email protected]         }
472ee303eddS[email protected]     }
473ee303eddS[email protected] 
474ee303eddS[email protected]     switch (address_type){
475ee303eddS[email protected]         case BD_ADDR_TYPE_UNKNOWN:
4762125de09SMatthias Ringwald             log_error("hci_number_free_acl_slots: unknown address type");
477ee303eddS[email protected]             return 0;
478ee303eddS[email protected] 
479ee303eddS[email protected]         case BD_ADDR_TYPE_CLASSIC:
480ee303eddS[email protected]             return free_slots_classic;
481ee303eddS[email protected] 
482ee303eddS[email protected]         default:
483cb00d3aaS[email protected]            if (hci_stack->le_acl_packets_total_num){
484ee303eddS[email protected]                return free_slots_le;
485ee303eddS[email protected]            }
486cb00d3aaS[email protected]            return free_slots_classic;
487cb00d3aaS[email protected]     }
488998906cdSmatthias.ringwald }
489998906cdSmatthias.ringwald 
4902125de09SMatthias Ringwald int hci_number_free_acl_slots_for_handle(hci_con_handle_t con_handle){
4912125de09SMatthias Ringwald     // get connection type
4922125de09SMatthias Ringwald     hci_connection_t * connection = hci_connection_for_handle(con_handle);
4932125de09SMatthias Ringwald     if (!connection){
4942125de09SMatthias Ringwald         log_error("hci_number_free_acl_slots: handle 0x%04x not in connection list", con_handle);
4952125de09SMatthias Ringwald         return 0;
4962125de09SMatthias Ringwald     }
4972125de09SMatthias Ringwald     return hci_number_free_acl_slots_for_connection_type(connection->address_type);
4982125de09SMatthias Ringwald }
4992125de09SMatthias Ringwald 
50035454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
501701e3307SMatthias Ringwald static int hci_number_free_sco_slots(void){
502f04a0c31SMatthias Ringwald     unsigned int num_sco_packets_sent  = 0;
503665d90f2SMatthias Ringwald     btstack_linked_item_t *it;
504665d90f2SMatthias Ringwald     for (it = (btstack_linked_item_t *) hci_stack->connections; it ; it = it->next){
505e35edcc1S[email protected]         hci_connection_t * connection = (hci_connection_t *) it;
506e35edcc1S[email protected]         num_sco_packets_sent += connection->num_sco_packets_sent;
507e35edcc1S[email protected]     }
508e35edcc1S[email protected]     if (num_sco_packets_sent > hci_stack->sco_packets_total_num){
509701e3307SMatthias Ringwald         log_info("hci_number_free_sco_slots:packets (%u) > total packets (%u)", num_sco_packets_sent, hci_stack->sco_packets_total_num);
51044d0e3d5S[email protected]         return 0;
51144d0e3d5S[email protected]     }
512701e3307SMatthias Ringwald     // log_info("hci_number_free_sco_slots u", handle, num_sco_packets_sent);
513e35edcc1S[email protected]     return hci_stack->sco_packets_total_num - num_sco_packets_sent;
514e35edcc1S[email protected] }
51535454696SMatthias Ringwald #endif
51644d0e3d5S[email protected] 
5172b838201SMatthias Ringwald // only used to send HCI Host Number Completed Packets
5182b838201SMatthias Ringwald static int hci_can_send_comand_packet_transport(void){
519ac928cc2S[email protected]     if (hci_stack->hci_packet_buffer_reserved) return 0;
520ac928cc2S[email protected] 
521ac928cc2S[email protected]     // check for async hci transport implementations
522ac928cc2S[email protected]     if (hci_stack->hci_transport->can_send_packet_now){
523ac928cc2S[email protected]         if (!hci_stack->hci_transport->can_send_packet_now(HCI_COMMAND_DATA_PACKET)){
524ac928cc2S[email protected]             return 0;
525ac928cc2S[email protected]         }
526ac928cc2S[email protected]     }
5272b838201SMatthias Ringwald     return 1;
5282b838201SMatthias Ringwald }
529ac928cc2S[email protected] 
5302b838201SMatthias Ringwald // new functions replacing hci_can_send_packet_now[_using_packet_buffer]
5312b838201SMatthias Ringwald int hci_can_send_command_packet_now(void){
5322b838201SMatthias Ringwald     if (hci_can_send_comand_packet_transport() == 0) return 0;
533ac928cc2S[email protected]     return hci_stack->num_cmd_packets > 0;
534ac928cc2S[email protected] }
535ac928cc2S[email protected] 
5369d04d3a7SMatthias Ringwald static int hci_transport_can_send_prepared_packet_now(uint8_t packet_type){
537ac928cc2S[email protected]     // check for async hci transport implementations
5389d04d3a7SMatthias Ringwald     if (!hci_stack->hci_transport->can_send_packet_now) return 1;
5399d04d3a7SMatthias Ringwald     return hci_stack->hci_transport->can_send_packet_now(packet_type);
540ac928cc2S[email protected] }
5419d04d3a7SMatthias Ringwald 
5429d04d3a7SMatthias Ringwald static int hci_can_send_prepared_acl_packet_for_address_type(bd_addr_type_t address_type){
5439d04d3a7SMatthias Ringwald     if (!hci_transport_can_send_prepared_packet_now(HCI_ACL_DATA_PACKET)) return 0;
5449d04d3a7SMatthias Ringwald     return hci_number_free_acl_slots_for_connection_type(address_type) > 0;
545ac928cc2S[email protected] }
5469d04d3a7SMatthias Ringwald 
5479d04d3a7SMatthias Ringwald int hci_can_send_acl_le_packet_now(void){
5489d04d3a7SMatthias Ringwald     if (hci_stack->hci_packet_buffer_reserved) return 0;
5499d04d3a7SMatthias Ringwald     return hci_can_send_prepared_acl_packet_for_address_type(BD_ADDR_TYPE_LE_PUBLIC);
5509d04d3a7SMatthias Ringwald }
5519d04d3a7SMatthias Ringwald 
5529d04d3a7SMatthias Ringwald int hci_can_send_prepared_acl_packet_now(hci_con_handle_t con_handle) {
5539d04d3a7SMatthias Ringwald     if (!hci_transport_can_send_prepared_packet_now(HCI_ACL_DATA_PACKET)) return 0;
554e79abdd6S[email protected]     return hci_number_free_acl_slots_for_handle(con_handle) > 0;
555ac928cc2S[email protected] }
556ac928cc2S[email protected] 
557ac928cc2S[email protected] int hci_can_send_acl_packet_now(hci_con_handle_t con_handle){
558ac928cc2S[email protected]     if (hci_stack->hci_packet_buffer_reserved) return 0;
559ac928cc2S[email protected]     return hci_can_send_prepared_acl_packet_now(con_handle);
5606b4af23dS[email protected] }
5616b4af23dS[email protected] 
56235454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
56335454696SMatthias Ringwald int hci_can_send_acl_classic_packet_now(void){
56435454696SMatthias Ringwald     if (hci_stack->hci_packet_buffer_reserved) return 0;
56535454696SMatthias Ringwald     return hci_can_send_prepared_acl_packet_for_address_type(BD_ADDR_TYPE_CLASSIC);
56635454696SMatthias Ringwald }
56735454696SMatthias Ringwald 
568701e3307SMatthias Ringwald int hci_can_send_prepared_sco_packet_now(void){
569d057580eSMatthias Ringwald     if (!hci_transport_can_send_prepared_packet_now(HCI_SCO_DATA_PACKET)) return 0;
570ed361f5fSMatthias Ringwald     if (!hci_stack->synchronous_flow_control_enabled) return 1;
571701e3307SMatthias Ringwald     return hci_number_free_sco_slots() > 0;
57244d0e3d5S[email protected] }
57344d0e3d5S[email protected] 
574701e3307SMatthias Ringwald int hci_can_send_sco_packet_now(void){
575d057580eSMatthias Ringwald     if (hci_stack->hci_packet_buffer_reserved) return 0;
576701e3307SMatthias Ringwald     return hci_can_send_prepared_sco_packet_now();
57744d0e3d5S[email protected] }
57844d0e3d5S[email protected] 
579d057580eSMatthias Ringwald void hci_request_sco_can_send_now_event(void){
580d057580eSMatthias Ringwald     hci_stack->sco_waiting_for_can_send_now = 1;
581d057580eSMatthias Ringwald     hci_notify_if_sco_can_send_now();
582d057580eSMatthias Ringwald }
58335454696SMatthias Ringwald #endif
584d057580eSMatthias Ringwald 
58595d71764SMatthias Ringwald // used for internal checks in l2cap.c
586c8b9416aS[email protected] int hci_is_packet_buffer_reserved(void){
587c8b9416aS[email protected]     return hci_stack->hci_packet_buffer_reserved;
588c8b9416aS[email protected] }
589c8b9416aS[email protected] 
5906b4af23dS[email protected] // reserves outgoing packet buffer. @returns 1 if successful
5916b4af23dS[email protected] int hci_reserve_packet_buffer(void){
5929d14b626S[email protected]     if (hci_stack->hci_packet_buffer_reserved) {
5939d14b626S[email protected]         log_error("hci_reserve_packet_buffer called but buffer already reserved");
5949d14b626S[email protected]         return 0;
5959d14b626S[email protected]     }
5966b4af23dS[email protected]     hci_stack->hci_packet_buffer_reserved = 1;
5976b4af23dS[email protected]     return 1;
5986b4af23dS[email protected] }
5996b4af23dS[email protected] 
60068a0fcf7S[email protected] void hci_release_packet_buffer(void){
60168a0fcf7S[email protected]     hci_stack->hci_packet_buffer_reserved = 0;
60268a0fcf7S[email protected] }
60368a0fcf7S[email protected] 
6046b4af23dS[email protected] // assumption: synchronous implementations don't provide can_send_packet_now as they don't keep the buffer after the call
6057f02f414SMatthias Ringwald static int hci_transport_synchronous(void){
6066b4af23dS[email protected]     return hci_stack->hci_transport->can_send_packet_now == NULL;
6076b4af23dS[email protected] }
6086b4af23dS[email protected] 
609452cf3bbS[email protected] static int hci_send_acl_packet_fragments(hci_connection_t *connection){
610452cf3bbS[email protected] 
611452cf3bbS[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);
612452cf3bbS[email protected] 
613452cf3bbS[email protected]     // max ACL data packet length depends on connection type (LE vs. Classic) and available buffers
614452cf3bbS[email protected]     uint16_t max_acl_data_packet_length = hci_stack->acl_data_packet_length;
615452cf3bbS[email protected]     if (hci_is_le_connection(connection) && hci_stack->le_data_packets_length > 0){
616452cf3bbS[email protected]         max_acl_data_packet_length = hci_stack->le_data_packets_length;
617452cf3bbS[email protected]     }
618452cf3bbS[email protected] 
619452cf3bbS[email protected]     // testing: reduce buffer to minimum
620452cf3bbS[email protected]     // max_acl_data_packet_length = 52;
621452cf3bbS[email protected] 
622d999b54eSMatthias Ringwald     log_debug("hci_send_acl_packet_fragments entered");
623d999b54eSMatthias Ringwald 
624452cf3bbS[email protected]     int err;
625452cf3bbS[email protected]     // multiple packets could be send on a synchronous HCI transport
626452cf3bbS[email protected]     while (1){
627452cf3bbS[email protected] 
628d999b54eSMatthias Ringwald         log_debug("hci_send_acl_packet_fragments loop entered");
629d999b54eSMatthias Ringwald 
630452cf3bbS[email protected]         // get current data
631452cf3bbS[email protected]         const uint16_t acl_header_pos = hci_stack->acl_fragmentation_pos - 4;
632452cf3bbS[email protected]         int current_acl_data_packet_length = hci_stack->acl_fragmentation_total_size - hci_stack->acl_fragmentation_pos;
633452cf3bbS[email protected]         int more_fragments = 0;
634452cf3bbS[email protected] 
635452cf3bbS[email protected]         // if ACL packet is larger than Bluetooth packet buffer, only send max_acl_data_packet_length
636452cf3bbS[email protected]         if (current_acl_data_packet_length > max_acl_data_packet_length){
637452cf3bbS[email protected]             more_fragments = 1;
638452cf3bbS[email protected]             current_acl_data_packet_length = max_acl_data_packet_length;
639452cf3bbS[email protected]         }
640452cf3bbS[email protected] 
641452cf3bbS[email protected]         // copy handle_and_flags if not first fragment and update packet boundary flags to be 01 (continuing fragmnent)
642452cf3bbS[email protected]         if (acl_header_pos > 0){
643f8fbdce0SMatthias Ringwald             uint16_t handle_and_flags = little_endian_read_16(hci_stack->hci_packet_buffer, 0);
644452cf3bbS[email protected]             handle_and_flags = (handle_and_flags & 0xcfff) | (1 << 12);
645f8fbdce0SMatthias Ringwald             little_endian_store_16(hci_stack->hci_packet_buffer, acl_header_pos, handle_and_flags);
646452cf3bbS[email protected]         }
647452cf3bbS[email protected] 
648452cf3bbS[email protected]         // update header len
649f8fbdce0SMatthias Ringwald         little_endian_store_16(hci_stack->hci_packet_buffer, acl_header_pos + 2, current_acl_data_packet_length);
650452cf3bbS[email protected] 
651452cf3bbS[email protected]         // count packet
652452cf3bbS[email protected]         connection->num_acl_packets_sent++;
653f04a0c31SMatthias Ringwald         log_debug("hci_send_acl_packet_fragments loop before send (more fragments %d)", more_fragments);
654d999b54eSMatthias Ringwald 
655d999b54eSMatthias Ringwald         // update state for next fragment (if any) as "transport done" might be sent during send_packet already
656d999b54eSMatthias Ringwald         if (more_fragments){
657d999b54eSMatthias Ringwald             // update start of next fragment to send
658d999b54eSMatthias Ringwald             hci_stack->acl_fragmentation_pos += current_acl_data_packet_length;
659d999b54eSMatthias Ringwald         } else {
660d999b54eSMatthias Ringwald             // done
661d999b54eSMatthias Ringwald             hci_stack->acl_fragmentation_pos = 0;
662d999b54eSMatthias Ringwald             hci_stack->acl_fragmentation_total_size = 0;
663d999b54eSMatthias Ringwald         }
664452cf3bbS[email protected] 
665452cf3bbS[email protected]         // send packet
666452cf3bbS[email protected]         uint8_t * packet = &hci_stack->hci_packet_buffer[acl_header_pos];
667452cf3bbS[email protected]         const int size = current_acl_data_packet_length + 4;
6685bb5bc3eS[email protected]         hci_dump_packet(HCI_ACL_DATA_PACKET, 0, packet, size);
669452cf3bbS[email protected]         err = hci_stack->hci_transport->send_packet(HCI_ACL_DATA_PACKET, packet, size);
670452cf3bbS[email protected] 
671f04a0c31SMatthias Ringwald         log_debug("hci_send_acl_packet_fragments loop after send (more fragments %d)", more_fragments);
672d999b54eSMatthias Ringwald 
673452cf3bbS[email protected]         // done yet?
674452cf3bbS[email protected]         if (!more_fragments) break;
675452cf3bbS[email protected] 
676452cf3bbS[email protected]         // can send more?
677452cf3bbS[email protected]         if (!hci_can_send_prepared_acl_packet_now(connection->con_handle)) return err;
678452cf3bbS[email protected]     }
679452cf3bbS[email protected] 
680d999b54eSMatthias Ringwald     log_debug("hci_send_acl_packet_fragments loop over");
681452cf3bbS[email protected] 
682d051460cS[email protected]     // release buffer now for synchronous transport
683203bace6S[email protected]     if (hci_transport_synchronous()){
684452cf3bbS[email protected]         hci_release_packet_buffer();
685fd43c0e0SMatthias Ringwald         hci_emit_transport_packet_sent();
686452cf3bbS[email protected]     }
687452cf3bbS[email protected] 
688452cf3bbS[email protected]     return err;
689452cf3bbS[email protected] }
690452cf3bbS[email protected] 
691826f7347S[email protected] // pre: caller has reserved the packet buffer
692826f7347S[email protected] int hci_send_acl_packet_buffer(int size){
6937856c818Smatthias.ringwald 
694452cf3bbS[email protected]     // log_info("hci_send_acl_packet_buffer size %u", size);
695452cf3bbS[email protected] 
696826f7347S[email protected]     if (!hci_stack->hci_packet_buffer_reserved) {
697826f7347S[email protected]         log_error("hci_send_acl_packet_buffer called without reserving packet buffer");
698826f7347S[email protected]         return 0;
699826f7347S[email protected]     }
700826f7347S[email protected] 
701d713a683S[email protected]     uint8_t * packet = hci_stack->hci_packet_buffer;
702d713a683S[email protected]     hci_con_handle_t con_handle = READ_ACL_CONNECTION_HANDLE(packet);
703d713a683S[email protected] 
704826f7347S[email protected]     // check for free places on Bluetooth module
705d713a683S[email protected]     if (!hci_can_send_prepared_acl_packet_now(con_handle)) {
706826f7347S[email protected]         log_error("hci_send_acl_packet_buffer called but no free ACL buffers on controller");
70797b61c7bS[email protected]         hci_release_packet_buffer();
708068b8592SMatthias Ringwald         hci_emit_transport_packet_sent();
70997b61c7bS[email protected]         return BTSTACK_ACL_BUFFERS_FULL;
71097b61c7bS[email protected]     }
7116218e6f1Smatthias.ringwald 
7125061f3afS[email protected]     hci_connection_t *connection = hci_connection_for_handle( con_handle);
71397b61c7bS[email protected]     if (!connection) {
7145fa0b7cfS[email protected]         log_error("hci_send_acl_packet_buffer called but no connection for handle 0x%04x", con_handle);
71597b61c7bS[email protected]         hci_release_packet_buffer();
716068b8592SMatthias Ringwald         hci_emit_transport_packet_sent();
71797b61c7bS[email protected]         return 0;
71897b61c7bS[email protected]     }
71952db98b2SMatthias Ringwald 
72052db98b2SMatthias Ringwald #ifdef ENABLE_CLASSIC
72156cf178bSmatthias.ringwald     hci_connection_timestamp(connection);
72252db98b2SMatthias Ringwald #endif
72356cf178bSmatthias.ringwald 
724452cf3bbS[email protected]     // hci_dump_packet( HCI_ACL_DATA_PACKET, 0, packet, size);
7257856c818Smatthias.ringwald 
726452cf3bbS[email protected]     // setup data
727452cf3bbS[email protected]     hci_stack->acl_fragmentation_total_size = size;
728452cf3bbS[email protected]     hci_stack->acl_fragmentation_pos = 4;   // start of L2CAP packet
7296218e6f1Smatthias.ringwald 
730452cf3bbS[email protected]     return hci_send_acl_packet_fragments(connection);
731ee091cf1Smatthias.ringwald }
732ee091cf1Smatthias.ringwald 
73335454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
73444d0e3d5S[email protected] // pre: caller has reserved the packet buffer
73544d0e3d5S[email protected] int hci_send_sco_packet_buffer(int size){
73644d0e3d5S[email protected] 
73744d0e3d5S[email protected]     // log_info("hci_send_acl_packet_buffer size %u", size);
73844d0e3d5S[email protected] 
73944d0e3d5S[email protected]     if (!hci_stack->hci_packet_buffer_reserved) {
74044d0e3d5S[email protected]         log_error("hci_send_acl_packet_buffer called without reserving packet buffer");
74144d0e3d5S[email protected]         return 0;
74244d0e3d5S[email protected]     }
74344d0e3d5S[email protected] 
74444d0e3d5S[email protected]     uint8_t * packet = hci_stack->hci_packet_buffer;
7454b3e1e19SMatthias Ringwald 
7464b3e1e19SMatthias Ringwald     // skip checks in loopback mode
7474b3e1e19SMatthias Ringwald     if (!hci_stack->loopback_mode){
74844d0e3d5S[email protected]         hci_con_handle_t con_handle = READ_ACL_CONNECTION_HANDLE(packet);   // same for ACL and SCO
74944d0e3d5S[email protected] 
75044d0e3d5S[email protected]         // check for free places on Bluetooth module
751701e3307SMatthias Ringwald         if (!hci_can_send_prepared_sco_packet_now()) {
75244d0e3d5S[email protected]             log_error("hci_send_sco_packet_buffer called but no free ACL buffers on controller");
75344d0e3d5S[email protected]             hci_release_packet_buffer();
754068b8592SMatthias Ringwald             hci_emit_transport_packet_sent();
75544d0e3d5S[email protected]             return BTSTACK_ACL_BUFFERS_FULL;
75644d0e3d5S[email protected]         }
75744d0e3d5S[email protected] 
758e35edcc1S[email protected]         // track send packet in connection struct
759e35edcc1S[email protected]         hci_connection_t *connection = hci_connection_for_handle( con_handle);
760e35edcc1S[email protected]         if (!connection) {
761e35edcc1S[email protected]             log_error("hci_send_sco_packet_buffer called but no connection for handle 0x%04x", con_handle);
762e35edcc1S[email protected]             hci_release_packet_buffer();
763068b8592SMatthias Ringwald             hci_emit_transport_packet_sent();
764e35edcc1S[email protected]             return 0;
765e35edcc1S[email protected]         }
766e35edcc1S[email protected]         connection->num_sco_packets_sent++;
7674b3e1e19SMatthias Ringwald     }
76844d0e3d5S[email protected] 
76944d0e3d5S[email protected]     hci_dump_packet( HCI_SCO_DATA_PACKET, 0, packet, size);
770543e835cSMatthias Ringwald     int err = hci_stack->hci_transport->send_packet(HCI_SCO_DATA_PACKET, packet, size);
771543e835cSMatthias Ringwald 
772543e835cSMatthias Ringwald     if (hci_transport_synchronous()){
773543e835cSMatthias Ringwald         hci_release_packet_buffer();
774fd43c0e0SMatthias Ringwald         hci_emit_transport_packet_sent();
775543e835cSMatthias Ringwald     }
776543e835cSMatthias Ringwald 
777543e835cSMatthias Ringwald     return err;
77844d0e3d5S[email protected] }
77935454696SMatthias Ringwald #endif
78044d0e3d5S[email protected] 
78116833f0aSmatthias.ringwald static void acl_handler(uint8_t *packet, int size){
7827856c818Smatthias.ringwald 
783e76a89eeS[email protected]     // log_info("acl_handler: size %u", size);
784e76a89eeS[email protected] 
7857856c818Smatthias.ringwald     // get info
7867856c818Smatthias.ringwald     hci_con_handle_t con_handle = READ_ACL_CONNECTION_HANDLE(packet);
7875061f3afS[email protected]     hci_connection_t *conn      = hci_connection_for_handle(con_handle);
7887856c818Smatthias.ringwald     uint8_t  acl_flags          = READ_ACL_FLAGS(packet);
7897856c818Smatthias.ringwald     uint16_t acl_length         = READ_ACL_LENGTH(packet);
7907856c818Smatthias.ringwald 
7917856c818Smatthias.ringwald     // ignore non-registered handle
7927856c818Smatthias.ringwald     if (!conn){
7939da54300S[email protected]         log_error( "hci.c: acl_handler called with non-registered handle %u!" , con_handle);
7947856c818Smatthias.ringwald         return;
7957856c818Smatthias.ringwald     }
7967856c818Smatthias.ringwald 
797e76a89eeS[email protected]     // assert packet is complete
7989ecc3e17S[email protected]     if (acl_length + 4 != size){
799f04a0c31SMatthias Ringwald         log_error("hci.c: acl_handler called with ACL packet of wrong size %d, expected %u => dropping packet", size, acl_length + 4);
800e76a89eeS[email protected]         return;
801e76a89eeS[email protected]     }
802e76a89eeS[email protected] 
80352db98b2SMatthias Ringwald #ifdef ENABLE_CLASSIC
8047856c818Smatthias.ringwald     // update idle timestamp
8057856c818Smatthias.ringwald     hci_connection_timestamp(conn);
80652db98b2SMatthias Ringwald #endif
8077856c818Smatthias.ringwald 
8082b838201SMatthias Ringwald #ifdef ENABLE_HCI_CONTROLLER_TO_HOST_FLOW_CONTROL
8092b838201SMatthias Ringwald     hci_stack->host_completed_packets = 1;
8102b838201SMatthias Ringwald     conn->num_packets_completed++;
8112b838201SMatthias Ringwald #endif
8122b838201SMatthias Ringwald 
8137856c818Smatthias.ringwald     // handle different packet types
8147856c818Smatthias.ringwald     switch (acl_flags & 0x03) {
8157856c818Smatthias.ringwald 
8167856c818Smatthias.ringwald         case 0x01: // continuation fragment
8177856c818Smatthias.ringwald 
8180ca847afS[email protected]             // sanity checks
8197856c818Smatthias.ringwald             if (conn->acl_recombination_pos == 0) {
8209da54300S[email protected]                 log_error( "ACL Cont Fragment but no first fragment for handle 0x%02x", con_handle);
8217856c818Smatthias.ringwald                 return;
8227856c818Smatthias.ringwald             }
8230ca847afS[email protected]             if (conn->acl_recombination_pos + acl_length > 4 + HCI_ACL_BUFFER_SIZE){
8240ca847afS[email protected]                 log_error( "ACL Cont Fragment to large: combined packet %u > buffer size %u for handle 0x%02x",
8250ca847afS[email protected]                     conn->acl_recombination_pos + acl_length, 4 + HCI_ACL_BUFFER_SIZE, con_handle);
8260ca847afS[email protected]                 conn->acl_recombination_pos = 0;
8270ca847afS[email protected]                 return;
8280ca847afS[email protected]             }
8297856c818Smatthias.ringwald 
8307856c818Smatthias.ringwald             // append fragment payload (header already stored)
831ec6321eeS[email protected]             memcpy(&conn->acl_recombination_buffer[HCI_INCOMING_PRE_BUFFER_SIZE + conn->acl_recombination_pos], &packet[4], acl_length );
8327856c818Smatthias.ringwald             conn->acl_recombination_pos += acl_length;
8337856c818Smatthias.ringwald 
8349da54300S[email protected]             // log_error( "ACL Cont Fragment: acl_len %u, combined_len %u, l2cap_len %u", acl_length,
835decc01a8Smatthias.ringwald             //        conn->acl_recombination_pos, conn->acl_recombination_length);
8367856c818Smatthias.ringwald 
8377856c818Smatthias.ringwald             // forward complete L2CAP packet if complete.
8387856c818Smatthias.ringwald             if (conn->acl_recombination_pos >= conn->acl_recombination_length + 4 + 4){ // pos already incl. ACL header
839d6b06661SMatthias Ringwald                 hci_emit_acl_packet(&conn->acl_recombination_buffer[HCI_INCOMING_PRE_BUFFER_SIZE], conn->acl_recombination_pos);
8407856c818Smatthias.ringwald                 // reset recombination buffer
8417856c818Smatthias.ringwald                 conn->acl_recombination_length = 0;
8427856c818Smatthias.ringwald                 conn->acl_recombination_pos = 0;
8437856c818Smatthias.ringwald             }
8447856c818Smatthias.ringwald             break;
8457856c818Smatthias.ringwald 
8467856c818Smatthias.ringwald         case 0x02: { // first fragment
8477856c818Smatthias.ringwald 
84823a77e1aS[email protected]             // sanity check
84923a77e1aS[email protected]             if (conn->acl_recombination_pos) {
85023a77e1aS[email protected]                 log_error( "ACL First Fragment but data in buffer for handle 0x%02x, dropping stale fragments", con_handle);
85123a77e1aS[email protected]                 conn->acl_recombination_pos = 0;
85223a77e1aS[email protected]             }
85323a77e1aS[email protected] 
8547856c818Smatthias.ringwald             // peek into L2CAP packet!
8557856c818Smatthias.ringwald             uint16_t l2cap_length = READ_L2CAP_LENGTH( packet );
8567856c818Smatthias.ringwald 
8579da54300S[email protected]             // log_info( "ACL First Fragment: acl_len %u, l2cap_len %u", acl_length, l2cap_length);
858decc01a8Smatthias.ringwald 
8597856c818Smatthias.ringwald             // compare fragment size to L2CAP packet size
8607856c818Smatthias.ringwald             if (acl_length >= l2cap_length + 4){
8617856c818Smatthias.ringwald                 // forward fragment as L2CAP packet
862d6b06661SMatthias Ringwald                 hci_emit_acl_packet(packet, acl_length + 4);
8637856c818Smatthias.ringwald             } else {
8640ca847afS[email protected] 
8650ca847afS[email protected]                 if (acl_length > HCI_ACL_BUFFER_SIZE){
8660ca847afS[email protected]                     log_error( "ACL First Fragment to large: fragment %u > buffer size %u for handle 0x%02x",
8670ca847afS[email protected]                         4 + acl_length, 4 + HCI_ACL_BUFFER_SIZE, con_handle);
8680ca847afS[email protected]                     return;
8690ca847afS[email protected]                 }
8700ca847afS[email protected] 
8717856c818Smatthias.ringwald                 // store first fragment and tweak acl length for complete package
872ec6321eeS[email protected]                 memcpy(&conn->acl_recombination_buffer[HCI_INCOMING_PRE_BUFFER_SIZE], packet, acl_length + 4);
8737856c818Smatthias.ringwald                 conn->acl_recombination_pos    = acl_length + 4;
8747856c818Smatthias.ringwald                 conn->acl_recombination_length = l2cap_length;
875f8fbdce0SMatthias Ringwald                 little_endian_store_16(conn->acl_recombination_buffer, HCI_INCOMING_PRE_BUFFER_SIZE + 2, l2cap_length +4);
8767856c818Smatthias.ringwald             }
8777856c818Smatthias.ringwald             break;
8787856c818Smatthias.ringwald 
8797856c818Smatthias.ringwald         }
8807856c818Smatthias.ringwald         default:
8819da54300S[email protected]             log_error( "hci.c: acl_handler called with invalid packet boundary flags %u", acl_flags & 0x03);
8827856c818Smatthias.ringwald             return;
8837856c818Smatthias.ringwald     }
88494ab26f8Smatthias.ringwald 
88594ab26f8Smatthias.ringwald     // execute main loop
88694ab26f8Smatthias.ringwald     hci_run();
88716833f0aSmatthias.ringwald }
88822909952Smatthias.ringwald 
88967a3e8ecSmatthias.ringwald static void hci_shutdown_connection(hci_connection_t *conn){
8909da54300S[email protected]     log_info("Connection closed: handle 0x%x, %s", conn->con_handle, bd_addr_to_str(conn->address));
8913c4d4b90Smatthias.ringwald 
892b3264428SMatthias Ringwald #ifdef ENABLE_CLASSIC
893ee752bb8SMatthias Ringwald #ifdef ENABLE_SCO_OVER_HCI
894ee752bb8SMatthias Ringwald     int addr_type = conn->address_type;
895ee752bb8SMatthias Ringwald #endif
896b3264428SMatthias Ringwald #endif
897ee752bb8SMatthias Ringwald 
898528a4a3bSMatthias Ringwald     btstack_run_loop_remove_timer(&conn->timeout);
899c785ef68Smatthias.ringwald 
900665d90f2SMatthias Ringwald     btstack_linked_list_remove(&hci_stack->connections, (btstack_linked_item_t *) conn);
901a3b02b71Smatthias.ringwald     btstack_memory_hci_connection_free( conn );
9023c4d4b90Smatthias.ringwald 
9033c4d4b90Smatthias.ringwald     // now it's gone
904c7e0c5f6Smatthias.ringwald     hci_emit_nr_connections_changed();
905ee752bb8SMatthias Ringwald 
906b3264428SMatthias Ringwald #ifdef ENABLE_CLASSIC
907034e9b53SMatthias Ringwald #ifdef ENABLE_SCO_OVER_HCI
908ee752bb8SMatthias Ringwald     // update SCO
909ee752bb8SMatthias Ringwald     if (addr_type == BD_ADDR_TYPE_SCO && hci_stack->hci_transport && hci_stack->hci_transport->set_sco_config){
910ee752bb8SMatthias Ringwald         hci_stack->hci_transport->set_sco_config(hci_stack->sco_voice_setting_active, hci_number_sco_connections());
911ee752bb8SMatthias Ringwald     }
912034e9b53SMatthias Ringwald #endif
913b3264428SMatthias Ringwald #endif
914c7e0c5f6Smatthias.ringwald }
915c7e0c5f6Smatthias.ringwald 
91635454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
91735454696SMatthias Ringwald 
9180c042179S[email protected] static const uint16_t packet_type_sizes[] = {
9198f8108aaSmatthias.ringwald     0, HCI_ACL_2DH1_SIZE, HCI_ACL_3DH1_SIZE, HCI_ACL_DM1_SIZE,
9208f8108aaSmatthias.ringwald     HCI_ACL_DH1_SIZE, 0, 0, 0,
9218f8108aaSmatthias.ringwald     HCI_ACL_2DH3_SIZE, HCI_ACL_3DH3_SIZE, HCI_ACL_DM3_SIZE, HCI_ACL_DH3_SIZE,
9228f8108aaSmatthias.ringwald     HCI_ACL_2DH5_SIZE, HCI_ACL_3DH5_SIZE, HCI_ACL_DM5_SIZE, HCI_ACL_DH5_SIZE
9238f8108aaSmatthias.ringwald };
92465389bfcS[email protected] static const uint8_t  packet_type_feature_requirement_bit[] = {
92565389bfcS[email protected]      0, // 3 slot packets
92665389bfcS[email protected]      1, // 5 slot packets
92765389bfcS[email protected]     25, // EDR 2 mpbs
92865389bfcS[email protected]     26, // EDR 3 mbps
92965389bfcS[email protected]     39, // 3 slot EDR packts
93065389bfcS[email protected]     40, // 5 slot EDR packet
93165389bfcS[email protected] };
93265389bfcS[email protected] static const uint16_t packet_type_feature_packet_mask[] = {
93365389bfcS[email protected]     0x0f00, // 3 slot packets
93465389bfcS[email protected]     0xf000, // 5 slot packets
93565389bfcS[email protected]     0x1102, // EDR 2 mpbs
93665389bfcS[email protected]     0x2204, // EDR 3 mbps
93765389bfcS[email protected]     0x0300, // 3 slot EDR packts
93865389bfcS[email protected]     0x3000, // 5 slot EDR packet
93965389bfcS[email protected] };
9408f8108aaSmatthias.ringwald 
94165389bfcS[email protected] static uint16_t hci_acl_packet_types_for_buffer_size_and_local_features(uint16_t buffer_size, uint8_t * local_supported_features){
94265389bfcS[email protected]     // enable packet types based on size
9438f8108aaSmatthias.ringwald     uint16_t packet_types = 0;
944f16a69bbS[email protected]     unsigned int i;
9458f8108aaSmatthias.ringwald     for (i=0;i<16;i++){
9468f8108aaSmatthias.ringwald         if (packet_type_sizes[i] == 0) continue;
9478f8108aaSmatthias.ringwald         if (packet_type_sizes[i] <= buffer_size){
9488f8108aaSmatthias.ringwald             packet_types |= 1 << i;
9498f8108aaSmatthias.ringwald         }
9508f8108aaSmatthias.ringwald     }
95165389bfcS[email protected]     // disable packet types due to missing local supported features
95265389bfcS[email protected]     for (i=0;i<sizeof(packet_type_feature_requirement_bit);i++){
953f04a0c31SMatthias Ringwald         unsigned int bit_idx = packet_type_feature_requirement_bit[i];
95465389bfcS[email protected]         int feature_set = (local_supported_features[bit_idx >> 3] & (1<<(bit_idx & 7))) != 0;
95565389bfcS[email protected]         if (feature_set) continue;
95665389bfcS[email protected]         log_info("Features bit %02u is not set, removing packet types 0x%04x", bit_idx, packet_type_feature_packet_mask[i]);
95765389bfcS[email protected]         packet_types &= ~packet_type_feature_packet_mask[i];
95865389bfcS[email protected]     }
9598f8108aaSmatthias.ringwald     // flip bits for "may not be used"
9608f8108aaSmatthias.ringwald     packet_types ^= 0x3306;
9618f8108aaSmatthias.ringwald     return packet_types;
9628f8108aaSmatthias.ringwald }
9638f8108aaSmatthias.ringwald 
9648f8108aaSmatthias.ringwald uint16_t hci_usable_acl_packet_types(void){
9653a9fb326S[email protected]     return hci_stack->packet_types;
9668f8108aaSmatthias.ringwald }
96735454696SMatthias Ringwald #endif
9688f8108aaSmatthias.ringwald 
969facf93fdS[email protected] uint8_t* hci_get_outgoing_packet_buffer(void){
9707dc17943Smatthias.ringwald     // hci packet buffer is >= acl data packet length
9713a9fb326S[email protected]     return hci_stack->hci_packet_buffer;
9727dc17943Smatthias.ringwald }
9737dc17943Smatthias.ringwald 
974f5d8d141S[email protected] uint16_t hci_max_acl_data_packet_length(void){
9753a9fb326S[email protected]     return hci_stack->acl_data_packet_length;
9767dc17943Smatthias.ringwald }
9777dc17943Smatthias.ringwald 
97806b9e820SMatthias Ringwald #ifdef ENABLE_CLASSIC
9793e68d23dSMatthias Ringwald int hci_extended_sco_link_supported(void){
9803e68d23dSMatthias Ringwald     // No. 31, byte 3, bit 7
9813e68d23dSMatthias Ringwald     return (hci_stack->local_supported_features[3] & (1 << 7)) != 0;
9823e68d23dSMatthias Ringwald }
98306b9e820SMatthias Ringwald #endif
9843e68d23dSMatthias Ringwald 
9856ac9a97eS[email protected] int hci_non_flushable_packet_boundary_flag_supported(void){
9866ac9a97eS[email protected]     // No. 54, byte 6, bit 6
9876ac9a97eS[email protected]     return (hci_stack->local_supported_features[6] & (1 << 6)) != 0;
9886ac9a97eS[email protected] }
9896ac9a97eS[email protected] 
99015a95bd5SMatthias Ringwald static int gap_ssp_supported(void){
9916ac9a97eS[email protected]     // No. 51, byte 6, bit 3
9923a9fb326S[email protected]     return (hci_stack->local_supported_features[6] & (1 << 3)) != 0;
993f5d8d141S[email protected] }
994f5d8d141S[email protected] 
9957f02f414SMatthias Ringwald static int hci_classic_supported(void){
99635454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
9976ac9a97eS[email protected]     // No. 37, byte 4, bit 5, = No BR/EDR Support
9983a9fb326S[email protected]     return (hci_stack->local_supported_features[4] & (1 << 5)) == 0;
99935454696SMatthias Ringwald #else
100035454696SMatthias Ringwald     return 0;
100135454696SMatthias Ringwald #endif
1002f5d8d141S[email protected] }
1003f5d8d141S[email protected] 
10047f02f414SMatthias Ringwald static int hci_le_supported(void){
1005a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE
10066ac9a97eS[email protected]     // No. 37, byte 4, bit 6 = LE Supported (Controller)
10073a9fb326S[email protected]     return (hci_stack->local_supported_features[4] & (1 << 6)) != 0;
1008f5d8d141S[email protected] #else
1009f5d8d141S[email protected]     return 0;
1010f5d8d141S[email protected] #endif
1011f5d8d141S[email protected] }
1012f5d8d141S[email protected] 
1013b95a5a35SMatthias Ringwald #ifdef ENABLE_BLE
1014b95a5a35SMatthias Ringwald 
1015b95a5a35SMatthias Ringwald /**
1016b95a5a35SMatthias Ringwald  * @brief Get addr type and address used for LE in Advertisements, Scan Responses,
1017b95a5a35SMatthias Ringwald  */
1018b95a5a35SMatthias Ringwald void gap_le_get_own_address(uint8_t * addr_type, bd_addr_t addr){
1019b95a5a35SMatthias Ringwald     *addr_type = hci_stack->le_own_addr_type;
1020b95a5a35SMatthias Ringwald     if (hci_stack->le_own_addr_type){
1021b95a5a35SMatthias Ringwald         memcpy(addr, hci_stack->le_random_address, 6);
102269a97523S[email protected]     } else {
10233a9fb326S[email protected]         memcpy(addr, hci_stack->local_bd_addr, 6);
102469a97523S[email protected]     }
102569a97523S[email protected] }
102669a97523S[email protected] 
1027e8c8828eSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
1028384b59deSMatthias Ringwald void le_handle_advertisement_report(uint8_t *packet, uint16_t size){
10299ec2630cSMatthias Ringwald 
1030d1dc057bS[email protected]     int offset = 3;
1031d1dc057bS[email protected]     int num_reports = packet[offset];
1032d1dc057bS[email protected]     offset += 1;
1033d1dc057bS[email protected] 
103457c9da5bS[email protected]     int i;
10354f4e0224SMatthias Ringwald     // log_info("HCI: handle adv report with num reports: %d", num_reports);
103603fbe9c6S[email protected]     uint8_t event[12 + LE_ADVERTISING_DATA_SIZE]; // use upper bound to avoid var size automatic var
1037384b59deSMatthias Ringwald     for (i=0; i<num_reports && offset < size;i++){
1038384b59deSMatthias Ringwald         uint8_t data_length = btstack_min( packet[offset + 8], LE_ADVERTISING_DATA_SIZE);
1039a0aac9c4S[email protected]         uint8_t event_size = 10 + data_length;
1040d1dc057bS[email protected]         int pos = 0;
1041045013feSMatthias Ringwald         event[pos++] = GAP_EVENT_ADVERTISING_REPORT;
104257c9da5bS[email protected]         event[pos++] = event_size;
1043210c6774S[email protected]         memcpy(&event[pos], &packet[offset], 1+1+6); // event type + address type + address
1044d1dc057bS[email protected]         offset += 8;
1045d1dc057bS[email protected]         pos += 8;
1046d1dc057bS[email protected]         event[pos++] = packet[offset + 1 + data_length]; // rssi
1047d1dc057bS[email protected]         event[pos++] = packet[offset++]; //data_length;
1048d1dc057bS[email protected]         memcpy(&event[pos], &packet[offset], data_length);
104957c9da5bS[email protected]         pos += data_length;
1050d1dc057bS[email protected]         offset += data_length + 1; // rssi
1051d6b06661SMatthias Ringwald         hci_emit_event(event, pos, 1);
105257c9da5bS[email protected]     }
105357c9da5bS[email protected] }
1054b2f949feS[email protected] #endif
1055e8c8828eSMatthias Ringwald #endif
105657c9da5bS[email protected] 
10572b6ab3e6SMatthias Ringwald #ifdef ENABLE_BLE
10582b6ab3e6SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
10592b6ab3e6SMatthias Ringwald static void hci_reenable_advertisements_if_needed(void){
10602b6ab3e6SMatthias Ringwald     if (!hci_stack->le_advertisements_active && hci_stack->le_advertisements_enabled){
10612b6ab3e6SMatthias Ringwald         // get number of active le slave connections
10622b6ab3e6SMatthias Ringwald         int num_slave_connections = 0;
10632b6ab3e6SMatthias Ringwald         btstack_linked_list_iterator_t it;
10642b6ab3e6SMatthias Ringwald         btstack_linked_list_iterator_init(&it, &hci_stack->connections);
10652b6ab3e6SMatthias Ringwald         while (btstack_linked_list_iterator_has_next(&it)){
10662b6ab3e6SMatthias Ringwald             hci_connection_t * con = (hci_connection_t*) btstack_linked_list_iterator_next(&it);
10672b6ab3e6SMatthias Ringwald             log_info("state %u, role %u, le_con %u", con->state, con->role, hci_is_le_connection(con));
10682b6ab3e6SMatthias Ringwald             if (con->state != OPEN) continue;
10692b6ab3e6SMatthias Ringwald             if (con->role  != HCI_ROLE_SLAVE) continue;
10702b6ab3e6SMatthias Ringwald             if (!hci_is_le_connection(con)) continue;
10712b6ab3e6SMatthias Ringwald             num_slave_connections++;
10722b6ab3e6SMatthias Ringwald         }
10732b6ab3e6SMatthias Ringwald         log_info("Num LE Peripheral roles: %u of %u", num_slave_connections, hci_stack->le_max_number_peripheral_connections);
10742b6ab3e6SMatthias Ringwald         if (num_slave_connections < hci_stack->le_max_number_peripheral_connections){
10752b6ab3e6SMatthias Ringwald             hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_ENABLE;
10762b6ab3e6SMatthias Ringwald         }
10772b6ab3e6SMatthias Ringwald     }
10782b6ab3e6SMatthias Ringwald }
10792b6ab3e6SMatthias Ringwald #endif
10802b6ab3e6SMatthias Ringwald #endif
10812b6ab3e6SMatthias Ringwald 
1082cd77dd38SMatthias Ringwald #if !defined(HAVE_PLATFORM_IPHONE_OS) && !defined (HAVE_HOST_CONTROLLER_API)
108306b9e820SMatthias Ringwald 
108496b53536SMatthias Ringwald static uint32_t hci_transport_uart_get_main_baud_rate(void){
108596b53536SMatthias Ringwald     if (!hci_stack->config) return 0;
10869796ebeaSMatthias Ringwald     uint32_t baud_rate = ((hci_transport_config_uart_t *)hci_stack->config)->baudrate_main;
108796b53536SMatthias Ringwald     // Limit baud rate for Broadcom chipsets to 3 mbps
108861f37892SMatthias Ringwald     if (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_BROADCOM_CORPORATION && baud_rate > 3000000){
108996b53536SMatthias Ringwald         baud_rate = 3000000;
109096b53536SMatthias Ringwald     }
109196b53536SMatthias Ringwald     return baud_rate;
109296b53536SMatthias Ringwald }
109396b53536SMatthias Ringwald 
1094ec820d77SMatthias Ringwald static void hci_initialization_timeout_handler(btstack_timer_source_t * ds){
10959ec2630cSMatthias Ringwald     UNUSED(ds);
10969ec2630cSMatthias Ringwald 
10970305bdeaSMatthias Ringwald     switch (hci_stack->substate){
10980305bdeaSMatthias Ringwald         case HCI_INIT_W4_SEND_RESET:
10997b0d7667SMatthias Ringwald             log_info("Resend HCI Reset");
11000305bdeaSMatthias Ringwald             hci_stack->substate = HCI_INIT_SEND_RESET;
11017b0d7667SMatthias Ringwald             hci_stack->num_cmd_packets = 1;
11020305bdeaSMatthias Ringwald             hci_run();
11030305bdeaSMatthias Ringwald             break;
11049f007422SMatthias Ringwald         case HCI_INIT_W4_CUSTOM_INIT_CSR_WARM_BOOT_LINK_RESET:
11059f007422SMatthias Ringwald             log_info("Resend HCI Reset - CSR Warm Boot with Link Reset");
11069f007422SMatthias Ringwald             if (hci_stack->hci_transport->reset_link){
11079f007422SMatthias Ringwald                 hci_stack->hci_transport->reset_link();
11089f007422SMatthias Ringwald             }
1109202c8a4cSMatthias Ringwald             // no break - explicit fallthrough to HCI_INIT_W4_CUSTOM_INIT_CSR_WARM_BOOT
1110e47e68c7SMatthias Ringwald         case HCI_INIT_W4_CUSTOM_INIT_CSR_WARM_BOOT:
1111e47e68c7SMatthias Ringwald             log_info("Resend HCI Reset - CSR Warm Boot");
1112e47e68c7SMatthias Ringwald             hci_stack->substate = HCI_INIT_SEND_RESET_CSR_WARM_BOOT;
1113e47e68c7SMatthias Ringwald             hci_stack->num_cmd_packets = 1;
1114e47e68c7SMatthias Ringwald             hci_run();
1115688c2635SMatthias Ringwald             break;
11167224be7eSMatthias Ringwald         case HCI_INIT_W4_SEND_BAUD_CHANGE:
11177224be7eSMatthias Ringwald             if (hci_stack->hci_transport->set_baudrate){
111896b53536SMatthias Ringwald                 uint32_t baud_rate = hci_transport_uart_get_main_baud_rate();
1119cd724cb7SMatthias Ringwald                 log_info("Local baud rate change to %"PRIu32"(timeout handler)", baud_rate);
11207dd9d0ecSMatthias Ringwald                 hci_stack->hci_transport->set_baudrate(baud_rate);
11217224be7eSMatthias Ringwald             }
1122834bce8cSMatthias Ringwald             // For CSR, HCI Reset is sent on new baud rate. Don't forget to reset link for H5/BCSP
112361f37892SMatthias Ringwald             if (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_CAMBRIDGE_SILICON_RADIO){
1124834bce8cSMatthias Ringwald                 if (hci_stack->hci_transport->reset_link){
1125834bce8cSMatthias Ringwald                     log_info("Link Reset");
1126834bce8cSMatthias Ringwald                     hci_stack->hci_transport->reset_link();
1127834bce8cSMatthias Ringwald                 }
1128772a36d3SMatthias Ringwald                 hci_stack->substate = HCI_INIT_SEND_RESET_CSR_WARM_BOOT;
1129772a36d3SMatthias Ringwald                 hci_run();
1130772a36d3SMatthias Ringwald             }
11314696bddbSMatthias Ringwald             break;
1132559961d0SMatthias Ringwald         case HCI_INIT_W4_CUSTOM_INIT_BCM_DELAY:
1133559961d0SMatthias Ringwald             // otherwise continue
1134559961d0SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_READ_LOCAL_SUPPORTED_COMMANDS;
1135559961d0SMatthias Ringwald             hci_send_cmd(&hci_read_local_supported_commands);
1136559961d0SMatthias Ringwald             break;
11370305bdeaSMatthias Ringwald         default:
11380305bdeaSMatthias Ringwald             break;
11390305bdeaSMatthias Ringwald     }
11400305bdeaSMatthias Ringwald }
114106b9e820SMatthias Ringwald #endif
11420305bdeaSMatthias Ringwald 
114371de195eSMatthias Ringwald static void hci_initializing_next_state(void){
114474b323a9SMatthias Ringwald     hci_stack->substate = (hci_substate_t )( ((int) hci_stack->substate) + 1);
114574b323a9SMatthias Ringwald }
114674b323a9SMatthias Ringwald 
1147e9f343c8SMatthias Ringwald #if defined(ENABLE_CLASSIC) || defined(ENABLE_LE_PERIPHERAL)
11481c2a62f5SMatthias Ringwald static void hci_replace_bd_addr_placeholder(uint8_t * data, uint16_t size){
11491c2a62f5SMatthias Ringwald     const int bd_addr_string_len = 17;
11501c2a62f5SMatthias Ringwald     int i = 0;
11511c2a62f5SMatthias Ringwald     while (i < size - bd_addr_string_len){
11521c2a62f5SMatthias Ringwald         if (memcmp(&data[i], "00:00:00:00:00:00", bd_addr_string_len)) {
11531c2a62f5SMatthias Ringwald             i++;
11541c2a62f5SMatthias Ringwald             continue;
11551c2a62f5SMatthias Ringwald         }
11561c2a62f5SMatthias Ringwald         // set real address
11571c2a62f5SMatthias Ringwald         memcpy(&data[i], bd_addr_to_str(hci_stack->local_bd_addr), bd_addr_string_len);
11581c2a62f5SMatthias Ringwald         i += bd_addr_string_len;
11591c2a62f5SMatthias Ringwald     }
11601c2a62f5SMatthias Ringwald }
11611c2a62f5SMatthias Ringwald #endif
11621c2a62f5SMatthias Ringwald 
116374b323a9SMatthias Ringwald // assumption: hci_can_send_command_packet_now() == true
116471de195eSMatthias Ringwald static void hci_initializing_run(void){
1165148ca237SMatthias Ringwald     log_debug("hci_initializing_run: substate %u, can send %u", hci_stack->substate, hci_can_send_command_packet_now());
116674b323a9SMatthias Ringwald     switch (hci_stack->substate){
116774b323a9SMatthias Ringwald         case HCI_INIT_SEND_RESET:
116874b323a9SMatthias Ringwald             hci_state_reset();
1169a0cf2f3fSMatthias Ringwald 
117006b9e820SMatthias Ringwald #if !defined(HAVE_PLATFORM_IPHONE_OS) && !defined (HAVE_HOST_CONTROLLER_API)
11710305bdeaSMatthias Ringwald             // prepare reset if command complete not received in 100ms
1172659d758cSMatthias Ringwald             btstack_run_loop_set_timer(&hci_stack->timeout, HCI_RESET_RESEND_TIMEOUT_MS);
1173528a4a3bSMatthias Ringwald             btstack_run_loop_set_timer_handler(&hci_stack->timeout, hci_initialization_timeout_handler);
1174528a4a3bSMatthias Ringwald             btstack_run_loop_add_timer(&hci_stack->timeout);
1175a0cf2f3fSMatthias Ringwald #endif
11760305bdeaSMatthias Ringwald             // send command
117774b323a9SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_SEND_RESET;
11780305bdeaSMatthias Ringwald             hci_send_cmd(&hci_reset);
117974b323a9SMatthias Ringwald             break;
118076fcb19bSMatthias Ringwald         case HCI_INIT_SEND_READ_LOCAL_VERSION_INFORMATION:
118176fcb19bSMatthias Ringwald             hci_send_cmd(&hci_read_local_version_information);
118276fcb19bSMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_SEND_READ_LOCAL_VERSION_INFORMATION;
118376fcb19bSMatthias Ringwald             break;
1184e90bae01SMatthias Ringwald         case HCI_INIT_SEND_READ_LOCAL_NAME:
1185e90bae01SMatthias Ringwald             hci_send_cmd(&hci_read_local_name);
1186e90bae01SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_SEND_READ_LOCAL_NAME;
1187e90bae01SMatthias Ringwald             break;
118806b9e820SMatthias Ringwald 
118906b9e820SMatthias Ringwald #if !defined(HAVE_PLATFORM_IPHONE_OS) && !defined (HAVE_HOST_CONTROLLER_API)
1190e47e68c7SMatthias Ringwald         case HCI_INIT_SEND_RESET_CSR_WARM_BOOT:
1191e47e68c7SMatthias Ringwald             hci_state_reset();
1192e47e68c7SMatthias Ringwald             // prepare reset if command complete not received in 100ms
1193659d758cSMatthias Ringwald             btstack_run_loop_set_timer(&hci_stack->timeout, HCI_RESET_RESEND_TIMEOUT_MS);
1194528a4a3bSMatthias Ringwald             btstack_run_loop_set_timer_handler(&hci_stack->timeout, hci_initialization_timeout_handler);
1195528a4a3bSMatthias Ringwald             btstack_run_loop_add_timer(&hci_stack->timeout);
1196e47e68c7SMatthias Ringwald             // send command
1197e47e68c7SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_CUSTOM_INIT_CSR_WARM_BOOT;
1198e47e68c7SMatthias Ringwald             hci_send_cmd(&hci_reset);
1199e47e68c7SMatthias Ringwald             break;
12008d29070eSMatthias Ringwald         case HCI_INIT_SEND_RESET_ST_WARM_BOOT:
12018d29070eSMatthias Ringwald             hci_state_reset();
12028d29070eSMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_SEND_RESET_ST_WARM_BOOT;
12038d29070eSMatthias Ringwald             hci_send_cmd(&hci_reset);
12048d29070eSMatthias Ringwald             break;
1205fab26ab3SMatthias Ringwald         case HCI_INIT_SEND_BAUD_CHANGE: {
120696b53536SMatthias Ringwald             uint32_t baud_rate = hci_transport_uart_get_main_baud_rate();
12073fb36a29SMatthias Ringwald             hci_stack->chipset->set_baudrate_command(baud_rate, hci_stack->hci_packet_buffer);
1208f8fbdce0SMatthias Ringwald             hci_stack->last_cmd_opcode = little_endian_read_16(hci_stack->hci_packet_buffer, 0);
120974b323a9SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_SEND_BAUD_CHANGE;
12100305bdeaSMatthias Ringwald             hci_send_cmd_packet(hci_stack->hci_packet_buffer, 3 + hci_stack->hci_packet_buffer[2]);
12114696bddbSMatthias Ringwald             // STLC25000D: baudrate change happens within 0.5 s after command was send,
12124696bddbSMatthias Ringwald             // use timer to update baud rate after 100 ms (knowing exactly, when command was sent is non-trivial)
121361f37892SMatthias Ringwald             if (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_ST_MICROELECTRONICS){
1214659d758cSMatthias Ringwald                 btstack_run_loop_set_timer(&hci_stack->timeout, HCI_RESET_RESEND_TIMEOUT_MS);
1215528a4a3bSMatthias Ringwald                 btstack_run_loop_add_timer(&hci_stack->timeout);
12164696bddbSMatthias Ringwald             }
121774b323a9SMatthias Ringwald             break;
1218fab26ab3SMatthias Ringwald         }
1219fab26ab3SMatthias Ringwald         case HCI_INIT_SEND_BAUD_CHANGE_BCM: {
122096b53536SMatthias Ringwald             uint32_t baud_rate = hci_transport_uart_get_main_baud_rate();
12213fb36a29SMatthias Ringwald             hci_stack->chipset->set_baudrate_command(baud_rate, hci_stack->hci_packet_buffer);
1222f8fbdce0SMatthias Ringwald             hci_stack->last_cmd_opcode = little_endian_read_16(hci_stack->hci_packet_buffer, 0);
1223eb3a5314SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_SEND_BAUD_CHANGE_BCM;
1224eb3a5314SMatthias Ringwald             hci_send_cmd_packet(hci_stack->hci_packet_buffer, 3 + hci_stack->hci_packet_buffer[2]);
1225eb3a5314SMatthias Ringwald             break;
1226fab26ab3SMatthias Ringwald         }
122774b323a9SMatthias Ringwald         case HCI_INIT_CUSTOM_INIT:
122874b323a9SMatthias Ringwald             // Custom initialization
12293fb36a29SMatthias Ringwald             if (hci_stack->chipset && hci_stack->chipset->next_command){
12303fb36a29SMatthias Ringwald                 int valid_cmd = (*hci_stack->chipset->next_command)(hci_stack->hci_packet_buffer);
123174b323a9SMatthias Ringwald                 if (valid_cmd){
123274b323a9SMatthias Ringwald                     int size = 3 + hci_stack->hci_packet_buffer[2];
1233f8fbdce0SMatthias Ringwald                     hci_stack->last_cmd_opcode = little_endian_read_16(hci_stack->hci_packet_buffer, 0);
123474b323a9SMatthias Ringwald                     hci_dump_packet(HCI_COMMAND_DATA_PACKET, 0, hci_stack->hci_packet_buffer, size);
1235e47e68c7SMatthias Ringwald                     switch (valid_cmd) {
1236f41911edSMatthias Ringwald                         case BTSTACK_CHIPSET_VALID_COMMAND:
1237e47e68c7SMatthias Ringwald                             hci_stack->substate = HCI_INIT_W4_CUSTOM_INIT;
1238e47e68c7SMatthias Ringwald                             break;
1239f41911edSMatthias Ringwald                         case BTSTACK_CHIPSET_WARMSTART_REQUIRED:
1240f41911edSMatthias Ringwald                             // CSR Warm Boot: Wait a bit, then send HCI Reset until HCI Command Complete
1241e47e68c7SMatthias Ringwald                             log_info("CSR Warm Boot");
1242659d758cSMatthias Ringwald                             btstack_run_loop_set_timer(&hci_stack->timeout, HCI_RESET_RESEND_TIMEOUT_MS);
1243528a4a3bSMatthias Ringwald                             btstack_run_loop_set_timer_handler(&hci_stack->timeout, hci_initialization_timeout_handler);
1244528a4a3bSMatthias Ringwald                             btstack_run_loop_add_timer(&hci_stack->timeout);
124561f37892SMatthias Ringwald                             if (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_CAMBRIDGE_SILICON_RADIO
1246772a36d3SMatthias Ringwald                                 && hci_stack->config
12473fb36a29SMatthias Ringwald                                 && hci_stack->chipset
12483fb36a29SMatthias Ringwald                                 // && hci_stack->chipset->set_baudrate_command -- there's no such command
1249772a36d3SMatthias Ringwald                                 && hci_stack->hci_transport->set_baudrate
12502caefae9SMatthias Ringwald                                 && hci_transport_uart_get_main_baud_rate()){
1251772a36d3SMatthias Ringwald                                 hci_stack->substate = HCI_INIT_W4_SEND_BAUD_CHANGE;
1252772a36d3SMatthias Ringwald                             } else {
12539f007422SMatthias Ringwald                                hci_stack->substate = HCI_INIT_W4_CUSTOM_INIT_CSR_WARM_BOOT_LINK_RESET;
1254772a36d3SMatthias Ringwald                             }
1255e47e68c7SMatthias Ringwald                             break;
1256f41911edSMatthias Ringwald                         default:
1257f41911edSMatthias Ringwald                             // should not get here
1258f41911edSMatthias Ringwald                             break;
1259e47e68c7SMatthias Ringwald                     }
12600305bdeaSMatthias Ringwald                     hci_stack->hci_transport->send_packet(HCI_COMMAND_DATA_PACKET, hci_stack->hci_packet_buffer, size);
126174b323a9SMatthias Ringwald                     break;
126274b323a9SMatthias Ringwald                 }
1263148ca237SMatthias Ringwald                 log_info("Init script done");
126492a0d36dSMatthias Ringwald 
1265559961d0SMatthias Ringwald                 // Init script download on Broadcom chipsets causes:
1266e021ff1eSMatthias Ringwald                 if (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_BROADCOM_CORPORATION
1267e021ff1eSMatthias Ringwald                 ||  hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_EM_MICROELECTRONIC_MARIN_SA){
1268e021ff1eSMatthias Ringwald 
1269559961d0SMatthias Ringwald                     // - baud rate to reset, restore UART baud rate if needed
127092a0d36dSMatthias Ringwald                     int need_baud_change = hci_stack->config
12713fb36a29SMatthias Ringwald                         && hci_stack->chipset
12723fb36a29SMatthias Ringwald                         && hci_stack->chipset->set_baudrate_command
127392a0d36dSMatthias Ringwald                         && hci_stack->hci_transport->set_baudrate
12749796ebeaSMatthias Ringwald                         && ((hci_transport_config_uart_t *)hci_stack->config)->baudrate_main;
127592a0d36dSMatthias Ringwald                     if (need_baud_change) {
12769796ebeaSMatthias Ringwald                         uint32_t baud_rate = ((hci_transport_config_uart_t *)hci_stack->config)->baudrate_init;
1277cd724cb7SMatthias Ringwald                         log_info("Local baud rate change to %"PRIu32" after init script (bcm)", baud_rate);
127892a0d36dSMatthias Ringwald                         hci_stack->hci_transport->set_baudrate(baud_rate);
127992a0d36dSMatthias Ringwald                     }
1280559961d0SMatthias Ringwald 
1281559961d0SMatthias Ringwald                     // - RTS will raise during update, but manual RTS/CTS in WICED port on RedBear Duo cannot handle this
1282559961d0SMatthias Ringwald                     //   -> Work around: wait a few milliseconds here.
1283559961d0SMatthias Ringwald                     log_info("BCM delay after init script");
1284559961d0SMatthias Ringwald                     hci_stack->substate = HCI_INIT_W4_CUSTOM_INIT_BCM_DELAY;
1285559961d0SMatthias Ringwald                     btstack_run_loop_set_timer(&hci_stack->timeout, 10);
1286559961d0SMatthias Ringwald                     btstack_run_loop_set_timer_handler(&hci_stack->timeout, hci_initialization_timeout_handler);
1287559961d0SMatthias Ringwald                     btstack_run_loop_add_timer(&hci_stack->timeout);
1288559961d0SMatthias Ringwald                     break;
128992a0d36dSMatthias Ringwald                 }
129074b323a9SMatthias Ringwald             }
129174b323a9SMatthias Ringwald             // otherwise continue
1292a828a756SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_READ_LOCAL_SUPPORTED_COMMANDS;
1293a828a756SMatthias Ringwald             hci_send_cmd(&hci_read_local_supported_commands);
1294a828a756SMatthias Ringwald             break;
129553860077SMatthias Ringwald         case HCI_INIT_SET_BD_ADDR:
129653860077SMatthias Ringwald             log_info("Set Public BD ADDR to %s", bd_addr_to_str(hci_stack->custom_bd_addr));
12973fb36a29SMatthias Ringwald             hci_stack->chipset->set_bd_addr_command(hci_stack->custom_bd_addr, hci_stack->hci_packet_buffer);
1298f8fbdce0SMatthias Ringwald             hci_stack->last_cmd_opcode = little_endian_read_16(hci_stack->hci_packet_buffer, 0);
129953860077SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_SET_BD_ADDR;
130053860077SMatthias Ringwald             hci_send_cmd_packet(hci_stack->hci_packet_buffer, 3 + hci_stack->hci_packet_buffer[2]);
130153860077SMatthias Ringwald             break;
130206b9e820SMatthias Ringwald #endif
130306b9e820SMatthias Ringwald 
130406b9e820SMatthias Ringwald         case HCI_INIT_READ_LOCAL_SUPPORTED_COMMANDS:
130506b9e820SMatthias Ringwald             log_info("Resend hci_read_local_supported_commands after CSR Warm Boot double reset");
130606b9e820SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_READ_LOCAL_SUPPORTED_COMMANDS;
130706b9e820SMatthias Ringwald             hci_send_cmd(&hci_read_local_supported_commands);
130806b9e820SMatthias Ringwald             break;
130953860077SMatthias Ringwald         case HCI_INIT_READ_BD_ADDR:
131053860077SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_READ_BD_ADDR;
131153860077SMatthias Ringwald             hci_send_cmd(&hci_read_bd_addr);
131253860077SMatthias Ringwald             break;
131374b323a9SMatthias Ringwald         case HCI_INIT_READ_BUFFER_SIZE:
131474b323a9SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_READ_BUFFER_SIZE;
13150305bdeaSMatthias Ringwald             hci_send_cmd(&hci_read_buffer_size);
131674b323a9SMatthias Ringwald             break;
131753860077SMatthias Ringwald         case HCI_INIT_READ_LOCAL_SUPPORTED_FEATURES:
131853860077SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_READ_LOCAL_SUPPORTED_FEATURES;
13190305bdeaSMatthias Ringwald             hci_send_cmd(&hci_read_local_supported_features);
132074b323a9SMatthias Ringwald             break;
13212b838201SMatthias Ringwald 
13222b838201SMatthias Ringwald #ifdef ENABLE_HCI_CONTROLLER_TO_HOST_FLOW_CONTROL
13232b838201SMatthias Ringwald         case HCI_INIT_SET_CONTROLLER_TO_HOST_FLOW_CONTROL:
13242b838201SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_SET_CONTROLLER_TO_HOST_FLOW_CONTROL;
13252b838201SMatthias Ringwald             hci_send_cmd(&hci_set_controller_to_host_flow_control, 3);  // ACL + SCO Flow Control
13262b838201SMatthias Ringwald             break;
13272b838201SMatthias Ringwald         case HCI_INIT_HOST_BUFFER_SIZE:
13282b838201SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_HOST_BUFFER_SIZE;
13292b838201SMatthias Ringwald             hci_send_cmd(&hci_host_buffer_size, HCI_HOST_ACL_PACKET_LEN, HCI_HOST_SCO_PACKET_LEN,
13302b838201SMatthias Ringwald                                                 HCI_HOST_ACL_PACKET_NUM, HCI_HOST_SCO_PACKET_NUM);
13312b838201SMatthias Ringwald             break;
13322b838201SMatthias Ringwald #endif
13332b838201SMatthias Ringwald 
133474b323a9SMatthias Ringwald         case HCI_INIT_SET_EVENT_MASK:
13350305bdeaSMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_SET_EVENT_MASK;
133674b323a9SMatthias Ringwald             if (hci_le_supported()){
133774b323a9SMatthias Ringwald                 hci_send_cmd(&hci_set_event_mask,0xffffffff, 0x3FFFFFFF);
133874b323a9SMatthias Ringwald             } else {
133974b323a9SMatthias Ringwald                 // Kensington Bluetooth 2.1 USB Dongle (CSR Chipset) returns an error for 0xffff...
134074b323a9SMatthias Ringwald                 hci_send_cmd(&hci_set_event_mask,0xffffffff, 0x1FFFFFFF);
134174b323a9SMatthias Ringwald             }
134274b323a9SMatthias Ringwald             break;
13432b838201SMatthias Ringwald 
134435454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
134574b323a9SMatthias Ringwald         case HCI_INIT_WRITE_SIMPLE_PAIRING_MODE:
134674b323a9SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_WRITE_SIMPLE_PAIRING_MODE;
13470305bdeaSMatthias Ringwald             hci_send_cmd(&hci_write_simple_pairing_mode, hci_stack->ssp_enable);
134874b323a9SMatthias Ringwald             break;
134974b323a9SMatthias Ringwald         case HCI_INIT_WRITE_PAGE_TIMEOUT:
135074b323a9SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_WRITE_PAGE_TIMEOUT;
13510305bdeaSMatthias Ringwald             hci_send_cmd(&hci_write_page_timeout, 0x6000);  // ca. 15 sec
135274b323a9SMatthias Ringwald             break;
135374b323a9SMatthias Ringwald         case HCI_INIT_WRITE_CLASS_OF_DEVICE:
135474b323a9SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_WRITE_CLASS_OF_DEVICE;
13550305bdeaSMatthias Ringwald             hci_send_cmd(&hci_write_class_of_device, hci_stack->class_of_device);
135674b323a9SMatthias Ringwald             break;
13571c2a62f5SMatthias Ringwald         case HCI_INIT_WRITE_LOCAL_NAME: {
13580305bdeaSMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_WRITE_LOCAL_NAME;
13591c2a62f5SMatthias Ringwald             hci_reserve_packet_buffer();
13601c2a62f5SMatthias Ringwald             uint8_t * packet = hci_stack->hci_packet_buffer;
13611c2a62f5SMatthias Ringwald             // construct HCI Command and send
13621c2a62f5SMatthias Ringwald             uint16_t opcode = hci_write_local_name.opcode;
13631c2a62f5SMatthias Ringwald             hci_stack->last_cmd_opcode = opcode;
13641c2a62f5SMatthias Ringwald             packet[0] = opcode & 0xff;
13651c2a62f5SMatthias Ringwald             packet[1] = opcode >> 8;
13661c2a62f5SMatthias Ringwald             packet[2] = DEVICE_NAME_LEN;
13671c2a62f5SMatthias Ringwald             memset(&packet[3], 0, DEVICE_NAME_LEN);
136863168530SMatthias Ringwald             memcpy(&packet[3], hci_stack->local_name, strlen(hci_stack->local_name));
13691c2a62f5SMatthias Ringwald             // expand '00:00:00:00:00:00' in name with bd_addr
13701c2a62f5SMatthias Ringwald             hci_replace_bd_addr_placeholder(&packet[3], DEVICE_NAME_LEN);
13711c2a62f5SMatthias Ringwald             hci_send_cmd_packet(packet, HCI_CMD_HEADER_SIZE + DEVICE_NAME_LEN);
137274b323a9SMatthias Ringwald             break;
13731c2a62f5SMatthias Ringwald         }
137429af07f3SMatthias Ringwald         case HCI_INIT_WRITE_EIR_DATA: {
13758a114470SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_WRITE_EIR_DATA;
137629af07f3SMatthias Ringwald             hci_reserve_packet_buffer();
137729af07f3SMatthias Ringwald             uint8_t * packet = hci_stack->hci_packet_buffer;
137829af07f3SMatthias Ringwald             // construct HCI Command and send
137929af07f3SMatthias Ringwald             uint16_t opcode = hci_write_extended_inquiry_response.opcode;
138029af07f3SMatthias Ringwald             hci_stack->last_cmd_opcode = opcode;
138129af07f3SMatthias Ringwald             packet[0] = opcode & 0xff;
138229af07f3SMatthias Ringwald             packet[1] = opcode >> 8;
138329af07f3SMatthias Ringwald             packet[2] = 1 + 240;
138429af07f3SMatthias Ringwald             packet[3] = 0;  // FEC not required
1385ad0d1108SMatthias Ringwald             if (hci_stack->eir_data){
138629af07f3SMatthias Ringwald                 memcpy(&packet[4], hci_stack->eir_data, 240);
1387ad0d1108SMatthias Ringwald             } else {
1388ad0d1108SMatthias Ringwald                 memset(&packet[4], 0, 240);
1389ad0d1108SMatthias Ringwald                 int name_len = strlen(hci_stack->local_name);
1390ad0d1108SMatthias Ringwald                 packet[4] = name_len + 1;
1391ad0d1108SMatthias Ringwald                 packet[5] = BLUETOOTH_DATA_TYPE_COMPLETE_LOCAL_NAME;
1392ad0d1108SMatthias Ringwald                 memcpy(&packet[6], hci_stack->local_name, name_len);
1393ad0d1108SMatthias Ringwald             }
139429af07f3SMatthias Ringwald             // expand '00:00:00:00:00:00' in name with bd_addr
139529af07f3SMatthias Ringwald             hci_replace_bd_addr_placeholder(&packet[4], 240);
1396c439e296SMatthias Ringwald             hci_send_cmd_packet(packet, HCI_CMD_HEADER_SIZE + 1 + 240);
1397ff00ed1cSMatthias Ringwald             break;
139829af07f3SMatthias Ringwald         }
1399f6858d14SMatthias Ringwald         case HCI_INIT_WRITE_INQUIRY_MODE:
1400f6858d14SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_WRITE_INQUIRY_MODE;
14018a114470SMatthias Ringwald             hci_send_cmd(&hci_write_inquiry_mode, (int) hci_stack->inquiry_mode);
1402f6858d14SMatthias Ringwald             break;
140374b323a9SMatthias Ringwald         case HCI_INIT_WRITE_SCAN_ENABLE:
140474b323a9SMatthias Ringwald             hci_send_cmd(&hci_write_scan_enable, (hci_stack->connectable << 1) | hci_stack->discoverable); // page scan
140574b323a9SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_WRITE_SCAN_ENABLE;
140674b323a9SMatthias Ringwald             break;
1407483c5078SMatthias Ringwald         // only sent if ENABLE_SCO_OVER_HCI is defined
1408729ed62eSMatthias Ringwald         case HCI_INIT_WRITE_SYNCHRONOUS_FLOW_CONTROL_ENABLE:
1409729ed62eSMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_WRITE_SYNCHRONOUS_FLOW_CONTROL_ENABLE;
1410729ed62eSMatthias Ringwald             hci_send_cmd(&hci_write_synchronous_flow_control_enable, 1); // SCO tracking enabled
1411729ed62eSMatthias Ringwald             break;
1412483c5078SMatthias Ringwald         case HCI_INIT_WRITE_DEFAULT_ERRONEOUS_DATA_REPORTING:
1413483c5078SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_WRITE_DEFAULT_ERRONEOUS_DATA_REPORTING;
1414483c5078SMatthias Ringwald             hci_send_cmd(&hci_write_default_erroneous_data_reporting, 1);
1415483c5078SMatthias Ringwald             break;
1416a42798c3SMatthias Ringwald         // only sent if ENABLE_SCO_OVER_HCI and manufacturer is Broadcom
1417a42798c3SMatthias Ringwald         case HCI_INIT_BCM_WRITE_SCO_PCM_INT:
1418a42798c3SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_BCM_WRITE_SCO_PCM_INT;
1419a42798c3SMatthias Ringwald             log_info("BCM: Route SCO data via HCI transport");
1420a42798c3SMatthias Ringwald             hci_send_cmd(&hci_bcm_write_sco_pcm_int, 1, 0, 0, 0, 0);
1421a42798c3SMatthias Ringwald             break;
1422a42798c3SMatthias Ringwald 
142335454696SMatthias Ringwald #endif
1424a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE
142574b323a9SMatthias Ringwald         // LE INIT
142674b323a9SMatthias Ringwald         case HCI_INIT_LE_READ_BUFFER_SIZE:
142774b323a9SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_LE_READ_BUFFER_SIZE;
14280305bdeaSMatthias Ringwald             hci_send_cmd(&hci_le_read_buffer_size);
142974b323a9SMatthias Ringwald             break;
1430daabb8b8SMatthias Ringwald         case HCI_INIT_LE_SET_EVENT_MASK:
1431daabb8b8SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_LE_SET_EVENT_MASK;
1432a004d674SMatthias Ringwald             hci_send_cmd(&hci_le_set_event_mask, 0x1FF, 0x0);
1433daabb8b8SMatthias Ringwald             break;
143474b323a9SMatthias Ringwald         case HCI_INIT_WRITE_LE_HOST_SUPPORTED:
143574b323a9SMatthias Ringwald             // LE Supported Host = 1, Simultaneous Host = 0
143674b323a9SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_WRITE_LE_HOST_SUPPORTED;
14370305bdeaSMatthias Ringwald             hci_send_cmd(&hci_write_le_host_supported, 1, 0);
143874b323a9SMatthias Ringwald             break;
1439b435e062SMatthias Ringwald #endif
1440b435e062SMatthias Ringwald 
1441b435e062SMatthias Ringwald #ifdef ENABLE_LE_DATA_LENGTH_EXTENSION
1442dcd678baSMatthias Ringwald         case HCI_INIT_LE_READ_MAX_DATA_LENGTH:
1443dcd678baSMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_LE_READ_MAX_DATA_LENGTH;
1444dcd678baSMatthias Ringwald             hci_send_cmd(&hci_le_read_maximum_data_length);
1445dcd678baSMatthias Ringwald             break;
1446dcd678baSMatthias Ringwald         case HCI_INIT_LE_WRITE_SUGGESTED_DATA_LENGTH:
1447dcd678baSMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_LE_WRITE_SUGGESTED_DATA_LENGTH;
1448b435e062SMatthias 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);
1449dcd678baSMatthias Ringwald             break;
1450b435e062SMatthias Ringwald #endif
1451b435e062SMatthias Ringwald 
1452b95a5a35SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
14533b6d4121SMatthias Ringwald         case HCI_INIT_READ_WHITE_LIST_SIZE:
14543b6d4121SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_READ_WHITE_LIST_SIZE;
14553b6d4121SMatthias Ringwald             hci_send_cmd(&hci_le_read_white_list_size);
14563b6d4121SMatthias Ringwald             break;
145774b323a9SMatthias Ringwald         case HCI_INIT_LE_SET_SCAN_PARAMETERS:
1458b95a5a35SMatthias Ringwald             // LE Scan Parameters: active scanning, 300 ms interval, 30 ms window, own address type, accept all advs
145974b323a9SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_LE_SET_SCAN_PARAMETERS;
1460b95a5a35SMatthias Ringwald             hci_send_cmd(&hci_le_set_scan_parameters, 1, 0x1e0, 0x30, hci_stack->le_own_addr_type, 0);
146174b323a9SMatthias Ringwald             break;
146274b323a9SMatthias Ringwald #endif
146374b323a9SMatthias Ringwald         default:
146474b323a9SMatthias Ringwald             return;
146574b323a9SMatthias Ringwald     }
146655975f88SMatthias Ringwald }
146755975f88SMatthias Ringwald 
1468a650ba4dSMatthias Ringwald static void hci_init_done(void){
1469a650ba4dSMatthias Ringwald     // done. tell the app
1470a650ba4dSMatthias Ringwald     log_info("hci_init_done -> HCI_STATE_WORKING");
1471a650ba4dSMatthias Ringwald     hci_stack->state = HCI_STATE_WORKING;
1472a650ba4dSMatthias Ringwald     hci_emit_state();
1473a650ba4dSMatthias Ringwald     hci_run();
1474a650ba4dSMatthias Ringwald }
1475a650ba4dSMatthias Ringwald 
14766155b3d3S[email protected] static void hci_initializing_event_handler(uint8_t * packet, uint16_t size){
1477384b59deSMatthias Ringwald 
1478384b59deSMatthias Ringwald     UNUSED(size);   // ok: less than 6 bytes are read from our buffer
14799ec2630cSMatthias Ringwald 
1480a2481739S[email protected]     uint8_t command_completed = 0;
1481c4633093SMatthias Ringwald 
14820e2df43fSMatthias Ringwald     if (hci_event_packet_get_type(packet) == HCI_EVENT_COMMAND_COMPLETE){
1483f8fbdce0SMatthias Ringwald         uint16_t opcode = little_endian_read_16(packet,3);
14846155b3d3S[email protected]         if (opcode == hci_stack->last_cmd_opcode){
1485a2481739S[email protected]             command_completed = 1;
1486148ca237SMatthias Ringwald             log_debug("Command complete for expected opcode %04x at substate %u", opcode, hci_stack->substate);
14876155b3d3S[email protected]         } else {
1488d58dd308SMatthias Ringwald             log_info("Command complete for different opcode %04x, expected %04x, at substate %u", opcode, hci_stack->last_cmd_opcode, hci_stack->substate);
14896155b3d3S[email protected]         }
14906155b3d3S[email protected]     }
14910f97eae7SMatthias Ringwald 
14920e2df43fSMatthias Ringwald     if (hci_event_packet_get_type(packet) == HCI_EVENT_COMMAND_STATUS){
14936155b3d3S[email protected]         uint8_t  status = packet[2];
1494f8fbdce0SMatthias Ringwald         uint16_t opcode = little_endian_read_16(packet,4);
14956155b3d3S[email protected]         if (opcode == hci_stack->last_cmd_opcode){
14966155b3d3S[email protected]             if (status){
1497a2481739S[email protected]                 command_completed = 1;
1498148ca237SMatthias Ringwald                 log_debug("Command status error 0x%02x for expected opcode %04x at substate %u", status, opcode, hci_stack->substate);
14996155b3d3S[email protected]             } else {
15006155b3d3S[email protected]                 log_info("Command status OK for expected opcode %04x, waiting for command complete", opcode);
15016155b3d3S[email protected]             }
15026155b3d3S[email protected]         } else {
1503148ca237SMatthias Ringwald             log_debug("Command status for opcode %04x, expected %04x", opcode, hci_stack->last_cmd_opcode);
15046155b3d3S[email protected]         }
15056155b3d3S[email protected]     }
15060f97eae7SMatthias Ringwald 
150706b9e820SMatthias Ringwald #if !defined(HAVE_PLATFORM_IPHONE_OS) && !defined (HAVE_HOST_CONTROLLER_API)
150806b9e820SMatthias Ringwald 
1509e47e68c7SMatthias Ringwald     // Vendor == CSR
15100e2df43fSMatthias Ringwald     if (hci_stack->substate == HCI_INIT_W4_CUSTOM_INIT && hci_event_packet_get_type(packet) == HCI_EVENT_VENDOR_SPECIFIC){
1511e47e68c7SMatthias Ringwald         // TODO: track actual command
1512e47e68c7SMatthias Ringwald         command_completed = 1;
1513e47e68c7SMatthias Ringwald     }
1514a2481739S[email protected] 
15154e9daa6fSMatthias Ringwald     // Vendor == Toshiba
15160e2df43fSMatthias Ringwald     if (hci_stack->substate == HCI_INIT_W4_SEND_BAUD_CHANGE && hci_event_packet_get_type(packet) == HCI_EVENT_VENDOR_SPECIFIC){
15174e9daa6fSMatthias Ringwald         // TODO: track actual command
15184e9daa6fSMatthias Ringwald         command_completed = 1;
1519004902f1SMatthias Ringwald         // Fix: no HCI Command Complete received, so num_cmd_packets not reset
1520004902f1SMatthias Ringwald         hci_stack->num_cmd_packets = 1;
15214e9daa6fSMatthias Ringwald     }
15224e9daa6fSMatthias Ringwald 
15230f97eae7SMatthias Ringwald     // Late response (> 100 ms) for HCI Reset e.g. on Toshiba TC35661:
15240f97eae7SMatthias Ringwald     // Command complete for HCI Reset arrives after we've resent the HCI Reset command
15250f97eae7SMatthias Ringwald     //
15260f97eae7SMatthias Ringwald     // HCI Reset
15270f97eae7SMatthias Ringwald     // Timeout 100 ms
15280f97eae7SMatthias Ringwald     // HCI Reset
15290f97eae7SMatthias Ringwald     // Command Complete Reset
15300f97eae7SMatthias Ringwald     // HCI Read Local Version Information
15310f97eae7SMatthias Ringwald     // Command Complete Reset - but we expected Command Complete Read Local Version Information
15320f97eae7SMatthias Ringwald     // hang...
15330f97eae7SMatthias Ringwald     //
15340f97eae7SMatthias Ringwald     // Fix: Command Complete for HCI Reset in HCI_INIT_W4_SEND_READ_LOCAL_VERSION_INFORMATION trigger resend
15350f97eae7SMatthias Ringwald     if (!command_completed
15360e2df43fSMatthias Ringwald             && hci_event_packet_get_type(packet) == HCI_EVENT_COMMAND_COMPLETE
15370f97eae7SMatthias Ringwald             && hci_stack->substate == HCI_INIT_W4_SEND_READ_LOCAL_VERSION_INFORMATION){
15380f97eae7SMatthias Ringwald 
1539f8fbdce0SMatthias Ringwald         uint16_t opcode = little_endian_read_16(packet,3);
15400f97eae7SMatthias Ringwald         if (opcode == hci_reset.opcode){
15410f97eae7SMatthias Ringwald             hci_stack->substate = HCI_INIT_SEND_READ_LOCAL_VERSION_INFORMATION;
15420f97eae7SMatthias Ringwald             return;
15430f97eae7SMatthias Ringwald         }
15440f97eae7SMatthias Ringwald     }
15450f97eae7SMatthias Ringwald 
15469f007422SMatthias Ringwald     // CSR & H5
15479f007422SMatthias Ringwald     // Fix: Command Complete for HCI Reset in HCI_INIT_W4_SEND_READ_LOCAL_VERSION_INFORMATION trigger resend
15489f007422SMatthias Ringwald     if (!command_completed
15499f007422SMatthias Ringwald             && hci_event_packet_get_type(packet) == HCI_EVENT_COMMAND_COMPLETE
15509f007422SMatthias Ringwald             && hci_stack->substate == HCI_INIT_W4_READ_LOCAL_SUPPORTED_COMMANDS){
15519f007422SMatthias Ringwald 
15529f007422SMatthias Ringwald         uint16_t opcode = little_endian_read_16(packet,3);
15539f007422SMatthias Ringwald         if (opcode == hci_reset.opcode){
15549f007422SMatthias Ringwald             hci_stack->substate = HCI_INIT_READ_LOCAL_SUPPORTED_COMMANDS;
15559f007422SMatthias Ringwald             return;
15569f007422SMatthias Ringwald         }
15579f007422SMatthias Ringwald     }
15589f007422SMatthias Ringwald 
15599f007422SMatthias 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
15609f007422SMatthias Ringwald     // fix: Correct substate and behave as command below
15619f007422SMatthias Ringwald     if (command_completed){
15629f007422SMatthias Ringwald         switch (hci_stack->substate){
15639f007422SMatthias Ringwald             case HCI_INIT_SEND_RESET:
15649f007422SMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_SEND_RESET;
15659f007422SMatthias Ringwald                 break;
15669f007422SMatthias Ringwald             case HCI_INIT_SEND_RESET_CSR_WARM_BOOT:
15679f007422SMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_CUSTOM_INIT_CSR_WARM_BOOT;
15689f007422SMatthias Ringwald                 break;
15699f007422SMatthias Ringwald             default:
15709f007422SMatthias Ringwald                 break;
15719f007422SMatthias Ringwald         }
15729f007422SMatthias Ringwald     }
15730f97eae7SMatthias Ringwald 
157406b9e820SMatthias Ringwald #endif
15750f97eae7SMatthias Ringwald 
1576a2481739S[email protected]     if (!command_completed) return;
1577a2481739S[email protected] 
157806b9e820SMatthias Ringwald     int need_baud_change = 0;
157906b9e820SMatthias Ringwald     int need_addr_change = 0;
158006b9e820SMatthias Ringwald 
158106b9e820SMatthias Ringwald #if !defined(HAVE_PLATFORM_IPHONE_OS) && !defined (HAVE_HOST_CONTROLLER_API)
158206b9e820SMatthias Ringwald     need_baud_change = hci_stack->config
15833fb36a29SMatthias Ringwald                         && hci_stack->chipset
15843fb36a29SMatthias Ringwald                         && hci_stack->chipset->set_baudrate_command
1585db8bc6ffSMatthias Ringwald                         && hci_stack->hci_transport->set_baudrate
15869796ebeaSMatthias Ringwald                         && ((hci_transport_config_uart_t *)hci_stack->config)->baudrate_main;
1587db8bc6ffSMatthias Ringwald 
158806b9e820SMatthias Ringwald     need_addr_change = hci_stack->custom_bd_addr_set
15893fb36a29SMatthias Ringwald                         && hci_stack->chipset
15903fb36a29SMatthias Ringwald                         && hci_stack->chipset->set_bd_addr_command;
159106b9e820SMatthias Ringwald #endif
1592a80162e9SMatthias Ringwald 
15935c363727SMatthias Ringwald     switch(hci_stack->substate){
159406b9e820SMatthias Ringwald 
159506b9e820SMatthias Ringwald #if !defined(HAVE_PLATFORM_IPHONE_OS) && !defined (HAVE_HOST_CONTROLLER_API)
15969f007422SMatthias Ringwald         case HCI_INIT_SEND_RESET:
1597d58dd308SMatthias Ringwald             // on CSR with BCSP/H5, resend triggers resend of HCI Reset and leads to substate == HCI_INIT_SEND_RESET
15989f007422SMatthias Ringwald             // fix: just correct substate and behave as command below
15999f007422SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_SEND_RESET;
16009f007422SMatthias Ringwald             btstack_run_loop_remove_timer(&hci_stack->timeout);
16019f007422SMatthias Ringwald             break;
160274b323a9SMatthias Ringwald         case HCI_INIT_W4_SEND_RESET:
1603528a4a3bSMatthias Ringwald             btstack_run_loop_remove_timer(&hci_stack->timeout);
160476fcb19bSMatthias Ringwald             break;
1605e90bae01SMatthias Ringwald         case HCI_INIT_W4_SEND_READ_LOCAL_NAME:
1606e90bae01SMatthias Ringwald             log_info("Received local name, need baud change %d", need_baud_change);
16072f48d920SMatthias Ringwald             if (need_baud_change){
16082f48d920SMatthias Ringwald                 hci_stack->substate = HCI_INIT_SEND_BAUD_CHANGE;
16092f48d920SMatthias Ringwald                 return;
16102f48d920SMatthias Ringwald             }
161153860077SMatthias Ringwald             // skip baud change
161274b323a9SMatthias Ringwald             hci_stack->substate = HCI_INIT_CUSTOM_INIT;
161374b323a9SMatthias Ringwald             return;
1614a80162e9SMatthias Ringwald         case HCI_INIT_W4_SEND_BAUD_CHANGE:
16154696bddbSMatthias Ringwald             // for STLC2500D, baud rate change already happened.
1616fab26ab3SMatthias Ringwald             // for others, baud rate gets changed now
161761f37892SMatthias Ringwald             if ((hci_stack->manufacturer != BLUETOOTH_COMPANY_ID_ST_MICROELECTRONICS) && need_baud_change){
161896b53536SMatthias Ringwald                 uint32_t baud_rate = hci_transport_uart_get_main_baud_rate();
1619cd724cb7SMatthias Ringwald                 log_info("Local baud rate change to %"PRIu32"(w4_send_baud_change)", baud_rate);
1620fab26ab3SMatthias Ringwald                 hci_stack->hci_transport->set_baudrate(baud_rate);
16214696bddbSMatthias Ringwald             }
162274b323a9SMatthias Ringwald             hci_stack->substate = HCI_INIT_CUSTOM_INIT;
162374b323a9SMatthias Ringwald             return;
1624a80162e9SMatthias Ringwald         case HCI_INIT_W4_CUSTOM_INIT_CSR_WARM_BOOT:
1625528a4a3bSMatthias Ringwald             btstack_run_loop_remove_timer(&hci_stack->timeout);
1626a80162e9SMatthias Ringwald             hci_stack->substate = HCI_INIT_CUSTOM_INIT;
1627a80162e9SMatthias Ringwald             return;
162874b323a9SMatthias Ringwald         case HCI_INIT_W4_CUSTOM_INIT:
162974b323a9SMatthias Ringwald             // repeat custom init
163074b323a9SMatthias Ringwald             hci_stack->substate = HCI_INIT_CUSTOM_INIT;
163174b323a9SMatthias Ringwald             return;
163206b9e820SMatthias Ringwald #else
163306b9e820SMatthias Ringwald         case HCI_INIT_W4_SEND_RESET:
163406b9e820SMatthias Ringwald             hci_stack->substate = HCI_INIT_READ_LOCAL_SUPPORTED_COMMANDS;
163506b9e820SMatthias Ringwald             return ;
163606b9e820SMatthias Ringwald #endif
163706b9e820SMatthias Ringwald 
1638a828a756SMatthias Ringwald         case HCI_INIT_W4_READ_LOCAL_SUPPORTED_COMMANDS:
1639efd3b327SMatthias Ringwald             if (need_baud_change &&
1640efd3b327SMatthias Ringwald               ((hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_BROADCOM_CORPORATION) ||
1641efd3b327SMatthias Ringwald                (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_EM_MICROELECTRONIC_MARIN_SA))) {
1642eb3a5314SMatthias Ringwald                 hci_stack->substate = HCI_INIT_SEND_BAUD_CHANGE_BCM;
1643eb3a5314SMatthias Ringwald                 return;
1644eb3a5314SMatthias Ringwald             }
164553860077SMatthias Ringwald             if (need_addr_change){
164653860077SMatthias Ringwald                 hci_stack->substate = HCI_INIT_SET_BD_ADDR;
164753860077SMatthias Ringwald                 return;
164853860077SMatthias Ringwald             }
164953860077SMatthias Ringwald             hci_stack->substate = HCI_INIT_READ_BD_ADDR;
165053860077SMatthias Ringwald             return;
165106b9e820SMatthias Ringwald #if !defined(HAVE_PLATFORM_IPHONE_OS) && !defined (HAVE_HOST_CONTROLLER_API)
16527224be7eSMatthias Ringwald         case HCI_INIT_W4_SEND_BAUD_CHANGE_BCM:
16537224be7eSMatthias Ringwald             if (need_baud_change){
165496b53536SMatthias Ringwald                 uint32_t baud_rate = hci_transport_uart_get_main_baud_rate();
1655cd724cb7SMatthias Ringwald                 log_info("Local baud rate change to %"PRIu32"(w4_send_baud_change_bcm))", baud_rate);
1656fab26ab3SMatthias Ringwald                 hci_stack->hci_transport->set_baudrate(baud_rate);
16577224be7eSMatthias Ringwald             }
1658eb3a5314SMatthias Ringwald             if (need_addr_change){
1659eb3a5314SMatthias Ringwald                 hci_stack->substate = HCI_INIT_SET_BD_ADDR;
1660eb3a5314SMatthias Ringwald                 return;
1661eb3a5314SMatthias Ringwald             }
1662eb3a5314SMatthias Ringwald             hci_stack->substate = HCI_INIT_READ_BD_ADDR;
1663eb3a5314SMatthias Ringwald             return;
166453860077SMatthias Ringwald         case HCI_INIT_W4_SET_BD_ADDR:
16656ca9a99aSMatthias Ringwald             // for STLC2500D + ATWILC3000, bd addr change only gets active after sending reset command
16666ca9a99aSMatthias Ringwald             if ((hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_ST_MICROELECTRONICS)
16676ca9a99aSMatthias Ringwald             ||  (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_ATMEL_CORPORATION)){
166853860077SMatthias Ringwald                 hci_stack->substate = HCI_INIT_SEND_RESET_ST_WARM_BOOT;
166953860077SMatthias Ringwald                 return;
167053860077SMatthias Ringwald             }
167153860077SMatthias Ringwald             // skipping st warm boot
167253860077SMatthias Ringwald             hci_stack->substate = HCI_INIT_READ_BD_ADDR;
167353860077SMatthias Ringwald             return;
167453860077SMatthias Ringwald         case HCI_INIT_W4_SEND_RESET_ST_WARM_BOOT:
167553860077SMatthias Ringwald             hci_stack->substate = HCI_INIT_READ_BD_ADDR;
167653860077SMatthias Ringwald             return;
167706b9e820SMatthias Ringwald #endif
167853860077SMatthias Ringwald         case HCI_INIT_W4_READ_BD_ADDR:
167953860077SMatthias Ringwald             // only read buffer size if supported
168053860077SMatthias Ringwald             if (hci_stack->local_supported_commands[0] & 0x01) {
168153860077SMatthias Ringwald                 hci_stack->substate = HCI_INIT_READ_BUFFER_SIZE;
168253860077SMatthias Ringwald                 return;
168353860077SMatthias Ringwald             }
168453860077SMatthias Ringwald             // skipping read buffer size
168553860077SMatthias Ringwald             hci_stack->substate = HCI_INIT_READ_LOCAL_SUPPORTED_FEATURES;
1686a828a756SMatthias Ringwald             return;
168774b323a9SMatthias Ringwald         case HCI_INIT_W4_SET_EVENT_MASK:
16886155b3d3S[email protected]             // skip Classic init commands for LE only chipsets
16896155b3d3S[email protected]             if (!hci_classic_supported()){
16902c68f164SMatthias Ringwald #ifdef ENABLE_BLE
16916155b3d3S[email protected]                 if (hci_le_supported()){
169274b323a9SMatthias Ringwald                     hci_stack->substate = HCI_INIT_LE_READ_BUFFER_SIZE; // skip all classic command
169374b323a9SMatthias Ringwald                     return;
16942c68f164SMatthias Ringwald                 }
16952c68f164SMatthias Ringwald #endif
16966155b3d3S[email protected]                 log_error("Neither BR/EDR nor LE supported");
1697a650ba4dSMatthias Ringwald                 hci_init_done();
169874b323a9SMatthias Ringwald                 return;
16996155b3d3S[email protected]             }
170015a95bd5SMatthias Ringwald             if (!gap_ssp_supported()){
17015c363727SMatthias Ringwald                 hci_stack->substate = HCI_INIT_WRITE_PAGE_TIMEOUT;
170274b323a9SMatthias Ringwald                 return;
17036155b3d3S[email protected]             }
17046155b3d3S[email protected]             break;
1705903ea03aSMatthias Ringwald #ifdef ENABLE_BLE
1706a828a756SMatthias Ringwald         case HCI_INIT_W4_LE_READ_BUFFER_SIZE:
1707a828a756SMatthias Ringwald             // skip write le host if not supported (e.g. on LE only EM9301)
1708a828a756SMatthias Ringwald             if (hci_stack->local_supported_commands[0] & 0x02) break;
1709daabb8b8SMatthias Ringwald             hci_stack->substate = HCI_INIT_LE_SET_EVENT_MASK;
1710daabb8b8SMatthias Ringwald             return;
1711daabb8b8SMatthias Ringwald 
1712b435e062SMatthias Ringwald #ifdef ENABLE_LE_DATA_LENGTH_EXTENSION
1713b435e062SMatthias Ringwald         case HCI_INIT_W4_WRITE_LE_HOST_SUPPORTED:
17146fab74dbSMatthias Ringwald             log_info("Supported commands %x", hci_stack->local_supported_commands[0] & 0x30);
1715b435e062SMatthias Ringwald             if ((hci_stack->local_supported_commands[0] & 0x30) == 0x30){
171680d7d618SMatthias Ringwald                 hci_stack->substate = HCI_INIT_LE_SET_EVENT_MASK;
1717b435e062SMatthias Ringwald                 return;
1718b435e062SMatthias Ringwald             }
1719b435e062SMatthias Ringwald             // explicit fall through to reduce repetitions
1720b435e062SMatthias Ringwald 
1721b435e062SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
1722b435e062SMatthias Ringwald             hci_stack->substate = HCI_INIT_READ_WHITE_LIST_SIZE;
1723903ea03aSMatthias Ringwald #else
1724903ea03aSMatthias Ringwald             hci_init_done();
1725903ea03aSMatthias Ringwald #endif
1726a828a756SMatthias Ringwald             return;
172706337f4fSMatthias Ringwald #endif  /* ENABLE_LE_DATA_LENGTH_EXTENSION */
172806337f4fSMatthias Ringwald 
172906337f4fSMatthias Ringwald #endif  /* ENABLE_BLE */
1730b435e062SMatthias Ringwald 
173171c4de7aSMatthias Ringwald #ifdef ENABLE_SCO_OVER_HCI
1732729ed62eSMatthias Ringwald         case HCI_INIT_W4_WRITE_SCAN_ENABLE:
17333905afbfSMatthias Ringwald             // skip write synchronous flow control if not supported
17343905afbfSMatthias Ringwald             if (hci_stack->local_supported_commands[0] & 0x04) break;
17353905afbfSMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_WRITE_SYNCHRONOUS_FLOW_CONTROL_ENABLE;
17363905afbfSMatthias Ringwald             // explicit fall through to reduce repetitions
17373905afbfSMatthias Ringwald 
1738729ed62eSMatthias Ringwald         case HCI_INIT_W4_WRITE_SYNCHRONOUS_FLOW_CONTROL_ENABLE:
17393905afbfSMatthias Ringwald             // skip write default erroneous data reporting if not supported
17403905afbfSMatthias Ringwald             if (hci_stack->local_supported_commands[0] & 0x08) break;
17413905afbfSMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_WRITE_DEFAULT_ERRONEOUS_DATA_REPORTING;
17423905afbfSMatthias Ringwald             // explicit fall through to reduce repetitions
17433905afbfSMatthias Ringwald 
1744f064e0bbSMatthias Ringwald         case HCI_INIT_W4_WRITE_DEFAULT_ERRONEOUS_DATA_REPORTING:
1745a42798c3SMatthias Ringwald             // skip bcm set sco pcm config on non-Broadcom chipsets
174661f37892SMatthias Ringwald             if (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_BROADCOM_CORPORATION) break;
1747a42798c3SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_BCM_WRITE_SCO_PCM_INT;
1748a42798c3SMatthias Ringwald             // explicit fall through to reduce repetitions
1749a42798c3SMatthias Ringwald 
1750a42798c3SMatthias Ringwald         case HCI_INIT_W4_BCM_WRITE_SCO_PCM_INT:
1751729ed62eSMatthias Ringwald             if (!hci_le_supported()){
1752729ed62eSMatthias Ringwald                 // SKIP LE init for Classic only configuration
1753a650ba4dSMatthias Ringwald                 hci_init_done();
1754729ed62eSMatthias Ringwald                 return;
1755729ed62eSMatthias Ringwald             }
1756729ed62eSMatthias Ringwald             break;
1757f3b012f9SMatthias Ringwald 
1758f3b012f9SMatthias Ringwald #else /* !ENABLE_SCO_OVER_HCI */
1759f3b012f9SMatthias Ringwald 
176074b323a9SMatthias Ringwald         case HCI_INIT_W4_WRITE_SCAN_ENABLE:
1761f3b012f9SMatthias Ringwald #ifdef ENABLE_BLE
1762f3b012f9SMatthias Ringwald             if (hci_le_supported()){
1763f3b012f9SMatthias Ringwald                 hci_stack->substate = HCI_INIT_LE_READ_BUFFER_SIZE;
176474b323a9SMatthias Ringwald                 return;
17656155b3d3S[email protected]             }
1766729ed62eSMatthias Ringwald #endif
1767f3b012f9SMatthias Ringwald             // SKIP LE init for Classic only configuration
1768f3b012f9SMatthias Ringwald             hci_init_done();
1769f3b012f9SMatthias Ringwald             return;
1770f3b012f9SMatthias Ringwald #endif /* ENABLE_SCO_OVER_HCI */
1771f3b012f9SMatthias Ringwald 
1772a4e96e78SMatthias Ringwald // avoid compile error due to duplicate cases: HCI_INIT_W4_BCM_WRITE_SCO_PCM_INT == HCI_INIT_DONE-1
1773a4e96e78SMatthias Ringwald #if defined(ENABLE_BLE) || defined(ENABLE_LE_DATA_LENGTH_EXTENSION) || defined(ENABLE_LE_CENTRAL)
1774a650ba4dSMatthias Ringwald         // Response to command before init done state -> init done
1775a650ba4dSMatthias Ringwald         case (HCI_INIT_DONE-1):
1776a650ba4dSMatthias Ringwald             hci_init_done();
1777a650ba4dSMatthias Ringwald             return;
1778a4e96e78SMatthias Ringwald #endif
1779a650ba4dSMatthias Ringwald 
17806155b3d3S[email protected]         default:
178174b323a9SMatthias Ringwald             break;
17826155b3d3S[email protected]     }
178355975f88SMatthias Ringwald     hci_initializing_next_state();
17846155b3d3S[email protected] }
17856155b3d3S[email protected] 
1786*0bbba85bSMatthias Ringwald static void hci_handle_connection_failed(hci_connection_t * conn, uint8_t status){
1787*0bbba85bSMatthias Ringwald     int notify_dedicated_bonding_failed = conn->bonding_flags & BONDING_DEDICATED;
1788*0bbba85bSMatthias Ringwald     bd_addr_t bd_address;
1789*0bbba85bSMatthias Ringwald     memcpy(&bd_address, conn->address, 6);
1790*0bbba85bSMatthias Ringwald 
1791*0bbba85bSMatthias Ringwald     // connection failed, remove entry
1792*0bbba85bSMatthias Ringwald     btstack_linked_list_remove(&hci_stack->connections, (btstack_linked_item_t *) conn);
1793*0bbba85bSMatthias Ringwald     btstack_memory_hci_connection_free( conn );
1794*0bbba85bSMatthias Ringwald 
1795*0bbba85bSMatthias Ringwald     // notify client if dedicated bonding
1796*0bbba85bSMatthias Ringwald     if (notify_dedicated_bonding_failed){
1797*0bbba85bSMatthias Ringwald         log_info("hci notify_dedicated_bonding_failed");
1798*0bbba85bSMatthias Ringwald         hci_emit_dedicated_bonding_result(bd_address, status);
1799*0bbba85bSMatthias Ringwald     }
1800*0bbba85bSMatthias Ringwald 
1801*0bbba85bSMatthias Ringwald     // if authentication error, also delete link key
1802*0bbba85bSMatthias Ringwald     if (status == ERROR_CODE_AUTHENTICATION_FAILURE) {
1803*0bbba85bSMatthias Ringwald         gap_drop_link_key_for_bd_addr(bd_address);
1804*0bbba85bSMatthias Ringwald     }
1805*0bbba85bSMatthias Ringwald }
1806*0bbba85bSMatthias Ringwald 
180716833f0aSmatthias.ringwald static void event_handler(uint8_t *packet, int size){
1808e76a89eeS[email protected] 
1809e76a89eeS[email protected]     uint16_t event_length = packet[1];
1810e76a89eeS[email protected] 
1811e76a89eeS[email protected]     // assert packet is complete
1812e76a89eeS[email protected]     if (size != event_length + 2){
1813f04a0c31SMatthias Ringwald         log_error("hci.c: event_handler called with event packet of wrong size %d, expected %u => dropping packet", size, event_length + 2);
1814e76a89eeS[email protected]         return;
1815e76a89eeS[email protected]     }
1816e76a89eeS[email protected] 
18171281a47eSmatthias.ringwald     bd_addr_t addr;
181896a45072S[email protected]     bd_addr_type_t addr_type;
1819fe1ed1b8Smatthias.ringwald     hci_con_handle_t handle;
18201f7b95a1Smatthias.ringwald     hci_connection_t * conn;
182156cf178bSmatthias.ringwald     int i;
18220014e02cSMatthias Ringwald #ifdef ENABLE_CLASSIC
18230014e02cSMatthias Ringwald     uint8_t link_type;
18240014e02cSMatthias Ringwald #endif
182535454696SMatthias Ringwald 
18260e2df43fSMatthias Ringwald     // log_info("HCI:EVENT:%02x", hci_event_packet_get_type(packet));
18275909f7f2Smatthias.ringwald 
18280e2df43fSMatthias Ringwald     switch (hci_event_packet_get_type(packet)) {
182922909952Smatthias.ringwald 
18306772a24cSmatthias.ringwald         case HCI_EVENT_COMMAND_COMPLETE:
18316bef4003SMatthias Ringwald             // get num cmd packets - limit to 1 to reduce complexity
18326bef4003SMatthias Ringwald             hci_stack->num_cmd_packets = packet[2] ? 1 : 0;
18337ec5eeaaSmatthias.ringwald 
18349e263bd7SMatthias Ringwald             if (HCI_EVENT_IS_COMMAND_COMPLETE(packet, hci_read_local_name)){
183506b9e820SMatthias Ringwald                 if (packet[5]) break;
18369e263bd7SMatthias Ringwald                 // terminate, name 248 chars
18379e263bd7SMatthias Ringwald                 packet[6+248] = 0;
18389e263bd7SMatthias Ringwald                 log_info("local name: %s", &packet[6]);
18399e263bd7SMatthias Ringwald             }
1840073bd0faSMatthias Ringwald             if (HCI_EVENT_IS_COMMAND_COMPLETE(packet, hci_read_buffer_size)){
18411d279b20Smatthias.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"
1842429122ccSMatthias Ringwald                 if (hci_stack->state == HCI_STATE_INITIALIZING){
1843429122ccSMatthias Ringwald                     uint16_t acl_len = little_endian_read_16(packet, 6);
1844429122ccSMatthias Ringwald                     uint16_t sco_len = packet[8];
1845429122ccSMatthias Ringwald 
1846429122ccSMatthias Ringwald                     // determine usable ACL/SCO payload size
1847429122ccSMatthias Ringwald                     hci_stack->acl_data_packet_length = btstack_min(acl_len, HCI_ACL_PAYLOAD_SIZE);
1848429122ccSMatthias Ringwald                     hci_stack->sco_data_packet_length = btstack_min(sco_len, HCI_ACL_PAYLOAD_SIZE);
1849429122ccSMatthias Ringwald 
1850f8fbdce0SMatthias Ringwald                     hci_stack->acl_packets_total_num  = little_endian_read_16(packet, 9);
1851f8fbdce0SMatthias Ringwald                     hci_stack->sco_packets_total_num  = little_endian_read_16(packet, 11);
1852a8b12447S[email protected] 
1853429122ccSMatthias Ringwald                     log_info("hci_read_buffer_size: ACL size module %u -> used %u, count %u / SCO size %u, count %u",
1854429122ccSMatthias Ringwald                              acl_len, hci_stack->acl_data_packet_length, hci_stack->acl_packets_total_num,
18551a06f663S[email protected]                              hci_stack->sco_data_packet_length, hci_stack->sco_packets_total_num);
1856e2edc0c3Smatthias.ringwald                 }
185756cf178bSmatthias.ringwald             }
1858a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE
1859073bd0faSMatthias Ringwald             if (HCI_EVENT_IS_COMMAND_COMPLETE(packet, hci_le_read_buffer_size)){
1860f8fbdce0SMatthias Ringwald                 hci_stack->le_data_packets_length = little_endian_read_16(packet, 6);
1861ee303eddS[email protected]                 hci_stack->le_acl_packets_total_num  = packet[8];
18626c26b087S[email protected]                 // determine usable ACL payload size
18636c26b087S[email protected]                 if (HCI_ACL_PAYLOAD_SIZE < hci_stack->le_data_packets_length){
18646c26b087S[email protected]                     hci_stack->le_data_packets_length = HCI_ACL_PAYLOAD_SIZE;
18656c26b087S[email protected]                 }
18669da54300S[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);
186765a46ef3S[email protected]             }
1868b435e062SMatthias Ringwald #endif
1869b435e062SMatthias Ringwald #ifdef ENABLE_LE_DATA_LENGTH_EXTENSION
1870dcd678baSMatthias Ringwald             if (HCI_EVENT_IS_COMMAND_COMPLETE(packet, hci_le_read_maximum_data_length)){
1871dcd678baSMatthias Ringwald                 hci_stack->le_supported_max_tx_octets = little_endian_read_16(packet, 6);
1872dcd678baSMatthias Ringwald                 hci_stack->le_supported_max_tx_time = little_endian_read_16(packet, 8);
1873dcd678baSMatthias 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);
1874dcd678baSMatthias Ringwald             }
1875b435e062SMatthias Ringwald #endif
1876d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
1877073bd0faSMatthias Ringwald             if (HCI_EVENT_IS_COMMAND_COMPLETE(packet, hci_le_read_white_list_size)){
1878e691bb38SMatthias Ringwald                 hci_stack->le_whitelist_capacity = packet[6];
187915d0a15bSMatthias Ringwald                 log_info("hci_le_read_white_list_size: size %u", hci_stack->le_whitelist_capacity);
18803b6d4121SMatthias Ringwald             }
188165a46ef3S[email protected] #endif
1882073bd0faSMatthias Ringwald             if (HCI_EVENT_IS_COMMAND_COMPLETE(packet, hci_read_bd_addr)) {
1883724d70a2SMatthias Ringwald                 reverse_bd_addr(&packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE + 1],
1884724d70a2SMatthias Ringwald 				hci_stack->local_bd_addr);
18859da54300S[email protected]                 log_info("Local Address, Status: 0x%02x: Addr: %s",
18863a9fb326S[email protected]                     packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE], bd_addr_to_str(hci_stack->local_bd_addr));
188733373e40SMatthias Ringwald #ifdef ENABLE_CLASSIC
18881624665aSMatthias Ringwald                 if (hci_stack->link_key_db){
18891624665aSMatthias Ringwald                     hci_stack->link_key_db->set_local_bd_addr(hci_stack->local_bd_addr);
18901624665aSMatthias Ringwald                 }
189133373e40SMatthias Ringwald #endif
1892188981d2Smatthias.ringwald             }
189335454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
1894073bd0faSMatthias Ringwald             if (HCI_EVENT_IS_COMMAND_COMPLETE(packet, hci_write_scan_enable)){
18953a9fb326S[email protected]                 hci_emit_discoverable_enabled(hci_stack->discoverable);
1896381fbed8Smatthias.ringwald             }
1897f5875de5SMatthias Ringwald             if (HCI_EVENT_IS_COMMAND_COMPLETE(packet, hci_inquiry_cancel)){
1898f5875de5SMatthias Ringwald                 if (hci_stack->inquiry_state == GAP_INQUIRY_STATE_W4_CANCELLED){
1899f5875de5SMatthias Ringwald                     hci_stack->inquiry_state = GAP_INQUIRY_STATE_IDLE;
1900f5875de5SMatthias Ringwald                     uint8_t event[] = { GAP_EVENT_INQUIRY_COMPLETE, 1, 0};
1901f5875de5SMatthias Ringwald                     hci_emit_event(event, sizeof(event), 1);
1902f5875de5SMatthias Ringwald                 }
1903f5875de5SMatthias Ringwald             }
190435454696SMatthias Ringwald #endif
190535454696SMatthias Ringwald 
190665389bfcS[email protected]             // Note: HCI init checks
1907073bd0faSMatthias Ringwald             if (HCI_EVENT_IS_COMMAND_COMPLETE(packet, hci_read_local_supported_features)){
19083a9fb326S[email protected]                 memcpy(hci_stack->local_supported_features, &packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1], 8);
190965389bfcS[email protected] 
191035454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
1911a5a23fc2S[email protected]                 // determine usable ACL packet types based on host buffer size and supported features
1912a5a23fc2S[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]);
19138b96126aSMatthias Ringwald                 log_info("Packet types %04x, eSCO %u", hci_stack->packet_types, hci_extended_sco_link_supported());
191435454696SMatthias Ringwald #endif
1915f5d8d141S[email protected]                 // Classic/LE
1916f5d8d141S[email protected]                 log_info("BR/EDR support %u, LE support %u", hci_classic_supported(), hci_le_supported());
1917559e517eS[email protected]             }
1918073bd0faSMatthias Ringwald             if (HCI_EVENT_IS_COMMAND_COMPLETE(packet, hci_read_local_version_information)){
1919f8fbdce0SMatthias Ringwald                 // hci_stack->hci_version    = little_endian_read_16(packet, 4);
1920f8fbdce0SMatthias Ringwald                 // hci_stack->hci_revision   = little_endian_read_16(packet, 6);
1921f8fbdce0SMatthias Ringwald                 // hci_stack->lmp_version    = little_endian_read_16(packet, 8);
1922f8fbdce0SMatthias Ringwald                 hci_stack->manufacturer   = little_endian_read_16(packet, 10);
1923f8fbdce0SMatthias Ringwald                 // hci_stack->lmp_subversion = little_endian_read_16(packet, 12);
19244696bddbSMatthias Ringwald                 log_info("Manufacturer: 0x%04x", hci_stack->manufacturer);
19254696bddbSMatthias Ringwald             }
1926073bd0faSMatthias Ringwald             if (HCI_EVENT_IS_COMMAND_COMPLETE(packet, hci_read_local_supported_commands)){
1927a828a756SMatthias Ringwald                 hci_stack->local_supported_commands[0] =
19283905afbfSMatthias Ringwald                     (packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1+14] & 0x80) >> 7 |  // bit 0 = Octet 14, bit 7
19293905afbfSMatthias Ringwald                     (packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1+24] & 0x40) >> 5 |  // bit 1 = Octet 24, bit 6
19303905afbfSMatthias Ringwald                     (packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1+10] & 0x10) >> 2 |  // bit 2 = Octet 10, bit 4
1931220006fbSMatthias Ringwald                     (packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1+18] & 0x08)      |  // bit 3 = Octet 18, bit 3
1932220006fbSMatthias Ringwald                     (packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1+34] & 0x01) << 4 |  // bit 4 = Octet 34, bit 0
1933220006fbSMatthias Ringwald                     (packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1+35] & 0x08) << 2;   // bit 5 = Octet 35, bit 3
19343905afbfSMatthias Ringwald                     log_info("Local supported commands summary 0x%02x", hci_stack->local_supported_commands[0]);
1935a828a756SMatthias Ringwald             }
1936e8c8828eSMatthias Ringwald #ifdef ENABLE_CLASSIC
1937073bd0faSMatthias Ringwald             if (HCI_EVENT_IS_COMMAND_COMPLETE(packet, hci_write_synchronous_flow_control_enable)){
19385b9b590fSMatthias Ringwald                 if (packet[5] == 0){
19395b9b590fSMatthias Ringwald                     hci_stack->synchronous_flow_control_enabled = 1;
19405b9b590fSMatthias Ringwald                 }
19415b9b590fSMatthias Ringwald             }
1942e8c8828eSMatthias Ringwald #endif
194356cf178bSmatthias.ringwald             break;
194456cf178bSmatthias.ringwald 
19457ec5eeaaSmatthias.ringwald         case HCI_EVENT_COMMAND_STATUS:
19466bef4003SMatthias Ringwald             // get num cmd packets - limit to 1 to reduce complexity
19476bef4003SMatthias Ringwald             hci_stack->num_cmd_packets = packet[3] ? 1 : 0;
19487ec5eeaaSmatthias.ringwald             break;
19497ec5eeaaSmatthias.ringwald 
19502e440c8aS[email protected]         case HCI_EVENT_NUMBER_OF_COMPLETED_PACKETS:{
19512e440c8aS[email protected]             int offset = 3;
195256cf178bSmatthias.ringwald             for (i=0; i<packet[2];i++){
195380117cebSMatthias Ringwald                 handle = little_endian_read_16(packet, offset) & 0x0fff;
19542e440c8aS[email protected]                 offset += 2;
1955f8fbdce0SMatthias Ringwald                 uint16_t num_packets = little_endian_read_16(packet, offset);
19562e440c8aS[email protected]                 offset += 2;
19572e440c8aS[email protected] 
19585061f3afS[email protected]                 conn = hci_connection_for_handle(handle);
195956cf178bSmatthias.ringwald                 if (!conn){
19609da54300S[email protected]                     log_error("hci_number_completed_packet lists unused con handle %u", handle);
196156cf178bSmatthias.ringwald                     continue;
196256cf178bSmatthias.ringwald                 }
196323bed257S[email protected] 
1964e35edcc1S[email protected]                 if (conn->address_type == BD_ADDR_TYPE_SCO){
196535454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
1966e35edcc1S[email protected]                     if (conn->num_sco_packets_sent >= num_packets){
1967e35edcc1S[email protected]                         conn->num_sco_packets_sent -= num_packets;
1968e35edcc1S[email protected]                     } else {
1969e35edcc1S[email protected]                         log_error("hci_number_completed_packets, more sco slots freed then sent.");
1970e35edcc1S[email protected]                         conn->num_sco_packets_sent = 0;
1971e35edcc1S[email protected]                     }
1972701e3307SMatthias Ringwald                     hci_notify_if_sco_can_send_now();
197335454696SMatthias Ringwald #endif
1974e35edcc1S[email protected]                 } else {
197523bed257S[email protected]                     if (conn->num_acl_packets_sent >= num_packets){
197656cf178bSmatthias.ringwald                         conn->num_acl_packets_sent -= num_packets;
197723bed257S[email protected]                     } else {
1978e35edcc1S[email protected]                         log_error("hci_number_completed_packets, more acl slots freed then sent.");
197923bed257S[email protected]                         conn->num_acl_packets_sent = 0;
198023bed257S[email protected]                     }
1981e35edcc1S[email protected]                 }
19829da54300S[email protected]                 // log_info("hci_number_completed_packet %u processed for handle %u, outstanding %u", num_packets, handle, conn->num_acl_packets_sent);
198356cf178bSmatthias.ringwald             }
19846772a24cSmatthias.ringwald             break;
19852e440c8aS[email protected]         }
198635454696SMatthias Ringwald 
198735454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
1988f5875de5SMatthias Ringwald         case HCI_EVENT_INQUIRY_COMPLETE:
1989f5875de5SMatthias Ringwald             if (hci_stack->inquiry_state == GAP_INQUIRY_STATE_ACTIVE){
1990f5875de5SMatthias Ringwald                 hci_stack->inquiry_state = GAP_INQUIRY_STATE_IDLE;
1991f5875de5SMatthias Ringwald                 uint8_t event[] = { GAP_EVENT_INQUIRY_COMPLETE, 1, 0};
1992f5875de5SMatthias Ringwald                 hci_emit_event(event, sizeof(event), 1);
1993f5875de5SMatthias Ringwald             }
1994f5875de5SMatthias Ringwald             break;
1995b7f1ee76SMatthias Ringwald         case HCI_EVENT_REMOTE_NAME_REQUEST_COMPLETE:
1996b7f1ee76SMatthias Ringwald             if (hci_stack->remote_name_state == GAP_REMOTE_NAME_STATE_W4_COMPLETE){
1997b7f1ee76SMatthias Ringwald                 hci_stack->remote_name_state = GAP_REMOTE_NAME_STATE_IDLE;
1998b7f1ee76SMatthias Ringwald             }
1999b7f1ee76SMatthias Ringwald             break;
20001f7b95a1Smatthias.ringwald         case HCI_EVENT_CONNECTION_REQUEST:
2001724d70a2SMatthias Ringwald             reverse_bd_addr(&packet[2], addr);
200237eaa4cfSmatthias.ringwald             // TODO: eval COD 8-10
20032d00edd4Smatthias.ringwald             link_type = packet[11];
20049da54300S[email protected]             log_info("Connection_incoming: %s, type %u", bd_addr_to_str(addr), link_type);
2005e35edcc1S[email protected]             addr_type = link_type == 1 ? BD_ADDR_TYPE_CLASSIC : BD_ADDR_TYPE_SCO;
20062e77e513S[email protected]             conn = hci_connection_for_bd_addr_and_type(addr, addr_type);
20071f7b95a1Smatthias.ringwald             if (!conn) {
20085293c072S[email protected]                 conn = create_connection_for_bd_addr_and_type(addr, addr_type);
20091f7b95a1Smatthias.ringwald             }
2010ce4c8fabSmatthias.ringwald             if (!conn) {
2011ce4c8fabSmatthias.ringwald                 // CONNECTION REJECTED DUE TO LIMITED RESOURCES (0X0D)
20123a9fb326S[email protected]                 hci_stack->decline_reason = 0x0d;
2013058e3d6bSMatthias Ringwald                 bd_addr_copy(hci_stack->decline_addr, addr);
2014ce4c8fabSmatthias.ringwald                 break;
2015ce4c8fabSmatthias.ringwald             }
20165cf766e8SMatthias Ringwald             conn->role  = HCI_ROLE_SLAVE;
201732ab9390Smatthias.ringwald             conn->state = RECEIVED_CONNECTION_REQUEST;
2018f3a16b9aSMatthias Ringwald             // store info about eSCO
2019f3a16b9aSMatthias Ringwald             if (link_type == 0x02){
2020f3a16b9aSMatthias Ringwald                 conn->remote_supported_feature_eSCO = 1;
2021f3a16b9aSMatthias Ringwald             }
202232ab9390Smatthias.ringwald             hci_run();
20231f7b95a1Smatthias.ringwald             break;
20241f7b95a1Smatthias.ringwald 
20256772a24cSmatthias.ringwald         case HCI_EVENT_CONNECTION_COMPLETE:
2026fe1ed1b8Smatthias.ringwald             // Connection management
2027724d70a2SMatthias Ringwald             reverse_bd_addr(&packet[5], addr);
20289da54300S[email protected]             log_info("Connection_complete (status=%u) %s", packet[2], bd_addr_to_str(addr));
202996a45072S[email protected]             addr_type = BD_ADDR_TYPE_CLASSIC;
20302e77e513S[email protected]             conn = hci_connection_for_bd_addr_and_type(addr, addr_type);
2031fe1ed1b8Smatthias.ringwald             if (conn) {
2032b448a0e7Smatthias.ringwald                 if (!packet[2]){
2033c8e4258aSmatthias.ringwald                     conn->state = OPEN;
2034f8fbdce0SMatthias Ringwald                     conn->con_handle = little_endian_read_16(packet, 3);
2035ad83dc6aS[email protected]                     conn->bonding_flags |= BONDING_REQUEST_REMOTE_FEATURES;
2036ee091cf1Smatthias.ringwald 
2037c785ef68Smatthias.ringwald                     // restart timer
2038528a4a3bSMatthias Ringwald                     btstack_run_loop_set_timer(&conn->timeout, HCI_CONNECTION_TIMEOUT_MS);
2039528a4a3bSMatthias Ringwald                     btstack_run_loop_add_timer(&conn->timeout);
2040c785ef68Smatthias.ringwald 
20419da54300S[email protected]                     log_info("New connection: handle %u, %s", conn->con_handle, bd_addr_to_str(conn->address));
204243bfb1bdSmatthias.ringwald 
204343bfb1bdSmatthias.ringwald                     hci_emit_nr_connections_changed();
2044b448a0e7Smatthias.ringwald                 } else {
2045*0bbba85bSMatthias Ringwald                     // connection failed
2046*0bbba85bSMatthias Ringwald                     hci_handle_connection_failed(conn, packet[2]);
2047fe1ed1b8Smatthias.ringwald                 }
2048fe1ed1b8Smatthias.ringwald             }
20496772a24cSmatthias.ringwald             break;
2050fe1ed1b8Smatthias.ringwald 
205144d0e3d5S[email protected]         case HCI_EVENT_SYNCHRONOUS_CONNECTION_COMPLETE:
2052724d70a2SMatthias Ringwald             reverse_bd_addr(&packet[5], addr);
205344d0e3d5S[email protected]             log_info("Synchronous Connection Complete (status=%u) %s", packet[2], bd_addr_to_str(addr));
20541a06f663S[email protected]             if (packet[2]){
205544d0e3d5S[email protected]                 // connection failed
205644d0e3d5S[email protected]                 break;
205744d0e3d5S[email protected]             }
20582e77e513S[email protected]             conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_SCO);
2059e35edcc1S[email protected]             if (!conn) {
2060e35edcc1S[email protected]                 conn = create_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_SCO);
2061e35edcc1S[email protected]             }
2062e35edcc1S[email protected]             if (!conn) {
2063e35edcc1S[email protected]                 break;
2064e35edcc1S[email protected]             }
20651a06f663S[email protected]             conn->state = OPEN;
2066f8fbdce0SMatthias Ringwald             conn->con_handle = little_endian_read_16(packet, 3);
2067ee752bb8SMatthias Ringwald 
2068ee752bb8SMatthias Ringwald #ifdef ENABLE_SCO_OVER_HCI
2069ee752bb8SMatthias Ringwald             // update SCO
2070ee752bb8SMatthias Ringwald             if (conn->address_type == BD_ADDR_TYPE_SCO && hci_stack->hci_transport && hci_stack->hci_transport->set_sco_config){
2071ee752bb8SMatthias Ringwald                 hci_stack->hci_transport->set_sco_config(hci_stack->sco_voice_setting_active, hci_number_sco_connections());
2072ee752bb8SMatthias Ringwald             }
2073ee752bb8SMatthias Ringwald #endif
207444d0e3d5S[email protected]             break;
207544d0e3d5S[email protected] 
2076afd4e962S[email protected]         case HCI_EVENT_READ_REMOTE_SUPPORTED_FEATURES_COMPLETE:
2077f8fbdce0SMatthias Ringwald             handle = little_endian_read_16(packet, 3);
2078afd4e962S[email protected]             conn = hci_connection_for_handle(handle);
2079afd4e962S[email protected]             if (!conn) break;
2080afd4e962S[email protected]             if (!packet[2]){
2081afd4e962S[email protected]                 uint8_t * features = &packet[5];
2082afd4e962S[email protected]                 if (features[6] & (1 << 3)){
2083afd4e962S[email protected]                     conn->bonding_flags |= BONDING_REMOTE_SUPPORTS_SSP;
2084afd4e962S[email protected]                 }
208598a2fd1cSMatthias Ringwald                 if (features[3] & (1<<7)){
208698a2fd1cSMatthias Ringwald                     conn->remote_supported_feature_eSCO = 1;
208798a2fd1cSMatthias Ringwald                 }
2088afd4e962S[email protected]             }
2089afd4e962S[email protected]             conn->bonding_flags |= BONDING_RECEIVED_REMOTE_FEATURES;
209098a2fd1cSMatthias Ringwald             log_info("HCI_EVENT_READ_REMOTE_SUPPORTED_FEATURES_COMPLETE, bonding flags %x, eSCO %u", conn->bonding_flags, conn->remote_supported_feature_eSCO);
2091ad83dc6aS[email protected]             if (conn->bonding_flags & BONDING_DEDICATED){
2092ad83dc6aS[email protected]                 conn->bonding_flags |= BONDING_SEND_AUTHENTICATE_REQUEST;
2093ad83dc6aS[email protected]             }
2094afd4e962S[email protected]             break;
2095afd4e962S[email protected] 
20967fde4af9Smatthias.ringwald         case HCI_EVENT_LINK_KEY_REQUEST:
20979da54300S[email protected]             log_info("HCI_EVENT_LINK_KEY_REQUEST");
20987fde4af9Smatthias.ringwald             hci_add_connection_flags_for_flipped_bd_addr(&packet[2], RECV_LINK_KEY_REQUEST);
209974d716b5S[email protected]             // non-bondable mode: link key negative reply will be sent by HANDLE_LINK_KEY_REQUEST
2100a98592bcSMatthias Ringwald             if (hci_stack->bondable && !hci_stack->link_key_db) break;
210132ab9390Smatthias.ringwald             hci_add_connection_flags_for_flipped_bd_addr(&packet[2], HANDLE_LINK_KEY_REQUEST);
210264472d52Smatthias.ringwald             hci_run();
2103d9a327f9Smatthias.ringwald             // request handled by hci_run() as HANDLE_LINK_KEY_REQUEST gets set
210429d53098Smatthias.ringwald             return;
21057fde4af9Smatthias.ringwald 
21069ab95c90S[email protected]         case HCI_EVENT_LINK_KEY_NOTIFICATION: {
2107724d70a2SMatthias Ringwald             reverse_bd_addr(&packet[2], addr);
21082e77e513S[email protected]             conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_CLASSIC);
21099ab95c90S[email protected]             if (!conn) break;
21109ab95c90S[email protected]             conn->authentication_flags |= RECV_LINK_KEY_NOTIFICATION;
21117bdc6798S[email protected]             link_key_type_t link_key_type = (link_key_type_t)packet[24];
21129ab95c90S[email protected]             // Change Connection Encryption keeps link key type
21139ab95c90S[email protected]             if (link_key_type != CHANGED_COMBINATION_KEY){
21149ab95c90S[email protected]                 conn->link_key_type = link_key_type;
21159ab95c90S[email protected]             }
211655597469SMatthias Ringwald             gap_store_link_key_for_bd_addr(addr, &packet[8], conn->link_key_type);
211729d53098Smatthias.ringwald             // still forward event to allow dismiss of pairing dialog
21187fde4af9Smatthias.ringwald             break;
21199ab95c90S[email protected]         }
21207fde4af9Smatthias.ringwald 
21217fde4af9Smatthias.ringwald         case HCI_EVENT_PIN_CODE_REQUEST:
21226724cd9eS[email protected]             hci_add_connection_flags_for_flipped_bd_addr(&packet[2], LEGACY_PAIRING_ACTIVE);
21234c57c146S[email protected]             // non-bondable mode: pin code negative reply will be sent
21243a9fb326S[email protected]             if (!hci_stack->bondable){
2125899283eaS[email protected]                 hci_add_connection_flags_for_flipped_bd_addr(&packet[2], DENY_PIN_CODE_REQUEST);
2126f8fb5f6eS[email protected]                 hci_run();
2127f8fb5f6eS[email protected]                 return;
21284c57c146S[email protected]             }
2129d9a327f9Smatthias.ringwald             // PIN CODE REQUEST means the link key request didn't succee -> delete stored link key
2130a98592bcSMatthias Ringwald             if (!hci_stack->link_key_db) break;
2131a6ef64baSMilanka Ringwald             hci_event_pin_code_request_get_bd_addr(packet, addr);
2132a98592bcSMatthias Ringwald             hci_stack->link_key_db->delete_link_key(addr);
21337fde4af9Smatthias.ringwald             break;
21347fde4af9Smatthias.ringwald 
21351d6b20aeS[email protected]         case HCI_EVENT_IO_CAPABILITY_REQUEST:
21361d6b20aeS[email protected]             hci_add_connection_flags_for_flipped_bd_addr(&packet[2], RECV_IO_CAPABILITIES_REQUEST);
2137dbe1a790S[email protected]             hci_add_connection_flags_for_flipped_bd_addr(&packet[2], SEND_IO_CAPABILITIES_REPLY);
2138dbe1a790S[email protected]             break;
2139dbe1a790S[email protected] 
2140dbe1a790S[email protected]         case HCI_EVENT_USER_CONFIRMATION_REQUEST:
21416724cd9eS[email protected]             hci_add_connection_flags_for_flipped_bd_addr(&packet[2], SSP_PAIRING_ACTIVE);
21423a9fb326S[email protected]             if (!hci_stack->ssp_auto_accept) break;
2143dbe1a790S[email protected]             hci_add_connection_flags_for_flipped_bd_addr(&packet[2], SEND_USER_CONFIRM_REPLY);
2144dbe1a790S[email protected]             break;
2145dbe1a790S[email protected] 
2146dbe1a790S[email protected]         case HCI_EVENT_USER_PASSKEY_REQUEST:
21476724cd9eS[email protected]             hci_add_connection_flags_for_flipped_bd_addr(&packet[2], SSP_PAIRING_ACTIVE);
21483a9fb326S[email protected]             if (!hci_stack->ssp_auto_accept) break;
2149dbe1a790S[email protected]             hci_add_connection_flags_for_flipped_bd_addr(&packet[2], SEND_USER_PASSKEY_REPLY);
21501d6b20aeS[email protected]             break;
215135454696SMatthias Ringwald #endif
21521d6b20aeS[email protected] 
2153f0944df2S[email protected]         case HCI_EVENT_ENCRYPTION_CHANGE:
2154f8fbdce0SMatthias Ringwald             handle = little_endian_read_16(packet, 3);
2155f0944df2S[email protected]             conn = hci_connection_for_handle(handle);
2156f0944df2S[email protected]             if (!conn) break;
2157ad83dc6aS[email protected]             if (packet[2] == 0) {
2158f0944df2S[email protected]                 if (packet[5]){
2159f0944df2S[email protected]                     conn->authentication_flags |= CONNECTION_ENCRYPTED;
2160f0944df2S[email protected]                 } else {
2161536f9994S[email protected]                     conn->authentication_flags &= ~CONNECTION_ENCRYPTED;
2162f0944df2S[email protected]                 }
2163ad83dc6aS[email protected]             }
216435454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
2165a00031e2S[email protected]             hci_emit_security_level(handle, gap_security_level_for_connection(conn));
216635454696SMatthias Ringwald #endif
2167f0944df2S[email protected]             break;
2168f0944df2S[email protected] 
216935454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
21701eb2563eS[email protected]         case HCI_EVENT_AUTHENTICATION_COMPLETE_EVENT:
2171f8fbdce0SMatthias Ringwald             handle = little_endian_read_16(packet, 3);
21721eb2563eS[email protected]             conn = hci_connection_for_handle(handle);
21731eb2563eS[email protected]             if (!conn) break;
2174ad83dc6aS[email protected] 
2175ad83dc6aS[email protected]             // dedicated bonding: send result and disconnect
2176ad83dc6aS[email protected]             if (conn->bonding_flags & BONDING_DEDICATED){
2177ad83dc6aS[email protected]                 conn->bonding_flags &= ~BONDING_DEDICATED;
2178ad83dc6aS[email protected]                 conn->bonding_flags |= BONDING_DISCONNECT_DEDICATED_DONE;
21791bd5283dS[email protected]                 conn->bonding_status = packet[2];
2180ad83dc6aS[email protected]                 break;
2181ad83dc6aS[email protected]             }
2182ad83dc6aS[email protected] 
2183b5cb6874S[email protected]             if (packet[2] == 0 && gap_security_level_for_link_key_type(conn->link_key_type) >= conn->requested_security_level){
21841eb2563eS[email protected]                 // link key sufficient for requested security
21851eb2563eS[email protected]                 conn->bonding_flags |= BONDING_SEND_ENCRYPTION_REQUEST;
2186ad83dc6aS[email protected]                 break;
2187ad83dc6aS[email protected]             }
21881eb2563eS[email protected]             // not enough
21891eb2563eS[email protected]             hci_emit_security_level(handle, gap_security_level_for_connection(conn));
21901eb2563eS[email protected]             break;
219135454696SMatthias Ringwald #endif
219234d2123cS[email protected] 
219386805605S[email protected]         // HCI_EVENT_DISCONNECTION_COMPLETE
2194ccda6e14S[email protected]         // has been split, to first notify stack before shutting connection down
2195ccda6e14S[email protected]         // see end of function, too.
2196a4f30ec0S[email protected]         case HCI_EVENT_DISCONNECTION_COMPLETE:
2197a4f30ec0S[email protected]             if (packet[2]) break;   // status != 0
2198f8fbdce0SMatthias Ringwald             handle = little_endian_read_16(packet, 3);
2199c6a37cfdSMatthias Ringwald             // drop outgoing ACL fragments if it is for closed connection
2200c6a37cfdSMatthias Ringwald             if (hci_stack->acl_fragmentation_total_size > 0) {
2201c6a37cfdSMatthias Ringwald                 if (handle == READ_ACL_CONNECTION_HANDLE(hci_stack->hci_packet_buffer)){
2202c6a37cfdSMatthias Ringwald                     log_info("hci: drop fragmented ACL data for closed connection");
2203c6a37cfdSMatthias Ringwald                      hci_stack->acl_fragmentation_total_size = 0;
2204c6a37cfdSMatthias Ringwald                      hci_stack->acl_fragmentation_pos = 0;
2205c6a37cfdSMatthias Ringwald                 }
2206c6a37cfdSMatthias Ringwald             }
220735454696SMatthias Ringwald 
22089a2e4658SMatthias Ringwald             // re-enable advertisements for le connections if active
2209c6a37cfdSMatthias Ringwald             conn = hci_connection_for_handle(handle);
2210c6a37cfdSMatthias Ringwald             if (!conn) break;
2211a70e17d4SMatthias Ringwald             conn->state = RECEIVED_DISCONNECTION_COMPLETE;
221235454696SMatthias Ringwald #ifdef ENABLE_BLE
2213d70217a2SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
22142b6ab3e6SMatthias Ringwald             if (hci_is_le_connection(conn)){
22152b6ab3e6SMatthias Ringwald                 hci_reenable_advertisements_if_needed();
22169a2e4658SMatthias Ringwald             }
221735454696SMatthias Ringwald #endif
2218d70217a2SMatthias Ringwald #endif
2219ccda6e14S[email protected]             break;
22206772a24cSmatthias.ringwald 
2221c68bdf90Smatthias.ringwald         case HCI_EVENT_HARDWARE_ERROR:
2222313e5f9cSMatthias Ringwald             log_error("Hardware Error: 0x%02x", packet[2]);
2223d23838ecSMatthias Ringwald             if (hci_stack->hardware_error_callback){
2224c2e1fa60SMatthias Ringwald                 (*hci_stack->hardware_error_callback)(packet[2]);
22257586ee35S[email protected]             } else {
22267586ee35S[email protected]                 // if no special requests, just reboot stack
22277586ee35S[email protected]                 hci_power_control_off();
22287586ee35S[email protected]                 hci_power_control_on();
2229c68bdf90Smatthias.ringwald             }
2230c68bdf90Smatthias.ringwald             break;
2231c68bdf90Smatthias.ringwald 
22320e6f3837SMatthias Ringwald #ifdef ENABLE_CLASSIC
22335cf766e8SMatthias Ringwald         case HCI_EVENT_ROLE_CHANGE:
22345cf766e8SMatthias Ringwald             if (packet[2]) break;   // status != 0
2235c4c88f1bSJakob Krantz             reverse_bd_addr(&packet[3], addr);
2236c4c88f1bSJakob Krantz             addr_type = BD_ADDR_TYPE_CLASSIC;
2237c4c88f1bSJakob Krantz             conn = hci_connection_for_bd_addr_and_type(addr, addr_type);
2238c4c88f1bSJakob Krantz             if (!conn) break;
22395cf766e8SMatthias Ringwald             conn->role = packet[9];
22405cf766e8SMatthias Ringwald             break;
22410e6f3837SMatthias Ringwald #endif
22425cf766e8SMatthias Ringwald 
224363fa3374SMatthias Ringwald         case HCI_EVENT_TRANSPORT_PACKET_SENT:
2244d051460cS[email protected]             // release packet buffer only for asynchronous transport and if there are not further fragements
22454fa24b5fS[email protected]             if (hci_transport_synchronous()) {
224663fa3374SMatthias Ringwald                 log_error("Synchronous HCI Transport shouldn't send HCI_EVENT_TRANSPORT_PACKET_SENT");
22474fa24b5fS[email protected]                 return; // instead of break: to avoid re-entering hci_run()
22484fa24b5fS[email protected]             }
2249d051460cS[email protected]             if (hci_stack->acl_fragmentation_total_size) break;
2250d051460cS[email protected]             hci_release_packet_buffer();
2251701e3307SMatthias Ringwald 
225263fa3374SMatthias Ringwald             // L2CAP receives this event via the hci_emit_event below
225363fa3374SMatthias Ringwald 
225435454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
225563fa3374SMatthias Ringwald             // For SCO, we do the can_send_now_check here
2256701e3307SMatthias Ringwald             hci_notify_if_sco_can_send_now();
225735454696SMatthias Ringwald #endif
22586b4af23dS[email protected]             break;
22596b4af23dS[email protected] 
226035454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
226163fa3374SMatthias Ringwald         case HCI_EVENT_SCO_CAN_SEND_NOW:
226263fa3374SMatthias Ringwald             // For SCO, we do the can_send_now_check here
226363fa3374SMatthias Ringwald             hci_notify_if_sco_can_send_now();
226463fa3374SMatthias Ringwald             return;
22651cfb383eSMatthias Ringwald 
22661cfb383eSMatthias Ringwald         // explode inquriy results for easier consumption
22671cfb383eSMatthias Ringwald         case HCI_EVENT_INQUIRY_RESULT:
22681cfb383eSMatthias Ringwald         case HCI_EVENT_INQUIRY_RESULT_WITH_RSSI:
22691cfb383eSMatthias Ringwald         case HCI_EVENT_EXTENDED_INQUIRY_RESPONSE:
22701cfb383eSMatthias Ringwald             gap_inquiry_explode(packet);
22711cfb383eSMatthias Ringwald             break;
227235454696SMatthias Ringwald #endif
227363fa3374SMatthias Ringwald 
2274a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE
22755909f7f2Smatthias.ringwald         case HCI_EVENT_LE_META:
22765909f7f2Smatthias.ringwald             switch (packet[2]){
2277d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
227857c9da5bS[email protected]                 case HCI_SUBEVENT_LE_ADVERTISING_REPORT:
22794f4e0224SMatthias Ringwald                     // log_info("advertising report received");
22806fab74dbSMatthias Ringwald                     if (!hci_stack->le_scanning_enabled) break;
228157c9da5bS[email protected]                     le_handle_advertisement_report(packet, size);
22827bdc6798S[email protected]                     break;
2283d70217a2SMatthias Ringwald #endif
22845909f7f2Smatthias.ringwald                 case HCI_SUBEVENT_LE_CONNECTION_COMPLETE:
22855909f7f2Smatthias.ringwald                     // Connection management
2286724d70a2SMatthias Ringwald                     reverse_bd_addr(&packet[8], addr);
22877bdc6798S[email protected]                     addr_type = (bd_addr_type_t)packet[7];
22889da54300S[email protected]                     log_info("LE Connection_complete (status=%u) type %u, %s", packet[3], addr_type, bd_addr_to_str(addr));
22892e77e513S[email protected]                     conn = hci_connection_for_bd_addr_and_type(addr, addr_type);
22909c77c9dbSMatthias Ringwald 
2291d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
229242ff5ba1SMatthias Ringwald                     // if auto-connect, remove from whitelist in both roles
229342ff5ba1SMatthias Ringwald                     if (hci_stack->le_connecting_state == LE_CONNECTING_WHITELIST){
229442ff5ba1SMatthias Ringwald                         hci_remove_from_whitelist(addr_type, addr);
229542ff5ba1SMatthias Ringwald                     }
229642ff5ba1SMatthias Ringwald                     // handle error: error is reported only to the initiator -> outgoing connection
22975909f7f2Smatthias.ringwald                     if (packet[3]){
22989c77c9dbSMatthias Ringwald 
22999c77c9dbSMatthias Ringwald                         // handle cancelled outgoing connection
23009c77c9dbSMatthias Ringwald                         // "If the cancellation was successful then, after the Command Complete event for the LE_Create_Connection_Cancel command,
23019c77c9dbSMatthias Ringwald                         //  either an LE Connection Complete or an LE Enhanced Connection Complete event shall be generated.
23029c77c9dbSMatthias Ringwald                         //  In either case, the event shall be sent with the error code Unknown Connection Identifier (0x02)."
23039c77c9dbSMatthias Ringwald                         if (packet[3] == ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER){
23049c77c9dbSMatthias Ringwald                             conn = gap_get_outgoing_connection();
23059c77c9dbSMatthias Ringwald                         }
23069c77c9dbSMatthias Ringwald 
230742ff5ba1SMatthias Ringwald                         // outgoing connection establishment is done
230842ff5ba1SMatthias Ringwald                         hci_stack->le_connecting_state = LE_CONNECTING_IDLE;
230942ff5ba1SMatthias Ringwald                         // remove entry
23105909f7f2Smatthias.ringwald                         if (conn){
2311665d90f2SMatthias Ringwald                             btstack_linked_list_remove(&hci_stack->connections, (btstack_linked_item_t *) conn);
23125909f7f2Smatthias.ringwald                             btstack_memory_hci_connection_free( conn );
23135909f7f2Smatthias.ringwald                         }
23145909f7f2Smatthias.ringwald                         break;
23155909f7f2Smatthias.ringwald                     }
2316d70217a2SMatthias Ringwald #endif
231742ff5ba1SMatthias Ringwald                     // on success, both hosts receive connection complete event
23185cf766e8SMatthias Ringwald                     if (packet[6] == HCI_ROLE_MASTER){
2319d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
232042ff5ba1SMatthias Ringwald                         // if we're master, it was an outgoing connection and we're done with it
232142ff5ba1SMatthias Ringwald                         hci_stack->le_connecting_state = LE_CONNECTING_IDLE;
2322d70217a2SMatthias Ringwald #endif
232342ff5ba1SMatthias Ringwald                     } else {
2324d70217a2SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
232542ff5ba1SMatthias Ringwald                         // if we're slave, it was an incoming connection, advertisements have stopped
2326171293d3SMatthias Ringwald                         hci_stack->le_advertisements_active = 0;
2327d70217a2SMatthias Ringwald #endif
232842ff5ba1SMatthias Ringwald                     }
2329171293d3SMatthias Ringwald                     // LE connections are auto-accepted, so just create a connection if there isn't one already
233042ff5ba1SMatthias Ringwald                     if (!conn){
233196a45072S[email protected]                         conn = create_connection_for_bd_addr_and_type(addr, addr_type);
23325909f7f2Smatthias.ringwald                     }
233342ff5ba1SMatthias Ringwald                     // no memory, sorry.
23345909f7f2Smatthias.ringwald                     if (!conn){
23355909f7f2Smatthias.ringwald                         break;
23365909f7f2Smatthias.ringwald                     }
23375909f7f2Smatthias.ringwald 
23385909f7f2Smatthias.ringwald                     conn->state = OPEN;
23395cf766e8SMatthias Ringwald                     conn->role  = packet[6];
2340f8fbdce0SMatthias Ringwald                     conn->con_handle = little_endian_read_16(packet, 4);
23415909f7f2Smatthias.ringwald 
23422b6ab3e6SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
23432b6ab3e6SMatthias Ringwald                     if (packet[6] == HCI_ROLE_SLAVE){
23442b6ab3e6SMatthias Ringwald                         hci_reenable_advertisements_if_needed();
23452b6ab3e6SMatthias Ringwald                     }
23462b6ab3e6SMatthias Ringwald #endif
23472b6ab3e6SMatthias Ringwald 
23485909f7f2Smatthias.ringwald                     // TODO: store - role, peer address type, conn_interval, conn_latency, supervision timeout, master clock
23495909f7f2Smatthias.ringwald 
23505909f7f2Smatthias.ringwald                     // restart timer
2351528a4a3bSMatthias Ringwald                     // btstack_run_loop_set_timer(&conn->timeout, HCI_CONNECTION_TIMEOUT_MS);
2352528a4a3bSMatthias Ringwald                     // btstack_run_loop_add_timer(&conn->timeout);
23535909f7f2Smatthias.ringwald 
23549da54300S[email protected]                     log_info("New connection: handle %u, %s", conn->con_handle, bd_addr_to_str(conn->address));
23555909f7f2Smatthias.ringwald 
23565909f7f2Smatthias.ringwald                     hci_emit_nr_connections_changed();
23575909f7f2Smatthias.ringwald                     break;
23585909f7f2Smatthias.ringwald 
2359f8fbdce0SMatthias Ringwald             // log_info("LE buffer size: %u, count %u", little_endian_read_16(packet,6), packet[8]);
236065a46ef3S[email protected] 
236173cd8a2aSMatthias Ringwald                 case HCI_SUBEVENT_LE_REMOTE_CONNECTION_PARAMETER_REQUEST:
236273cd8a2aSMatthias Ringwald                     // connection
236373cd8a2aSMatthias Ringwald                     handle = hci_subevent_le_remote_connection_parameter_request_get_connection_handle(packet);
236473cd8a2aSMatthias Ringwald                     conn = hci_connection_for_handle(handle);
236573cd8a2aSMatthias Ringwald                     if (conn) {
236673cd8a2aSMatthias Ringwald                         // read arguments
236773cd8a2aSMatthias Ringwald                         uint16_t le_conn_interval_min   = hci_subevent_le_remote_connection_parameter_request_get_interval_min(packet);
236873cd8a2aSMatthias Ringwald                         uint16_t le_conn_interval_max   = hci_subevent_le_remote_connection_parameter_request_get_interval_max(packet);
236973cd8a2aSMatthias Ringwald                         uint16_t le_conn_latency        = hci_subevent_le_remote_connection_parameter_request_get_latency(packet);
237073cd8a2aSMatthias Ringwald                         uint16_t le_supervision_timeout = hci_subevent_le_remote_connection_parameter_request_get_timeout(packet);
237173cd8a2aSMatthias Ringwald 
237273cd8a2aSMatthias Ringwald                         // validate against current connection parameter range
237373cd8a2aSMatthias Ringwald                         le_connection_parameter_range_t existing_range;
237473cd8a2aSMatthias Ringwald                         gap_get_connection_parameter_range(&existing_range);
237573cd8a2aSMatthias 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);
237673cd8a2aSMatthias Ringwald                         if (update_parameter){
237773cd8a2aSMatthias Ringwald                             conn->le_con_parameter_update_state = CON_PARAMETER_UPDATE_REPLY;
237873cd8a2aSMatthias Ringwald                             conn->le_conn_interval_min = le_conn_interval_min;
237973cd8a2aSMatthias Ringwald                             conn->le_conn_interval_max = le_conn_interval_max;
238073cd8a2aSMatthias Ringwald                             conn->le_conn_latency = le_conn_latency;
238173cd8a2aSMatthias Ringwald                             conn->le_supervision_timeout = le_supervision_timeout;
238273cd8a2aSMatthias Ringwald                         } else {
238373cd8a2aSMatthias Ringwald                             conn->le_con_parameter_update_state = CON_PARAMETER_UPDATE_DENY;
238473cd8a2aSMatthias Ringwald                         }
238573cd8a2aSMatthias Ringwald                     }
238673cd8a2aSMatthias Ringwald                     break;
23875909f7f2Smatthias.ringwald                 default:
23885909f7f2Smatthias.ringwald                     break;
23895909f7f2Smatthias.ringwald             }
23905909f7f2Smatthias.ringwald             break;
23915909f7f2Smatthias.ringwald #endif
23920b36101dSMatthias Ringwald         case HCI_EVENT_VENDOR_SPECIFIC:
23930b36101dSMatthias Ringwald             // Vendor specific commands often create vendor specific event instead of num completed packets
23940b36101dSMatthias Ringwald             // To avoid getting stuck as num_cmds_packets is zero, reset it to 1 for controllers with this behaviour
23950b36101dSMatthias Ringwald             switch (hci_stack->manufacturer){
23960b36101dSMatthias Ringwald                 case BLUETOOTH_COMPANY_ID_CAMBRIDGE_SILICON_RADIO:
23970b36101dSMatthias Ringwald                     hci_stack->num_cmd_packets = 1;
23980b36101dSMatthias Ringwald                     break;
23990b36101dSMatthias Ringwald                 default:
24000b36101dSMatthias Ringwald                     break;
24010b36101dSMatthias Ringwald             }
24020b36101dSMatthias Ringwald             break;
24036772a24cSmatthias.ringwald         default:
24046772a24cSmatthias.ringwald             break;
2405fe1ed1b8Smatthias.ringwald     }
2406fe1ed1b8Smatthias.ringwald 
24073429f56bSmatthias.ringwald     // handle BT initialization
24083a9fb326S[email protected]     if (hci_stack->state == HCI_STATE_INITIALIZING){
24096155b3d3S[email protected]         hci_initializing_event_handler(packet, size);
2410c9af4d3fS[email protected]     }
241122909952Smatthias.ringwald 
241289db417bSmatthias.ringwald     // help with BT sleep
24133a9fb326S[email protected]     if (hci_stack->state == HCI_STATE_FALLING_ASLEEP
241474b323a9SMatthias Ringwald         && hci_stack->substate == HCI_FALLING_ASLEEP_W4_WRITE_SCAN_ENABLE
2415073bd0faSMatthias Ringwald         && HCI_EVENT_IS_COMMAND_COMPLETE(packet, hci_write_scan_enable)){
241655975f88SMatthias Ringwald         hci_initializing_next_state();
241789db417bSmatthias.ringwald     }
241889db417bSmatthias.ringwald 
241986805605S[email protected]     // notify upper stack
2420d6b06661SMatthias Ringwald 	hci_emit_event(packet, size, 0);   // don't dump, already happened in packet handler
242194ab26f8Smatthias.ringwald 
242286805605S[email protected]     // moved here to give upper stack a chance to close down everything with hci_connection_t intact
24230e2df43fSMatthias Ringwald     if (hci_event_packet_get_type(packet) == HCI_EVENT_DISCONNECTION_COMPLETE){
242486805605S[email protected]         if (!packet[2]){
2425f8fbdce0SMatthias Ringwald             handle = little_endian_read_16(packet, 3);
242605ae8de3SMatthias Ringwald             hci_connection_t * aConn = hci_connection_for_handle(handle);
242705ae8de3SMatthias Ringwald             if (aConn) {
242805ae8de3SMatthias Ringwald                 uint8_t status = aConn->bonding_status;
242905ae8de3SMatthias Ringwald                 uint16_t flags = aConn->bonding_flags;
243086805605S[email protected]                 bd_addr_t bd_address;
243105ae8de3SMatthias Ringwald                 memcpy(&bd_address, aConn->address, 6);
243205ae8de3SMatthias Ringwald                 hci_shutdown_connection(aConn);
2433bb820044S[email protected]                 // connection struct is gone, don't access anymore
2434bb820044S[email protected]                 if (flags & BONDING_EMIT_COMPLETE_ON_DISCONNECT){
243586805605S[email protected]                     hci_emit_dedicated_bonding_result(bd_address, status);
243686805605S[email protected]                 }
243786805605S[email protected]             }
243886805605S[email protected]         }
243986805605S[email protected]     }
244086805605S[email protected] 
244194ab26f8Smatthias.ringwald 	// execute main loop
244294ab26f8Smatthias.ringwald 	hci_run();
244316833f0aSmatthias.ringwald }
244416833f0aSmatthias.ringwald 
244535454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
2446c91d150bS[email protected] static void sco_handler(uint8_t * packet, uint16_t size){
24478abbe8b5SMatthias Ringwald     if (!hci_stack->sco_packet_handler) return;
24483d50b4baSMatthias Ringwald     hci_stack->sco_packet_handler(HCI_SCO_DATA_PACKET, 0, packet, size);
24492b838201SMatthias Ringwald #ifdef ENABLE_HCI_CONTROLLER_TO_HOST_FLOW_CONTROL
24502b838201SMatthias Ringwald     hci_con_handle_t con_handle = READ_SCO_CONNECTION_HANDLE(packet);
24512b838201SMatthias Ringwald     hci_connection_t *conn      = hci_connection_for_handle(con_handle);
24522b838201SMatthias Ringwald     if (conn){
24532b838201SMatthias Ringwald         conn->num_packets_completed++;
24542b838201SMatthias Ringwald         hci_stack->host_completed_packets = 1;
24552b838201SMatthias Ringwald         hci_run();
24562b838201SMatthias Ringwald     }
24572b838201SMatthias Ringwald #endif
2458c91d150bS[email protected] }
245935454696SMatthias Ringwald #endif
2460c91d150bS[email protected] 
24610a57e69fSmatthias.ringwald static void packet_handler(uint8_t packet_type, uint8_t *packet, uint16_t size){
24625bb5bc3eS[email protected]     hci_dump_packet(packet_type, 1, packet, size);
246310e830c9Smatthias.ringwald     switch (packet_type) {
246410e830c9Smatthias.ringwald         case HCI_EVENT_PACKET:
246510e830c9Smatthias.ringwald             event_handler(packet, size);
246610e830c9Smatthias.ringwald             break;
246710e830c9Smatthias.ringwald         case HCI_ACL_DATA_PACKET:
246810e830c9Smatthias.ringwald             acl_handler(packet, size);
246910e830c9Smatthias.ringwald             break;
247035454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
2471c91d150bS[email protected]         case HCI_SCO_DATA_PACKET:
2472c91d150bS[email protected]             sco_handler(packet, size);
2473202c8a4cSMatthias Ringwald             break;
247435454696SMatthias Ringwald #endif
247510e830c9Smatthias.ringwald         default:
247610e830c9Smatthias.ringwald             break;
247710e830c9Smatthias.ringwald     }
247810e830c9Smatthias.ringwald }
247910e830c9Smatthias.ringwald 
2480d6b06661SMatthias Ringwald /**
2481d6b06661SMatthias Ringwald  * @brief Add event packet handler.
2482d6b06661SMatthias Ringwald  */
2483d6b06661SMatthias Ringwald void hci_add_event_handler(btstack_packet_callback_registration_t * callback_handler){
2484d6b06661SMatthias Ringwald     btstack_linked_list_add_tail(&hci_stack->event_handlers, (btstack_linked_item_t*) callback_handler);
2485d6b06661SMatthias Ringwald }
2486d6b06661SMatthias Ringwald 
2487d6b06661SMatthias Ringwald 
2488fcadd0caSmatthias.ringwald /** Register HCI packet handlers */
24893d50b4baSMatthias Ringwald void hci_register_acl_packet_handler(btstack_packet_handler_t handler){
2490fb37a842SMatthias Ringwald     hci_stack->acl_packet_handler = handler;
249116833f0aSmatthias.ringwald }
249216833f0aSmatthias.ringwald 
249335454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
24948abbe8b5SMatthias Ringwald /**
24958abbe8b5SMatthias Ringwald  * @brief Registers a packet handler for SCO data. Used for HSP and HFP profiles.
24968abbe8b5SMatthias Ringwald  */
24973d50b4baSMatthias Ringwald void hci_register_sco_packet_handler(btstack_packet_handler_t handler){
24988abbe8b5SMatthias Ringwald     hci_stack->sco_packet_handler = handler;
24998abbe8b5SMatthias Ringwald }
250035454696SMatthias Ringwald #endif
25018abbe8b5SMatthias Ringwald 
250271de195eSMatthias Ringwald static void hci_state_reset(void){
2503595bdbfbS[email protected]     // no connections yet
2504595bdbfbS[email protected]     hci_stack->connections = NULL;
250574308b23Smatthias.ringwald 
250674308b23Smatthias.ringwald     // keep discoverable/connectable as this has been requested by the client(s)
250774308b23Smatthias.ringwald     // hci_stack->discoverable = 0;
250874308b23Smatthias.ringwald     // hci_stack->connectable = 0;
250974308b23Smatthias.ringwald     // hci_stack->bondable = 1;
2510b95a5a35SMatthias Ringwald     // hci_stack->own_addr_type = 0;
2511595bdbfbS[email protected] 
251244935e40S[email protected]     // buffer is free
251344935e40S[email protected]     hci_stack->hci_packet_buffer_reserved = 0;
251444935e40S[email protected] 
2515595bdbfbS[email protected]     // no pending cmds
2516595bdbfbS[email protected]     hci_stack->decline_reason = 0;
2517595bdbfbS[email protected]     hci_stack->new_scan_enable_value = 0xff;
2518595bdbfbS[email protected] 
2519595bdbfbS[email protected]     // LE
2520b95a5a35SMatthias Ringwald #ifdef ENABLE_BLE
2521b95a5a35SMatthias Ringwald     memset(hci_stack->le_random_address, 0, 6);
2522b95a5a35SMatthias Ringwald     hci_stack->le_random_address_set = 0;
2523d70217a2SMatthias Ringwald #endif
2524d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
25256fab74dbSMatthias Ringwald     hci_stack->le_scanning_active  = 0;
2526e2602ea2Smatthias.ringwald     hci_stack->le_scan_type = 0xff;
2527b04dfa37SMatthias Ringwald     hci_stack->le_connecting_state = LE_CONNECTING_IDLE;
2528e83201bcSMatthias Ringwald     hci_stack->le_whitelist = 0;
2529e83201bcSMatthias Ringwald     hci_stack->le_whitelist_capacity = 0;
2530d70217a2SMatthias Ringwald #endif
2531595bdbfbS[email protected] }
2532595bdbfbS[email protected] 
253335454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
25342d5e09d6SMatthias Ringwald /**
25352d5e09d6SMatthias Ringwald  * @brief Configure Bluetooth hardware control. Has to be called before power on.
25362d5e09d6SMatthias Ringwald  */
25372d5e09d6SMatthias Ringwald void hci_set_link_key_db(btstack_link_key_db_t const * link_key_db){
25382d5e09d6SMatthias Ringwald     // store and open remote device db
25392d5e09d6SMatthias Ringwald     hci_stack->link_key_db = link_key_db;
25402d5e09d6SMatthias Ringwald     if (hci_stack->link_key_db) {
25412d5e09d6SMatthias Ringwald         hci_stack->link_key_db->open();
25422d5e09d6SMatthias Ringwald     }
25432d5e09d6SMatthias Ringwald }
254435454696SMatthias Ringwald #endif
25452d5e09d6SMatthias Ringwald 
25462d5e09d6SMatthias Ringwald void hci_init(const hci_transport_t *transport, const void *config){
2547475c8125Smatthias.ringwald 
25483a9fb326S[email protected] #ifdef HAVE_MALLOC
25493a9fb326S[email protected]     if (!hci_stack) {
25503a9fb326S[email protected]         hci_stack = (hci_stack_t*) malloc(sizeof(hci_stack_t));
25513a9fb326S[email protected]     }
25523a9fb326S[email protected] #else
25533a9fb326S[email protected]     hci_stack = &hci_stack_static;
25543a9fb326S[email protected] #endif
255566fb9560S[email protected]     memset(hci_stack, 0, sizeof(hci_stack_t));
25563a9fb326S[email protected] 
2557475c8125Smatthias.ringwald     // reference to use transport layer implementation
25583a9fb326S[email protected]     hci_stack->hci_transport = transport;
2559475c8125Smatthias.ringwald 
256011e23e5fSmatthias.ringwald     // reference to used config
25613a9fb326S[email protected]     hci_stack->config = config;
256211e23e5fSmatthias.ringwald 
256326a9b6daSMatthias Ringwald     // setup pointer for outgoing packet buffer
256426a9b6daSMatthias Ringwald     hci_stack->hci_packet_buffer = &hci_stack->hci_packet_buffer_data[HCI_OUTGOING_PRE_BUFFER_SIZE];
256526a9b6daSMatthias Ringwald 
25668fcba05dSmatthias.ringwald     // max acl payload size defined in config.h
25673a9fb326S[email protected]     hci_stack->acl_data_packet_length = HCI_ACL_PAYLOAD_SIZE;
25688fcba05dSmatthias.ringwald 
256916833f0aSmatthias.ringwald     // register packet handlers with transport
257010e830c9Smatthias.ringwald     transport->register_packet_handler(&packet_handler);
2571f5454fc6Smatthias.ringwald 
25723a9fb326S[email protected]     hci_stack->state = HCI_STATE_OFF;
2573e2386ba1S[email protected] 
2574e2386ba1S[email protected]     // class of device
25753a9fb326S[email protected]     hci_stack->class_of_device = 0x007a020c; // Smartphone
2576a45d6b9fS[email protected] 
2577f20168b8Smatthias.ringwald     // bondable by default
2578f20168b8Smatthias.ringwald     hci_stack->bondable = 1;
2579f20168b8Smatthias.ringwald 
2580e9f343c8SMatthias Ringwald #ifdef ENABLE_CLASSIC
258163168530SMatthias Ringwald     // classic name
258263168530SMatthias Ringwald     hci_stack->local_name = default_classic_name;
2583c4c88f1bSJakob Krantz 
2584c4c88f1bSJakob Krantz     // Master slave policy
2585c4c88f1bSJakob Krantz     hci_stack->master_slave_policy = 1;
2586e9f343c8SMatthias Ringwald #endif
258763168530SMatthias Ringwald 
258863048403S[email protected]     // Secure Simple Pairing default: enable, no I/O capabilities, general bonding, mitm not required, auto accept
25893a9fb326S[email protected]     hci_stack->ssp_enable = 1;
25903a9fb326S[email protected]     hci_stack->ssp_io_capability = SSP_IO_CAPABILITY_NO_INPUT_NO_OUTPUT;
25913a9fb326S[email protected]     hci_stack->ssp_authentication_requirement = SSP_IO_AUTHREQ_MITM_PROTECTION_NOT_REQUIRED_GENERAL_BONDING;
25923a9fb326S[email protected]     hci_stack->ssp_auto_accept = 1;
259369a97523S[email protected] 
2594fac2e2feSMatthias Ringwald     // voice setting - signed 16 bit pcm data with CVSD over the air
2595fac2e2feSMatthias Ringwald     hci_stack->sco_voice_setting = 0x60;
2596d950d659SMatthias Ringwald 
2597831711daSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
2598831711daSMatthias Ringwald     // connection parameter to use for outgoing connections
2599cbe54ab2SJakob Krantz     hci_stack->le_connection_scan_interval = 0x0060;   // 60ms
2600cbe54ab2SJakob Krantz     hci_stack->le_connection_scan_window  = 0x0030;    // 30ms
2601831711daSMatthias Ringwald     hci_stack->le_connection_interval_min = 0x0008;    // 10 ms
2602831711daSMatthias Ringwald     hci_stack->le_connection_interval_max = 0x0018;    // 30 ms
2603831711daSMatthias Ringwald     hci_stack->le_connection_latency      = 4;         // 4
2604831711daSMatthias Ringwald     hci_stack->le_supervision_timeout     = 0x0048;    // 720 ms
2605831711daSMatthias Ringwald     hci_stack->le_minimum_ce_length       = 2;         // 1.25 ms
2606831711daSMatthias Ringwald     hci_stack->le_maximum_ce_length       = 0x0030;    // 30 ms
2607831711daSMatthias Ringwald #endif
2608831711daSMatthias Ringwald 
26092b6ab3e6SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
26102b6ab3e6SMatthias Ringwald     hci_stack->le_max_number_peripheral_connections = 1; // only single connection as peripheral
26112b6ab3e6SMatthias Ringwald #endif
26122b6ab3e6SMatthias Ringwald 
2613831711daSMatthias Ringwald     // connection parameter range used to answer connection parameter update requests in l2cap
2614831711daSMatthias Ringwald     hci_stack->le_connection_parameter_range.le_conn_interval_min =          6;
2615831711daSMatthias Ringwald     hci_stack->le_connection_parameter_range.le_conn_interval_max =       3200;
2616831711daSMatthias Ringwald     hci_stack->le_connection_parameter_range.le_conn_latency_min =           0;
2617831711daSMatthias Ringwald     hci_stack->le_connection_parameter_range.le_conn_latency_max =         500;
2618831711daSMatthias Ringwald     hci_stack->le_connection_parameter_range.le_supervision_timeout_min =   10;
2619831711daSMatthias Ringwald     hci_stack->le_connection_parameter_range.le_supervision_timeout_max = 3200;
2620831711daSMatthias Ringwald 
2621595bdbfbS[email protected]     hci_state_reset();
2622475c8125Smatthias.ringwald }
2623475c8125Smatthias.ringwald 
26243fb36a29SMatthias Ringwald /**
26253fb36a29SMatthias Ringwald  * @brief Configure Bluetooth chipset driver. Has to be called before power on, or right after receiving the local version information
26263fb36a29SMatthias Ringwald  */
26273fb36a29SMatthias Ringwald void hci_set_chipset(const btstack_chipset_t *chipset_driver){
26283fb36a29SMatthias Ringwald     hci_stack->chipset = chipset_driver;
26293fb36a29SMatthias Ringwald 
26303fb36a29SMatthias Ringwald     // reset chipset driver - init is also called on power_up
26313fb36a29SMatthias Ringwald     if (hci_stack->chipset && hci_stack->chipset->init){
26323fb36a29SMatthias Ringwald         hci_stack->chipset->init(hci_stack->config);
26333fb36a29SMatthias Ringwald     }
26343fb36a29SMatthias Ringwald }
26353fb36a29SMatthias Ringwald 
2636fb55bd0aSMatthias Ringwald /**
2637d0b87befSMatthias Ringwald  * @brief Configure Bluetooth hardware control. Has to be called after hci_init() but before power on.
2638fb55bd0aSMatthias Ringwald  */
2639fb55bd0aSMatthias Ringwald void hci_set_control(const btstack_control_t *hardware_control){
2640fb55bd0aSMatthias Ringwald     // references to used control implementation
2641fb55bd0aSMatthias Ringwald     hci_stack->control = hardware_control;
2642d0b87befSMatthias Ringwald     // init with transport config
2643d0b87befSMatthias Ringwald     hardware_control->init(hci_stack->config);
2644fb55bd0aSMatthias Ringwald }
2645fb55bd0aSMatthias Ringwald 
264671de195eSMatthias Ringwald void hci_close(void){
2647404843c1Smatthias.ringwald     // close remote device db
2648a98592bcSMatthias Ringwald     if (hci_stack->link_key_db) {
2649a98592bcSMatthias Ringwald         hci_stack->link_key_db->close();
2650404843c1Smatthias.ringwald     }
26517224be7eSMatthias Ringwald 
26527224be7eSMatthias Ringwald     btstack_linked_list_iterator_t lit;
26537224be7eSMatthias Ringwald     btstack_linked_list_iterator_init(&lit, &hci_stack->connections);
26547224be7eSMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&lit)){
26557224be7eSMatthias Ringwald         // cancel all l2cap connections by emitting dicsconnection complete before shutdown (free) connection
26567224be7eSMatthias Ringwald         hci_connection_t * connection = (hci_connection_t*) btstack_linked_list_iterator_next(&lit);
26577224be7eSMatthias Ringwald         hci_emit_disconnection_complete(connection->con_handle, 0x16); // terminated by local host
26587224be7eSMatthias Ringwald         hci_shutdown_connection(connection);
2659f5454fc6Smatthias.ringwald     }
26607224be7eSMatthias Ringwald 
2661f5454fc6Smatthias.ringwald     hci_power_control(HCI_POWER_OFF);
26623a9fb326S[email protected] 
26633a9fb326S[email protected] #ifdef HAVE_MALLOC
26643a9fb326S[email protected]     free(hci_stack);
26653a9fb326S[email protected] #endif
26663a9fb326S[email protected]     hci_stack = NULL;
2667404843c1Smatthias.ringwald }
2668404843c1Smatthias.ringwald 
266935454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
267060b9e82fSMatthias Ringwald void gap_set_class_of_device(uint32_t class_of_device){
26719e61646fS[email protected]     hci_stack->class_of_device = class_of_device;
26729e61646fS[email protected] }
267376f27cffSMatthias Ringwald 
267476f27cffSMatthias Ringwald void hci_disable_l2cap_timeout_check(void){
267576f27cffSMatthias Ringwald     disable_l2cap_timeouts = 1;
267676f27cffSMatthias Ringwald }
267735454696SMatthias Ringwald #endif
26789e61646fS[email protected] 
267976f27cffSMatthias Ringwald #if !defined(HAVE_PLATFORM_IPHONE_OS) && !defined (HAVE_HOST_CONTROLLER_API)
2680f456b2d0S[email protected] // Set Public BD ADDR - passed on to Bluetooth chipset if supported in bt_control_h
2681f456b2d0S[email protected] void hci_set_bd_addr(bd_addr_t addr){
2682f456b2d0S[email protected]     memcpy(hci_stack->custom_bd_addr, addr, 6);
2683f456b2d0S[email protected]     hci_stack->custom_bd_addr_set = 1;
2684f456b2d0S[email protected] }
268576f27cffSMatthias Ringwald #endif
2686f456b2d0S[email protected] 
26878d213e1aSmatthias.ringwald // State-Module-Driver overview
26888d213e1aSmatthias.ringwald // state                    module  low-level
26898d213e1aSmatthias.ringwald // HCI_STATE_OFF             off      close
26908d213e1aSmatthias.ringwald // HCI_STATE_INITIALIZING,   on       open
26918d213e1aSmatthias.ringwald // HCI_STATE_WORKING,        on       open
26928d213e1aSmatthias.ringwald // HCI_STATE_HALTING,        on       open
2693d661ed19Smatthias.ringwald // HCI_STATE_SLEEPING,    off/sleep   close
2694d661ed19Smatthias.ringwald // HCI_STATE_FALLING_ASLEEP  on       open
2695c7e0c5f6Smatthias.ringwald 
269640d1c7a4Smatthias.ringwald static int hci_power_control_on(void){
26977301ad89Smatthias.ringwald 
2698038bc64cSmatthias.ringwald     // power on
2699f9a30166Smatthias.ringwald     int err = 0;
27003a9fb326S[email protected]     if (hci_stack->control && hci_stack->control->on){
2701d0b87befSMatthias Ringwald         err = (*hci_stack->control->on)();
2702f9a30166Smatthias.ringwald     }
2703038bc64cSmatthias.ringwald     if (err){
27049da54300S[email protected]         log_error( "POWER_ON failed");
2705038bc64cSmatthias.ringwald         hci_emit_hci_open_failed();
2706038bc64cSmatthias.ringwald         return err;
2707038bc64cSmatthias.ringwald     }
2708038bc64cSmatthias.ringwald 
270924b3c629SMatthias Ringwald     // int chipset driver
27103fb36a29SMatthias Ringwald     if (hci_stack->chipset && hci_stack->chipset->init){
27113fb36a29SMatthias Ringwald         hci_stack->chipset->init(hci_stack->config);
27123fb36a29SMatthias Ringwald     }
27133fb36a29SMatthias Ringwald 
271424b3c629SMatthias Ringwald     // init transport
271524b3c629SMatthias Ringwald     if (hci_stack->hci_transport->init){
271624b3c629SMatthias Ringwald         hci_stack->hci_transport->init(hci_stack->config);
271724b3c629SMatthias Ringwald     }
271824b3c629SMatthias Ringwald 
271924b3c629SMatthias Ringwald     // open transport
272024b3c629SMatthias Ringwald     err = hci_stack->hci_transport->open();
2721038bc64cSmatthias.ringwald     if (err){
27229da54300S[email protected]         log_error( "HCI_INIT failed, turning Bluetooth off again");
27233a9fb326S[email protected]         if (hci_stack->control && hci_stack->control->off){
2724d0b87befSMatthias Ringwald             (*hci_stack->control->off)();
2725f9a30166Smatthias.ringwald         }
2726038bc64cSmatthias.ringwald         hci_emit_hci_open_failed();
2727038bc64cSmatthias.ringwald         return err;
2728038bc64cSmatthias.ringwald     }
27298d213e1aSmatthias.ringwald     return 0;
27308d213e1aSmatthias.ringwald }
2731038bc64cSmatthias.ringwald 
273240d1c7a4Smatthias.ringwald static void hci_power_control_off(void){
27338d213e1aSmatthias.ringwald 
27349da54300S[email protected]     log_info("hci_power_control_off");
27359418f9c9Smatthias.ringwald 
27368d213e1aSmatthias.ringwald     // close low-level device
273724b3c629SMatthias Ringwald     hci_stack->hci_transport->close();
27388d213e1aSmatthias.ringwald 
27399da54300S[email protected]     log_info("hci_power_control_off - hci_transport closed");
27409418f9c9Smatthias.ringwald 
27418d213e1aSmatthias.ringwald     // power off
27423a9fb326S[email protected]     if (hci_stack->control && hci_stack->control->off){
2743d0b87befSMatthias Ringwald         (*hci_stack->control->off)();
27448d213e1aSmatthias.ringwald     }
27459418f9c9Smatthias.ringwald 
27469da54300S[email protected]     log_info("hci_power_control_off - control closed");
27479418f9c9Smatthias.ringwald 
27483a9fb326S[email protected]     hci_stack->state = HCI_STATE_OFF;
274972ea5239Smatthias.ringwald }
275072ea5239Smatthias.ringwald 
275140d1c7a4Smatthias.ringwald static void hci_power_control_sleep(void){
275272ea5239Smatthias.ringwald 
27539da54300S[email protected]     log_info("hci_power_control_sleep");
27543144bce4Smatthias.ringwald 
2755b429b9b7Smatthias.ringwald #if 0
2756b429b9b7Smatthias.ringwald     // don't close serial port during sleep
2757b429b9b7Smatthias.ringwald 
275872ea5239Smatthias.ringwald     // close low-level device
27593a9fb326S[email protected]     hci_stack->hci_transport->close(hci_stack->config);
2760b429b9b7Smatthias.ringwald #endif
276172ea5239Smatthias.ringwald 
276272ea5239Smatthias.ringwald     // sleep mode
27633a9fb326S[email protected]     if (hci_stack->control && hci_stack->control->sleep){
2764d0b87befSMatthias Ringwald         (*hci_stack->control->sleep)();
276572ea5239Smatthias.ringwald     }
2766b429b9b7Smatthias.ringwald 
27673a9fb326S[email protected]     hci_stack->state = HCI_STATE_SLEEPING;
27688d213e1aSmatthias.ringwald }
27698d213e1aSmatthias.ringwald 
277040d1c7a4Smatthias.ringwald static int hci_power_control_wake(void){
2771b429b9b7Smatthias.ringwald 
27729da54300S[email protected]     log_info("hci_power_control_wake");
2773b429b9b7Smatthias.ringwald 
2774b429b9b7Smatthias.ringwald     // wake on
27753a9fb326S[email protected]     if (hci_stack->control && hci_stack->control->wake){
2776d0b87befSMatthias Ringwald         (*hci_stack->control->wake)();
2777b429b9b7Smatthias.ringwald     }
2778b429b9b7Smatthias.ringwald 
2779b429b9b7Smatthias.ringwald #if 0
2780b429b9b7Smatthias.ringwald     // open low-level device
27813a9fb326S[email protected]     int err = hci_stack->hci_transport->open(hci_stack->config);
2782b429b9b7Smatthias.ringwald     if (err){
27839da54300S[email protected]         log_error( "HCI_INIT failed, turning Bluetooth off again");
27843a9fb326S[email protected]         if (hci_stack->control && hci_stack->control->off){
2785d0b87befSMatthias Ringwald             (*hci_stack->control->off)();
2786b429b9b7Smatthias.ringwald         }
2787b429b9b7Smatthias.ringwald         hci_emit_hci_open_failed();
2788b429b9b7Smatthias.ringwald         return err;
2789b429b9b7Smatthias.ringwald     }
2790b429b9b7Smatthias.ringwald #endif
2791b429b9b7Smatthias.ringwald 
2792b429b9b7Smatthias.ringwald     return 0;
2793b429b9b7Smatthias.ringwald }
2794b429b9b7Smatthias.ringwald 
279544935e40S[email protected] static void hci_power_transition_to_initializing(void){
279644935e40S[email protected]     // set up state machine
279744935e40S[email protected]     hci_stack->num_cmd_packets = 1; // assume that one cmd can be sent
279844935e40S[email protected]     hci_stack->hci_packet_buffer_reserved = 0;
279944935e40S[email protected]     hci_stack->state = HCI_STATE_INITIALIZING;
28005c363727SMatthias Ringwald     hci_stack->substate = HCI_INIT_SEND_RESET;
280144935e40S[email protected] }
2802b429b9b7Smatthias.ringwald 
28038d213e1aSmatthias.ringwald int hci_power_control(HCI_POWER_MODE power_mode){
2804d661ed19Smatthias.ringwald 
2805f04a0c31SMatthias Ringwald     log_info("hci_power_control: %d, current mode %u", power_mode, hci_stack->state);
2806d661ed19Smatthias.ringwald 
28078d213e1aSmatthias.ringwald     int err = 0;
28083a9fb326S[email protected]     switch (hci_stack->state){
28098d213e1aSmatthias.ringwald 
28108d213e1aSmatthias.ringwald         case HCI_STATE_OFF:
28118d213e1aSmatthias.ringwald             switch (power_mode){
28128d213e1aSmatthias.ringwald                 case HCI_POWER_ON:
28138d213e1aSmatthias.ringwald                     err = hci_power_control_on();
281497b61c7bS[email protected]                     if (err) {
2815f04a0c31SMatthias Ringwald                         log_error("hci_power_control_on() error %d", err);
281697b61c7bS[email protected]                         return err;
281797b61c7bS[email protected]                     }
281844935e40S[email protected]                     hci_power_transition_to_initializing();
28198d213e1aSmatthias.ringwald                     break;
28208d213e1aSmatthias.ringwald                 case HCI_POWER_OFF:
28218d213e1aSmatthias.ringwald                     // do nothing
28228d213e1aSmatthias.ringwald                     break;
28238d213e1aSmatthias.ringwald                 case HCI_POWER_SLEEP:
2824b546ac54Smatthias.ringwald                     // do nothing (with SLEEP == OFF)
28258d213e1aSmatthias.ringwald                     break;
28268d213e1aSmatthias.ringwald             }
28278d213e1aSmatthias.ringwald             break;
28287301ad89Smatthias.ringwald 
28298d213e1aSmatthias.ringwald         case HCI_STATE_INITIALIZING:
28308d213e1aSmatthias.ringwald             switch (power_mode){
28318d213e1aSmatthias.ringwald                 case HCI_POWER_ON:
28328d213e1aSmatthias.ringwald                     // do nothing
28338d213e1aSmatthias.ringwald                     break;
28348d213e1aSmatthias.ringwald                 case HCI_POWER_OFF:
28358d213e1aSmatthias.ringwald                     // no connections yet, just turn it off
28368d213e1aSmatthias.ringwald                     hci_power_control_off();
28378d213e1aSmatthias.ringwald                     break;
28388d213e1aSmatthias.ringwald                 case HCI_POWER_SLEEP:
2839b546ac54Smatthias.ringwald                     // no connections yet, just turn it off
284072ea5239Smatthias.ringwald                     hci_power_control_sleep();
28418d213e1aSmatthias.ringwald                     break;
28428d213e1aSmatthias.ringwald             }
28438d213e1aSmatthias.ringwald             break;
28447301ad89Smatthias.ringwald 
28458d213e1aSmatthias.ringwald         case HCI_STATE_WORKING:
28468d213e1aSmatthias.ringwald             switch (power_mode){
28478d213e1aSmatthias.ringwald                 case HCI_POWER_ON:
28488d213e1aSmatthias.ringwald                     // do nothing
28498d213e1aSmatthias.ringwald                     break;
28508d213e1aSmatthias.ringwald                 case HCI_POWER_OFF:
2851c7e0c5f6Smatthias.ringwald                     // see hci_run
28523a9fb326S[email protected]                     hci_stack->state = HCI_STATE_HALTING;
28538d213e1aSmatthias.ringwald                     break;
28548d213e1aSmatthias.ringwald                 case HCI_POWER_SLEEP:
2855b546ac54Smatthias.ringwald                     // see hci_run
28563a9fb326S[email protected]                     hci_stack->state = HCI_STATE_FALLING_ASLEEP;
285774b323a9SMatthias Ringwald                     hci_stack->substate = HCI_FALLING_ASLEEP_DISCONNECT;
28588d213e1aSmatthias.ringwald                     break;
28598d213e1aSmatthias.ringwald             }
28608d213e1aSmatthias.ringwald             break;
28617301ad89Smatthias.ringwald 
28628d213e1aSmatthias.ringwald         case HCI_STATE_HALTING:
28638d213e1aSmatthias.ringwald             switch (power_mode){
28648d213e1aSmatthias.ringwald                 case HCI_POWER_ON:
286544935e40S[email protected]                     hci_power_transition_to_initializing();
28668d213e1aSmatthias.ringwald                     break;
28678d213e1aSmatthias.ringwald                 case HCI_POWER_OFF:
28688d213e1aSmatthias.ringwald                     // do nothing
28698d213e1aSmatthias.ringwald                     break;
28708d213e1aSmatthias.ringwald                 case HCI_POWER_SLEEP:
2871b546ac54Smatthias.ringwald                     // see hci_run
28723a9fb326S[email protected]                     hci_stack->state = HCI_STATE_FALLING_ASLEEP;
287374b323a9SMatthias Ringwald                     hci_stack->substate = HCI_FALLING_ASLEEP_DISCONNECT;
28748d213e1aSmatthias.ringwald                     break;
28758d213e1aSmatthias.ringwald             }
28768d213e1aSmatthias.ringwald             break;
28778d213e1aSmatthias.ringwald 
28788d213e1aSmatthias.ringwald         case HCI_STATE_FALLING_ASLEEP:
28798d213e1aSmatthias.ringwald             switch (power_mode){
28808d213e1aSmatthias.ringwald                 case HCI_POWER_ON:
288128171530Smatthias.ringwald 
2882423a3e49SMatthias Ringwald #ifdef HAVE_PLATFORM_IPHONE_OS
288328171530Smatthias.ringwald                     // nothing to do, if H4 supports power management
2884d0b87befSMatthias Ringwald                     if (btstack_control_iphone_power_management_enabled()){
28853a9fb326S[email protected]                         hci_stack->state = HCI_STATE_INITIALIZING;
288674b323a9SMatthias Ringwald                         hci_stack->substate = HCI_INIT_WRITE_SCAN_ENABLE;   // init after sleep
288728171530Smatthias.ringwald                         break;
288828171530Smatthias.ringwald                     }
288928171530Smatthias.ringwald #endif
289044935e40S[email protected]                     hci_power_transition_to_initializing();
28918d213e1aSmatthias.ringwald                     break;
28928d213e1aSmatthias.ringwald                 case HCI_POWER_OFF:
2893b546ac54Smatthias.ringwald                     // see hci_run
28943a9fb326S[email protected]                     hci_stack->state = HCI_STATE_HALTING;
28958d213e1aSmatthias.ringwald                     break;
28968d213e1aSmatthias.ringwald                 case HCI_POWER_SLEEP:
2897b546ac54Smatthias.ringwald                     // do nothing
28988d213e1aSmatthias.ringwald                     break;
28998d213e1aSmatthias.ringwald             }
29008d213e1aSmatthias.ringwald             break;
29018d213e1aSmatthias.ringwald 
29028d213e1aSmatthias.ringwald         case HCI_STATE_SLEEPING:
29038d213e1aSmatthias.ringwald             switch (power_mode){
29048d213e1aSmatthias.ringwald                 case HCI_POWER_ON:
290528171530Smatthias.ringwald 
2906423a3e49SMatthias Ringwald #ifdef HAVE_PLATFORM_IPHONE_OS
290728171530Smatthias.ringwald                     // nothing to do, if H4 supports power management
2908d0b87befSMatthias Ringwald                     if (btstack_control_iphone_power_management_enabled()){
29093a9fb326S[email protected]                         hci_stack->state = HCI_STATE_INITIALIZING;
29105c363727SMatthias Ringwald                         hci_stack->substate = HCI_INIT_AFTER_SLEEP;
2911758b46ceSmatthias.ringwald                         hci_update_scan_enable();
291228171530Smatthias.ringwald                         break;
291328171530Smatthias.ringwald                     }
291428171530Smatthias.ringwald #endif
29153144bce4Smatthias.ringwald                     err = hci_power_control_wake();
29163144bce4Smatthias.ringwald                     if (err) return err;
291744935e40S[email protected]                     hci_power_transition_to_initializing();
29188d213e1aSmatthias.ringwald                     break;
29198d213e1aSmatthias.ringwald                 case HCI_POWER_OFF:
29203a9fb326S[email protected]                     hci_stack->state = HCI_STATE_HALTING;
29218d213e1aSmatthias.ringwald                     break;
29228d213e1aSmatthias.ringwald                 case HCI_POWER_SLEEP:
2923b546ac54Smatthias.ringwald                     // do nothing
29248d213e1aSmatthias.ringwald                     break;
29258d213e1aSmatthias.ringwald             }
29268d213e1aSmatthias.ringwald             break;
292711e23e5fSmatthias.ringwald     }
292868d92d03Smatthias.ringwald 
2929038bc64cSmatthias.ringwald     // create internal event
2930ee8bf225Smatthias.ringwald 	hci_emit_state();
2931ee8bf225Smatthias.ringwald 
293268d92d03Smatthias.ringwald 	// trigger next/first action
293368d92d03Smatthias.ringwald 	hci_run();
293468d92d03Smatthias.ringwald 
2935475c8125Smatthias.ringwald     return 0;
2936475c8125Smatthias.ringwald }
2937475c8125Smatthias.ringwald 
293835454696SMatthias Ringwald 
293935454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
294035454696SMatthias Ringwald 
2941758b46ceSmatthias.ringwald static void hci_update_scan_enable(void){
2942758b46ceSmatthias.ringwald     // 2 = page scan, 1 = inq scan
29433a9fb326S[email protected]     hci_stack->new_scan_enable_value  = hci_stack->connectable << 1 | hci_stack->discoverable;
2944758b46ceSmatthias.ringwald     hci_run();
2945758b46ceSmatthias.ringwald }
2946758b46ceSmatthias.ringwald 
294715a95bd5SMatthias Ringwald void gap_discoverable_control(uint8_t enable){
2948381fbed8Smatthias.ringwald     if (enable) enable = 1; // normalize argument
2949381fbed8Smatthias.ringwald 
29503a9fb326S[email protected]     if (hci_stack->discoverable == enable){
29513a9fb326S[email protected]         hci_emit_discoverable_enabled(hci_stack->discoverable);
2952381fbed8Smatthias.ringwald         return;
2953381fbed8Smatthias.ringwald     }
2954381fbed8Smatthias.ringwald 
29553a9fb326S[email protected]     hci_stack->discoverable = enable;
2956758b46ceSmatthias.ringwald     hci_update_scan_enable();
2957758b46ceSmatthias.ringwald }
2958b031bebbSmatthias.ringwald 
295915a95bd5SMatthias Ringwald void gap_connectable_control(uint8_t enable){
2960758b46ceSmatthias.ringwald     if (enable) enable = 1; // normalize argument
2961758b46ceSmatthias.ringwald 
2962758b46ceSmatthias.ringwald     // don't emit event
29633a9fb326S[email protected]     if (hci_stack->connectable == enable) return;
2964758b46ceSmatthias.ringwald 
29653a9fb326S[email protected]     hci_stack->connectable = enable;
2966758b46ceSmatthias.ringwald     hci_update_scan_enable();
2967381fbed8Smatthias.ringwald }
296835454696SMatthias Ringwald #endif
2969381fbed8Smatthias.ringwald 
297015a95bd5SMatthias Ringwald void gap_local_bd_addr(bd_addr_t address_buffer){
2971690bd0baS[email protected]     memcpy(address_buffer, hci_stack->local_bd_addr, 6);
29725061f3afS[email protected] }
29735061f3afS[email protected] 
29742b838201SMatthias Ringwald #ifdef ENABLE_HCI_CONTROLLER_TO_HOST_FLOW_CONTROL
29752b838201SMatthias Ringwald static void hci_host_num_completed_packets(void){
29762b838201SMatthias Ringwald 
29772b838201SMatthias Ringwald     // create packet manually as arrays are not supported and num_commands should not get reduced
29782b838201SMatthias Ringwald     hci_reserve_packet_buffer();
29792b838201SMatthias Ringwald     uint8_t * packet = hci_get_outgoing_packet_buffer();
29802b838201SMatthias Ringwald 
29812b838201SMatthias Ringwald     uint16_t size = 0;
29822b838201SMatthias Ringwald     uint16_t num_handles = 0;
29832b838201SMatthias Ringwald     packet[size++] = 0x35;
29842b838201SMatthias Ringwald     packet[size++] = 0x0c;
29852b838201SMatthias Ringwald     size++;  // skip param len
29862b838201SMatthias Ringwald     size++;  // skip num handles
29872b838201SMatthias Ringwald 
29882b838201SMatthias Ringwald     // add { handle, packets } entries
29892b838201SMatthias Ringwald     btstack_linked_item_t * it;
29902b838201SMatthias Ringwald     for (it = (btstack_linked_item_t *) hci_stack->connections; it ; it = it->next){
29912b838201SMatthias Ringwald         hci_connection_t * connection = (hci_connection_t *) it;
29922b838201SMatthias Ringwald         if (connection->num_packets_completed){
29932b838201SMatthias Ringwald             little_endian_store_16(packet, size, connection->con_handle);
29942b838201SMatthias Ringwald             size += 2;
29952b838201SMatthias Ringwald             little_endian_store_16(packet, size, connection->num_packets_completed);
29962b838201SMatthias Ringwald             size += 2;
29972b838201SMatthias Ringwald             //
29982b838201SMatthias Ringwald             num_handles++;
29992b838201SMatthias Ringwald             connection->num_packets_completed = 0;
30002b838201SMatthias Ringwald         }
30012b838201SMatthias Ringwald     }
30022b838201SMatthias Ringwald 
30032b838201SMatthias Ringwald     packet[2] = size - 3;
30042b838201SMatthias Ringwald     packet[3] = num_handles;
30052b838201SMatthias Ringwald 
30062b838201SMatthias Ringwald     hci_stack->host_completed_packets = 0;
30072b838201SMatthias Ringwald 
30082b838201SMatthias Ringwald     hci_dump_packet(HCI_COMMAND_DATA_PACKET, 0, packet, size);
30092b838201SMatthias Ringwald     hci_stack->hci_transport->send_packet(HCI_COMMAND_DATA_PACKET, packet, size);
30102b838201SMatthias Ringwald 
30112b838201SMatthias Ringwald     // release packet buffer for synchronous transport implementations
30122b838201SMatthias Ringwald     if (hci_transport_synchronous()){
3013e2d22487SMatthias Ringwald         hci_release_packet_buffer();
3014068b8592SMatthias Ringwald         hci_emit_transport_packet_sent();
30152b838201SMatthias Ringwald     }
30162b838201SMatthias Ringwald }
30172b838201SMatthias Ringwald #endif
30182b838201SMatthias Ringwald 
301995d71764SMatthias Ringwald static void hci_run(void){
30208a485f27Smatthias.ringwald 
3021db8bc6ffSMatthias Ringwald     // log_info("hci_run: entered");
3022665d90f2SMatthias Ringwald     btstack_linked_item_t * it;
302332ab9390Smatthias.ringwald 
3024b5d8b22bS[email protected]     // send continuation fragments first, as they block the prepared packet buffer
3025b5d8b22bS[email protected]     if (hci_stack->acl_fragmentation_total_size > 0) {
3026b5d8b22bS[email protected]         hci_con_handle_t con_handle = READ_ACL_CONNECTION_HANDLE(hci_stack->hci_packet_buffer);
3027b5d8b22bS[email protected]         hci_connection_t *connection = hci_connection_for_handle(con_handle);
3028b5d8b22bS[email protected]         if (connection) {
302928a0332dSMatthias Ringwald             if (hci_can_send_prepared_acl_packet_now(con_handle)){
3030b5d8b22bS[email protected]                 hci_send_acl_packet_fragments(connection);
3031b5d8b22bS[email protected]                 return;
3032b5d8b22bS[email protected]             }
303328a0332dSMatthias Ringwald         } else {
3034b5d8b22bS[email protected]             // connection gone -> discard further fragments
303528a0332dSMatthias Ringwald             log_info("hci_run: fragmented ACL packet no connection -> discard fragment");
3036b5d8b22bS[email protected]             hci_stack->acl_fragmentation_total_size = 0;
3037b5d8b22bS[email protected]             hci_stack->acl_fragmentation_pos = 0;
3038b5d8b22bS[email protected]         }
3039b5d8b22bS[email protected]     }
3040b5d8b22bS[email protected] 
30412b838201SMatthias Ringwald #ifdef ENABLE_HCI_CONTROLLER_TO_HOST_FLOW_CONTROL
30422b838201SMatthias Ringwald     // send host num completed packets next as they don't require num_cmd_packets > 0
30432b838201SMatthias Ringwald     if (!hci_can_send_comand_packet_transport()) return;
30442b838201SMatthias Ringwald     if (hci_stack->host_completed_packets){
30452b838201SMatthias Ringwald         hci_host_num_completed_packets();
30462b838201SMatthias Ringwald         return;
30472b838201SMatthias Ringwald     }
30482b838201SMatthias Ringwald #endif
30492b838201SMatthias Ringwald 
3050d94d3cafS[email protected]     if (!hci_can_send_command_packet_now()) return;
3051ce4c8fabSmatthias.ringwald 
3052b031bebbSmatthias.ringwald     // global/non-connection oriented commands
3053b031bebbSmatthias.ringwald 
305435454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
3055b031bebbSmatthias.ringwald     // decline incoming connections
30563a9fb326S[email protected]     if (hci_stack->decline_reason){
30573a9fb326S[email protected]         uint8_t reason = hci_stack->decline_reason;
30583a9fb326S[email protected]         hci_stack->decline_reason = 0;
30593a9fb326S[email protected]         hci_send_cmd(&hci_reject_connection_request, hci_stack->decline_addr, reason);
3060dbe1a790S[email protected]         return;
3061ce4c8fabSmatthias.ringwald     }
3062b031bebbSmatthias.ringwald     // send scan enable
30633a9fb326S[email protected]     if (hci_stack->state == HCI_STATE_WORKING && hci_stack->new_scan_enable_value != 0xff && hci_classic_supported()){
30643a9fb326S[email protected]         hci_send_cmd(&hci_write_scan_enable, hci_stack->new_scan_enable_value);
30653a9fb326S[email protected]         hci_stack->new_scan_enable_value = 0xff;
3066dbe1a790S[email protected]         return;
3067b031bebbSmatthias.ringwald     }
3068f5875de5SMatthias Ringwald     // start/stop inquiry
3069f5875de5SMatthias Ringwald     if (hci_stack->inquiry_state >= GAP_INQUIRY_DURATION_MIN && hci_stack->inquiry_state <= GAP_INQUIRY_DURATION_MAX){
3070f5875de5SMatthias Ringwald         uint8_t duration = hci_stack->inquiry_state;
3071f5875de5SMatthias Ringwald         hci_stack->inquiry_state = GAP_INQUIRY_STATE_ACTIVE;
3072f5875de5SMatthias Ringwald         hci_send_cmd(&hci_inquiry, HCI_INQUIRY_LAP, duration, 0);
3073f5875de5SMatthias Ringwald         return;
3074f5875de5SMatthias Ringwald     }
3075f5875de5SMatthias Ringwald     if (hci_stack->inquiry_state == GAP_INQUIRY_STATE_W2_CANCEL){
3076f5875de5SMatthias Ringwald         hci_stack->inquiry_state = GAP_INQUIRY_STATE_W4_CANCELLED;
3077f5875de5SMatthias Ringwald         hci_send_cmd(&hci_inquiry_cancel);
3078f5875de5SMatthias Ringwald         return;
3079f5875de5SMatthias Ringwald     }
3080b7f1ee76SMatthias Ringwald     // remote name request
3081b7f1ee76SMatthias Ringwald     if (hci_stack->remote_name_state == GAP_REMOTE_NAME_STATE_W2_SEND){
3082b7f1ee76SMatthias Ringwald         hci_stack->remote_name_state = GAP_REMOTE_NAME_STATE_W4_COMPLETE;
3083b7f1ee76SMatthias Ringwald         hci_send_cmd(&hci_remote_name_request, hci_stack->remote_name_addr,
3084ee8a36c8SMatthias Ringwald             hci_stack->remote_name_page_scan_repetition_mode, 0, hci_stack->remote_name_clock_offset);
30850e55bd69SMatthias Ringwald         return;
3086b7f1ee76SMatthias Ringwald     }
30870a51f88bSMatthias Ringwald     // pairing
30880a51f88bSMatthias Ringwald     if (hci_stack->gap_pairing_state != GAP_PAIRING_STATE_IDLE){
30890a51f88bSMatthias Ringwald         uint8_t state = hci_stack->gap_pairing_state;
30900a51f88bSMatthias Ringwald         hci_stack->gap_pairing_state = GAP_PAIRING_STATE_IDLE;
30910a51f88bSMatthias Ringwald         switch (state){
30920a51f88bSMatthias Ringwald             case GAP_PAIRING_STATE_SEND_PIN:
3093d504181aSMatthias 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);
30940a51f88bSMatthias Ringwald                 break;
30950a51f88bSMatthias Ringwald             case GAP_PAIRING_STATE_SEND_PIN_NEGATIVE:
30960a51f88bSMatthias Ringwald                 hci_send_cmd(&hci_pin_code_request_negative_reply, hci_stack->gap_pairing_addr);
30970a51f88bSMatthias Ringwald                 break;
30980a51f88bSMatthias Ringwald             case GAP_PAIRING_STATE_SEND_PASSKEY:
3099d504181aSMatthias Ringwald                 hci_send_cmd(&hci_user_passkey_request_reply, hci_stack->gap_pairing_addr, hci_stack->gap_pairing_input.gap_pairing_passkey);
31000a51f88bSMatthias Ringwald                 break;
31010a51f88bSMatthias Ringwald             case GAP_PAIRING_STATE_SEND_PASSKEY_NEGATIVE:
31020a51f88bSMatthias Ringwald                 hci_send_cmd(&hci_user_passkey_request_negative_reply, hci_stack->gap_pairing_addr);
31030a51f88bSMatthias Ringwald                 break;
31040a51f88bSMatthias Ringwald             case GAP_PAIRING_STATE_SEND_CONFIRMATION:
31050a51f88bSMatthias Ringwald                 hci_send_cmd(&hci_user_confirmation_request_reply, hci_stack->gap_pairing_addr);
31060a51f88bSMatthias Ringwald                 break;
31070a51f88bSMatthias Ringwald             case GAP_PAIRING_STATE_SEND_CONFIRMATION_NEGATIVE:
31080a51f88bSMatthias Ringwald                 hci_send_cmd(&hci_user_confirmation_request_negative_reply, hci_stack->gap_pairing_addr);
31090a51f88bSMatthias Ringwald                 break;
31100a51f88bSMatthias Ringwald             default:
31110a51f88bSMatthias Ringwald                 break;
31120a51f88bSMatthias Ringwald         }
31130a51f88bSMatthias Ringwald         return;
31140a51f88bSMatthias Ringwald     }
311535454696SMatthias Ringwald #endif
3116b031bebbSmatthias.ringwald 
3117a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE
3118b95a5a35SMatthias Ringwald     // advertisements, active scanning, and creating connections requires randaom address to be set if using private address
3119b95a5a35SMatthias Ringwald     if ((hci_stack->state == HCI_STATE_WORKING)
3120b95a5a35SMatthias Ringwald     && (hci_stack->le_own_addr_type == BD_ADDR_TYPE_LE_PUBLIC || hci_stack->le_random_address_set)){
3121d70217a2SMatthias Ringwald 
3122d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
312345c102fdSMatthias Ringwald         // handle le scan
31246fab74dbSMatthias Ringwald         if ((hci_stack->le_scanning_enabled != hci_stack->le_scanning_active)){
31256fab74dbSMatthias Ringwald             hci_stack->le_scanning_active = hci_stack->le_scanning_enabled;
31266fab74dbSMatthias Ringwald             hci_send_cmd(&hci_le_set_scan_enable, hci_stack->le_scanning_enabled, 0);
31277bdc6798S[email protected]             return;
31287bdc6798S[email protected]         }
3129e2602ea2Smatthias.ringwald         if (hci_stack->le_scan_type != 0xff){
3130e2602ea2Smatthias.ringwald             // defaults: active scanning, accept all advertisement packets
3131e2602ea2Smatthias.ringwald             int scan_type = hci_stack->le_scan_type;
3132e2602ea2Smatthias.ringwald             hci_stack->le_scan_type = 0xff;
3133b95a5a35SMatthias 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);
3134e2602ea2Smatthias.ringwald             return;
3135e2602ea2Smatthias.ringwald         }
3136d70217a2SMatthias Ringwald #endif
3137d70217a2SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
313845c102fdSMatthias Ringwald         // le advertisement control
31399a2e4658SMatthias Ringwald         if (hci_stack->le_advertisements_todo){
31409a2e4658SMatthias Ringwald             log_info("hci_run: gap_le: adv todo: %x", hci_stack->le_advertisements_todo );
31419a2e4658SMatthias Ringwald         }
314245c102fdSMatthias Ringwald         if (hci_stack->le_advertisements_todo & LE_ADVERTISEMENT_TASKS_DISABLE){
314345c102fdSMatthias Ringwald             hci_stack->le_advertisements_todo &= ~LE_ADVERTISEMENT_TASKS_DISABLE;
314445c102fdSMatthias Ringwald             hci_send_cmd(&hci_le_set_advertise_enable, 0);
314545c102fdSMatthias Ringwald             return;
314645c102fdSMatthias Ringwald         }
314745c102fdSMatthias Ringwald         if (hci_stack->le_advertisements_todo & LE_ADVERTISEMENT_TASKS_SET_PARAMS){
314845c102fdSMatthias Ringwald             hci_stack->le_advertisements_todo &= ~LE_ADVERTISEMENT_TASKS_SET_PARAMS;
314945c102fdSMatthias Ringwald             hci_send_cmd(&hci_le_set_advertising_parameters,
315045c102fdSMatthias Ringwald                  hci_stack->le_advertisements_interval_min,
315145c102fdSMatthias Ringwald                  hci_stack->le_advertisements_interval_max,
315245c102fdSMatthias Ringwald                  hci_stack->le_advertisements_type,
3153b95a5a35SMatthias Ringwald                  hci_stack->le_own_addr_type,
315445c102fdSMatthias Ringwald                  hci_stack->le_advertisements_direct_address_type,
315545c102fdSMatthias Ringwald                  hci_stack->le_advertisements_direct_address,
315645c102fdSMatthias Ringwald                  hci_stack->le_advertisements_channel_map,
315745c102fdSMatthias Ringwald                  hci_stack->le_advertisements_filter_policy);
315845c102fdSMatthias Ringwald             return;
315945c102fdSMatthias Ringwald         }
3160501f56b3SMatthias Ringwald         if (hci_stack->le_advertisements_todo & LE_ADVERTISEMENT_TASKS_SET_ADV_DATA){
3161501f56b3SMatthias Ringwald             hci_stack->le_advertisements_todo &= ~LE_ADVERTISEMENT_TASKS_SET_ADV_DATA;
31627a85e4f5SMatthias Ringwald             uint8_t adv_data_clean[31];
31637a85e4f5SMatthias Ringwald             memset(adv_data_clean, 0, sizeof(adv_data_clean));
31647a85e4f5SMatthias Ringwald             memcpy(adv_data_clean, hci_stack->le_advertisements_data, hci_stack->le_advertisements_data_len);
3165f868b059SMatthias Ringwald             hci_replace_bd_addr_placeholder(adv_data_clean, hci_stack->le_advertisements_data_len);
31667a85e4f5SMatthias Ringwald             hci_send_cmd(&hci_le_set_advertising_data, hci_stack->le_advertisements_data_len, adv_data_clean);
316745c102fdSMatthias Ringwald             return;
316845c102fdSMatthias Ringwald         }
3169501f56b3SMatthias Ringwald         if (hci_stack->le_advertisements_todo & LE_ADVERTISEMENT_TASKS_SET_SCAN_DATA){
3170501f56b3SMatthias Ringwald             hci_stack->le_advertisements_todo &= ~LE_ADVERTISEMENT_TASKS_SET_SCAN_DATA;
3171f868b059SMatthias Ringwald             uint8_t scan_data_clean[31];
3172f868b059SMatthias Ringwald             memset(scan_data_clean, 0, sizeof(scan_data_clean));
31738cdc9940SMatthias Ringwald             memcpy(scan_data_clean, hci_stack->le_scan_response_data, hci_stack->le_scan_response_data_len);
3174f868b059SMatthias Ringwald             hci_replace_bd_addr_placeholder(scan_data_clean, hci_stack->le_scan_response_data_len);
3175f868b059SMatthias Ringwald             hci_send_cmd(&hci_le_set_scan_response_data, hci_stack->le_scan_response_data_len, hci_stack->le_scan_response_data);
3176501f56b3SMatthias Ringwald             return;
3177501f56b3SMatthias Ringwald         }
3178b95a5a35SMatthias Ringwald         if (hci_stack->le_advertisements_todo & LE_ADVERTISEMENT_TASKS_ENABLE){
317945c102fdSMatthias Ringwald             hci_stack->le_advertisements_todo &= ~LE_ADVERTISEMENT_TASKS_ENABLE;
318045c102fdSMatthias Ringwald             hci_send_cmd(&hci_le_set_advertise_enable, 1);
318145c102fdSMatthias Ringwald             return;
318245c102fdSMatthias Ringwald         }
3183d70217a2SMatthias Ringwald #endif
31849956955bSMatthias Ringwald 
3185d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
31869956955bSMatthias Ringwald         //
31879956955bSMatthias Ringwald         // LE Whitelist Management
31889956955bSMatthias Ringwald         //
31899956955bSMatthias Ringwald 
31909956955bSMatthias Ringwald         // check if whitelist needs modification
3191665d90f2SMatthias Ringwald         btstack_linked_list_iterator_t lit;
31929956955bSMatthias Ringwald         int modification_pending = 0;
3193665d90f2SMatthias Ringwald         btstack_linked_list_iterator_init(&lit, &hci_stack->le_whitelist);
3194665d90f2SMatthias Ringwald         while (btstack_linked_list_iterator_has_next(&lit)){
3195665d90f2SMatthias Ringwald             whitelist_entry_t * entry = (whitelist_entry_t*) btstack_linked_list_iterator_next(&lit);
31969956955bSMatthias Ringwald             if (entry->state & (LE_WHITELIST_REMOVE_FROM_CONTROLLER | LE_WHITELIST_ADD_TO_CONTROLLER)){
31979956955bSMatthias Ringwald                 modification_pending = 1;
31989956955bSMatthias Ringwald                 break;
31999956955bSMatthias Ringwald             }
32009956955bSMatthias Ringwald         }
320191915b0bSMatthias Ringwald 
32029956955bSMatthias Ringwald         if (modification_pending){
320391915b0bSMatthias Ringwald             // stop connnecting if modification pending
32049956955bSMatthias Ringwald             if (hci_stack->le_connecting_state != LE_CONNECTING_IDLE){
32059956955bSMatthias Ringwald                 hci_send_cmd(&hci_le_create_connection_cancel);
32069956955bSMatthias Ringwald                 return;
32079956955bSMatthias Ringwald             }
32089956955bSMatthias Ringwald 
32099956955bSMatthias Ringwald             // add/remove entries
3210665d90f2SMatthias Ringwald             btstack_linked_list_iterator_init(&lit, &hci_stack->le_whitelist);
3211665d90f2SMatthias Ringwald             while (btstack_linked_list_iterator_has_next(&lit)){
3212665d90f2SMatthias Ringwald                 whitelist_entry_t * entry = (whitelist_entry_t*) btstack_linked_list_iterator_next(&lit);
32139956955bSMatthias Ringwald                 if (entry->state & LE_WHITELIST_ADD_TO_CONTROLLER){
32149956955bSMatthias Ringwald                     entry->state = LE_WHITELIST_ON_CONTROLLER;
32159956955bSMatthias Ringwald                     hci_send_cmd(&hci_le_add_device_to_white_list, entry->address_type, entry->address);
32169956955bSMatthias Ringwald                     return;
32179956955bSMatthias Ringwald 
32189956955bSMatthias Ringwald                 }
32199956955bSMatthias Ringwald                 if (entry->state & LE_WHITELIST_REMOVE_FROM_CONTROLLER){
32209ecbe201SMatthias Ringwald                     bd_addr_t address;
32219ecbe201SMatthias Ringwald                     bd_addr_type_t address_type = entry->address_type;
32229ecbe201SMatthias Ringwald                     memcpy(address, entry->address, 6);
3223665d90f2SMatthias Ringwald                     btstack_linked_list_remove(&hci_stack->le_whitelist, (btstack_linked_item_t *) entry);
32249956955bSMatthias Ringwald                     btstack_memory_whitelist_entry_free(entry);
32259ecbe201SMatthias Ringwald                     hci_send_cmd(&hci_le_remove_device_from_white_list, address_type, address);
32269956955bSMatthias Ringwald                     return;
32279956955bSMatthias Ringwald                 }
32289956955bSMatthias Ringwald             }
322991915b0bSMatthias Ringwald         }
32309956955bSMatthias Ringwald 
32319956955bSMatthias Ringwald         // start connecting
323291915b0bSMatthias Ringwald         if ( hci_stack->le_connecting_state == LE_CONNECTING_IDLE &&
3233665d90f2SMatthias Ringwald             !btstack_linked_list_empty(&hci_stack->le_whitelist)){
32349956955bSMatthias Ringwald             bd_addr_t null_addr;
32359956955bSMatthias Ringwald             memset(null_addr, 0, 6);
32369956955bSMatthias Ringwald             hci_send_cmd(&hci_le_create_connection,
3237cbe54ab2SJakob Krantz                 hci_stack->le_connection_scan_interval,    // scan interval: 60 ms
3238cbe54ab2SJakob Krantz                 hci_stack->le_connection_scan_window,    // scan interval: 30 ms
32399956955bSMatthias Ringwald                  1,         // use whitelist
32409956955bSMatthias Ringwald                  0,         // peer address type
32419956955bSMatthias Ringwald                  null_addr, // peer bd addr
3242b95a5a35SMatthias Ringwald                  hci_stack->le_own_addr_type, // our addr type:
324373044eb2SMatthias Ringwald                  hci_stack->le_connection_interval_min,    // conn interval min
324473044eb2SMatthias Ringwald                  hci_stack->le_connection_interval_max,    // conn interval max
324573044eb2SMatthias Ringwald                  hci_stack->le_connection_latency,         // conn latency
324673044eb2SMatthias Ringwald                  hci_stack->le_supervision_timeout,        // conn latency
324773044eb2SMatthias Ringwald                  hci_stack->le_minimum_ce_length,          // min ce length
324873044eb2SMatthias Ringwald                  hci_stack->le_maximum_ce_length           // max ce length
32499956955bSMatthias Ringwald                 );
32509956955bSMatthias Ringwald             return;
32519956955bSMatthias Ringwald         }
3252d70217a2SMatthias Ringwald #endif
32537bdc6798S[email protected]     }
3254b2f949feS[email protected] #endif
32557bdc6798S[email protected] 
325632ab9390Smatthias.ringwald     // send pending HCI commands
3257665d90f2SMatthias Ringwald     for (it = (btstack_linked_item_t *) hci_stack->connections; it ; it = it->next){
325805ae8de3SMatthias Ringwald         hci_connection_t * connection = (hci_connection_t *) it;
325932ab9390Smatthias.ringwald 
32600bf6344aS[email protected]         switch(connection->state){
32610bf6344aS[email protected]             case SEND_CREATE_CONNECTION:
32624f3229d8S[email protected]                 switch(connection->address_type){
326335454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
32644f3229d8S[email protected]                     case BD_ADDR_TYPE_CLASSIC:
32659da54300S[email protected]                         log_info("sending hci_create_connection");
3266ad83dc6aS[email protected]                         hci_send_cmd(&hci_create_connection, connection->address, hci_usable_acl_packet_types(), 0, 0, 0, 1);
32674f3229d8S[email protected]                         break;
326835454696SMatthias Ringwald #endif
32694f3229d8S[email protected]                     default:
3270a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE
3271d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
32729da54300S[email protected]                         log_info("sending hci_le_create_connection");
32734f3229d8S[email protected]                         hci_send_cmd(&hci_le_create_connection,
3274cbe54ab2SJakob Krantz                              hci_stack->le_connection_scan_interval,    // conn scan interval
3275cbe54ab2SJakob Krantz                              hci_stack->le_connection_scan_window,      // conn scan windows
32764f3229d8S[email protected]                              0,         // don't use whitelist
32774f3229d8S[email protected]                              connection->address_type, // peer address type
32784f3229d8S[email protected]                              connection->address,      // peer bd addr
3279b95a5a35SMatthias Ringwald                              hci_stack->le_own_addr_type, // our addr type:
328073044eb2SMatthias Ringwald                              hci_stack->le_connection_interval_min,    // conn interval min
328173044eb2SMatthias Ringwald                              hci_stack->le_connection_interval_max,    // conn interval max
328273044eb2SMatthias Ringwald                              hci_stack->le_connection_latency,         // conn latency
328373044eb2SMatthias Ringwald                              hci_stack->le_supervision_timeout,        // conn latency
328473044eb2SMatthias Ringwald                              hci_stack->le_minimum_ce_length,          // min ce length
328573044eb2SMatthias Ringwald                              hci_stack->le_maximum_ce_length          // max ce length
32864f3229d8S[email protected]                              );
32874f3229d8S[email protected]                         connection->state = SENT_CREATE_CONNECTION;
3288b2f949feS[email protected] #endif
3289d70217a2SMatthias Ringwald #endif
32904f3229d8S[email protected]                         break;
32914f3229d8S[email protected]                 }
3292ad83dc6aS[email protected]                 return;
3293ad83dc6aS[email protected] 
329435454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
32950bf6344aS[email protected]             case RECEIVED_CONNECTION_REQUEST:
32965cf766e8SMatthias Ringwald                 connection->role  = HCI_ROLE_SLAVE;
3297e35edcc1S[email protected]                 if (connection->address_type == BD_ADDR_TYPE_CLASSIC){
3298895f6685SMilanka Ringwald                     log_info("sending hci_accept_connection_request, remote eSCO %u", connection->remote_supported_feature_eSCO);
3299895f6685SMilanka Ringwald                     connection->state = ACCEPTED_CONNECTION_REQUEST;
3300c4c88f1bSJakob Krantz                     hci_send_cmd(&hci_accept_connection_request, connection->address, hci_stack->master_slave_policy);
3301e35edcc1S[email protected]                 }
3302dbe1a790S[email protected]                 return;
330335454696SMatthias Ringwald #endif
33040bf6344aS[email protected] 
3305a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE
3306d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
33070bf6344aS[email protected]             case SEND_CANCEL_CONNECTION:
33080bf6344aS[email protected]                 connection->state = SENT_CANCEL_CONNECTION;
33090bf6344aS[email protected]                 hci_send_cmd(&hci_le_create_connection_cancel);
33100bf6344aS[email protected]                 return;
3311a6725849S[email protected] #endif
3312d70217a2SMatthias Ringwald #endif
33130bf6344aS[email protected]             case SEND_DISCONNECT:
33140bf6344aS[email protected]                 connection->state = SENT_DISCONNECT;
33157851196eSmatthias.ringwald                 hci_send_cmd(&hci_disconnect, connection->con_handle, 0x13); // remote closed connection
33160bf6344aS[email protected]                 return;
33170bf6344aS[email protected] 
33180bf6344aS[email protected]             default:
33190bf6344aS[email protected]                 break;
3320c7e0c5f6Smatthias.ringwald         }
3321c7e0c5f6Smatthias.ringwald 
332235454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
332332ab9390Smatthias.ringwald         if (connection->authentication_flags & HANDLE_LINK_KEY_REQUEST){
33249da54300S[email protected]             log_info("responding to link key request");
332534d2123cS[email protected]             connectionClearAuthenticationFlags(connection, HANDLE_LINK_KEY_REQUEST);
332632ab9390Smatthias.ringwald             link_key_t link_key;
3327c77e8838S[email protected]             link_key_type_t link_key_type;
3328a98592bcSMatthias Ringwald             if ( hci_stack->link_key_db
3329a98592bcSMatthias Ringwald               && hci_stack->link_key_db->get_link_key(connection->address, link_key, &link_key_type)
333034d2123cS[email protected]               && gap_security_level_for_link_key_type(link_key_type) >= connection->requested_security_level){
33319ab95c90S[email protected]                connection->link_key_type = link_key_type;
333232ab9390Smatthias.ringwald                hci_send_cmd(&hci_link_key_request_reply, connection->address, &link_key);
333332ab9390Smatthias.ringwald             } else {
333432ab9390Smatthias.ringwald                hci_send_cmd(&hci_link_key_request_negative_reply, connection->address);
333532ab9390Smatthias.ringwald             }
3336dbe1a790S[email protected]             return;
333732ab9390Smatthias.ringwald         }
33381d6b20aeS[email protected] 
3339899283eaS[email protected]         if (connection->authentication_flags & DENY_PIN_CODE_REQUEST){
33409da54300S[email protected]             log_info("denying to pin request");
3341899283eaS[email protected]             connectionClearAuthenticationFlags(connection, DENY_PIN_CODE_REQUEST);
334234d2123cS[email protected]             hci_send_cmd(&hci_pin_code_request_negative_reply, connection->address);
33434c57c146S[email protected]             return;
33444c57c146S[email protected]         }
33454c57c146S[email protected] 
3346dbe1a790S[email protected]         if (connection->authentication_flags & SEND_IO_CAPABILITIES_REPLY){
334734d2123cS[email protected]             connectionClearAuthenticationFlags(connection, SEND_IO_CAPABILITIES_REPLY);
334882d8f825S[email protected]             log_info("IO Capability Request received, stack bondable %u, io cap %u", hci_stack->bondable, hci_stack->ssp_io_capability);
334982d8f825S[email protected]             if (hci_stack->bondable && (hci_stack->ssp_io_capability != SSP_IO_CAPABILITY_UNKNOWN)){
3350106d6d11S[email protected]                 // tweak authentication requirements
33513a9fb326S[email protected]                 uint8_t authreq = hci_stack->ssp_authentication_requirement;
3352106d6d11S[email protected]                 if (connection->bonding_flags & BONDING_DEDICATED){
33539faad3abS[email protected]                     authreq = SSP_IO_AUTHREQ_MITM_PROTECTION_NOT_REQUIRED_DEDICATED_BONDING;
33549faad3abS[email protected]                 }
33559faad3abS[email protected]                 if (gap_mitm_protection_required_for_security_level(connection->requested_security_level)){
33569faad3abS[email protected]                     authreq |= 1;
3357106d6d11S[email protected]                 }
33583a9fb326S[email protected]                 hci_send_cmd(&hci_io_capability_request_reply, &connection->address, hci_stack->ssp_io_capability, NULL, authreq);
3359f8fb5f6eS[email protected]             } else {
3360f8fb5f6eS[email protected]                 hci_send_cmd(&hci_io_capability_request_negative_reply, &connection->address, ERROR_CODE_PAIRING_NOT_ALLOWED);
3361f8fb5f6eS[email protected]             }
3362dbe1a790S[email protected]             return;
336332ab9390Smatthias.ringwald         }
336432ab9390Smatthias.ringwald 
3365dbe1a790S[email protected]         if (connection->authentication_flags & SEND_USER_CONFIRM_REPLY){
3366dbe1a790S[email protected]             connectionClearAuthenticationFlags(connection, SEND_USER_CONFIRM_REPLY);
336734d2123cS[email protected]             hci_send_cmd(&hci_user_confirmation_request_reply, &connection->address);
3368dbe1a790S[email protected]             return;
3369dbe1a790S[email protected]         }
3370dbe1a790S[email protected] 
3371dbe1a790S[email protected]         if (connection->authentication_flags & SEND_USER_PASSKEY_REPLY){
3372dbe1a790S[email protected]             connectionClearAuthenticationFlags(connection, SEND_USER_PASSKEY_REPLY);
337334d2123cS[email protected]             hci_send_cmd(&hci_user_passkey_request_reply, &connection->address, 000000);
3374dbe1a790S[email protected]             return;
3375dbe1a790S[email protected]         }
3376afd4e962S[email protected] 
3377afd4e962S[email protected]         if (connection->bonding_flags & BONDING_REQUEST_REMOTE_FEATURES){
3378afd4e962S[email protected]             connection->bonding_flags &= ~BONDING_REQUEST_REMOTE_FEATURES;
337934d2123cS[email protected]             hci_send_cmd(&hci_read_remote_supported_features_command, connection->con_handle);
33802bd8b7e7S[email protected]             return;
33812bd8b7e7S[email protected]         }
33822bd8b7e7S[email protected] 
3383ad83dc6aS[email protected]         if (connection->bonding_flags & BONDING_DISCONNECT_DEDICATED_DONE){
3384ad83dc6aS[email protected]             connection->bonding_flags &= ~BONDING_DISCONNECT_DEDICATED_DONE;
33851bd5283dS[email protected]             connection->bonding_flags |= BONDING_EMIT_COMPLETE_ON_DISCONNECT;
338652d34f98S[email protected]             hci_send_cmd(&hci_disconnect, connection->con_handle, 0x13);  // authentication done
3387ad83dc6aS[email protected]             return;
3388ad83dc6aS[email protected]         }
338976f27cffSMatthias Ringwald 
339034d2123cS[email protected]         if (connection->bonding_flags & BONDING_SEND_AUTHENTICATE_REQUEST){
339134d2123cS[email protected]             connection->bonding_flags &= ~BONDING_SEND_AUTHENTICATE_REQUEST;
339234d2123cS[email protected]             hci_send_cmd(&hci_authentication_requested, connection->con_handle);
33932bd8b7e7S[email protected]             return;
3394afd4e962S[email protected]         }
339576f27cffSMatthias Ringwald 
3396dce78009S[email protected]         if (connection->bonding_flags & BONDING_SEND_ENCRYPTION_REQUEST){
3397dce78009S[email protected]             connection->bonding_flags &= ~BONDING_SEND_ENCRYPTION_REQUEST;
3398dce78009S[email protected]             hci_send_cmd(&hci_set_connection_encryption, connection->con_handle, 1);
3399dce78009S[email protected]             return;
3400dce78009S[email protected]         }
340176f27cffSMatthias Ringwald #endif
340276f27cffSMatthias Ringwald 
340376f27cffSMatthias Ringwald         if (connection->bonding_flags & BONDING_DISCONNECT_SECURITY_BLOCK){
340476f27cffSMatthias Ringwald             connection->bonding_flags &= ~BONDING_DISCONNECT_SECURITY_BLOCK;
340576f27cffSMatthias Ringwald             hci_send_cmd(&hci_disconnect, connection->con_handle, 0x0005);  // authentication failure
340676f27cffSMatthias Ringwald             return;
340776f27cffSMatthias Ringwald         }
3408da886c03S[email protected] 
3409a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE
341073cd8a2aSMatthias Ringwald         switch (connection->le_con_parameter_update_state){
341173cd8a2aSMatthias Ringwald             // response to L2CAP CON PARAMETER UPDATE REQUEST
341273cd8a2aSMatthias Ringwald             case CON_PARAMETER_UPDATE_CHANGE_HCI_CON_PARAMETERS:
3413da886c03S[email protected]                 connection->le_con_parameter_update_state = CON_PARAMETER_UPDATE_NONE;
341473cd8a2aSMatthias Ringwald                 hci_send_cmd(&hci_le_connection_update, connection->con_handle, connection->le_conn_interval_min,
3415c37a3166S[email protected]                     connection->le_conn_interval_max, connection->le_conn_latency, connection->le_supervision_timeout,
3416c37a3166S[email protected]                     0x0000, 0xffff);
341773cd8a2aSMatthias Ringwald                 break;
341873cd8a2aSMatthias Ringwald             case CON_PARAMETER_UPDATE_REPLY:
341973cd8a2aSMatthias Ringwald                 connection->le_con_parameter_update_state = CON_PARAMETER_UPDATE_NONE;
342073cd8a2aSMatthias Ringwald                 hci_send_cmd(&hci_le_remote_connection_parameter_request_reply, connection->con_handle, connection->le_conn_interval_min,
342173cd8a2aSMatthias Ringwald                     connection->le_conn_interval_max, connection->le_conn_latency, connection->le_supervision_timeout,
342273cd8a2aSMatthias Ringwald                     0x0000, 0xffff);
342373cd8a2aSMatthias Ringwald                 break;
342473cd8a2aSMatthias Ringwald             case CON_PARAMETER_UPDATE_NEGATIVE_REPLY:
342573cd8a2aSMatthias Ringwald                 connection->le_con_parameter_update_state = CON_PARAMETER_UPDATE_NONE;
342673cd8a2aSMatthias Ringwald                 hci_send_cmd(&hci_le_remote_connection_parameter_request_negative_reply, ERROR_CODE_UNSUPPORTED_LMP_PARAMETER_VALUE_UNSUPPORTED_LL_PARAMETER_VALUE);
342773cd8a2aSMatthias Ringwald                 break;
342873cd8a2aSMatthias Ringwald             default:
342973cd8a2aSMatthias Ringwald                 break;
3430c37a3166S[email protected]         }
3431c37a3166S[email protected] #endif
3432dbe1a790S[email protected]     }
3433c7e0c5f6Smatthias.ringwald 
343405ae8de3SMatthias Ringwald     hci_connection_t * connection;
34353a9fb326S[email protected]     switch (hci_stack->state){
34363429f56bSmatthias.ringwald         case HCI_STATE_INITIALIZING:
343774b323a9SMatthias Ringwald             hci_initializing_run();
34383429f56bSmatthias.ringwald             break;
3439c7e0c5f6Smatthias.ringwald 
3440c7e0c5f6Smatthias.ringwald         case HCI_STATE_HALTING:
3441c7e0c5f6Smatthias.ringwald 
34429da54300S[email protected]             log_info("HCI_STATE_HALTING");
34439956955bSMatthias Ringwald 
34449956955bSMatthias Ringwald             // free whitelist entries
3445a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE
3446d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
34479956955bSMatthias Ringwald             {
3448665d90f2SMatthias Ringwald                 btstack_linked_list_iterator_t lit;
3449665d90f2SMatthias Ringwald                 btstack_linked_list_iterator_init(&lit, &hci_stack->le_whitelist);
3450665d90f2SMatthias Ringwald                 while (btstack_linked_list_iterator_has_next(&lit)){
3451665d90f2SMatthias Ringwald                     whitelist_entry_t * entry = (whitelist_entry_t*) btstack_linked_list_iterator_next(&lit);
3452665d90f2SMatthias Ringwald                     btstack_linked_list_remove(&hci_stack->le_whitelist, (btstack_linked_item_t *) entry);
34539956955bSMatthias Ringwald                     btstack_memory_whitelist_entry_free(entry);
34549956955bSMatthias Ringwald                 }
34559956955bSMatthias Ringwald             }
34569956955bSMatthias Ringwald #endif
3457d70217a2SMatthias Ringwald #endif
3458c7e0c5f6Smatthias.ringwald             // close all open connections
34593a9fb326S[email protected]             connection =  (hci_connection_t *) hci_stack->connections;
3460c7e0c5f6Smatthias.ringwald             if (connection){
3461711e6c80SMatthias Ringwald                 hci_con_handle_t con_handle = (uint16_t) connection->con_handle;
3462d94d3cafS[email protected]                 if (!hci_can_send_command_packet_now()) return;
346332ab9390Smatthias.ringwald 
34648fca890eSMatthias Ringwald                 // check state
34658fca890eSMatthias Ringwald                 if (connection->state == SENT_DISCONNECT) return;
34668fca890eSMatthias Ringwald                 connection->state = SENT_DISCONNECT;
34678fca890eSMatthias Ringwald 
34688837e9efSMatthias Ringwald                 log_info("HCI_STATE_HALTING, connection %p, handle %u", connection, con_handle);
3469c7e0c5f6Smatthias.ringwald 
34708837e9efSMatthias Ringwald                 // cancel all l2cap connections right away instead of waiting for disconnection complete event ...
34718837e9efSMatthias Ringwald                 hci_emit_disconnection_complete(con_handle, 0x16); // terminated by local host
34728837e9efSMatthias Ringwald 
34738837e9efSMatthias Ringwald                 // ... which would be ignored anyway as we shutdown (free) the connection now
3474c7e0c5f6Smatthias.ringwald                 hci_shutdown_connection(connection);
34758837e9efSMatthias Ringwald 
34768837e9efSMatthias Ringwald                 // finally, send the disconnect command
34778837e9efSMatthias Ringwald                 hci_send_cmd(&hci_disconnect, con_handle, 0x13);  // remote closed connection
3478c7e0c5f6Smatthias.ringwald                 return;
3479c7e0c5f6Smatthias.ringwald             }
34809da54300S[email protected]             log_info("HCI_STATE_HALTING, calling off");
3481c7e0c5f6Smatthias.ringwald 
348272ea5239Smatthias.ringwald             // switch mode
3483c7e0c5f6Smatthias.ringwald             hci_power_control_off();
34849418f9c9Smatthias.ringwald 
34859da54300S[email protected]             log_info("HCI_STATE_HALTING, emitting state");
348672ea5239Smatthias.ringwald             hci_emit_state();
34879da54300S[email protected]             log_info("HCI_STATE_HALTING, done");
348872ea5239Smatthias.ringwald             break;
3489c7e0c5f6Smatthias.ringwald 
349072ea5239Smatthias.ringwald         case HCI_STATE_FALLING_ASLEEP:
34913a9fb326S[email protected]             switch(hci_stack->substate) {
349274b323a9SMatthias Ringwald                 case HCI_FALLING_ASLEEP_DISCONNECT:
34939da54300S[email protected]                     log_info("HCI_STATE_FALLING_ASLEEP");
349472ea5239Smatthias.ringwald                     // close all open connections
34953a9fb326S[email protected]                     connection =  (hci_connection_t *) hci_stack->connections;
349666da7044Smatthias.ringwald 
3497423a3e49SMatthias Ringwald #ifdef HAVE_PLATFORM_IPHONE_OS
349866da7044Smatthias.ringwald                     // don't close connections, if H4 supports power management
3499d0b87befSMatthias Ringwald                     if (btstack_control_iphone_power_management_enabled()){
350066da7044Smatthias.ringwald                         connection = NULL;
350166da7044Smatthias.ringwald                     }
350266da7044Smatthias.ringwald #endif
350372ea5239Smatthias.ringwald                     if (connection){
350432ab9390Smatthias.ringwald 
350572ea5239Smatthias.ringwald                         // send disconnect
3506d94d3cafS[email protected]                         if (!hci_can_send_command_packet_now()) return;
350732ab9390Smatthias.ringwald 
35089da54300S[email protected]                         log_info("HCI_STATE_FALLING_ASLEEP, connection %p, handle %u", connection, (uint16_t)connection->con_handle);
35096ad890d3Smatthias.ringwald                         hci_send_cmd(&hci_disconnect, connection->con_handle, 0x13);  // remote closed connection
351072ea5239Smatthias.ringwald 
351172ea5239Smatthias.ringwald                         // send disconnected event right away - causes higher layer connections to get closed, too.
351272ea5239Smatthias.ringwald                         hci_shutdown_connection(connection);
351372ea5239Smatthias.ringwald                         return;
351472ea5239Smatthias.ringwald                     }
351572ea5239Smatthias.ringwald 
351692368cd3S[email protected]                     if (hci_classic_supported()){
351789db417bSmatthias.ringwald                         // disable page and inquiry scan
3518d94d3cafS[email protected]                         if (!hci_can_send_command_packet_now()) return;
351932ab9390Smatthias.ringwald 
35209da54300S[email protected]                         log_info("HCI_STATE_HALTING, disabling inq scans");
35213a9fb326S[email protected]                         hci_send_cmd(&hci_write_scan_enable, hci_stack->connectable << 1); // drop inquiry scan but keep page scan
352289db417bSmatthias.ringwald 
352389db417bSmatthias.ringwald                         // continue in next sub state
352474b323a9SMatthias Ringwald                         hci_stack->substate = HCI_FALLING_ASLEEP_W4_WRITE_SCAN_ENABLE;
352589db417bSmatthias.ringwald                         break;
352692368cd3S[email protected]                     }
3527202c8a4cSMatthias Ringwald                     // no break - fall through for ble-only chips
352892368cd3S[email protected] 
352974b323a9SMatthias Ringwald                 case HCI_FALLING_ASLEEP_COMPLETE:
35309da54300S[email protected]                     log_info("HCI_STATE_HALTING, calling sleep");
3531423a3e49SMatthias Ringwald #ifdef HAVE_PLATFORM_IPHONE_OS
353228171530Smatthias.ringwald                     // don't actually go to sleep, if H4 supports power management
3533d0b87befSMatthias Ringwald                     if (btstack_control_iphone_power_management_enabled()){
353428171530Smatthias.ringwald                         // SLEEP MODE reached
35353a9fb326S[email protected]                         hci_stack->state = HCI_STATE_SLEEPING;
353628171530Smatthias.ringwald                         hci_emit_state();
353728171530Smatthias.ringwald                         break;
353828171530Smatthias.ringwald                     }
353928171530Smatthias.ringwald #endif
354072ea5239Smatthias.ringwald                     // switch mode
35413a9fb326S[email protected]                     hci_power_control_sleep();  // changes hci_stack->state to SLEEP
3542c7e0c5f6Smatthias.ringwald                     hci_emit_state();
354328171530Smatthias.ringwald                     break;
354428171530Smatthias.ringwald 
354589db417bSmatthias.ringwald                 default:
354689db417bSmatthias.ringwald                     break;
354789db417bSmatthias.ringwald             }
3548c7e0c5f6Smatthias.ringwald             break;
3549c7e0c5f6Smatthias.ringwald 
35503429f56bSmatthias.ringwald         default:
35513429f56bSmatthias.ringwald             break;
35521f504dbdSmatthias.ringwald     }
35533429f56bSmatthias.ringwald }
355416833f0aSmatthias.ringwald 
355531452debSmatthias.ringwald int hci_send_cmd_packet(uint8_t *packet, int size){
355635454696SMatthias Ringwald     // house-keeping
355735454696SMatthias Ringwald 
355835454696SMatthias Ringwald     if (IS_COMMAND(packet, hci_write_loopback_mode)){
355935454696SMatthias Ringwald         hci_stack->loopback_mode = packet[3];
356035454696SMatthias Ringwald     }
356135454696SMatthias Ringwald 
356235454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
3563c8e4258aSmatthias.ringwald     bd_addr_t addr;
3564c8e4258aSmatthias.ringwald     hci_connection_t * conn;
3565c8e4258aSmatthias.ringwald 
3566c8e4258aSmatthias.ringwald     // create_connection?
3567c8e4258aSmatthias.ringwald     if (IS_COMMAND(packet, hci_create_connection)){
3568724d70a2SMatthias Ringwald         reverse_bd_addr(&packet[3], addr);
35699da54300S[email protected]         log_info("Create_connection to %s", bd_addr_to_str(addr));
3570c8e4258aSmatthias.ringwald 
35712e77e513S[email protected]         conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_CLASSIC);
3572ad83dc6aS[email protected]         if (!conn){
357396a45072S[email protected]             conn = create_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_CLASSIC);
357417f1ba2aSmatthias.ringwald             if (!conn){
357517f1ba2aSmatthias.ringwald                 // notify client that alloc failed
35762deddeceSMatthias Ringwald                 hci_emit_connection_complete(addr, 0, BTSTACK_MEMORY_ALLOC_FAILED);
3577f5e5741dSMatthias Ringwald                 return -1; // packet not sent to controller
357817f1ba2aSmatthias.ringwald             }
3579ad83dc6aS[email protected]             conn->state = SEND_CREATE_CONNECTION;
3580ad83dc6aS[email protected]         }
3581ad83dc6aS[email protected]         log_info("conn state %u", conn->state);
3582ad83dc6aS[email protected]         switch (conn->state){
3583ad83dc6aS[email protected]             // if connection active exists
3584ad83dc6aS[email protected]             case OPEN:
3585f5e5741dSMatthias Ringwald                 // and OPEN, emit connection complete command
3586274dad91SMatthias Ringwald                 hci_emit_connection_complete(addr, conn->con_handle, 0);
3587f5e5741dSMatthias Ringwald                 return -1; // packet not sent to controller
3588ad83dc6aS[email protected]             case SEND_CREATE_CONNECTION:
3589532f91a5SMatthias Ringwald                 // connection created by hci, e.g. dedicated bonding, but not executed yet, let's do it now
3590532f91a5SMatthias Ringwald                 break;
3591ad83dc6aS[email protected]             default:
3592ad83dc6aS[email protected]                 // otherwise, just ignore as it is already in the open process
3593f5e5741dSMatthias Ringwald                 return -1; // packet not sent to controller
3594ad83dc6aS[email protected]         }
3595c8e4258aSmatthias.ringwald         conn->state = SENT_CREATE_CONNECTION;
3596c8e4258aSmatthias.ringwald     }
359735454696SMatthias Ringwald 
35987fde4af9Smatthias.ringwald     if (IS_COMMAND(packet, hci_link_key_request_reply)){
35997fde4af9Smatthias.ringwald         hci_add_connection_flags_for_flipped_bd_addr(&packet[3], SENT_LINK_KEY_REPLY);
36007fde4af9Smatthias.ringwald     }
36017fde4af9Smatthias.ringwald     if (IS_COMMAND(packet, hci_link_key_request_negative_reply)){
36027fde4af9Smatthias.ringwald         hci_add_connection_flags_for_flipped_bd_addr(&packet[3], SENT_LINK_KEY_NEGATIVE_REQUEST);
36037fde4af9Smatthias.ringwald     }
36047fde4af9Smatthias.ringwald 
36058ef73945Smatthias.ringwald     if (IS_COMMAND(packet, hci_delete_stored_link_key)){
3606a98592bcSMatthias Ringwald         if (hci_stack->link_key_db){
3607724d70a2SMatthias Ringwald             reverse_bd_addr(&packet[3], addr);
3608a98592bcSMatthias Ringwald             hci_stack->link_key_db->delete_link_key(addr);
36098ef73945Smatthias.ringwald         }
36108ef73945Smatthias.ringwald     }
3611c8e4258aSmatthias.ringwald 
36126724cd9eS[email protected]     if (IS_COMMAND(packet, hci_pin_code_request_negative_reply)
36136724cd9eS[email protected]     ||  IS_COMMAND(packet, hci_pin_code_request_reply)){
3614724d70a2SMatthias Ringwald         reverse_bd_addr(&packet[3], addr);
36152e77e513S[email protected]         conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_CLASSIC);
36166724cd9eS[email protected]         if (conn){
36176724cd9eS[email protected]             connectionClearAuthenticationFlags(conn, LEGACY_PAIRING_ACTIVE);
36186724cd9eS[email protected]         }
36196724cd9eS[email protected]     }
36206724cd9eS[email protected] 
36216724cd9eS[email protected]     if (IS_COMMAND(packet, hci_user_confirmation_request_negative_reply)
36226724cd9eS[email protected]     ||  IS_COMMAND(packet, hci_user_confirmation_request_reply)
36236724cd9eS[email protected]     ||  IS_COMMAND(packet, hci_user_passkey_request_negative_reply)
36246724cd9eS[email protected]     ||  IS_COMMAND(packet, hci_user_passkey_request_reply)) {
3625724d70a2SMatthias Ringwald         reverse_bd_addr(&packet[3], addr);
36262e77e513S[email protected]         conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_CLASSIC);
36276724cd9eS[email protected]         if (conn){
36286724cd9eS[email protected]             connectionClearAuthenticationFlags(conn, SSP_PAIRING_ACTIVE);
36296724cd9eS[email protected]         }
36306724cd9eS[email protected]     }
3631ee752bb8SMatthias Ringwald 
3632ee752bb8SMatthias Ringwald #ifdef ENABLE_SCO_OVER_HCI
3633ee752bb8SMatthias Ringwald     // setup_synchronous_connection? Voice setting at offset 22
3634ee752bb8SMatthias Ringwald     if (IS_COMMAND(packet, hci_setup_synchronous_connection)){
3635ee752bb8SMatthias Ringwald         // TODO: compare to current setting if sco connection already active
3636ee752bb8SMatthias Ringwald         hci_stack->sco_voice_setting_active = little_endian_read_16(packet, 15);
3637ee752bb8SMatthias Ringwald     }
3638ee752bb8SMatthias Ringwald     // accept_synchronus_connection? Voice setting at offset 18
3639ee752bb8SMatthias Ringwald     if (IS_COMMAND(packet, hci_accept_synchronous_connection)){
3640ee752bb8SMatthias Ringwald         // TODO: compare to current setting if sco connection already active
3641ee752bb8SMatthias Ringwald         hci_stack->sco_voice_setting_active = little_endian_read_16(packet, 19);
3642ee752bb8SMatthias Ringwald     }
3643ee752bb8SMatthias Ringwald #endif
364435454696SMatthias Ringwald #endif
36454b3e1e19SMatthias Ringwald 
3646a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE
3647d70217a2SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
364869a97523S[email protected]     if (IS_COMMAND(packet, hci_le_set_random_address)){
3649b95a5a35SMatthias Ringwald         hci_stack->le_random_address_set = 1;
3650b95a5a35SMatthias Ringwald         reverse_bd_addr(&packet[3], hci_stack->le_random_address);
3651d70217a2SMatthias Ringwald     }
3652171293d3SMatthias Ringwald     if (IS_COMMAND(packet, hci_le_set_advertise_enable)){
3653171293d3SMatthias Ringwald         hci_stack->le_advertisements_active = packet[3];
3654171293d3SMatthias Ringwald     }
3655d70217a2SMatthias Ringwald #endif
3656d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
3657b04dfa37SMatthias Ringwald     if (IS_COMMAND(packet, hci_le_create_connection)){
3658b04dfa37SMatthias Ringwald         // white list used?
3659b04dfa37SMatthias Ringwald         uint8_t initiator_filter_policy = packet[7];
3660b04dfa37SMatthias Ringwald         switch (initiator_filter_policy){
3661b04dfa37SMatthias Ringwald             case 0:
3662b04dfa37SMatthias Ringwald                 // whitelist not used
3663b04dfa37SMatthias Ringwald                 hci_stack->le_connecting_state = LE_CONNECTING_DIRECT;
3664b04dfa37SMatthias Ringwald                 break;
3665b04dfa37SMatthias Ringwald             case 1:
3666b04dfa37SMatthias Ringwald                 hci_stack->le_connecting_state = LE_CONNECTING_WHITELIST;
3667b04dfa37SMatthias Ringwald                 break;
3668b04dfa37SMatthias Ringwald             default:
3669b04dfa37SMatthias Ringwald                 log_error("Invalid initiator_filter_policy in LE Create Connection %u", initiator_filter_policy);
3670b04dfa37SMatthias Ringwald                 break;
3671b04dfa37SMatthias Ringwald         }
3672b04dfa37SMatthias Ringwald     }
3673b04dfa37SMatthias Ringwald     if (IS_COMMAND(packet, hci_le_create_connection_cancel)){
3674b04dfa37SMatthias Ringwald         hci_stack->le_connecting_state = LE_CONNECTING_IDLE;
3675b04dfa37SMatthias Ringwald     }
367669a97523S[email protected] #endif
3677d70217a2SMatthias Ringwald #endif
367869a97523S[email protected] 
36793a9fb326S[email protected]     hci_stack->num_cmd_packets--;
36805bb5bc3eS[email protected] 
36815bb5bc3eS[email protected]     hci_dump_packet(HCI_COMMAND_DATA_PACKET, 0, packet, size);
3682bfea0222SMatthias Ringwald     return hci_stack->hci_transport->send_packet(HCI_COMMAND_DATA_PACKET, packet, size);
368331452debSmatthias.ringwald }
36848adf0ddaSmatthias.ringwald 
36852bd8b7e7S[email protected] // disconnect because of security block
36862bd8b7e7S[email protected] void hci_disconnect_security_block(hci_con_handle_t con_handle){
36872bd8b7e7S[email protected]     hci_connection_t * connection = hci_connection_for_handle(con_handle);
36882bd8b7e7S[email protected]     if (!connection) return;
36892bd8b7e7S[email protected]     connection->bonding_flags |= BONDING_DISCONNECT_SECURITY_BLOCK;
36902bd8b7e7S[email protected] }
36912bd8b7e7S[email protected] 
36922bd8b7e7S[email protected] 
3693dbe1a790S[email protected] // Configure Secure Simple Pairing
3694dbe1a790S[email protected] 
369535454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
369635454696SMatthias Ringwald 
3697dbe1a790S[email protected] // enable will enable SSP during init
369815a95bd5SMatthias Ringwald void gap_ssp_set_enable(int enable){
36993a9fb326S[email protected]     hci_stack->ssp_enable = enable;
3700dbe1a790S[email protected] }
3701dbe1a790S[email protected] 
370295d71764SMatthias Ringwald static int hci_local_ssp_activated(void){
370315a95bd5SMatthias Ringwald     return gap_ssp_supported() && hci_stack->ssp_enable;
37042bd8b7e7S[email protected] }
37052bd8b7e7S[email protected] 
3706dbe1a790S[email protected] // if set, BTstack will respond to io capability request using authentication requirement
370715a95bd5SMatthias Ringwald void gap_ssp_set_io_capability(int io_capability){
37083a9fb326S[email protected]     hci_stack->ssp_io_capability = io_capability;
3709dbe1a790S[email protected] }
371015a95bd5SMatthias Ringwald void gap_ssp_set_authentication_requirement(int authentication_requirement){
37113a9fb326S[email protected]     hci_stack->ssp_authentication_requirement = authentication_requirement;
3712dbe1a790S[email protected] }
3713dbe1a790S[email protected] 
3714dbe1a790S[email protected] // if set, BTstack will confirm a numberic comparion and enter '000000' if requested
371515a95bd5SMatthias Ringwald void gap_ssp_set_auto_accept(int auto_accept){
37163a9fb326S[email protected]     hci_stack->ssp_auto_accept = auto_accept;
3717dbe1a790S[email protected] }
371835454696SMatthias Ringwald #endif
3719dbe1a790S[email protected] 
372094be1a66SMatthias Ringwald // va_list part of hci_send_cmd
372194be1a66SMatthias Ringwald int hci_send_cmd_va_arg(const hci_cmd_t *cmd, va_list argptr){
3722d94d3cafS[email protected]     if (!hci_can_send_command_packet_now()){
37239d14b626S[email protected]         log_error("hci_send_cmd called but cannot send packet now");
37249d14b626S[email protected]         return 0;
37259d14b626S[email protected]     }
37269d14b626S[email protected] 
37275127cc62S[email protected]     // for HCI INITIALIZATION
37289da54300S[email protected]     // log_info("hci_send_cmd: opcode %04x", cmd->opcode);
37295127cc62S[email protected]     hci_stack->last_cmd_opcode = cmd->opcode;
37305127cc62S[email protected] 
37319d14b626S[email protected]     hci_reserve_packet_buffer();
37329d14b626S[email protected]     uint8_t * packet = hci_stack->hci_packet_buffer;
373394be1a66SMatthias Ringwald     uint16_t size = hci_cmd_create_from_template(packet, cmd, argptr);
3734bfea0222SMatthias Ringwald     int err = hci_send_cmd_packet(packet, size);
3735bfea0222SMatthias Ringwald 
3736bfea0222SMatthias Ringwald     // release packet buffer for synchronous transport implementations
3737bfea0222SMatthias Ringwald     if (hci_transport_synchronous()){
3738e2d22487SMatthias Ringwald         hci_release_packet_buffer();
3739068b8592SMatthias Ringwald         hci_emit_transport_packet_sent();
3740bfea0222SMatthias Ringwald     }
3741bfea0222SMatthias Ringwald 
3742bfea0222SMatthias Ringwald     return err;
374394be1a66SMatthias Ringwald }
37449d14b626S[email protected] 
374594be1a66SMatthias Ringwald /**
374694be1a66SMatthias Ringwald  * pre: numcmds >= 0 - it's allowed to send a command to the controller
374794be1a66SMatthias Ringwald  */
374894be1a66SMatthias Ringwald int hci_send_cmd(const hci_cmd_t *cmd, ...){
37491cd208adSmatthias.ringwald     va_list argptr;
37501cd208adSmatthias.ringwald     va_start(argptr, cmd);
375194be1a66SMatthias Ringwald     int res = hci_send_cmd_va_arg(cmd, argptr);
37521cd208adSmatthias.ringwald     va_end(argptr);
375394be1a66SMatthias Ringwald     return res;
375493b8dc03Smatthias.ringwald }
3755c8e4258aSmatthias.ringwald 
3756ee091cf1Smatthias.ringwald // Create various non-HCI events.
3757ee091cf1Smatthias.ringwald // TODO: generalize, use table similar to hci_create_command
3758ee091cf1Smatthias.ringwald 
3759d6b06661SMatthias Ringwald static void hci_emit_event(uint8_t * event, uint16_t size, int dump){
3760fb37a842SMatthias Ringwald     // dump packet
3761d6b06661SMatthias Ringwald     if (dump) {
3762300c1ba4SMatthias Ringwald         hci_dump_packet( HCI_EVENT_PACKET, 0, event, size);
3763d6b06661SMatthias Ringwald     }
37641ef6bb52SMatthias Ringwald 
3765fb37a842SMatthias Ringwald     // dispatch to all event handlers
37661ef6bb52SMatthias Ringwald     btstack_linked_list_iterator_t it;
37671ef6bb52SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->event_handlers);
37681ef6bb52SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
37691ef6bb52SMatthias Ringwald         btstack_packet_callback_registration_t * entry = (btstack_packet_callback_registration_t*) btstack_linked_list_iterator_next(&it);
3770d9a7306aSMatthias Ringwald         entry->callback(HCI_EVENT_PACKET, 0, event, size);
37711ef6bb52SMatthias Ringwald     }
3772d6b06661SMatthias Ringwald }
3773d6b06661SMatthias Ringwald 
3774d6b06661SMatthias Ringwald static void hci_emit_acl_packet(uint8_t * packet, uint16_t size){
3775fb37a842SMatthias Ringwald     if (!hci_stack->acl_packet_handler) return;
37763d50b4baSMatthias Ringwald     hci_stack->acl_packet_handler(HCI_ACL_DATA_PACKET, 0, packet, size);
3777d6b06661SMatthias Ringwald }
3778d6b06661SMatthias Ringwald 
377935454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
3780701e3307SMatthias Ringwald static void hci_notify_if_sco_can_send_now(void){
37813bc639ceSMatthias Ringwald     // notify SCO sender if waiting
3782701e3307SMatthias Ringwald     if (!hci_stack->sco_waiting_for_can_send_now) return;
3783701e3307SMatthias Ringwald     if (hci_can_send_sco_packet_now()){
37843bc639ceSMatthias Ringwald         hci_stack->sco_waiting_for_can_send_now = 0;
3785701e3307SMatthias Ringwald         uint8_t event[2] = { HCI_EVENT_SCO_CAN_SEND_NOW, 0 };
3786701e3307SMatthias Ringwald         hci_dump_packet(HCI_EVENT_PACKET, 1, event, sizeof(event));
37873d50b4baSMatthias Ringwald         hci_stack->sco_packet_handler(HCI_EVENT_PACKET, 0, event, sizeof(event));
37883bc639ceSMatthias Ringwald     }
37893bc639ceSMatthias Ringwald }
37901cfb383eSMatthias Ringwald 
37911cfb383eSMatthias Ringwald // parsing end emitting has been merged to reduce code size
37921cfb383eSMatthias Ringwald static void gap_inquiry_explode(uint8_t * packet){
3793e4f5dd75SMatthias Ringwald     uint8_t event[19+GAP_INQUIRY_MAX_NAME_LEN];
37941cfb383eSMatthias Ringwald 
37951cfb383eSMatthias Ringwald     uint8_t * eir_data;
37961cfb383eSMatthias Ringwald     ad_context_t context;
37971cfb383eSMatthias Ringwald     const uint8_t * name;
37981cfb383eSMatthias Ringwald     uint8_t         name_len;
37991cfb383eSMatthias Ringwald 
38001cfb383eSMatthias Ringwald     int event_type = hci_event_packet_get_type(packet);
38011cfb383eSMatthias Ringwald     int num_reserved_fields = event_type == HCI_EVENT_INQUIRY_RESULT ? 2 : 1;    // 2 for old event, 1 otherwise
38021cfb383eSMatthias Ringwald     int num_responses       = hci_event_inquiry_result_get_num_responses(packet);
38031cfb383eSMatthias Ringwald 
38041cfb383eSMatthias Ringwald     // event[1] is set at the end
38051cfb383eSMatthias Ringwald     int i;
38061cfb383eSMatthias Ringwald     for (i=0; i<num_responses;i++){
38071cfb383eSMatthias Ringwald         memset(event, 0, sizeof(event));
38081cfb383eSMatthias Ringwald         event[0] = GAP_EVENT_INQUIRY_RESULT;
38091cfb383eSMatthias Ringwald         uint8_t event_size = 18;    // if name is not set by EIR
38101cfb383eSMatthias Ringwald 
38111cfb383eSMatthias Ringwald         memcpy(&event[2],  &packet[3 +                                             i*6], 6); // bd_addr
38121cfb383eSMatthias Ringwald         event[8] =          packet[3 + num_responses*(6)                         + i*1];     // page_scan_repetition_mode
38131cfb383eSMatthias Ringwald         memcpy(&event[9],  &packet[3 + num_responses*(6+1+num_reserved_fields)   + i*3], 3); // class of device
38141cfb383eSMatthias Ringwald         memcpy(&event[12], &packet[3 + num_responses*(6+1+num_reserved_fields+3) + i*2], 2); // clock offset
38151cfb383eSMatthias Ringwald 
38161cfb383eSMatthias Ringwald         switch (event_type){
38171cfb383eSMatthias Ringwald             case HCI_EVENT_INQUIRY_RESULT:
38181cfb383eSMatthias Ringwald                 // 14,15,16,17 = 0, size 18
38191cfb383eSMatthias Ringwald                 break;
38201cfb383eSMatthias Ringwald             case HCI_EVENT_INQUIRY_RESULT_WITH_RSSI:
38211cfb383eSMatthias Ringwald                 event[14] = 1;
38221cfb383eSMatthias Ringwald                 event[15] = packet [3 + num_responses*(6+1+num_reserved_fields+3+2) + i*1]; // rssi
38231cfb383eSMatthias Ringwald                 // 16,17 = 0, size 18
38241cfb383eSMatthias Ringwald                 break;
38251cfb383eSMatthias Ringwald             case HCI_EVENT_EXTENDED_INQUIRY_RESPONSE:
38261cfb383eSMatthias Ringwald                 event[14] = 1;
38271cfb383eSMatthias Ringwald                 event[15] = packet [3 + num_responses*(6+1+num_reserved_fields+3+2) + i*1]; // rssi
38281cfb383eSMatthias Ringwald                 // for EIR packets, there is only one reponse in it
38291cfb383eSMatthias Ringwald                 eir_data = &packet[3 + (6+1+num_reserved_fields+3+2+1)];
38301cfb383eSMatthias Ringwald                 name = NULL;
38311cfb383eSMatthias Ringwald                 // EIR data is 240 bytes in EIR event
38321cfb383eSMatthias Ringwald                 for (ad_iterator_init(&context, 240, eir_data) ; ad_iterator_has_more(&context) ; ad_iterator_next(&context)){
38331cfb383eSMatthias Ringwald                     uint8_t data_type    = ad_iterator_get_data_type(&context);
38341cfb383eSMatthias Ringwald                     uint8_t data_size    = ad_iterator_get_data_len(&context);
38351cfb383eSMatthias Ringwald                     const uint8_t * data = ad_iterator_get_data(&context);
38361cfb383eSMatthias Ringwald                     // Prefer Complete Local Name over Shortend Local Name
38371cfb383eSMatthias Ringwald                     switch (data_type){
38381cfb383eSMatthias Ringwald                         case BLUETOOTH_DATA_TYPE_SHORTENED_LOCAL_NAME:
38391cfb383eSMatthias Ringwald                             if (name) continue;
38401cfb383eSMatthias Ringwald                             /* explicit fall-through */
38411cfb383eSMatthias Ringwald                         case BLUETOOTH_DATA_TYPE_COMPLETE_LOCAL_NAME:
38421cfb383eSMatthias Ringwald                             name = data;
38431cfb383eSMatthias Ringwald                             name_len = data_size;
38441cfb383eSMatthias Ringwald                             break;
38451cfb383eSMatthias Ringwald                         default:
38461cfb383eSMatthias Ringwald                             break;
38471cfb383eSMatthias Ringwald                     }
38481cfb383eSMatthias Ringwald                 }
38491cfb383eSMatthias Ringwald                 if (name){
38501cfb383eSMatthias Ringwald                     event[16] = 1;
38511cfb383eSMatthias Ringwald                     // truncate name if needed
38521cfb383eSMatthias Ringwald                     int len = btstack_min(name_len, GAP_INQUIRY_MAX_NAME_LEN);
38531cfb383eSMatthias Ringwald                     event[17] = len;
38541cfb383eSMatthias Ringwald                     memcpy(&event[18], name, len);
38551cfb383eSMatthias Ringwald                     event_size += len;
38561cfb383eSMatthias Ringwald                 }
38571cfb383eSMatthias Ringwald                 break;
38581cfb383eSMatthias Ringwald         }
38591cfb383eSMatthias Ringwald         event[1] = event_size - 2;
38601cfb383eSMatthias Ringwald         hci_emit_event(event, event_size, 1);
38611cfb383eSMatthias Ringwald     }
38621cfb383eSMatthias Ringwald }
386335454696SMatthias Ringwald #endif
38643bc639ceSMatthias Ringwald 
386571de195eSMatthias Ringwald void hci_emit_state(void){
38663a9fb326S[email protected]     log_info("BTSTACK_EVENT_STATE %u", hci_stack->state);
3867425d1371Smatthias.ringwald     uint8_t event[3];
386880d52d6bSmatthias.ringwald     event[0] = BTSTACK_EVENT_STATE;
3869425d1371Smatthias.ringwald     event[1] = sizeof(event) - 2;
38703a9fb326S[email protected]     event[2] = hci_stack->state;
3871d6b06661SMatthias Ringwald     hci_emit_event(event, sizeof(event), 1);
3872c8e4258aSmatthias.ringwald }
3873c8e4258aSmatthias.ringwald 
387435454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
38752deddeceSMatthias Ringwald static void hci_emit_connection_complete(bd_addr_t address, hci_con_handle_t con_handle, uint8_t status){
3876425d1371Smatthias.ringwald     uint8_t event[13];
3877c8e4258aSmatthias.ringwald     event[0] = HCI_EVENT_CONNECTION_COMPLETE;
3878425d1371Smatthias.ringwald     event[1] = sizeof(event) - 2;
387917f1ba2aSmatthias.ringwald     event[2] = status;
38802deddeceSMatthias Ringwald     little_endian_store_16(event, 3, con_handle);
38812deddeceSMatthias Ringwald     reverse_bd_addr(address, &event[5]);
3882c8e4258aSmatthias.ringwald     event[11] = 1; // ACL connection
3883c8e4258aSmatthias.ringwald     event[12] = 0; // encryption disabled
3884d6b06661SMatthias Ringwald     hci_emit_event(event, sizeof(event), 1);
3885c8e4258aSmatthias.ringwald }
388652db98b2SMatthias Ringwald static void hci_emit_l2cap_check_timeout(hci_connection_t *conn){
388752db98b2SMatthias Ringwald     if (disable_l2cap_timeouts) return;
388852db98b2SMatthias Ringwald     log_info("L2CAP_EVENT_TIMEOUT_CHECK");
388952db98b2SMatthias Ringwald     uint8_t event[4];
389052db98b2SMatthias Ringwald     event[0] = L2CAP_EVENT_TIMEOUT_CHECK;
389152db98b2SMatthias Ringwald     event[1] = sizeof(event) - 2;
389252db98b2SMatthias Ringwald     little_endian_store_16(event, 2, conn->con_handle);
389352db98b2SMatthias Ringwald     hci_emit_event(event, sizeof(event), 1);
389452db98b2SMatthias Ringwald }
389535454696SMatthias Ringwald #endif
3896c8e4258aSmatthias.ringwald 
389735454696SMatthias Ringwald #ifdef ENABLE_BLE
3898d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
3899fc64f94aSMatthias 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){
39004f3229d8S[email protected]     uint8_t event[21];
39014f3229d8S[email protected]     event[0] = HCI_EVENT_LE_META;
39024f3229d8S[email protected]     event[1] = sizeof(event) - 2;
39034f3229d8S[email protected]     event[2] = HCI_SUBEVENT_LE_CONNECTION_COMPLETE;
39044f3229d8S[email protected]     event[3] = status;
3905fc64f94aSMatthias Ringwald     little_endian_store_16(event, 4, con_handle);
39064f3229d8S[email protected]     event[6] = 0; // TODO: role
39076e2e9a6bS[email protected]     event[7] = address_type;
3908724d70a2SMatthias Ringwald     reverse_bd_addr(address, &event[8]);
3909f8fbdce0SMatthias Ringwald     little_endian_store_16(event, 14, 0); // interval
3910f8fbdce0SMatthias Ringwald     little_endian_store_16(event, 16, 0); // latency
3911f8fbdce0SMatthias Ringwald     little_endian_store_16(event, 18, 0); // supervision timeout
39124f3229d8S[email protected]     event[20] = 0; // master clock accuracy
3913d6b06661SMatthias Ringwald     hci_emit_event(event, sizeof(event), 1);
39144f3229d8S[email protected] }
391535454696SMatthias Ringwald #endif
3916d70217a2SMatthias Ringwald #endif
39174f3229d8S[email protected] 
3918fd43c0e0SMatthias Ringwald static void hci_emit_transport_packet_sent(void){
3919fd43c0e0SMatthias Ringwald     // notify upper stack that it might be possible to send again
3920fd43c0e0SMatthias Ringwald     uint8_t event[] = { HCI_EVENT_TRANSPORT_PACKET_SENT, 0};
3921fd43c0e0SMatthias Ringwald     hci_emit_event(&event[0], sizeof(event), 0);  // don't dump
3922fd43c0e0SMatthias Ringwald }
3923fd43c0e0SMatthias Ringwald 
3924fc64f94aSMatthias Ringwald static void hci_emit_disconnection_complete(hci_con_handle_t con_handle, uint8_t reason){
3925425d1371Smatthias.ringwald     uint8_t event[6];
39263c4d4b90Smatthias.ringwald     event[0] = HCI_EVENT_DISCONNECTION_COMPLETE;
3927e518c4b8Smatthias.ringwald     event[1] = sizeof(event) - 2;
39283c4d4b90Smatthias.ringwald     event[2] = 0; // status = OK
3929fc64f94aSMatthias Ringwald     little_endian_store_16(event, 3, con_handle);
39303c4d4b90Smatthias.ringwald     event[5] = reason;
3931d6b06661SMatthias Ringwald     hci_emit_event(event, sizeof(event), 1);
39323c4d4b90Smatthias.ringwald }
39333c4d4b90Smatthias.ringwald 
3934b83d5eabSMatthias Ringwald static void hci_emit_nr_connections_changed(void){
3935e0abb8e7S[email protected]     log_info("BTSTACK_EVENT_NR_CONNECTIONS_CHANGED %u", nr_hci_connections());
3936425d1371Smatthias.ringwald     uint8_t event[3];
393780d52d6bSmatthias.ringwald     event[0] = BTSTACK_EVENT_NR_CONNECTIONS_CHANGED;
3938425d1371Smatthias.ringwald     event[1] = sizeof(event) - 2;
393943bfb1bdSmatthias.ringwald     event[2] = nr_hci_connections();
3940d6b06661SMatthias Ringwald     hci_emit_event(event, sizeof(event), 1);
394143bfb1bdSmatthias.ringwald }
3942038bc64cSmatthias.ringwald 
3943b83d5eabSMatthias Ringwald static void hci_emit_hci_open_failed(void){
3944e0abb8e7S[email protected]     log_info("BTSTACK_EVENT_POWERON_FAILED");
3945425d1371Smatthias.ringwald     uint8_t event[2];
394680d52d6bSmatthias.ringwald     event[0] = BTSTACK_EVENT_POWERON_FAILED;
3947425d1371Smatthias.ringwald     event[1] = sizeof(event) - 2;
3948d6b06661SMatthias Ringwald     hci_emit_event(event, sizeof(event), 1);
3949038bc64cSmatthias.ringwald }
39501b0e3922Smatthias.ringwald 
395135454696SMatthias Ringwald static void hci_emit_dedicated_bonding_result(bd_addr_t address, uint8_t status){
395235454696SMatthias Ringwald     log_info("hci_emit_dedicated_bonding_result %u ", status);
395335454696SMatthias Ringwald     uint8_t event[9];
395435454696SMatthias Ringwald     int pos = 0;
395535454696SMatthias Ringwald     event[pos++] = GAP_EVENT_DEDICATED_BONDING_COMPLETED;
395635454696SMatthias Ringwald     event[pos++] = sizeof(event) - 2;
395735454696SMatthias Ringwald     event[pos++] = status;
395835454696SMatthias Ringwald     reverse_bd_addr(address, &event[pos]);
3959d6b06661SMatthias Ringwald     hci_emit_event(event, sizeof(event), 1);
3960381fbed8Smatthias.ringwald }
3961458bf4e8S[email protected] 
396235454696SMatthias Ringwald 
396335454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
396435454696SMatthias Ringwald 
3965b83d5eabSMatthias Ringwald static void hci_emit_security_level(hci_con_handle_t con_handle, gap_security_level_t level){
3966df3354fcS[email protected]     log_info("hci_emit_security_level %u for handle %x", level, con_handle);
3967a00031e2S[email protected]     uint8_t event[5];
3968e00caf9cS[email protected]     int pos = 0;
39695611a760SMatthias Ringwald     event[pos++] = GAP_EVENT_SECURITY_LEVEL;
3970e00caf9cS[email protected]     event[pos++] = sizeof(event) - 2;
3971f8fbdce0SMatthias Ringwald     little_endian_store_16(event, 2, con_handle);
3972e00caf9cS[email protected]     pos += 2;
3973e00caf9cS[email protected]     event[pos++] = level;
3974d6b06661SMatthias Ringwald     hci_emit_event(event, sizeof(event), 1);
3975e00caf9cS[email protected] }
3976e00caf9cS[email protected] 
397735454696SMatthias Ringwald static gap_security_level_t gap_security_level_for_connection(hci_connection_t * connection){
397835454696SMatthias Ringwald     if (!connection) return LEVEL_0;
397935454696SMatthias Ringwald     if ((connection->authentication_flags & CONNECTION_ENCRYPTED) == 0) return LEVEL_0;
398035454696SMatthias Ringwald     return gap_security_level_for_link_key_type(connection->link_key_type);
398135454696SMatthias Ringwald }
398235454696SMatthias Ringwald 
398335454696SMatthias Ringwald static void hci_emit_discoverable_enabled(uint8_t enabled){
398435454696SMatthias Ringwald     log_info("BTSTACK_EVENT_DISCOVERABLE_ENABLED %u", enabled);
398535454696SMatthias Ringwald     uint8_t event[3];
398635454696SMatthias Ringwald     event[0] = BTSTACK_EVENT_DISCOVERABLE_ENABLED;
398735454696SMatthias Ringwald     event[1] = sizeof(event) - 2;
398835454696SMatthias Ringwald     event[2] = enabled;
3989d6b06661SMatthias Ringwald     hci_emit_event(event, sizeof(event), 1);
3990ad83dc6aS[email protected] }
3991ad83dc6aS[email protected] 
399206b9e820SMatthias Ringwald #ifdef ENABLE_CLASSIC
399398a2fd1cSMatthias Ringwald // query if remote side supports eSCO
3994073bd0faSMatthias Ringwald int hci_remote_esco_supported(hci_con_handle_t con_handle){
399598a2fd1cSMatthias Ringwald     hci_connection_t * connection = hci_connection_for_handle(con_handle);
399698a2fd1cSMatthias Ringwald     if (!connection) return 0;
399798a2fd1cSMatthias Ringwald     return connection->remote_supported_feature_eSCO;
399898a2fd1cSMatthias Ringwald }
399998a2fd1cSMatthias Ringwald 
40002bd8b7e7S[email protected] // query if remote side supports SSP
40012bd8b7e7S[email protected] int hci_remote_ssp_supported(hci_con_handle_t con_handle){
40022bd8b7e7S[email protected]     hci_connection_t * connection = hci_connection_for_handle(con_handle);
40032bd8b7e7S[email protected]     if (!connection) return 0;
40042bd8b7e7S[email protected]     return (connection->bonding_flags & BONDING_REMOTE_SUPPORTS_SSP) ? 1 : 0;
40052bd8b7e7S[email protected] }
40062bd8b7e7S[email protected] 
400715a95bd5SMatthias Ringwald int gap_ssp_supported_on_both_sides(hci_con_handle_t handle){
4008df3354fcS[email protected]     return hci_local_ssp_activated() && hci_remote_ssp_supported(handle);
4009df3354fcS[email protected] }
401006b9e820SMatthias Ringwald #endif
4011df3354fcS[email protected] 
4012458bf4e8S[email protected] // GAP API
4013458bf4e8S[email protected] /**
4014458bf4e8S[email protected]  * @bbrief enable/disable bonding. default is enabled
4015458bf4e8S[email protected]  * @praram enabled
4016458bf4e8S[email protected]  */
40174c57c146S[email protected] void gap_set_bondable_mode(int enable){
40183a9fb326S[email protected]     hci_stack->bondable = enable ? 1 : 0;
4019458bf4e8S[email protected] }
40204ef6443cSMatthias Ringwald /**
40214ef6443cSMatthias Ringwald  * @brief Get bondable mode.
40224ef6443cSMatthias Ringwald  * @return 1 if bondable
40234ef6443cSMatthias Ringwald  */
40244ef6443cSMatthias Ringwald int gap_get_bondable_mode(void){
40254ef6443cSMatthias Ringwald     return hci_stack->bondable;
40264ef6443cSMatthias Ringwald }
4027cb230b9dS[email protected] 
4028cb230b9dS[email protected] /**
402934d2123cS[email protected]  * @brief map link keys to security levels
4030cb230b9dS[email protected]  */
403134d2123cS[email protected] gap_security_level_t gap_security_level_for_link_key_type(link_key_type_t link_key_type){
403234d2123cS[email protected]     switch (link_key_type){
40333c68dfa9S[email protected]         case AUTHENTICATED_COMBINATION_KEY_GENERATED_FROM_P256:
40343c68dfa9S[email protected]             return LEVEL_4;
40353c68dfa9S[email protected]         case COMBINATION_KEY:
40363c68dfa9S[email protected]         case AUTHENTICATED_COMBINATION_KEY_GENERATED_FROM_P192:
40373c68dfa9S[email protected]             return LEVEL_3;
40383c68dfa9S[email protected]         default:
40393c68dfa9S[email protected]             return LEVEL_2;
40403c68dfa9S[email protected]     }
4041cb230b9dS[email protected] }
4042cb230b9dS[email protected] 
4043106d6d11S[email protected] int gap_mitm_protection_required_for_security_level(gap_security_level_t level){
40445127cc62S[email protected]     log_info("gap_mitm_protection_required_for_security_level %u", level);
4045106d6d11S[email protected]     return level > LEVEL_2;
4046106d6d11S[email protected] }
4047106d6d11S[email protected] 
404834d2123cS[email protected] /**
404934d2123cS[email protected]  * @brief get current security level
405034d2123cS[email protected]  */
405134d2123cS[email protected] gap_security_level_t gap_security_level(hci_con_handle_t con_handle){
405234d2123cS[email protected]     hci_connection_t * connection = hci_connection_for_handle(con_handle);
405334d2123cS[email protected]     if (!connection) return LEVEL_0;
405434d2123cS[email protected]     return gap_security_level_for_connection(connection);
405534d2123cS[email protected] }
405634d2123cS[email protected] 
4057cb230b9dS[email protected] /**
4058cb230b9dS[email protected]  * @brief request connection to device to
4059cb230b9dS[email protected]  * @result GAP_AUTHENTICATION_RESULT
4060cb230b9dS[email protected]  */
406134d2123cS[email protected] void gap_request_security_level(hci_con_handle_t con_handle, gap_security_level_t requested_level){
406234d2123cS[email protected]     hci_connection_t * connection = hci_connection_for_handle(con_handle);
406334d2123cS[email protected]     if (!connection){
4064a00031e2S[email protected]         hci_emit_security_level(con_handle, LEVEL_0);
406534d2123cS[email protected]         return;
406634d2123cS[email protected]     }
406734d2123cS[email protected]     gap_security_level_t current_level = gap_security_level(con_handle);
406883d08d7cSMatthias Ringwald     log_info("gap_request_security_level requested level %u, planned level %u, current level %u",
406983d08d7cSMatthias Ringwald         requested_level, connection->requested_security_level, current_level);
407083d08d7cSMatthias Ringwald 
407183d08d7cSMatthias Ringwald     // assumption: earlier requested security higher than current level => security request is active
407283d08d7cSMatthias Ringwald     if (current_level < connection->requested_security_level){
407383d08d7cSMatthias Ringwald         if (connection->requested_security_level < requested_level){
407483d08d7cSMatthias Ringwald             // increase requested level as new level is higher
407583d08d7cSMatthias Ringwald 
407683d08d7cSMatthias Ringwald             // TODO: handle re-authentication when done
407783d08d7cSMatthias Ringwald 
407883d08d7cSMatthias Ringwald             connection->requested_security_level = requested_level;
407983d08d7cSMatthias Ringwald         }
408083d08d7cSMatthias Ringwald         return;
408183d08d7cSMatthias Ringwald     }
408283d08d7cSMatthias Ringwald 
408383d08d7cSMatthias Ringwald     // no request active, notify if security sufficient
408483d08d7cSMatthias Ringwald     if (requested_level <= current_level){
4085a00031e2S[email protected]         hci_emit_security_level(con_handle, current_level);
408634d2123cS[email protected]         return;
408734d2123cS[email protected]     }
4088a00031e2S[email protected] 
408983d08d7cSMatthias Ringwald     // start pairing to increase security level
409034d2123cS[email protected]     connection->requested_security_level = requested_level;
4091a00031e2S[email protected] 
409225bf5872S[email protected] #if 0
409325bf5872S[email protected]     // sending encryption request without a link key results in an error.
409425bf5872S[email protected]     // TODO: figure out how to use it properly
409525bf5872S[email protected] 
4096fb8ba0dbS[email protected]     // would enabling ecnryption suffice (>= LEVEL_2)?
4097a98592bcSMatthias Ringwald     if (hci_stack->link_key_db){
4098a00031e2S[email protected]         link_key_type_t link_key_type;
4099a00031e2S[email protected]         link_key_t      link_key;
4100a98592bcSMatthias Ringwald         if (hci_stack->link_key_db->get_link_key( &connection->address, &link_key, &link_key_type)){
4101a00031e2S[email protected]             if (gap_security_level_for_link_key_type(link_key_type) >= requested_level){
4102a00031e2S[email protected]                 connection->bonding_flags |= BONDING_SEND_ENCRYPTION_REQUEST;
4103a00031e2S[email protected]                 return;
4104a00031e2S[email protected]             }
4105a00031e2S[email protected]         }
4106a00031e2S[email protected]     }
410725bf5872S[email protected] #endif
4108a00031e2S[email protected] 
410983d08d7cSMatthias Ringwald     // start to authenticate connection
41101eb2563eS[email protected]     connection->bonding_flags |= BONDING_SEND_AUTHENTICATE_REQUEST;
4111e80b2cf9S[email protected]     hci_run();
4112e00caf9cS[email protected] }
4113ad83dc6aS[email protected] 
4114ad83dc6aS[email protected] /**
4115ad83dc6aS[email protected]  * @brief start dedicated bonding with device. disconnect after bonding
4116ad83dc6aS[email protected]  * @param device
4117ad83dc6aS[email protected]  * @param request MITM protection
4118ad83dc6aS[email protected]  * @result GAP_DEDICATED_BONDING_COMPLETE
4119ad83dc6aS[email protected]  */
4120ad83dc6aS[email protected] int gap_dedicated_bonding(bd_addr_t device, int mitm_protection_required){
4121ad83dc6aS[email protected] 
4122ad83dc6aS[email protected]     // create connection state machine
412396a45072S[email protected]     hci_connection_t * connection = create_connection_for_bd_addr_and_type(device, BD_ADDR_TYPE_CLASSIC);
4124ad83dc6aS[email protected] 
4125ad83dc6aS[email protected]     if (!connection){
4126ad83dc6aS[email protected]         return BTSTACK_MEMORY_ALLOC_FAILED;
4127ad83dc6aS[email protected]     }
4128ad83dc6aS[email protected] 
4129ad83dc6aS[email protected]     // delete linkn key
413015a95bd5SMatthias Ringwald     gap_drop_link_key_for_bd_addr(device);
4131ad83dc6aS[email protected] 
4132ad83dc6aS[email protected]     // configure LEVEL_2/3, dedicated bonding
4133ad83dc6aS[email protected]     connection->state = SEND_CREATE_CONNECTION;
4134ad83dc6aS[email protected]     connection->requested_security_level = mitm_protection_required ? LEVEL_3 : LEVEL_2;
4135f04a0c31SMatthias Ringwald     log_info("gap_dedicated_bonding, mitm %d -> level %u", mitm_protection_required, connection->requested_security_level);
4136ad83dc6aS[email protected]     connection->bonding_flags = BONDING_DEDICATED;
4137ad83dc6aS[email protected] 
4138ad83dc6aS[email protected]     // wait for GAP Security Result and send GAP Dedicated Bonding complete
4139ad83dc6aS[email protected] 
4140ad83dc6aS[email protected]     // handle: connnection failure (connection complete != ok)
4141ad83dc6aS[email protected]     // handle: authentication failure
4142ad83dc6aS[email protected]     // handle: disconnect on done
4143ad83dc6aS[email protected] 
4144ad83dc6aS[email protected]     hci_run();
4145ad83dc6aS[email protected] 
4146ad83dc6aS[email protected]     return 0;
4147ad83dc6aS[email protected] }
414835454696SMatthias Ringwald #endif
41498e618f72S[email protected] 
41508e618f72S[email protected] void gap_set_local_name(const char * local_name){
41518e618f72S[email protected]     hci_stack->local_name = local_name;
41528e618f72S[email protected] }
41538e618f72S[email protected] 
415435454696SMatthias Ringwald 
415535454696SMatthias Ringwald #ifdef ENABLE_BLE
415635454696SMatthias Ringwald 
4157d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
4158d8e8f12aSMatthias Ringwald void gap_start_scan(void){
41596fab74dbSMatthias Ringwald     hci_stack->le_scanning_enabled = 1;
41607bdc6798S[email protected]     hci_run();
41617bdc6798S[email protected] }
41628e618f72S[email protected] 
4163d8e8f12aSMatthias Ringwald void gap_stop_scan(void){
41646fab74dbSMatthias Ringwald     hci_stack->le_scanning_enabled = 0;
41657bdc6798S[email protected]     hci_run();
41667bdc6798S[email protected] }
41674f3229d8S[email protected] 
4168d8e8f12aSMatthias Ringwald void gap_set_scan_parameters(uint8_t scan_type, uint16_t scan_interval, uint16_t scan_window){
4169ef11999fSmatthias.ringwald     hci_stack->le_scan_type     = scan_type;
4170ef11999fSmatthias.ringwald     hci_stack->le_scan_interval = scan_interval;
4171ef11999fSmatthias.ringwald     hci_stack->le_scan_window   = scan_window;
4172ef11999fSmatthias.ringwald     hci_run();
4173ef11999fSmatthias.ringwald }
41744f3229d8S[email protected] 
4175d8e8f12aSMatthias Ringwald uint8_t gap_connect(bd_addr_t addr, bd_addr_type_t addr_type){
41764f3229d8S[email protected]     hci_connection_t * conn = hci_connection_for_bd_addr_and_type(addr, addr_type);
41774f3229d8S[email protected]     if (!conn){
4178d8e8f12aSMatthias Ringwald         log_info("gap_connect: no connection exists yet, creating context");
41792e77e513S[email protected]         conn = create_connection_for_bd_addr_and_type(addr, addr_type);
41804f3229d8S[email protected]         if (!conn){
41814f3229d8S[email protected]             // notify client that alloc failed
41826e2e9a6bS[email protected]             hci_emit_le_connection_complete(addr_type, addr, 0, BTSTACK_MEMORY_ALLOC_FAILED);
4183d8e8f12aSMatthias Ringwald             log_info("gap_connect: failed to alloc hci_connection_t");
4184472a5742SMatthias Ringwald             return GATT_CLIENT_NOT_CONNECTED; // don't sent packet to controller
41854f3229d8S[email protected]         }
41864f3229d8S[email protected]         conn->state = SEND_CREATE_CONNECTION;
4187d8e8f12aSMatthias Ringwald         log_info("gap_connect: send create connection next");
4188564fca32S[email protected]         hci_run();
4189616edd56SMatthias Ringwald         return 0;
41904f3229d8S[email protected]     }
41910bf6344aS[email protected] 
41920bf6344aS[email protected]     if (!hci_is_le_connection(conn) ||
41930bf6344aS[email protected]         conn->state == SEND_CREATE_CONNECTION ||
41940bf6344aS[email protected]         conn->state == SENT_CREATE_CONNECTION) {
41952e77e513S[email protected]         hci_emit_le_connection_complete(conn->address_type, conn->address, 0, ERROR_CODE_COMMAND_DISALLOWED);
4196d8e8f12aSMatthias Ringwald         log_error("gap_connect: classic connection or connect is already being created");
4197616edd56SMatthias Ringwald         return GATT_CLIENT_IN_WRONG_STATE;
41980bf6344aS[email protected]     }
41990bf6344aS[email protected] 
4200d8e8f12aSMatthias Ringwald     log_info("gap_connect: context exists with state %u", conn->state);
42012e77e513S[email protected]     hci_emit_le_connection_complete(conn->address_type, conn->address, conn->con_handle, 0);
42024f3229d8S[email protected]     hci_run();
4203616edd56SMatthias Ringwald     return 0;
42044f3229d8S[email protected] }
42054f3229d8S[email protected] 
42067851196eSmatthias.ringwald // @assumption: only a single outgoing LE Connection exists
4207d8e8f12aSMatthias Ringwald static hci_connection_t * gap_get_outgoing_connection(void){
4208665d90f2SMatthias Ringwald     btstack_linked_item_t *it;
4209665d90f2SMatthias Ringwald     for (it = (btstack_linked_item_t *) hci_stack->connections; it ; it = it->next){
42100bf6344aS[email protected]         hci_connection_t * conn = (hci_connection_t *) it;
42110bf6344aS[email protected]         if (!hci_is_le_connection(conn)) continue;
42120bf6344aS[email protected]         switch (conn->state){
4213a6725849S[email protected]             case SEND_CREATE_CONNECTION:
42147851196eSmatthias.ringwald             case SENT_CREATE_CONNECTION:
42159c77c9dbSMatthias Ringwald             case SENT_CANCEL_CONNECTION:
42167851196eSmatthias.ringwald                 return conn;
42177851196eSmatthias.ringwald             default:
42187851196eSmatthias.ringwald                 break;
42197851196eSmatthias.ringwald         };
42207851196eSmatthias.ringwald     }
42217851196eSmatthias.ringwald     return NULL;
42227851196eSmatthias.ringwald }
42237851196eSmatthias.ringwald 
4224d8e8f12aSMatthias Ringwald uint8_t gap_connect_cancel(void){
4225d8e8f12aSMatthias Ringwald     hci_connection_t * conn = gap_get_outgoing_connection();
4226616edd56SMatthias Ringwald     if (!conn) return 0;
42277851196eSmatthias.ringwald     switch (conn->state){
42287851196eSmatthias.ringwald         case SEND_CREATE_CONNECTION:
42297851196eSmatthias.ringwald             // skip sending create connection and emit event instead
42302e77e513S[email protected]             hci_emit_le_connection_complete(conn->address_type, conn->address, 0, ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER);
4231665d90f2SMatthias Ringwald             btstack_linked_list_remove(&hci_stack->connections, (btstack_linked_item_t *) conn);
42327851196eSmatthias.ringwald             btstack_memory_hci_connection_free( conn );
42330bf6344aS[email protected]             break;
4234a6725849S[email protected]         case SENT_CREATE_CONNECTION:
42357851196eSmatthias.ringwald             // request to send cancel connection
42360bf6344aS[email protected]             conn->state = SEND_CANCEL_CONNECTION;
42370bf6344aS[email protected]             hci_run();
42380bf6344aS[email protected]             break;
42390bf6344aS[email protected]         default:
42400bf6344aS[email protected]             break;
42410bf6344aS[email protected]     }
4242616edd56SMatthias Ringwald     return 0;
4243e31f89a7S[email protected] }
4244d70217a2SMatthias Ringwald #endif
42454f3229d8S[email protected] 
424613e645d2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
4247c37a3166S[email protected] /**
42486012052bSMatthias Ringwald  * @brief Set connection parameters for outgoing connections
4249cbe54ab2SJakob Krantz  * @param conn_scan_interval (unit: 0.625 msec), default: 60 ms
4250cbe54ab2SJakob Krantz  * @param conn_scan_window (unit: 0.625 msec), default: 30 ms
42516012052bSMatthias Ringwald  * @param conn_interval_min (unit: 1.25ms), default: 10 ms
42526012052bSMatthias Ringwald  * @param conn_interval_max (unit: 1.25ms), default: 30 ms
42536012052bSMatthias Ringwald  * @param conn_latency, default: 4
42546012052bSMatthias Ringwald  * @param supervision_timeout (unit: 10ms), default: 720 ms
42556012052bSMatthias Ringwald  * @param min_ce_length (unit: 0.625ms), default: 10 ms
42566012052bSMatthias Ringwald  * @param max_ce_length (unit: 0.625ms), default: 30 ms
42576012052bSMatthias Ringwald  */
42586012052bSMatthias Ringwald 
4259cbe54ab2SJakob Krantz void gap_set_connection_parameters(uint16_t conn_scan_interval, uint16_t conn_scan_window,
4260cbe54ab2SJakob Krantz     uint16_t conn_interval_min, uint16_t conn_interval_max, uint16_t conn_latency,
4261cbe54ab2SJakob Krantz     uint16_t supervision_timeout, uint16_t min_ce_length, uint16_t max_ce_length){
4262cbe54ab2SJakob Krantz     hci_stack->le_connection_scan_interval = conn_scan_interval;
4263cbe54ab2SJakob Krantz     hci_stack->le_connection_scan_window = conn_scan_window;
42646012052bSMatthias Ringwald     hci_stack->le_connection_interval_min = conn_interval_min;
42656012052bSMatthias Ringwald     hci_stack->le_connection_interval_max = conn_interval_max;
42666012052bSMatthias Ringwald     hci_stack->le_connection_latency = conn_latency;
42676012052bSMatthias Ringwald     hci_stack->le_supervision_timeout = supervision_timeout;
42686012052bSMatthias Ringwald     hci_stack->le_minimum_ce_length = min_ce_length;
42696012052bSMatthias Ringwald     hci_stack->le_maximum_ce_length = max_ce_length;
42706012052bSMatthias Ringwald }
427113e645d2SMatthias Ringwald #endif
42726012052bSMatthias Ringwald 
42736012052bSMatthias Ringwald /**
4274c37a3166S[email protected]  * @brief Updates the connection parameters for a given LE connection
4275c37a3166S[email protected]  * @param handle
4276c37a3166S[email protected]  * @param conn_interval_min (unit: 1.25ms)
4277c37a3166S[email protected]  * @param conn_interval_max (unit: 1.25ms)
4278c37a3166S[email protected]  * @param conn_latency
4279c37a3166S[email protected]  * @param supervision_timeout (unit: 10ms)
4280c37a3166S[email protected]  * @returns 0 if ok
4281c37a3166S[email protected]  */
4282c37a3166S[email protected] int gap_update_connection_parameters(hci_con_handle_t con_handle, uint16_t conn_interval_min,
4283c37a3166S[email protected]     uint16_t conn_interval_max, uint16_t conn_latency, uint16_t supervision_timeout){
4284c37a3166S[email protected]     hci_connection_t * connection = hci_connection_for_handle(con_handle);
4285c37a3166S[email protected]     if (!connection) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
4286c37a3166S[email protected]     connection->le_conn_interval_min = conn_interval_min;
4287c37a3166S[email protected]     connection->le_conn_interval_max = conn_interval_max;
4288c37a3166S[email protected]     connection->le_conn_latency = conn_latency;
4289c37a3166S[email protected]     connection->le_supervision_timeout = supervision_timeout;
429084cf6d83SMatthias Ringwald     connection->le_con_parameter_update_state = CON_PARAMETER_UPDATE_CHANGE_HCI_CON_PARAMETERS;
4291cfc59f1bSMatthias Ringwald     hci_run();
4292c37a3166S[email protected]     return 0;
4293c37a3166S[email protected] }
4294c37a3166S[email protected] 
429545c102fdSMatthias Ringwald /**
4296b68d7bc3SMatthias Ringwald  * @brief Request an update of the connection parameter for a given LE connection
4297b68d7bc3SMatthias Ringwald  * @param handle
4298b68d7bc3SMatthias Ringwald  * @param conn_interval_min (unit: 1.25ms)
4299b68d7bc3SMatthias Ringwald  * @param conn_interval_max (unit: 1.25ms)
4300b68d7bc3SMatthias Ringwald  * @param conn_latency
4301b68d7bc3SMatthias Ringwald  * @param supervision_timeout (unit: 10ms)
4302b68d7bc3SMatthias Ringwald  * @returns 0 if ok
4303b68d7bc3SMatthias Ringwald  */
4304b68d7bc3SMatthias Ringwald int gap_request_connection_parameter_update(hci_con_handle_t con_handle, uint16_t conn_interval_min,
4305b68d7bc3SMatthias Ringwald     uint16_t conn_interval_max, uint16_t conn_latency, uint16_t supervision_timeout){
4306b68d7bc3SMatthias Ringwald     hci_connection_t * connection = hci_connection_for_handle(con_handle);
4307b68d7bc3SMatthias Ringwald     if (!connection) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
4308b68d7bc3SMatthias Ringwald     connection->le_conn_interval_min = conn_interval_min;
4309b68d7bc3SMatthias Ringwald     connection->le_conn_interval_max = conn_interval_max;
4310b68d7bc3SMatthias Ringwald     connection->le_conn_latency = conn_latency;
4311b68d7bc3SMatthias Ringwald     connection->le_supervision_timeout = supervision_timeout;
4312b68d7bc3SMatthias Ringwald     connection->le_con_parameter_update_state = CON_PARAMETER_UPDATE_SEND_REQUEST;
4313b68d7bc3SMatthias Ringwald     hci_run();
4314b68d7bc3SMatthias Ringwald     return 0;
4315b68d7bc3SMatthias Ringwald }
4316b68d7bc3SMatthias Ringwald 
4317d70217a2SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
4318d70217a2SMatthias Ringwald 
4319501f56b3SMatthias Ringwald static void gap_advertisments_changed(void){
4320501f56b3SMatthias Ringwald     // disable advertisements before updating adv, scan data, or adv params
4321501f56b3SMatthias Ringwald     if (hci_stack->le_advertisements_active){
4322501f56b3SMatthias Ringwald         hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_DISABLE | LE_ADVERTISEMENT_TASKS_ENABLE;
4323501f56b3SMatthias Ringwald     }
4324501f56b3SMatthias Ringwald     hci_run();
4325501f56b3SMatthias Ringwald }
4326501f56b3SMatthias Ringwald 
4327b68d7bc3SMatthias Ringwald /**
432845c102fdSMatthias Ringwald  * @brief Set Advertisement Data
432945c102fdSMatthias Ringwald  * @param advertising_data_length
433045c102fdSMatthias Ringwald  * @param advertising_data (max 31 octets)
433145c102fdSMatthias Ringwald  * @note data is not copied, pointer has to stay valid
433245c102fdSMatthias Ringwald  */
433345c102fdSMatthias Ringwald void gap_advertisements_set_data(uint8_t advertising_data_length, uint8_t * advertising_data){
433445c102fdSMatthias Ringwald     hci_stack->le_advertisements_data_len = advertising_data_length;
433545c102fdSMatthias Ringwald     hci_stack->le_advertisements_data = advertising_data;
4336501f56b3SMatthias Ringwald     hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_SET_ADV_DATA;
4337501f56b3SMatthias Ringwald     gap_advertisments_changed();
433845c102fdSMatthias Ringwald }
4339501f56b3SMatthias Ringwald 
4340501f56b3SMatthias Ringwald /**
4341501f56b3SMatthias Ringwald  * @brief Set Scan Response Data
4342501f56b3SMatthias Ringwald  * @param advertising_data_length
4343501f56b3SMatthias Ringwald  * @param advertising_data (max 31 octets)
4344501f56b3SMatthias Ringwald  * @note data is not copied, pointer has to stay valid
4345501f56b3SMatthias Ringwald  */
4346501f56b3SMatthias Ringwald void gap_scan_response_set_data(uint8_t scan_response_data_length, uint8_t * scan_response_data){
4347501f56b3SMatthias Ringwald     hci_stack->le_scan_response_data_len = scan_response_data_length;
4348501f56b3SMatthias Ringwald     hci_stack->le_scan_response_data = scan_response_data;
4349501f56b3SMatthias Ringwald     hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_SET_SCAN_DATA;
4350501f56b3SMatthias Ringwald     gap_advertisments_changed();
435145c102fdSMatthias Ringwald }
435245c102fdSMatthias Ringwald 
435345c102fdSMatthias Ringwald /**
435445c102fdSMatthias Ringwald  * @brief Set Advertisement Parameters
435545c102fdSMatthias Ringwald  * @param adv_int_min
435645c102fdSMatthias Ringwald  * @param adv_int_max
435745c102fdSMatthias Ringwald  * @param adv_type
435845c102fdSMatthias Ringwald  * @param direct_address_type
435945c102fdSMatthias Ringwald  * @param direct_address
436045c102fdSMatthias Ringwald  * @param channel_map
436145c102fdSMatthias Ringwald  * @param filter_policy
436245c102fdSMatthias Ringwald  *
436345c102fdSMatthias Ringwald  * @note internal use. use gap_advertisements_set_params from gap_le.h instead.
436445c102fdSMatthias Ringwald  */
436545c102fdSMatthias Ringwald  void hci_le_advertisements_set_params(uint16_t adv_int_min, uint16_t adv_int_max, uint8_t adv_type,
4366b95a5a35SMatthias Ringwald     uint8_t direct_address_typ, bd_addr_t direct_address,
436745c102fdSMatthias Ringwald     uint8_t channel_map, uint8_t filter_policy) {
436845c102fdSMatthias Ringwald 
436945c102fdSMatthias Ringwald     hci_stack->le_advertisements_interval_min = adv_int_min;
437045c102fdSMatthias Ringwald     hci_stack->le_advertisements_interval_max = adv_int_max;
437145c102fdSMatthias Ringwald     hci_stack->le_advertisements_type = adv_type;
437245c102fdSMatthias Ringwald     hci_stack->le_advertisements_direct_address_type = direct_address_typ;
437345c102fdSMatthias Ringwald     hci_stack->le_advertisements_channel_map = channel_map;
437445c102fdSMatthias Ringwald     hci_stack->le_advertisements_filter_policy = filter_policy;
437545c102fdSMatthias Ringwald     memcpy(hci_stack->le_advertisements_direct_address, direct_address, 6);
437645c102fdSMatthias Ringwald 
437745c102fdSMatthias Ringwald     hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_SET_PARAMS;
4378501f56b3SMatthias Ringwald     gap_advertisments_changed();
437945c102fdSMatthias Ringwald  }
438045c102fdSMatthias Ringwald 
438145c102fdSMatthias Ringwald /**
438245c102fdSMatthias Ringwald  * @brief Enable/Disable Advertisements
438345c102fdSMatthias Ringwald  * @param enabled
438445c102fdSMatthias Ringwald  */
438545c102fdSMatthias Ringwald void gap_advertisements_enable(int enabled){
438645c102fdSMatthias Ringwald     hci_stack->le_advertisements_enabled = enabled;
438745c102fdSMatthias Ringwald     if (enabled && !hci_stack->le_advertisements_active){
438845c102fdSMatthias Ringwald         hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_ENABLE;
438945c102fdSMatthias Ringwald     }
439045c102fdSMatthias Ringwald     if (!enabled && hci_stack->le_advertisements_active){
439145c102fdSMatthias Ringwald         hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_DISABLE;
439245c102fdSMatthias Ringwald     }
4393cfc59f1bSMatthias Ringwald     hci_run();
439445c102fdSMatthias Ringwald }
439545c102fdSMatthias Ringwald 
439635454696SMatthias Ringwald #endif
439706e5cf96SMatthias Ringwald 
439806e5cf96SMatthias Ringwald void hci_le_set_own_address_type(uint8_t own_address_type){
439906e5cf96SMatthias Ringwald     log_info("hci_le_set_own_address_type: old %u, new %u", hci_stack->le_own_addr_type, own_address_type);
440006e5cf96SMatthias Ringwald     if (own_address_type == hci_stack->le_own_addr_type) return;
440106e5cf96SMatthias Ringwald     hci_stack->le_own_addr_type = own_address_type;
440206e5cf96SMatthias Ringwald 
440364068776SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
440406e5cf96SMatthias Ringwald     // update advertisement parameters, too
440506e5cf96SMatthias Ringwald     hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_SET_PARAMS;
440606e5cf96SMatthias Ringwald     gap_advertisments_changed();
440764068776SMatthias Ringwald #endif
440864068776SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
440906e5cf96SMatthias Ringwald     // note: we don't update scan parameters or modify ongoing connection attempts
441064068776SMatthias Ringwald #endif
441106e5cf96SMatthias Ringwald }
441206e5cf96SMatthias Ringwald 
4413d70217a2SMatthias Ringwald #endif
441445c102fdSMatthias Ringwald 
4415616edd56SMatthias Ringwald uint8_t gap_disconnect(hci_con_handle_t handle){
44165917a5c5S[email protected]     hci_connection_t * conn = hci_connection_for_handle(handle);
44175917a5c5S[email protected]     if (!conn){
44187851196eSmatthias.ringwald         hci_emit_disconnection_complete(handle, 0);
4419616edd56SMatthias Ringwald         return 0;
44205917a5c5S[email protected]     }
44217fd7aa6fSMatthias Ringwald     // ignore if already disconnected
44227fd7aa6fSMatthias Ringwald     if (conn->state == RECEIVED_DISCONNECTION_COMPLETE){
44237fd7aa6fSMatthias Ringwald         return 0;
44247fd7aa6fSMatthias Ringwald     }
44255917a5c5S[email protected]     conn->state = SEND_DISCONNECT;
44265917a5c5S[email protected]     hci_run();
4427616edd56SMatthias Ringwald     return 0;
44284f3229d8S[email protected] }
442904a6ef8cSmatthias.ringwald 
4430a1bf5ae7SMatthias Ringwald /**
4431a1bf5ae7SMatthias Ringwald  * @brief Get connection type
4432a1bf5ae7SMatthias Ringwald  * @param con_handle
4433a1bf5ae7SMatthias Ringwald  * @result connection_type
4434a1bf5ae7SMatthias Ringwald  */
4435a1bf5ae7SMatthias Ringwald gap_connection_type_t gap_get_connection_type(hci_con_handle_t connection_handle){
4436a1bf5ae7SMatthias Ringwald     hci_connection_t * conn = hci_connection_for_handle(connection_handle);
4437a1bf5ae7SMatthias Ringwald     if (!conn) return GAP_CONNECTION_INVALID;
4438a1bf5ae7SMatthias Ringwald     switch (conn->address_type){
4439a1bf5ae7SMatthias Ringwald         case BD_ADDR_TYPE_LE_PUBLIC:
4440a1bf5ae7SMatthias Ringwald         case BD_ADDR_TYPE_LE_RANDOM:
4441a1bf5ae7SMatthias Ringwald             return GAP_CONNECTION_LE;
4442a1bf5ae7SMatthias Ringwald         case BD_ADDR_TYPE_SCO:
4443a1bf5ae7SMatthias Ringwald             return GAP_CONNECTION_SCO;
4444a1bf5ae7SMatthias Ringwald         case BD_ADDR_TYPE_CLASSIC:
4445a1bf5ae7SMatthias Ringwald             return GAP_CONNECTION_ACL;
4446a1bf5ae7SMatthias Ringwald         default:
4447a1bf5ae7SMatthias Ringwald             return GAP_CONNECTION_INVALID;
4448a1bf5ae7SMatthias Ringwald     }
4449a1bf5ae7SMatthias Ringwald }
4450a1bf5ae7SMatthias Ringwald 
4451a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE
44524f551432SMatthias Ringwald 
4453d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
4454d23838ecSMatthias Ringwald /**
4455ac9c45e0SMatthias Ringwald  * @brief Auto Connection Establishment - Start Connecting to device
4456ac9c45e0SMatthias Ringwald  * @param address_typ
4457ac9c45e0SMatthias Ringwald  * @param address
4458ac9c45e0SMatthias Ringwald  * @returns 0 if ok
4459ac9c45e0SMatthias Ringwald  */
44604f551432SMatthias Ringwald int gap_auto_connection_start(bd_addr_type_t address_type, bd_addr_t address){
4461e83201bcSMatthias Ringwald     // check capacity
4462665d90f2SMatthias Ringwald     int num_entries = btstack_linked_list_count(&hci_stack->le_whitelist);
446391915b0bSMatthias Ringwald     if (num_entries >= hci_stack->le_whitelist_capacity) return ERROR_CODE_MEMORY_CAPACITY_EXCEEDED;
4464e83201bcSMatthias Ringwald     whitelist_entry_t * entry = btstack_memory_whitelist_entry_get();
4465e83201bcSMatthias Ringwald     if (!entry) return BTSTACK_MEMORY_ALLOC_FAILED;
4466e83201bcSMatthias Ringwald     entry->address_type = address_type;
4467e83201bcSMatthias Ringwald     memcpy(entry->address, address, 6);
4468e83201bcSMatthias Ringwald     entry->state = LE_WHITELIST_ADD_TO_CONTROLLER;
4469665d90f2SMatthias Ringwald     btstack_linked_list_add(&hci_stack->le_whitelist, (btstack_linked_item_t*) entry);
4470e83201bcSMatthias Ringwald     hci_run();
4471e83201bcSMatthias Ringwald     return 0;
4472ac9c45e0SMatthias Ringwald }
4473ac9c45e0SMatthias Ringwald 
447442ff5ba1SMatthias Ringwald static void hci_remove_from_whitelist(bd_addr_type_t address_type, bd_addr_t address){
4475665d90f2SMatthias Ringwald     btstack_linked_list_iterator_t it;
4476665d90f2SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->le_whitelist);
4477665d90f2SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
4478665d90f2SMatthias Ringwald         whitelist_entry_t * entry = (whitelist_entry_t*) btstack_linked_list_iterator_next(&it);
4479e83201bcSMatthias Ringwald         if (entry->address_type != address_type) continue;
4480e83201bcSMatthias Ringwald         if (memcmp(entry->address, address, 6) != 0) continue;
4481e83201bcSMatthias Ringwald         if (entry->state & LE_WHITELIST_ON_CONTROLLER){
4482e83201bcSMatthias Ringwald             // remove from controller if already present
4483e83201bcSMatthias Ringwald             entry->state |= LE_WHITELIST_REMOVE_FROM_CONTROLLER;
4484e83201bcSMatthias Ringwald             continue;
4485e83201bcSMatthias Ringwald         }
4486e83201bcSMatthias Ringwald         // direclty remove entry from whitelist
4487665d90f2SMatthias Ringwald         btstack_linked_list_iterator_remove(&it);
4488e83201bcSMatthias Ringwald         btstack_memory_whitelist_entry_free(entry);
4489e83201bcSMatthias Ringwald     }
449042ff5ba1SMatthias Ringwald }
449142ff5ba1SMatthias Ringwald 
449242ff5ba1SMatthias Ringwald /**
449342ff5ba1SMatthias Ringwald  * @brief Auto Connection Establishment - Stop Connecting to device
449442ff5ba1SMatthias Ringwald  * @param address_typ
449542ff5ba1SMatthias Ringwald  * @param address
449642ff5ba1SMatthias Ringwald  * @returns 0 if ok
449742ff5ba1SMatthias Ringwald  */
449842ff5ba1SMatthias Ringwald int gap_auto_connection_stop(bd_addr_type_t address_type, bd_addr_t address){
449942ff5ba1SMatthias Ringwald     hci_remove_from_whitelist(address_type, address);
4500e83201bcSMatthias Ringwald     hci_run();
4501e83201bcSMatthias Ringwald     return 0;
4502ac9c45e0SMatthias Ringwald }
4503ac9c45e0SMatthias Ringwald 
4504ac9c45e0SMatthias Ringwald /**
4505ac9c45e0SMatthias Ringwald  * @brief Auto Connection Establishment - Stop everything
4506ac9c45e0SMatthias Ringwald  * @note  Convenience function to stop all active auto connection attempts
4507ac9c45e0SMatthias Ringwald  */
4508ac9c45e0SMatthias Ringwald void gap_auto_connection_stop_all(void){
4509665d90f2SMatthias Ringwald     btstack_linked_list_iterator_t it;
4510665d90f2SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->le_whitelist);
4511665d90f2SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
4512665d90f2SMatthias Ringwald         whitelist_entry_t * entry = (whitelist_entry_t*) btstack_linked_list_iterator_next(&it);
4513e83201bcSMatthias Ringwald         if (entry->state & LE_WHITELIST_ON_CONTROLLER){
4514e83201bcSMatthias Ringwald             // remove from controller if already present
4515e83201bcSMatthias Ringwald             entry->state |= LE_WHITELIST_REMOVE_FROM_CONTROLLER;
4516e83201bcSMatthias Ringwald             continue;
4517e83201bcSMatthias Ringwald         }
451891915b0bSMatthias Ringwald         // directly remove entry from whitelist
4519665d90f2SMatthias Ringwald         btstack_linked_list_iterator_remove(&it);
4520e83201bcSMatthias Ringwald         btstack_memory_whitelist_entry_free(entry);
4521e83201bcSMatthias Ringwald     }
4522e83201bcSMatthias Ringwald     hci_run();
4523ac9c45e0SMatthias Ringwald }
4524d70217a2SMatthias Ringwald #endif
45254f551432SMatthias Ringwald #endif
45264f551432SMatthias Ringwald 
452735454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
4528ac9c45e0SMatthias Ringwald /**
4529ff00ed1cSMatthias Ringwald  * @brief Set Extended Inquiry Response data
4530ff00ed1cSMatthias Ringwald  * @param eir_data size 240 bytes, is not copied make sure memory is accessible during stack startup
4531ff00ed1cSMatthias Ringwald  * @note has to be done before stack starts up
4532ff00ed1cSMatthias Ringwald  */
4533ff00ed1cSMatthias Ringwald void gap_set_extended_inquiry_response(const uint8_t * data){
4534ff00ed1cSMatthias Ringwald     hci_stack->eir_data = data;
4535ff00ed1cSMatthias Ringwald }
4536ff00ed1cSMatthias Ringwald 
4537ff00ed1cSMatthias Ringwald /**
4538f5875de5SMatthias Ringwald  * @brief Start GAP Classic Inquiry
4539f5875de5SMatthias Ringwald  * @param duration in 1.28s units
4540f5875de5SMatthias Ringwald  * @return 0 if ok
4541f5875de5SMatthias Ringwald  * @events: GAP_EVENT_INQUIRY_RESULT, GAP_EVENT_INQUIRY_COMPLETE
4542f5875de5SMatthias Ringwald  */
4543f5875de5SMatthias Ringwald int gap_inquiry_start(uint8_t duration_in_1280ms_units){
4544f5875de5SMatthias Ringwald     if (hci_stack->inquiry_state != GAP_INQUIRY_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED;
4545f5875de5SMatthias Ringwald     if (duration_in_1280ms_units < GAP_INQUIRY_DURATION_MIN || duration_in_1280ms_units > GAP_INQUIRY_DURATION_MAX){
4546f5875de5SMatthias Ringwald         return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS;
4547f5875de5SMatthias Ringwald     }
4548f5875de5SMatthias Ringwald     hci_stack->inquiry_state = duration_in_1280ms_units;
4549f5875de5SMatthias Ringwald     hci_run();
4550f5875de5SMatthias Ringwald     return 0;
4551f5875de5SMatthias Ringwald }
4552f5875de5SMatthias Ringwald 
4553f5875de5SMatthias Ringwald /**
4554f5875de5SMatthias Ringwald  * @brief Stop GAP Classic Inquiry
4555f5875de5SMatthias Ringwald  * @returns 0 if ok
4556f5875de5SMatthias Ringwald  */
4557f5875de5SMatthias Ringwald int gap_inquiry_stop(void){
4558f5875de5SMatthias Ringwald     if (hci_stack->inquiry_state >= GAP_INQUIRY_DURATION_MIN || hci_stack->inquiry_state <= GAP_INQUIRY_DURATION_MAX) {
4559f5875de5SMatthias Ringwald         // emit inquiry complete event, before it even started
4560f5875de5SMatthias Ringwald         uint8_t event[] = { GAP_EVENT_INQUIRY_COMPLETE, 1, 0};
4561f5875de5SMatthias Ringwald         hci_emit_event(event, sizeof(event), 1);
4562f5875de5SMatthias Ringwald         return 0;
4563f5875de5SMatthias Ringwald     }
4564f5875de5SMatthias Ringwald     if (hci_stack->inquiry_state != GAP_INQUIRY_STATE_ACTIVE) return ERROR_CODE_COMMAND_DISALLOWED;
4565f5875de5SMatthias Ringwald     hci_stack->inquiry_state = GAP_INQUIRY_STATE_W2_CANCEL;
4566f5875de5SMatthias Ringwald     hci_run();
4567f5875de5SMatthias Ringwald     return 0;
4568f5875de5SMatthias Ringwald }
4569f5875de5SMatthias Ringwald 
4570b7f1ee76SMatthias Ringwald 
4571b7f1ee76SMatthias Ringwald /**
4572b7f1ee76SMatthias Ringwald  * @brief Remote Name Request
4573b7f1ee76SMatthias Ringwald  * @param addr
4574b7f1ee76SMatthias Ringwald  * @param page_scan_repetition_mode
4575b7f1ee76SMatthias Ringwald  * @param clock_offset only used when bit 15 is set
4576b7f1ee76SMatthias Ringwald  * @events: HCI_EVENT_REMOTE_NAME_REQUEST_COMPLETE
4577b7f1ee76SMatthias Ringwald  */
4578b7f1ee76SMatthias Ringwald int gap_remote_name_request(bd_addr_t addr, uint8_t page_scan_repetition_mode, uint16_t clock_offset){
4579b7f1ee76SMatthias Ringwald     if (hci_stack->remote_name_state != GAP_REMOTE_NAME_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED;
4580b7f1ee76SMatthias Ringwald     memcpy(hci_stack->remote_name_addr, addr, 6);
4581b7f1ee76SMatthias Ringwald     hci_stack->remote_name_page_scan_repetition_mode = page_scan_repetition_mode;
4582b7f1ee76SMatthias Ringwald     hci_stack->remote_name_clock_offset = clock_offset;
4583b7f1ee76SMatthias Ringwald     hci_stack->remote_name_state = GAP_REMOTE_NAME_STATE_W2_SEND;
4584b7f1ee76SMatthias Ringwald     hci_run();
4585b7f1ee76SMatthias Ringwald     return 0;
4586b7f1ee76SMatthias Ringwald }
4587b7f1ee76SMatthias Ringwald 
45880a51f88bSMatthias Ringwald static int gap_pairing_set_state_and_run(bd_addr_t addr, uint8_t state){
45890a51f88bSMatthias Ringwald     hci_stack->gap_pairing_state = state;
45900a51f88bSMatthias Ringwald     memcpy(hci_stack->gap_pairing_addr, addr, 6);
45910a51f88bSMatthias Ringwald     hci_run();
45920a51f88bSMatthias Ringwald     return 0;
45930a51f88bSMatthias Ringwald }
45940a51f88bSMatthias Ringwald 
45950a51f88bSMatthias Ringwald /**
45960a51f88bSMatthias Ringwald  * @brief Legacy Pairing Pin Code Response
45970a51f88bSMatthias Ringwald  * @param addr
45980a51f88bSMatthias Ringwald  * @param pin
45990a51f88bSMatthias Ringwald  * @return 0 if ok
46000a51f88bSMatthias Ringwald  */
46010a51f88bSMatthias Ringwald int gap_pin_code_response(bd_addr_t addr, const char * pin){
4602cd74063aSMatthias Ringwald     if (hci_stack->gap_pairing_state != GAP_PAIRING_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED;
4603d504181aSMatthias Ringwald     hci_stack->gap_pairing_input.gap_pairing_pin = pin;
46040a51f88bSMatthias Ringwald     return gap_pairing_set_state_and_run(addr, GAP_PAIRING_STATE_SEND_PIN);
46050a51f88bSMatthias Ringwald }
46060a51f88bSMatthias Ringwald 
46070a51f88bSMatthias Ringwald /**
46080a51f88bSMatthias Ringwald  * @brief Abort Legacy Pairing
46090a51f88bSMatthias Ringwald  * @param addr
46100a51f88bSMatthias Ringwald  * @param pin
46110a51f88bSMatthias Ringwald  * @return 0 if ok
46120a51f88bSMatthias Ringwald  */
46130a51f88bSMatthias Ringwald int gap_pin_code_negative(bd_addr_t addr){
4614cd74063aSMatthias Ringwald     if (hci_stack->gap_pairing_state != GAP_PAIRING_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED;
46150a51f88bSMatthias Ringwald     return gap_pairing_set_state_and_run(addr, GAP_PAIRING_STATE_SEND_PIN_NEGATIVE);
46160a51f88bSMatthias Ringwald }
46170a51f88bSMatthias Ringwald 
46180a51f88bSMatthias Ringwald /**
46190a51f88bSMatthias Ringwald  * @brief SSP Passkey Response
46200a51f88bSMatthias Ringwald  * @param addr
46210a51f88bSMatthias Ringwald  * @param passkey
46220a51f88bSMatthias Ringwald  * @return 0 if ok
46230a51f88bSMatthias Ringwald  */
46240a51f88bSMatthias Ringwald int gap_ssp_passkey_response(bd_addr_t addr, uint32_t passkey){
4625cd74063aSMatthias Ringwald     if (hci_stack->gap_pairing_state != GAP_PAIRING_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED;
4626d504181aSMatthias Ringwald     hci_stack->gap_pairing_input.gap_pairing_passkey = passkey;
46270a51f88bSMatthias Ringwald     return gap_pairing_set_state_and_run(addr, GAP_PAIRING_STATE_SEND_PASSKEY);
46280a51f88bSMatthias Ringwald }
46290a51f88bSMatthias Ringwald 
46300a51f88bSMatthias Ringwald /**
46310a51f88bSMatthias Ringwald  * @brief Abort SSP Passkey Entry/Pairing
46320a51f88bSMatthias Ringwald  * @param addr
46330a51f88bSMatthias Ringwald  * @param pin
46340a51f88bSMatthias Ringwald  * @return 0 if ok
46350a51f88bSMatthias Ringwald  */
46360a51f88bSMatthias Ringwald int gap_ssp_passkey_negative(bd_addr_t addr){
4637cd74063aSMatthias Ringwald     if (hci_stack->gap_pairing_state != GAP_PAIRING_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED;
46380a51f88bSMatthias Ringwald     return gap_pairing_set_state_and_run(addr, GAP_PAIRING_STATE_SEND_PASSKEY_NEGATIVE);
46390a51f88bSMatthias Ringwald }
46400a51f88bSMatthias Ringwald 
46410a51f88bSMatthias Ringwald /**
46420a51f88bSMatthias Ringwald  * @brief Accept SSP Numeric Comparison
46430a51f88bSMatthias Ringwald  * @param addr
46440a51f88bSMatthias Ringwald  * @param passkey
46450a51f88bSMatthias Ringwald  * @return 0 if ok
46460a51f88bSMatthias Ringwald  */
46470a51f88bSMatthias Ringwald int gap_ssp_confirmation_response(bd_addr_t addr){
4648cd74063aSMatthias Ringwald     if (hci_stack->gap_pairing_state != GAP_PAIRING_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED;
46490a51f88bSMatthias Ringwald     return gap_pairing_set_state_and_run(addr, GAP_PAIRING_STATE_SEND_CONFIRMATION);
46500a51f88bSMatthias Ringwald }
46510a51f88bSMatthias Ringwald 
46520a51f88bSMatthias Ringwald /**
46530a51f88bSMatthias Ringwald  * @brief Abort SSP Numeric Comparison/Pairing
46540a51f88bSMatthias Ringwald  * @param addr
46550a51f88bSMatthias Ringwald  * @param pin
46560a51f88bSMatthias Ringwald  * @return 0 if ok
46570a51f88bSMatthias Ringwald  */
46580a51f88bSMatthias Ringwald int gap_ssp_confirmation_negative(bd_addr_t addr){
4659cd74063aSMatthias Ringwald     if (hci_stack->gap_pairing_state != GAP_PAIRING_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED;
46600a51f88bSMatthias Ringwald     return gap_pairing_set_state_and_run(addr, GAP_PAIRING_STATE_SEND_CONFIRMATION_NEGATIVE);
46610a51f88bSMatthias Ringwald }
46620a51f88bSMatthias Ringwald 
4663f5875de5SMatthias Ringwald /**
4664f6858d14SMatthias Ringwald  * @brief Set inquiry mode: standard, with RSSI, with RSSI + Extended Inquiry Results. Has to be called before power on.
4665f5875de5SMatthias Ringwald  * @param inquiry_mode see bluetooth_defines.h
4666f6858d14SMatthias Ringwald  */
4667f6858d14SMatthias Ringwald void hci_set_inquiry_mode(inquiry_mode_t mode){
4668f6858d14SMatthias Ringwald     hci_stack->inquiry_mode = mode;
4669f6858d14SMatthias Ringwald }
4670f6858d14SMatthias Ringwald 
4671f6858d14SMatthias Ringwald /**
4672d950d659SMatthias Ringwald  * @brief Configure Voice Setting for use with SCO data in HSP/HFP
4673d950d659SMatthias Ringwald  */
4674d950d659SMatthias Ringwald void hci_set_sco_voice_setting(uint16_t voice_setting){
4675d950d659SMatthias Ringwald     hci_stack->sco_voice_setting = voice_setting;
4676d950d659SMatthias Ringwald }
4677d950d659SMatthias Ringwald 
4678d950d659SMatthias Ringwald /**
4679d950d659SMatthias Ringwald  * @brief Get SCO Voice Setting
4680d950d659SMatthias Ringwald  * @return current voice setting
4681d950d659SMatthias Ringwald  */
46820cb5b971SMatthias Ringwald uint16_t hci_get_sco_voice_setting(void){
4683d950d659SMatthias Ringwald     return hci_stack->sco_voice_setting;
4684d950d659SMatthias Ringwald }
4685d950d659SMatthias Ringwald 
4686b3aad8daSMatthias Ringwald /** @brief Get SCO packet length for current SCO Voice setting
4687b3aad8daSMatthias Ringwald  *  @note  Using SCO packets of the exact length is required for USB transfer
4688b3aad8daSMatthias Ringwald  *  @return Length of SCO packets in bytes (not audio frames)
4689b3aad8daSMatthias Ringwald  */
4690b3aad8daSMatthias Ringwald int hci_get_sco_packet_length(void){
4691a3069afeSMatthias Ringwald     int sco_packet_length = 0;
4692a3069afeSMatthias Ringwald 
4693a3069afeSMatthias Ringwald #ifdef ENABLE_CLASSIC
4694a3069afeSMatthias Ringwald #ifdef ENABLE_SCO_OVER_HCI
4695b3aad8daSMatthias Ringwald     // see Core Spec for H2 USB Transfer.
4696cf119f3bSMatthias Ringwald 
4697cf119f3bSMatthias Ringwald     // CVSD requires twice as much bytes
4698cf119f3bSMatthias Ringwald     int multiplier = hci_stack->sco_voice_setting & 0x0020 ? 2 : 1;
4699cf119f3bSMatthias Ringwald 
4700cf119f3bSMatthias Ringwald     // 3 byte SCO header + 24 bytes per connection
4701a3069afeSMatthias Ringwald     sco_packet_length = 3 + 24 * hci_number_sco_connections() * multiplier;
4702a3069afeSMatthias Ringwald #endif
4703a3069afeSMatthias Ringwald #endif
4704a3069afeSMatthias Ringwald     return sco_packet_length;
4705b3aad8daSMatthias Ringwald }
4706b3aad8daSMatthias Ringwald 
4707c4c88f1bSJakob Krantz /**
4708c4c88f1bSJakob Krantz * @brief Sets the master/slave policy
4709c4c88f1bSJakob Krantz * @param policy (0: attempt to become master, 1: let connecting device decide)
4710c4c88f1bSJakob Krantz */
4711c4c88f1bSJakob Krantz void hci_set_master_slave_policy(uint8_t policy){
4712c4c88f1bSJakob Krantz     hci_stack->master_slave_policy = policy;
4713c4c88f1bSJakob Krantz }
4714c4c88f1bSJakob Krantz 
4715c4c88f1bSJakob Krantz #endif
4716ec111c8bSMatthias Ringwald 
4717ec111c8bSMatthias Ringwald HCI_STATE hci_get_state(void){
4718ec111c8bSMatthias Ringwald     return hci_stack->state;
4719ec111c8bSMatthias Ringwald }
4720ec111c8bSMatthias Ringwald 
4721ec111c8bSMatthias Ringwald 
4722d950d659SMatthias Ringwald /**
4723d23838ecSMatthias Ringwald  * @brief Set callback for Bluetooth Hardware Error
4724d23838ecSMatthias Ringwald  */
4725c2e1fa60SMatthias Ringwald void hci_set_hardware_error_callback(void (*fn)(uint8_t error)){
4726d23838ecSMatthias Ringwald     hci_stack->hardware_error_callback = fn;
4727d23838ecSMatthias Ringwald }
4728d23838ecSMatthias Ringwald 
472971de195eSMatthias Ringwald void hci_disconnect_all(void){
4730665d90f2SMatthias Ringwald     btstack_linked_list_iterator_t it;
4731665d90f2SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->connections);
4732665d90f2SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
4733665d90f2SMatthias Ringwald         hci_connection_t * con = (hci_connection_t*) btstack_linked_list_iterator_next(&it);
473404a6ef8cSmatthias.ringwald         if (con->state == SENT_DISCONNECT) continue;
473504a6ef8cSmatthias.ringwald         con->state = SEND_DISCONNECT;
473604a6ef8cSmatthias.ringwald     }
4737d31fba26S[email protected]     hci_run();
473804a6ef8cSmatthias.ringwald }
473933373e40SMatthias Ringwald 
474033373e40SMatthias Ringwald uint16_t hci_get_manufacturer(void){
474133373e40SMatthias Ringwald     return hci_stack->manufacturer;
474233373e40SMatthias Ringwald }
47439c6e867eSMatthias Ringwald 
47443e329ddfSandryblack #ifdef ENABLE_BLE
47453e329ddfSandryblack 
47469c6e867eSMatthias Ringwald static sm_connection_t * sm_get_connection_for_handle(hci_con_handle_t con_handle){
47479c6e867eSMatthias Ringwald     hci_connection_t * hci_con = hci_connection_for_handle(con_handle);
47489c6e867eSMatthias Ringwald     if (!hci_con) return NULL;
47499c6e867eSMatthias Ringwald     return &hci_con->sm_connection;
47509c6e867eSMatthias Ringwald }
47519c6e867eSMatthias Ringwald 
47529c6e867eSMatthias Ringwald // extracted from sm.c to allow enabling of l2cap le data channels without adding sm.c to the build
47539c6e867eSMatthias Ringwald // without sm.c default values from create_connection_for_bd_addr_and_type() resulg in non-encrypted, not-authenticated
47549c6e867eSMatthias Ringwald 
47559c6e867eSMatthias Ringwald int gap_encryption_key_size(hci_con_handle_t con_handle){
47569c6e867eSMatthias Ringwald     sm_connection_t * sm_conn = sm_get_connection_for_handle(con_handle);
47579c6e867eSMatthias Ringwald     if (!sm_conn) return 0;     // wrong connection
47589c6e867eSMatthias Ringwald     if (!sm_conn->sm_connection_encrypted) return 0;
47599c6e867eSMatthias Ringwald     return sm_conn->sm_actual_encryption_key_size;
47609c6e867eSMatthias Ringwald }
47619c6e867eSMatthias Ringwald 
47629c6e867eSMatthias Ringwald int gap_authenticated(hci_con_handle_t con_handle){
47639c6e867eSMatthias Ringwald     sm_connection_t * sm_conn = sm_get_connection_for_handle(con_handle);
47649c6e867eSMatthias Ringwald     if (!sm_conn) return 0;     // wrong connection
47659c6e867eSMatthias Ringwald     if (!sm_conn->sm_connection_encrypted) return 0; // unencrypted connection cannot be authenticated
47669c6e867eSMatthias Ringwald     return sm_conn->sm_connection_authenticated;
47679c6e867eSMatthias Ringwald }
47689c6e867eSMatthias Ringwald 
47699c6e867eSMatthias Ringwald authorization_state_t gap_authorization_state(hci_con_handle_t con_handle){
47709c6e867eSMatthias Ringwald     sm_connection_t * sm_conn = sm_get_connection_for_handle(con_handle);
47719c6e867eSMatthias Ringwald     if (!sm_conn) return AUTHORIZATION_UNKNOWN;     // wrong connection
47729c6e867eSMatthias Ringwald     if (!sm_conn->sm_connection_encrypted)               return AUTHORIZATION_UNKNOWN; // unencrypted connection cannot be authorized
47739c6e867eSMatthias Ringwald     if (!sm_conn->sm_connection_authenticated)           return AUTHORIZATION_UNKNOWN; // unauthenticatd connection cannot be authorized
47749c6e867eSMatthias Ringwald     return sm_conn->sm_connection_authorization_state;
47759c6e867eSMatthias Ringwald }
47769c6e867eSMatthias Ringwald #endif
4777