xref: /btstack/src/hci.c (revision 3905afbfd96e9d06c62bcf4e707fabca15750b53)
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 
381713bceaSmatthias.ringwald /*
391f504dbdSmatthias.ringwald  *  hci.c
401f504dbdSmatthias.ringwald  *
411f504dbdSmatthias.ringwald  *  Created by Matthias Ringwald on 4/29/09.
421f504dbdSmatthias.ringwald  *
431f504dbdSmatthias.ringwald  */
441f504dbdSmatthias.ringwald 
457907f069SMatthias Ringwald #include "btstack_config.h"
4628171530Smatthias.ringwald 
477f2435e6Smatthias.ringwald 
48aec7654dSMatthias Ringwald #ifdef HAVE_EMBEDDED_TICK
498f2a52f4SMatthias Ringwald #include "btstack_run_loop_embedded.h"
50a484130cSMatthias Ringwald #endif
51a484130cSMatthias Ringwald 
524a3574a1SMatthias Ringwald #ifdef HAVE_PLATFORM_IPHONE_OS
53d0b87befSMatthias Ringwald #include "../port/ios/src/btstack_control_iphone.h"
544a3574a1SMatthias Ringwald #endif
554a3574a1SMatthias Ringwald 
56a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE
57472a5742SMatthias Ringwald #include "gap.h"
5845c102fdSMatthias Ringwald #endif
5945c102fdSMatthias Ringwald 
6093b8dc03Smatthias.ringwald #include <stdarg.h>
6193b8dc03Smatthias.ringwald #include <string.h>
6256fe0872Smatthias.ringwald #include <stdio.h>
635838a2edSMatthias Ringwald #include <inttypes.h>
647f2435e6Smatthias.ringwald 
6516ece135SMatthias Ringwald #include "btstack_debug.h"
660e2df43fSMatthias Ringwald #include "btstack_event.h"
674a3574a1SMatthias Ringwald #include "btstack_linked_list.h"
684a3574a1SMatthias Ringwald #include "btstack_memory.h"
694a3574a1SMatthias Ringwald #include "gap.h"
704a3574a1SMatthias Ringwald #include "hci.h"
714a3574a1SMatthias Ringwald #include "hci_cmd.h"
72d8905019Smatthias.ringwald #include "hci_dump.h"
7393b8dc03Smatthias.ringwald 
741b0e3922Smatthias.ringwald 
75169f8b28Smatthias.ringwald #define HCI_CONNECTION_TIMEOUT_MS 10000
76659d758cSMatthias Ringwald #define HCI_RESET_RESEND_TIMEOUT_MS 200
77ee091cf1Smatthias.ringwald 
78b83d5eabSMatthias Ringwald // prototypes
79758b46ceSmatthias.ringwald static void hci_update_scan_enable(void);
80a00031e2S[email protected] static gap_security_level_t gap_security_level_for_connection(hci_connection_t * connection);
81ec820d77SMatthias Ringwald static void hci_connection_timeout_handler(btstack_timer_source_t *timer);
8296a45072S[email protected] static void hci_connection_timestamp(hci_connection_t *connection);
837586ee35S[email protected] static int  hci_power_control_on(void);
847586ee35S[email protected] static void hci_power_control_off(void);
856da48142SSean Wilson static void hci_state_reset(void);
862deddeceSMatthias Ringwald static void hci_emit_connection_complete(bd_addr_t address, hci_con_handle_t con_handle, uint8_t status);
87b83d5eabSMatthias Ringwald static void hci_emit_l2cap_check_timeout(hci_connection_t *conn);
88fc64f94aSMatthias Ringwald static void hci_emit_disconnection_complete(hci_con_handle_t con_handle, uint8_t reason);
89b83d5eabSMatthias Ringwald static void hci_emit_nr_connections_changed(void);
90b83d5eabSMatthias Ringwald static void hci_emit_hci_open_failed(void);
91b83d5eabSMatthias Ringwald static void hci_emit_discoverable_enabled(uint8_t enabled);
92b83d5eabSMatthias Ringwald static void hci_emit_security_level(hci_con_handle_t con_handle, gap_security_level_t level);
93b83d5eabSMatthias Ringwald static void hci_emit_dedicated_bonding_result(bd_addr_t address, uint8_t status);
94b83d5eabSMatthias Ringwald static void hci_emit_event(uint8_t * event, uint16_t size, int dump);
95b83d5eabSMatthias Ringwald static void hci_emit_acl_packet(uint8_t * packet, uint16_t size);
96b83d5eabSMatthias Ringwald static void hci_notify_if_sco_can_send_now(void);
9795d71764SMatthias Ringwald static void hci_run(void);
9895d71764SMatthias Ringwald static int  hci_is_le_connection(hci_connection_t * connection);
9995d71764SMatthias Ringwald static int  hci_number_free_acl_slots_for_connection_type( bd_addr_type_t address_type);
10095d71764SMatthias Ringwald static int  hci_local_ssp_activated(void);
10195d71764SMatthias Ringwald static int  hci_remote_ssp_supported(hci_con_handle_t con_handle);
1025d509858SMatthias Ringwald 
103a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE
10439677e66SMatthias Ringwald // called from test/ble_client/advertising_data_parser.c
10539677e66SMatthias Ringwald void le_handle_advertisement_report(uint8_t *packet, int size);
10642ff5ba1SMatthias Ringwald static void hci_remove_from_whitelist(bd_addr_type_t address_type, bd_addr_t address);
1075d509858SMatthias Ringwald #endif
108758b46ceSmatthias.ringwald 
10906b35ec0Smatthias.ringwald // the STACK is here
1103a9fb326S[email protected] #ifndef HAVE_MALLOC
1113a9fb326S[email protected] static hci_stack_t   hci_stack_static;
1123a9fb326S[email protected] #endif
1133a9fb326S[email protected] static hci_stack_t * hci_stack = NULL;
11416833f0aSmatthias.ringwald 
11566fb9560S[email protected] // test helper
11666fb9560S[email protected] static uint8_t disable_l2cap_timeouts = 0;
11766fb9560S[email protected] 
11896a45072S[email protected] /**
11996a45072S[email protected]  * create connection for given address
12096a45072S[email protected]  *
12196a45072S[email protected]  * @return connection OR NULL, if no memory left
12296a45072S[email protected]  */
12396a45072S[email protected] static hci_connection_t * create_connection_for_bd_addr_and_type(bd_addr_t addr, bd_addr_type_t addr_type){
1241a06f663S[email protected]     log_info("create_connection_for_addr %s, type %x", bd_addr_to_str(addr), addr_type);
125bb69aaaeS[email protected]     hci_connection_t * conn = btstack_memory_hci_connection_get();
12696a45072S[email protected]     if (!conn) return NULL;
127c91d150bS[email protected]     memset(conn, 0, sizeof(hci_connection_t));
128058e3d6bSMatthias Ringwald     bd_addr_copy(conn->address, addr);
12996a45072S[email protected]     conn->address_type = addr_type;
13096a45072S[email protected]     conn->con_handle = 0xffff;
13196a45072S[email protected]     conn->authentication_flags = AUTH_FLAGS_NONE;
13296a45072S[email protected]     conn->bonding_flags = 0;
13396a45072S[email protected]     conn->requested_security_level = LEVEL_0;
13491a977e8SMatthias Ringwald     btstack_run_loop_set_timer_handler(&conn->timeout, hci_connection_timeout_handler);
13591a977e8SMatthias Ringwald     btstack_run_loop_set_timer_context(&conn->timeout, conn);
13696a45072S[email protected]     hci_connection_timestamp(conn);
13796a45072S[email protected]     conn->acl_recombination_length = 0;
13896a45072S[email protected]     conn->acl_recombination_pos = 0;
13996a45072S[email protected]     conn->num_acl_packets_sent = 0;
1401a06f663S[email protected]     conn->num_sco_packets_sent = 0;
141da886c03S[email protected]     conn->le_con_parameter_update_state = CON_PARAMETER_UPDATE_NONE;
142665d90f2SMatthias Ringwald     btstack_linked_list_add(&hci_stack->connections, (btstack_linked_item_t *) conn);
14396a45072S[email protected]     return conn;
14496a45072S[email protected] }
14566fb9560S[email protected] 
146da886c03S[email protected] 
147da886c03S[email protected] /**
148da886c03S[email protected]  * get le connection parameter range
149da886c03S[email protected] *
150da886c03S[email protected]  * @return le connection parameter range struct
151da886c03S[email protected]  */
1524ced4e8cSMatthias Ringwald void gap_get_connection_parameter_range(le_connection_parameter_range_t * range){
1534ced4e8cSMatthias Ringwald     *range = hci_stack->le_connection_parameter_range;
154da886c03S[email protected] }
155da886c03S[email protected] 
156da886c03S[email protected] /**
157da886c03S[email protected]  * set le connection parameter range
158da886c03S[email protected]  *
159da886c03S[email protected]  */
160da886c03S[email protected] 
1614ced4e8cSMatthias Ringwald void gap_set_connection_parameter_range(le_connection_parameter_range_t *range){
1624ced4e8cSMatthias Ringwald     hci_stack->le_connection_parameter_range = *range;
163da886c03S[email protected] }
164da886c03S[email protected] 
165da886c03S[email protected] /**
166da886c03S[email protected]  * get hci connections iterator
167da886c03S[email protected]  *
168da886c03S[email protected]  * @return hci connections iterator
169da886c03S[email protected]  */
170da886c03S[email protected] 
171665d90f2SMatthias Ringwald void hci_connections_get_iterator(btstack_linked_list_iterator_t *it){
172665d90f2SMatthias Ringwald     btstack_linked_list_iterator_init(it, &hci_stack->connections);
173da886c03S[email protected] }
174da886c03S[email protected] 
17597addcc5Smatthias.ringwald /**
176ee091cf1Smatthias.ringwald  * get connection for a given handle
177ee091cf1Smatthias.ringwald  *
178ee091cf1Smatthias.ringwald  * @return connection OR NULL, if not found
179ee091cf1Smatthias.ringwald  */
1805061f3afS[email protected] hci_connection_t * hci_connection_for_handle(hci_con_handle_t con_handle){
181665d90f2SMatthias Ringwald     btstack_linked_list_iterator_t it;
182665d90f2SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->connections);
183665d90f2SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
184665d90f2SMatthias Ringwald         hci_connection_t * item = (hci_connection_t *) btstack_linked_list_iterator_next(&it);
1853ac2fe56S[email protected]         if ( item->con_handle == con_handle ) {
186da886c03S[email protected]             return item;
187ee091cf1Smatthias.ringwald         }
188ee091cf1Smatthias.ringwald     }
189ee091cf1Smatthias.ringwald     return NULL;
190ee091cf1Smatthias.ringwald }
191ee091cf1Smatthias.ringwald 
19296a45072S[email protected] /**
19396a45072S[email protected]  * get connection for given address
19496a45072S[email protected]  *
19596a45072S[email protected]  * @return connection OR NULL, if not found
19696a45072S[email protected]  */
1972e77e513S[email protected] hci_connection_t * hci_connection_for_bd_addr_and_type(bd_addr_t  addr, bd_addr_type_t addr_type){
198665d90f2SMatthias Ringwald     btstack_linked_list_iterator_t it;
199665d90f2SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->connections);
200665d90f2SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
201665d90f2SMatthias Ringwald         hci_connection_t * connection = (hci_connection_t *) btstack_linked_list_iterator_next(&it);
20296a45072S[email protected]         if (connection->address_type != addr_type)  continue;
20396a45072S[email protected]         if (memcmp(addr, connection->address, 6) != 0) continue;
20462bda3fbS[email protected]         return connection;
20562bda3fbS[email protected]     }
20662bda3fbS[email protected]     return NULL;
20762bda3fbS[email protected] }
20862bda3fbS[email protected] 
209ec820d77SMatthias Ringwald static void hci_connection_timeout_handler(btstack_timer_source_t *timer){
21091a977e8SMatthias Ringwald     hci_connection_t * connection = (hci_connection_t *) btstack_run_loop_get_timer_context(timer);
211aec7654dSMatthias Ringwald #ifdef HAVE_EMBEDDED_TICK
212528a4a3bSMatthias Ringwald     if (btstack_run_loop_embedded_get_ticks() > connection->timestamp + btstack_run_loop_embedded_ticks_for_ms(HCI_CONNECTION_TIMEOUT_MS)){
213c785ef68Smatthias.ringwald         // connections might be timed out
214c785ef68Smatthias.ringwald         hci_emit_l2cap_check_timeout(connection);
215c785ef68Smatthias.ringwald     }
216f316a845SMatthias Ringwald #else
217528a4a3bSMatthias Ringwald     if (btstack_run_loop_get_time_ms() > connection->timestamp + HCI_CONNECTION_TIMEOUT_MS){
2185f26aadcSMatthias Ringwald         // connections might be timed out
2195f26aadcSMatthias Ringwald         hci_emit_l2cap_check_timeout(connection);
2205f26aadcSMatthias Ringwald     }
2215f26aadcSMatthias Ringwald #endif
222c785ef68Smatthias.ringwald }
223ee091cf1Smatthias.ringwald 
224ee091cf1Smatthias.ringwald static void hci_connection_timestamp(hci_connection_t *connection){
225aec7654dSMatthias Ringwald #ifdef HAVE_EMBEDDED_TICK
226528a4a3bSMatthias Ringwald     connection->timestamp = btstack_run_loop_embedded_get_ticks();
227f316a845SMatthias Ringwald #else
228528a4a3bSMatthias Ringwald     connection->timestamp = btstack_run_loop_get_time_ms();
2295f26aadcSMatthias Ringwald #endif
230ee091cf1Smatthias.ringwald }
231ee091cf1Smatthias.ringwald 
23206b35ec0Smatthias.ringwald 
23328ca2b46S[email protected] inline static void connectionSetAuthenticationFlags(hci_connection_t * conn, hci_authentication_flags_t flags){
23428ca2b46S[email protected]     conn->authentication_flags = (hci_authentication_flags_t)(conn->authentication_flags | flags);
23528ca2b46S[email protected] }
23628ca2b46S[email protected] 
23728ca2b46S[email protected] inline static void connectionClearAuthenticationFlags(hci_connection_t * conn, hci_authentication_flags_t flags){
23828ca2b46S[email protected]     conn->authentication_flags = (hci_authentication_flags_t)(conn->authentication_flags & ~flags);
23928ca2b46S[email protected] }
24028ca2b46S[email protected] 
24128ca2b46S[email protected] 
24243bfb1bdSmatthias.ringwald /**
24380ca58a0Smatthias.ringwald  * add authentication flags and reset timer
24496a45072S[email protected]  * @note: assumes classic connection
2452e77e513S[email protected]  * @note: bd_addr is passed in as litle endian uint8_t * as it is called from parsing packets
2467fde4af9Smatthias.ringwald  */
2477fde4af9Smatthias.ringwald static void hci_add_connection_flags_for_flipped_bd_addr(uint8_t *bd_addr, hci_authentication_flags_t flags){
2487fde4af9Smatthias.ringwald     bd_addr_t addr;
249724d70a2SMatthias Ringwald     reverse_bd_addr(bd_addr, addr);
2502e77e513S[email protected]     hci_connection_t * conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_CLASSIC);
2517fde4af9Smatthias.ringwald     if (conn) {
25228ca2b46S[email protected]         connectionSetAuthenticationFlags(conn, flags);
25380ca58a0Smatthias.ringwald         hci_connection_timestamp(conn);
2547fde4af9Smatthias.ringwald     }
2557fde4af9Smatthias.ringwald }
2567fde4af9Smatthias.ringwald 
25780ca58a0Smatthias.ringwald int  hci_authentication_active_for_handle(hci_con_handle_t handle){
2585061f3afS[email protected]     hci_connection_t * conn = hci_connection_for_handle(handle);
25980ca58a0Smatthias.ringwald     if (!conn) return 0;
2606724cd9eS[email protected]     if (conn->authentication_flags & LEGACY_PAIRING_ACTIVE) return 1;
2616724cd9eS[email protected]     if (conn->authentication_flags & SSP_PAIRING_ACTIVE) return 1;
2626724cd9eS[email protected]     return 0;
26380ca58a0Smatthias.ringwald }
26480ca58a0Smatthias.ringwald 
26515a95bd5SMatthias Ringwald void gap_drop_link_key_for_bd_addr(bd_addr_t addr){
26655597469SMatthias Ringwald     if (!hci_stack->link_key_db) return;
2672bacf595SMatthias Ringwald     log_info("gap_drop_link_key_for_bd_addr: %s", bd_addr_to_str(addr));
268a98592bcSMatthias Ringwald     hci_stack->link_key_db->delete_link_key(addr);
269c12e46e7Smatthias.ringwald }
27055597469SMatthias Ringwald 
27155597469SMatthias Ringwald void gap_store_link_key_for_bd_addr(bd_addr_t addr, link_key_t link_key, link_key_type_t type){
27255597469SMatthias Ringwald     if (!hci_stack->link_key_db) return;
2732bacf595SMatthias Ringwald     log_info("gap_store_link_key_for_bd_addr: %s, type %u", bd_addr_to_str(addr), type);
27455597469SMatthias Ringwald     hci_stack->link_key_db->put_link_key(addr, link_key, type);
275c12e46e7Smatthias.ringwald }
276c12e46e7Smatthias.ringwald 
27795d71764SMatthias Ringwald static int hci_is_le_connection(hci_connection_t * connection){
2780bf6344aS[email protected]     return  connection->address_type == BD_ADDR_TYPE_LE_PUBLIC ||
2790bf6344aS[email protected]     connection->address_type == BD_ADDR_TYPE_LE_RANDOM;
2800bf6344aS[email protected] }
2810bf6344aS[email protected] 
2827fde4af9Smatthias.ringwald /**
28343bfb1bdSmatthias.ringwald  * count connections
28443bfb1bdSmatthias.ringwald  */
28540d1c7a4Smatthias.ringwald static int nr_hci_connections(void){
28656c253c9Smatthias.ringwald     int count = 0;
287665d90f2SMatthias Ringwald     btstack_linked_item_t *it;
288665d90f2SMatthias Ringwald     for (it = (btstack_linked_item_t *) hci_stack->connections; it ; it = it->next, count++);
28943bfb1bdSmatthias.ringwald     return count;
29043bfb1bdSmatthias.ringwald }
291c8e4258aSmatthias.ringwald 
29295d71764SMatthias Ringwald static int hci_number_free_acl_slots_for_connection_type(bd_addr_type_t address_type){
293ee303eddS[email protected] 
294ee303eddS[email protected]     int num_packets_sent_classic = 0;
295ee303eddS[email protected]     int num_packets_sent_le = 0;
296ee303eddS[email protected] 
297665d90f2SMatthias Ringwald     btstack_linked_item_t *it;
298665d90f2SMatthias Ringwald     for (it = (btstack_linked_item_t *) hci_stack->connections; it ; it = it->next){
299998906cdSmatthias.ringwald         hci_connection_t * connection = (hci_connection_t *) it;
300ee303eddS[email protected]         if (connection->address_type == BD_ADDR_TYPE_CLASSIC){
301ee303eddS[email protected]             num_packets_sent_classic += connection->num_acl_packets_sent;
302ee303eddS[email protected]         } else {
303ee303eddS[email protected]             num_packets_sent_le += connection->num_acl_packets_sent;
304ee303eddS[email protected]         }
305ee303eddS[email protected]     }
306d999b54eSMatthias Ringwald     log_debug("ACL classic buffers: %u used of %u", num_packets_sent_classic, hci_stack->acl_packets_total_num);
307ee303eddS[email protected]     int free_slots_classic = hci_stack->acl_packets_total_num - num_packets_sent_classic;
308ee303eddS[email protected]     int free_slots_le = 0;
309ee303eddS[email protected] 
310ee303eddS[email protected]     if (free_slots_classic < 0){
3119da54300S[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);
312998906cdSmatthias.ringwald         return 0;
313998906cdSmatthias.ringwald     }
314ee303eddS[email protected] 
315ee303eddS[email protected]     if (hci_stack->le_acl_packets_total_num){
316ee303eddS[email protected]         // if we have LE slots, they are used
317ee303eddS[email protected]         free_slots_le = hci_stack->le_acl_packets_total_num - num_packets_sent_le;
318ee303eddS[email protected]         if (free_slots_le < 0){
3199da54300S[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);
320ee303eddS[email protected]             return 0;
321998906cdSmatthias.ringwald         }
322ee303eddS[email protected]     } else {
323ee303eddS[email protected]         // otherwise, classic slots are used for LE, too
324ee303eddS[email protected]         free_slots_classic -= num_packets_sent_le;
325ee303eddS[email protected]         if (free_slots_classic < 0){
3269da54300S[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);
327ee303eddS[email protected]             return 0;
328ee303eddS[email protected]         }
329ee303eddS[email protected]     }
330ee303eddS[email protected] 
331ee303eddS[email protected]     switch (address_type){
332ee303eddS[email protected]         case BD_ADDR_TYPE_UNKNOWN:
3332125de09SMatthias Ringwald             log_error("hci_number_free_acl_slots: unknown address type");
334ee303eddS[email protected]             return 0;
335ee303eddS[email protected] 
336ee303eddS[email protected]         case BD_ADDR_TYPE_CLASSIC:
337ee303eddS[email protected]             return free_slots_classic;
338ee303eddS[email protected] 
339ee303eddS[email protected]         default:
340cb00d3aaS[email protected]            if (hci_stack->le_acl_packets_total_num){
341ee303eddS[email protected]                return free_slots_le;
342ee303eddS[email protected]            }
343cb00d3aaS[email protected]            return free_slots_classic;
344cb00d3aaS[email protected]     }
345998906cdSmatthias.ringwald }
346998906cdSmatthias.ringwald 
3472125de09SMatthias Ringwald int hci_number_free_acl_slots_for_handle(hci_con_handle_t con_handle){
3482125de09SMatthias Ringwald     // get connection type
3492125de09SMatthias Ringwald     hci_connection_t * connection = hci_connection_for_handle(con_handle);
3502125de09SMatthias Ringwald     if (!connection){
3512125de09SMatthias Ringwald         log_error("hci_number_free_acl_slots: handle 0x%04x not in connection list", con_handle);
3522125de09SMatthias Ringwald         return 0;
3532125de09SMatthias Ringwald     }
3542125de09SMatthias Ringwald     return hci_number_free_acl_slots_for_connection_type(connection->address_type);
3552125de09SMatthias Ringwald }
3562125de09SMatthias Ringwald 
357701e3307SMatthias Ringwald static int hci_number_free_sco_slots(void){
358e35edcc1S[email protected]     int num_sco_packets_sent = 0;
359665d90f2SMatthias Ringwald     btstack_linked_item_t *it;
360665d90f2SMatthias Ringwald     for (it = (btstack_linked_item_t *) hci_stack->connections; it ; it = it->next){
361e35edcc1S[email protected]         hci_connection_t * connection = (hci_connection_t *) it;
362e35edcc1S[email protected]         num_sco_packets_sent += connection->num_sco_packets_sent;
363e35edcc1S[email protected]     }
364e35edcc1S[email protected]     if (num_sco_packets_sent > hci_stack->sco_packets_total_num){
365701e3307SMatthias Ringwald         log_info("hci_number_free_sco_slots:packets (%u) > total packets (%u)", num_sco_packets_sent, hci_stack->sco_packets_total_num);
36644d0e3d5S[email protected]         return 0;
36744d0e3d5S[email protected]     }
368701e3307SMatthias Ringwald     // log_info("hci_number_free_sco_slots u", handle, num_sco_packets_sent);
369e35edcc1S[email protected]     return hci_stack->sco_packets_total_num - num_sco_packets_sent;
370e35edcc1S[email protected] }
37144d0e3d5S[email protected] 
372ac928cc2S[email protected] // new functions replacing hci_can_send_packet_now[_using_packet_buffer]
373ac928cc2S[email protected] int hci_can_send_command_packet_now(void){
374ac928cc2S[email protected]     if (hci_stack->hci_packet_buffer_reserved) return 0;
375ac928cc2S[email protected] 
376ac928cc2S[email protected]     // check for async hci transport implementations
377ac928cc2S[email protected]     if (hci_stack->hci_transport->can_send_packet_now){
378ac928cc2S[email protected]         if (!hci_stack->hci_transport->can_send_packet_now(HCI_COMMAND_DATA_PACKET)){
379ac928cc2S[email protected]             return 0;
380ac928cc2S[email protected]         }
381ac928cc2S[email protected]     }
382ac928cc2S[email protected] 
383ac928cc2S[email protected]     return hci_stack->num_cmd_packets > 0;
384ac928cc2S[email protected] }
385ac928cc2S[email protected] 
3869d04d3a7SMatthias Ringwald static int hci_transport_can_send_prepared_packet_now(uint8_t packet_type){
387ac928cc2S[email protected]     // check for async hci transport implementations
3889d04d3a7SMatthias Ringwald     if (!hci_stack->hci_transport->can_send_packet_now) return 1;
3899d04d3a7SMatthias Ringwald     return hci_stack->hci_transport->can_send_packet_now(packet_type);
390ac928cc2S[email protected] }
3919d04d3a7SMatthias Ringwald 
3929d04d3a7SMatthias Ringwald static int hci_can_send_prepared_acl_packet_for_address_type(bd_addr_type_t address_type){
3939d04d3a7SMatthias Ringwald     if (!hci_transport_can_send_prepared_packet_now(HCI_ACL_DATA_PACKET)) return 0;
3949d04d3a7SMatthias Ringwald     return hci_number_free_acl_slots_for_connection_type(address_type) > 0;
395ac928cc2S[email protected] }
3969d04d3a7SMatthias Ringwald 
3979d04d3a7SMatthias Ringwald int hci_can_send_acl_classic_packet_now(void){
3989d04d3a7SMatthias Ringwald     if (hci_stack->hci_packet_buffer_reserved) return 0;
3999d04d3a7SMatthias Ringwald     return hci_can_send_prepared_acl_packet_for_address_type(BD_ADDR_TYPE_CLASSIC);
4009d04d3a7SMatthias Ringwald }
4019d04d3a7SMatthias Ringwald 
4029d04d3a7SMatthias Ringwald int hci_can_send_acl_le_packet_now(void){
4039d04d3a7SMatthias Ringwald     if (hci_stack->hci_packet_buffer_reserved) return 0;
4049d04d3a7SMatthias Ringwald     return hci_can_send_prepared_acl_packet_for_address_type(BD_ADDR_TYPE_LE_PUBLIC);
4059d04d3a7SMatthias Ringwald }
4069d04d3a7SMatthias Ringwald 
4079d04d3a7SMatthias Ringwald int hci_can_send_prepared_acl_packet_now(hci_con_handle_t con_handle) {
4089d04d3a7SMatthias Ringwald     if (!hci_transport_can_send_prepared_packet_now(HCI_ACL_DATA_PACKET)) return 0;
409e79abdd6S[email protected]     return hci_number_free_acl_slots_for_handle(con_handle) > 0;
410ac928cc2S[email protected] }
411ac928cc2S[email protected] 
412ac928cc2S[email protected] int hci_can_send_acl_packet_now(hci_con_handle_t con_handle){
413ac928cc2S[email protected]     if (hci_stack->hci_packet_buffer_reserved) return 0;
414ac928cc2S[email protected]     return hci_can_send_prepared_acl_packet_now(con_handle);
4156b4af23dS[email protected] }
4166b4af23dS[email protected] 
417701e3307SMatthias Ringwald int hci_can_send_prepared_sco_packet_now(void){
418d057580eSMatthias Ringwald     if (!hci_transport_can_send_prepared_packet_now(HCI_SCO_DATA_PACKET)) return 0;
419ed361f5fSMatthias Ringwald     if (!hci_stack->synchronous_flow_control_enabled) return 1;
420701e3307SMatthias Ringwald     return hci_number_free_sco_slots() > 0;
42144d0e3d5S[email protected] }
42244d0e3d5S[email protected] 
423701e3307SMatthias Ringwald int hci_can_send_sco_packet_now(void){
424d057580eSMatthias Ringwald     if (hci_stack->hci_packet_buffer_reserved) return 0;
425701e3307SMatthias Ringwald     return hci_can_send_prepared_sco_packet_now();
42644d0e3d5S[email protected] }
42744d0e3d5S[email protected] 
428d057580eSMatthias Ringwald void hci_request_sco_can_send_now_event(void){
429d057580eSMatthias Ringwald     hci_stack->sco_waiting_for_can_send_now = 1;
430d057580eSMatthias Ringwald     hci_notify_if_sco_can_send_now();
431d057580eSMatthias Ringwald }
432d057580eSMatthias Ringwald 
43395d71764SMatthias Ringwald // used for internal checks in l2cap.c
434c8b9416aS[email protected] int hci_is_packet_buffer_reserved(void){
435c8b9416aS[email protected]     return hci_stack->hci_packet_buffer_reserved;
436c8b9416aS[email protected] }
437c8b9416aS[email protected] 
4386b4af23dS[email protected] // reserves outgoing packet buffer. @returns 1 if successful
4396b4af23dS[email protected] int hci_reserve_packet_buffer(void){
4409d14b626S[email protected]     if (hci_stack->hci_packet_buffer_reserved) {
4419d14b626S[email protected]         log_error("hci_reserve_packet_buffer called but buffer already reserved");
4429d14b626S[email protected]         return 0;
4439d14b626S[email protected]     }
4446b4af23dS[email protected]     hci_stack->hci_packet_buffer_reserved = 1;
4456b4af23dS[email protected]     return 1;
4466b4af23dS[email protected] }
4476b4af23dS[email protected] 
44868a0fcf7S[email protected] void hci_release_packet_buffer(void){
44968a0fcf7S[email protected]     hci_stack->hci_packet_buffer_reserved = 0;
45068a0fcf7S[email protected] }
45168a0fcf7S[email protected] 
4526b4af23dS[email protected] // assumption: synchronous implementations don't provide can_send_packet_now as they don't keep the buffer after the call
4537f02f414SMatthias Ringwald static int hci_transport_synchronous(void){
4546b4af23dS[email protected]     return hci_stack->hci_transport->can_send_packet_now == NULL;
4556b4af23dS[email protected] }
4566b4af23dS[email protected] 
457452cf3bbS[email protected] static int hci_send_acl_packet_fragments(hci_connection_t *connection){
458452cf3bbS[email protected] 
459452cf3bbS[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);
460452cf3bbS[email protected] 
461452cf3bbS[email protected]     // max ACL data packet length depends on connection type (LE vs. Classic) and available buffers
462452cf3bbS[email protected]     uint16_t max_acl_data_packet_length = hci_stack->acl_data_packet_length;
463452cf3bbS[email protected]     if (hci_is_le_connection(connection) && hci_stack->le_data_packets_length > 0){
464452cf3bbS[email protected]         max_acl_data_packet_length = hci_stack->le_data_packets_length;
465452cf3bbS[email protected]     }
466452cf3bbS[email protected] 
467452cf3bbS[email protected]     // testing: reduce buffer to minimum
468452cf3bbS[email protected]     // max_acl_data_packet_length = 52;
469452cf3bbS[email protected] 
470d999b54eSMatthias Ringwald     log_debug("hci_send_acl_packet_fragments entered");
471d999b54eSMatthias Ringwald 
472452cf3bbS[email protected]     int err;
473452cf3bbS[email protected]     // multiple packets could be send on a synchronous HCI transport
474452cf3bbS[email protected]     while (1){
475452cf3bbS[email protected] 
476d999b54eSMatthias Ringwald         log_debug("hci_send_acl_packet_fragments loop entered");
477d999b54eSMatthias Ringwald 
478452cf3bbS[email protected]         // get current data
479452cf3bbS[email protected]         const uint16_t acl_header_pos = hci_stack->acl_fragmentation_pos - 4;
480452cf3bbS[email protected]         int current_acl_data_packet_length = hci_stack->acl_fragmentation_total_size - hci_stack->acl_fragmentation_pos;
481452cf3bbS[email protected]         int more_fragments = 0;
482452cf3bbS[email protected] 
483452cf3bbS[email protected]         // if ACL packet is larger than Bluetooth packet buffer, only send max_acl_data_packet_length
484452cf3bbS[email protected]         if (current_acl_data_packet_length > max_acl_data_packet_length){
485452cf3bbS[email protected]             more_fragments = 1;
486452cf3bbS[email protected]             current_acl_data_packet_length = max_acl_data_packet_length;
487452cf3bbS[email protected]         }
488452cf3bbS[email protected] 
489452cf3bbS[email protected]         // copy handle_and_flags if not first fragment and update packet boundary flags to be 01 (continuing fragmnent)
490452cf3bbS[email protected]         if (acl_header_pos > 0){
491f8fbdce0SMatthias Ringwald             uint16_t handle_and_flags = little_endian_read_16(hci_stack->hci_packet_buffer, 0);
492452cf3bbS[email protected]             handle_and_flags = (handle_and_flags & 0xcfff) | (1 << 12);
493f8fbdce0SMatthias Ringwald             little_endian_store_16(hci_stack->hci_packet_buffer, acl_header_pos, handle_and_flags);
494452cf3bbS[email protected]         }
495452cf3bbS[email protected] 
496452cf3bbS[email protected]         // update header len
497f8fbdce0SMatthias Ringwald         little_endian_store_16(hci_stack->hci_packet_buffer, acl_header_pos + 2, current_acl_data_packet_length);
498452cf3bbS[email protected] 
499452cf3bbS[email protected]         // count packet
500452cf3bbS[email protected]         connection->num_acl_packets_sent++;
501d999b54eSMatthias Ringwald         log_debug("hci_send_acl_packet_fragments loop before send (more fragments %u)", more_fragments);
502d999b54eSMatthias Ringwald 
503d999b54eSMatthias Ringwald         // update state for next fragment (if any) as "transport done" might be sent during send_packet already
504d999b54eSMatthias Ringwald         if (more_fragments){
505d999b54eSMatthias Ringwald             // update start of next fragment to send
506d999b54eSMatthias Ringwald             hci_stack->acl_fragmentation_pos += current_acl_data_packet_length;
507d999b54eSMatthias Ringwald         } else {
508d999b54eSMatthias Ringwald             // done
509d999b54eSMatthias Ringwald             hci_stack->acl_fragmentation_pos = 0;
510d999b54eSMatthias Ringwald             hci_stack->acl_fragmentation_total_size = 0;
511d999b54eSMatthias Ringwald         }
512452cf3bbS[email protected] 
513452cf3bbS[email protected]         // send packet
514452cf3bbS[email protected]         uint8_t * packet = &hci_stack->hci_packet_buffer[acl_header_pos];
515452cf3bbS[email protected]         const int size = current_acl_data_packet_length + 4;
5165bb5bc3eS[email protected]         hci_dump_packet(HCI_ACL_DATA_PACKET, 0, packet, size);
517452cf3bbS[email protected]         err = hci_stack->hci_transport->send_packet(HCI_ACL_DATA_PACKET, packet, size);
518452cf3bbS[email protected] 
519d999b54eSMatthias Ringwald         log_debug("hci_send_acl_packet_fragments loop after send (more fragments %u)", more_fragments);
520d999b54eSMatthias Ringwald 
521452cf3bbS[email protected]         // done yet?
522452cf3bbS[email protected]         if (!more_fragments) break;
523452cf3bbS[email protected] 
524452cf3bbS[email protected]         // can send more?
525452cf3bbS[email protected]         if (!hci_can_send_prepared_acl_packet_now(connection->con_handle)) return err;
526452cf3bbS[email protected]     }
527452cf3bbS[email protected] 
528d999b54eSMatthias Ringwald     log_debug("hci_send_acl_packet_fragments loop over");
529452cf3bbS[email protected] 
530d051460cS[email protected]     // release buffer now for synchronous transport
531203bace6S[email protected]     if (hci_transport_synchronous()){
532452cf3bbS[email protected]         hci_release_packet_buffer();
53363fa3374SMatthias Ringwald         // notify upper stack that it might be possible to send again
53463fa3374SMatthias Ringwald         uint8_t event[] = { HCI_EVENT_TRANSPORT_PACKET_SENT, 0};
535d6b06661SMatthias Ringwald         hci_emit_event(&event[0], sizeof(event), 0);  // don't dump
536452cf3bbS[email protected]     }
537452cf3bbS[email protected] 
538452cf3bbS[email protected]     return err;
539452cf3bbS[email protected] }
540452cf3bbS[email protected] 
541826f7347S[email protected] // pre: caller has reserved the packet buffer
542826f7347S[email protected] int hci_send_acl_packet_buffer(int size){
5437856c818Smatthias.ringwald 
544452cf3bbS[email protected]     // log_info("hci_send_acl_packet_buffer size %u", size);
545452cf3bbS[email protected] 
546826f7347S[email protected]     if (!hci_stack->hci_packet_buffer_reserved) {
547826f7347S[email protected]         log_error("hci_send_acl_packet_buffer called without reserving packet buffer");
548826f7347S[email protected]         return 0;
549826f7347S[email protected]     }
550826f7347S[email protected] 
551d713a683S[email protected]     uint8_t * packet = hci_stack->hci_packet_buffer;
552d713a683S[email protected]     hci_con_handle_t con_handle = READ_ACL_CONNECTION_HANDLE(packet);
553d713a683S[email protected] 
554826f7347S[email protected]     // check for free places on Bluetooth module
555d713a683S[email protected]     if (!hci_can_send_prepared_acl_packet_now(con_handle)) {
556826f7347S[email protected]         log_error("hci_send_acl_packet_buffer called but no free ACL buffers on controller");
55797b61c7bS[email protected]         hci_release_packet_buffer();
55897b61c7bS[email protected]         return BTSTACK_ACL_BUFFERS_FULL;
55997b61c7bS[email protected]     }
5606218e6f1Smatthias.ringwald 
5615061f3afS[email protected]     hci_connection_t *connection = hci_connection_for_handle( con_handle);
56297b61c7bS[email protected]     if (!connection) {
5635fa0b7cfS[email protected]         log_error("hci_send_acl_packet_buffer called but no connection for handle 0x%04x", con_handle);
56497b61c7bS[email protected]         hci_release_packet_buffer();
56597b61c7bS[email protected]         return 0;
56697b61c7bS[email protected]     }
56756cf178bSmatthias.ringwald     hci_connection_timestamp(connection);
56856cf178bSmatthias.ringwald 
569452cf3bbS[email protected]     // hci_dump_packet( HCI_ACL_DATA_PACKET, 0, packet, size);
5707856c818Smatthias.ringwald 
571452cf3bbS[email protected]     // setup data
572452cf3bbS[email protected]     hci_stack->acl_fragmentation_total_size = size;
573452cf3bbS[email protected]     hci_stack->acl_fragmentation_pos = 4;   // start of L2CAP packet
5746218e6f1Smatthias.ringwald 
575452cf3bbS[email protected]     return hci_send_acl_packet_fragments(connection);
576ee091cf1Smatthias.ringwald }
577ee091cf1Smatthias.ringwald 
57844d0e3d5S[email protected] // pre: caller has reserved the packet buffer
57944d0e3d5S[email protected] int hci_send_sco_packet_buffer(int size){
58044d0e3d5S[email protected] 
58144d0e3d5S[email protected]     // log_info("hci_send_acl_packet_buffer size %u", size);
58244d0e3d5S[email protected] 
58344d0e3d5S[email protected]     if (!hci_stack->hci_packet_buffer_reserved) {
58444d0e3d5S[email protected]         log_error("hci_send_acl_packet_buffer called without reserving packet buffer");
58544d0e3d5S[email protected]         return 0;
58644d0e3d5S[email protected]     }
58744d0e3d5S[email protected] 
58844d0e3d5S[email protected]     uint8_t * packet = hci_stack->hci_packet_buffer;
5894b3e1e19SMatthias Ringwald 
5904b3e1e19SMatthias Ringwald     // skip checks in loopback mode
5914b3e1e19SMatthias Ringwald     if (!hci_stack->loopback_mode){
59244d0e3d5S[email protected]         hci_con_handle_t con_handle = READ_ACL_CONNECTION_HANDLE(packet);   // same for ACL and SCO
59344d0e3d5S[email protected] 
59444d0e3d5S[email protected]         // check for free places on Bluetooth module
595701e3307SMatthias Ringwald         if (!hci_can_send_prepared_sco_packet_now()) {
59644d0e3d5S[email protected]             log_error("hci_send_sco_packet_buffer called but no free ACL buffers on controller");
59744d0e3d5S[email protected]             hci_release_packet_buffer();
59844d0e3d5S[email protected]             return BTSTACK_ACL_BUFFERS_FULL;
59944d0e3d5S[email protected]         }
60044d0e3d5S[email protected] 
601e35edcc1S[email protected]         // track send packet in connection struct
602e35edcc1S[email protected]         hci_connection_t *connection = hci_connection_for_handle( con_handle);
603e35edcc1S[email protected]         if (!connection) {
604e35edcc1S[email protected]             log_error("hci_send_sco_packet_buffer called but no connection for handle 0x%04x", con_handle);
605e35edcc1S[email protected]             hci_release_packet_buffer();
606e35edcc1S[email protected]             return 0;
607e35edcc1S[email protected]         }
608e35edcc1S[email protected]         connection->num_sco_packets_sent++;
6094b3e1e19SMatthias Ringwald     }
61044d0e3d5S[email protected] 
61144d0e3d5S[email protected]     hci_dump_packet( HCI_SCO_DATA_PACKET, 0, packet, size);
612543e835cSMatthias Ringwald     int err = hci_stack->hci_transport->send_packet(HCI_SCO_DATA_PACKET, packet, size);
613543e835cSMatthias Ringwald 
614543e835cSMatthias Ringwald     if (hci_transport_synchronous()){
615543e835cSMatthias Ringwald         hci_release_packet_buffer();
61663fa3374SMatthias Ringwald         // notify upper stack that it might be possible to send again
61763fa3374SMatthias Ringwald         uint8_t event[] = { HCI_EVENT_TRANSPORT_PACKET_SENT, 0};
618d6b06661SMatthias Ringwald         hci_emit_event(&event[0], sizeof(event), 0);    // don't dump
619543e835cSMatthias Ringwald     }
620543e835cSMatthias Ringwald 
621543e835cSMatthias Ringwald     return err;
62244d0e3d5S[email protected] }
62344d0e3d5S[email protected] 
62416833f0aSmatthias.ringwald static void acl_handler(uint8_t *packet, int size){
6257856c818Smatthias.ringwald 
626e76a89eeS[email protected]     // log_info("acl_handler: size %u", size);
627e76a89eeS[email protected] 
6287856c818Smatthias.ringwald     // get info
6297856c818Smatthias.ringwald     hci_con_handle_t con_handle = READ_ACL_CONNECTION_HANDLE(packet);
6305061f3afS[email protected]     hci_connection_t *conn      = hci_connection_for_handle(con_handle);
6317856c818Smatthias.ringwald     uint8_t  acl_flags          = READ_ACL_FLAGS(packet);
6327856c818Smatthias.ringwald     uint16_t acl_length         = READ_ACL_LENGTH(packet);
6337856c818Smatthias.ringwald 
6347856c818Smatthias.ringwald     // ignore non-registered handle
6357856c818Smatthias.ringwald     if (!conn){
6369da54300S[email protected]         log_error( "hci.c: acl_handler called with non-registered handle %u!" , con_handle);
6377856c818Smatthias.ringwald         return;
6387856c818Smatthias.ringwald     }
6397856c818Smatthias.ringwald 
640e76a89eeS[email protected]     // assert packet is complete
6419ecc3e17S[email protected]     if (acl_length + 4 != size){
642e76a89eeS[email protected]         log_error("hci.c: acl_handler called with ACL packet of wrong size %u, expected %u => dropping packet", size, acl_length + 4);
643e76a89eeS[email protected]         return;
644e76a89eeS[email protected]     }
645e76a89eeS[email protected] 
6467856c818Smatthias.ringwald     // update idle timestamp
6477856c818Smatthias.ringwald     hci_connection_timestamp(conn);
6487856c818Smatthias.ringwald 
6497856c818Smatthias.ringwald     // handle different packet types
6507856c818Smatthias.ringwald     switch (acl_flags & 0x03) {
6517856c818Smatthias.ringwald 
6527856c818Smatthias.ringwald         case 0x01: // continuation fragment
6537856c818Smatthias.ringwald 
6540ca847afS[email protected]             // sanity checks
6557856c818Smatthias.ringwald             if (conn->acl_recombination_pos == 0) {
6569da54300S[email protected]                 log_error( "ACL Cont Fragment but no first fragment for handle 0x%02x", con_handle);
6577856c818Smatthias.ringwald                 return;
6587856c818Smatthias.ringwald             }
6590ca847afS[email protected]             if (conn->acl_recombination_pos + acl_length > 4 + HCI_ACL_BUFFER_SIZE){
6600ca847afS[email protected]                 log_error( "ACL Cont Fragment to large: combined packet %u > buffer size %u for handle 0x%02x",
6610ca847afS[email protected]                     conn->acl_recombination_pos + acl_length, 4 + HCI_ACL_BUFFER_SIZE, con_handle);
6620ca847afS[email protected]                 conn->acl_recombination_pos = 0;
6630ca847afS[email protected]                 return;
6640ca847afS[email protected]             }
6657856c818Smatthias.ringwald 
6667856c818Smatthias.ringwald             // append fragment payload (header already stored)
667ec6321eeS[email protected]             memcpy(&conn->acl_recombination_buffer[HCI_INCOMING_PRE_BUFFER_SIZE + conn->acl_recombination_pos], &packet[4], acl_length );
6687856c818Smatthias.ringwald             conn->acl_recombination_pos += acl_length;
6697856c818Smatthias.ringwald 
6709da54300S[email protected]             // log_error( "ACL Cont Fragment: acl_len %u, combined_len %u, l2cap_len %u", acl_length,
671decc01a8Smatthias.ringwald             //        conn->acl_recombination_pos, conn->acl_recombination_length);
6727856c818Smatthias.ringwald 
6737856c818Smatthias.ringwald             // forward complete L2CAP packet if complete.
6747856c818Smatthias.ringwald             if (conn->acl_recombination_pos >= conn->acl_recombination_length + 4 + 4){ // pos already incl. ACL header
675d6b06661SMatthias Ringwald                 hci_emit_acl_packet(&conn->acl_recombination_buffer[HCI_INCOMING_PRE_BUFFER_SIZE], conn->acl_recombination_pos);
6767856c818Smatthias.ringwald                 // reset recombination buffer
6777856c818Smatthias.ringwald                 conn->acl_recombination_length = 0;
6787856c818Smatthias.ringwald                 conn->acl_recombination_pos = 0;
6797856c818Smatthias.ringwald             }
6807856c818Smatthias.ringwald             break;
6817856c818Smatthias.ringwald 
6827856c818Smatthias.ringwald         case 0x02: { // first fragment
6837856c818Smatthias.ringwald 
68423a77e1aS[email protected]             // sanity check
68523a77e1aS[email protected]             if (conn->acl_recombination_pos) {
68623a77e1aS[email protected]                 log_error( "ACL First Fragment but data in buffer for handle 0x%02x, dropping stale fragments", con_handle);
68723a77e1aS[email protected]                 conn->acl_recombination_pos = 0;
68823a77e1aS[email protected]             }
68923a77e1aS[email protected] 
6907856c818Smatthias.ringwald             // peek into L2CAP packet!
6917856c818Smatthias.ringwald             uint16_t l2cap_length = READ_L2CAP_LENGTH( packet );
6927856c818Smatthias.ringwald 
6939da54300S[email protected]             // log_info( "ACL First Fragment: acl_len %u, l2cap_len %u", acl_length, l2cap_length);
694decc01a8Smatthias.ringwald 
6957856c818Smatthias.ringwald             // compare fragment size to L2CAP packet size
6967856c818Smatthias.ringwald             if (acl_length >= l2cap_length + 4){
6977856c818Smatthias.ringwald                 // forward fragment as L2CAP packet
698d6b06661SMatthias Ringwald                 hci_emit_acl_packet(packet, acl_length + 4);
6997856c818Smatthias.ringwald             } else {
7000ca847afS[email protected] 
7010ca847afS[email protected]                 if (acl_length > HCI_ACL_BUFFER_SIZE){
7020ca847afS[email protected]                     log_error( "ACL First Fragment to large: fragment %u > buffer size %u for handle 0x%02x",
7030ca847afS[email protected]                         4 + acl_length, 4 + HCI_ACL_BUFFER_SIZE, con_handle);
7040ca847afS[email protected]                     return;
7050ca847afS[email protected]                 }
7060ca847afS[email protected] 
7077856c818Smatthias.ringwald                 // store first fragment and tweak acl length for complete package
708ec6321eeS[email protected]                 memcpy(&conn->acl_recombination_buffer[HCI_INCOMING_PRE_BUFFER_SIZE], packet, acl_length + 4);
7097856c818Smatthias.ringwald                 conn->acl_recombination_pos    = acl_length + 4;
7107856c818Smatthias.ringwald                 conn->acl_recombination_length = l2cap_length;
711f8fbdce0SMatthias Ringwald                 little_endian_store_16(conn->acl_recombination_buffer, HCI_INCOMING_PRE_BUFFER_SIZE + 2, l2cap_length +4);
7127856c818Smatthias.ringwald             }
7137856c818Smatthias.ringwald             break;
7147856c818Smatthias.ringwald 
7157856c818Smatthias.ringwald         }
7167856c818Smatthias.ringwald         default:
7179da54300S[email protected]             log_error( "hci.c: acl_handler called with invalid packet boundary flags %u", acl_flags & 0x03);
7187856c818Smatthias.ringwald             return;
7197856c818Smatthias.ringwald     }
72094ab26f8Smatthias.ringwald 
72194ab26f8Smatthias.ringwald     // execute main loop
72294ab26f8Smatthias.ringwald     hci_run();
72316833f0aSmatthias.ringwald }
72422909952Smatthias.ringwald 
72567a3e8ecSmatthias.ringwald static void hci_shutdown_connection(hci_connection_t *conn){
7269da54300S[email protected]     log_info("Connection closed: handle 0x%x, %s", conn->con_handle, bd_addr_to_str(conn->address));
7273c4d4b90Smatthias.ringwald 
728528a4a3bSMatthias Ringwald     btstack_run_loop_remove_timer(&conn->timeout);
729c785ef68Smatthias.ringwald 
730665d90f2SMatthias Ringwald     btstack_linked_list_remove(&hci_stack->connections, (btstack_linked_item_t *) conn);
731a3b02b71Smatthias.ringwald     btstack_memory_hci_connection_free( conn );
7323c4d4b90Smatthias.ringwald 
7333c4d4b90Smatthias.ringwald     // now it's gone
734c7e0c5f6Smatthias.ringwald     hci_emit_nr_connections_changed();
735c7e0c5f6Smatthias.ringwald }
736c7e0c5f6Smatthias.ringwald 
7370c042179S[email protected] static const uint16_t packet_type_sizes[] = {
7388f8108aaSmatthias.ringwald     0, HCI_ACL_2DH1_SIZE, HCI_ACL_3DH1_SIZE, HCI_ACL_DM1_SIZE,
7398f8108aaSmatthias.ringwald     HCI_ACL_DH1_SIZE, 0, 0, 0,
7408f8108aaSmatthias.ringwald     HCI_ACL_2DH3_SIZE, HCI_ACL_3DH3_SIZE, HCI_ACL_DM3_SIZE, HCI_ACL_DH3_SIZE,
7418f8108aaSmatthias.ringwald     HCI_ACL_2DH5_SIZE, HCI_ACL_3DH5_SIZE, HCI_ACL_DM5_SIZE, HCI_ACL_DH5_SIZE
7428f8108aaSmatthias.ringwald };
74365389bfcS[email protected] static const uint8_t  packet_type_feature_requirement_bit[] = {
74465389bfcS[email protected]      0, // 3 slot packets
74565389bfcS[email protected]      1, // 5 slot packets
74665389bfcS[email protected]     25, // EDR 2 mpbs
74765389bfcS[email protected]     26, // EDR 3 mbps
74865389bfcS[email protected]     39, // 3 slot EDR packts
74965389bfcS[email protected]     40, // 5 slot EDR packet
75065389bfcS[email protected] };
75165389bfcS[email protected] static const uint16_t packet_type_feature_packet_mask[] = {
75265389bfcS[email protected]     0x0f00, // 3 slot packets
75365389bfcS[email protected]     0xf000, // 5 slot packets
75465389bfcS[email protected]     0x1102, // EDR 2 mpbs
75565389bfcS[email protected]     0x2204, // EDR 3 mbps
75665389bfcS[email protected]     0x0300, // 3 slot EDR packts
75765389bfcS[email protected]     0x3000, // 5 slot EDR packet
75865389bfcS[email protected] };
7598f8108aaSmatthias.ringwald 
76065389bfcS[email protected] static uint16_t hci_acl_packet_types_for_buffer_size_and_local_features(uint16_t buffer_size, uint8_t * local_supported_features){
76165389bfcS[email protected]     // enable packet types based on size
7628f8108aaSmatthias.ringwald     uint16_t packet_types = 0;
763f16a69bbS[email protected]     unsigned int i;
7648f8108aaSmatthias.ringwald     for (i=0;i<16;i++){
7658f8108aaSmatthias.ringwald         if (packet_type_sizes[i] == 0) continue;
7668f8108aaSmatthias.ringwald         if (packet_type_sizes[i] <= buffer_size){
7678f8108aaSmatthias.ringwald             packet_types |= 1 << i;
7688f8108aaSmatthias.ringwald         }
7698f8108aaSmatthias.ringwald     }
77065389bfcS[email protected]     // disable packet types due to missing local supported features
77165389bfcS[email protected]     for (i=0;i<sizeof(packet_type_feature_requirement_bit);i++){
77265389bfcS[email protected]         int bit_idx = packet_type_feature_requirement_bit[i];
77365389bfcS[email protected]         int feature_set = (local_supported_features[bit_idx >> 3] & (1<<(bit_idx & 7))) != 0;
77465389bfcS[email protected]         if (feature_set) continue;
77565389bfcS[email protected]         log_info("Features bit %02u is not set, removing packet types 0x%04x", bit_idx, packet_type_feature_packet_mask[i]);
77665389bfcS[email protected]         packet_types &= ~packet_type_feature_packet_mask[i];
77765389bfcS[email protected]     }
7788f8108aaSmatthias.ringwald     // flip bits for "may not be used"
7798f8108aaSmatthias.ringwald     packet_types ^= 0x3306;
7808f8108aaSmatthias.ringwald     return packet_types;
7818f8108aaSmatthias.ringwald }
7828f8108aaSmatthias.ringwald 
7838f8108aaSmatthias.ringwald uint16_t hci_usable_acl_packet_types(void){
7843a9fb326S[email protected]     return hci_stack->packet_types;
7858f8108aaSmatthias.ringwald }
7868f8108aaSmatthias.ringwald 
787facf93fdS[email protected] uint8_t* hci_get_outgoing_packet_buffer(void){
7887dc17943Smatthias.ringwald     // hci packet buffer is >= acl data packet length
7893a9fb326S[email protected]     return hci_stack->hci_packet_buffer;
7907dc17943Smatthias.ringwald }
7917dc17943Smatthias.ringwald 
792f5d8d141S[email protected] uint16_t hci_max_acl_data_packet_length(void){
7933a9fb326S[email protected]     return hci_stack->acl_data_packet_length;
7947dc17943Smatthias.ringwald }
7957dc17943Smatthias.ringwald 
7963e68d23dSMatthias Ringwald int hci_extended_sco_link_supported(void){
7973e68d23dSMatthias Ringwald     // No. 31, byte 3, bit 7
7983e68d23dSMatthias Ringwald     return (hci_stack->local_supported_features[3] & (1 << 7)) != 0;
7993e68d23dSMatthias Ringwald }
8003e68d23dSMatthias Ringwald 
8016ac9a97eS[email protected] int hci_non_flushable_packet_boundary_flag_supported(void){
8026ac9a97eS[email protected]     // No. 54, byte 6, bit 6
8036ac9a97eS[email protected]     return (hci_stack->local_supported_features[6] & (1 << 6)) != 0;
8046ac9a97eS[email protected] }
8056ac9a97eS[email protected] 
80615a95bd5SMatthias Ringwald static int gap_ssp_supported(void){
8076ac9a97eS[email protected]     // No. 51, byte 6, bit 3
8083a9fb326S[email protected]     return (hci_stack->local_supported_features[6] & (1 << 3)) != 0;
809f5d8d141S[email protected] }
810f5d8d141S[email protected] 
8117f02f414SMatthias Ringwald static int hci_classic_supported(void){
8126ac9a97eS[email protected]     // No. 37, byte 4, bit 5, = No BR/EDR Support
8133a9fb326S[email protected]     return (hci_stack->local_supported_features[4] & (1 << 5)) == 0;
814f5d8d141S[email protected] }
815f5d8d141S[email protected] 
8167f02f414SMatthias Ringwald static int hci_le_supported(void){
817a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE
8186ac9a97eS[email protected]     // No. 37, byte 4, bit 6 = LE Supported (Controller)
8193a9fb326S[email protected]     return (hci_stack->local_supported_features[4] & (1 << 6)) != 0;
820f5d8d141S[email protected] #else
821f5d8d141S[email protected]     return 0;
822f5d8d141S[email protected] #endif
823f5d8d141S[email protected] }
824f5d8d141S[email protected] 
82569a97523S[email protected] // get addr type and address used in advertisement packets
82615a95bd5SMatthias Ringwald void gap_advertisements_get_address(uint8_t * addr_type, bd_addr_t  addr){
8273a9fb326S[email protected]     *addr_type = hci_stack->adv_addr_type;
8283a9fb326S[email protected]     if (hci_stack->adv_addr_type){
8293a9fb326S[email protected]         memcpy(addr, hci_stack->adv_address, 6);
83069a97523S[email protected]     } else {
8313a9fb326S[email protected]         memcpy(addr, hci_stack->local_bd_addr, 6);
83269a97523S[email protected]     }
83369a97523S[email protected] }
83469a97523S[email protected] 
835a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE
83639677e66SMatthias Ringwald void le_handle_advertisement_report(uint8_t *packet, int size){
837d1dc057bS[email protected]     int offset = 3;
838d1dc057bS[email protected]     int num_reports = packet[offset];
839d1dc057bS[email protected]     offset += 1;
840d1dc057bS[email protected] 
84157c9da5bS[email protected]     int i;
8424f4e0224SMatthias Ringwald     // log_info("HCI: handle adv report with num reports: %d", num_reports);
84303fbe9c6S[email protected]     uint8_t event[12 + LE_ADVERTISING_DATA_SIZE]; // use upper bound to avoid var size automatic var
84457c9da5bS[email protected]     for (i=0; i<num_reports;i++){
845210c6774S[email protected]         uint8_t data_length = packet[offset + 8];
846a0aac9c4S[email protected]         uint8_t event_size = 10 + data_length;
847d1dc057bS[email protected]         int pos = 0;
848045013feSMatthias Ringwald         event[pos++] = GAP_EVENT_ADVERTISING_REPORT;
84957c9da5bS[email protected]         event[pos++] = event_size;
850210c6774S[email protected]         memcpy(&event[pos], &packet[offset], 1+1+6); // event type + address type + address
851d1dc057bS[email protected]         offset += 8;
852d1dc057bS[email protected]         pos += 8;
853d1dc057bS[email protected]         event[pos++] = packet[offset + 1 + data_length]; // rssi
854d1dc057bS[email protected]         event[pos++] = packet[offset++]; //data_length;
855d1dc057bS[email protected]         memcpy(&event[pos], &packet[offset], data_length);
85657c9da5bS[email protected]         pos += data_length;
857d1dc057bS[email protected]         offset += data_length + 1; // rssi
858d6b06661SMatthias Ringwald         hci_emit_event(event, pos, 1);
85957c9da5bS[email protected]     }
86057c9da5bS[email protected] }
861b2f949feS[email protected] #endif
86257c9da5bS[email protected] 
86396b53536SMatthias Ringwald static uint32_t hci_transport_uart_get_main_baud_rate(void){
86496b53536SMatthias Ringwald     if (!hci_stack->config) return 0;
8659796ebeaSMatthias Ringwald     uint32_t baud_rate = ((hci_transport_config_uart_t *)hci_stack->config)->baudrate_main;
86696b53536SMatthias Ringwald     // Limit baud rate for Broadcom chipsets to 3 mbps
867c6d1dbedSMatthias Ringwald     if (hci_stack->manufacturer == COMPANY_ID_BROADCOM_CORPORATION && baud_rate > 3000000){
86896b53536SMatthias Ringwald         baud_rate = 3000000;
86996b53536SMatthias Ringwald     }
87096b53536SMatthias Ringwald     return baud_rate;
87196b53536SMatthias Ringwald }
87296b53536SMatthias Ringwald 
873ec820d77SMatthias Ringwald static void hci_initialization_timeout_handler(btstack_timer_source_t * ds){
8740305bdeaSMatthias Ringwald     switch (hci_stack->substate){
8750305bdeaSMatthias Ringwald         case HCI_INIT_W4_SEND_RESET:
8767b0d7667SMatthias Ringwald             log_info("Resend HCI Reset");
8770305bdeaSMatthias Ringwald             hci_stack->substate = HCI_INIT_SEND_RESET;
8787b0d7667SMatthias Ringwald             hci_stack->num_cmd_packets = 1;
8790305bdeaSMatthias Ringwald             hci_run();
8800305bdeaSMatthias Ringwald             break;
8819f007422SMatthias Ringwald         case HCI_INIT_W4_CUSTOM_INIT_CSR_WARM_BOOT_LINK_RESET:
8829f007422SMatthias Ringwald             log_info("Resend HCI Reset - CSR Warm Boot with Link Reset");
8839f007422SMatthias Ringwald             if (hci_stack->hci_transport->reset_link){
8849f007422SMatthias Ringwald                 hci_stack->hci_transport->reset_link();
8859f007422SMatthias Ringwald             }
8869f007422SMatthias Ringwald             // NOTE: explicit fallthrough to HCI_INIT_W4_CUSTOM_INIT_CSR_WARM_BOOT
887e47e68c7SMatthias Ringwald         case HCI_INIT_W4_CUSTOM_INIT_CSR_WARM_BOOT:
888e47e68c7SMatthias Ringwald             log_info("Resend HCI Reset - CSR Warm Boot");
889e47e68c7SMatthias Ringwald             hci_stack->substate = HCI_INIT_SEND_RESET_CSR_WARM_BOOT;
890e47e68c7SMatthias Ringwald             hci_stack->num_cmd_packets = 1;
891e47e68c7SMatthias Ringwald             hci_run();
892688c2635SMatthias Ringwald             break;
8937224be7eSMatthias Ringwald         case HCI_INIT_W4_SEND_BAUD_CHANGE:
8947224be7eSMatthias Ringwald             if (hci_stack->hci_transport->set_baudrate){
89596b53536SMatthias Ringwald                 uint32_t baud_rate = hci_transport_uart_get_main_baud_rate();
896cd724cb7SMatthias Ringwald                 log_info("Local baud rate change to %"PRIu32"(timeout handler)", baud_rate);
8977dd9d0ecSMatthias Ringwald                 hci_stack->hci_transport->set_baudrate(baud_rate);
8987224be7eSMatthias Ringwald             }
899772a36d3SMatthias Ringwald             // For CSR, HCI Reset is sent on new baud rate
9002caefae9SMatthias Ringwald             if (hci_stack->manufacturer == COMPANY_ID_CAMBRIDGE_SILICON_RADIO){
901772a36d3SMatthias Ringwald                 hci_stack->substate = HCI_INIT_SEND_RESET_CSR_WARM_BOOT;
902772a36d3SMatthias Ringwald                 hci_run();
903772a36d3SMatthias Ringwald             }
9044696bddbSMatthias Ringwald             break;
9050305bdeaSMatthias Ringwald         default:
9060305bdeaSMatthias Ringwald             break;
9070305bdeaSMatthias Ringwald     }
9080305bdeaSMatthias Ringwald }
9090305bdeaSMatthias Ringwald 
91071de195eSMatthias Ringwald static void hci_initializing_next_state(void){
91174b323a9SMatthias Ringwald     hci_stack->substate = (hci_substate_t )( ((int) hci_stack->substate) + 1);
91274b323a9SMatthias Ringwald }
91374b323a9SMatthias Ringwald 
91474b323a9SMatthias Ringwald // assumption: hci_can_send_command_packet_now() == true
91571de195eSMatthias Ringwald static void hci_initializing_run(void){
916148ca237SMatthias Ringwald     log_debug("hci_initializing_run: substate %u, can send %u", hci_stack->substate, hci_can_send_command_packet_now());
91774b323a9SMatthias Ringwald     switch (hci_stack->substate){
91874b323a9SMatthias Ringwald         case HCI_INIT_SEND_RESET:
91974b323a9SMatthias Ringwald             hci_state_reset();
920a0cf2f3fSMatthias Ringwald 
921423a3e49SMatthias Ringwald #ifndef HAVE_PLATFORM_IPHONE_OS
9220305bdeaSMatthias Ringwald             // prepare reset if command complete not received in 100ms
923659d758cSMatthias Ringwald             btstack_run_loop_set_timer(&hci_stack->timeout, HCI_RESET_RESEND_TIMEOUT_MS);
924528a4a3bSMatthias Ringwald             btstack_run_loop_set_timer_handler(&hci_stack->timeout, hci_initialization_timeout_handler);
925528a4a3bSMatthias Ringwald             btstack_run_loop_add_timer(&hci_stack->timeout);
926a0cf2f3fSMatthias Ringwald #endif
9270305bdeaSMatthias Ringwald             // send command
92874b323a9SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_SEND_RESET;
9290305bdeaSMatthias Ringwald             hci_send_cmd(&hci_reset);
93074b323a9SMatthias Ringwald             break;
93176fcb19bSMatthias Ringwald         case HCI_INIT_SEND_READ_LOCAL_VERSION_INFORMATION:
93276fcb19bSMatthias Ringwald             hci_send_cmd(&hci_read_local_version_information);
93376fcb19bSMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_SEND_READ_LOCAL_VERSION_INFORMATION;
93476fcb19bSMatthias Ringwald             break;
935e47e68c7SMatthias Ringwald         case HCI_INIT_SEND_RESET_CSR_WARM_BOOT:
936e47e68c7SMatthias Ringwald             hci_state_reset();
937e47e68c7SMatthias Ringwald             // prepare reset if command complete not received in 100ms
938659d758cSMatthias Ringwald             btstack_run_loop_set_timer(&hci_stack->timeout, HCI_RESET_RESEND_TIMEOUT_MS);
939528a4a3bSMatthias Ringwald             btstack_run_loop_set_timer_handler(&hci_stack->timeout, hci_initialization_timeout_handler);
940528a4a3bSMatthias Ringwald             btstack_run_loop_add_timer(&hci_stack->timeout);
941e47e68c7SMatthias Ringwald             // send command
942e47e68c7SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_CUSTOM_INIT_CSR_WARM_BOOT;
943e47e68c7SMatthias Ringwald             hci_send_cmd(&hci_reset);
944e47e68c7SMatthias Ringwald             break;
9458d29070eSMatthias Ringwald         case HCI_INIT_SEND_RESET_ST_WARM_BOOT:
9468d29070eSMatthias Ringwald             hci_state_reset();
9478d29070eSMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_SEND_RESET_ST_WARM_BOOT;
9488d29070eSMatthias Ringwald             hci_send_cmd(&hci_reset);
9498d29070eSMatthias Ringwald             break;
950fab26ab3SMatthias Ringwald         case HCI_INIT_SEND_BAUD_CHANGE: {
95196b53536SMatthias Ringwald             uint32_t baud_rate = hci_transport_uart_get_main_baud_rate();
9523fb36a29SMatthias Ringwald             hci_stack->chipset->set_baudrate_command(baud_rate, hci_stack->hci_packet_buffer);
953f8fbdce0SMatthias Ringwald             hci_stack->last_cmd_opcode = little_endian_read_16(hci_stack->hci_packet_buffer, 0);
95474b323a9SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_SEND_BAUD_CHANGE;
9550305bdeaSMatthias Ringwald             hci_send_cmd_packet(hci_stack->hci_packet_buffer, 3 + hci_stack->hci_packet_buffer[2]);
9564696bddbSMatthias Ringwald             // STLC25000D: baudrate change happens within 0.5 s after command was send,
9574696bddbSMatthias Ringwald             // use timer to update baud rate after 100 ms (knowing exactly, when command was sent is non-trivial)
958c6d1dbedSMatthias Ringwald             if (hci_stack->manufacturer == COMPANY_ID_ST_MICROELECTRONICS){
959659d758cSMatthias Ringwald                 btstack_run_loop_set_timer(&hci_stack->timeout, HCI_RESET_RESEND_TIMEOUT_MS);
960528a4a3bSMatthias Ringwald                 btstack_run_loop_add_timer(&hci_stack->timeout);
9614696bddbSMatthias Ringwald             }
96274b323a9SMatthias Ringwald             break;
963fab26ab3SMatthias Ringwald         }
964fab26ab3SMatthias Ringwald         case HCI_INIT_SEND_BAUD_CHANGE_BCM: {
96596b53536SMatthias Ringwald             uint32_t baud_rate = hci_transport_uart_get_main_baud_rate();
9663fb36a29SMatthias Ringwald             hci_stack->chipset->set_baudrate_command(baud_rate, hci_stack->hci_packet_buffer);
967f8fbdce0SMatthias Ringwald             hci_stack->last_cmd_opcode = little_endian_read_16(hci_stack->hci_packet_buffer, 0);
968eb3a5314SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_SEND_BAUD_CHANGE_BCM;
969eb3a5314SMatthias Ringwald             hci_send_cmd_packet(hci_stack->hci_packet_buffer, 3 + hci_stack->hci_packet_buffer[2]);
970eb3a5314SMatthias Ringwald             break;
971fab26ab3SMatthias Ringwald         }
97274b323a9SMatthias Ringwald         case HCI_INIT_CUSTOM_INIT:
97374b323a9SMatthias Ringwald             // Custom initialization
9743fb36a29SMatthias Ringwald             if (hci_stack->chipset && hci_stack->chipset->next_command){
9753fb36a29SMatthias Ringwald                 int valid_cmd = (*hci_stack->chipset->next_command)(hci_stack->hci_packet_buffer);
97674b323a9SMatthias Ringwald                 if (valid_cmd){
97774b323a9SMatthias Ringwald                     int size = 3 + hci_stack->hci_packet_buffer[2];
978f8fbdce0SMatthias Ringwald                     hci_stack->last_cmd_opcode = little_endian_read_16(hci_stack->hci_packet_buffer, 0);
97974b323a9SMatthias Ringwald                     hci_dump_packet(HCI_COMMAND_DATA_PACKET, 0, hci_stack->hci_packet_buffer, size);
980e47e68c7SMatthias Ringwald                     switch (valid_cmd) {
981e47e68c7SMatthias Ringwald                         case 1:
982e47e68c7SMatthias Ringwald                         default:
983e47e68c7SMatthias Ringwald                             hci_stack->substate = HCI_INIT_W4_CUSTOM_INIT;
984e47e68c7SMatthias Ringwald                             break;
985e47e68c7SMatthias Ringwald                         case 2: // CSR Warm Boot: Wait a bit, then send HCI Reset until HCI Command Complete
986e47e68c7SMatthias Ringwald                             log_info("CSR Warm Boot");
987659d758cSMatthias Ringwald                             btstack_run_loop_set_timer(&hci_stack->timeout, HCI_RESET_RESEND_TIMEOUT_MS);
988528a4a3bSMatthias Ringwald                             btstack_run_loop_set_timer_handler(&hci_stack->timeout, hci_initialization_timeout_handler);
989528a4a3bSMatthias Ringwald                             btstack_run_loop_add_timer(&hci_stack->timeout);
9902caefae9SMatthias Ringwald                             if (hci_stack->manufacturer == COMPANY_ID_CAMBRIDGE_SILICON_RADIO
991772a36d3SMatthias Ringwald                                 && hci_stack->config
9923fb36a29SMatthias Ringwald                                 && hci_stack->chipset
9933fb36a29SMatthias Ringwald                                 // && hci_stack->chipset->set_baudrate_command -- there's no such command
994772a36d3SMatthias Ringwald                                 && hci_stack->hci_transport->set_baudrate
9952caefae9SMatthias Ringwald                                 && hci_transport_uart_get_main_baud_rate()){
996772a36d3SMatthias Ringwald                                 hci_stack->substate = HCI_INIT_W4_SEND_BAUD_CHANGE;
997772a36d3SMatthias Ringwald                             } else {
9989f007422SMatthias Ringwald                                hci_stack->substate = HCI_INIT_W4_CUSTOM_INIT_CSR_WARM_BOOT_LINK_RESET;
999772a36d3SMatthias Ringwald                             }
1000e47e68c7SMatthias Ringwald                             break;
1001e47e68c7SMatthias Ringwald                     }
10020305bdeaSMatthias Ringwald                     hci_stack->hci_transport->send_packet(HCI_COMMAND_DATA_PACKET, hci_stack->hci_packet_buffer, size);
100374b323a9SMatthias Ringwald                     break;
100474b323a9SMatthias Ringwald                 }
1005148ca237SMatthias Ringwald                 log_info("Init script done");
100692a0d36dSMatthias Ringwald 
100792a0d36dSMatthias Ringwald                 // Init script download causes baud rate to reset on Broadcom chipsets, restore UART baud rate if needed
1008c6d1dbedSMatthias Ringwald                 if (hci_stack->manufacturer == COMPANY_ID_BROADCOM_CORPORATION){
100992a0d36dSMatthias Ringwald                     int need_baud_change = hci_stack->config
10103fb36a29SMatthias Ringwald                         && hci_stack->chipset
10113fb36a29SMatthias Ringwald                         && hci_stack->chipset->set_baudrate_command
101292a0d36dSMatthias Ringwald                         && hci_stack->hci_transport->set_baudrate
10139796ebeaSMatthias Ringwald                         && ((hci_transport_config_uart_t *)hci_stack->config)->baudrate_main;
101492a0d36dSMatthias Ringwald                     if (need_baud_change) {
10159796ebeaSMatthias Ringwald                         uint32_t baud_rate = ((hci_transport_config_uart_t *)hci_stack->config)->baudrate_init;
1016cd724cb7SMatthias Ringwald                         log_info("Local baud rate change to %"PRIu32" after init script (bcm)", baud_rate);
101792a0d36dSMatthias Ringwald                         hci_stack->hci_transport->set_baudrate(baud_rate);
101892a0d36dSMatthias Ringwald                     }
101992a0d36dSMatthias Ringwald                 }
102074b323a9SMatthias Ringwald             }
102174b323a9SMatthias Ringwald             // otherwise continue
1022a828a756SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_READ_LOCAL_SUPPORTED_COMMANDS;
1023a828a756SMatthias Ringwald             hci_send_cmd(&hci_read_local_supported_commands);
1024a828a756SMatthias Ringwald             break;
1025d58dd308SMatthias Ringwald         case HCI_INIT_READ_LOCAL_SUPPORTED_COMMANDS:
1026d58dd308SMatthias Ringwald             log_info("Resend hci_read_local_supported_commands after CSR Warm Boot double reset");
1027d58dd308SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_READ_LOCAL_SUPPORTED_COMMANDS;
1028d58dd308SMatthias Ringwald             hci_send_cmd(&hci_read_local_supported_commands);
1029d58dd308SMatthias Ringwald             break;
103053860077SMatthias Ringwald         case HCI_INIT_SET_BD_ADDR:
103153860077SMatthias Ringwald             log_info("Set Public BD ADDR to %s", bd_addr_to_str(hci_stack->custom_bd_addr));
10323fb36a29SMatthias Ringwald             hci_stack->chipset->set_bd_addr_command(hci_stack->custom_bd_addr, hci_stack->hci_packet_buffer);
1033f8fbdce0SMatthias Ringwald             hci_stack->last_cmd_opcode = little_endian_read_16(hci_stack->hci_packet_buffer, 0);
103453860077SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_SET_BD_ADDR;
103553860077SMatthias Ringwald             hci_send_cmd_packet(hci_stack->hci_packet_buffer, 3 + hci_stack->hci_packet_buffer[2]);
103653860077SMatthias Ringwald             break;
103753860077SMatthias Ringwald         case HCI_INIT_READ_BD_ADDR:
103853860077SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_READ_BD_ADDR;
103953860077SMatthias Ringwald             hci_send_cmd(&hci_read_bd_addr);
104053860077SMatthias Ringwald             break;
104174b323a9SMatthias Ringwald         case HCI_INIT_READ_BUFFER_SIZE:
104274b323a9SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_READ_BUFFER_SIZE;
10430305bdeaSMatthias Ringwald             hci_send_cmd(&hci_read_buffer_size);
104474b323a9SMatthias Ringwald             break;
104553860077SMatthias Ringwald         case HCI_INIT_READ_LOCAL_SUPPORTED_FEATURES:
104653860077SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_READ_LOCAL_SUPPORTED_FEATURES;
10470305bdeaSMatthias Ringwald             hci_send_cmd(&hci_read_local_supported_features);
104874b323a9SMatthias Ringwald             break;
104974b323a9SMatthias Ringwald         case HCI_INIT_SET_EVENT_MASK:
10500305bdeaSMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_SET_EVENT_MASK;
105174b323a9SMatthias Ringwald             if (hci_le_supported()){
105274b323a9SMatthias Ringwald                 hci_send_cmd(&hci_set_event_mask,0xffffffff, 0x3FFFFFFF);
105374b323a9SMatthias Ringwald             } else {
105474b323a9SMatthias Ringwald                 // Kensington Bluetooth 2.1 USB Dongle (CSR Chipset) returns an error for 0xffff...
105574b323a9SMatthias Ringwald                 hci_send_cmd(&hci_set_event_mask,0xffffffff, 0x1FFFFFFF);
105674b323a9SMatthias Ringwald             }
105774b323a9SMatthias Ringwald             break;
105874b323a9SMatthias Ringwald         case HCI_INIT_WRITE_SIMPLE_PAIRING_MODE:
105974b323a9SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_WRITE_SIMPLE_PAIRING_MODE;
10600305bdeaSMatthias Ringwald             hci_send_cmd(&hci_write_simple_pairing_mode, hci_stack->ssp_enable);
106174b323a9SMatthias Ringwald             break;
106274b323a9SMatthias Ringwald         case HCI_INIT_WRITE_PAGE_TIMEOUT:
106374b323a9SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_WRITE_PAGE_TIMEOUT;
10640305bdeaSMatthias Ringwald             hci_send_cmd(&hci_write_page_timeout, 0x6000);  // ca. 15 sec
106574b323a9SMatthias Ringwald             break;
106674b323a9SMatthias Ringwald         case HCI_INIT_WRITE_CLASS_OF_DEVICE:
106774b323a9SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_WRITE_CLASS_OF_DEVICE;
10680305bdeaSMatthias Ringwald             hci_send_cmd(&hci_write_class_of_device, hci_stack->class_of_device);
106974b323a9SMatthias Ringwald             break;
107074b323a9SMatthias Ringwald         case HCI_INIT_WRITE_LOCAL_NAME:
10710305bdeaSMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_WRITE_LOCAL_NAME;
107274b323a9SMatthias Ringwald             if (hci_stack->local_name){
107374b323a9SMatthias Ringwald                 hci_send_cmd(&hci_write_local_name, hci_stack->local_name);
107474b323a9SMatthias Ringwald             } else {
10757224be7eSMatthias Ringwald                 char local_name[8+17+1];
10767224be7eSMatthias Ringwald                 // BTstack 11:22:33:44:55:66
10777224be7eSMatthias Ringwald                 memcpy(local_name, "BTstack ", 8);
10787224be7eSMatthias Ringwald                 memcpy(&local_name[8], bd_addr_to_str(hci_stack->local_bd_addr), 17);   // strlen(bd_addr_to_str(...)) = 17
10797224be7eSMatthias Ringwald                 local_name[8+17] = '\0';
108093bcd4d0SMatthias Ringwald                 log_info("---> Name %s", local_name);
108193bcd4d0SMatthias Ringwald                 hci_send_cmd(&hci_write_local_name, local_name);
108274b323a9SMatthias Ringwald             }
108374b323a9SMatthias Ringwald             break;
1084ff00ed1cSMatthias Ringwald         case HCI_INIT_WRITE_EIR_DATA:
10858a114470SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_WRITE_EIR_DATA;
1086ff00ed1cSMatthias Ringwald             hci_send_cmd(&hci_write_extended_inquiry_response, 0, hci_stack->eir_data);
1087ff00ed1cSMatthias Ringwald             break;
1088f6858d14SMatthias Ringwald         case HCI_INIT_WRITE_INQUIRY_MODE:
1089f6858d14SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_WRITE_INQUIRY_MODE;
10908a114470SMatthias Ringwald             hci_send_cmd(&hci_write_inquiry_mode, (int) hci_stack->inquiry_mode);
1091f6858d14SMatthias Ringwald             break;
109274b323a9SMatthias Ringwald         case HCI_INIT_WRITE_SCAN_ENABLE:
109374b323a9SMatthias Ringwald             hci_send_cmd(&hci_write_scan_enable, (hci_stack->connectable << 1) | hci_stack->discoverable); // page scan
109474b323a9SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_WRITE_SCAN_ENABLE;
109574b323a9SMatthias Ringwald             break;
1096483c5078SMatthias Ringwald         // only sent if ENABLE_SCO_OVER_HCI is defined
1097729ed62eSMatthias Ringwald         case HCI_INIT_WRITE_SYNCHRONOUS_FLOW_CONTROL_ENABLE:
1098729ed62eSMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_WRITE_SYNCHRONOUS_FLOW_CONTROL_ENABLE;
1099729ed62eSMatthias Ringwald             hci_send_cmd(&hci_write_synchronous_flow_control_enable, 1); // SCO tracking enabled
1100729ed62eSMatthias Ringwald             break;
1101483c5078SMatthias Ringwald         case HCI_INIT_WRITE_DEFAULT_ERRONEOUS_DATA_REPORTING:
1102483c5078SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_WRITE_DEFAULT_ERRONEOUS_DATA_REPORTING;
1103483c5078SMatthias Ringwald             hci_send_cmd(&hci_write_default_erroneous_data_reporting, 1);
1104483c5078SMatthias Ringwald             break;
1105a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE
110674b323a9SMatthias Ringwald         // LE INIT
110774b323a9SMatthias Ringwald         case HCI_INIT_LE_READ_BUFFER_SIZE:
110874b323a9SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_LE_READ_BUFFER_SIZE;
11090305bdeaSMatthias Ringwald             hci_send_cmd(&hci_le_read_buffer_size);
111074b323a9SMatthias Ringwald             break;
111174b323a9SMatthias Ringwald         case HCI_INIT_WRITE_LE_HOST_SUPPORTED:
111274b323a9SMatthias Ringwald             // LE Supported Host = 1, Simultaneous Host = 0
111374b323a9SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_WRITE_LE_HOST_SUPPORTED;
11140305bdeaSMatthias Ringwald             hci_send_cmd(&hci_write_le_host_supported, 1, 0);
111574b323a9SMatthias Ringwald             break;
11163b6d4121SMatthias Ringwald         case HCI_INIT_READ_WHITE_LIST_SIZE:
11173b6d4121SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_READ_WHITE_LIST_SIZE;
11183b6d4121SMatthias Ringwald             hci_send_cmd(&hci_le_read_white_list_size);
11193b6d4121SMatthias Ringwald             break;
112074b323a9SMatthias Ringwald         case HCI_INIT_LE_SET_SCAN_PARAMETERS:
112174b323a9SMatthias Ringwald             // LE Scan Parameters: active scanning, 300 ms interval, 30 ms window, public address, accept all advs
112274b323a9SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_LE_SET_SCAN_PARAMETERS;
11230305bdeaSMatthias Ringwald             hci_send_cmd(&hci_le_set_scan_parameters, 1, 0x1e0, 0x30, 0, 0);
112474b323a9SMatthias Ringwald             break;
112574b323a9SMatthias Ringwald #endif
112674b323a9SMatthias Ringwald         default:
112774b323a9SMatthias Ringwald             return;
112874b323a9SMatthias Ringwald     }
112955975f88SMatthias Ringwald }
113055975f88SMatthias Ringwald 
1131a650ba4dSMatthias Ringwald static void hci_init_done(void){
1132a650ba4dSMatthias Ringwald     // done. tell the app
1133a650ba4dSMatthias Ringwald     log_info("hci_init_done -> HCI_STATE_WORKING");
1134a650ba4dSMatthias Ringwald     hci_stack->state = HCI_STATE_WORKING;
1135a650ba4dSMatthias Ringwald     hci_emit_state();
1136a650ba4dSMatthias Ringwald     hci_run();
1137a650ba4dSMatthias Ringwald }
1138a650ba4dSMatthias Ringwald 
11396155b3d3S[email protected] static void hci_initializing_event_handler(uint8_t * packet, uint16_t size){
1140a2481739S[email protected]     uint8_t command_completed = 0;
1141c4633093SMatthias Ringwald 
11420e2df43fSMatthias Ringwald     if (hci_event_packet_get_type(packet) == HCI_EVENT_COMMAND_COMPLETE){
1143f8fbdce0SMatthias Ringwald         uint16_t opcode = little_endian_read_16(packet,3);
11446155b3d3S[email protected]         if (opcode == hci_stack->last_cmd_opcode){
1145a2481739S[email protected]             command_completed = 1;
1146148ca237SMatthias Ringwald             log_debug("Command complete for expected opcode %04x at substate %u", opcode, hci_stack->substate);
11476155b3d3S[email protected]         } else {
1148d58dd308SMatthias Ringwald             log_info("Command complete for different opcode %04x, expected %04x, at substate %u", opcode, hci_stack->last_cmd_opcode, hci_stack->substate);
11496155b3d3S[email protected]         }
11506155b3d3S[email protected]     }
11510f97eae7SMatthias Ringwald 
11520e2df43fSMatthias Ringwald     if (hci_event_packet_get_type(packet) == HCI_EVENT_COMMAND_STATUS){
11536155b3d3S[email protected]         uint8_t  status = packet[2];
1154f8fbdce0SMatthias Ringwald         uint16_t opcode = little_endian_read_16(packet,4);
11556155b3d3S[email protected]         if (opcode == hci_stack->last_cmd_opcode){
11566155b3d3S[email protected]             if (status){
1157a2481739S[email protected]                 command_completed = 1;
1158148ca237SMatthias Ringwald                 log_debug("Command status error 0x%02x for expected opcode %04x at substate %u", status, opcode, hci_stack->substate);
11596155b3d3S[email protected]             } else {
11606155b3d3S[email protected]                 log_info("Command status OK for expected opcode %04x, waiting for command complete", opcode);
11616155b3d3S[email protected]             }
11626155b3d3S[email protected]         } else {
1163148ca237SMatthias Ringwald             log_debug("Command status for opcode %04x, expected %04x", opcode, hci_stack->last_cmd_opcode);
11646155b3d3S[email protected]         }
11656155b3d3S[email protected]     }
11660f97eae7SMatthias Ringwald 
1167e47e68c7SMatthias Ringwald     // Vendor == CSR
11680e2df43fSMatthias Ringwald     if (hci_stack->substate == HCI_INIT_W4_CUSTOM_INIT && hci_event_packet_get_type(packet) == HCI_EVENT_VENDOR_SPECIFIC){
1169e47e68c7SMatthias Ringwald         // TODO: track actual command
1170e47e68c7SMatthias Ringwald         command_completed = 1;
1171e47e68c7SMatthias Ringwald     }
1172a2481739S[email protected] 
11734e9daa6fSMatthias Ringwald     // Vendor == Toshiba
11740e2df43fSMatthias Ringwald     if (hci_stack->substate == HCI_INIT_W4_SEND_BAUD_CHANGE && hci_event_packet_get_type(packet) == HCI_EVENT_VENDOR_SPECIFIC){
11754e9daa6fSMatthias Ringwald         // TODO: track actual command
11764e9daa6fSMatthias Ringwald         command_completed = 1;
11774e9daa6fSMatthias Ringwald     }
11784e9daa6fSMatthias Ringwald 
11790f97eae7SMatthias Ringwald     // Late response (> 100 ms) for HCI Reset e.g. on Toshiba TC35661:
11800f97eae7SMatthias Ringwald     // Command complete for HCI Reset arrives after we've resent the HCI Reset command
11810f97eae7SMatthias Ringwald     //
11820f97eae7SMatthias Ringwald     // HCI Reset
11830f97eae7SMatthias Ringwald     // Timeout 100 ms
11840f97eae7SMatthias Ringwald     // HCI Reset
11850f97eae7SMatthias Ringwald     // Command Complete Reset
11860f97eae7SMatthias Ringwald     // HCI Read Local Version Information
11870f97eae7SMatthias Ringwald     // Command Complete Reset - but we expected Command Complete Read Local Version Information
11880f97eae7SMatthias Ringwald     // hang...
11890f97eae7SMatthias Ringwald     //
11900f97eae7SMatthias Ringwald     // Fix: Command Complete for HCI Reset in HCI_INIT_W4_SEND_READ_LOCAL_VERSION_INFORMATION trigger resend
11910f97eae7SMatthias Ringwald     if (!command_completed
11920e2df43fSMatthias Ringwald             && hci_event_packet_get_type(packet) == HCI_EVENT_COMMAND_COMPLETE
11930f97eae7SMatthias Ringwald             && hci_stack->substate == HCI_INIT_W4_SEND_READ_LOCAL_VERSION_INFORMATION){
11940f97eae7SMatthias Ringwald 
1195f8fbdce0SMatthias Ringwald         uint16_t opcode = little_endian_read_16(packet,3);
11960f97eae7SMatthias Ringwald         if (opcode == hci_reset.opcode){
11970f97eae7SMatthias Ringwald             hci_stack->substate = HCI_INIT_SEND_READ_LOCAL_VERSION_INFORMATION;
11980f97eae7SMatthias Ringwald             return;
11990f97eae7SMatthias Ringwald         }
12000f97eae7SMatthias Ringwald     }
12010f97eae7SMatthias Ringwald 
12029f007422SMatthias Ringwald     // CSR & H5
12039f007422SMatthias Ringwald     // Fix: Command Complete for HCI Reset in HCI_INIT_W4_SEND_READ_LOCAL_VERSION_INFORMATION trigger resend
12049f007422SMatthias Ringwald     if (!command_completed
12059f007422SMatthias Ringwald             && hci_event_packet_get_type(packet) == HCI_EVENT_COMMAND_COMPLETE
12069f007422SMatthias Ringwald             && hci_stack->substate == HCI_INIT_W4_READ_LOCAL_SUPPORTED_COMMANDS){
12079f007422SMatthias Ringwald 
12089f007422SMatthias Ringwald         uint16_t opcode = little_endian_read_16(packet,3);
12099f007422SMatthias Ringwald         if (opcode == hci_reset.opcode){
12109f007422SMatthias Ringwald             hci_stack->substate = HCI_INIT_READ_LOCAL_SUPPORTED_COMMANDS;
12119f007422SMatthias Ringwald             return;
12129f007422SMatthias Ringwald         }
12139f007422SMatthias Ringwald     }
12149f007422SMatthias Ringwald 
12159f007422SMatthias 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
12169f007422SMatthias Ringwald     // fix: Correct substate and behave as command below
12179f007422SMatthias Ringwald     if (command_completed){
12189f007422SMatthias Ringwald         switch (hci_stack->substate){
12199f007422SMatthias Ringwald             case HCI_INIT_SEND_RESET:
12209f007422SMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_SEND_RESET;
12219f007422SMatthias Ringwald                 break;
12229f007422SMatthias Ringwald             case HCI_INIT_SEND_RESET_CSR_WARM_BOOT:
12239f007422SMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_CUSTOM_INIT_CSR_WARM_BOOT;
12249f007422SMatthias Ringwald                 break;
12259f007422SMatthias Ringwald             default:
12269f007422SMatthias Ringwald                 break;
12279f007422SMatthias Ringwald         }
12289f007422SMatthias Ringwald     }
12290f97eae7SMatthias Ringwald 
12300f97eae7SMatthias Ringwald 
1231a2481739S[email protected]     if (!command_completed) return;
1232a2481739S[email protected] 
1233db8bc6ffSMatthias Ringwald     int need_baud_change = hci_stack->config
12343fb36a29SMatthias Ringwald                         && hci_stack->chipset
12353fb36a29SMatthias Ringwald                         && hci_stack->chipset->set_baudrate_command
1236db8bc6ffSMatthias Ringwald                         && hci_stack->hci_transport->set_baudrate
12379796ebeaSMatthias Ringwald                         && ((hci_transport_config_uart_t *)hci_stack->config)->baudrate_main;
1238db8bc6ffSMatthias Ringwald 
1239db8bc6ffSMatthias Ringwald     int need_addr_change = hci_stack->custom_bd_addr_set
12403fb36a29SMatthias Ringwald                         && hci_stack->chipset
12413fb36a29SMatthias Ringwald                         && hci_stack->chipset->set_bd_addr_command;
1242a80162e9SMatthias Ringwald 
12435c363727SMatthias Ringwald     switch(hci_stack->substate){
12449f007422SMatthias Ringwald         case HCI_INIT_SEND_RESET:
1245d58dd308SMatthias Ringwald             // on CSR with BCSP/H5, resend triggers resend of HCI Reset and leads to substate == HCI_INIT_SEND_RESET
12469f007422SMatthias Ringwald             // fix: just correct substate and behave as command below
12479f007422SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_SEND_RESET;
12489f007422SMatthias Ringwald             btstack_run_loop_remove_timer(&hci_stack->timeout);
12499f007422SMatthias Ringwald             break;
125074b323a9SMatthias Ringwald         case HCI_INIT_W4_SEND_RESET:
1251528a4a3bSMatthias Ringwald             btstack_run_loop_remove_timer(&hci_stack->timeout);
125276fcb19bSMatthias Ringwald             break;
125376fcb19bSMatthias Ringwald         case HCI_INIT_W4_SEND_READ_LOCAL_VERSION_INFORMATION:
1254cd724cb7SMatthias Ringwald             log_info("Received local version info, need baud change %u", need_baud_change);
12552f48d920SMatthias Ringwald             if (need_baud_change){
12562f48d920SMatthias Ringwald                 hci_stack->substate = HCI_INIT_SEND_BAUD_CHANGE;
12572f48d920SMatthias Ringwald                 return;
12582f48d920SMatthias Ringwald             }
125953860077SMatthias Ringwald             // skip baud change
126074b323a9SMatthias Ringwald             hci_stack->substate = HCI_INIT_CUSTOM_INIT;
126174b323a9SMatthias Ringwald             return;
1262a80162e9SMatthias Ringwald         case HCI_INIT_W4_SEND_BAUD_CHANGE:
12634696bddbSMatthias Ringwald             // for STLC2500D, baud rate change already happened.
1264fab26ab3SMatthias Ringwald             // for others, baud rate gets changed now
12657224be7eSMatthias Ringwald             if ((hci_stack->manufacturer != COMPANY_ID_ST_MICROELECTRONICS) && need_baud_change){
126696b53536SMatthias Ringwald                 uint32_t baud_rate = hci_transport_uart_get_main_baud_rate();
1267cd724cb7SMatthias Ringwald                 log_info("Local baud rate change to %"PRIu32"(w4_send_baud_change)", baud_rate);
1268fab26ab3SMatthias Ringwald                 hci_stack->hci_transport->set_baudrate(baud_rate);
12694696bddbSMatthias Ringwald             }
127074b323a9SMatthias Ringwald             hci_stack->substate = HCI_INIT_CUSTOM_INIT;
127174b323a9SMatthias Ringwald             return;
1272a80162e9SMatthias Ringwald         case HCI_INIT_W4_CUSTOM_INIT_CSR_WARM_BOOT:
1273528a4a3bSMatthias Ringwald             btstack_run_loop_remove_timer(&hci_stack->timeout);
1274a80162e9SMatthias Ringwald             hci_stack->substate = HCI_INIT_CUSTOM_INIT;
1275a80162e9SMatthias Ringwald             return;
127674b323a9SMatthias Ringwald         case HCI_INIT_W4_CUSTOM_INIT:
127774b323a9SMatthias Ringwald             // repeat custom init
127874b323a9SMatthias Ringwald             hci_stack->substate = HCI_INIT_CUSTOM_INIT;
127974b323a9SMatthias Ringwald             return;
1280a828a756SMatthias Ringwald         case HCI_INIT_W4_READ_LOCAL_SUPPORTED_COMMANDS:
1281c6d1dbedSMatthias Ringwald             if (need_baud_change && hci_stack->manufacturer == COMPANY_ID_BROADCOM_CORPORATION){
1282eb3a5314SMatthias Ringwald                 hci_stack->substate = HCI_INIT_SEND_BAUD_CHANGE_BCM;
1283eb3a5314SMatthias Ringwald                 return;
1284eb3a5314SMatthias Ringwald             }
128553860077SMatthias Ringwald             if (need_addr_change){
128653860077SMatthias Ringwald                 hci_stack->substate = HCI_INIT_SET_BD_ADDR;
128753860077SMatthias Ringwald                 return;
128853860077SMatthias Ringwald             }
128953860077SMatthias Ringwald             hci_stack->substate = HCI_INIT_READ_BD_ADDR;
129053860077SMatthias Ringwald             return;
12917224be7eSMatthias Ringwald         case HCI_INIT_W4_SEND_BAUD_CHANGE_BCM:
12927224be7eSMatthias Ringwald             if (need_baud_change){
129396b53536SMatthias Ringwald                 uint32_t baud_rate = hci_transport_uart_get_main_baud_rate();
1294cd724cb7SMatthias Ringwald                 log_info("Local baud rate change to %"PRIu32"(w4_send_baud_change_bcm))", baud_rate);
1295fab26ab3SMatthias Ringwald                 hci_stack->hci_transport->set_baudrate(baud_rate);
12967224be7eSMatthias Ringwald             }
1297eb3a5314SMatthias Ringwald             if (need_addr_change){
1298eb3a5314SMatthias Ringwald                 hci_stack->substate = HCI_INIT_SET_BD_ADDR;
1299eb3a5314SMatthias Ringwald                 return;
1300eb3a5314SMatthias Ringwald             }
1301eb3a5314SMatthias Ringwald             hci_stack->substate = HCI_INIT_READ_BD_ADDR;
1302eb3a5314SMatthias Ringwald             return;
130353860077SMatthias Ringwald         case HCI_INIT_W4_SET_BD_ADDR:
130453860077SMatthias Ringwald             // for STLC2500D, bd addr change only gets active after sending reset command
1305c6d1dbedSMatthias Ringwald             if (hci_stack->manufacturer == COMPANY_ID_ST_MICROELECTRONICS){
130653860077SMatthias Ringwald                 hci_stack->substate = HCI_INIT_SEND_RESET_ST_WARM_BOOT;
130753860077SMatthias Ringwald                 return;
130853860077SMatthias Ringwald             }
130953860077SMatthias Ringwald             // skipping st warm boot
131053860077SMatthias Ringwald             hci_stack->substate = HCI_INIT_READ_BD_ADDR;
131153860077SMatthias Ringwald             return;
131253860077SMatthias Ringwald         case HCI_INIT_W4_SEND_RESET_ST_WARM_BOOT:
131353860077SMatthias Ringwald             hci_stack->substate = HCI_INIT_READ_BD_ADDR;
131453860077SMatthias Ringwald             return;
131553860077SMatthias Ringwald         case HCI_INIT_W4_READ_BD_ADDR:
131653860077SMatthias Ringwald             // only read buffer size if supported
131753860077SMatthias Ringwald             if (hci_stack->local_supported_commands[0] & 0x01) {
131853860077SMatthias Ringwald                 hci_stack->substate = HCI_INIT_READ_BUFFER_SIZE;
131953860077SMatthias Ringwald                 return;
132053860077SMatthias Ringwald             }
132153860077SMatthias Ringwald             // skipping read buffer size
132253860077SMatthias Ringwald             hci_stack->substate = HCI_INIT_READ_LOCAL_SUPPORTED_FEATURES;
1323a828a756SMatthias Ringwald             return;
132474b323a9SMatthias Ringwald         case HCI_INIT_W4_SET_EVENT_MASK:
13256155b3d3S[email protected]             // skip Classic init commands for LE only chipsets
13266155b3d3S[email protected]             if (!hci_classic_supported()){
13276155b3d3S[email protected]                 if (hci_le_supported()){
132874b323a9SMatthias Ringwald                     hci_stack->substate = HCI_INIT_LE_READ_BUFFER_SIZE; // skip all classic command
132974b323a9SMatthias Ringwald                     return;
13306155b3d3S[email protected]                 } else {
13316155b3d3S[email protected]                     log_error("Neither BR/EDR nor LE supported");
1332a650ba4dSMatthias Ringwald                     hci_init_done();
133374b323a9SMatthias Ringwald                     return;
13346155b3d3S[email protected]                 }
13356155b3d3S[email protected]             }
133615a95bd5SMatthias Ringwald             if (!gap_ssp_supported()){
13375c363727SMatthias Ringwald                 hci_stack->substate = HCI_INIT_WRITE_PAGE_TIMEOUT;
133874b323a9SMatthias Ringwald                 return;
13396155b3d3S[email protected]             }
13406155b3d3S[email protected]             break;
1341729ed62eSMatthias Ringwald         case HCI_INIT_W4_WRITE_PAGE_TIMEOUT:
1342729ed62eSMatthias Ringwald             break;
1343a828a756SMatthias Ringwald         case HCI_INIT_W4_LE_READ_BUFFER_SIZE:
1344a828a756SMatthias Ringwald             // skip write le host if not supported (e.g. on LE only EM9301)
1345a828a756SMatthias Ringwald             if (hci_stack->local_supported_commands[0] & 0x02) break;
1346a828a756SMatthias Ringwald             hci_stack->substate = HCI_INIT_LE_SET_SCAN_PARAMETERS;
1347a828a756SMatthias Ringwald             return;
1348ff00ed1cSMatthias Ringwald         case HCI_INIT_W4_WRITE_LOCAL_NAME:
1349ff00ed1cSMatthias Ringwald             // skip write eir data if no eir data set
1350ff00ed1cSMatthias Ringwald             if (hci_stack->eir_data) break;
1351ff00ed1cSMatthias Ringwald             hci_stack->substate = HCI_INIT_WRITE_INQUIRY_MODE;
1352ff00ed1cSMatthias Ringwald             return;
1353729ed62eSMatthias Ringwald 
135471c4de7aSMatthias Ringwald #ifdef ENABLE_SCO_OVER_HCI
1355729ed62eSMatthias Ringwald         case HCI_INIT_W4_WRITE_SCAN_ENABLE:
1356*3905afbfSMatthias Ringwald             // skip write synchronous flow control if not supported
1357*3905afbfSMatthias Ringwald             if (hci_stack->local_supported_commands[0] & 0x04) break;
1358*3905afbfSMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_WRITE_SYNCHRONOUS_FLOW_CONTROL_ENABLE;
1359*3905afbfSMatthias Ringwald             // explicit fall through to reduce repetitions
1360*3905afbfSMatthias Ringwald 
1361729ed62eSMatthias Ringwald         case HCI_INIT_W4_WRITE_SYNCHRONOUS_FLOW_CONTROL_ENABLE:
1362*3905afbfSMatthias Ringwald             // skip write default erroneous data reporting if not supported
1363*3905afbfSMatthias Ringwald             if (hci_stack->local_supported_commands[0] & 0x08) break;
1364*3905afbfSMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_WRITE_DEFAULT_ERRONEOUS_DATA_REPORTING;
1365*3905afbfSMatthias Ringwald             // explicit fall through to reduce repetitions
1366*3905afbfSMatthias Ringwald 
1367f064e0bbSMatthias Ringwald         case HCI_INIT_W4_WRITE_DEFAULT_ERRONEOUS_DATA_REPORTING:
1368729ed62eSMatthias Ringwald             if (!hci_le_supported()){
1369729ed62eSMatthias Ringwald                 // SKIP LE init for Classic only configuration
1370a650ba4dSMatthias Ringwald                 hci_init_done();
1371729ed62eSMatthias Ringwald                 return;
1372729ed62eSMatthias Ringwald             }
1373729ed62eSMatthias Ringwald             break;
1374729ed62eSMatthias Ringwald #else
137574b323a9SMatthias Ringwald         case HCI_INIT_W4_WRITE_SCAN_ENABLE:
13766155b3d3S[email protected]             if (!hci_le_supported()){
13776155b3d3S[email protected]                 // SKIP LE init for Classic only configuration
1378a650ba4dSMatthias Ringwald                 hci_init_done();
137974b323a9SMatthias Ringwald                 return;
13806155b3d3S[email protected]             }
1381729ed62eSMatthias Ringwald #endif
1382729ed62eSMatthias Ringwald             break;
1383a650ba4dSMatthias Ringwald         // Response to command before init done state -> init done
1384a650ba4dSMatthias Ringwald         case (HCI_INIT_DONE-1):
1385a650ba4dSMatthias Ringwald             hci_init_done();
1386a650ba4dSMatthias Ringwald             return;
1387a650ba4dSMatthias Ringwald 
13886155b3d3S[email protected]         default:
138974b323a9SMatthias Ringwald             break;
13906155b3d3S[email protected]     }
139155975f88SMatthias Ringwald     hci_initializing_next_state();
13926155b3d3S[email protected] }
13936155b3d3S[email protected] 
139416833f0aSmatthias.ringwald static void event_handler(uint8_t *packet, int size){
1395e76a89eeS[email protected] 
1396e76a89eeS[email protected]     uint16_t event_length = packet[1];
1397e76a89eeS[email protected] 
1398e76a89eeS[email protected]     // assert packet is complete
1399e76a89eeS[email protected]     if (size != event_length + 2){
1400e76a89eeS[email protected]         log_error("hci.c: event_handler called with event packet of wrong size %u, expected %u => dropping packet", size, event_length + 2);
1401e76a89eeS[email protected]         return;
1402e76a89eeS[email protected]     }
1403e76a89eeS[email protected] 
14041281a47eSmatthias.ringwald     bd_addr_t addr;
140596a45072S[email protected]     bd_addr_type_t addr_type;
14062d00edd4Smatthias.ringwald     uint8_t link_type;
1407fe1ed1b8Smatthias.ringwald     hci_con_handle_t handle;
14081f7b95a1Smatthias.ringwald     hci_connection_t * conn;
140956cf178bSmatthias.ringwald     int i;
141022909952Smatthias.ringwald 
14110e2df43fSMatthias Ringwald     // log_info("HCI:EVENT:%02x", hci_event_packet_get_type(packet));
14125909f7f2Smatthias.ringwald 
14130e2df43fSMatthias Ringwald     switch (hci_event_packet_get_type(packet)) {
141422909952Smatthias.ringwald 
14156772a24cSmatthias.ringwald         case HCI_EVENT_COMMAND_COMPLETE:
14167ec5eeaaSmatthias.ringwald             // get num cmd packets
14179da54300S[email protected]             // log_info("HCI_EVENT_COMMAND_COMPLETE cmds old %u - new %u", hci_stack->num_cmd_packets, packet[2]);
14183a9fb326S[email protected]             hci_stack->num_cmd_packets = packet[2];
14197ec5eeaaSmatthias.ringwald 
1420073bd0faSMatthias Ringwald             if (HCI_EVENT_IS_COMMAND_COMPLETE(packet, hci_read_buffer_size)){
1421e2edc0c3Smatthias.ringwald                 // from offset 5
1422e2edc0c3Smatthias.ringwald                 // status
14231d279b20Smatthias.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"
1424f8fbdce0SMatthias Ringwald                 hci_stack->acl_data_packet_length = little_endian_read_16(packet, 6);
1425a8b12447S[email protected]                 hci_stack->sco_data_packet_length = packet[8];
1426f8fbdce0SMatthias Ringwald                 hci_stack->acl_packets_total_num  = little_endian_read_16(packet, 9);
1427f8fbdce0SMatthias Ringwald                 hci_stack->sco_packets_total_num  = little_endian_read_16(packet, 11);
1428a8b12447S[email protected] 
14293a9fb326S[email protected]                 if (hci_stack->state == HCI_STATE_INITIALIZING){
1430a7a04bd9Smatthias.ringwald                     // determine usable ACL payload size
14313a9fb326S[email protected]                     if (HCI_ACL_PAYLOAD_SIZE < hci_stack->acl_data_packet_length){
14323a9fb326S[email protected]                         hci_stack->acl_data_packet_length = HCI_ACL_PAYLOAD_SIZE;
14338f8108aaSmatthias.ringwald                     }
14341a06f663S[email protected]                     log_info("hci_read_buffer_size: acl used size %u, count %u / sco size %u, count %u",
14351a06f663S[email protected]                              hci_stack->acl_data_packet_length, hci_stack->acl_packets_total_num,
14361a06f663S[email protected]                              hci_stack->sco_data_packet_length, hci_stack->sco_packets_total_num);
1437e2edc0c3Smatthias.ringwald                 }
143856cf178bSmatthias.ringwald             }
1439a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE
1440073bd0faSMatthias Ringwald             if (HCI_EVENT_IS_COMMAND_COMPLETE(packet, hci_le_read_buffer_size)){
1441f8fbdce0SMatthias Ringwald                 hci_stack->le_data_packets_length = little_endian_read_16(packet, 6);
1442ee303eddS[email protected]                 hci_stack->le_acl_packets_total_num  = packet[8];
14436c26b087S[email protected]                     // determine usable ACL payload size
14446c26b087S[email protected]                     if (HCI_ACL_PAYLOAD_SIZE < hci_stack->le_data_packets_length){
14456c26b087S[email protected]                         hci_stack->le_data_packets_length = HCI_ACL_PAYLOAD_SIZE;
14466c26b087S[email protected]                     }
14479da54300S[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);
144865a46ef3S[email protected]             }
1449073bd0faSMatthias Ringwald             if (HCI_EVENT_IS_COMMAND_COMPLETE(packet, hci_le_read_white_list_size)){
1450f8fbdce0SMatthias Ringwald                 hci_stack->le_whitelist_capacity = little_endian_read_16(packet, 6);
145115d0a15bSMatthias Ringwald                 log_info("hci_le_read_white_list_size: size %u", hci_stack->le_whitelist_capacity);
14523b6d4121SMatthias Ringwald             }
145365a46ef3S[email protected] #endif
1454188981d2Smatthias.ringwald             // Dump local address
1455073bd0faSMatthias Ringwald             if (HCI_EVENT_IS_COMMAND_COMPLETE(packet, hci_read_bd_addr)) {
1456724d70a2SMatthias Ringwald                 reverse_bd_addr(&packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE + 1],
1457724d70a2SMatthias Ringwald 				hci_stack->local_bd_addr);
14589da54300S[email protected]                 log_info("Local Address, Status: 0x%02x: Addr: %s",
14593a9fb326S[email protected]                     packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE], bd_addr_to_str(hci_stack->local_bd_addr));
14601624665aSMatthias Ringwald                 if (hci_stack->link_key_db){
14611624665aSMatthias Ringwald                     hci_stack->link_key_db->set_local_bd_addr(hci_stack->local_bd_addr);
14621624665aSMatthias Ringwald                 }
1463188981d2Smatthias.ringwald             }
1464073bd0faSMatthias Ringwald             if (HCI_EVENT_IS_COMMAND_COMPLETE(packet, hci_write_scan_enable)){
14653a9fb326S[email protected]                 hci_emit_discoverable_enabled(hci_stack->discoverable);
1466381fbed8Smatthias.ringwald             }
146765389bfcS[email protected]             // Note: HCI init checks
1468073bd0faSMatthias Ringwald             if (HCI_EVENT_IS_COMMAND_COMPLETE(packet, hci_read_local_supported_features)){
14693a9fb326S[email protected]                 memcpy(hci_stack->local_supported_features, &packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1], 8);
147065389bfcS[email protected] 
1471a5a23fc2S[email protected]                 // determine usable ACL packet types based on host buffer size and supported features
1472a5a23fc2S[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]);
14738b96126aSMatthias Ringwald                 log_info("Packet types %04x, eSCO %u", hci_stack->packet_types, hci_extended_sco_link_supported());
1474f5d8d141S[email protected] 
1475f5d8d141S[email protected]                 // Classic/LE
1476f5d8d141S[email protected]                 log_info("BR/EDR support %u, LE support %u", hci_classic_supported(), hci_le_supported());
1477559e517eS[email protected]             }
1478073bd0faSMatthias Ringwald             if (HCI_EVENT_IS_COMMAND_COMPLETE(packet, hci_read_local_version_information)){
1479f8fbdce0SMatthias Ringwald                 // hci_stack->hci_version    = little_endian_read_16(packet, 4);
1480f8fbdce0SMatthias Ringwald                 // hci_stack->hci_revision   = little_endian_read_16(packet, 6);
1481f8fbdce0SMatthias Ringwald                 // hci_stack->lmp_version    = little_endian_read_16(packet, 8);
1482f8fbdce0SMatthias Ringwald                 hci_stack->manufacturer   = little_endian_read_16(packet, 10);
1483f8fbdce0SMatthias Ringwald                 // hci_stack->lmp_subversion = little_endian_read_16(packet, 12);
14844696bddbSMatthias Ringwald                 log_info("Manufacturer: 0x%04x", hci_stack->manufacturer);
1485a6ddbcb9SMatthias Ringwald                 // notify app
1486a6ddbcb9SMatthias Ringwald                 if (hci_stack->local_version_information_callback){
1487a6ddbcb9SMatthias Ringwald                     hci_stack->local_version_information_callback(packet);
1488a6ddbcb9SMatthias Ringwald                 }
14894696bddbSMatthias Ringwald             }
1490073bd0faSMatthias Ringwald             if (HCI_EVENT_IS_COMMAND_COMPLETE(packet, hci_read_local_supported_commands)){
1491a828a756SMatthias Ringwald                 hci_stack->local_supported_commands[0] =
1492*3905afbfSMatthias Ringwald                     (packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1+14] & 0x80) >> 7 |  // bit 0 = Octet 14, bit 7
1493*3905afbfSMatthias Ringwald                     (packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1+24] & 0x40) >> 5 |  // bit 1 = Octet 24, bit 6
1494*3905afbfSMatthias Ringwald                     (packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1+10] & 0x10) >> 2 |  // bit 2 = Octet 10, bit 4
1495*3905afbfSMatthias Ringwald                     (packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1+18] & 0x08);        // bit 3 = Octet 18, bit 3
1496*3905afbfSMatthias Ringwald                     log_info("Local supported commands summary 0x%02x", hci_stack->local_supported_commands[0]);
1497a828a756SMatthias Ringwald             }
1498073bd0faSMatthias Ringwald             if (HCI_EVENT_IS_COMMAND_COMPLETE(packet, hci_write_synchronous_flow_control_enable)){
14995b9b590fSMatthias Ringwald                 if (packet[5] == 0){
15005b9b590fSMatthias Ringwald                     hci_stack->synchronous_flow_control_enabled = 1;
15015b9b590fSMatthias Ringwald                 }
15025b9b590fSMatthias Ringwald             }
150356cf178bSmatthias.ringwald             break;
150456cf178bSmatthias.ringwald 
15057ec5eeaaSmatthias.ringwald         case HCI_EVENT_COMMAND_STATUS:
15067ec5eeaaSmatthias.ringwald             // get num cmd packets
15079da54300S[email protected]             // log_info("HCI_EVENT_COMMAND_STATUS cmds - old %u - new %u", hci_stack->num_cmd_packets, packet[3]);
15083a9fb326S[email protected]             hci_stack->num_cmd_packets = packet[3];
15097ec5eeaaSmatthias.ringwald             break;
15107ec5eeaaSmatthias.ringwald 
15112e440c8aS[email protected]         case HCI_EVENT_NUMBER_OF_COMPLETED_PACKETS:{
15122e440c8aS[email protected]             int offset = 3;
151356cf178bSmatthias.ringwald             for (i=0; i<packet[2];i++){
1514f8fbdce0SMatthias Ringwald                 handle = little_endian_read_16(packet, offset);
15152e440c8aS[email protected]                 offset += 2;
1516f8fbdce0SMatthias Ringwald                 uint16_t num_packets = little_endian_read_16(packet, offset);
15172e440c8aS[email protected]                 offset += 2;
15182e440c8aS[email protected] 
15195061f3afS[email protected]                 conn = hci_connection_for_handle(handle);
152056cf178bSmatthias.ringwald                 if (!conn){
15219da54300S[email protected]                     log_error("hci_number_completed_packet lists unused con handle %u", handle);
152256cf178bSmatthias.ringwald                     continue;
152356cf178bSmatthias.ringwald                 }
152423bed257S[email protected] 
1525e35edcc1S[email protected]                 if (conn->address_type == BD_ADDR_TYPE_SCO){
1526e35edcc1S[email protected]                     if (conn->num_sco_packets_sent >= num_packets){
1527e35edcc1S[email protected]                         conn->num_sco_packets_sent -= num_packets;
1528e35edcc1S[email protected]                     } else {
1529e35edcc1S[email protected]                         log_error("hci_number_completed_packets, more sco slots freed then sent.");
1530e35edcc1S[email protected]                         conn->num_sco_packets_sent = 0;
1531e35edcc1S[email protected]                     }
1532701e3307SMatthias Ringwald                     hci_notify_if_sco_can_send_now();
1533e35edcc1S[email protected]                 } else {
153423bed257S[email protected]                     if (conn->num_acl_packets_sent >= num_packets){
153556cf178bSmatthias.ringwald                         conn->num_acl_packets_sent -= num_packets;
153623bed257S[email protected]                     } else {
1537e35edcc1S[email protected]                         log_error("hci_number_completed_packets, more acl slots freed then sent.");
153823bed257S[email protected]                         conn->num_acl_packets_sent = 0;
153923bed257S[email protected]                     }
1540e35edcc1S[email protected]                 }
15419da54300S[email protected]                 // log_info("hci_number_completed_packet %u processed for handle %u, outstanding %u", num_packets, handle, conn->num_acl_packets_sent);
154256cf178bSmatthias.ringwald             }
15436772a24cSmatthias.ringwald             break;
15442e440c8aS[email protected]         }
15451f7b95a1Smatthias.ringwald         case HCI_EVENT_CONNECTION_REQUEST:
1546724d70a2SMatthias Ringwald             reverse_bd_addr(&packet[2], addr);
154737eaa4cfSmatthias.ringwald             // TODO: eval COD 8-10
15482d00edd4Smatthias.ringwald             link_type = packet[11];
15499da54300S[email protected]             log_info("Connection_incoming: %s, type %u", bd_addr_to_str(addr), link_type);
1550e35edcc1S[email protected]             addr_type = link_type == 1 ? BD_ADDR_TYPE_CLASSIC : BD_ADDR_TYPE_SCO;
15512e77e513S[email protected]             conn = hci_connection_for_bd_addr_and_type(addr, addr_type);
15521f7b95a1Smatthias.ringwald             if (!conn) {
15535293c072S[email protected]                 conn = create_connection_for_bd_addr_and_type(addr, addr_type);
15541f7b95a1Smatthias.ringwald             }
1555ce4c8fabSmatthias.ringwald             if (!conn) {
1556ce4c8fabSmatthias.ringwald                 // CONNECTION REJECTED DUE TO LIMITED RESOURCES (0X0D)
15573a9fb326S[email protected]                 hci_stack->decline_reason = 0x0d;
1558058e3d6bSMatthias Ringwald                 bd_addr_copy(hci_stack->decline_addr, addr);
1559ce4c8fabSmatthias.ringwald                 break;
1560ce4c8fabSmatthias.ringwald             }
15615cf766e8SMatthias Ringwald             conn->role  = HCI_ROLE_SLAVE;
156232ab9390Smatthias.ringwald             conn->state = RECEIVED_CONNECTION_REQUEST;
1563f3a16b9aSMatthias Ringwald             // store info about eSCO
1564f3a16b9aSMatthias Ringwald             if (link_type == 0x02){
1565f3a16b9aSMatthias Ringwald                 conn->remote_supported_feature_eSCO = 1;
1566f3a16b9aSMatthias Ringwald             }
156732ab9390Smatthias.ringwald             hci_run();
15681f7b95a1Smatthias.ringwald             break;
15691f7b95a1Smatthias.ringwald 
15706772a24cSmatthias.ringwald         case HCI_EVENT_CONNECTION_COMPLETE:
1571fe1ed1b8Smatthias.ringwald             // Connection management
1572724d70a2SMatthias Ringwald             reverse_bd_addr(&packet[5], addr);
15739da54300S[email protected]             log_info("Connection_complete (status=%u) %s", packet[2], bd_addr_to_str(addr));
157496a45072S[email protected]             addr_type = BD_ADDR_TYPE_CLASSIC;
15752e77e513S[email protected]             conn = hci_connection_for_bd_addr_and_type(addr, addr_type);
1576fe1ed1b8Smatthias.ringwald             if (conn) {
1577b448a0e7Smatthias.ringwald                 if (!packet[2]){
1578c8e4258aSmatthias.ringwald                     conn->state = OPEN;
1579f8fbdce0SMatthias Ringwald                     conn->con_handle = little_endian_read_16(packet, 3);
1580ad83dc6aS[email protected]                     conn->bonding_flags |= BONDING_REQUEST_REMOTE_FEATURES;
1581ee091cf1Smatthias.ringwald 
1582c785ef68Smatthias.ringwald                     // restart timer
1583528a4a3bSMatthias Ringwald                     btstack_run_loop_set_timer(&conn->timeout, HCI_CONNECTION_TIMEOUT_MS);
1584528a4a3bSMatthias Ringwald                     btstack_run_loop_add_timer(&conn->timeout);
1585c785ef68Smatthias.ringwald 
15869da54300S[email protected]                     log_info("New connection: handle %u, %s", conn->con_handle, bd_addr_to_str(conn->address));
158743bfb1bdSmatthias.ringwald 
158843bfb1bdSmatthias.ringwald                     hci_emit_nr_connections_changed();
1589b448a0e7Smatthias.ringwald                 } else {
15901bd5283dS[email protected]                     int notify_dedicated_bonding_failed = conn->bonding_flags & BONDING_DEDICATED;
15911bd5283dS[email protected]                     uint8_t status = packet[2];
15921bd5283dS[email protected]                     bd_addr_t bd_address;
15931bd5283dS[email protected]                     memcpy(&bd_address, conn->address, 6);
1594ad83dc6aS[email protected] 
1595b448a0e7Smatthias.ringwald                     // connection failed, remove entry
1596665d90f2SMatthias Ringwald                     btstack_linked_list_remove(&hci_stack->connections, (btstack_linked_item_t *) conn);
1597a3b02b71Smatthias.ringwald                     btstack_memory_hci_connection_free( conn );
1598c12e46e7Smatthias.ringwald 
15991bd5283dS[email protected]                     // notify client if dedicated bonding
16001bd5283dS[email protected]                     if (notify_dedicated_bonding_failed){
16011bd5283dS[email protected]                         log_info("hci notify_dedicated_bonding_failed");
16021bd5283dS[email protected]                         hci_emit_dedicated_bonding_result(bd_address, status);
16031bd5283dS[email protected]                     }
16041bd5283dS[email protected] 
1605c12e46e7Smatthias.ringwald                     // if authentication error, also delete link key
1606c12e46e7Smatthias.ringwald                     if (packet[2] == 0x05) {
160715a95bd5SMatthias Ringwald                         gap_drop_link_key_for_bd_addr(addr);
1608c12e46e7Smatthias.ringwald                     }
1609fe1ed1b8Smatthias.ringwald                 }
1610fe1ed1b8Smatthias.ringwald             }
16116772a24cSmatthias.ringwald             break;
1612fe1ed1b8Smatthias.ringwald 
161344d0e3d5S[email protected]         case HCI_EVENT_SYNCHRONOUS_CONNECTION_COMPLETE:
1614724d70a2SMatthias Ringwald             reverse_bd_addr(&packet[5], addr);
161544d0e3d5S[email protected]             log_info("Synchronous Connection Complete (status=%u) %s", packet[2], bd_addr_to_str(addr));
16161a06f663S[email protected]             if (packet[2]){
161744d0e3d5S[email protected]                 // connection failed
161844d0e3d5S[email protected]                 break;
161944d0e3d5S[email protected]             }
16202e77e513S[email protected]             conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_SCO);
1621e35edcc1S[email protected]             if (!conn) {
1622e35edcc1S[email protected]                 conn = create_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_SCO);
1623e35edcc1S[email protected]             }
1624e35edcc1S[email protected]             if (!conn) {
1625e35edcc1S[email protected]                 break;
1626e35edcc1S[email protected]             }
16271a06f663S[email protected]             conn->state = OPEN;
1628f8fbdce0SMatthias Ringwald             conn->con_handle = little_endian_read_16(packet, 3);
162944d0e3d5S[email protected]             break;
163044d0e3d5S[email protected] 
1631afd4e962S[email protected]         case HCI_EVENT_READ_REMOTE_SUPPORTED_FEATURES_COMPLETE:
1632f8fbdce0SMatthias Ringwald             handle = little_endian_read_16(packet, 3);
1633afd4e962S[email protected]             conn = hci_connection_for_handle(handle);
1634afd4e962S[email protected]             if (!conn) break;
1635afd4e962S[email protected]             if (!packet[2]){
1636afd4e962S[email protected]                 uint8_t * features = &packet[5];
1637afd4e962S[email protected]                 if (features[6] & (1 << 3)){
1638afd4e962S[email protected]                     conn->bonding_flags |= BONDING_REMOTE_SUPPORTS_SSP;
1639afd4e962S[email protected]                 }
164098a2fd1cSMatthias Ringwald                 if (features[3] & (1<<7)){
164198a2fd1cSMatthias Ringwald                     conn->remote_supported_feature_eSCO = 1;
164298a2fd1cSMatthias Ringwald                 }
1643afd4e962S[email protected]             }
1644afd4e962S[email protected]             conn->bonding_flags |= BONDING_RECEIVED_REMOTE_FEATURES;
164598a2fd1cSMatthias Ringwald             log_info("HCI_EVENT_READ_REMOTE_SUPPORTED_FEATURES_COMPLETE, bonding flags %x, eSCO %u", conn->bonding_flags, conn->remote_supported_feature_eSCO);
1646ad83dc6aS[email protected]             if (conn->bonding_flags & BONDING_DEDICATED){
1647ad83dc6aS[email protected]                 conn->bonding_flags |= BONDING_SEND_AUTHENTICATE_REQUEST;
1648ad83dc6aS[email protected]             }
1649afd4e962S[email protected]             break;
1650afd4e962S[email protected] 
16517fde4af9Smatthias.ringwald         case HCI_EVENT_LINK_KEY_REQUEST:
16529da54300S[email protected]             log_info("HCI_EVENT_LINK_KEY_REQUEST");
16537fde4af9Smatthias.ringwald             hci_add_connection_flags_for_flipped_bd_addr(&packet[2], RECV_LINK_KEY_REQUEST);
165474d716b5S[email protected]             // non-bondable mode: link key negative reply will be sent by HANDLE_LINK_KEY_REQUEST
1655a98592bcSMatthias Ringwald             if (hci_stack->bondable && !hci_stack->link_key_db) break;
165632ab9390Smatthias.ringwald             hci_add_connection_flags_for_flipped_bd_addr(&packet[2], HANDLE_LINK_KEY_REQUEST);
165764472d52Smatthias.ringwald             hci_run();
1658d9a327f9Smatthias.ringwald             // request handled by hci_run() as HANDLE_LINK_KEY_REQUEST gets set
165929d53098Smatthias.ringwald             return;
16607fde4af9Smatthias.ringwald 
16619ab95c90S[email protected]         case HCI_EVENT_LINK_KEY_NOTIFICATION: {
1662724d70a2SMatthias Ringwald             reverse_bd_addr(&packet[2], addr);
16632e77e513S[email protected]             conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_CLASSIC);
16649ab95c90S[email protected]             if (!conn) break;
16659ab95c90S[email protected]             conn->authentication_flags |= RECV_LINK_KEY_NOTIFICATION;
16667bdc6798S[email protected]             link_key_type_t link_key_type = (link_key_type_t)packet[24];
16679ab95c90S[email protected]             // Change Connection Encryption keeps link key type
16689ab95c90S[email protected]             if (link_key_type != CHANGED_COMBINATION_KEY){
16699ab95c90S[email protected]                 conn->link_key_type = link_key_type;
16709ab95c90S[email protected]             }
167155597469SMatthias Ringwald             gap_store_link_key_for_bd_addr(addr, &packet[8], conn->link_key_type);
167229d53098Smatthias.ringwald             // still forward event to allow dismiss of pairing dialog
16737fde4af9Smatthias.ringwald             break;
16749ab95c90S[email protected]         }
16757fde4af9Smatthias.ringwald 
16767fde4af9Smatthias.ringwald         case HCI_EVENT_PIN_CODE_REQUEST:
16776724cd9eS[email protected]             hci_add_connection_flags_for_flipped_bd_addr(&packet[2], LEGACY_PAIRING_ACTIVE);
16784c57c146S[email protected]             // non-bondable mode: pin code negative reply will be sent
16793a9fb326S[email protected]             if (!hci_stack->bondable){
1680899283eaS[email protected]                 hci_add_connection_flags_for_flipped_bd_addr(&packet[2], DENY_PIN_CODE_REQUEST);
1681f8fb5f6eS[email protected]                 hci_run();
1682f8fb5f6eS[email protected]                 return;
16834c57c146S[email protected]             }
1684d9a327f9Smatthias.ringwald             // PIN CODE REQUEST means the link key request didn't succee -> delete stored link key
1685a98592bcSMatthias Ringwald             if (!hci_stack->link_key_db) break;
1686a6ef64baSMilanka Ringwald             hci_event_pin_code_request_get_bd_addr(packet, addr);
1687a98592bcSMatthias Ringwald             hci_stack->link_key_db->delete_link_key(addr);
16887fde4af9Smatthias.ringwald             break;
16897fde4af9Smatthias.ringwald 
16901d6b20aeS[email protected]         case HCI_EVENT_IO_CAPABILITY_REQUEST:
16911d6b20aeS[email protected]             hci_add_connection_flags_for_flipped_bd_addr(&packet[2], RECV_IO_CAPABILITIES_REQUEST);
1692dbe1a790S[email protected]             hci_add_connection_flags_for_flipped_bd_addr(&packet[2], SEND_IO_CAPABILITIES_REPLY);
1693dbe1a790S[email protected]             break;
1694dbe1a790S[email protected] 
1695dbe1a790S[email protected]         case HCI_EVENT_USER_CONFIRMATION_REQUEST:
16966724cd9eS[email protected]             hci_add_connection_flags_for_flipped_bd_addr(&packet[2], SSP_PAIRING_ACTIVE);
16973a9fb326S[email protected]             if (!hci_stack->ssp_auto_accept) break;
1698dbe1a790S[email protected]             hci_add_connection_flags_for_flipped_bd_addr(&packet[2], SEND_USER_CONFIRM_REPLY);
1699dbe1a790S[email protected]             break;
1700dbe1a790S[email protected] 
1701dbe1a790S[email protected]         case HCI_EVENT_USER_PASSKEY_REQUEST:
17026724cd9eS[email protected]             hci_add_connection_flags_for_flipped_bd_addr(&packet[2], SSP_PAIRING_ACTIVE);
17033a9fb326S[email protected]             if (!hci_stack->ssp_auto_accept) break;
1704dbe1a790S[email protected]             hci_add_connection_flags_for_flipped_bd_addr(&packet[2], SEND_USER_PASSKEY_REPLY);
17051d6b20aeS[email protected]             break;
17061d6b20aeS[email protected] 
1707f0944df2S[email protected]         case HCI_EVENT_ENCRYPTION_CHANGE:
1708f8fbdce0SMatthias Ringwald             handle = little_endian_read_16(packet, 3);
1709f0944df2S[email protected]             conn = hci_connection_for_handle(handle);
1710f0944df2S[email protected]             if (!conn) break;
1711ad83dc6aS[email protected]             if (packet[2] == 0) {
1712f0944df2S[email protected]                 if (packet[5]){
1713f0944df2S[email protected]                     conn->authentication_flags |= CONNECTION_ENCRYPTED;
1714f0944df2S[email protected]                 } else {
1715536f9994S[email protected]                     conn->authentication_flags &= ~CONNECTION_ENCRYPTED;
1716f0944df2S[email protected]                 }
1717ad83dc6aS[email protected]             }
1718a00031e2S[email protected]             hci_emit_security_level(handle, gap_security_level_for_connection(conn));
1719f0944df2S[email protected]             break;
1720f0944df2S[email protected] 
17211eb2563eS[email protected]         case HCI_EVENT_AUTHENTICATION_COMPLETE_EVENT:
1722f8fbdce0SMatthias Ringwald             handle = little_endian_read_16(packet, 3);
17231eb2563eS[email protected]             conn = hci_connection_for_handle(handle);
17241eb2563eS[email protected]             if (!conn) break;
1725ad83dc6aS[email protected] 
1726ad83dc6aS[email protected]             // dedicated bonding: send result and disconnect
1727ad83dc6aS[email protected]             if (conn->bonding_flags & BONDING_DEDICATED){
1728ad83dc6aS[email protected]                 conn->bonding_flags &= ~BONDING_DEDICATED;
1729ad83dc6aS[email protected]                 conn->bonding_flags |= BONDING_DISCONNECT_DEDICATED_DONE;
17301bd5283dS[email protected]                 conn->bonding_status = packet[2];
1731ad83dc6aS[email protected]                 break;
1732ad83dc6aS[email protected]             }
1733ad83dc6aS[email protected] 
1734b5cb6874S[email protected]             if (packet[2] == 0 && gap_security_level_for_link_key_type(conn->link_key_type) >= conn->requested_security_level){
17351eb2563eS[email protected]                 // link key sufficient for requested security
17361eb2563eS[email protected]                 conn->bonding_flags |= BONDING_SEND_ENCRYPTION_REQUEST;
1737ad83dc6aS[email protected]                 break;
1738ad83dc6aS[email protected]             }
17391eb2563eS[email protected]             // not enough
17401eb2563eS[email protected]             hci_emit_security_level(handle, gap_security_level_for_connection(conn));
17411eb2563eS[email protected]             break;
174234d2123cS[email protected] 
174386805605S[email protected]         // HCI_EVENT_DISCONNECTION_COMPLETE
1744ccda6e14S[email protected]         // has been split, to first notify stack before shutting connection down
1745ccda6e14S[email protected]         // see end of function, too.
1746a4f30ec0S[email protected]         case HCI_EVENT_DISCONNECTION_COMPLETE:
1747a4f30ec0S[email protected]             if (packet[2]) break;   // status != 0
1748f8fbdce0SMatthias Ringwald             handle = little_endian_read_16(packet, 3);
1749c6a37cfdSMatthias Ringwald             // drop outgoing ACL fragments if it is for closed connection
1750c6a37cfdSMatthias Ringwald             if (hci_stack->acl_fragmentation_total_size > 0) {
1751c6a37cfdSMatthias Ringwald                 if (handle == READ_ACL_CONNECTION_HANDLE(hci_stack->hci_packet_buffer)){
1752c6a37cfdSMatthias Ringwald                     log_info("hci: drop fragmented ACL data for closed connection");
1753c6a37cfdSMatthias Ringwald                      hci_stack->acl_fragmentation_total_size = 0;
1754c6a37cfdSMatthias Ringwald                      hci_stack->acl_fragmentation_pos = 0;
1755c6a37cfdSMatthias Ringwald                 }
1756c6a37cfdSMatthias Ringwald             }
17579a2e4658SMatthias Ringwald             // re-enable advertisements for le connections if active
1758c6a37cfdSMatthias Ringwald             conn = hci_connection_for_handle(handle);
1759c6a37cfdSMatthias Ringwald             if (!conn) break;
17609a2e4658SMatthias Ringwald             if (hci_is_le_connection(conn) && hci_stack->le_advertisements_enabled){
17619a2e4658SMatthias Ringwald                 hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_ENABLE;
17629a2e4658SMatthias Ringwald             }
1763ccda6e14S[email protected]             conn->state = RECEIVED_DISCONNECTION_COMPLETE;
1764ccda6e14S[email protected]             break;
17656772a24cSmatthias.ringwald 
1766c68bdf90Smatthias.ringwald         case HCI_EVENT_HARDWARE_ERROR:
1767313e5f9cSMatthias Ringwald             log_error("Hardware Error: 0x%02x", packet[2]);
1768d23838ecSMatthias Ringwald             if (hci_stack->hardware_error_callback){
1769c2e1fa60SMatthias Ringwald                 (*hci_stack->hardware_error_callback)(packet[2]);
17707586ee35S[email protected]             } else {
17717586ee35S[email protected]                 // if no special requests, just reboot stack
17727586ee35S[email protected]                 hci_power_control_off();
17737586ee35S[email protected]                 hci_power_control_on();
1774c68bdf90Smatthias.ringwald             }
1775c68bdf90Smatthias.ringwald             break;
1776c68bdf90Smatthias.ringwald 
17775cf766e8SMatthias Ringwald         case HCI_EVENT_ROLE_CHANGE:
17785cf766e8SMatthias Ringwald             if (packet[2]) break;   // status != 0
1779f8fbdce0SMatthias Ringwald             handle = little_endian_read_16(packet, 3);
17805cf766e8SMatthias Ringwald             conn = hci_connection_for_handle(handle);
17815cf766e8SMatthias Ringwald             if (!conn) break;       // no conn
17825cf766e8SMatthias Ringwald             conn->role = packet[9];
17835cf766e8SMatthias Ringwald             break;
17845cf766e8SMatthias Ringwald 
178563fa3374SMatthias Ringwald         case HCI_EVENT_TRANSPORT_PACKET_SENT:
1786d051460cS[email protected]             // release packet buffer only for asynchronous transport and if there are not further fragements
17874fa24b5fS[email protected]             if (hci_transport_synchronous()) {
178863fa3374SMatthias Ringwald                 log_error("Synchronous HCI Transport shouldn't send HCI_EVENT_TRANSPORT_PACKET_SENT");
17894fa24b5fS[email protected]                 return; // instead of break: to avoid re-entering hci_run()
17904fa24b5fS[email protected]             }
1791d051460cS[email protected]             if (hci_stack->acl_fragmentation_total_size) break;
1792d051460cS[email protected]             hci_release_packet_buffer();
1793701e3307SMatthias Ringwald 
179463fa3374SMatthias Ringwald             // L2CAP receives this event via the hci_emit_event below
179563fa3374SMatthias Ringwald 
179663fa3374SMatthias Ringwald             // For SCO, we do the can_send_now_check here
1797701e3307SMatthias Ringwald             hci_notify_if_sco_can_send_now();
17986b4af23dS[email protected]             break;
17996b4af23dS[email protected] 
180063fa3374SMatthias Ringwald         case HCI_EVENT_SCO_CAN_SEND_NOW:
180163fa3374SMatthias Ringwald             // For SCO, we do the can_send_now_check here
180263fa3374SMatthias Ringwald             hci_notify_if_sco_can_send_now();
180363fa3374SMatthias Ringwald             return;
180463fa3374SMatthias Ringwald 
1805a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE
18065909f7f2Smatthias.ringwald         case HCI_EVENT_LE_META:
18075909f7f2Smatthias.ringwald             switch (packet[2]){
180857c9da5bS[email protected]                 case HCI_SUBEVENT_LE_ADVERTISING_REPORT:
18094f4e0224SMatthias Ringwald                     // log_info("advertising report received");
18107bdc6798S[email protected]                     if (hci_stack->le_scanning_state != LE_SCANNING) break;
181157c9da5bS[email protected]                     le_handle_advertisement_report(packet, size);
18127bdc6798S[email protected]                     break;
18135909f7f2Smatthias.ringwald                 case HCI_SUBEVENT_LE_CONNECTION_COMPLETE:
18145909f7f2Smatthias.ringwald                     // Connection management
1815724d70a2SMatthias Ringwald                     reverse_bd_addr(&packet[8], addr);
18167bdc6798S[email protected]                     addr_type = (bd_addr_type_t)packet[7];
18179da54300S[email protected]                     log_info("LE Connection_complete (status=%u) type %u, %s", packet[3], addr_type, bd_addr_to_str(addr));
18182e77e513S[email protected]                     conn = hci_connection_for_bd_addr_and_type(addr, addr_type);
181942ff5ba1SMatthias Ringwald                     // if auto-connect, remove from whitelist in both roles
182042ff5ba1SMatthias Ringwald                     if (hci_stack->le_connecting_state == LE_CONNECTING_WHITELIST){
182142ff5ba1SMatthias Ringwald                         hci_remove_from_whitelist(addr_type, addr);
182242ff5ba1SMatthias Ringwald                     }
182342ff5ba1SMatthias Ringwald                     // handle error: error is reported only to the initiator -> outgoing connection
18245909f7f2Smatthias.ringwald                     if (packet[3]){
182542ff5ba1SMatthias Ringwald                         // outgoing connection establishment is done
182642ff5ba1SMatthias Ringwald                         hci_stack->le_connecting_state = LE_CONNECTING_IDLE;
182742ff5ba1SMatthias Ringwald                         // remove entry
18285909f7f2Smatthias.ringwald                         if (conn){
1829665d90f2SMatthias Ringwald                             btstack_linked_list_remove(&hci_stack->connections, (btstack_linked_item_t *) conn);
18305909f7f2Smatthias.ringwald                             btstack_memory_hci_connection_free( conn );
18315909f7f2Smatthias.ringwald                         }
18325909f7f2Smatthias.ringwald                         break;
18335909f7f2Smatthias.ringwald                     }
183442ff5ba1SMatthias Ringwald                     // on success, both hosts receive connection complete event
18355cf766e8SMatthias Ringwald                     if (packet[6] == HCI_ROLE_MASTER){
183642ff5ba1SMatthias Ringwald                         // if we're master, it was an outgoing connection and we're done with it
183742ff5ba1SMatthias Ringwald                         hci_stack->le_connecting_state = LE_CONNECTING_IDLE;
183842ff5ba1SMatthias Ringwald                     } else {
183942ff5ba1SMatthias Ringwald                         // if we're slave, it was an incoming connection, advertisements have stopped
1840171293d3SMatthias Ringwald                         hci_stack->le_advertisements_active = 0;
184142ff5ba1SMatthias Ringwald                     }
1842171293d3SMatthias Ringwald                     // LE connections are auto-accepted, so just create a connection if there isn't one already
184342ff5ba1SMatthias Ringwald                     if (!conn){
184496a45072S[email protected]                         conn = create_connection_for_bd_addr_and_type(addr, addr_type);
18455909f7f2Smatthias.ringwald                     }
184642ff5ba1SMatthias Ringwald                     // no memory, sorry.
18475909f7f2Smatthias.ringwald                     if (!conn){
18485909f7f2Smatthias.ringwald                         break;
18495909f7f2Smatthias.ringwald                     }
18505909f7f2Smatthias.ringwald 
18515909f7f2Smatthias.ringwald                     conn->state = OPEN;
18525cf766e8SMatthias Ringwald                     conn->role  = packet[6];
1853f8fbdce0SMatthias Ringwald                     conn->con_handle = little_endian_read_16(packet, 4);
18545909f7f2Smatthias.ringwald 
18555909f7f2Smatthias.ringwald                     // TODO: store - role, peer address type, conn_interval, conn_latency, supervision timeout, master clock
18565909f7f2Smatthias.ringwald 
18575909f7f2Smatthias.ringwald                     // restart timer
1858528a4a3bSMatthias Ringwald                     // btstack_run_loop_set_timer(&conn->timeout, HCI_CONNECTION_TIMEOUT_MS);
1859528a4a3bSMatthias Ringwald                     // btstack_run_loop_add_timer(&conn->timeout);
18605909f7f2Smatthias.ringwald 
18619da54300S[email protected]                     log_info("New connection: handle %u, %s", conn->con_handle, bd_addr_to_str(conn->address));
18625909f7f2Smatthias.ringwald 
18635909f7f2Smatthias.ringwald                     hci_emit_nr_connections_changed();
18645909f7f2Smatthias.ringwald                     break;
18655909f7f2Smatthias.ringwald 
1866f8fbdce0SMatthias Ringwald             // log_info("LE buffer size: %u, count %u", little_endian_read_16(packet,6), packet[8]);
186765a46ef3S[email protected] 
18685909f7f2Smatthias.ringwald                 default:
18695909f7f2Smatthias.ringwald                     break;
18705909f7f2Smatthias.ringwald             }
18715909f7f2Smatthias.ringwald             break;
18725909f7f2Smatthias.ringwald #endif
18736772a24cSmatthias.ringwald         default:
18746772a24cSmatthias.ringwald             break;
1875fe1ed1b8Smatthias.ringwald     }
1876fe1ed1b8Smatthias.ringwald 
18773429f56bSmatthias.ringwald     // handle BT initialization
18783a9fb326S[email protected]     if (hci_stack->state == HCI_STATE_INITIALIZING){
18796155b3d3S[email protected]         hci_initializing_event_handler(packet, size);
1880c9af4d3fS[email protected]     }
188122909952Smatthias.ringwald 
188289db417bSmatthias.ringwald     // help with BT sleep
18833a9fb326S[email protected]     if (hci_stack->state == HCI_STATE_FALLING_ASLEEP
188474b323a9SMatthias Ringwald         && hci_stack->substate == HCI_FALLING_ASLEEP_W4_WRITE_SCAN_ENABLE
1885073bd0faSMatthias Ringwald         && HCI_EVENT_IS_COMMAND_COMPLETE(packet, hci_write_scan_enable)){
188655975f88SMatthias Ringwald         hci_initializing_next_state();
188789db417bSmatthias.ringwald     }
188889db417bSmatthias.ringwald 
188986805605S[email protected]     // notify upper stack
1890d6b06661SMatthias Ringwald 	hci_emit_event(packet, size, 0);   // don't dump, already happened in packet handler
189194ab26f8Smatthias.ringwald 
189286805605S[email protected]     // moved here to give upper stack a chance to close down everything with hci_connection_t intact
18930e2df43fSMatthias Ringwald     if (hci_event_packet_get_type(packet) == HCI_EVENT_DISCONNECTION_COMPLETE){
189486805605S[email protected]         if (!packet[2]){
1895f8fbdce0SMatthias Ringwald             handle = little_endian_read_16(packet, 3);
189605ae8de3SMatthias Ringwald             hci_connection_t * aConn = hci_connection_for_handle(handle);
189705ae8de3SMatthias Ringwald             if (aConn) {
189805ae8de3SMatthias Ringwald                 uint8_t status = aConn->bonding_status;
189905ae8de3SMatthias Ringwald                 uint16_t flags = aConn->bonding_flags;
190086805605S[email protected]                 bd_addr_t bd_address;
190105ae8de3SMatthias Ringwald                 memcpy(&bd_address, aConn->address, 6);
190205ae8de3SMatthias Ringwald                 hci_shutdown_connection(aConn);
1903bb820044S[email protected]                 // connection struct is gone, don't access anymore
1904bb820044S[email protected]                 if (flags & BONDING_EMIT_COMPLETE_ON_DISCONNECT){
190586805605S[email protected]                     hci_emit_dedicated_bonding_result(bd_address, status);
190686805605S[email protected]                 }
190786805605S[email protected]             }
190886805605S[email protected]         }
190986805605S[email protected]     }
191086805605S[email protected] 
191194ab26f8Smatthias.ringwald 	// execute main loop
191294ab26f8Smatthias.ringwald 	hci_run();
191316833f0aSmatthias.ringwald }
191416833f0aSmatthias.ringwald 
1915c91d150bS[email protected] static void sco_handler(uint8_t * packet, uint16_t size){
19168abbe8b5SMatthias Ringwald     if (!hci_stack->sco_packet_handler) return;
19173d50b4baSMatthias Ringwald     hci_stack->sco_packet_handler(HCI_SCO_DATA_PACKET, 0, packet, size);
1918c91d150bS[email protected] }
1919c91d150bS[email protected] 
19200a57e69fSmatthias.ringwald static void packet_handler(uint8_t packet_type, uint8_t *packet, uint16_t size){
19215bb5bc3eS[email protected]     hci_dump_packet(packet_type, 1, packet, size);
192210e830c9Smatthias.ringwald     switch (packet_type) {
192310e830c9Smatthias.ringwald         case HCI_EVENT_PACKET:
192410e830c9Smatthias.ringwald             event_handler(packet, size);
192510e830c9Smatthias.ringwald             break;
192610e830c9Smatthias.ringwald         case HCI_ACL_DATA_PACKET:
192710e830c9Smatthias.ringwald             acl_handler(packet, size);
192810e830c9Smatthias.ringwald             break;
1929c91d150bS[email protected]         case HCI_SCO_DATA_PACKET:
1930c91d150bS[email protected]             sco_handler(packet, size);
193110e830c9Smatthias.ringwald         default:
193210e830c9Smatthias.ringwald             break;
193310e830c9Smatthias.ringwald     }
193410e830c9Smatthias.ringwald }
193510e830c9Smatthias.ringwald 
1936d6b06661SMatthias Ringwald /**
1937d6b06661SMatthias Ringwald  * @brief Add event packet handler.
1938d6b06661SMatthias Ringwald  */
1939d6b06661SMatthias Ringwald void hci_add_event_handler(btstack_packet_callback_registration_t * callback_handler){
1940d6b06661SMatthias Ringwald     btstack_linked_list_add_tail(&hci_stack->event_handlers, (btstack_linked_item_t*) callback_handler);
1941d6b06661SMatthias Ringwald }
1942d6b06661SMatthias Ringwald 
1943d6b06661SMatthias Ringwald 
1944fcadd0caSmatthias.ringwald /** Register HCI packet handlers */
19453d50b4baSMatthias Ringwald void hci_register_acl_packet_handler(btstack_packet_handler_t handler){
1946fb37a842SMatthias Ringwald     hci_stack->acl_packet_handler = handler;
194716833f0aSmatthias.ringwald }
194816833f0aSmatthias.ringwald 
19498abbe8b5SMatthias Ringwald /**
19508abbe8b5SMatthias Ringwald  * @brief Registers a packet handler for SCO data. Used for HSP and HFP profiles.
19518abbe8b5SMatthias Ringwald  */
19523d50b4baSMatthias Ringwald void hci_register_sco_packet_handler(btstack_packet_handler_t handler){
19538abbe8b5SMatthias Ringwald     hci_stack->sco_packet_handler = handler;
19548abbe8b5SMatthias Ringwald }
19558abbe8b5SMatthias Ringwald 
195671de195eSMatthias Ringwald static void hci_state_reset(void){
1957595bdbfbS[email protected]     // no connections yet
1958595bdbfbS[email protected]     hci_stack->connections = NULL;
195974308b23Smatthias.ringwald 
196074308b23Smatthias.ringwald     // keep discoverable/connectable as this has been requested by the client(s)
196174308b23Smatthias.ringwald     // hci_stack->discoverable = 0;
196274308b23Smatthias.ringwald     // hci_stack->connectable = 0;
196374308b23Smatthias.ringwald     // hci_stack->bondable = 1;
1964595bdbfbS[email protected] 
196544935e40S[email protected]     // buffer is free
196644935e40S[email protected]     hci_stack->hci_packet_buffer_reserved = 0;
196744935e40S[email protected] 
1968595bdbfbS[email protected]     // no pending cmds
1969595bdbfbS[email protected]     hci_stack->decline_reason = 0;
1970595bdbfbS[email protected]     hci_stack->new_scan_enable_value = 0xff;
1971595bdbfbS[email protected] 
1972595bdbfbS[email protected]     // LE
1973595bdbfbS[email protected]     hci_stack->adv_addr_type = 0;
1974595bdbfbS[email protected]     memset(hci_stack->adv_address, 0, 6);
1975595bdbfbS[email protected]     hci_stack->le_scanning_state = LE_SCAN_IDLE;
1976e2602ea2Smatthias.ringwald     hci_stack->le_scan_type = 0xff;
1977b04dfa37SMatthias Ringwald     hci_stack->le_connecting_state = LE_CONNECTING_IDLE;
1978e83201bcSMatthias Ringwald     hci_stack->le_whitelist = 0;
1979e83201bcSMatthias Ringwald     hci_stack->le_whitelist_capacity = 0;
1980e21192abSMatthias Ringwald     hci_stack->le_connection_parameter_range.le_conn_interval_min =          6;
1981e21192abSMatthias Ringwald     hci_stack->le_connection_parameter_range.le_conn_interval_max =       3200;
1982e21192abSMatthias Ringwald     hci_stack->le_connection_parameter_range.le_conn_latency_min =           0;
1983e21192abSMatthias Ringwald     hci_stack->le_connection_parameter_range.le_conn_latency_max =         500;
1984e21192abSMatthias Ringwald     hci_stack->le_connection_parameter_range.le_supervision_timeout_min =   10;
1985e21192abSMatthias Ringwald     hci_stack->le_connection_parameter_range.le_supervision_timeout_max = 3200;
1986595bdbfbS[email protected] }
1987595bdbfbS[email protected] 
19882d5e09d6SMatthias Ringwald /**
19892d5e09d6SMatthias Ringwald  * @brief Configure Bluetooth hardware control. Has to be called before power on.
19902d5e09d6SMatthias Ringwald  */
19912d5e09d6SMatthias Ringwald void hci_set_link_key_db(btstack_link_key_db_t const * link_key_db){
19922d5e09d6SMatthias Ringwald     // store and open remote device db
19932d5e09d6SMatthias Ringwald     hci_stack->link_key_db = link_key_db;
19942d5e09d6SMatthias Ringwald     if (hci_stack->link_key_db) {
19952d5e09d6SMatthias Ringwald         hci_stack->link_key_db->open();
19962d5e09d6SMatthias Ringwald     }
19972d5e09d6SMatthias Ringwald }
19982d5e09d6SMatthias Ringwald 
19992d5e09d6SMatthias Ringwald void hci_init(const hci_transport_t *transport, const void *config){
2000475c8125Smatthias.ringwald 
20013a9fb326S[email protected] #ifdef HAVE_MALLOC
20023a9fb326S[email protected]     if (!hci_stack) {
20033a9fb326S[email protected]         hci_stack = (hci_stack_t*) malloc(sizeof(hci_stack_t));
20043a9fb326S[email protected]     }
20053a9fb326S[email protected] #else
20063a9fb326S[email protected]     hci_stack = &hci_stack_static;
20073a9fb326S[email protected] #endif
200866fb9560S[email protected]     memset(hci_stack, 0, sizeof(hci_stack_t));
20093a9fb326S[email protected] 
2010475c8125Smatthias.ringwald     // reference to use transport layer implementation
20113a9fb326S[email protected]     hci_stack->hci_transport = transport;
2012475c8125Smatthias.ringwald 
201311e23e5fSmatthias.ringwald     // reference to used config
20143a9fb326S[email protected]     hci_stack->config = config;
201511e23e5fSmatthias.ringwald 
201626a9b6daSMatthias Ringwald     // setup pointer for outgoing packet buffer
201726a9b6daSMatthias Ringwald     hci_stack->hci_packet_buffer = &hci_stack->hci_packet_buffer_data[HCI_OUTGOING_PRE_BUFFER_SIZE];
201826a9b6daSMatthias Ringwald 
20198fcba05dSmatthias.ringwald     // max acl payload size defined in config.h
20203a9fb326S[email protected]     hci_stack->acl_data_packet_length = HCI_ACL_PAYLOAD_SIZE;
20218fcba05dSmatthias.ringwald 
202216833f0aSmatthias.ringwald     // register packet handlers with transport
202310e830c9Smatthias.ringwald     transport->register_packet_handler(&packet_handler);
2024f5454fc6Smatthias.ringwald 
20253a9fb326S[email protected]     hci_stack->state = HCI_STATE_OFF;
2026e2386ba1S[email protected] 
2027e2386ba1S[email protected]     // class of device
20283a9fb326S[email protected]     hci_stack->class_of_device = 0x007a020c; // Smartphone
2029a45d6b9fS[email protected] 
2030f20168b8Smatthias.ringwald     // bondable by default
2031f20168b8Smatthias.ringwald     hci_stack->bondable = 1;
2032f20168b8Smatthias.ringwald 
203363048403S[email protected]     // Secure Simple Pairing default: enable, no I/O capabilities, general bonding, mitm not required, auto accept
20343a9fb326S[email protected]     hci_stack->ssp_enable = 1;
20353a9fb326S[email protected]     hci_stack->ssp_io_capability = SSP_IO_CAPABILITY_NO_INPUT_NO_OUTPUT;
20363a9fb326S[email protected]     hci_stack->ssp_authentication_requirement = SSP_IO_AUTHREQ_MITM_PROTECTION_NOT_REQUIRED_GENERAL_BONDING;
20373a9fb326S[email protected]     hci_stack->ssp_auto_accept = 1;
203869a97523S[email protected] 
2039d950d659SMatthias Ringwald     // voice setting - signed 8 bit pcm data with CVSD over the air
2040d950d659SMatthias Ringwald     hci_stack->sco_voice_setting = 0x40;
2041d950d659SMatthias Ringwald 
2042595bdbfbS[email protected]     hci_state_reset();
2043475c8125Smatthias.ringwald }
2044475c8125Smatthias.ringwald 
20453fb36a29SMatthias Ringwald /**
20463fb36a29SMatthias Ringwald  * @brief Configure Bluetooth chipset driver. Has to be called before power on, or right after receiving the local version information
20473fb36a29SMatthias Ringwald  */
20483fb36a29SMatthias Ringwald void hci_set_chipset(const btstack_chipset_t *chipset_driver){
20493fb36a29SMatthias Ringwald     hci_stack->chipset = chipset_driver;
20503fb36a29SMatthias Ringwald 
20513fb36a29SMatthias Ringwald     // reset chipset driver - init is also called on power_up
20523fb36a29SMatthias Ringwald     if (hci_stack->chipset && hci_stack->chipset->init){
20533fb36a29SMatthias Ringwald         hci_stack->chipset->init(hci_stack->config);
20543fb36a29SMatthias Ringwald     }
20553fb36a29SMatthias Ringwald }
20563fb36a29SMatthias Ringwald 
2057fb55bd0aSMatthias Ringwald /**
2058d0b87befSMatthias Ringwald  * @brief Configure Bluetooth hardware control. Has to be called after hci_init() but before power on.
2059fb55bd0aSMatthias Ringwald  */
2060fb55bd0aSMatthias Ringwald void hci_set_control(const btstack_control_t *hardware_control){
2061fb55bd0aSMatthias Ringwald     // references to used control implementation
2062fb55bd0aSMatthias Ringwald     hci_stack->control = hardware_control;
2063d0b87befSMatthias Ringwald     // init with transport config
2064d0b87befSMatthias Ringwald     hardware_control->init(hci_stack->config);
2065fb55bd0aSMatthias Ringwald }
2066fb55bd0aSMatthias Ringwald 
206771de195eSMatthias Ringwald void hci_close(void){
2068404843c1Smatthias.ringwald     // close remote device db
2069a98592bcSMatthias Ringwald     if (hci_stack->link_key_db) {
2070a98592bcSMatthias Ringwald         hci_stack->link_key_db->close();
2071404843c1Smatthias.ringwald     }
20727224be7eSMatthias Ringwald 
20737224be7eSMatthias Ringwald     btstack_linked_list_iterator_t lit;
20747224be7eSMatthias Ringwald     btstack_linked_list_iterator_init(&lit, &hci_stack->connections);
20757224be7eSMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&lit)){
20767224be7eSMatthias Ringwald         // cancel all l2cap connections by emitting dicsconnection complete before shutdown (free) connection
20777224be7eSMatthias Ringwald         hci_connection_t * connection = (hci_connection_t*) btstack_linked_list_iterator_next(&lit);
20787224be7eSMatthias Ringwald         hci_emit_disconnection_complete(connection->con_handle, 0x16); // terminated by local host
20797224be7eSMatthias Ringwald         hci_shutdown_connection(connection);
2080f5454fc6Smatthias.ringwald     }
20817224be7eSMatthias Ringwald 
2082f5454fc6Smatthias.ringwald     hci_power_control(HCI_POWER_OFF);
20833a9fb326S[email protected] 
20843a9fb326S[email protected] #ifdef HAVE_MALLOC
20853a9fb326S[email protected]     free(hci_stack);
20863a9fb326S[email protected] #endif
20873a9fb326S[email protected]     hci_stack = NULL;
2088404843c1Smatthias.ringwald }
2089404843c1Smatthias.ringwald 
209060b9e82fSMatthias Ringwald void gap_set_class_of_device(uint32_t class_of_device){
20919e61646fS[email protected]     hci_stack->class_of_device = class_of_device;
20929e61646fS[email protected] }
20939e61646fS[email protected] 
2094f456b2d0S[email protected] // Set Public BD ADDR - passed on to Bluetooth chipset if supported in bt_control_h
2095f456b2d0S[email protected] void hci_set_bd_addr(bd_addr_t addr){
2096f456b2d0S[email protected]     memcpy(hci_stack->custom_bd_addr, addr, 6);
2097f456b2d0S[email protected]     hci_stack->custom_bd_addr_set = 1;
2098f456b2d0S[email protected] }
2099f456b2d0S[email protected] 
210071de195eSMatthias Ringwald void hci_disable_l2cap_timeout_check(void){
210166fb9560S[email protected]     disable_l2cap_timeouts = 1;
210266fb9560S[email protected] }
21038d213e1aSmatthias.ringwald // State-Module-Driver overview
21048d213e1aSmatthias.ringwald // state                    module  low-level
21058d213e1aSmatthias.ringwald // HCI_STATE_OFF             off      close
21068d213e1aSmatthias.ringwald // HCI_STATE_INITIALIZING,   on       open
21078d213e1aSmatthias.ringwald // HCI_STATE_WORKING,        on       open
21088d213e1aSmatthias.ringwald // HCI_STATE_HALTING,        on       open
2109d661ed19Smatthias.ringwald // HCI_STATE_SLEEPING,    off/sleep   close
2110d661ed19Smatthias.ringwald // HCI_STATE_FALLING_ASLEEP  on       open
2111c7e0c5f6Smatthias.ringwald 
211240d1c7a4Smatthias.ringwald static int hci_power_control_on(void){
21137301ad89Smatthias.ringwald 
2114038bc64cSmatthias.ringwald     // power on
2115f9a30166Smatthias.ringwald     int err = 0;
21163a9fb326S[email protected]     if (hci_stack->control && hci_stack->control->on){
2117d0b87befSMatthias Ringwald         err = (*hci_stack->control->on)();
2118f9a30166Smatthias.ringwald     }
2119038bc64cSmatthias.ringwald     if (err){
21209da54300S[email protected]         log_error( "POWER_ON failed");
2121038bc64cSmatthias.ringwald         hci_emit_hci_open_failed();
2122038bc64cSmatthias.ringwald         return err;
2123038bc64cSmatthias.ringwald     }
2124038bc64cSmatthias.ringwald 
212524b3c629SMatthias Ringwald     // int chipset driver
21263fb36a29SMatthias Ringwald     if (hci_stack->chipset && hci_stack->chipset->init){
21273fb36a29SMatthias Ringwald         hci_stack->chipset->init(hci_stack->config);
21283fb36a29SMatthias Ringwald     }
21293fb36a29SMatthias Ringwald 
213024b3c629SMatthias Ringwald     // init transport
213124b3c629SMatthias Ringwald     if (hci_stack->hci_transport->init){
213224b3c629SMatthias Ringwald         hci_stack->hci_transport->init(hci_stack->config);
213324b3c629SMatthias Ringwald     }
213424b3c629SMatthias Ringwald 
213524b3c629SMatthias Ringwald     // open transport
213624b3c629SMatthias Ringwald     err = hci_stack->hci_transport->open();
2137038bc64cSmatthias.ringwald     if (err){
21389da54300S[email protected]         log_error( "HCI_INIT failed, turning Bluetooth off again");
21393a9fb326S[email protected]         if (hci_stack->control && hci_stack->control->off){
2140d0b87befSMatthias Ringwald             (*hci_stack->control->off)();
2141f9a30166Smatthias.ringwald         }
2142038bc64cSmatthias.ringwald         hci_emit_hci_open_failed();
2143038bc64cSmatthias.ringwald         return err;
2144038bc64cSmatthias.ringwald     }
21458d213e1aSmatthias.ringwald     return 0;
21468d213e1aSmatthias.ringwald }
2147038bc64cSmatthias.ringwald 
214840d1c7a4Smatthias.ringwald static void hci_power_control_off(void){
21498d213e1aSmatthias.ringwald 
21509da54300S[email protected]     log_info("hci_power_control_off");
21519418f9c9Smatthias.ringwald 
21528d213e1aSmatthias.ringwald     // close low-level device
215324b3c629SMatthias Ringwald     hci_stack->hci_transport->close();
21548d213e1aSmatthias.ringwald 
21559da54300S[email protected]     log_info("hci_power_control_off - hci_transport closed");
21569418f9c9Smatthias.ringwald 
21578d213e1aSmatthias.ringwald     // power off
21583a9fb326S[email protected]     if (hci_stack->control && hci_stack->control->off){
2159d0b87befSMatthias Ringwald         (*hci_stack->control->off)();
21608d213e1aSmatthias.ringwald     }
21619418f9c9Smatthias.ringwald 
21629da54300S[email protected]     log_info("hci_power_control_off - control closed");
21639418f9c9Smatthias.ringwald 
21643a9fb326S[email protected]     hci_stack->state = HCI_STATE_OFF;
216572ea5239Smatthias.ringwald }
216672ea5239Smatthias.ringwald 
216740d1c7a4Smatthias.ringwald static void hci_power_control_sleep(void){
216872ea5239Smatthias.ringwald 
21699da54300S[email protected]     log_info("hci_power_control_sleep");
21703144bce4Smatthias.ringwald 
2171b429b9b7Smatthias.ringwald #if 0
2172b429b9b7Smatthias.ringwald     // don't close serial port during sleep
2173b429b9b7Smatthias.ringwald 
217472ea5239Smatthias.ringwald     // close low-level device
21753a9fb326S[email protected]     hci_stack->hci_transport->close(hci_stack->config);
2176b429b9b7Smatthias.ringwald #endif
217772ea5239Smatthias.ringwald 
217872ea5239Smatthias.ringwald     // sleep mode
21793a9fb326S[email protected]     if (hci_stack->control && hci_stack->control->sleep){
2180d0b87befSMatthias Ringwald         (*hci_stack->control->sleep)();
218172ea5239Smatthias.ringwald     }
2182b429b9b7Smatthias.ringwald 
21833a9fb326S[email protected]     hci_stack->state = HCI_STATE_SLEEPING;
21848d213e1aSmatthias.ringwald }
21858d213e1aSmatthias.ringwald 
218640d1c7a4Smatthias.ringwald static int hci_power_control_wake(void){
2187b429b9b7Smatthias.ringwald 
21889da54300S[email protected]     log_info("hci_power_control_wake");
2189b429b9b7Smatthias.ringwald 
2190b429b9b7Smatthias.ringwald     // wake on
21913a9fb326S[email protected]     if (hci_stack->control && hci_stack->control->wake){
2192d0b87befSMatthias Ringwald         (*hci_stack->control->wake)();
2193b429b9b7Smatthias.ringwald     }
2194b429b9b7Smatthias.ringwald 
2195b429b9b7Smatthias.ringwald #if 0
2196b429b9b7Smatthias.ringwald     // open low-level device
21973a9fb326S[email protected]     int err = hci_stack->hci_transport->open(hci_stack->config);
2198b429b9b7Smatthias.ringwald     if (err){
21999da54300S[email protected]         log_error( "HCI_INIT failed, turning Bluetooth off again");
22003a9fb326S[email protected]         if (hci_stack->control && hci_stack->control->off){
2201d0b87befSMatthias Ringwald             (*hci_stack->control->off)();
2202b429b9b7Smatthias.ringwald         }
2203b429b9b7Smatthias.ringwald         hci_emit_hci_open_failed();
2204b429b9b7Smatthias.ringwald         return err;
2205b429b9b7Smatthias.ringwald     }
2206b429b9b7Smatthias.ringwald #endif
2207b429b9b7Smatthias.ringwald 
2208b429b9b7Smatthias.ringwald     return 0;
2209b429b9b7Smatthias.ringwald }
2210b429b9b7Smatthias.ringwald 
221144935e40S[email protected] static void hci_power_transition_to_initializing(void){
221244935e40S[email protected]     // set up state machine
221344935e40S[email protected]     hci_stack->num_cmd_packets = 1; // assume that one cmd can be sent
221444935e40S[email protected]     hci_stack->hci_packet_buffer_reserved = 0;
221544935e40S[email protected]     hci_stack->state = HCI_STATE_INITIALIZING;
22165c363727SMatthias Ringwald     hci_stack->substate = HCI_INIT_SEND_RESET;
221744935e40S[email protected] }
2218b429b9b7Smatthias.ringwald 
22198d213e1aSmatthias.ringwald int hci_power_control(HCI_POWER_MODE power_mode){
2220d661ed19Smatthias.ringwald 
22219da54300S[email protected]     log_info("hci_power_control: %u, current mode %u", power_mode, hci_stack->state);
2222d661ed19Smatthias.ringwald 
22238d213e1aSmatthias.ringwald     int err = 0;
22243a9fb326S[email protected]     switch (hci_stack->state){
22258d213e1aSmatthias.ringwald 
22268d213e1aSmatthias.ringwald         case HCI_STATE_OFF:
22278d213e1aSmatthias.ringwald             switch (power_mode){
22288d213e1aSmatthias.ringwald                 case HCI_POWER_ON:
22298d213e1aSmatthias.ringwald                     err = hci_power_control_on();
223097b61c7bS[email protected]                     if (err) {
223197b61c7bS[email protected]                         log_error("hci_power_control_on() error %u", err);
223297b61c7bS[email protected]                         return err;
223397b61c7bS[email protected]                     }
223444935e40S[email protected]                     hci_power_transition_to_initializing();
22358d213e1aSmatthias.ringwald                     break;
22368d213e1aSmatthias.ringwald                 case HCI_POWER_OFF:
22378d213e1aSmatthias.ringwald                     // do nothing
22388d213e1aSmatthias.ringwald                     break;
22398d213e1aSmatthias.ringwald                 case HCI_POWER_SLEEP:
2240b546ac54Smatthias.ringwald                     // do nothing (with SLEEP == OFF)
22418d213e1aSmatthias.ringwald                     break;
22428d213e1aSmatthias.ringwald             }
22438d213e1aSmatthias.ringwald             break;
22447301ad89Smatthias.ringwald 
22458d213e1aSmatthias.ringwald         case HCI_STATE_INITIALIZING:
22468d213e1aSmatthias.ringwald             switch (power_mode){
22478d213e1aSmatthias.ringwald                 case HCI_POWER_ON:
22488d213e1aSmatthias.ringwald                     // do nothing
22498d213e1aSmatthias.ringwald                     break;
22508d213e1aSmatthias.ringwald                 case HCI_POWER_OFF:
22518d213e1aSmatthias.ringwald                     // no connections yet, just turn it off
22528d213e1aSmatthias.ringwald                     hci_power_control_off();
22538d213e1aSmatthias.ringwald                     break;
22548d213e1aSmatthias.ringwald                 case HCI_POWER_SLEEP:
2255b546ac54Smatthias.ringwald                     // no connections yet, just turn it off
225672ea5239Smatthias.ringwald                     hci_power_control_sleep();
22578d213e1aSmatthias.ringwald                     break;
22588d213e1aSmatthias.ringwald             }
22598d213e1aSmatthias.ringwald             break;
22607301ad89Smatthias.ringwald 
22618d213e1aSmatthias.ringwald         case HCI_STATE_WORKING:
22628d213e1aSmatthias.ringwald             switch (power_mode){
22638d213e1aSmatthias.ringwald                 case HCI_POWER_ON:
22648d213e1aSmatthias.ringwald                     // do nothing
22658d213e1aSmatthias.ringwald                     break;
22668d213e1aSmatthias.ringwald                 case HCI_POWER_OFF:
2267c7e0c5f6Smatthias.ringwald                     // see hci_run
22683a9fb326S[email protected]                     hci_stack->state = HCI_STATE_HALTING;
22698d213e1aSmatthias.ringwald                     break;
22708d213e1aSmatthias.ringwald                 case HCI_POWER_SLEEP:
2271b546ac54Smatthias.ringwald                     // see hci_run
22723a9fb326S[email protected]                     hci_stack->state = HCI_STATE_FALLING_ASLEEP;
227374b323a9SMatthias Ringwald                     hci_stack->substate = HCI_FALLING_ASLEEP_DISCONNECT;
22748d213e1aSmatthias.ringwald                     break;
22758d213e1aSmatthias.ringwald             }
22768d213e1aSmatthias.ringwald             break;
22777301ad89Smatthias.ringwald 
22788d213e1aSmatthias.ringwald         case HCI_STATE_HALTING:
22798d213e1aSmatthias.ringwald             switch (power_mode){
22808d213e1aSmatthias.ringwald                 case HCI_POWER_ON:
228144935e40S[email protected]                     hci_power_transition_to_initializing();
22828d213e1aSmatthias.ringwald                     break;
22838d213e1aSmatthias.ringwald                 case HCI_POWER_OFF:
22848d213e1aSmatthias.ringwald                     // do nothing
22858d213e1aSmatthias.ringwald                     break;
22868d213e1aSmatthias.ringwald                 case HCI_POWER_SLEEP:
2287b546ac54Smatthias.ringwald                     // see hci_run
22883a9fb326S[email protected]                     hci_stack->state = HCI_STATE_FALLING_ASLEEP;
228974b323a9SMatthias Ringwald                     hci_stack->substate = HCI_FALLING_ASLEEP_DISCONNECT;
22908d213e1aSmatthias.ringwald                     break;
22918d213e1aSmatthias.ringwald             }
22928d213e1aSmatthias.ringwald             break;
22938d213e1aSmatthias.ringwald 
22948d213e1aSmatthias.ringwald         case HCI_STATE_FALLING_ASLEEP:
22958d213e1aSmatthias.ringwald             switch (power_mode){
22968d213e1aSmatthias.ringwald                 case HCI_POWER_ON:
229728171530Smatthias.ringwald 
2298423a3e49SMatthias Ringwald #ifdef HAVE_PLATFORM_IPHONE_OS
229928171530Smatthias.ringwald                     // nothing to do, if H4 supports power management
2300d0b87befSMatthias Ringwald                     if (btstack_control_iphone_power_management_enabled()){
23013a9fb326S[email protected]                         hci_stack->state = HCI_STATE_INITIALIZING;
230274b323a9SMatthias Ringwald                         hci_stack->substate = HCI_INIT_WRITE_SCAN_ENABLE;   // init after sleep
230328171530Smatthias.ringwald                         break;
230428171530Smatthias.ringwald                     }
230528171530Smatthias.ringwald #endif
230644935e40S[email protected]                     hci_power_transition_to_initializing();
23078d213e1aSmatthias.ringwald                     break;
23088d213e1aSmatthias.ringwald                 case HCI_POWER_OFF:
2309b546ac54Smatthias.ringwald                     // see hci_run
23103a9fb326S[email protected]                     hci_stack->state = HCI_STATE_HALTING;
23118d213e1aSmatthias.ringwald                     break;
23128d213e1aSmatthias.ringwald                 case HCI_POWER_SLEEP:
2313b546ac54Smatthias.ringwald                     // do nothing
23148d213e1aSmatthias.ringwald                     break;
23158d213e1aSmatthias.ringwald             }
23168d213e1aSmatthias.ringwald             break;
23178d213e1aSmatthias.ringwald 
23188d213e1aSmatthias.ringwald         case HCI_STATE_SLEEPING:
23198d213e1aSmatthias.ringwald             switch (power_mode){
23208d213e1aSmatthias.ringwald                 case HCI_POWER_ON:
232128171530Smatthias.ringwald 
2322423a3e49SMatthias Ringwald #ifdef HAVE_PLATFORM_IPHONE_OS
232328171530Smatthias.ringwald                     // nothing to do, if H4 supports power management
2324d0b87befSMatthias Ringwald                     if (btstack_control_iphone_power_management_enabled()){
23253a9fb326S[email protected]                         hci_stack->state = HCI_STATE_INITIALIZING;
23265c363727SMatthias Ringwald                         hci_stack->substate = HCI_INIT_AFTER_SLEEP;
2327758b46ceSmatthias.ringwald                         hci_update_scan_enable();
232828171530Smatthias.ringwald                         break;
232928171530Smatthias.ringwald                     }
233028171530Smatthias.ringwald #endif
23313144bce4Smatthias.ringwald                     err = hci_power_control_wake();
23323144bce4Smatthias.ringwald                     if (err) return err;
233344935e40S[email protected]                     hci_power_transition_to_initializing();
23348d213e1aSmatthias.ringwald                     break;
23358d213e1aSmatthias.ringwald                 case HCI_POWER_OFF:
23363a9fb326S[email protected]                     hci_stack->state = HCI_STATE_HALTING;
23378d213e1aSmatthias.ringwald                     break;
23388d213e1aSmatthias.ringwald                 case HCI_POWER_SLEEP:
2339b546ac54Smatthias.ringwald                     // do nothing
23408d213e1aSmatthias.ringwald                     break;
23418d213e1aSmatthias.ringwald             }
23428d213e1aSmatthias.ringwald             break;
234311e23e5fSmatthias.ringwald     }
234468d92d03Smatthias.ringwald 
2345038bc64cSmatthias.ringwald     // create internal event
2346ee8bf225Smatthias.ringwald 	hci_emit_state();
2347ee8bf225Smatthias.ringwald 
234868d92d03Smatthias.ringwald 	// trigger next/first action
234968d92d03Smatthias.ringwald 	hci_run();
235068d92d03Smatthias.ringwald 
2351475c8125Smatthias.ringwald     return 0;
2352475c8125Smatthias.ringwald }
2353475c8125Smatthias.ringwald 
2354758b46ceSmatthias.ringwald static void hci_update_scan_enable(void){
2355758b46ceSmatthias.ringwald     // 2 = page scan, 1 = inq scan
23563a9fb326S[email protected]     hci_stack->new_scan_enable_value  = hci_stack->connectable << 1 | hci_stack->discoverable;
2357758b46ceSmatthias.ringwald     hci_run();
2358758b46ceSmatthias.ringwald }
2359758b46ceSmatthias.ringwald 
236015a95bd5SMatthias Ringwald void gap_discoverable_control(uint8_t enable){
2361381fbed8Smatthias.ringwald     if (enable) enable = 1; // normalize argument
2362381fbed8Smatthias.ringwald 
23633a9fb326S[email protected]     if (hci_stack->discoverable == enable){
23643a9fb326S[email protected]         hci_emit_discoverable_enabled(hci_stack->discoverable);
2365381fbed8Smatthias.ringwald         return;
2366381fbed8Smatthias.ringwald     }
2367381fbed8Smatthias.ringwald 
23683a9fb326S[email protected]     hci_stack->discoverable = enable;
2369758b46ceSmatthias.ringwald     hci_update_scan_enable();
2370758b46ceSmatthias.ringwald }
2371b031bebbSmatthias.ringwald 
237215a95bd5SMatthias Ringwald void gap_connectable_control(uint8_t enable){
2373758b46ceSmatthias.ringwald     if (enable) enable = 1; // normalize argument
2374758b46ceSmatthias.ringwald 
2375758b46ceSmatthias.ringwald     // don't emit event
23763a9fb326S[email protected]     if (hci_stack->connectable == enable) return;
2377758b46ceSmatthias.ringwald 
23783a9fb326S[email protected]     hci_stack->connectable = enable;
2379758b46ceSmatthias.ringwald     hci_update_scan_enable();
2380381fbed8Smatthias.ringwald }
2381381fbed8Smatthias.ringwald 
238215a95bd5SMatthias Ringwald void gap_local_bd_addr(bd_addr_t address_buffer){
2383690bd0baS[email protected]     memcpy(address_buffer, hci_stack->local_bd_addr, 6);
23845061f3afS[email protected] }
23855061f3afS[email protected] 
238695d71764SMatthias Ringwald static void hci_run(void){
23878a485f27Smatthias.ringwald 
2388db8bc6ffSMatthias Ringwald     // log_info("hci_run: entered");
2389665d90f2SMatthias Ringwald     btstack_linked_item_t * it;
239032ab9390Smatthias.ringwald 
2391b5d8b22bS[email protected]     // send continuation fragments first, as they block the prepared packet buffer
2392b5d8b22bS[email protected]     if (hci_stack->acl_fragmentation_total_size > 0) {
2393b5d8b22bS[email protected]         hci_con_handle_t con_handle = READ_ACL_CONNECTION_HANDLE(hci_stack->hci_packet_buffer);
2394b5d8b22bS[email protected]         hci_connection_t *connection = hci_connection_for_handle(con_handle);
2395b5d8b22bS[email protected]         if (connection) {
239628a0332dSMatthias Ringwald             if (hci_can_send_prepared_acl_packet_now(con_handle)){
2397b5d8b22bS[email protected]                 hci_send_acl_packet_fragments(connection);
2398b5d8b22bS[email protected]                 return;
2399b5d8b22bS[email protected]             }
240028a0332dSMatthias Ringwald         } else {
2401b5d8b22bS[email protected]             // connection gone -> discard further fragments
240228a0332dSMatthias Ringwald             log_info("hci_run: fragmented ACL packet no connection -> discard fragment");
2403b5d8b22bS[email protected]             hci_stack->acl_fragmentation_total_size = 0;
2404b5d8b22bS[email protected]             hci_stack->acl_fragmentation_pos = 0;
2405b5d8b22bS[email protected]         }
2406b5d8b22bS[email protected]     }
2407b5d8b22bS[email protected] 
2408d94d3cafS[email protected]     if (!hci_can_send_command_packet_now()) return;
2409ce4c8fabSmatthias.ringwald 
2410b031bebbSmatthias.ringwald     // global/non-connection oriented commands
2411b031bebbSmatthias.ringwald 
2412b031bebbSmatthias.ringwald     // decline incoming connections
24133a9fb326S[email protected]     if (hci_stack->decline_reason){
24143a9fb326S[email protected]         uint8_t reason = hci_stack->decline_reason;
24153a9fb326S[email protected]         hci_stack->decline_reason = 0;
24163a9fb326S[email protected]         hci_send_cmd(&hci_reject_connection_request, hci_stack->decline_addr, reason);
2417dbe1a790S[email protected]         return;
2418ce4c8fabSmatthias.ringwald     }
2419ce4c8fabSmatthias.ringwald 
2420b031bebbSmatthias.ringwald     // send scan enable
24213a9fb326S[email protected]     if (hci_stack->state == HCI_STATE_WORKING && hci_stack->new_scan_enable_value != 0xff && hci_classic_supported()){
24223a9fb326S[email protected]         hci_send_cmd(&hci_write_scan_enable, hci_stack->new_scan_enable_value);
24233a9fb326S[email protected]         hci_stack->new_scan_enable_value = 0xff;
2424dbe1a790S[email protected]         return;
2425b031bebbSmatthias.ringwald     }
2426b031bebbSmatthias.ringwald 
2427a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE
24287bdc6798S[email protected]     if (hci_stack->state == HCI_STATE_WORKING){
242945c102fdSMatthias Ringwald         // handle le scan
24307bdc6798S[email protected]         switch(hci_stack->le_scanning_state){
24317bdc6798S[email protected]             case LE_START_SCAN:
24327bdc6798S[email protected]                 hci_stack->le_scanning_state = LE_SCANNING;
24337bdc6798S[email protected]                 hci_send_cmd(&hci_le_set_scan_enable, 1, 0);
24347bdc6798S[email protected]                 return;
24357bdc6798S[email protected] 
24367bdc6798S[email protected]             case LE_STOP_SCAN:
24377bdc6798S[email protected]                 hci_stack->le_scanning_state = LE_SCAN_IDLE;
24387bdc6798S[email protected]                 hci_send_cmd(&hci_le_set_scan_enable, 0, 0);
24397bdc6798S[email protected]                 return;
24407bdc6798S[email protected]             default:
24417bdc6798S[email protected]                 break;
24427bdc6798S[email protected]         }
2443e2602ea2Smatthias.ringwald         if (hci_stack->le_scan_type != 0xff){
2444e2602ea2Smatthias.ringwald             // defaults: active scanning, accept all advertisement packets
2445e2602ea2Smatthias.ringwald             int scan_type = hci_stack->le_scan_type;
2446e2602ea2Smatthias.ringwald             hci_stack->le_scan_type = 0xff;
2447e2602ea2Smatthias.ringwald             hci_send_cmd(&hci_le_set_scan_parameters, scan_type, hci_stack->le_scan_interval, hci_stack->le_scan_window, hci_stack->adv_addr_type, 0);
2448e2602ea2Smatthias.ringwald             return;
2449e2602ea2Smatthias.ringwald         }
245045c102fdSMatthias Ringwald         // le advertisement control
24519a2e4658SMatthias Ringwald         if (hci_stack->le_advertisements_todo){
24529a2e4658SMatthias Ringwald             log_info("hci_run: gap_le: adv todo: %x", hci_stack->le_advertisements_todo );
24539a2e4658SMatthias Ringwald         }
245445c102fdSMatthias Ringwald         if (hci_stack->le_advertisements_todo & LE_ADVERTISEMENT_TASKS_DISABLE){
245545c102fdSMatthias Ringwald             hci_stack->le_advertisements_todo &= ~LE_ADVERTISEMENT_TASKS_DISABLE;
245645c102fdSMatthias Ringwald             hci_send_cmd(&hci_le_set_advertise_enable, 0);
245745c102fdSMatthias Ringwald             return;
245845c102fdSMatthias Ringwald         }
245945c102fdSMatthias Ringwald         if (hci_stack->le_advertisements_todo & LE_ADVERTISEMENT_TASKS_SET_PARAMS){
246045c102fdSMatthias Ringwald             hci_stack->le_advertisements_todo &= ~LE_ADVERTISEMENT_TASKS_SET_PARAMS;
246145c102fdSMatthias Ringwald             hci_send_cmd(&hci_le_set_advertising_parameters,
246245c102fdSMatthias Ringwald                  hci_stack->le_advertisements_interval_min,
246345c102fdSMatthias Ringwald                  hci_stack->le_advertisements_interval_max,
246445c102fdSMatthias Ringwald                  hci_stack->le_advertisements_type,
246545c102fdSMatthias Ringwald                  hci_stack->le_advertisements_own_address_type,
246645c102fdSMatthias Ringwald                  hci_stack->le_advertisements_direct_address_type,
246745c102fdSMatthias Ringwald                  hci_stack->le_advertisements_direct_address,
246845c102fdSMatthias Ringwald                  hci_stack->le_advertisements_channel_map,
246945c102fdSMatthias Ringwald                  hci_stack->le_advertisements_filter_policy);
247045c102fdSMatthias Ringwald             return;
247145c102fdSMatthias Ringwald         }
2472501f56b3SMatthias Ringwald         if (hci_stack->le_advertisements_todo & LE_ADVERTISEMENT_TASKS_SET_ADV_DATA){
2473501f56b3SMatthias Ringwald             hci_stack->le_advertisements_todo &= ~LE_ADVERTISEMENT_TASKS_SET_ADV_DATA;
247445c102fdSMatthias Ringwald             hci_send_cmd(&hci_le_set_advertising_data, hci_stack->le_advertisements_data_len,
247545c102fdSMatthias Ringwald                 hci_stack->le_advertisements_data);
247645c102fdSMatthias Ringwald             return;
247745c102fdSMatthias Ringwald         }
2478501f56b3SMatthias Ringwald         if (hci_stack->le_advertisements_todo & LE_ADVERTISEMENT_TASKS_SET_SCAN_DATA){
2479501f56b3SMatthias Ringwald             hci_stack->le_advertisements_todo &= ~LE_ADVERTISEMENT_TASKS_SET_SCAN_DATA;
2480501f56b3SMatthias Ringwald             hci_send_cmd(&hci_le_set_scan_response_data, hci_stack->le_scan_response_data_len,
2481501f56b3SMatthias Ringwald                 hci_stack->le_scan_response_data);
2482501f56b3SMatthias Ringwald             return;
2483501f56b3SMatthias Ringwald         }
248445c102fdSMatthias Ringwald         if (hci_stack->le_advertisements_todo & LE_ADVERTISEMENT_TASKS_ENABLE){
248545c102fdSMatthias Ringwald             hci_stack->le_advertisements_todo &= ~LE_ADVERTISEMENT_TASKS_ENABLE;
248645c102fdSMatthias Ringwald             hci_send_cmd(&hci_le_set_advertise_enable, 1);
248745c102fdSMatthias Ringwald             return;
248845c102fdSMatthias Ringwald         }
24899956955bSMatthias Ringwald 
24909956955bSMatthias Ringwald         //
24919956955bSMatthias Ringwald         // LE Whitelist Management
24929956955bSMatthias Ringwald         //
24939956955bSMatthias Ringwald 
24949956955bSMatthias Ringwald         // check if whitelist needs modification
2495665d90f2SMatthias Ringwald         btstack_linked_list_iterator_t lit;
24969956955bSMatthias Ringwald         int modification_pending = 0;
2497665d90f2SMatthias Ringwald         btstack_linked_list_iterator_init(&lit, &hci_stack->le_whitelist);
2498665d90f2SMatthias Ringwald         while (btstack_linked_list_iterator_has_next(&lit)){
2499665d90f2SMatthias Ringwald             whitelist_entry_t * entry = (whitelist_entry_t*) btstack_linked_list_iterator_next(&lit);
25009956955bSMatthias Ringwald             if (entry->state & (LE_WHITELIST_REMOVE_FROM_CONTROLLER | LE_WHITELIST_ADD_TO_CONTROLLER)){
25019956955bSMatthias Ringwald                 modification_pending = 1;
25029956955bSMatthias Ringwald                 break;
25039956955bSMatthias Ringwald             }
25049956955bSMatthias Ringwald         }
250591915b0bSMatthias Ringwald 
25069956955bSMatthias Ringwald         if (modification_pending){
250791915b0bSMatthias Ringwald             // stop connnecting if modification pending
25089956955bSMatthias Ringwald             if (hci_stack->le_connecting_state != LE_CONNECTING_IDLE){
25099956955bSMatthias Ringwald                 hci_send_cmd(&hci_le_create_connection_cancel);
25109956955bSMatthias Ringwald                 return;
25119956955bSMatthias Ringwald             }
25129956955bSMatthias Ringwald 
25139956955bSMatthias Ringwald             // add/remove entries
2514665d90f2SMatthias Ringwald             btstack_linked_list_iterator_init(&lit, &hci_stack->le_whitelist);
2515665d90f2SMatthias Ringwald             while (btstack_linked_list_iterator_has_next(&lit)){
2516665d90f2SMatthias Ringwald                 whitelist_entry_t * entry = (whitelist_entry_t*) btstack_linked_list_iterator_next(&lit);
25179956955bSMatthias Ringwald                 if (entry->state & LE_WHITELIST_ADD_TO_CONTROLLER){
25189956955bSMatthias Ringwald                     entry->state = LE_WHITELIST_ON_CONTROLLER;
25199956955bSMatthias Ringwald                     hci_send_cmd(&hci_le_add_device_to_white_list, entry->address_type, entry->address);
25209956955bSMatthias Ringwald                     return;
25219956955bSMatthias Ringwald 
25229956955bSMatthias Ringwald                 }
25239956955bSMatthias Ringwald                 if (entry->state & LE_WHITELIST_REMOVE_FROM_CONTROLLER){
25249ecbe201SMatthias Ringwald                     bd_addr_t address;
25259ecbe201SMatthias Ringwald                     bd_addr_type_t address_type = entry->address_type;
25269ecbe201SMatthias Ringwald                     memcpy(address, entry->address, 6);
2527665d90f2SMatthias Ringwald                     btstack_linked_list_remove(&hci_stack->le_whitelist, (btstack_linked_item_t *) entry);
25289956955bSMatthias Ringwald                     btstack_memory_whitelist_entry_free(entry);
25299ecbe201SMatthias Ringwald                     hci_send_cmd(&hci_le_remove_device_from_white_list, address_type, address);
25309956955bSMatthias Ringwald                     return;
25319956955bSMatthias Ringwald                 }
25329956955bSMatthias Ringwald             }
253391915b0bSMatthias Ringwald         }
25349956955bSMatthias Ringwald 
25359956955bSMatthias Ringwald         // start connecting
253691915b0bSMatthias Ringwald         if ( hci_stack->le_connecting_state == LE_CONNECTING_IDLE &&
2537665d90f2SMatthias Ringwald             !btstack_linked_list_empty(&hci_stack->le_whitelist)){
25389956955bSMatthias Ringwald             bd_addr_t null_addr;
25399956955bSMatthias Ringwald             memset(null_addr, 0, 6);
25409956955bSMatthias Ringwald             hci_send_cmd(&hci_le_create_connection,
25419956955bSMatthias Ringwald                  0x0060,    // scan interval: 60 ms
25429956955bSMatthias Ringwald                  0x0030,    // scan interval: 30 ms
25439956955bSMatthias Ringwald                  1,         // use whitelist
25449956955bSMatthias Ringwald                  0,         // peer address type
25459956955bSMatthias Ringwald                  null_addr,      // peer bd addr
25469956955bSMatthias Ringwald                  hci_stack->adv_addr_type, // our addr type:
25479956955bSMatthias Ringwald                  0x0008,    // conn interval min
25489956955bSMatthias Ringwald                  0x0018,    // conn interval max
25499956955bSMatthias Ringwald                  0,         // conn latency
25509956955bSMatthias Ringwald                  0x0048,    // supervision timeout
25519956955bSMatthias Ringwald                  0x0001,    // min ce length
25529956955bSMatthias Ringwald                  0x0001     // max ce length
25539956955bSMatthias Ringwald                  );
25549956955bSMatthias Ringwald             return;
25559956955bSMatthias Ringwald         }
25567bdc6798S[email protected]     }
2557b2f949feS[email protected] #endif
25587bdc6798S[email protected] 
255932ab9390Smatthias.ringwald     // send pending HCI commands
2560665d90f2SMatthias Ringwald     for (it = (btstack_linked_item_t *) hci_stack->connections; it ; it = it->next){
256105ae8de3SMatthias Ringwald         hci_connection_t * connection = (hci_connection_t *) it;
256232ab9390Smatthias.ringwald 
25630bf6344aS[email protected]         switch(connection->state){
25640bf6344aS[email protected]             case SEND_CREATE_CONNECTION:
25654f3229d8S[email protected]                 switch(connection->address_type){
25664f3229d8S[email protected]                     case BD_ADDR_TYPE_CLASSIC:
25679da54300S[email protected]                         log_info("sending hci_create_connection");
2568ad83dc6aS[email protected]                         hci_send_cmd(&hci_create_connection, connection->address, hci_usable_acl_packet_types(), 0, 0, 0, 1);
25694f3229d8S[email protected]                         break;
25704f3229d8S[email protected]                     default:
2571a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE
25729da54300S[email protected]                         log_info("sending hci_le_create_connection");
25734f3229d8S[email protected]                         hci_send_cmd(&hci_le_create_connection,
2574b2571179Smatthias.ringwald                                      0x0060,    // scan interval: 60 ms
2575b2571179Smatthias.ringwald                                      0x0030,    // scan interval: 30 ms
25764f3229d8S[email protected]                                      0,         // don't use whitelist
25774f3229d8S[email protected]                                      connection->address_type, // peer address type
25784f3229d8S[email protected]                                      connection->address,      // peer bd addr
2579b2571179Smatthias.ringwald                                      hci_stack->adv_addr_type, // our addr type:
2580b2571179Smatthias.ringwald                                      0x0008,    // conn interval min
2581b2571179Smatthias.ringwald                                      0x0018,    // conn interval max
25824f3229d8S[email protected]                                      0,         // conn latency
2583b2571179Smatthias.ringwald                                      0x0048,    // supervision timeout
2584b2571179Smatthias.ringwald                                      0x0001,    // min ce length
2585b2571179Smatthias.ringwald                                      0x0001     // max ce length
25864f3229d8S[email protected]                                      );
25874f3229d8S[email protected] 
25884f3229d8S[email protected]                         connection->state = SENT_CREATE_CONNECTION;
2589b2f949feS[email protected] #endif
25904f3229d8S[email protected]                         break;
25914f3229d8S[email protected]                 }
2592ad83dc6aS[email protected]                 return;
2593ad83dc6aS[email protected] 
25940bf6344aS[email protected]             case RECEIVED_CONNECTION_REQUEST:
259594e4aaa2SMatthias Ringwald                 log_info("sending hci_accept_connection_request, remote eSCO %u", connection->remote_supported_feature_eSCO);
259632ab9390Smatthias.ringwald                 connection->state = ACCEPTED_CONNECTION_REQUEST;
25975cf766e8SMatthias Ringwald                 connection->role  = HCI_ROLE_SLAVE;
2598e35edcc1S[email protected]                 if (connection->address_type == BD_ADDR_TYPE_CLASSIC){
259934d2123cS[email protected]                     hci_send_cmd(&hci_accept_connection_request, connection->address, 1);
2600e35edcc1S[email protected]                 }
2601dbe1a790S[email protected]                 return;
26020bf6344aS[email protected] 
2603a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE
26040bf6344aS[email protected]             case SEND_CANCEL_CONNECTION:
26050bf6344aS[email protected]                 connection->state = SENT_CANCEL_CONNECTION;
26060bf6344aS[email protected]                 hci_send_cmd(&hci_le_create_connection_cancel);
26070bf6344aS[email protected]                 return;
2608a6725849S[email protected] #endif
26090bf6344aS[email protected]             case SEND_DISCONNECT:
26100bf6344aS[email protected]                 connection->state = SENT_DISCONNECT;
26117851196eSmatthias.ringwald                 hci_send_cmd(&hci_disconnect, connection->con_handle, 0x13); // remote closed connection
26120bf6344aS[email protected]                 return;
26130bf6344aS[email protected] 
26140bf6344aS[email protected]             default:
26150bf6344aS[email protected]                 break;
2616c7e0c5f6Smatthias.ringwald         }
2617c7e0c5f6Smatthias.ringwald 
261832ab9390Smatthias.ringwald         if (connection->authentication_flags & HANDLE_LINK_KEY_REQUEST){
26199da54300S[email protected]             log_info("responding to link key request");
262034d2123cS[email protected]             connectionClearAuthenticationFlags(connection, HANDLE_LINK_KEY_REQUEST);
262132ab9390Smatthias.ringwald             link_key_t link_key;
2622c77e8838S[email protected]             link_key_type_t link_key_type;
2623a98592bcSMatthias Ringwald             if ( hci_stack->link_key_db
2624a98592bcSMatthias Ringwald               && hci_stack->link_key_db->get_link_key(connection->address, link_key, &link_key_type)
262534d2123cS[email protected]               && gap_security_level_for_link_key_type(link_key_type) >= connection->requested_security_level){
26269ab95c90S[email protected]                connection->link_key_type = link_key_type;
262732ab9390Smatthias.ringwald                hci_send_cmd(&hci_link_key_request_reply, connection->address, &link_key);
262832ab9390Smatthias.ringwald             } else {
262932ab9390Smatthias.ringwald                hci_send_cmd(&hci_link_key_request_negative_reply, connection->address);
263032ab9390Smatthias.ringwald             }
2631dbe1a790S[email protected]             return;
263232ab9390Smatthias.ringwald         }
26331d6b20aeS[email protected] 
2634899283eaS[email protected]         if (connection->authentication_flags & DENY_PIN_CODE_REQUEST){
26359da54300S[email protected]             log_info("denying to pin request");
2636899283eaS[email protected]             connectionClearAuthenticationFlags(connection, DENY_PIN_CODE_REQUEST);
263734d2123cS[email protected]             hci_send_cmd(&hci_pin_code_request_negative_reply, connection->address);
26384c57c146S[email protected]             return;
26394c57c146S[email protected]         }
26404c57c146S[email protected] 
2641dbe1a790S[email protected]         if (connection->authentication_flags & SEND_IO_CAPABILITIES_REPLY){
264234d2123cS[email protected]             connectionClearAuthenticationFlags(connection, SEND_IO_CAPABILITIES_REPLY);
264382d8f825S[email protected]             log_info("IO Capability Request received, stack bondable %u, io cap %u", hci_stack->bondable, hci_stack->ssp_io_capability);
264482d8f825S[email protected]             if (hci_stack->bondable && (hci_stack->ssp_io_capability != SSP_IO_CAPABILITY_UNKNOWN)){
2645106d6d11S[email protected]                 // tweak authentication requirements
26463a9fb326S[email protected]                 uint8_t authreq = hci_stack->ssp_authentication_requirement;
2647106d6d11S[email protected]                 if (connection->bonding_flags & BONDING_DEDICATED){
26489faad3abS[email protected]                     authreq = SSP_IO_AUTHREQ_MITM_PROTECTION_NOT_REQUIRED_DEDICATED_BONDING;
26499faad3abS[email protected]                 }
26509faad3abS[email protected]                 if (gap_mitm_protection_required_for_security_level(connection->requested_security_level)){
26519faad3abS[email protected]                     authreq |= 1;
2652106d6d11S[email protected]                 }
26533a9fb326S[email protected]                 hci_send_cmd(&hci_io_capability_request_reply, &connection->address, hci_stack->ssp_io_capability, NULL, authreq);
2654f8fb5f6eS[email protected]             } else {
2655f8fb5f6eS[email protected]                 hci_send_cmd(&hci_io_capability_request_negative_reply, &connection->address, ERROR_CODE_PAIRING_NOT_ALLOWED);
2656f8fb5f6eS[email protected]             }
2657dbe1a790S[email protected]             return;
265832ab9390Smatthias.ringwald         }
265932ab9390Smatthias.ringwald 
2660dbe1a790S[email protected]         if (connection->authentication_flags & SEND_USER_CONFIRM_REPLY){
2661dbe1a790S[email protected]             connectionClearAuthenticationFlags(connection, SEND_USER_CONFIRM_REPLY);
266234d2123cS[email protected]             hci_send_cmd(&hci_user_confirmation_request_reply, &connection->address);
2663dbe1a790S[email protected]             return;
2664dbe1a790S[email protected]         }
2665dbe1a790S[email protected] 
2666dbe1a790S[email protected]         if (connection->authentication_flags & SEND_USER_PASSKEY_REPLY){
2667dbe1a790S[email protected]             connectionClearAuthenticationFlags(connection, SEND_USER_PASSKEY_REPLY);
266834d2123cS[email protected]             hci_send_cmd(&hci_user_passkey_request_reply, &connection->address, 000000);
2669dbe1a790S[email protected]             return;
2670dbe1a790S[email protected]         }
2671afd4e962S[email protected] 
2672afd4e962S[email protected]         if (connection->bonding_flags & BONDING_REQUEST_REMOTE_FEATURES){
2673afd4e962S[email protected]             connection->bonding_flags &= ~BONDING_REQUEST_REMOTE_FEATURES;
267434d2123cS[email protected]             hci_send_cmd(&hci_read_remote_supported_features_command, connection->con_handle);
26752bd8b7e7S[email protected]             return;
26762bd8b7e7S[email protected]         }
26772bd8b7e7S[email protected] 
26782bd8b7e7S[email protected]         if (connection->bonding_flags & BONDING_DISCONNECT_SECURITY_BLOCK){
26792bd8b7e7S[email protected]             connection->bonding_flags &= ~BONDING_DISCONNECT_SECURITY_BLOCK;
268034d2123cS[email protected]             hci_send_cmd(&hci_disconnect, connection->con_handle, 0x0005);  // authentication failure
268134d2123cS[email protected]             return;
268234d2123cS[email protected]         }
2683ad83dc6aS[email protected]         if (connection->bonding_flags & BONDING_DISCONNECT_DEDICATED_DONE){
2684ad83dc6aS[email protected]             connection->bonding_flags &= ~BONDING_DISCONNECT_DEDICATED_DONE;
26851bd5283dS[email protected]             connection->bonding_flags |= BONDING_EMIT_COMPLETE_ON_DISCONNECT;
268652d34f98S[email protected]             hci_send_cmd(&hci_disconnect, connection->con_handle, 0x13);  // authentication done
2687ad83dc6aS[email protected]             return;
2688ad83dc6aS[email protected]         }
268934d2123cS[email protected]         if (connection->bonding_flags & BONDING_SEND_AUTHENTICATE_REQUEST){
269034d2123cS[email protected]             connection->bonding_flags &= ~BONDING_SEND_AUTHENTICATE_REQUEST;
269134d2123cS[email protected]             hci_send_cmd(&hci_authentication_requested, connection->con_handle);
26922bd8b7e7S[email protected]             return;
2693afd4e962S[email protected]         }
2694dce78009S[email protected]         if (connection->bonding_flags & BONDING_SEND_ENCRYPTION_REQUEST){
2695dce78009S[email protected]             connection->bonding_flags &= ~BONDING_SEND_ENCRYPTION_REQUEST;
2696dce78009S[email protected]             hci_send_cmd(&hci_set_connection_encryption, connection->con_handle, 1);
2697dce78009S[email protected]             return;
2698dce78009S[email protected]         }
2699da886c03S[email protected] 
2700a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE
2701da886c03S[email protected]         if (connection->le_con_parameter_update_state == CON_PARAMETER_UPDATE_CHANGE_HCI_CON_PARAMETERS){
2702da886c03S[email protected]             connection->le_con_parameter_update_state = CON_PARAMETER_UPDATE_NONE;
2703da886c03S[email protected] 
2704c37a3166S[email protected]             uint16_t connection_interval_min = connection->le_conn_interval_min;
2705c37a3166S[email protected]             connection->le_conn_interval_min = 0;
2706c37a3166S[email protected]             hci_send_cmd(&hci_le_connection_update, connection->con_handle, connection_interval_min,
2707c37a3166S[email protected]                 connection->le_conn_interval_max, connection->le_conn_latency, connection->le_supervision_timeout,
2708c37a3166S[email protected]                 0x0000, 0xffff);
2709c37a3166S[email protected]         }
2710c37a3166S[email protected] #endif
2711dbe1a790S[email protected]     }
2712c7e0c5f6Smatthias.ringwald 
271305ae8de3SMatthias Ringwald     hci_connection_t * connection;
27143a9fb326S[email protected]     switch (hci_stack->state){
27153429f56bSmatthias.ringwald         case HCI_STATE_INITIALIZING:
271674b323a9SMatthias Ringwald             hci_initializing_run();
27173429f56bSmatthias.ringwald             break;
2718c7e0c5f6Smatthias.ringwald 
2719c7e0c5f6Smatthias.ringwald         case HCI_STATE_HALTING:
2720c7e0c5f6Smatthias.ringwald 
27219da54300S[email protected]             log_info("HCI_STATE_HALTING");
27229956955bSMatthias Ringwald 
27239956955bSMatthias Ringwald             // free whitelist entries
2724a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE
27259956955bSMatthias Ringwald             {
2726665d90f2SMatthias Ringwald                 btstack_linked_list_iterator_t lit;
2727665d90f2SMatthias Ringwald                 btstack_linked_list_iterator_init(&lit, &hci_stack->le_whitelist);
2728665d90f2SMatthias Ringwald                 while (btstack_linked_list_iterator_has_next(&lit)){
2729665d90f2SMatthias Ringwald                     whitelist_entry_t * entry = (whitelist_entry_t*) btstack_linked_list_iterator_next(&lit);
2730665d90f2SMatthias Ringwald                     btstack_linked_list_remove(&hci_stack->le_whitelist, (btstack_linked_item_t *) entry);
27319956955bSMatthias Ringwald                     btstack_memory_whitelist_entry_free(entry);
27329956955bSMatthias Ringwald                 }
27339956955bSMatthias Ringwald             }
27349956955bSMatthias Ringwald #endif
2735c7e0c5f6Smatthias.ringwald             // close all open connections
27363a9fb326S[email protected]             connection =  (hci_connection_t *) hci_stack->connections;
2737c7e0c5f6Smatthias.ringwald             if (connection){
2738711e6c80SMatthias Ringwald                 hci_con_handle_t con_handle = (uint16_t) connection->con_handle;
2739d94d3cafS[email protected]                 if (!hci_can_send_command_packet_now()) return;
274032ab9390Smatthias.ringwald 
27418837e9efSMatthias Ringwald                 log_info("HCI_STATE_HALTING, connection %p, handle %u", connection, con_handle);
2742c7e0c5f6Smatthias.ringwald 
27438837e9efSMatthias Ringwald                 // cancel all l2cap connections right away instead of waiting for disconnection complete event ...
27448837e9efSMatthias Ringwald                 hci_emit_disconnection_complete(con_handle, 0x16); // terminated by local host
27458837e9efSMatthias Ringwald 
27468837e9efSMatthias Ringwald                 // ... which would be ignored anyway as we shutdown (free) the connection now
2747c7e0c5f6Smatthias.ringwald                 hci_shutdown_connection(connection);
27488837e9efSMatthias Ringwald 
27498837e9efSMatthias Ringwald                 // finally, send the disconnect command
27508837e9efSMatthias Ringwald                 hci_send_cmd(&hci_disconnect, con_handle, 0x13);  // remote closed connection
2751c7e0c5f6Smatthias.ringwald                 return;
2752c7e0c5f6Smatthias.ringwald             }
27539da54300S[email protected]             log_info("HCI_STATE_HALTING, calling off");
2754c7e0c5f6Smatthias.ringwald 
275572ea5239Smatthias.ringwald             // switch mode
2756c7e0c5f6Smatthias.ringwald             hci_power_control_off();
27579418f9c9Smatthias.ringwald 
27589da54300S[email protected]             log_info("HCI_STATE_HALTING, emitting state");
275972ea5239Smatthias.ringwald             hci_emit_state();
27609da54300S[email protected]             log_info("HCI_STATE_HALTING, done");
276172ea5239Smatthias.ringwald             break;
2762c7e0c5f6Smatthias.ringwald 
276372ea5239Smatthias.ringwald         case HCI_STATE_FALLING_ASLEEP:
27643a9fb326S[email protected]             switch(hci_stack->substate) {
276574b323a9SMatthias Ringwald                 case HCI_FALLING_ASLEEP_DISCONNECT:
27669da54300S[email protected]                     log_info("HCI_STATE_FALLING_ASLEEP");
276772ea5239Smatthias.ringwald                     // close all open connections
27683a9fb326S[email protected]                     connection =  (hci_connection_t *) hci_stack->connections;
276966da7044Smatthias.ringwald 
2770423a3e49SMatthias Ringwald #ifdef HAVE_PLATFORM_IPHONE_OS
277166da7044Smatthias.ringwald                     // don't close connections, if H4 supports power management
2772d0b87befSMatthias Ringwald                     if (btstack_control_iphone_power_management_enabled()){
277366da7044Smatthias.ringwald                         connection = NULL;
277466da7044Smatthias.ringwald                     }
277566da7044Smatthias.ringwald #endif
277672ea5239Smatthias.ringwald                     if (connection){
277732ab9390Smatthias.ringwald 
277872ea5239Smatthias.ringwald                         // send disconnect
2779d94d3cafS[email protected]                         if (!hci_can_send_command_packet_now()) return;
278032ab9390Smatthias.ringwald 
27819da54300S[email protected]                         log_info("HCI_STATE_FALLING_ASLEEP, connection %p, handle %u", connection, (uint16_t)connection->con_handle);
27826ad890d3Smatthias.ringwald                         hci_send_cmd(&hci_disconnect, connection->con_handle, 0x13);  // remote closed connection
278372ea5239Smatthias.ringwald 
278472ea5239Smatthias.ringwald                         // send disconnected event right away - causes higher layer connections to get closed, too.
278572ea5239Smatthias.ringwald                         hci_shutdown_connection(connection);
278672ea5239Smatthias.ringwald                         return;
278772ea5239Smatthias.ringwald                     }
278872ea5239Smatthias.ringwald 
278992368cd3S[email protected]                     if (hci_classic_supported()){
279089db417bSmatthias.ringwald                         // disable page and inquiry scan
2791d94d3cafS[email protected]                         if (!hci_can_send_command_packet_now()) return;
279232ab9390Smatthias.ringwald 
27939da54300S[email protected]                         log_info("HCI_STATE_HALTING, disabling inq scans");
27943a9fb326S[email protected]                         hci_send_cmd(&hci_write_scan_enable, hci_stack->connectable << 1); // drop inquiry scan but keep page scan
279589db417bSmatthias.ringwald 
279689db417bSmatthias.ringwald                         // continue in next sub state
279774b323a9SMatthias Ringwald                         hci_stack->substate = HCI_FALLING_ASLEEP_W4_WRITE_SCAN_ENABLE;
279889db417bSmatthias.ringwald                         break;
279992368cd3S[email protected]                     }
280092368cd3S[email protected]                     // fall through for ble-only chips
280192368cd3S[email protected] 
280274b323a9SMatthias Ringwald                 case HCI_FALLING_ASLEEP_COMPLETE:
28039da54300S[email protected]                     log_info("HCI_STATE_HALTING, calling sleep");
2804423a3e49SMatthias Ringwald #ifdef HAVE_PLATFORM_IPHONE_OS
280528171530Smatthias.ringwald                     // don't actually go to sleep, if H4 supports power management
2806d0b87befSMatthias Ringwald                     if (btstack_control_iphone_power_management_enabled()){
280728171530Smatthias.ringwald                         // SLEEP MODE reached
28083a9fb326S[email protected]                         hci_stack->state = HCI_STATE_SLEEPING;
280928171530Smatthias.ringwald                         hci_emit_state();
281028171530Smatthias.ringwald                         break;
281128171530Smatthias.ringwald                     }
281228171530Smatthias.ringwald #endif
281372ea5239Smatthias.ringwald                     // switch mode
28143a9fb326S[email protected]                     hci_power_control_sleep();  // changes hci_stack->state to SLEEP
2815c7e0c5f6Smatthias.ringwald                     hci_emit_state();
281628171530Smatthias.ringwald                     break;
281728171530Smatthias.ringwald 
281889db417bSmatthias.ringwald                 default:
281989db417bSmatthias.ringwald                     break;
282089db417bSmatthias.ringwald             }
2821c7e0c5f6Smatthias.ringwald             break;
2822c7e0c5f6Smatthias.ringwald 
28233429f56bSmatthias.ringwald         default:
28243429f56bSmatthias.ringwald             break;
28251f504dbdSmatthias.ringwald     }
28263429f56bSmatthias.ringwald }
282716833f0aSmatthias.ringwald 
282831452debSmatthias.ringwald int hci_send_cmd_packet(uint8_t *packet, int size){
2829c8e4258aSmatthias.ringwald     bd_addr_t addr;
2830c8e4258aSmatthias.ringwald     hci_connection_t * conn;
2831c8e4258aSmatthias.ringwald     // house-keeping
2832c8e4258aSmatthias.ringwald 
2833c8e4258aSmatthias.ringwald     // create_connection?
2834c8e4258aSmatthias.ringwald     if (IS_COMMAND(packet, hci_create_connection)){
2835724d70a2SMatthias Ringwald         reverse_bd_addr(&packet[3], addr);
28369da54300S[email protected]         log_info("Create_connection to %s", bd_addr_to_str(addr));
2837c8e4258aSmatthias.ringwald 
28382e77e513S[email protected]         conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_CLASSIC);
2839ad83dc6aS[email protected]         if (!conn){
284096a45072S[email protected]             conn = create_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_CLASSIC);
284117f1ba2aSmatthias.ringwald             if (!conn){
284217f1ba2aSmatthias.ringwald                 // notify client that alloc failed
28432deddeceSMatthias Ringwald                 hci_emit_connection_complete(addr, 0, BTSTACK_MEMORY_ALLOC_FAILED);
284417f1ba2aSmatthias.ringwald                 return 0; // don't sent packet to controller
284517f1ba2aSmatthias.ringwald             }
2846ad83dc6aS[email protected]             conn->state = SEND_CREATE_CONNECTION;
2847ad83dc6aS[email protected]         }
2848ad83dc6aS[email protected]         log_info("conn state %u", conn->state);
2849ad83dc6aS[email protected]         switch (conn->state){
2850ad83dc6aS[email protected]             // if connection active exists
2851ad83dc6aS[email protected]             case OPEN:
285262bda3fbS[email protected]                 // and OPEN, emit connection complete command, don't send to controller
2853274dad91SMatthias Ringwald                 hci_emit_connection_complete(addr, conn->con_handle, 0);
285462bda3fbS[email protected]                 return 0;
2855ad83dc6aS[email protected]             case SEND_CREATE_CONNECTION:
2856ad83dc6aS[email protected]                 // connection created by hci, e.g. dedicated bonding
2857ad83dc6aS[email protected]                 break;
2858ad83dc6aS[email protected]             default:
2859ad83dc6aS[email protected]                 // otherwise, just ignore as it is already in the open process
2860ad83dc6aS[email protected]                 return 0;
2861ad83dc6aS[email protected]         }
2862c8e4258aSmatthias.ringwald         conn->state = SENT_CREATE_CONNECTION;
2863c8e4258aSmatthias.ringwald     }
28647fde4af9Smatthias.ringwald     if (IS_COMMAND(packet, hci_link_key_request_reply)){
28657fde4af9Smatthias.ringwald         hci_add_connection_flags_for_flipped_bd_addr(&packet[3], SENT_LINK_KEY_REPLY);
28667fde4af9Smatthias.ringwald     }
28677fde4af9Smatthias.ringwald     if (IS_COMMAND(packet, hci_link_key_request_negative_reply)){
28687fde4af9Smatthias.ringwald         hci_add_connection_flags_for_flipped_bd_addr(&packet[3], SENT_LINK_KEY_NEGATIVE_REQUEST);
28697fde4af9Smatthias.ringwald     }
28707fde4af9Smatthias.ringwald 
28718ef73945Smatthias.ringwald     if (IS_COMMAND(packet, hci_delete_stored_link_key)){
2872a98592bcSMatthias Ringwald         if (hci_stack->link_key_db){
2873724d70a2SMatthias Ringwald             reverse_bd_addr(&packet[3], addr);
2874a98592bcSMatthias Ringwald             hci_stack->link_key_db->delete_link_key(addr);
28758ef73945Smatthias.ringwald         }
28768ef73945Smatthias.ringwald     }
2877c8e4258aSmatthias.ringwald 
28786724cd9eS[email protected]     if (IS_COMMAND(packet, hci_pin_code_request_negative_reply)
28796724cd9eS[email protected]     ||  IS_COMMAND(packet, hci_pin_code_request_reply)){
2880724d70a2SMatthias Ringwald         reverse_bd_addr(&packet[3], addr);
28812e77e513S[email protected]         conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_CLASSIC);
28826724cd9eS[email protected]         if (conn){
28836724cd9eS[email protected]             connectionClearAuthenticationFlags(conn, LEGACY_PAIRING_ACTIVE);
28846724cd9eS[email protected]         }
28856724cd9eS[email protected]     }
28866724cd9eS[email protected] 
28876724cd9eS[email protected]     if (IS_COMMAND(packet, hci_user_confirmation_request_negative_reply)
28886724cd9eS[email protected]     ||  IS_COMMAND(packet, hci_user_confirmation_request_reply)
28896724cd9eS[email protected]     ||  IS_COMMAND(packet, hci_user_passkey_request_negative_reply)
28906724cd9eS[email protected]     ||  IS_COMMAND(packet, hci_user_passkey_request_reply)) {
2891724d70a2SMatthias Ringwald         reverse_bd_addr(&packet[3], addr);
28922e77e513S[email protected]         conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_CLASSIC);
28936724cd9eS[email protected]         if (conn){
28946724cd9eS[email protected]             connectionClearAuthenticationFlags(conn, SSP_PAIRING_ACTIVE);
28956724cd9eS[email protected]         }
28966724cd9eS[email protected]     }
28976724cd9eS[email protected] 
28984b3e1e19SMatthias Ringwald     if (IS_COMMAND(packet, hci_write_loopback_mode)){
28994b3e1e19SMatthias Ringwald         hci_stack->loopback_mode = packet[3];
29004b3e1e19SMatthias Ringwald     }
29014b3e1e19SMatthias Ringwald 
2902a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE
290369a97523S[email protected]     if (IS_COMMAND(packet, hci_le_set_advertising_parameters)){
29043a9fb326S[email protected]         hci_stack->adv_addr_type = packet[8];
290569a97523S[email protected]     }
290669a97523S[email protected]     if (IS_COMMAND(packet, hci_le_set_random_address)){
2907724d70a2SMatthias Ringwald         reverse_bd_addr(&packet[3], hci_stack->adv_address);
290869a97523S[email protected]     }
2909171293d3SMatthias Ringwald     if (IS_COMMAND(packet, hci_le_set_advertise_enable)){
2910171293d3SMatthias Ringwald         hci_stack->le_advertisements_active = packet[3];
2911171293d3SMatthias Ringwald     }
2912b04dfa37SMatthias Ringwald     if (IS_COMMAND(packet, hci_le_create_connection)){
2913b04dfa37SMatthias Ringwald         // white list used?
2914b04dfa37SMatthias Ringwald         uint8_t initiator_filter_policy = packet[7];
2915b04dfa37SMatthias Ringwald         switch (initiator_filter_policy){
2916b04dfa37SMatthias Ringwald             case 0:
2917b04dfa37SMatthias Ringwald                 // whitelist not used
2918b04dfa37SMatthias Ringwald                 hci_stack->le_connecting_state = LE_CONNECTING_DIRECT;
2919b04dfa37SMatthias Ringwald                 break;
2920b04dfa37SMatthias Ringwald             case 1:
2921b04dfa37SMatthias Ringwald                 hci_stack->le_connecting_state = LE_CONNECTING_WHITELIST;
2922b04dfa37SMatthias Ringwald                 break;
2923b04dfa37SMatthias Ringwald             default:
2924b04dfa37SMatthias Ringwald                 log_error("Invalid initiator_filter_policy in LE Create Connection %u", initiator_filter_policy);
2925b04dfa37SMatthias Ringwald                 break;
2926b04dfa37SMatthias Ringwald         }
2927b04dfa37SMatthias Ringwald     }
2928b04dfa37SMatthias Ringwald     if (IS_COMMAND(packet, hci_le_create_connection_cancel)){
2929b04dfa37SMatthias Ringwald         hci_stack->le_connecting_state = LE_CONNECTING_IDLE;
2930b04dfa37SMatthias Ringwald     }
293169a97523S[email protected] #endif
293269a97523S[email protected] 
29333a9fb326S[email protected]     hci_stack->num_cmd_packets--;
29345bb5bc3eS[email protected] 
29355bb5bc3eS[email protected]     hci_dump_packet(HCI_COMMAND_DATA_PACKET, 0, packet, size);
29366b4af23dS[email protected]     int err = hci_stack->hci_transport->send_packet(HCI_COMMAND_DATA_PACKET, packet, size);
29376b4af23dS[email protected] 
2938d051460cS[email protected]     // release packet buffer for synchronous transport implementations
2939c8b9416aS[email protected]     if (hci_transport_synchronous() && (packet == hci_stack->hci_packet_buffer)){
29406b4af23dS[email protected]         hci_stack->hci_packet_buffer_reserved = 0;
29416b4af23dS[email protected]     }
29426b4af23dS[email protected] 
29436b4af23dS[email protected]     return err;
294431452debSmatthias.ringwald }
29458adf0ddaSmatthias.ringwald 
29462bd8b7e7S[email protected] // disconnect because of security block
29472bd8b7e7S[email protected] void hci_disconnect_security_block(hci_con_handle_t con_handle){
29482bd8b7e7S[email protected]     hci_connection_t * connection = hci_connection_for_handle(con_handle);
29492bd8b7e7S[email protected]     if (!connection) return;
29502bd8b7e7S[email protected]     connection->bonding_flags |= BONDING_DISCONNECT_SECURITY_BLOCK;
29512bd8b7e7S[email protected] }
29522bd8b7e7S[email protected] 
29532bd8b7e7S[email protected] 
2954dbe1a790S[email protected] // Configure Secure Simple Pairing
2955dbe1a790S[email protected] 
2956dbe1a790S[email protected] // enable will enable SSP during init
295715a95bd5SMatthias Ringwald void gap_ssp_set_enable(int enable){
29583a9fb326S[email protected]     hci_stack->ssp_enable = enable;
2959dbe1a790S[email protected] }
2960dbe1a790S[email protected] 
296195d71764SMatthias Ringwald static int hci_local_ssp_activated(void){
296215a95bd5SMatthias Ringwald     return gap_ssp_supported() && hci_stack->ssp_enable;
29632bd8b7e7S[email protected] }
29642bd8b7e7S[email protected] 
2965dbe1a790S[email protected] // if set, BTstack will respond to io capability request using authentication requirement
296615a95bd5SMatthias Ringwald void gap_ssp_set_io_capability(int io_capability){
29673a9fb326S[email protected]     hci_stack->ssp_io_capability = io_capability;
2968dbe1a790S[email protected] }
296915a95bd5SMatthias Ringwald void gap_ssp_set_authentication_requirement(int authentication_requirement){
29703a9fb326S[email protected]     hci_stack->ssp_authentication_requirement = authentication_requirement;
2971dbe1a790S[email protected] }
2972dbe1a790S[email protected] 
2973dbe1a790S[email protected] // if set, BTstack will confirm a numberic comparion and enter '000000' if requested
297415a95bd5SMatthias Ringwald void gap_ssp_set_auto_accept(int auto_accept){
29753a9fb326S[email protected]     hci_stack->ssp_auto_accept = auto_accept;
2976dbe1a790S[email protected] }
2977dbe1a790S[email protected] 
29781cd208adSmatthias.ringwald /**
29791cd208adSmatthias.ringwald  * pre: numcmds >= 0 - it's allowed to send a command to the controller
29801cd208adSmatthias.ringwald  */
2981fe35119dSmatthias.ringwald int hci_send_cmd(const hci_cmd_t *cmd, ...){
29825127cc62S[email protected] 
2983d94d3cafS[email protected]     if (!hci_can_send_command_packet_now()){
29849d14b626S[email protected]         log_error("hci_send_cmd called but cannot send packet now");
29859d14b626S[email protected]         return 0;
29869d14b626S[email protected]     }
29879d14b626S[email protected] 
29885127cc62S[email protected]     // for HCI INITIALIZATION
29899da54300S[email protected]     // log_info("hci_send_cmd: opcode %04x", cmd->opcode);
29905127cc62S[email protected]     hci_stack->last_cmd_opcode = cmd->opcode;
29915127cc62S[email protected] 
29929d14b626S[email protected]     hci_reserve_packet_buffer();
29939d14b626S[email protected]     uint8_t * packet = hci_stack->hci_packet_buffer;
29949d14b626S[email protected] 
29951cd208adSmatthias.ringwald     va_list argptr;
29961cd208adSmatthias.ringwald     va_start(argptr, cmd);
2997bcc59d6cSMatthias Ringwald     uint16_t size = hci_cmd_create_from_template(packet, cmd, argptr);
29981cd208adSmatthias.ringwald     va_end(argptr);
29999d14b626S[email protected] 
30009d14b626S[email protected]     return hci_send_cmd_packet(packet, size);
300193b8dc03Smatthias.ringwald }
3002c8e4258aSmatthias.ringwald 
3003ee091cf1Smatthias.ringwald // Create various non-HCI events.
3004ee091cf1Smatthias.ringwald // TODO: generalize, use table similar to hci_create_command
3005ee091cf1Smatthias.ringwald 
3006d6b06661SMatthias Ringwald static void hci_emit_event(uint8_t * event, uint16_t size, int dump){
3007fb37a842SMatthias Ringwald     // dump packet
3008d6b06661SMatthias Ringwald     if (dump) {
3009300c1ba4SMatthias Ringwald         hci_dump_packet( HCI_EVENT_PACKET, 0, event, size);
3010d6b06661SMatthias Ringwald     }
30111ef6bb52SMatthias Ringwald 
3012fb37a842SMatthias Ringwald     // dispatch to all event handlers
30131ef6bb52SMatthias Ringwald     btstack_linked_list_iterator_t it;
30141ef6bb52SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->event_handlers);
30151ef6bb52SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
30161ef6bb52SMatthias Ringwald         btstack_packet_callback_registration_t * entry = (btstack_packet_callback_registration_t*) btstack_linked_list_iterator_next(&it);
3017d9a7306aSMatthias Ringwald         entry->callback(HCI_EVENT_PACKET, 0, event, size);
30181ef6bb52SMatthias Ringwald     }
3019d6b06661SMatthias Ringwald }
3020d6b06661SMatthias Ringwald 
3021d6b06661SMatthias Ringwald static void hci_emit_acl_packet(uint8_t * packet, uint16_t size){
3022fb37a842SMatthias Ringwald     if (!hci_stack->acl_packet_handler) return;
30233d50b4baSMatthias Ringwald     hci_stack->acl_packet_handler(HCI_ACL_DATA_PACKET, 0, packet, size);
3024d6b06661SMatthias Ringwald }
3025d6b06661SMatthias Ringwald 
3026701e3307SMatthias Ringwald static void hci_notify_if_sco_can_send_now(void){
30273bc639ceSMatthias Ringwald     // notify SCO sender if waiting
3028701e3307SMatthias Ringwald     if (!hci_stack->sco_waiting_for_can_send_now) return;
3029701e3307SMatthias Ringwald     if (hci_can_send_sco_packet_now()){
30303bc639ceSMatthias Ringwald         hci_stack->sco_waiting_for_can_send_now = 0;
3031701e3307SMatthias Ringwald         uint8_t event[2] = { HCI_EVENT_SCO_CAN_SEND_NOW, 0 };
3032701e3307SMatthias Ringwald         hci_dump_packet(HCI_EVENT_PACKET, 1, event, sizeof(event));
30333d50b4baSMatthias Ringwald         hci_stack->sco_packet_handler(HCI_EVENT_PACKET, 0, event, sizeof(event));
30343bc639ceSMatthias Ringwald     }
30353bc639ceSMatthias Ringwald }
30363bc639ceSMatthias Ringwald 
303771de195eSMatthias Ringwald void hci_emit_state(void){
30383a9fb326S[email protected]     log_info("BTSTACK_EVENT_STATE %u", hci_stack->state);
3039425d1371Smatthias.ringwald     uint8_t event[3];
304080d52d6bSmatthias.ringwald     event[0] = BTSTACK_EVENT_STATE;
3041425d1371Smatthias.ringwald     event[1] = sizeof(event) - 2;
30423a9fb326S[email protected]     event[2] = hci_stack->state;
3043d6b06661SMatthias Ringwald     hci_emit_event(event, sizeof(event), 1);
3044c8e4258aSmatthias.ringwald }
3045c8e4258aSmatthias.ringwald 
30462deddeceSMatthias Ringwald static void hci_emit_connection_complete(bd_addr_t address, hci_con_handle_t con_handle, uint8_t status){
3047425d1371Smatthias.ringwald     uint8_t event[13];
3048c8e4258aSmatthias.ringwald     event[0] = HCI_EVENT_CONNECTION_COMPLETE;
3049425d1371Smatthias.ringwald     event[1] = sizeof(event) - 2;
305017f1ba2aSmatthias.ringwald     event[2] = status;
30512deddeceSMatthias Ringwald     little_endian_store_16(event, 3, con_handle);
30522deddeceSMatthias Ringwald     reverse_bd_addr(address, &event[5]);
3053c8e4258aSmatthias.ringwald     event[11] = 1; // ACL connection
3054c8e4258aSmatthias.ringwald     event[12] = 0; // encryption disabled
3055d6b06661SMatthias Ringwald     hci_emit_event(event, sizeof(event), 1);
3056c8e4258aSmatthias.ringwald }
3057c8e4258aSmatthias.ringwald 
3058fc64f94aSMatthias 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){
30594f3229d8S[email protected]     uint8_t event[21];
30604f3229d8S[email protected]     event[0] = HCI_EVENT_LE_META;
30614f3229d8S[email protected]     event[1] = sizeof(event) - 2;
30624f3229d8S[email protected]     event[2] = HCI_SUBEVENT_LE_CONNECTION_COMPLETE;
30634f3229d8S[email protected]     event[3] = status;
3064fc64f94aSMatthias Ringwald     little_endian_store_16(event, 4, con_handle);
30654f3229d8S[email protected]     event[6] = 0; // TODO: role
30666e2e9a6bS[email protected]     event[7] = address_type;
3067724d70a2SMatthias Ringwald     reverse_bd_addr(address, &event[8]);
3068f8fbdce0SMatthias Ringwald     little_endian_store_16(event, 14, 0); // interval
3069f8fbdce0SMatthias Ringwald     little_endian_store_16(event, 16, 0); // latency
3070f8fbdce0SMatthias Ringwald     little_endian_store_16(event, 18, 0); // supervision timeout
30714f3229d8S[email protected]     event[20] = 0; // master clock accuracy
3072d6b06661SMatthias Ringwald     hci_emit_event(event, sizeof(event), 1);
30734f3229d8S[email protected] }
30744f3229d8S[email protected] 
3075fc64f94aSMatthias Ringwald static void hci_emit_disconnection_complete(hci_con_handle_t con_handle, uint8_t reason){
3076425d1371Smatthias.ringwald     uint8_t event[6];
30773c4d4b90Smatthias.ringwald     event[0] = HCI_EVENT_DISCONNECTION_COMPLETE;
3078e518c4b8Smatthias.ringwald     event[1] = sizeof(event) - 2;
30793c4d4b90Smatthias.ringwald     event[2] = 0; // status = OK
3080fc64f94aSMatthias Ringwald     little_endian_store_16(event, 3, con_handle);
30813c4d4b90Smatthias.ringwald     event[5] = reason;
3082d6b06661SMatthias Ringwald     hci_emit_event(event, sizeof(event), 1);
30833c4d4b90Smatthias.ringwald }
30843c4d4b90Smatthias.ringwald 
3085b83d5eabSMatthias Ringwald static void hci_emit_l2cap_check_timeout(hci_connection_t *conn){
308666fb9560S[email protected]     if (disable_l2cap_timeouts) return;
3087e0abb8e7S[email protected]     log_info("L2CAP_EVENT_TIMEOUT_CHECK");
3088425d1371Smatthias.ringwald     uint8_t event[4];
308980d52d6bSmatthias.ringwald     event[0] = L2CAP_EVENT_TIMEOUT_CHECK;
3090425d1371Smatthias.ringwald     event[1] = sizeof(event) - 2;
3091f8fbdce0SMatthias Ringwald     little_endian_store_16(event, 2, conn->con_handle);
3092d6b06661SMatthias Ringwald     hci_emit_event(event, sizeof(event), 1);
3093ee091cf1Smatthias.ringwald }
309443bfb1bdSmatthias.ringwald 
3095b83d5eabSMatthias Ringwald static void hci_emit_nr_connections_changed(void){
3096e0abb8e7S[email protected]     log_info("BTSTACK_EVENT_NR_CONNECTIONS_CHANGED %u", nr_hci_connections());
3097425d1371Smatthias.ringwald     uint8_t event[3];
309880d52d6bSmatthias.ringwald     event[0] = BTSTACK_EVENT_NR_CONNECTIONS_CHANGED;
3099425d1371Smatthias.ringwald     event[1] = sizeof(event) - 2;
310043bfb1bdSmatthias.ringwald     event[2] = nr_hci_connections();
3101d6b06661SMatthias Ringwald     hci_emit_event(event, sizeof(event), 1);
310243bfb1bdSmatthias.ringwald }
3103038bc64cSmatthias.ringwald 
3104b83d5eabSMatthias Ringwald static void hci_emit_hci_open_failed(void){
3105e0abb8e7S[email protected]     log_info("BTSTACK_EVENT_POWERON_FAILED");
3106425d1371Smatthias.ringwald     uint8_t event[2];
310780d52d6bSmatthias.ringwald     event[0] = BTSTACK_EVENT_POWERON_FAILED;
3108425d1371Smatthias.ringwald     event[1] = sizeof(event) - 2;
3109d6b06661SMatthias Ringwald     hci_emit_event(event, sizeof(event), 1);
3110038bc64cSmatthias.ringwald }
31111b0e3922Smatthias.ringwald 
3112b83d5eabSMatthias Ringwald static void hci_emit_discoverable_enabled(uint8_t enabled){
3113e0abb8e7S[email protected]     log_info("BTSTACK_EVENT_DISCOVERABLE_ENABLED %u", enabled);
3114425d1371Smatthias.ringwald     uint8_t event[3];
3115381fbed8Smatthias.ringwald     event[0] = BTSTACK_EVENT_DISCOVERABLE_ENABLED;
3116425d1371Smatthias.ringwald     event[1] = sizeof(event) - 2;
3117381fbed8Smatthias.ringwald     event[2] = enabled;
3118d6b06661SMatthias Ringwald     hci_emit_event(event, sizeof(event), 1);
3119381fbed8Smatthias.ringwald }
3120458bf4e8S[email protected] 
3121b83d5eabSMatthias Ringwald static void hci_emit_security_level(hci_con_handle_t con_handle, gap_security_level_t level){
3122df3354fcS[email protected]     log_info("hci_emit_security_level %u for handle %x", level, con_handle);
3123a00031e2S[email protected]     uint8_t event[5];
3124e00caf9cS[email protected]     int pos = 0;
31255611a760SMatthias Ringwald     event[pos++] = GAP_EVENT_SECURITY_LEVEL;
3126e00caf9cS[email protected]     event[pos++] = sizeof(event) - 2;
3127f8fbdce0SMatthias Ringwald     little_endian_store_16(event, 2, con_handle);
3128e00caf9cS[email protected]     pos += 2;
3129e00caf9cS[email protected]     event[pos++] = level;
3130d6b06661SMatthias Ringwald     hci_emit_event(event, sizeof(event), 1);
3131e00caf9cS[email protected] }
3132e00caf9cS[email protected] 
3133b83d5eabSMatthias Ringwald static void hci_emit_dedicated_bonding_result(bd_addr_t address, uint8_t status){
3134ad83dc6aS[email protected]     log_info("hci_emit_dedicated_bonding_result %u ", status);
3135ad83dc6aS[email protected]     uint8_t event[9];
3136ad83dc6aS[email protected]     int pos = 0;
31375611a760SMatthias Ringwald     event[pos++] = GAP_EVENT_DEDICATED_BONDING_COMPLETED;
3138ad83dc6aS[email protected]     event[pos++] = sizeof(event) - 2;
3139ad83dc6aS[email protected]     event[pos++] = status;
3140724d70a2SMatthias Ringwald     reverse_bd_addr(address, &event[pos]);
3141d6b06661SMatthias Ringwald     hci_emit_event(event, sizeof(event), 1);
3142ad83dc6aS[email protected] }
3143ad83dc6aS[email protected] 
314498a2fd1cSMatthias Ringwald // query if remote side supports eSCO
3145073bd0faSMatthias Ringwald int hci_remote_esco_supported(hci_con_handle_t con_handle){
314698a2fd1cSMatthias Ringwald     hci_connection_t * connection = hci_connection_for_handle(con_handle);
314798a2fd1cSMatthias Ringwald     if (!connection) return 0;
314898a2fd1cSMatthias Ringwald     return connection->remote_supported_feature_eSCO;
314998a2fd1cSMatthias Ringwald }
315098a2fd1cSMatthias Ringwald 
31512bd8b7e7S[email protected] // query if remote side supports SSP
31522bd8b7e7S[email protected] int hci_remote_ssp_supported(hci_con_handle_t con_handle){
31532bd8b7e7S[email protected]     hci_connection_t * connection = hci_connection_for_handle(con_handle);
31542bd8b7e7S[email protected]     if (!connection) return 0;
31552bd8b7e7S[email protected]     return (connection->bonding_flags & BONDING_REMOTE_SUPPORTS_SSP) ? 1 : 0;
31562bd8b7e7S[email protected] }
31572bd8b7e7S[email protected] 
315815a95bd5SMatthias Ringwald int gap_ssp_supported_on_both_sides(hci_con_handle_t handle){
3159df3354fcS[email protected]     return hci_local_ssp_activated() && hci_remote_ssp_supported(handle);
3160df3354fcS[email protected] }
3161df3354fcS[email protected] 
3162458bf4e8S[email protected] // GAP API
3163458bf4e8S[email protected] /**
3164458bf4e8S[email protected]  * @bbrief enable/disable bonding. default is enabled
3165458bf4e8S[email protected]  * @praram enabled
3166458bf4e8S[email protected]  */
31674c57c146S[email protected] void gap_set_bondable_mode(int enable){
31683a9fb326S[email protected]     hci_stack->bondable = enable ? 1 : 0;
3169458bf4e8S[email protected] }
31704ef6443cSMatthias Ringwald /**
31714ef6443cSMatthias Ringwald  * @brief Get bondable mode.
31724ef6443cSMatthias Ringwald  * @return 1 if bondable
31734ef6443cSMatthias Ringwald  */
31744ef6443cSMatthias Ringwald int gap_get_bondable_mode(void){
31754ef6443cSMatthias Ringwald     return hci_stack->bondable;
31764ef6443cSMatthias Ringwald }
3177cb230b9dS[email protected] 
3178cb230b9dS[email protected] /**
317934d2123cS[email protected]  * @brief map link keys to security levels
3180cb230b9dS[email protected]  */
318134d2123cS[email protected] gap_security_level_t gap_security_level_for_link_key_type(link_key_type_t link_key_type){
318234d2123cS[email protected]     switch (link_key_type){
31833c68dfa9S[email protected]         case AUTHENTICATED_COMBINATION_KEY_GENERATED_FROM_P256:
31843c68dfa9S[email protected]             return LEVEL_4;
31853c68dfa9S[email protected]         case COMBINATION_KEY:
31863c68dfa9S[email protected]         case AUTHENTICATED_COMBINATION_KEY_GENERATED_FROM_P192:
31873c68dfa9S[email protected]             return LEVEL_3;
31883c68dfa9S[email protected]         default:
31893c68dfa9S[email protected]             return LEVEL_2;
31903c68dfa9S[email protected]     }
3191cb230b9dS[email protected] }
3192cb230b9dS[email protected] 
3193a00031e2S[email protected] static gap_security_level_t gap_security_level_for_connection(hci_connection_t * connection){
319434d2123cS[email protected]     if (!connection) return LEVEL_0;
319534d2123cS[email protected]     if ((connection->authentication_flags & CONNECTION_ENCRYPTED) == 0) return LEVEL_0;
319634d2123cS[email protected]     return gap_security_level_for_link_key_type(connection->link_key_type);
319734d2123cS[email protected] }
319834d2123cS[email protected] 
319934d2123cS[email protected] 
3200106d6d11S[email protected] int gap_mitm_protection_required_for_security_level(gap_security_level_t level){
32015127cc62S[email protected]     log_info("gap_mitm_protection_required_for_security_level %u", level);
3202106d6d11S[email protected]     return level > LEVEL_2;
3203106d6d11S[email protected] }
3204106d6d11S[email protected] 
320534d2123cS[email protected] /**
320634d2123cS[email protected]  * @brief get current security level
320734d2123cS[email protected]  */
320834d2123cS[email protected] gap_security_level_t gap_security_level(hci_con_handle_t con_handle){
320934d2123cS[email protected]     hci_connection_t * connection = hci_connection_for_handle(con_handle);
321034d2123cS[email protected]     if (!connection) return LEVEL_0;
321134d2123cS[email protected]     return gap_security_level_for_connection(connection);
321234d2123cS[email protected] }
321334d2123cS[email protected] 
3214cb230b9dS[email protected] /**
3215cb230b9dS[email protected]  * @brief request connection to device to
3216cb230b9dS[email protected]  * @result GAP_AUTHENTICATION_RESULT
3217cb230b9dS[email protected]  */
321834d2123cS[email protected] void gap_request_security_level(hci_con_handle_t con_handle, gap_security_level_t requested_level){
321934d2123cS[email protected]     hci_connection_t * connection = hci_connection_for_handle(con_handle);
322034d2123cS[email protected]     if (!connection){
3221a00031e2S[email protected]         hci_emit_security_level(con_handle, LEVEL_0);
322234d2123cS[email protected]         return;
322334d2123cS[email protected]     }
322434d2123cS[email protected]     gap_security_level_t current_level = gap_security_level(con_handle);
322534d2123cS[email protected]     log_info("gap_request_security_level %u, current level %u", requested_level, current_level);
322634d2123cS[email protected]     if (current_level >= requested_level){
3227a00031e2S[email protected]         hci_emit_security_level(con_handle, current_level);
322834d2123cS[email protected]         return;
322934d2123cS[email protected]     }
3230a00031e2S[email protected] 
323134d2123cS[email protected]     connection->requested_security_level = requested_level;
3232a00031e2S[email protected] 
323325bf5872S[email protected] #if 0
323425bf5872S[email protected]     // sending encryption request without a link key results in an error.
323525bf5872S[email protected]     // TODO: figure out how to use it properly
323625bf5872S[email protected] 
3237fb8ba0dbS[email protected]     // would enabling ecnryption suffice (>= LEVEL_2)?
3238a98592bcSMatthias Ringwald     if (hci_stack->link_key_db){
3239a00031e2S[email protected]         link_key_type_t link_key_type;
3240a00031e2S[email protected]         link_key_t      link_key;
3241a98592bcSMatthias Ringwald         if (hci_stack->link_key_db->get_link_key( &connection->address, &link_key, &link_key_type)){
3242a00031e2S[email protected]             if (gap_security_level_for_link_key_type(link_key_type) >= requested_level){
3243a00031e2S[email protected]                 connection->bonding_flags |= BONDING_SEND_ENCRYPTION_REQUEST;
3244a00031e2S[email protected]                 return;
3245a00031e2S[email protected]             }
3246a00031e2S[email protected]         }
3247a00031e2S[email protected]     }
324825bf5872S[email protected] #endif
3249a00031e2S[email protected] 
32501eb2563eS[email protected]     // try to authenticate connection
32511eb2563eS[email protected]     connection->bonding_flags |= BONDING_SEND_AUTHENTICATE_REQUEST;
3252e80b2cf9S[email protected]     hci_run();
3253e00caf9cS[email protected] }
3254ad83dc6aS[email protected] 
3255ad83dc6aS[email protected] /**
3256ad83dc6aS[email protected]  * @brief start dedicated bonding with device. disconnect after bonding
3257ad83dc6aS[email protected]  * @param device
3258ad83dc6aS[email protected]  * @param request MITM protection
3259ad83dc6aS[email protected]  * @result GAP_DEDICATED_BONDING_COMPLETE
3260ad83dc6aS[email protected]  */
3261ad83dc6aS[email protected] int gap_dedicated_bonding(bd_addr_t device, int mitm_protection_required){
3262ad83dc6aS[email protected] 
3263ad83dc6aS[email protected]     // create connection state machine
326496a45072S[email protected]     hci_connection_t * connection = create_connection_for_bd_addr_and_type(device, BD_ADDR_TYPE_CLASSIC);
3265ad83dc6aS[email protected] 
3266ad83dc6aS[email protected]     if (!connection){
3267ad83dc6aS[email protected]         return BTSTACK_MEMORY_ALLOC_FAILED;
3268ad83dc6aS[email protected]     }
3269ad83dc6aS[email protected] 
3270ad83dc6aS[email protected]     // delete linkn key
327115a95bd5SMatthias Ringwald     gap_drop_link_key_for_bd_addr(device);
3272ad83dc6aS[email protected] 
3273ad83dc6aS[email protected]     // configure LEVEL_2/3, dedicated bonding
3274ad83dc6aS[email protected]     connection->state = SEND_CREATE_CONNECTION;
3275ad83dc6aS[email protected]     connection->requested_security_level = mitm_protection_required ? LEVEL_3 : LEVEL_2;
32765127cc62S[email protected]     log_info("gap_dedicated_bonding, mitm %u -> level %u", mitm_protection_required, connection->requested_security_level);
3277ad83dc6aS[email protected]     connection->bonding_flags = BONDING_DEDICATED;
3278ad83dc6aS[email protected] 
3279ad83dc6aS[email protected]     // wait for GAP Security Result and send GAP Dedicated Bonding complete
3280ad83dc6aS[email protected] 
3281ad83dc6aS[email protected]     // handle: connnection failure (connection complete != ok)
3282ad83dc6aS[email protected]     // handle: authentication failure
3283ad83dc6aS[email protected]     // handle: disconnect on done
3284ad83dc6aS[email protected] 
3285ad83dc6aS[email protected]     hci_run();
3286ad83dc6aS[email protected] 
3287ad83dc6aS[email protected]     return 0;
3288ad83dc6aS[email protected] }
32898e618f72S[email protected] 
32908e618f72S[email protected] void gap_set_local_name(const char * local_name){
32918e618f72S[email protected]     hci_stack->local_name = local_name;
32928e618f72S[email protected] }
32938e618f72S[email protected] 
3294d8e8f12aSMatthias Ringwald void gap_start_scan(void){
3295d8e8f12aSMatthias Ringwald     if (hci_stack->le_scanning_state == LE_SCANNING) return;
32967bdc6798S[email protected]     hci_stack->le_scanning_state = LE_START_SCAN;
32977bdc6798S[email protected]     hci_run();
32987bdc6798S[email protected] }
32998e618f72S[email protected] 
3300d8e8f12aSMatthias Ringwald void gap_stop_scan(void){
3301d8e8f12aSMatthias Ringwald     if ( hci_stack->le_scanning_state == LE_SCAN_IDLE) return;
33027bdc6798S[email protected]     hci_stack->le_scanning_state = LE_STOP_SCAN;
33037bdc6798S[email protected]     hci_run();
33047bdc6798S[email protected] }
33054f3229d8S[email protected] 
3306d8e8f12aSMatthias Ringwald void gap_set_scan_parameters(uint8_t scan_type, uint16_t scan_interval, uint16_t scan_window){
3307ef11999fSmatthias.ringwald     hci_stack->le_scan_type     = scan_type;
3308ef11999fSmatthias.ringwald     hci_stack->le_scan_interval = scan_interval;
3309ef11999fSmatthias.ringwald     hci_stack->le_scan_window   = scan_window;
3310ef11999fSmatthias.ringwald     hci_run();
3311ef11999fSmatthias.ringwald }
33124f3229d8S[email protected] 
3313d8e8f12aSMatthias Ringwald uint8_t gap_connect(bd_addr_t addr, bd_addr_type_t addr_type){
33144f3229d8S[email protected]     hci_connection_t * conn = hci_connection_for_bd_addr_and_type(addr, addr_type);
33154f3229d8S[email protected]     if (!conn){
3316d8e8f12aSMatthias Ringwald         log_info("gap_connect: no connection exists yet, creating context");
33172e77e513S[email protected]         conn = create_connection_for_bd_addr_and_type(addr, addr_type);
33184f3229d8S[email protected]         if (!conn){
33194f3229d8S[email protected]             // notify client that alloc failed
33206e2e9a6bS[email protected]             hci_emit_le_connection_complete(addr_type, addr, 0, BTSTACK_MEMORY_ALLOC_FAILED);
3321d8e8f12aSMatthias Ringwald             log_info("gap_connect: failed to alloc hci_connection_t");
3322472a5742SMatthias Ringwald             return GATT_CLIENT_NOT_CONNECTED; // don't sent packet to controller
33234f3229d8S[email protected]         }
33244f3229d8S[email protected]         conn->state = SEND_CREATE_CONNECTION;
3325d8e8f12aSMatthias Ringwald         log_info("gap_connect: send create connection next");
3326564fca32S[email protected]         hci_run();
3327616edd56SMatthias Ringwald         return 0;
33284f3229d8S[email protected]     }
33290bf6344aS[email protected] 
33300bf6344aS[email protected]     if (!hci_is_le_connection(conn) ||
33310bf6344aS[email protected]         conn->state == SEND_CREATE_CONNECTION ||
33320bf6344aS[email protected]         conn->state == SENT_CREATE_CONNECTION) {
33332e77e513S[email protected]         hci_emit_le_connection_complete(conn->address_type, conn->address, 0, ERROR_CODE_COMMAND_DISALLOWED);
3334d8e8f12aSMatthias Ringwald         log_error("gap_connect: classic connection or connect is already being created");
3335616edd56SMatthias Ringwald         return GATT_CLIENT_IN_WRONG_STATE;
33360bf6344aS[email protected]     }
33370bf6344aS[email protected] 
3338d8e8f12aSMatthias Ringwald     log_info("gap_connect: context exists with state %u", conn->state);
33392e77e513S[email protected]     hci_emit_le_connection_complete(conn->address_type, conn->address, conn->con_handle, 0);
33404f3229d8S[email protected]     hci_run();
3341616edd56SMatthias Ringwald     return 0;
33424f3229d8S[email protected] }
33434f3229d8S[email protected] 
33447851196eSmatthias.ringwald // @assumption: only a single outgoing LE Connection exists
3345d8e8f12aSMatthias Ringwald static hci_connection_t * gap_get_outgoing_connection(void){
3346665d90f2SMatthias Ringwald     btstack_linked_item_t *it;
3347665d90f2SMatthias Ringwald     for (it = (btstack_linked_item_t *) hci_stack->connections; it ; it = it->next){
33480bf6344aS[email protected]         hci_connection_t * conn = (hci_connection_t *) it;
33490bf6344aS[email protected]         if (!hci_is_le_connection(conn)) continue;
33500bf6344aS[email protected]         switch (conn->state){
3351a6725849S[email protected]             case SEND_CREATE_CONNECTION:
33527851196eSmatthias.ringwald             case SENT_CREATE_CONNECTION:
33537851196eSmatthias.ringwald                 return conn;
33547851196eSmatthias.ringwald             default:
33557851196eSmatthias.ringwald                 break;
33567851196eSmatthias.ringwald         };
33577851196eSmatthias.ringwald     }
33587851196eSmatthias.ringwald     return NULL;
33597851196eSmatthias.ringwald }
33607851196eSmatthias.ringwald 
3361d8e8f12aSMatthias Ringwald uint8_t gap_connect_cancel(void){
3362d8e8f12aSMatthias Ringwald     hci_connection_t * conn = gap_get_outgoing_connection();
3363616edd56SMatthias Ringwald     if (!conn) return 0;
33647851196eSmatthias.ringwald     switch (conn->state){
33657851196eSmatthias.ringwald         case SEND_CREATE_CONNECTION:
33667851196eSmatthias.ringwald             // skip sending create connection and emit event instead
33672e77e513S[email protected]             hci_emit_le_connection_complete(conn->address_type, conn->address, 0, ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER);
3368665d90f2SMatthias Ringwald             btstack_linked_list_remove(&hci_stack->connections, (btstack_linked_item_t *) conn);
33697851196eSmatthias.ringwald             btstack_memory_hci_connection_free( conn );
33700bf6344aS[email protected]             break;
3371a6725849S[email protected]         case SENT_CREATE_CONNECTION:
33727851196eSmatthias.ringwald             // request to send cancel connection
33730bf6344aS[email protected]             conn->state = SEND_CANCEL_CONNECTION;
33740bf6344aS[email protected]             hci_run();
33750bf6344aS[email protected]             break;
33760bf6344aS[email protected]         default:
33770bf6344aS[email protected]             break;
33780bf6344aS[email protected]     }
3379616edd56SMatthias Ringwald     return 0;
3380e31f89a7S[email protected] }
33814f3229d8S[email protected] 
3382c37a3166S[email protected] /**
3383c37a3166S[email protected]  * @brief Updates the connection parameters for a given LE connection
3384c37a3166S[email protected]  * @param handle
3385c37a3166S[email protected]  * @param conn_interval_min (unit: 1.25ms)
3386c37a3166S[email protected]  * @param conn_interval_max (unit: 1.25ms)
3387c37a3166S[email protected]  * @param conn_latency
3388c37a3166S[email protected]  * @param supervision_timeout (unit: 10ms)
3389c37a3166S[email protected]  * @returns 0 if ok
3390c37a3166S[email protected]  */
3391c37a3166S[email protected] int gap_update_connection_parameters(hci_con_handle_t con_handle, uint16_t conn_interval_min,
3392c37a3166S[email protected]     uint16_t conn_interval_max, uint16_t conn_latency, uint16_t supervision_timeout){
3393c37a3166S[email protected]     hci_connection_t * connection = hci_connection_for_handle(con_handle);
3394c37a3166S[email protected]     if (!connection) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
3395c37a3166S[email protected]     connection->le_conn_interval_min = conn_interval_min;
3396c37a3166S[email protected]     connection->le_conn_interval_max = conn_interval_max;
3397c37a3166S[email protected]     connection->le_conn_latency = conn_latency;
3398c37a3166S[email protected]     connection->le_supervision_timeout = supervision_timeout;
339984cf6d83SMatthias Ringwald     connection->le_con_parameter_update_state = CON_PARAMETER_UPDATE_CHANGE_HCI_CON_PARAMETERS;
3400cfc59f1bSMatthias Ringwald     hci_run();
3401c37a3166S[email protected]     return 0;
3402c37a3166S[email protected] }
3403c37a3166S[email protected] 
340445c102fdSMatthias Ringwald /**
3405b68d7bc3SMatthias Ringwald  * @brief Request an update of the connection parameter for a given LE connection
3406b68d7bc3SMatthias Ringwald  * @param handle
3407b68d7bc3SMatthias Ringwald  * @param conn_interval_min (unit: 1.25ms)
3408b68d7bc3SMatthias Ringwald  * @param conn_interval_max (unit: 1.25ms)
3409b68d7bc3SMatthias Ringwald  * @param conn_latency
3410b68d7bc3SMatthias Ringwald  * @param supervision_timeout (unit: 10ms)
3411b68d7bc3SMatthias Ringwald  * @returns 0 if ok
3412b68d7bc3SMatthias Ringwald  */
3413b68d7bc3SMatthias Ringwald int gap_request_connection_parameter_update(hci_con_handle_t con_handle, uint16_t conn_interval_min,
3414b68d7bc3SMatthias Ringwald     uint16_t conn_interval_max, uint16_t conn_latency, uint16_t supervision_timeout){
3415b68d7bc3SMatthias Ringwald     hci_connection_t * connection = hci_connection_for_handle(con_handle);
3416b68d7bc3SMatthias Ringwald     if (!connection) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
3417b68d7bc3SMatthias Ringwald     connection->le_conn_interval_min = conn_interval_min;
3418b68d7bc3SMatthias Ringwald     connection->le_conn_interval_max = conn_interval_max;
3419b68d7bc3SMatthias Ringwald     connection->le_conn_latency = conn_latency;
3420b68d7bc3SMatthias Ringwald     connection->le_supervision_timeout = supervision_timeout;
3421b68d7bc3SMatthias Ringwald     connection->le_con_parameter_update_state = CON_PARAMETER_UPDATE_SEND_REQUEST;
3422b68d7bc3SMatthias Ringwald     hci_run();
3423b68d7bc3SMatthias Ringwald     return 0;
3424b68d7bc3SMatthias Ringwald }
3425b68d7bc3SMatthias Ringwald 
3426501f56b3SMatthias Ringwald static void gap_advertisments_changed(void){
3427501f56b3SMatthias Ringwald     // disable advertisements before updating adv, scan data, or adv params
3428501f56b3SMatthias Ringwald     if (hci_stack->le_advertisements_active){
3429501f56b3SMatthias Ringwald         hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_DISABLE | LE_ADVERTISEMENT_TASKS_ENABLE;
3430501f56b3SMatthias Ringwald     }
3431501f56b3SMatthias Ringwald     hci_run();
3432501f56b3SMatthias Ringwald }
3433501f56b3SMatthias Ringwald 
3434b68d7bc3SMatthias Ringwald /**
343545c102fdSMatthias Ringwald  * @brief Set Advertisement Data
343645c102fdSMatthias Ringwald  * @param advertising_data_length
343745c102fdSMatthias Ringwald  * @param advertising_data (max 31 octets)
343845c102fdSMatthias Ringwald  * @note data is not copied, pointer has to stay valid
343945c102fdSMatthias Ringwald  */
344045c102fdSMatthias Ringwald void gap_advertisements_set_data(uint8_t advertising_data_length, uint8_t * advertising_data){
344145c102fdSMatthias Ringwald     hci_stack->le_advertisements_data_len = advertising_data_length;
344245c102fdSMatthias Ringwald     hci_stack->le_advertisements_data = advertising_data;
3443501f56b3SMatthias Ringwald     hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_SET_ADV_DATA;
3444501f56b3SMatthias Ringwald     gap_advertisments_changed();
344545c102fdSMatthias Ringwald }
3446501f56b3SMatthias Ringwald 
3447501f56b3SMatthias Ringwald /**
3448501f56b3SMatthias Ringwald  * @brief Set Scan Response Data
3449501f56b3SMatthias Ringwald  * @param advertising_data_length
3450501f56b3SMatthias Ringwald  * @param advertising_data (max 31 octets)
3451501f56b3SMatthias Ringwald  * @note data is not copied, pointer has to stay valid
3452501f56b3SMatthias Ringwald  */
3453501f56b3SMatthias Ringwald void gap_scan_response_set_data(uint8_t scan_response_data_length, uint8_t * scan_response_data){
3454501f56b3SMatthias Ringwald     hci_stack->le_scan_response_data_len = scan_response_data_length;
3455501f56b3SMatthias Ringwald     hci_stack->le_scan_response_data = scan_response_data;
3456501f56b3SMatthias Ringwald     hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_SET_SCAN_DATA;
3457501f56b3SMatthias Ringwald     gap_advertisments_changed();
345845c102fdSMatthias Ringwald }
345945c102fdSMatthias Ringwald 
346045c102fdSMatthias Ringwald /**
346145c102fdSMatthias Ringwald  * @brief Set Advertisement Parameters
346245c102fdSMatthias Ringwald  * @param adv_int_min
346345c102fdSMatthias Ringwald  * @param adv_int_max
346445c102fdSMatthias Ringwald  * @param adv_type
346545c102fdSMatthias Ringwald  * @param own_address_type
346645c102fdSMatthias Ringwald  * @param direct_address_type
346745c102fdSMatthias Ringwald  * @param direct_address
346845c102fdSMatthias Ringwald  * @param channel_map
346945c102fdSMatthias Ringwald  * @param filter_policy
347045c102fdSMatthias Ringwald  *
347145c102fdSMatthias Ringwald  * @note internal use. use gap_advertisements_set_params from gap_le.h instead.
347245c102fdSMatthias Ringwald  */
347345c102fdSMatthias Ringwald  void hci_le_advertisements_set_params(uint16_t adv_int_min, uint16_t adv_int_max, uint8_t adv_type,
347445c102fdSMatthias Ringwald     uint8_t own_address_type, uint8_t direct_address_typ, bd_addr_t direct_address,
347545c102fdSMatthias Ringwald     uint8_t channel_map, uint8_t filter_policy) {
347645c102fdSMatthias Ringwald 
347745c102fdSMatthias Ringwald     hci_stack->le_advertisements_interval_min = adv_int_min;
347845c102fdSMatthias Ringwald     hci_stack->le_advertisements_interval_max = adv_int_max;
347945c102fdSMatthias Ringwald     hci_stack->le_advertisements_type = adv_type;
348045c102fdSMatthias Ringwald     hci_stack->le_advertisements_own_address_type = own_address_type;
348145c102fdSMatthias Ringwald     hci_stack->le_advertisements_direct_address_type = direct_address_typ;
348245c102fdSMatthias Ringwald     hci_stack->le_advertisements_channel_map = channel_map;
348345c102fdSMatthias Ringwald     hci_stack->le_advertisements_filter_policy = filter_policy;
348445c102fdSMatthias Ringwald     memcpy(hci_stack->le_advertisements_direct_address, direct_address, 6);
348545c102fdSMatthias Ringwald 
348645c102fdSMatthias Ringwald     hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_SET_PARAMS;
3487501f56b3SMatthias Ringwald     gap_advertisments_changed();
348845c102fdSMatthias Ringwald  }
348945c102fdSMatthias Ringwald 
349045c102fdSMatthias Ringwald /**
349145c102fdSMatthias Ringwald  * @brief Enable/Disable Advertisements
349245c102fdSMatthias Ringwald  * @param enabled
349345c102fdSMatthias Ringwald  */
349445c102fdSMatthias Ringwald void gap_advertisements_enable(int enabled){
349545c102fdSMatthias Ringwald     hci_stack->le_advertisements_enabled = enabled;
349645c102fdSMatthias Ringwald     if (enabled && !hci_stack->le_advertisements_active){
349745c102fdSMatthias Ringwald         hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_ENABLE;
349845c102fdSMatthias Ringwald     }
349945c102fdSMatthias Ringwald     if (!enabled && hci_stack->le_advertisements_active){
350045c102fdSMatthias Ringwald         hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_DISABLE;
350145c102fdSMatthias Ringwald     }
3502cfc59f1bSMatthias Ringwald     hci_run();
350345c102fdSMatthias Ringwald }
350445c102fdSMatthias Ringwald 
350545c102fdSMatthias Ringwald 
3506616edd56SMatthias Ringwald uint8_t gap_disconnect(hci_con_handle_t handle){
35075917a5c5S[email protected]     hci_connection_t * conn = hci_connection_for_handle(handle);
35085917a5c5S[email protected]     if (!conn){
35097851196eSmatthias.ringwald         hci_emit_disconnection_complete(handle, 0);
3510616edd56SMatthias Ringwald         return 0;
35115917a5c5S[email protected]     }
35125917a5c5S[email protected]     conn->state = SEND_DISCONNECT;
35135917a5c5S[email protected]     hci_run();
3514616edd56SMatthias Ringwald     return 0;
35154f3229d8S[email protected] }
351604a6ef8cSmatthias.ringwald 
3517a1bf5ae7SMatthias Ringwald /**
3518a1bf5ae7SMatthias Ringwald  * @brief Get connection type
3519a1bf5ae7SMatthias Ringwald  * @param con_handle
3520a1bf5ae7SMatthias Ringwald  * @result connection_type
3521a1bf5ae7SMatthias Ringwald  */
3522a1bf5ae7SMatthias Ringwald gap_connection_type_t gap_get_connection_type(hci_con_handle_t connection_handle){
3523a1bf5ae7SMatthias Ringwald     hci_connection_t * conn = hci_connection_for_handle(connection_handle);
3524a1bf5ae7SMatthias Ringwald     if (!conn) return GAP_CONNECTION_INVALID;
3525a1bf5ae7SMatthias Ringwald     switch (conn->address_type){
3526a1bf5ae7SMatthias Ringwald         case BD_ADDR_TYPE_LE_PUBLIC:
3527a1bf5ae7SMatthias Ringwald         case BD_ADDR_TYPE_LE_RANDOM:
3528a1bf5ae7SMatthias Ringwald             return GAP_CONNECTION_LE;
3529a1bf5ae7SMatthias Ringwald         case BD_ADDR_TYPE_SCO:
3530a1bf5ae7SMatthias Ringwald             return GAP_CONNECTION_SCO;
3531a1bf5ae7SMatthias Ringwald         case BD_ADDR_TYPE_CLASSIC:
3532a1bf5ae7SMatthias Ringwald             return GAP_CONNECTION_ACL;
3533a1bf5ae7SMatthias Ringwald         default:
3534a1bf5ae7SMatthias Ringwald             return GAP_CONNECTION_INVALID;
3535a1bf5ae7SMatthias Ringwald     }
3536a1bf5ae7SMatthias Ringwald }
3537a1bf5ae7SMatthias Ringwald 
3538a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE
35394f551432SMatthias Ringwald 
3540d23838ecSMatthias Ringwald /**
3541ac9c45e0SMatthias Ringwald  * @brief Auto Connection Establishment - Start Connecting to device
3542ac9c45e0SMatthias Ringwald  * @param address_typ
3543ac9c45e0SMatthias Ringwald  * @param address
3544ac9c45e0SMatthias Ringwald  * @returns 0 if ok
3545ac9c45e0SMatthias Ringwald  */
35464f551432SMatthias Ringwald int gap_auto_connection_start(bd_addr_type_t address_type, bd_addr_t address){
3547e83201bcSMatthias Ringwald     // check capacity
3548665d90f2SMatthias Ringwald     int num_entries = btstack_linked_list_count(&hci_stack->le_whitelist);
354991915b0bSMatthias Ringwald     if (num_entries >= hci_stack->le_whitelist_capacity) return ERROR_CODE_MEMORY_CAPACITY_EXCEEDED;
3550e83201bcSMatthias Ringwald     whitelist_entry_t * entry = btstack_memory_whitelist_entry_get();
3551e83201bcSMatthias Ringwald     if (!entry) return BTSTACK_MEMORY_ALLOC_FAILED;
3552e83201bcSMatthias Ringwald     entry->address_type = address_type;
3553e83201bcSMatthias Ringwald     memcpy(entry->address, address, 6);
3554e83201bcSMatthias Ringwald     entry->state = LE_WHITELIST_ADD_TO_CONTROLLER;
3555665d90f2SMatthias Ringwald     btstack_linked_list_add(&hci_stack->le_whitelist, (btstack_linked_item_t*) entry);
3556e83201bcSMatthias Ringwald     hci_run();
3557e83201bcSMatthias Ringwald     return 0;
3558ac9c45e0SMatthias Ringwald }
3559ac9c45e0SMatthias Ringwald 
356042ff5ba1SMatthias Ringwald static void hci_remove_from_whitelist(bd_addr_type_t address_type, bd_addr_t address){
3561665d90f2SMatthias Ringwald     btstack_linked_list_iterator_t it;
3562665d90f2SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->le_whitelist);
3563665d90f2SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
3564665d90f2SMatthias Ringwald         whitelist_entry_t * entry = (whitelist_entry_t*) btstack_linked_list_iterator_next(&it);
3565e83201bcSMatthias Ringwald         if (entry->address_type != address_type) continue;
3566e83201bcSMatthias Ringwald         if (memcmp(entry->address, address, 6) != 0) continue;
3567e83201bcSMatthias Ringwald         if (entry->state & LE_WHITELIST_ON_CONTROLLER){
3568e83201bcSMatthias Ringwald             // remove from controller if already present
3569e83201bcSMatthias Ringwald             entry->state |= LE_WHITELIST_REMOVE_FROM_CONTROLLER;
3570e83201bcSMatthias Ringwald             continue;
3571e83201bcSMatthias Ringwald         }
3572e83201bcSMatthias Ringwald         // direclty remove entry from whitelist
3573665d90f2SMatthias Ringwald         btstack_linked_list_iterator_remove(&it);
3574e83201bcSMatthias Ringwald         btstack_memory_whitelist_entry_free(entry);
3575e83201bcSMatthias Ringwald     }
357642ff5ba1SMatthias Ringwald }
357742ff5ba1SMatthias Ringwald 
357842ff5ba1SMatthias Ringwald /**
357942ff5ba1SMatthias Ringwald  * @brief Auto Connection Establishment - Stop Connecting to device
358042ff5ba1SMatthias Ringwald  * @param address_typ
358142ff5ba1SMatthias Ringwald  * @param address
358242ff5ba1SMatthias Ringwald  * @returns 0 if ok
358342ff5ba1SMatthias Ringwald  */
358442ff5ba1SMatthias Ringwald int gap_auto_connection_stop(bd_addr_type_t address_type, bd_addr_t address){
358542ff5ba1SMatthias Ringwald     hci_remove_from_whitelist(address_type, address);
3586e83201bcSMatthias Ringwald     hci_run();
3587e83201bcSMatthias Ringwald     return 0;
3588ac9c45e0SMatthias Ringwald }
3589ac9c45e0SMatthias Ringwald 
3590ac9c45e0SMatthias Ringwald /**
3591ac9c45e0SMatthias Ringwald  * @brief Auto Connection Establishment - Stop everything
3592ac9c45e0SMatthias Ringwald  * @note  Convenience function to stop all active auto connection attempts
3593ac9c45e0SMatthias Ringwald  */
3594ac9c45e0SMatthias Ringwald void gap_auto_connection_stop_all(void){
3595665d90f2SMatthias Ringwald     btstack_linked_list_iterator_t it;
3596665d90f2SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->le_whitelist);
3597665d90f2SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
3598665d90f2SMatthias Ringwald         whitelist_entry_t * entry = (whitelist_entry_t*) btstack_linked_list_iterator_next(&it);
3599e83201bcSMatthias Ringwald         if (entry->state & LE_WHITELIST_ON_CONTROLLER){
3600e83201bcSMatthias Ringwald             // remove from controller if already present
3601e83201bcSMatthias Ringwald             entry->state |= LE_WHITELIST_REMOVE_FROM_CONTROLLER;
3602e83201bcSMatthias Ringwald             continue;
3603e83201bcSMatthias Ringwald         }
360491915b0bSMatthias Ringwald         // directly remove entry from whitelist
3605665d90f2SMatthias Ringwald         btstack_linked_list_iterator_remove(&it);
3606e83201bcSMatthias Ringwald         btstack_memory_whitelist_entry_free(entry);
3607e83201bcSMatthias Ringwald     }
3608e83201bcSMatthias Ringwald     hci_run();
3609ac9c45e0SMatthias Ringwald }
3610ac9c45e0SMatthias Ringwald 
36114f551432SMatthias Ringwald #endif
36124f551432SMatthias Ringwald 
3613ac9c45e0SMatthias Ringwald /**
3614ff00ed1cSMatthias Ringwald  * @brief Set Extended Inquiry Response data
3615ff00ed1cSMatthias Ringwald  * @param eir_data size 240 bytes, is not copied make sure memory is accessible during stack startup
3616ff00ed1cSMatthias Ringwald  * @note has to be done before stack starts up
3617ff00ed1cSMatthias Ringwald  */
3618ff00ed1cSMatthias Ringwald void gap_set_extended_inquiry_response(const uint8_t * data){
3619ff00ed1cSMatthias Ringwald     hci_stack->eir_data = data;
3620ff00ed1cSMatthias Ringwald }
3621ff00ed1cSMatthias Ringwald 
3622ff00ed1cSMatthias Ringwald /**
3623f6858d14SMatthias Ringwald  * @brief Set inquiry mode: standard, with RSSI, with RSSI + Extended Inquiry Results. Has to be called before power on.
3624f6858d14SMatthias Ringwald  * @param inquriy_mode see bluetooth_defines.h
3625f6858d14SMatthias Ringwald  */
3626f6858d14SMatthias Ringwald void hci_set_inquiry_mode(inquiry_mode_t mode){
3627f6858d14SMatthias Ringwald     hci_stack->inquiry_mode = mode;
3628f6858d14SMatthias Ringwald }
3629f6858d14SMatthias Ringwald 
3630f6858d14SMatthias Ringwald /**
3631d950d659SMatthias Ringwald  * @brief Configure Voice Setting for use with SCO data in HSP/HFP
3632d950d659SMatthias Ringwald  */
3633d950d659SMatthias Ringwald void hci_set_sco_voice_setting(uint16_t voice_setting){
3634d950d659SMatthias Ringwald     hci_stack->sco_voice_setting = voice_setting;
3635d950d659SMatthias Ringwald }
3636d950d659SMatthias Ringwald 
3637d950d659SMatthias Ringwald /**
3638d950d659SMatthias Ringwald  * @brief Get SCO Voice Setting
3639d950d659SMatthias Ringwald  * @return current voice setting
3640d950d659SMatthias Ringwald  */
36410cb5b971SMatthias Ringwald uint16_t hci_get_sco_voice_setting(void){
3642d950d659SMatthias Ringwald     return hci_stack->sco_voice_setting;
3643d950d659SMatthias Ringwald }
3644d950d659SMatthias Ringwald 
3645b3aad8daSMatthias Ringwald /** @brief Get SCO packet length for current SCO Voice setting
3646b3aad8daSMatthias Ringwald  *  @note  Using SCO packets of the exact length is required for USB transfer
3647b3aad8daSMatthias Ringwald  *  @return Length of SCO packets in bytes (not audio frames)
3648b3aad8daSMatthias Ringwald  */
3649b3aad8daSMatthias Ringwald int hci_get_sco_packet_length(void){
3650b3aad8daSMatthias Ringwald     // see Core Spec for H2 USB Transfer.
3651b3aad8daSMatthias Ringwald     if (hci_stack->sco_voice_setting & 0x0020) return 51;
3652b3aad8daSMatthias Ringwald     return 27;
3653b3aad8daSMatthias Ringwald }
3654b3aad8daSMatthias Ringwald 
3655d950d659SMatthias Ringwald /**
3656d23838ecSMatthias Ringwald  * @brief Set callback for Bluetooth Hardware Error
3657d23838ecSMatthias Ringwald  */
3658c2e1fa60SMatthias Ringwald void hci_set_hardware_error_callback(void (*fn)(uint8_t error)){
3659d23838ecSMatthias Ringwald     hci_stack->hardware_error_callback = fn;
3660d23838ecSMatthias Ringwald }
3661d23838ecSMatthias Ringwald 
3662a6ddbcb9SMatthias Ringwald /**
3663a6ddbcb9SMatthias Ringwald  * @brief Set callback for local information from Bluetooth controller right after HCI Reset
3664a6ddbcb9SMatthias Ringwald  * @note Can be used to select chipset driver dynamically during startup
3665a6ddbcb9SMatthias Ringwald  */
3666a6ddbcb9SMatthias Ringwald void hci_set_local_version_information_callback(void (*fn)(uint8_t * local_version_information)){
3667a6ddbcb9SMatthias Ringwald     hci_stack->local_version_information_callback = fn;
3668a6ddbcb9SMatthias Ringwald }
3669a6ddbcb9SMatthias Ringwald 
367071de195eSMatthias Ringwald void hci_disconnect_all(void){
3671665d90f2SMatthias Ringwald     btstack_linked_list_iterator_t it;
3672665d90f2SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->connections);
3673665d90f2SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
3674665d90f2SMatthias Ringwald         hci_connection_t * con = (hci_connection_t*) btstack_linked_list_iterator_next(&it);
367504a6ef8cSmatthias.ringwald         if (con->state == SENT_DISCONNECT) continue;
367604a6ef8cSmatthias.ringwald         con->state = SEND_DISCONNECT;
367704a6ef8cSmatthias.ringwald     }
3678d31fba26S[email protected]     hci_run();
367904a6ef8cSmatthias.ringwald }
3680