xref: /btstack/src/hci.c (revision 4dbe0476f2747f7334f34bae9fdeb5c33940f1cd)
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
232fca4dadSMilanka Ringwald  * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL BLUEKITCHEN
242fca4dadSMilanka Ringwald  * GMBH OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
251713bceaSmatthias.ringwald  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
261713bceaSmatthias.ringwald  * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
271713bceaSmatthias.ringwald  * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
281713bceaSmatthias.ringwald  * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
291713bceaSmatthias.ringwald  * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF
301713bceaSmatthias.ringwald  * THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
311713bceaSmatthias.ringwald  * SUCH DAMAGE.
321713bceaSmatthias.ringwald  *
33a0c35809S[email protected]  * Please inquire about commercial licensing options at
34a0c35809S[email protected]  * [email protected]
356b64433eSmatthias.ringwald  *
361713bceaSmatthias.ringwald  */
371713bceaSmatthias.ringwald 
38e501bae0SMatthias Ringwald #define BTSTACK_FILE__ "hci.c"
39ab2c6ae4SMatthias Ringwald 
401713bceaSmatthias.ringwald /*
411f504dbdSmatthias.ringwald  *  hci.c
421f504dbdSmatthias.ringwald  *
431f504dbdSmatthias.ringwald  *  Created by Matthias Ringwald on 4/29/09.
441f504dbdSmatthias.ringwald  *
451f504dbdSmatthias.ringwald  */
461f504dbdSmatthias.ringwald 
477907f069SMatthias Ringwald #include "btstack_config.h"
4828171530Smatthias.ringwald 
497f2435e6Smatthias.ringwald 
5006b9e820SMatthias Ringwald #ifdef ENABLE_CLASSIC
51aec7654dSMatthias Ringwald #ifdef HAVE_EMBEDDED_TICK
528f2a52f4SMatthias Ringwald #include "btstack_run_loop_embedded.h"
53a484130cSMatthias Ringwald #endif
5406b9e820SMatthias Ringwald #endif
55a484130cSMatthias Ringwald 
56a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE
57472a5742SMatthias Ringwald #include "gap.h"
5821debf25SMatthias Ringwald #include "ble/le_device_db.h"
5945c102fdSMatthias Ringwald #endif
6045c102fdSMatthias Ringwald 
6193b8dc03Smatthias.ringwald #include <stdarg.h>
6293b8dc03Smatthias.ringwald #include <string.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"
6961f37892SMatthias Ringwald #include "bluetooth_company_id.h"
701cfb383eSMatthias Ringwald #include "bluetooth_data_types.h"
714a3574a1SMatthias Ringwald #include "gap.h"
724a3574a1SMatthias Ringwald #include "hci.h"
734a3574a1SMatthias Ringwald #include "hci_cmd.h"
74d8905019Smatthias.ringwald #include "hci_dump.h"
751cfb383eSMatthias Ringwald #include "ad_parser.h"
7693b8dc03Smatthias.ringwald 
778ad9cf99SMatthias Ringwald #ifdef ENABLE_CONTROLLER_DUMP_PACKETS
788ad9cf99SMatthias Ringwald #include <stdio.h>  // sprintf
798ad9cf99SMatthias Ringwald #endif
808ad9cf99SMatthias Ringwald 
812b838201SMatthias Ringwald #ifdef ENABLE_HCI_CONTROLLER_TO_HOST_FLOW_CONTROL
822b838201SMatthias Ringwald #ifndef HCI_HOST_ACL_PACKET_NUM
832b838201SMatthias Ringwald #error "ENABLE_HCI_CONTROLLER_TO_HOST_FLOW_CONTROL requires to define HCI_HOST_ACL_PACKET_NUM"
842b838201SMatthias Ringwald #endif
852b838201SMatthias Ringwald #ifndef HCI_HOST_ACL_PACKET_LEN
862b838201SMatthias Ringwald #error "ENABLE_HCI_CONTROLLER_TO_HOST_FLOW_CONTROL requires to define HCI_HOST_ACL_PACKET_LEN"
872b838201SMatthias Ringwald #endif
882b838201SMatthias Ringwald #ifndef HCI_HOST_SCO_PACKET_NUM
892b838201SMatthias Ringwald #error "ENABLE_HCI_CONTROLLER_TO_HOST_FLOW_CONTROL requires to define HCI_HOST_SCO_PACKET_NUM"
902b838201SMatthias Ringwald #endif
912b838201SMatthias Ringwald #ifndef HCI_HOST_SCO_PACKET_LEN
922b838201SMatthias Ringwald #error "ENABLE_HCI_CONTROLLER_TO_HOST_FLOW_CONTROL requires to define HCI_HOST_SCO_PACKET_LEN"
932b838201SMatthias Ringwald #endif
942b838201SMatthias Ringwald #endif
951b0e3922Smatthias.ringwald 
96616cfd90SMatthias Ringwald #ifndef MAX_NR_CONTROLLER_ACL_BUFFERS
97616cfd90SMatthias Ringwald #define MAX_NR_CONTROLLER_ACL_BUFFERS 255
98616cfd90SMatthias Ringwald #endif
99616cfd90SMatthias Ringwald #ifndef MAX_NR_CONTROLLER_SCO_PACKETS
100616cfd90SMatthias Ringwald #define MAX_NR_CONTROLLER_SCO_PACKETS 255
101616cfd90SMatthias Ringwald #endif
102616cfd90SMatthias Ringwald 
1036bcf18c2SMatthias Ringwald #ifndef HCI_ACL_CHUNK_SIZE_ALIGNMENT
1046bcf18c2SMatthias Ringwald #define HCI_ACL_CHUNK_SIZE_ALIGNMENT 1
1056bcf18c2SMatthias Ringwald #endif
1066bcf18c2SMatthias Ringwald 
107aa81e641SMatthias Ringwald #if defined(ENABLE_SCO_OVER_HCI) && defined(ENABLE_SCO_OVER_PCM)
108aa81e641SMatthias Ringwald #error "SCO data can either be routed over HCI or over PCM, but not over both. Please only enable ENABLE_SCO_OVER_HCI or ENABLE_SCO_OVER_PCM."
109aa81e641SMatthias Ringwald #endif
110aa81e641SMatthias Ringwald 
1111e20a53eSMatthias Ringwald #if defined(ENABLE_SCO_OVER_HCI) && defined(HAVE_SCO_TRANSPORT)
1121e20a53eSMatthias Ringwald #error "SCO data can either be routed over HCI or over PCM, but not over both. Please only enable ENABLE_SCO_OVER_HCI or HAVE_SCO_TRANSPORT."
1131e20a53eSMatthias Ringwald #endif
1141e20a53eSMatthias Ringwald 
115169f8b28Smatthias.ringwald #define HCI_CONNECTION_TIMEOUT_MS 10000
11662473419SMatthias Ringwald 
11762473419SMatthias Ringwald #ifndef HCI_RESET_RESEND_TIMEOUT_MS
118659d758cSMatthias Ringwald #define HCI_RESET_RESEND_TIMEOUT_MS 200
11962473419SMatthias Ringwald #endif
120ee091cf1Smatthias.ringwald 
1211cfb383eSMatthias Ringwald // Names are arbitrarily shortened to 32 bytes if not requested otherwise
1221cfb383eSMatthias Ringwald #ifndef GAP_INQUIRY_MAX_NAME_LEN
1231cfb383eSMatthias Ringwald #define GAP_INQUIRY_MAX_NAME_LEN 32
1241cfb383eSMatthias Ringwald #endif
1251cfb383eSMatthias Ringwald 
126f5875de5SMatthias Ringwald // GAP inquiry state: 0 = off, 0x01 - 0x30 = requested duration, 0xfe = active, 0xff = stop requested
127f5875de5SMatthias Ringwald #define GAP_INQUIRY_DURATION_MIN       0x01
128f5875de5SMatthias Ringwald #define GAP_INQUIRY_DURATION_MAX       0x30
12930199e24SMatthias Ringwald #define GAP_INQUIRY_MIN_PERIODIC_LEN_MIN 0x02
13030199e24SMatthias Ringwald #define GAP_INQUIRY_MAX_PERIODIC_LEN_MIN 0x03
131beb3c81dSMatthias Ringwald #define GAP_INQUIRY_STATE_IDLE         0x00
132beb3c81dSMatthias Ringwald #define GAP_INQUIRY_STATE_W4_ACTIVE    0x80
133beb3c81dSMatthias Ringwald #define GAP_INQUIRY_STATE_ACTIVE       0x81
134beb3c81dSMatthias Ringwald #define GAP_INQUIRY_STATE_W2_CANCEL    0x82
135beb3c81dSMatthias Ringwald #define GAP_INQUIRY_STATE_W4_CANCELLED 0x83
13630199e24SMatthias Ringwald #define GAP_INQUIRY_STATE_PERIODIC     0x84
13730199e24SMatthias Ringwald #define GAP_INQUIRY_STATE_W2_EXIT_PERIODIC 0x85
138f5875de5SMatthias Ringwald 
139b7f1ee76SMatthias Ringwald // GAP Remote Name Request
140b7f1ee76SMatthias Ringwald #define GAP_REMOTE_NAME_STATE_IDLE 0
141b7f1ee76SMatthias Ringwald #define GAP_REMOTE_NAME_STATE_W2_SEND 1
142b7f1ee76SMatthias Ringwald #define GAP_REMOTE_NAME_STATE_W4_COMPLETE 2
143b7f1ee76SMatthias Ringwald 
1440a51f88bSMatthias Ringwald // GAP Pairing
1450a51f88bSMatthias Ringwald #define GAP_PAIRING_STATE_IDLE                       0
1460a51f88bSMatthias Ringwald #define GAP_PAIRING_STATE_SEND_PIN                   1
1470a51f88bSMatthias Ringwald #define GAP_PAIRING_STATE_SEND_PIN_NEGATIVE          2
1480a51f88bSMatthias Ringwald #define GAP_PAIRING_STATE_SEND_PASSKEY               3
1490a51f88bSMatthias Ringwald #define GAP_PAIRING_STATE_SEND_PASSKEY_NEGATIVE      4
1500a51f88bSMatthias Ringwald #define GAP_PAIRING_STATE_SEND_CONFIRMATION          5
1510a51f88bSMatthias Ringwald #define GAP_PAIRING_STATE_SEND_CONFIRMATION_NEGATIVE 6
152cc15bb2cSMatthias Ringwald #define GAP_PAIRING_STATE_WAIT_FOR_COMMAND_COMPLETE  7
1530a51f88bSMatthias Ringwald 
15425e46151SMatthias Ringwald //
1559ce37759SMatthias Ringwald // compact storage of relevant supported HCI Commands.
1569ce37759SMatthias Ringwald // X-Macro below provides enumeration and mapping table into the supported
15725e46151SMatthias Ringwald // commands bitmap (64 bytes) from HCI Read Local Supported Commands
15825e46151SMatthias Ringwald //
15925e46151SMatthias Ringwald 
16025e46151SMatthias Ringwald // format: command name, byte offset, bit nr in 64-byte supported commands
1618c021356SMatthias Ringwald // currently stored in 32-bit variable
16225e46151SMatthias Ringwald #define SUPPORTED_HCI_COMMANDS \
1639ce37759SMatthias Ringwald     X( SUPPORTED_HCI_COMMAND_READ_REMOTE_EXTENDED_FEATURES         ,  2, 5) \
16425e46151SMatthias Ringwald     X( SUPPORTED_HCI_COMMAND_WRITE_SYNCHRONOUS_FLOW_CONTROL_ENABLE , 10, 4) \
1659ce37759SMatthias Ringwald     X( SUPPORTED_HCI_COMMAND_READ_BUFFER_SIZE                      , 14, 7) \
16625e46151SMatthias Ringwald     X( SUPPORTED_HCI_COMMAND_WRITE_DEFAULT_ERRONEOUS_DATA_REPORTING, 18, 3) \
1679ce37759SMatthias Ringwald     X( SUPPORTED_HCI_COMMAND_READ_ENCRYPTION_KEY_SIZE              , 20, 4) \
168ff7d1758SMatthias Ringwald     X( SUPPORTED_HCI_COMMAND_SET_EVENT_MASK_PAGE_2                 , 22, 2) \
1699ce37759SMatthias Ringwald     X( SUPPORTED_HCI_COMMAND_WRITE_LE_HOST_SUPPORTED               , 24, 6) \
1704639b1e4SMatthias Ringwald     X( SUPPORTED_HCI_COMMAND_LE_READ_REMOTE_FEATURES               , 27, 5) \
1719ce37759SMatthias Ringwald     X( SUPPORTED_HCI_COMMAND_REMOTE_OOB_EXTENDED_DATA_REQUEST_REPLY, 32, 1) \
1729ce37759SMatthias Ringwald     X( SUPPORTED_HCI_COMMAND_WRITE_SECURE_CONNECTIONS_HOST         , 32, 3) \
1739ce37759SMatthias Ringwald     X( SUPPORTED_HCI_COMMAND_READ_LOCAL_OOB_EXTENDED_DATA_COMMAND  , 32, 6) \
17425e46151SMatthias Ringwald     X( SUPPORTED_HCI_COMMAND_LE_WRITE_SUGGESTED_DEFAULT_DATA_LENGTH, 34, 0) \
17525e46151SMatthias Ringwald     X( SUPPORTED_HCI_COMMAND_LE_SET_ADDRESS_RESOLUTION_ENABLE      , 35, 1) \
176a391128dSMatthias Ringwald     X( SUPPORTED_HCI_COMMAND_LE_READ_MAXIMUM_DATA_LENGTH           , 35, 3) \
1779ce37759SMatthias Ringwald     X( SUPPORTED_HCI_COMMAND_LE_SET_DEFAULT_PHY                    , 35, 5) \
17863671e69SMatthias Ringwald     X( SUPPORTED_HCI_COMMAND_LE_SET_EXTENDED_ADVERTISING_ENABLE    , 36, 6) \
17979b7ea2dSMatthias Ringwald     X( SUPPORTED_HCI_COMMAND_LE_READ_BUFFER_SIZE_V2                , 41, 5) \
180a391128dSMatthias Ringwald     X( SUPPORTED_HCI_COMMAND_SET_MIN_ENCRYPTION_KEY_SIZE           , 45, 7) \
18125e46151SMatthias Ringwald 
18225e46151SMatthias Ringwald // enumerate supported commands
18325e46151SMatthias Ringwald #define X(name, offset, bit) name,
18425e46151SMatthias Ringwald enum {
18525e46151SMatthias Ringwald     SUPPORTED_HCI_COMMANDS
18625e46151SMatthias Ringwald     SUPPORTED_HCI_COMMANDS_COUNT
18725e46151SMatthias Ringwald };
18825e46151SMatthias Ringwald #undef X
18925e46151SMatthias Ringwald 
190b83d5eabSMatthias Ringwald // prototypes
19135454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
192758b46ceSmatthias.ringwald static void hci_update_scan_enable(void);
19371fd255dSMatthias Ringwald static void hci_emit_scan_mode_changed(uint8_t discoverable, uint8_t connectable);
19435454696SMatthias Ringwald static int  hci_local_ssp_activated(void);
19520dcdd22SMatthias Ringwald static bool hci_remote_ssp_supported(hci_con_handle_t con_handle);
19667aae551SMatthias Ringwald static bool hci_ssp_supported(hci_connection_t * connection);
19735454696SMatthias Ringwald static void hci_notify_if_sco_can_send_now(void);
19835454696SMatthias Ringwald static void hci_emit_connection_complete(bd_addr_t address, hci_con_handle_t con_handle, uint8_t status);
199a00031e2S[email protected] static gap_security_level_t gap_security_level_for_connection(hci_connection_t * connection);
20035454696SMatthias Ringwald static void hci_emit_security_level(hci_con_handle_t con_handle, gap_security_level_t level);
201ec820d77SMatthias Ringwald static void hci_connection_timeout_handler(btstack_timer_source_t *timer);
20296a45072S[email protected] static void hci_connection_timestamp(hci_connection_t *connection);
20352db98b2SMatthias Ringwald static void hci_emit_l2cap_check_timeout(hci_connection_t *conn);
2049784dac1SMatthias Ringwald static void gap_inquiry_explode(uint8_t *packet, uint16_t size);
20552db98b2SMatthias Ringwald #endif
2061cfb383eSMatthias Ringwald 
2077586ee35S[email protected] static int  hci_power_control_on(void);
2087586ee35S[email protected] static void hci_power_control_off(void);
2096da48142SSean Wilson static void hci_state_reset(void);
210685ec254SMatthias Ringwald static void hci_halting_timeout_handler(btstack_timer_source_t * ds);
211fd43c0e0SMatthias Ringwald static void hci_emit_transport_packet_sent(void);
212fc64f94aSMatthias Ringwald static void hci_emit_disconnection_complete(hci_con_handle_t con_handle, uint8_t reason);
213b83d5eabSMatthias Ringwald static void hci_emit_nr_connections_changed(void);
214b83d5eabSMatthias Ringwald static void hci_emit_hci_open_failed(void);
215b83d5eabSMatthias Ringwald static void hci_emit_dedicated_bonding_result(bd_addr_t address, uint8_t status);
216b83d5eabSMatthias Ringwald static void hci_emit_event(uint8_t * event, uint16_t size, int dump);
217b83d5eabSMatthias Ringwald static void hci_emit_acl_packet(uint8_t * packet, uint16_t size);
21895d71764SMatthias Ringwald static void hci_run(void);
219617c03d6SMatthias Ringwald static bool hci_is_le_connection(hci_connection_t * connection);
220ed208344SMatthias Ringwald static uint8_t hci_send_prepared_cmd_packet(void);
2216a5ffed8SMatthias Ringwald 
2226a5ffed8SMatthias Ringwald #ifdef ENABLE_CLASSIC
223f234b250SMatthias Ringwald static int hci_have_usb_transport(void);
224dbe0d85cSMatthias Ringwald static void hci_trigger_remote_features_for_connection(hci_connection_t * connection);
2256a5ffed8SMatthias Ringwald #endif
2265d509858SMatthias Ringwald 
227a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE
228137a570aSMatthias Ringwald static bool hci_run_general_gap_le(void);
229137a570aSMatthias Ringwald static void gap_privacy_clients_handle_ready(void);
230137a570aSMatthias Ringwald static void gap_privacy_clients_notify(bd_addr_t new_random_address);
231e8c8828eSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
23239677e66SMatthias Ringwald // called from test/ble_client/advertising_data_parser.c
233384b59deSMatthias Ringwald void le_handle_advertisement_report(uint8_t *packet, uint16_t size);
234667ba9d1SMatthias Ringwald static uint8_t hci_whitelist_remove(bd_addr_type_t address_type, const bd_addr_t address);
235ca0d6e5aSMatthias Ringwald static hci_connection_t * gap_get_outgoing_le_connection(void);
236c42da3bcSMatthias Ringwald static void hci_le_scan_stop(void);
2375d509858SMatthias Ringwald #endif
23825df6c61SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
239ee54aff5SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
24025df6c61SMatthias Ringwald static le_advertising_set_t * hci_advertising_set_for_handle(uint8_t advertising_handle);
241033393eeSBob Abeles static uint8_t hci_le_extended_advertising_operation_for_chunk(uint16_t pos, uint16_t len);
242033393eeSBob Abeles static void le_handle_extended_advertisement_report(uint8_t *packet, uint16_t size);
243ee54aff5SMatthias Ringwald #endif /* ENABLE_LE_EXTENDED_ADVERTISING */
244ee54aff5SMatthias Ringwald #endif /* ENABLE_LE_PERIPHERAL */
2454ae8623eSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
246969d876aSMatthias Ringwald static hci_iso_stream_t * hci_iso_stream_create(hci_iso_type_t iso_type, hci_iso_stream_state_t state, uint8_t group_id, uint8_t stream_id);
2474ae8623eSMatthias Ringwald static void hci_iso_stream_finalize(hci_iso_stream_t * iso_stream);
248778463d0SMatthias Ringwald static void hci_iso_stream_finalize_by_type_and_group_id(hci_iso_type_t iso_type, uint8_t group_id);
24915a15be3SMatthias Ringwald static hci_iso_stream_t * hci_iso_stream_for_con_handle(hci_con_handle_t con_handle);
25015a15be3SMatthias Ringwald static void hci_iso_stream_requested_finalize(uint8_t big_handle);
25115a15be3SMatthias Ringwald static void hci_iso_stream_requested_confirm(uint8_t big_handle);
252750818acSMatthias Ringwald static void hci_iso_packet_handler(hci_iso_stream_t *iso_stream, uint8_t *packet, uint16_t size);
2537aa35f6aSMatthias Ringwald static le_audio_big_t * hci_big_for_handle(uint8_t big_handle);
254d3a89d91SMatthias Ringwald static le_audio_cig_t * hci_cig_for_id(uint8_t cig_id);
2555ade6657SMatthias Ringwald static void hci_iso_notify_can_send_now(void);
2567aa35f6aSMatthias Ringwald static void hci_emit_big_created(const le_audio_big_t * big, uint8_t status);
2577aa35f6aSMatthias Ringwald static void hci_emit_big_terminated(const le_audio_big_t * big);
2582a6c0f82SMatthias Ringwald static void hci_emit_big_sync_created(const le_audio_big_sync_t * big_sync, uint8_t status);
259d04a9afcSMatthias Ringwald static void hci_emit_big_sync_stopped(uint8_t big_handle);
260d3a89d91SMatthias Ringwald static void hci_emit_cig_created(const le_audio_cig_t * cig, uint8_t status);
26114045fdbSMatthias Ringwald static void hci_cis_handle_created(hci_iso_stream_t * iso_stream, uint8_t status);
2622a6c0f82SMatthias Ringwald static le_audio_big_sync_t * hci_big_sync_for_handle(uint8_t big_handle);
2634ae8623eSMatthias Ringwald #endif /* ENABLE_LE_ISOCHRONOUS_STREAMS */
264ee54aff5SMatthias Ringwald #endif /* ENABLE_BLE */
265758b46ceSmatthias.ringwald 
26606b35ec0Smatthias.ringwald // the STACK is here
2673a9fb326S[email protected] #ifndef HAVE_MALLOC
2683a9fb326S[email protected] static hci_stack_t   hci_stack_static;
2693a9fb326S[email protected] #endif
2703a9fb326S[email protected] static hci_stack_t * hci_stack = NULL;
27116833f0aSmatthias.ringwald 
2721c9e5e9dSMatthias Ringwald #ifdef ENABLE_CLASSIC
27363168530SMatthias Ringwald // default name
27463168530SMatthias Ringwald static const char * default_classic_name = "BTstack 00:00:00:00:00:00";
27563168530SMatthias Ringwald 
27666fb9560S[email protected] // test helper
27766fb9560S[email protected] static uint8_t disable_l2cap_timeouts = 0;
2781c9e5e9dSMatthias Ringwald #endif
27966fb9560S[email protected] 
280aee5d5c1SMatthias Ringwald // reset connection state on create and on reconnect
281aee5d5c1SMatthias Ringwald // don't overwrite addr, con handle, role
282aee5d5c1SMatthias Ringwald static void hci_connection_init(hci_connection_t * conn){
2838daf94bcSMatthias Ringwald     conn->authentication_flags = AUTH_FLAG_NONE;
28496a45072S[email protected]     conn->bonding_flags = 0;
28596a45072S[email protected]     conn->requested_security_level = LEVEL_0;
2868ce18681SMatthias Ringwald     conn->link_key_type = INVALID_LINK_KEY;
28752db98b2SMatthias Ringwald #ifdef ENABLE_CLASSIC
28888a03c8dSMatthias Ringwald     conn->request_role = HCI_ROLE_INVALID;
289140c0557SMatthias Ringwald     conn->sniff_subrating_max_latency = 0xffff;
290965a4ccfSMatthias Ringwald     conn->qos_service_type = HCI_SERVICE_TYPE_INVALID;
29191a977e8SMatthias Ringwald     btstack_run_loop_set_timer_handler(&conn->timeout, hci_connection_timeout_handler);
29291a977e8SMatthias Ringwald     btstack_run_loop_set_timer_context(&conn->timeout, conn);
29396a45072S[email protected]     hci_connection_timestamp(conn);
29452db98b2SMatthias Ringwald #endif
29596a45072S[email protected]     conn->acl_recombination_length = 0;
29696a45072S[email protected]     conn->acl_recombination_pos = 0;
297ce41473eSMatthias Ringwald     conn->num_packets_sent = 0;
298760b20efSMatthias Ringwald 
299da886c03S[email protected]     conn->le_con_parameter_update_state = CON_PARAMETER_UPDATE_NONE;
300b90f6e0aSMatthias Ringwald #ifdef ENABLE_BLE
301b90f6e0aSMatthias Ringwald     conn->le_phy_update_all_phys = 0xff;
302b90f6e0aSMatthias Ringwald #endif
3030f3b27c5SMatthias Ringwald #ifdef ENABLE_LE_LIMIT_ACL_FRAGMENT_BY_MAX_OCTETS
3040f3b27c5SMatthias Ringwald     conn->le_max_tx_octets = 27;
3050f3b27c5SMatthias Ringwald #endif
306cb439cf1SMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB
307cb439cf1SMatthias Ringwald     conn->classic_oob_c_192 = NULL;
308cb439cf1SMatthias Ringwald     conn->classic_oob_r_192 = NULL;
309cb439cf1SMatthias Ringwald     conn->classic_oob_c_256 = NULL;
310cb439cf1SMatthias Ringwald     conn->classic_oob_r_256 = NULL;
311cb439cf1SMatthias Ringwald #endif
3124dcab8b6SMatthias Ringwald #ifdef ENABLE_LE_PERIODIC_ADVERTISING
3134dcab8b6SMatthias Ringwald     conn->le_past_sync_handle = HCI_CON_HANDLE_INVALID;
3144dcab8b6SMatthias Ringwald     conn->le_past_advertising_handle = 0xff;
3154dcab8b6SMatthias Ringwald #endif
316aee5d5c1SMatthias Ringwald }
317aee5d5c1SMatthias Ringwald 
318aee5d5c1SMatthias Ringwald /**
319aee5d5c1SMatthias Ringwald  * create connection for given address
320aee5d5c1SMatthias Ringwald  *
321aee5d5c1SMatthias Ringwald  * @return connection OR NULL, if no memory left
322aee5d5c1SMatthias Ringwald  */
32388f925b1SMatthias Ringwald static hci_connection_t *
32488f925b1SMatthias Ringwald create_connection_for_bd_addr_and_type(const bd_addr_t addr, bd_addr_type_t addr_type, hci_role_t role) {
325aee5d5c1SMatthias Ringwald     log_info("create_connection_for_addr %s, type %x", bd_addr_to_str(addr), addr_type);
326aee5d5c1SMatthias Ringwald 
327aee5d5c1SMatthias Ringwald     hci_connection_t * conn = btstack_memory_hci_connection_get();
328aee5d5c1SMatthias Ringwald     if (!conn) return NULL;
329aee5d5c1SMatthias Ringwald     hci_connection_init(conn);
330aee5d5c1SMatthias Ringwald 
331aee5d5c1SMatthias Ringwald     bd_addr_copy(conn->address, addr);
332aee5d5c1SMatthias Ringwald     conn->address_type = addr_type;
333aee5d5c1SMatthias Ringwald     conn->con_handle = HCI_CON_HANDLE_INVALID;
33488f925b1SMatthias Ringwald     conn->role = role;
335665d90f2SMatthias Ringwald     btstack_linked_list_add(&hci_stack->connections, (btstack_linked_item_t *) conn);
336aee5d5c1SMatthias Ringwald 
33796a45072S[email protected]     return conn;
33896a45072S[email protected] }
33966fb9560S[email protected] 
340da886c03S[email protected] 
341da886c03S[email protected] /**
342da886c03S[email protected]  * get le connection parameter range
343da886c03S[email protected] *
344da886c03S[email protected]  * @return le connection parameter range struct
345da886c03S[email protected]  */
3464ced4e8cSMatthias Ringwald void gap_get_connection_parameter_range(le_connection_parameter_range_t * range){
3474ced4e8cSMatthias Ringwald     *range = hci_stack->le_connection_parameter_range;
348da886c03S[email protected] }
349da886c03S[email protected] 
350da886c03S[email protected] /**
351da886c03S[email protected]  * set le connection parameter range
352da886c03S[email protected]  *
353da886c03S[email protected]  */
354da886c03S[email protected] 
3554ced4e8cSMatthias Ringwald void gap_set_connection_parameter_range(le_connection_parameter_range_t *range){
3564ced4e8cSMatthias Ringwald     hci_stack->le_connection_parameter_range = *range;
357da886c03S[email protected] }
358da886c03S[email protected] 
359da886c03S[email protected] /**
36073cd8a2aSMatthias Ringwald  * @brief Test if connection parameters are inside in existing rage
36173cd8a2aSMatthias Ringwald  * @param conn_interval_min (unit: 1.25ms)
36273cd8a2aSMatthias Ringwald  * @param conn_interval_max (unit: 1.25ms)
36373cd8a2aSMatthias Ringwald  * @param conn_latency
36473cd8a2aSMatthias Ringwald  * @param supervision_timeout (unit: 10ms)
3656b65794dSMilanka Ringwald  * @return 1 if included
36673cd8a2aSMatthias Ringwald  */
36773cd8a2aSMatthias Ringwald int gap_connection_parameter_range_included(le_connection_parameter_range_t * existing_range, uint16_t le_conn_interval_min, uint16_t le_conn_interval_max, uint16_t le_conn_latency, uint16_t le_supervision_timeout){
36873cd8a2aSMatthias Ringwald     if (le_conn_interval_min < existing_range->le_conn_interval_min) return 0;
36973cd8a2aSMatthias Ringwald     if (le_conn_interval_max > existing_range->le_conn_interval_max) return 0;
37073cd8a2aSMatthias Ringwald 
37173cd8a2aSMatthias Ringwald     if (le_conn_latency < existing_range->le_conn_latency_min) return 0;
37273cd8a2aSMatthias Ringwald     if (le_conn_latency > existing_range->le_conn_latency_max) return 0;
37373cd8a2aSMatthias Ringwald 
37473cd8a2aSMatthias Ringwald     if (le_supervision_timeout < existing_range->le_supervision_timeout_min) return 0;
37573cd8a2aSMatthias Ringwald     if (le_supervision_timeout > existing_range->le_supervision_timeout_max) return 0;
37673cd8a2aSMatthias Ringwald 
37773cd8a2aSMatthias Ringwald     return 1;
37873cd8a2aSMatthias Ringwald }
37973cd8a2aSMatthias Ringwald 
38073cd8a2aSMatthias Ringwald /**
3812b6ab3e6SMatthias Ringwald  * @brief Set max number of connections in LE Peripheral role (if Bluetooth Controller supports it)
3822b6ab3e6SMatthias Ringwald  * @note: default: 1
3832b6ab3e6SMatthias Ringwald  * @param max_peripheral_connections
3842b6ab3e6SMatthias Ringwald  */
385d4e4907bSMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
3862b6ab3e6SMatthias Ringwald void gap_set_max_number_peripheral_connections(int max_peripheral_connections){
3872b6ab3e6SMatthias Ringwald     hci_stack->le_max_number_peripheral_connections = max_peripheral_connections;
3882b6ab3e6SMatthias Ringwald }
389d4e4907bSMatthias Ringwald #endif
3902b6ab3e6SMatthias Ringwald 
3912b6ab3e6SMatthias Ringwald /**
392da886c03S[email protected]  * get hci connections iterator
393da886c03S[email protected]  *
394da886c03S[email protected]  * @return hci connections iterator
395da886c03S[email protected]  */
396da886c03S[email protected] 
397665d90f2SMatthias Ringwald void hci_connections_get_iterator(btstack_linked_list_iterator_t *it){
398665d90f2SMatthias Ringwald     btstack_linked_list_iterator_init(it, &hci_stack->connections);
399da886c03S[email protected] }
400da886c03S[email protected] 
40197addcc5Smatthias.ringwald /**
402ee091cf1Smatthias.ringwald  * get connection for a given handle
403ee091cf1Smatthias.ringwald  *
404ee091cf1Smatthias.ringwald  * @return connection OR NULL, if not found
405ee091cf1Smatthias.ringwald  */
4065061f3afS[email protected] hci_connection_t * hci_connection_for_handle(hci_con_handle_t con_handle){
407665d90f2SMatthias Ringwald     btstack_linked_list_iterator_t it;
408665d90f2SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->connections);
409665d90f2SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
410665d90f2SMatthias Ringwald         hci_connection_t * item = (hci_connection_t *) btstack_linked_list_iterator_next(&it);
4113ac2fe56S[email protected]         if ( item->con_handle == con_handle ) {
412da886c03S[email protected]             return item;
413ee091cf1Smatthias.ringwald         }
414ee091cf1Smatthias.ringwald     }
415ee091cf1Smatthias.ringwald     return NULL;
416ee091cf1Smatthias.ringwald }
417ee091cf1Smatthias.ringwald 
41896a45072S[email protected] /**
41996a45072S[email protected]  * get connection for given address
42096a45072S[email protected]  *
42196a45072S[email protected]  * @return connection OR NULL, if not found
42296a45072S[email protected]  */
423667ba9d1SMatthias Ringwald hci_connection_t * hci_connection_for_bd_addr_and_type(const bd_addr_t  addr, bd_addr_type_t addr_type){
424665d90f2SMatthias Ringwald     btstack_linked_list_iterator_t it;
425665d90f2SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->connections);
426665d90f2SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
427665d90f2SMatthias Ringwald         hci_connection_t * connection = (hci_connection_t *) btstack_linked_list_iterator_next(&it);
42896a45072S[email protected]         if (connection->address_type != addr_type)  continue;
42996a45072S[email protected]         if (memcmp(addr, connection->address, 6) != 0) continue;
43062bda3fbS[email protected]         return connection;
43162bda3fbS[email protected]     }
43262bda3fbS[email protected]     return NULL;
43362bda3fbS[email protected] }
43462bda3fbS[email protected] 
435d5f71a7eSMatthias Ringwald #ifdef ENABLE_CLASSIC
436d5f71a7eSMatthias Ringwald 
4373e5e0926SMatthias Ringwald inline static void connectionClearAuthenticationFlags(hci_connection_t * conn, hci_authentication_flags_t flags){
4383e5e0926SMatthias Ringwald     conn->authentication_flags = (hci_authentication_flags_t)(conn->authentication_flags & ~flags);
4393e5e0926SMatthias Ringwald }
44052db98b2SMatthias Ringwald 
441228e430cSMatthias Ringwald inline static void connectionSetAuthenticationFlags(hci_connection_t * conn, hci_authentication_flags_t flags){
442228e430cSMatthias Ringwald     conn->authentication_flags = (hci_authentication_flags_t)(conn->authentication_flags | flags);
443228e430cSMatthias Ringwald }
444228e430cSMatthias Ringwald 
445ee752bb8SMatthias Ringwald #ifdef ENABLE_SCO_OVER_HCI
446ee752bb8SMatthias Ringwald static int hci_number_sco_connections(void){
447ee752bb8SMatthias Ringwald     int connections = 0;
448ee752bb8SMatthias Ringwald     btstack_linked_list_iterator_t it;
449ee752bb8SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->connections);
450ee752bb8SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
451ee752bb8SMatthias Ringwald         hci_connection_t * connection = (hci_connection_t *) btstack_linked_list_iterator_next(&it);
452ee752bb8SMatthias Ringwald         if (connection->address_type != BD_ADDR_TYPE_SCO) continue;
453ee752bb8SMatthias Ringwald         connections++;
454ee752bb8SMatthias Ringwald     }
455ee752bb8SMatthias Ringwald     return connections;
456ee752bb8SMatthias Ringwald }
457ee752bb8SMatthias Ringwald #endif
458ee752bb8SMatthias Ringwald 
459ec820d77SMatthias Ringwald static void hci_connection_timeout_handler(btstack_timer_source_t *timer){
46091a977e8SMatthias Ringwald     hci_connection_t * connection = (hci_connection_t *) btstack_run_loop_get_timer_context(timer);
461aec7654dSMatthias Ringwald #ifdef HAVE_EMBEDDED_TICK
462528a4a3bSMatthias Ringwald     if (btstack_run_loop_embedded_get_ticks() > connection->timestamp + btstack_run_loop_embedded_ticks_for_ms(HCI_CONNECTION_TIMEOUT_MS)){
463c785ef68Smatthias.ringwald         // connections might be timed out
464c785ef68Smatthias.ringwald         hci_emit_l2cap_check_timeout(connection);
465c785ef68Smatthias.ringwald     }
466f316a845SMatthias Ringwald #else
467c1ab6cc1SMatthias Ringwald     if (btstack_run_loop_get_time_ms() > (connection->timestamp + HCI_CONNECTION_TIMEOUT_MS)){
4685f26aadcSMatthias Ringwald         // connections might be timed out
4695f26aadcSMatthias Ringwald         hci_emit_l2cap_check_timeout(connection);
4705f26aadcSMatthias Ringwald     }
4715f26aadcSMatthias Ringwald #endif
472c785ef68Smatthias.ringwald }
473ee091cf1Smatthias.ringwald 
474ee091cf1Smatthias.ringwald static void hci_connection_timestamp(hci_connection_t *connection){
475aec7654dSMatthias Ringwald #ifdef HAVE_EMBEDDED_TICK
476528a4a3bSMatthias Ringwald     connection->timestamp = btstack_run_loop_embedded_get_ticks();
477f316a845SMatthias Ringwald #else
478528a4a3bSMatthias Ringwald     connection->timestamp = btstack_run_loop_get_time_ms();
4795f26aadcSMatthias Ringwald #endif
480ee091cf1Smatthias.ringwald }
481ee091cf1Smatthias.ringwald 
48243bfb1bdSmatthias.ringwald /**
48380ca58a0Smatthias.ringwald  * add authentication flags and reset timer
48496a45072S[email protected]  * @note: assumes classic connection
4852e77e513S[email protected]  * @note: bd_addr is passed in as litle endian uint8_t * as it is called from parsing packets
4867fde4af9Smatthias.ringwald  */
4877fde4af9Smatthias.ringwald static void hci_add_connection_flags_for_flipped_bd_addr(uint8_t *bd_addr, hci_authentication_flags_t flags){
4887fde4af9Smatthias.ringwald     bd_addr_t addr;
489724d70a2SMatthias Ringwald     reverse_bd_addr(bd_addr, addr);
490f16129ceSMatthias Ringwald     hci_connection_t * conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL);
4917fde4af9Smatthias.ringwald     if (conn) {
49228ca2b46S[email protected]         connectionSetAuthenticationFlags(conn, flags);
49380ca58a0Smatthias.ringwald         hci_connection_timestamp(conn);
4947fde4af9Smatthias.ringwald     }
4957fde4af9Smatthias.ringwald }
4967fde4af9Smatthias.ringwald 
4971714cbbdSMatthias Ringwald static bool hci_pairing_active(hci_connection_t * hci_connection){
4988daf94bcSMatthias Ringwald     return (hci_connection->authentication_flags & AUTH_FLAG_PAIRING_ACTIVE_MASK) != 0;
4991714cbbdSMatthias Ringwald }
5001714cbbdSMatthias Ringwald 
5011714cbbdSMatthias Ringwald static void hci_pairing_started(hci_connection_t * hci_connection, bool ssp){
5021714cbbdSMatthias Ringwald     if (hci_pairing_active(hci_connection)) return;
5031714cbbdSMatthias Ringwald     if (ssp){
5048daf94bcSMatthias Ringwald         hci_connection->authentication_flags |= AUTH_FLAG_SSP_PAIRING_ACTIVE;
5051714cbbdSMatthias Ringwald     } else {
5068daf94bcSMatthias Ringwald         hci_connection->authentication_flags |= AUTH_FLAG_LEGACY_PAIRING_ACTIVE;
5071714cbbdSMatthias Ringwald     }
5081714cbbdSMatthias Ringwald     // if we are initiator, we have sent an HCI Authenticate Request
5091714cbbdSMatthias Ringwald     bool initiator = (hci_connection->bonding_flags & BONDING_SENT_AUTHENTICATE_REQUEST) != 0;
5101714cbbdSMatthias Ringwald 
5115a561920SMatthias Ringwald     // if we are responder, use minimal service security level as required level
5125a561920SMatthias Ringwald     if (!initiator){
513acadfdd0SMatthias Ringwald         hci_connection->requested_security_level = (gap_security_level_t) btstack_max((uint32_t) hci_connection->requested_security_level, (uint32_t) hci_stack->gap_minimal_service_security_level);
5145a561920SMatthias Ringwald     }
5155a561920SMatthias Ringwald 
5165a561920SMatthias Ringwald     log_info("pairing started, ssp %u, initiator %u, requested level %u", (int) ssp, (int) initiator, hci_connection->requested_security_level);
51777208d90SMatthias Ringwald 
51877208d90SMatthias Ringwald     uint8_t event[12];
51977208d90SMatthias Ringwald     event[0] = GAP_EVENT_PAIRING_STARTED;
52077208d90SMatthias Ringwald     event[1] = 10;
521bfaf6993SMatthias Ringwald     little_endian_store_16(event, 2, (uint16_t) hci_connection->con_handle);
5224159a80bSMatthias Ringwald     reverse_bd_addr(hci_connection->address, &event[4]);
52377208d90SMatthias Ringwald     event[10] = (uint8_t) ssp;
52477208d90SMatthias Ringwald     event[11] = (uint8_t) initiator;
52577208d90SMatthias Ringwald     hci_emit_event(event, sizeof(event), 1);
5261714cbbdSMatthias Ringwald }
5271714cbbdSMatthias Ringwald 
5281714cbbdSMatthias Ringwald static void hci_pairing_complete(hci_connection_t * hci_connection, uint8_t status){
5293c439ac4SMatthias Ringwald     hci_connection->requested_security_level = LEVEL_0;
5301714cbbdSMatthias Ringwald     if (!hci_pairing_active(hci_connection)) return;
5318daf94bcSMatthias Ringwald     hci_connection->authentication_flags &= ~AUTH_FLAG_PAIRING_ACTIVE_MASK;
5321e7371deSMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB
533cb439cf1SMatthias Ringwald     hci_connection->classic_oob_c_192 = NULL;
534cb439cf1SMatthias Ringwald     hci_connection->classic_oob_r_192 = NULL;
535cb439cf1SMatthias Ringwald     hci_connection->classic_oob_c_256 = NULL;
536cb439cf1SMatthias Ringwald     hci_connection->classic_oob_r_256 = NULL;
5371e7371deSMatthias Ringwald #endif
5381714cbbdSMatthias Ringwald     log_info("pairing complete, status %02x", status);
53977208d90SMatthias Ringwald 
5403176c896SMatthias Ringwald     uint8_t event[11];
54177208d90SMatthias Ringwald     event[0] = GAP_EVENT_PAIRING_COMPLETE;
54277208d90SMatthias Ringwald     event[1] = 9;
543bfaf6993SMatthias Ringwald     little_endian_store_16(event, 2, (uint16_t) hci_connection->con_handle);
5444159a80bSMatthias Ringwald     reverse_bd_addr(hci_connection->address, &event[4]);
54577208d90SMatthias Ringwald     event[10] = status;
54677208d90SMatthias Ringwald     hci_emit_event(event, sizeof(event), 1);
5475999ee11SMatthias Ringwald 
5485999ee11SMatthias Ringwald     // emit dedicated bonding done on failure, otherwise verify that connection can be encrypted
5495999ee11SMatthias Ringwald     if ((status != ERROR_CODE_SUCCESS) && ((hci_connection->bonding_flags & BONDING_DEDICATED) != 0)){
5505999ee11SMatthias Ringwald         hci_connection->bonding_flags &= ~BONDING_DEDICATED;
5515999ee11SMatthias Ringwald         hci_connection->bonding_flags |= BONDING_DISCONNECT_DEDICATED_DONE;
5525999ee11SMatthias Ringwald         hci_connection->bonding_status = status;
5535999ee11SMatthias Ringwald     }
5541714cbbdSMatthias Ringwald }
5551714cbbdSMatthias Ringwald 
55620dcdd22SMatthias Ringwald bool hci_authentication_active_for_handle(hci_con_handle_t handle){
5575061f3afS[email protected]     hci_connection_t * conn = hci_connection_for_handle(handle);
55820dcdd22SMatthias Ringwald     if (!conn) return false;
55920dcdd22SMatthias Ringwald     return hci_pairing_active(conn);
56080ca58a0Smatthias.ringwald }
56180ca58a0Smatthias.ringwald 
56215a95bd5SMatthias Ringwald void gap_drop_link_key_for_bd_addr(bd_addr_t addr){
56355597469SMatthias Ringwald     if (!hci_stack->link_key_db) return;
5642bacf595SMatthias Ringwald     log_info("gap_drop_link_key_for_bd_addr: %s", bd_addr_to_str(addr));
565a98592bcSMatthias Ringwald     hci_stack->link_key_db->delete_link_key(addr);
566c12e46e7Smatthias.ringwald }
56755597469SMatthias Ringwald 
56855597469SMatthias Ringwald void gap_store_link_key_for_bd_addr(bd_addr_t addr, link_key_t link_key, link_key_type_t type){
56955597469SMatthias Ringwald     if (!hci_stack->link_key_db) return;
5702bacf595SMatthias Ringwald     log_info("gap_store_link_key_for_bd_addr: %s, type %u", bd_addr_to_str(addr), type);
57155597469SMatthias Ringwald     hci_stack->link_key_db->put_link_key(addr, link_key, type);
572c12e46e7Smatthias.ringwald }
5731b6fb31bSMatthias Ringwald 
574e8ad470fSMatthias Ringwald bool gap_get_link_key_for_bd_addr(bd_addr_t addr, link_key_t link_key, link_key_type_t * type){
575e8ad470fSMatthias Ringwald 	if (!hci_stack->link_key_db) return false;
57676b0318eSMatthias Ringwald 	int result = hci_stack->link_key_db->get_link_key(addr, link_key, type) != 0;
57776b0318eSMatthias Ringwald 	log_info("link key for %s available %u, type %u", bd_addr_to_str(addr), result, (int) *type);
57876b0318eSMatthias Ringwald 	return result;
579e8ad470fSMatthias Ringwald }
580e8ad470fSMatthias Ringwald 
581ceecb9d9SMatthias Ringwald void gap_delete_all_link_keys(void){
582ceecb9d9SMatthias Ringwald     bd_addr_t  addr;
583ceecb9d9SMatthias Ringwald     link_key_t link_key;
584ceecb9d9SMatthias Ringwald     link_key_type_t type;
585ceecb9d9SMatthias Ringwald     btstack_link_key_iterator_t it;
586ceecb9d9SMatthias Ringwald     int ok = gap_link_key_iterator_init(&it);
587ceecb9d9SMatthias Ringwald     if (!ok) {
588ceecb9d9SMatthias Ringwald         log_error("could not initialize iterator");
589ceecb9d9SMatthias Ringwald         return;
590ceecb9d9SMatthias Ringwald     }
591ceecb9d9SMatthias Ringwald     while (gap_link_key_iterator_get_next(&it, addr, link_key, &type)){
592ceecb9d9SMatthias Ringwald         gap_drop_link_key_for_bd_addr(addr);
593ceecb9d9SMatthias Ringwald     }
594ceecb9d9SMatthias Ringwald     gap_link_key_iterator_done(&it);
595ceecb9d9SMatthias Ringwald }
596ceecb9d9SMatthias Ringwald 
5971b6fb31bSMatthias Ringwald int gap_link_key_iterator_init(btstack_link_key_iterator_t * it){
5981b6fb31bSMatthias Ringwald     if (!hci_stack->link_key_db) return 0;
5991b6fb31bSMatthias Ringwald     if (!hci_stack->link_key_db->iterator_init) return 0;
6001b6fb31bSMatthias Ringwald     return hci_stack->link_key_db->iterator_init(it);
6011b6fb31bSMatthias Ringwald }
6021b6fb31bSMatthias Ringwald int gap_link_key_iterator_get_next(btstack_link_key_iterator_t * it, bd_addr_t bd_addr, link_key_t link_key, link_key_type_t * type){
6031b6fb31bSMatthias Ringwald     if (!hci_stack->link_key_db) return 0;
6041b6fb31bSMatthias Ringwald     return hci_stack->link_key_db->iterator_get_next(it, bd_addr, link_key, type);
6051b6fb31bSMatthias Ringwald }
6061b6fb31bSMatthias Ringwald void gap_link_key_iterator_done(btstack_link_key_iterator_t * it){
6071b6fb31bSMatthias Ringwald     if (!hci_stack->link_key_db) return;
6081b6fb31bSMatthias Ringwald     hci_stack->link_key_db->iterator_done(it);
6091b6fb31bSMatthias Ringwald }
61035454696SMatthias Ringwald #endif
611c12e46e7Smatthias.ringwald 
6128e97a820SMatthias Ringwald bool hci_is_le_connection_type(bd_addr_type_t address_type){
613eb8076ddSMatthias Ringwald     switch (address_type){
614ce41473eSMatthias Ringwald         case BD_ADDR_TYPE_LE_PUBLIC:
615ce41473eSMatthias Ringwald         case BD_ADDR_TYPE_LE_RANDOM:
6163739bc96SMatthias Ringwald         case BD_ADDR_TYPE_LE_PUBLIC_IDENTITY:
6173739bc96SMatthias Ringwald         case BD_ADDR_TYPE_LE_RANDOM_IDENTITY:
618eb8076ddSMatthias Ringwald             return true;
619ce41473eSMatthias Ringwald         default:
620eb8076ddSMatthias Ringwald             return false;
621ce41473eSMatthias Ringwald     }
6220bf6344aS[email protected] }
6230bf6344aS[email protected] 
6240890cf2bSMatthias Ringwald bool hci_is_le_identity_address_type(bd_addr_type_t address_type){
6250890cf2bSMatthias Ringwald     switch (address_type){
6260890cf2bSMatthias Ringwald         case BD_ADDR_TYPE_LE_PUBLIC_IDENTITY:
6270890cf2bSMatthias Ringwald         case BD_ADDR_TYPE_LE_RANDOM_IDENTITY:
6280890cf2bSMatthias Ringwald             return true;
6290890cf2bSMatthias Ringwald         default:
6300890cf2bSMatthias Ringwald             return false;
6310890cf2bSMatthias Ringwald     }
6320890cf2bSMatthias Ringwald }
6330890cf2bSMatthias Ringwald 
634617c03d6SMatthias Ringwald static bool hci_is_le_connection(hci_connection_t * connection){
635eb8076ddSMatthias Ringwald     return hci_is_le_connection_type(connection->address_type);
636eb8076ddSMatthias Ringwald }
637eb8076ddSMatthias Ringwald 
6387fde4af9Smatthias.ringwald /**
63943bfb1bdSmatthias.ringwald  * count connections
64043bfb1bdSmatthias.ringwald  */
64140d1c7a4Smatthias.ringwald static int nr_hci_connections(void){
64256c253c9Smatthias.ringwald     int count = 0;
643665d90f2SMatthias Ringwald     btstack_linked_item_t *it;
644a0da043fSMatthias Ringwald     for (it = (btstack_linked_item_t *) hci_stack->connections; it != NULL ; it = it->next){
64515a27967SMatthias Ringwald         count++;
64615a27967SMatthias Ringwald     }
64743bfb1bdSmatthias.ringwald     return count;
64843bfb1bdSmatthias.ringwald }
649c8e4258aSmatthias.ringwald 
6508f733c6fSMatthias Ringwald uint16_t hci_number_free_acl_slots_for_connection_type(bd_addr_type_t address_type){
651ee303eddS[email protected] 
652f04a0c31SMatthias Ringwald     unsigned int num_packets_sent_classic = 0;
653f04a0c31SMatthias Ringwald     unsigned int num_packets_sent_le = 0;
654ee303eddS[email protected] 
655665d90f2SMatthias Ringwald     btstack_linked_item_t *it;
656a0da043fSMatthias Ringwald     for (it = (btstack_linked_item_t *) hci_stack->connections; it != NULL; it = it->next){
657998906cdSmatthias.ringwald         hci_connection_t * connection = (hci_connection_t *) it;
658ce41473eSMatthias Ringwald         if (hci_is_le_connection(connection)){
659ce41473eSMatthias Ringwald             num_packets_sent_le += connection->num_packets_sent;
660ce41473eSMatthias Ringwald         }
661f16129ceSMatthias Ringwald         if (connection->address_type == BD_ADDR_TYPE_ACL){
662ce41473eSMatthias Ringwald             num_packets_sent_classic += connection->num_packets_sent;
663ee303eddS[email protected]         }
664ee303eddS[email protected]     }
665d999b54eSMatthias Ringwald     log_debug("ACL classic buffers: %u used of %u", num_packets_sent_classic, hci_stack->acl_packets_total_num);
666ee303eddS[email protected]     int free_slots_classic = hci_stack->acl_packets_total_num - num_packets_sent_classic;
667ee303eddS[email protected]     int free_slots_le = 0;
668ee303eddS[email protected] 
669ee303eddS[email protected]     if (free_slots_classic < 0){
6709da54300S[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);
671998906cdSmatthias.ringwald         return 0;
672998906cdSmatthias.ringwald     }
673ee303eddS[email protected] 
674ee303eddS[email protected]     if (hci_stack->le_acl_packets_total_num){
675ee303eddS[email protected]         // if we have LE slots, they are used
676ee303eddS[email protected]         free_slots_le = hci_stack->le_acl_packets_total_num - num_packets_sent_le;
677ee303eddS[email protected]         if (free_slots_le < 0){
6789da54300S[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);
679ee303eddS[email protected]             return 0;
680998906cdSmatthias.ringwald         }
681ee303eddS[email protected]     } else {
682ee303eddS[email protected]         // otherwise, classic slots are used for LE, too
683ee303eddS[email protected]         free_slots_classic -= num_packets_sent_le;
684ee303eddS[email protected]         if (free_slots_classic < 0){
6859da54300S[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);
686ee303eddS[email protected]             return 0;
687ee303eddS[email protected]         }
688ee303eddS[email protected]     }
689ee303eddS[email protected] 
690ee303eddS[email protected]     switch (address_type){
691ee303eddS[email protected]         case BD_ADDR_TYPE_UNKNOWN:
6922125de09SMatthias Ringwald             log_error("hci_number_free_acl_slots: unknown address type");
693ee303eddS[email protected]             return 0;
694ee303eddS[email protected] 
695f16129ceSMatthias Ringwald         case BD_ADDR_TYPE_ACL:
6968f733c6fSMatthias Ringwald             return (uint16_t) free_slots_classic;
697ee303eddS[email protected] 
698ee303eddS[email protected]         default:
6998f733c6fSMatthias Ringwald            if (hci_stack->le_acl_packets_total_num > 0){
7008f733c6fSMatthias Ringwald                return (uint16_t) free_slots_le;
701ee303eddS[email protected]            }
7028f733c6fSMatthias Ringwald            return (uint16_t) free_slots_classic;
703cb00d3aaS[email protected]     }
704998906cdSmatthias.ringwald }
705998906cdSmatthias.ringwald 
7062125de09SMatthias Ringwald int hci_number_free_acl_slots_for_handle(hci_con_handle_t con_handle){
7072125de09SMatthias Ringwald     // get connection type
7082125de09SMatthias Ringwald     hci_connection_t * connection = hci_connection_for_handle(con_handle);
7092125de09SMatthias Ringwald     if (!connection){
7102125de09SMatthias Ringwald         log_error("hci_number_free_acl_slots: handle 0x%04x not in connection list", con_handle);
7112125de09SMatthias Ringwald         return 0;
7122125de09SMatthias Ringwald     }
7132125de09SMatthias Ringwald     return hci_number_free_acl_slots_for_connection_type(connection->address_type);
7142125de09SMatthias Ringwald }
7152125de09SMatthias Ringwald 
71635454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
717701e3307SMatthias Ringwald static int hci_number_free_sco_slots(void){
718f04a0c31SMatthias Ringwald     unsigned int num_sco_packets_sent  = 0;
719665d90f2SMatthias Ringwald     btstack_linked_item_t *it;
720760b20efSMatthias Ringwald     if (hci_stack->synchronous_flow_control_enabled){
721760b20efSMatthias Ringwald         // explicit flow control
722665d90f2SMatthias Ringwald         for (it = (btstack_linked_item_t *) hci_stack->connections; it ; it = it->next){
723e35edcc1S[email protected]             hci_connection_t * connection = (hci_connection_t *) it;
724ce41473eSMatthias Ringwald             if (connection->address_type != BD_ADDR_TYPE_SCO) continue;
725ce41473eSMatthias Ringwald             num_sco_packets_sent += connection->num_packets_sent;
726e35edcc1S[email protected]         }
727e35edcc1S[email protected]         if (num_sco_packets_sent > hci_stack->sco_packets_total_num){
728701e3307SMatthias Ringwald             log_info("hci_number_free_sco_slots:packets (%u) > total packets (%u)", num_sco_packets_sent, hci_stack->sco_packets_total_num);
72944d0e3d5S[email protected]             return 0;
73044d0e3d5S[email protected]         }
731e35edcc1S[email protected]         return hci_stack->sco_packets_total_num - num_sco_packets_sent;
73249205f5dSMatthias Ringwald     } else {
733fa7f2dfdSMatthias Ringwald         // implicit flow control
7346f28d2eeSMatthias Ringwald         int num_ready = 0;
7356f28d2eeSMatthias Ringwald         for (it = (btstack_linked_item_t *) hci_stack->connections; it ; it = it->next){
7366f28d2eeSMatthias Ringwald             hci_connection_t * connection = (hci_connection_t *) it;
7376f28d2eeSMatthias Ringwald             if (connection->address_type != BD_ADDR_TYPE_SCO) continue;
7386f28d2eeSMatthias Ringwald             if (connection->sco_tx_ready == 0) continue;
7396f28d2eeSMatthias Ringwald             num_ready++;
74049205f5dSMatthias Ringwald         }
7416f28d2eeSMatthias Ringwald         return num_ready;
7426f28d2eeSMatthias Ringwald     }
743e35edcc1S[email protected] }
74435454696SMatthias Ringwald #endif
74544d0e3d5S[email protected] 
7462b838201SMatthias Ringwald // only used to send HCI Host Number Completed Packets
7472b838201SMatthias Ringwald static int hci_can_send_comand_packet_transport(void){
748ac928cc2S[email protected]     if (hci_stack->hci_packet_buffer_reserved) return 0;
749ac928cc2S[email protected] 
750ac928cc2S[email protected]     // check for async hci transport implementations
751ac928cc2S[email protected]     if (hci_stack->hci_transport->can_send_packet_now){
752ac928cc2S[email protected]         if (!hci_stack->hci_transport->can_send_packet_now(HCI_COMMAND_DATA_PACKET)){
753ac928cc2S[email protected]             return 0;
754ac928cc2S[email protected]         }
755ac928cc2S[email protected]     }
7562b838201SMatthias Ringwald     return 1;
7572b838201SMatthias Ringwald }
758ac928cc2S[email protected] 
7592b838201SMatthias Ringwald // new functions replacing hci_can_send_packet_now[_using_packet_buffer]
7601972f31fSMatthias Ringwald bool hci_can_send_command_packet_now(void){
7611972f31fSMatthias Ringwald     if (hci_can_send_comand_packet_transport() == 0) return false;
7624ea43905SMatthias Ringwald     return hci_stack->num_cmd_packets > 0u;
763ac928cc2S[email protected] }
764ac928cc2S[email protected] 
7659d04d3a7SMatthias Ringwald static int hci_transport_can_send_prepared_packet_now(uint8_t packet_type){
766ac928cc2S[email protected]     // check for async hci transport implementations
7671972f31fSMatthias Ringwald     if (!hci_stack->hci_transport->can_send_packet_now) return true;
7689d04d3a7SMatthias Ringwald     return hci_stack->hci_transport->can_send_packet_now(packet_type);
769ac928cc2S[email protected] }
7709d04d3a7SMatthias Ringwald 
7711972f31fSMatthias Ringwald static bool hci_can_send_prepared_acl_packet_for_address_type(bd_addr_type_t address_type){
7721972f31fSMatthias Ringwald     if (!hci_transport_can_send_prepared_packet_now(HCI_ACL_DATA_PACKET)) return false;
7739d04d3a7SMatthias Ringwald     return hci_number_free_acl_slots_for_connection_type(address_type) > 0;
774ac928cc2S[email protected] }
7759d04d3a7SMatthias Ringwald 
7761972f31fSMatthias Ringwald bool hci_can_send_acl_le_packet_now(void){
7771972f31fSMatthias Ringwald     if (hci_stack->hci_packet_buffer_reserved) return false;
7789d04d3a7SMatthias Ringwald     return hci_can_send_prepared_acl_packet_for_address_type(BD_ADDR_TYPE_LE_PUBLIC);
7799d04d3a7SMatthias Ringwald }
7809d04d3a7SMatthias Ringwald 
7811972f31fSMatthias Ringwald bool hci_can_send_prepared_acl_packet_now(hci_con_handle_t con_handle) {
7821972f31fSMatthias Ringwald     if (!hci_transport_can_send_prepared_packet_now(HCI_ACL_DATA_PACKET)) return false;
783e79abdd6S[email protected]     return hci_number_free_acl_slots_for_handle(con_handle) > 0;
784ac928cc2S[email protected] }
785ac928cc2S[email protected] 
7861972f31fSMatthias Ringwald bool hci_can_send_acl_packet_now(hci_con_handle_t con_handle){
7871972f31fSMatthias Ringwald     if (hci_stack->hci_packet_buffer_reserved) return false;
788ac928cc2S[email protected]     return hci_can_send_prepared_acl_packet_now(con_handle);
7896b4af23dS[email protected] }
7906b4af23dS[email protected] 
79135454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
7921972f31fSMatthias Ringwald bool hci_can_send_acl_classic_packet_now(void){
7931972f31fSMatthias Ringwald     if (hci_stack->hci_packet_buffer_reserved) return false;
794f16129ceSMatthias Ringwald     return hci_can_send_prepared_acl_packet_for_address_type(BD_ADDR_TYPE_ACL);
79535454696SMatthias Ringwald }
79635454696SMatthias Ringwald 
7971972f31fSMatthias Ringwald bool hci_can_send_prepared_sco_packet_now(void){
7981972f31fSMatthias Ringwald     if (!hci_transport_can_send_prepared_packet_now(HCI_SCO_DATA_PACKET)) return false;
799f234b250SMatthias Ringwald     if (hci_have_usb_transport()){
800f234b250SMatthias Ringwald         return hci_stack->sco_can_send_now;
801f234b250SMatthias Ringwald     } else {
802701e3307SMatthias Ringwald         return hci_number_free_sco_slots() > 0;
80344d0e3d5S[email protected]     }
804f234b250SMatthias Ringwald }
80544d0e3d5S[email protected] 
8061972f31fSMatthias Ringwald bool hci_can_send_sco_packet_now(void){
8071972f31fSMatthias Ringwald     if (hci_stack->hci_packet_buffer_reserved) return false;
808701e3307SMatthias Ringwald     return hci_can_send_prepared_sco_packet_now();
80944d0e3d5S[email protected] }
81044d0e3d5S[email protected] 
811d057580eSMatthias Ringwald void hci_request_sco_can_send_now_event(void){
812d057580eSMatthias Ringwald     hci_stack->sco_waiting_for_can_send_now = 1;
813d057580eSMatthias Ringwald     hci_notify_if_sco_can_send_now();
814d057580eSMatthias Ringwald }
81535454696SMatthias Ringwald #endif
816d057580eSMatthias Ringwald 
81795d71764SMatthias Ringwald // used for internal checks in l2cap.c
81802c7fc01SMatthias Ringwald bool hci_is_packet_buffer_reserved(void){
819c8b9416aS[email protected]     return hci_stack->hci_packet_buffer_reserved;
820c8b9416aS[email protected] }
821c8b9416aS[email protected] 
8228f4649e3SMatthias Ringwald void hci_reserve_packet_buffer(void){
8235d350981SMatthias Ringwald     btstack_assert(hci_stack->hci_packet_buffer_reserved == false);
82402c7fc01SMatthias Ringwald     hci_stack->hci_packet_buffer_reserved = true;
8256b4af23dS[email protected] }
8266b4af23dS[email protected] 
82768a0fcf7S[email protected] void hci_release_packet_buffer(void){
8285d350981SMatthias Ringwald     btstack_assert(hci_stack->hci_packet_buffer_reserved);
82902c7fc01SMatthias Ringwald     hci_stack->hci_packet_buffer_reserved = false;
8305daaa52eSMatthias Ringwald     hci_emit_transport_packet_sent();
83168a0fcf7S[email protected] }
83268a0fcf7S[email protected] 
8336b4af23dS[email protected] // assumption: synchronous implementations don't provide can_send_packet_now as they don't keep the buffer after the call
8347f02f414SMatthias Ringwald static int hci_transport_synchronous(void){
8356b4af23dS[email protected]     return hci_stack->hci_transport->can_send_packet_now == NULL;
8366b4af23dS[email protected] }
8376b4af23dS[email protected] 
8388ad9cf99SMatthias Ringwald // used for debugging
8398ad9cf99SMatthias Ringwald #ifdef ENABLE_CONTROLLER_DUMP_PACKETS
8408ad9cf99SMatthias Ringwald static void hci_controller_dump_packets(void){
8418ad9cf99SMatthias Ringwald     // format: "{handle:04x}:{count:02d} "
8428ad9cf99SMatthias Ringwald     char summaries[3][7 * 8 + 1];
8438ad9cf99SMatthias Ringwald     uint16_t totals[3];
8448ad9cf99SMatthias Ringwald     uint8_t index;
8458ad9cf99SMatthias Ringwald     for (index = 0 ; index < 3 ; index++){
8468ad9cf99SMatthias Ringwald         summaries[index][0] = 0;
8478ad9cf99SMatthias Ringwald         totals[index] = 0;
8488ad9cf99SMatthias Ringwald     }
8498ad9cf99SMatthias Ringwald     btstack_linked_item_t *it;
8508ad9cf99SMatthias Ringwald     for (it = (btstack_linked_item_t *) hci_stack->connections; it != NULL; it = it->next){
8518ad9cf99SMatthias Ringwald         hci_connection_t * connection = (hci_connection_t *) it;
8528ad9cf99SMatthias Ringwald         switch (connection->address_type){
8538ad9cf99SMatthias Ringwald             case BD_ADDR_TYPE_ACL:
8548ad9cf99SMatthias Ringwald                 index = 0;
8558ad9cf99SMatthias Ringwald                 break;
8568ad9cf99SMatthias Ringwald             case BD_ADDR_TYPE_SCO:
8578ad9cf99SMatthias Ringwald                 index = 2;
8588ad9cf99SMatthias Ringwald                 break;
8598ad9cf99SMatthias Ringwald             default:
8608ad9cf99SMatthias Ringwald                 index = 1;
861ce7ca7c8SMatthias Ringwald                 break;
8628ad9cf99SMatthias Ringwald         }
8638ad9cf99SMatthias Ringwald         totals[index] += connection->num_packets_sent;
8648ad9cf99SMatthias Ringwald         char item_text[10];
8658ad9cf99SMatthias Ringwald         sprintf(item_text, "%04x:%02d ", connection->con_handle,connection->num_packets_sent);
8668ad9cf99SMatthias Ringwald         btstack_strcat(summaries[index], sizeof(summaries[0]), item_text);
8678ad9cf99SMatthias Ringwald     }
8688ad9cf99SMatthias Ringwald     for (index = 0 ; index < 3 ; index++){
8698ad9cf99SMatthias Ringwald         if (summaries[index][0] == 0){
8708ad9cf99SMatthias Ringwald             summaries[index][0] = '-';
8718ad9cf99SMatthias Ringwald             summaries[index][1] = 0;
8728ad9cf99SMatthias Ringwald         }
8738ad9cf99SMatthias Ringwald     }
8748ad9cf99SMatthias Ringwald     log_info("Controller ACL BR/EDR: %s total %u / LE: %s total %u / SCO: %s total %u", summaries[0], totals[0], summaries[1], totals[1], summaries[2], totals[2]);
8758ad9cf99SMatthias Ringwald }
8768ad9cf99SMatthias Ringwald #endif
8778ad9cf99SMatthias Ringwald 
8783e2050f7SMatthias Ringwald static uint8_t hci_send_acl_packet_fragments(hci_connection_t *connection){
879452cf3bbS[email protected] 
880452cf3bbS[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);
881452cf3bbS[email protected] 
882452cf3bbS[email protected]     // max ACL data packet length depends on connection type (LE vs. Classic) and available buffers
883452cf3bbS[email protected]     uint16_t max_acl_data_packet_length = hci_stack->acl_data_packet_length;
8844ea43905SMatthias Ringwald     if (hci_is_le_connection(connection) && (hci_stack->le_data_packets_length > 0u)){
885452cf3bbS[email protected]         max_acl_data_packet_length = hci_stack->le_data_packets_length;
886452cf3bbS[email protected]     }
887452cf3bbS[email protected] 
8880f3b27c5SMatthias Ringwald #ifdef ENABLE_LE_LIMIT_ACL_FRAGMENT_BY_MAX_OCTETS
889fcf88f47SMatthias Ringwald     if (hci_is_le_connection(connection) && (connection->le_max_tx_octets < max_acl_data_packet_length)){
8900f3b27c5SMatthias Ringwald         max_acl_data_packet_length = connection->le_max_tx_octets;
8910f3b27c5SMatthias Ringwald     }
8920f3b27c5SMatthias Ringwald #endif
893452cf3bbS[email protected] 
894d999b54eSMatthias Ringwald     log_debug("hci_send_acl_packet_fragments entered");
895d999b54eSMatthias Ringwald 
8963e2050f7SMatthias Ringwald     uint8_t status = ERROR_CODE_SUCCESS;
897452cf3bbS[email protected]     // multiple packets could be send on a synchronous HCI transport
898ff3cc4a5SMatthias Ringwald     while (true){
899452cf3bbS[email protected] 
900d999b54eSMatthias Ringwald         log_debug("hci_send_acl_packet_fragments loop entered");
901d999b54eSMatthias Ringwald 
902452cf3bbS[email protected]         // get current data
9034ea43905SMatthias Ringwald         const uint16_t acl_header_pos = hci_stack->acl_fragmentation_pos - 4u;
904452cf3bbS[email protected]         int current_acl_data_packet_length = hci_stack->acl_fragmentation_total_size - hci_stack->acl_fragmentation_pos;
9051979f09cSMatthias Ringwald         bool more_fragments = false;
906452cf3bbS[email protected] 
907452cf3bbS[email protected]         // if ACL packet is larger than Bluetooth packet buffer, only send max_acl_data_packet_length
908452cf3bbS[email protected]         if (current_acl_data_packet_length > max_acl_data_packet_length){
9091979f09cSMatthias Ringwald             more_fragments = true;
9106bcf18c2SMatthias Ringwald             current_acl_data_packet_length = max_acl_data_packet_length & (~(HCI_ACL_CHUNK_SIZE_ALIGNMENT-1));
911452cf3bbS[email protected]         }
912452cf3bbS[email protected] 
913452cf3bbS[email protected]         // copy handle_and_flags if not first fragment and update packet boundary flags to be 01 (continuing fragmnent)
9144ea43905SMatthias Ringwald         if (acl_header_pos > 0u){
915f8fbdce0SMatthias Ringwald             uint16_t handle_and_flags = little_endian_read_16(hci_stack->hci_packet_buffer, 0);
9164ea43905SMatthias Ringwald             handle_and_flags = (handle_and_flags & 0xcfffu) | (1u << 12u);
917f8fbdce0SMatthias Ringwald             little_endian_store_16(hci_stack->hci_packet_buffer, acl_header_pos, handle_and_flags);
918452cf3bbS[email protected]         }
919452cf3bbS[email protected] 
920452cf3bbS[email protected]         // update header len
9214ea43905SMatthias Ringwald         little_endian_store_16(hci_stack->hci_packet_buffer, acl_header_pos + 2u, current_acl_data_packet_length);
922452cf3bbS[email protected] 
923452cf3bbS[email protected]         // count packet
924ce41473eSMatthias Ringwald         connection->num_packets_sent++;
9251979f09cSMatthias Ringwald         log_debug("hci_send_acl_packet_fragments loop before send (more fragments %d)", (int) more_fragments);
926d999b54eSMatthias Ringwald 
927d999b54eSMatthias Ringwald         // update state for next fragment (if any) as "transport done" might be sent during send_packet already
928d999b54eSMatthias Ringwald         if (more_fragments){
929d999b54eSMatthias Ringwald             // update start of next fragment to send
930d999b54eSMatthias Ringwald             hci_stack->acl_fragmentation_pos += current_acl_data_packet_length;
931d999b54eSMatthias Ringwald         } else {
932d999b54eSMatthias Ringwald             // done
933d999b54eSMatthias Ringwald             hci_stack->acl_fragmentation_pos = 0;
934d999b54eSMatthias Ringwald             hci_stack->acl_fragmentation_total_size = 0;
935d999b54eSMatthias Ringwald         }
936452cf3bbS[email protected] 
937452cf3bbS[email protected]         // send packet
938452cf3bbS[email protected]         uint8_t * packet = &hci_stack->hci_packet_buffer[acl_header_pos];
939452cf3bbS[email protected]         const int size = current_acl_data_packet_length + 4;
9405bb5bc3eS[email protected]         hci_dump_packet(HCI_ACL_DATA_PACKET, 0, packet, size);
94181d2bdb2SMatthias Ringwald         hci_stack->acl_fragmentation_tx_active = 1;
9423e2050f7SMatthias Ringwald         int err = hci_stack->hci_transport->send_packet(HCI_ACL_DATA_PACKET, packet, size);
9433e2050f7SMatthias Ringwald         if (err != 0){
9443e2050f7SMatthias Ringwald             // no error from HCI Transport expected
9453e2050f7SMatthias Ringwald             status = ERROR_CODE_HARDWARE_FAILURE;
946a84946b2SMatthias Ringwald             break;
9473e2050f7SMatthias Ringwald         }
948452cf3bbS[email protected] 
9498ad9cf99SMatthias Ringwald #ifdef ENABLE_CONTROLLER_DUMP_PACKETS
9508ad9cf99SMatthias Ringwald         hci_controller_dump_packets();
9518ad9cf99SMatthias Ringwald #endif
9528ad9cf99SMatthias Ringwald 
9531979f09cSMatthias Ringwald         log_debug("hci_send_acl_packet_fragments loop after send (more fragments %d)", (int) more_fragments);
954d999b54eSMatthias Ringwald 
955452cf3bbS[email protected]         // done yet?
956452cf3bbS[email protected]         if (!more_fragments) break;
957452cf3bbS[email protected] 
958452cf3bbS[email protected]         // can send more?
9593e2050f7SMatthias Ringwald         if (!hci_can_send_prepared_acl_packet_now(connection->con_handle)) return status;
960452cf3bbS[email protected]     }
961452cf3bbS[email protected] 
962d999b54eSMatthias Ringwald     log_debug("hci_send_acl_packet_fragments loop over");
963452cf3bbS[email protected] 
964d051460cS[email protected]     // release buffer now for synchronous transport
965203bace6S[email protected]     if (hci_transport_synchronous()){
96681d2bdb2SMatthias Ringwald         hci_stack->acl_fragmentation_tx_active = 0;
967452cf3bbS[email protected]         hci_release_packet_buffer();
968452cf3bbS[email protected]     }
969452cf3bbS[email protected] 
9703e2050f7SMatthias Ringwald     return status;
971452cf3bbS[email protected] }
972452cf3bbS[email protected] 
973826f7347S[email protected] // pre: caller has reserved the packet buffer
9743e2050f7SMatthias Ringwald uint8_t hci_send_acl_packet_buffer(int size){
9753e2050f7SMatthias Ringwald     btstack_assert(hci_stack->hci_packet_buffer_reserved);
976826f7347S[email protected] 
977d713a683S[email protected]     uint8_t * packet = hci_stack->hci_packet_buffer;
978d713a683S[email protected]     hci_con_handle_t con_handle = READ_ACL_CONNECTION_HANDLE(packet);
979d713a683S[email protected] 
9805061f3afS[email protected]     hci_connection_t *connection = hci_connection_for_handle( con_handle);
98197b61c7bS[email protected]     if (!connection) {
9825fa0b7cfS[email protected]         log_error("hci_send_acl_packet_buffer called but no connection for handle 0x%04x", con_handle);
98397b61c7bS[email protected]         hci_release_packet_buffer();
9843e2050f7SMatthias Ringwald         return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
98597b61c7bS[email protected]     }
98652db98b2SMatthias Ringwald 
98779a2851bSMilanka Ringwald     // check for free places on Bluetooth module
98879a2851bSMilanka Ringwald     if (!hci_can_send_prepared_acl_packet_now(con_handle)) {
98979a2851bSMilanka Ringwald         log_error("hci_send_acl_packet_buffer called but no free ACL buffers on controller");
99079a2851bSMilanka Ringwald         hci_release_packet_buffer();
99179a2851bSMilanka Ringwald         return BTSTACK_ACL_BUFFERS_FULL;
99279a2851bSMilanka Ringwald     }
99379a2851bSMilanka Ringwald 
99452db98b2SMatthias Ringwald #ifdef ENABLE_CLASSIC
99556cf178bSmatthias.ringwald     hci_connection_timestamp(connection);
99652db98b2SMatthias Ringwald #endif
99756cf178bSmatthias.ringwald 
998452cf3bbS[email protected]     // hci_dump_packet( HCI_ACL_DATA_PACKET, 0, packet, size);
9997856c818Smatthias.ringwald 
1000452cf3bbS[email protected]     // setup data
1001452cf3bbS[email protected]     hci_stack->acl_fragmentation_total_size = size;
1002452cf3bbS[email protected]     hci_stack->acl_fragmentation_pos = 4;   // start of L2CAP packet
10036218e6f1Smatthias.ringwald 
1004452cf3bbS[email protected]     return hci_send_acl_packet_fragments(connection);
1005ee091cf1Smatthias.ringwald }
1006ee091cf1Smatthias.ringwald 
100735454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
100844d0e3d5S[email protected] // pre: caller has reserved the packet buffer
10093e2050f7SMatthias Ringwald uint8_t hci_send_sco_packet_buffer(int size){
10103e2050f7SMatthias Ringwald     btstack_assert(hci_stack->hci_packet_buffer_reserved);
101144d0e3d5S[email protected] 
101244d0e3d5S[email protected]     uint8_t * packet = hci_stack->hci_packet_buffer;
10134b3e1e19SMatthias Ringwald 
10144b3e1e19SMatthias Ringwald     // skip checks in loopback mode
10154b3e1e19SMatthias Ringwald     if (!hci_stack->loopback_mode){
101644d0e3d5S[email protected]         hci_con_handle_t con_handle = READ_ACL_CONNECTION_HANDLE(packet);   // same for ACL and SCO
101744d0e3d5S[email protected] 
101844d0e3d5S[email protected]         // check for free places on Bluetooth module
1019701e3307SMatthias Ringwald         if (!hci_can_send_prepared_sco_packet_now()) {
1020cbf638a9SMatthias Ringwald             log_error("hci_send_sco_packet_buffer called but no free SCO buffers on controller");
102144d0e3d5S[email protected]             hci_release_packet_buffer();
102244d0e3d5S[email protected]             return BTSTACK_ACL_BUFFERS_FULL;
102344d0e3d5S[email protected]         }
102444d0e3d5S[email protected] 
1025e35edcc1S[email protected]         // track send packet in connection struct
1026e35edcc1S[email protected]         hci_connection_t *connection = hci_connection_for_handle( con_handle);
1027e35edcc1S[email protected]         if (!connection) {
1028e35edcc1S[email protected]             log_error("hci_send_sco_packet_buffer called but no connection for handle 0x%04x", con_handle);
1029e35edcc1S[email protected]             hci_release_packet_buffer();
10303e2050f7SMatthias Ringwald             return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
1031e35edcc1S[email protected]         }
1032f234b250SMatthias Ringwald 
1033f234b250SMatthias Ringwald         if (hci_have_usb_transport()){
1034f234b250SMatthias Ringwald             // token used
10351972f31fSMatthias Ringwald             hci_stack->sco_can_send_now = false;
1036f234b250SMatthias Ringwald         } else {
1037760b20efSMatthias Ringwald             if (hci_stack->synchronous_flow_control_enabled){
1038ce41473eSMatthias Ringwald                 connection->num_packets_sent++;
10396f28d2eeSMatthias Ringwald             } else {
1040e4157653SMatthias Ringwald                 connection->sco_tx_ready--;
1041760b20efSMatthias Ringwald             }
10424b3e1e19SMatthias Ringwald         }
1043f234b250SMatthias Ringwald     }
104444d0e3d5S[email protected] 
104544d0e3d5S[email protected]     hci_dump_packet( HCI_SCO_DATA_PACKET, 0, packet, size);
1046543e835cSMatthias Ringwald 
104743149fc9SMatthias Ringwald #ifdef HAVE_SCO_TRANSPORT
104843149fc9SMatthias Ringwald     hci_stack->sco_transport->send_packet(packet, size);
104943149fc9SMatthias Ringwald     hci_release_packet_buffer();
105043149fc9SMatthias Ringwald     hci_emit_transport_packet_sent();
105143149fc9SMatthias Ringwald 
105243149fc9SMatthias Ringwald     return 0;
105343149fc9SMatthias Ringwald #else
105443149fc9SMatthias Ringwald     int err = hci_stack->hci_transport->send_packet(HCI_SCO_DATA_PACKET, packet, size);
1055a84946b2SMatthias Ringwald     uint8_t status;
1056a84946b2SMatthias Ringwald     if (err == 0){
1057a84946b2SMatthias Ringwald         status = ERROR_CODE_SUCCESS;
1058a84946b2SMatthias Ringwald     } else {
1059a84946b2SMatthias Ringwald         status = ERROR_CODE_HARDWARE_FAILURE;
1060a84946b2SMatthias Ringwald     }
1061a84946b2SMatthias Ringwald     if ((status != ERROR_CODE_SUCCESS) || hci_transport_synchronous()){
1062543e835cSMatthias Ringwald         hci_release_packet_buffer();
1063543e835cSMatthias Ringwald     }
1064a84946b2SMatthias Ringwald     return status;
106543149fc9SMatthias Ringwald #endif
106644d0e3d5S[email protected] }
106735454696SMatthias Ringwald #endif
106844d0e3d5S[email protected] 
10690a8cccd5SMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
107068ab6207SMatthias Ringwald static uint8_t hci_send_iso_packet_fragments(void){
107168ab6207SMatthias Ringwald 
107268ab6207SMatthias Ringwald     uint16_t max_iso_data_packet_length = hci_stack->le_iso_packets_length;
107368ab6207SMatthias Ringwald     uint8_t status = ERROR_CODE_SUCCESS;
107468ab6207SMatthias Ringwald     // multiple packets could be send on a synchronous HCI transport
107568ab6207SMatthias Ringwald     while (true){
107668ab6207SMatthias Ringwald 
107768ab6207SMatthias Ringwald         // get current data
107868ab6207SMatthias Ringwald         const uint16_t iso_header_pos = hci_stack->iso_fragmentation_pos - 4u;
107968ab6207SMatthias Ringwald         int current_iso_data_packet_length = hci_stack->iso_fragmentation_total_size - hci_stack->iso_fragmentation_pos;
108068ab6207SMatthias Ringwald         bool more_fragments = false;
108168ab6207SMatthias Ringwald 
108268ab6207SMatthias Ringwald         // if ISO packet is larger than Bluetooth packet buffer, only send max_acl_data_packet_length
108368ab6207SMatthias Ringwald         if (current_iso_data_packet_length > max_iso_data_packet_length){
108468ab6207SMatthias Ringwald             more_fragments = true;
108568ab6207SMatthias Ringwald             current_iso_data_packet_length = max_iso_data_packet_length;
108668ab6207SMatthias Ringwald         }
108768ab6207SMatthias Ringwald 
108868ab6207SMatthias Ringwald         // copy handle_and_flags if not first fragment and update packet boundary flags to be 01 (continuing fragmnent)
108968ab6207SMatthias Ringwald         uint16_t handle_and_flags = little_endian_read_16(hci_stack->hci_packet_buffer, 0);
109068ab6207SMatthias Ringwald         uint8_t pb_flags;
109168ab6207SMatthias Ringwald         if (iso_header_pos == 0u){
109268ab6207SMatthias Ringwald             // first fragment, keep TS field
109368ab6207SMatthias Ringwald             pb_flags = more_fragments ? 0x00 : 0x02;
109468ab6207SMatthias Ringwald             handle_and_flags = (handle_and_flags & 0x4fffu) | (pb_flags << 12u);
109568ab6207SMatthias Ringwald         } else {
109668ab6207SMatthias Ringwald             // later fragment, drop TS field
109768ab6207SMatthias Ringwald             pb_flags = more_fragments ? 0x01 : 0x03;
109868ab6207SMatthias Ringwald             handle_and_flags = (handle_and_flags & 0x0fffu) | (pb_flags << 12u);
109968ab6207SMatthias Ringwald         }
110068ab6207SMatthias Ringwald         little_endian_store_16(hci_stack->hci_packet_buffer, iso_header_pos, handle_and_flags);
110168ab6207SMatthias Ringwald 
110268ab6207SMatthias Ringwald         // update header len
110368ab6207SMatthias Ringwald         little_endian_store_16(hci_stack->hci_packet_buffer, iso_header_pos + 2u, current_iso_data_packet_length);
110468ab6207SMatthias Ringwald 
110568ab6207SMatthias Ringwald         // update state for next fragment (if any) as "transport done" might be sent during send_packet already
110668ab6207SMatthias Ringwald         if (more_fragments){
110768ab6207SMatthias Ringwald             // update start of next fragment to send
110868ab6207SMatthias Ringwald             hci_stack->iso_fragmentation_pos += current_iso_data_packet_length;
110968ab6207SMatthias Ringwald         } else {
111068ab6207SMatthias Ringwald             // done
111168ab6207SMatthias Ringwald             hci_stack->iso_fragmentation_pos = 0;
111268ab6207SMatthias Ringwald             hci_stack->iso_fragmentation_total_size = 0;
111368ab6207SMatthias Ringwald         }
111468ab6207SMatthias Ringwald 
111568ab6207SMatthias Ringwald         // send packet
111668ab6207SMatthias Ringwald         uint8_t * packet = &hci_stack->hci_packet_buffer[iso_header_pos];
111768ab6207SMatthias Ringwald         const int size = current_iso_data_packet_length + 4;
111868ab6207SMatthias Ringwald         hci_dump_packet(HCI_ISO_DATA_PACKET, 0, packet, size);
111968ab6207SMatthias Ringwald         hci_stack->iso_fragmentation_tx_active = true;
112068ab6207SMatthias Ringwald         int err = hci_stack->hci_transport->send_packet(HCI_ISO_DATA_PACKET, packet, size);
112168ab6207SMatthias Ringwald         if (err != 0){
112268ab6207SMatthias Ringwald             // no error from HCI Transport expected
112368ab6207SMatthias Ringwald             status = ERROR_CODE_HARDWARE_FAILURE;
112468ab6207SMatthias Ringwald         }
112568ab6207SMatthias Ringwald 
112668ab6207SMatthias Ringwald         // done yet?
112768ab6207SMatthias Ringwald         if (!more_fragments) break;
112868ab6207SMatthias Ringwald 
112968ab6207SMatthias Ringwald         // can send more?
113068ab6207SMatthias Ringwald         if (!hci_transport_can_send_prepared_packet_now(HCI_ISO_DATA_PACKET)) return false;
113168ab6207SMatthias Ringwald     }
113268ab6207SMatthias Ringwald 
113368ab6207SMatthias Ringwald     // release buffer now for synchronous transport
113468ab6207SMatthias Ringwald     if (hci_transport_synchronous()){
113568ab6207SMatthias Ringwald         hci_stack->iso_fragmentation_tx_active = false;
113668ab6207SMatthias Ringwald         hci_release_packet_buffer();
113768ab6207SMatthias Ringwald         hci_emit_transport_packet_sent();
113868ab6207SMatthias Ringwald     }
113968ab6207SMatthias Ringwald 
114068ab6207SMatthias Ringwald     return status;
114168ab6207SMatthias Ringwald }
114268ab6207SMatthias Ringwald 
1143ace08712SMatthias Ringwald uint8_t hci_send_iso_packet_buffer(uint16_t size){
1144ace08712SMatthias Ringwald     btstack_assert(hci_stack->hci_packet_buffer_reserved);
1145ace08712SMatthias Ringwald 
1146e5413aa0SMatthias Ringwald     hci_con_handle_t con_handle = (hci_con_handle_t) little_endian_read_16(hci_stack->hci_packet_buffer, 0) & 0xfff;
1147e5413aa0SMatthias Ringwald     hci_iso_stream_t * iso_stream = hci_iso_stream_for_con_handle(con_handle);
1148e5413aa0SMatthias Ringwald     if (iso_stream == NULL){
1149977f918dSMatthias Ringwald         hci_release_packet_buffer();
1150977f918dSMatthias Ringwald         hci_iso_notify_can_send_now();
1151e5413aa0SMatthias Ringwald         return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
1152e5413aa0SMatthias Ringwald     }
1153e5413aa0SMatthias Ringwald 
1154e5413aa0SMatthias Ringwald     // TODO: check for space on controller
1155e5413aa0SMatthias Ringwald 
1156977f918dSMatthias Ringwald     // skip iso packets if needed
1157977f918dSMatthias Ringwald     if (iso_stream->num_packets_to_skip > 0){
1158977f918dSMatthias Ringwald         iso_stream->num_packets_to_skip--;
1159977f918dSMatthias Ringwald         // pretend it was processed and trigger next one
1160977f918dSMatthias Ringwald         hci_release_packet_buffer();
1161977f918dSMatthias Ringwald         hci_iso_notify_can_send_now();
1162977f918dSMatthias Ringwald         return ERROR_CODE_SUCCESS;
1163977f918dSMatthias Ringwald     }
1164977f918dSMatthias Ringwald 
1165e5413aa0SMatthias Ringwald     // track outgoing packet sent
1166e5413aa0SMatthias Ringwald     log_info("Outgoing ISO packet for con handle 0x%04x", con_handle);
1167e5413aa0SMatthias Ringwald     iso_stream->num_packets_sent++;
1168e5413aa0SMatthias Ringwald 
116968ab6207SMatthias Ringwald     // setup data
117068ab6207SMatthias Ringwald     hci_stack->iso_fragmentation_total_size = size;
117168ab6207SMatthias Ringwald     hci_stack->iso_fragmentation_pos = 4;   // start of L2CAP packet
117268ab6207SMatthias Ringwald 
117368ab6207SMatthias Ringwald     return hci_send_iso_packet_fragments();
1174ace08712SMatthias Ringwald }
1175ace08712SMatthias Ringwald #endif
1176ace08712SMatthias Ringwald 
1177c3b46f5aSMatthias Ringwald static void acl_handler(uint8_t *packet, uint16_t size){
1178e76a89eeS[email protected] 
11797856c818Smatthias.ringwald     // get info
11807856c818Smatthias.ringwald     hci_con_handle_t con_handle = READ_ACL_CONNECTION_HANDLE(packet);
11815061f3afS[email protected]     hci_connection_t *conn      = hci_connection_for_handle(con_handle);
11827856c818Smatthias.ringwald     uint8_t  acl_flags          = READ_ACL_FLAGS(packet);
11837856c818Smatthias.ringwald     uint16_t acl_length         = READ_ACL_LENGTH(packet);
11847856c818Smatthias.ringwald 
11857856c818Smatthias.ringwald     // ignore non-registered handle
11867856c818Smatthias.ringwald     if (!conn){
1187c3b46f5aSMatthias Ringwald         log_error("acl_handler called with non-registered handle %u!" , con_handle);
11887856c818Smatthias.ringwald         return;
11897856c818Smatthias.ringwald     }
11907856c818Smatthias.ringwald 
1191e76a89eeS[email protected]     // assert packet is complete
11924ea43905SMatthias Ringwald     if ((acl_length + 4u) != size){
1193c3b46f5aSMatthias Ringwald         log_error("acl_handler called with ACL packet of wrong size %d, expected %u => dropping packet", size, acl_length + 4);
1194e76a89eeS[email protected]         return;
1195e76a89eeS[email protected]     }
1196e76a89eeS[email protected] 
119752db98b2SMatthias Ringwald #ifdef ENABLE_CLASSIC
11987856c818Smatthias.ringwald     // update idle timestamp
11997856c818Smatthias.ringwald     hci_connection_timestamp(conn);
120052db98b2SMatthias Ringwald #endif
12017856c818Smatthias.ringwald 
12022b838201SMatthias Ringwald #ifdef ENABLE_HCI_CONTROLLER_TO_HOST_FLOW_CONTROL
12032b838201SMatthias Ringwald     hci_stack->host_completed_packets = 1;
12042b838201SMatthias Ringwald     conn->num_packets_completed++;
12052b838201SMatthias Ringwald #endif
12062b838201SMatthias Ringwald 
12077856c818Smatthias.ringwald     // handle different packet types
12084ea43905SMatthias Ringwald     switch (acl_flags & 0x03u) {
12097856c818Smatthias.ringwald 
12107856c818Smatthias.ringwald         case 0x01: // continuation fragment
12117856c818Smatthias.ringwald 
12120ca847afS[email protected]             // sanity checks
12134ea43905SMatthias Ringwald             if (conn->acl_recombination_pos == 0u) {
12149da54300S[email protected]                 log_error( "ACL Cont Fragment but no first fragment for handle 0x%02x", con_handle);
12157856c818Smatthias.ringwald                 return;
12167856c818Smatthias.ringwald             }
12174ea43905SMatthias Ringwald             if ((conn->acl_recombination_pos + acl_length) > (4u + HCI_ACL_BUFFER_SIZE)){
12180ca847afS[email protected]                 log_error( "ACL Cont Fragment to large: combined packet %u > buffer size %u for handle 0x%02x",
12190ca847afS[email protected]                     conn->acl_recombination_pos + acl_length, 4 + HCI_ACL_BUFFER_SIZE, con_handle);
12200ca847afS[email protected]                 conn->acl_recombination_pos = 0;
12210ca847afS[email protected]                 return;
12220ca847afS[email protected]             }
12237856c818Smatthias.ringwald 
12247856c818Smatthias.ringwald             // append fragment payload (header already stored)
12256535961aSMatthias Ringwald             (void)memcpy(&conn->acl_recombination_buffer[HCI_INCOMING_PRE_BUFFER_SIZE + conn->acl_recombination_pos],
12266535961aSMatthias Ringwald                          &packet[4], acl_length);
12277856c818Smatthias.ringwald             conn->acl_recombination_pos += acl_length;
12287856c818Smatthias.ringwald 
12297856c818Smatthias.ringwald             // forward complete L2CAP packet if complete.
12304ea43905SMatthias Ringwald             if (conn->acl_recombination_pos >= (conn->acl_recombination_length + 4u + 4u)){ // pos already incl. ACL header
1231d6b06661SMatthias Ringwald                 hci_emit_acl_packet(&conn->acl_recombination_buffer[HCI_INCOMING_PRE_BUFFER_SIZE], conn->acl_recombination_pos);
12327856c818Smatthias.ringwald                 // reset recombination buffer
12337856c818Smatthias.ringwald                 conn->acl_recombination_length = 0;
12347856c818Smatthias.ringwald                 conn->acl_recombination_pos = 0;
12357856c818Smatthias.ringwald             }
12367856c818Smatthias.ringwald             break;
12377856c818Smatthias.ringwald 
12387856c818Smatthias.ringwald         case 0x02: { // first fragment
12397856c818Smatthias.ringwald 
124023a77e1aS[email protected]             // sanity check
124123a77e1aS[email protected]             if (conn->acl_recombination_pos) {
124260737d2bSMatthias Ringwald                 // we just received the first fragment, but still have data. Only warn if the packet wasn't a flushable packet
124360737d2bSMatthias Ringwald                 if ((conn->acl_recombination_buffer[HCI_INCOMING_PRE_BUFFER_SIZE+1] >> 4) != 0x02){
124460737d2bSMatthias Ringwald                     log_error( "ACL First Fragment but %u bytes in buffer for handle 0x%02x, dropping stale fragments", conn->acl_recombination_pos, con_handle);
124560737d2bSMatthias Ringwald                 }
124623a77e1aS[email protected]                 conn->acl_recombination_pos = 0;
124723a77e1aS[email protected]             }
124823a77e1aS[email protected] 
12497856c818Smatthias.ringwald             // peek into L2CAP packet!
12507856c818Smatthias.ringwald             uint16_t l2cap_length = READ_L2CAP_LENGTH( packet );
12517856c818Smatthias.ringwald 
12527856c818Smatthias.ringwald             // compare fragment size to L2CAP packet size
12534ea43905SMatthias Ringwald             if (acl_length >= (l2cap_length + 4u)){
12547856c818Smatthias.ringwald                 // forward fragment as L2CAP packet
12554ea43905SMatthias Ringwald                 hci_emit_acl_packet(packet, acl_length + 4u);
12567856c818Smatthias.ringwald             } else {
12570ca847afS[email protected] 
12580ca847afS[email protected]                 if (acl_length > HCI_ACL_BUFFER_SIZE){
12590ca847afS[email protected]                     log_error( "ACL First Fragment to large: fragment %u > buffer size %u for handle 0x%02x",
12600ca847afS[email protected]                         4 + acl_length, 4 + HCI_ACL_BUFFER_SIZE, con_handle);
12610ca847afS[email protected]                     return;
12620ca847afS[email protected]                 }
12630ca847afS[email protected] 
12647856c818Smatthias.ringwald                 // store first fragment and tweak acl length for complete package
12656535961aSMatthias Ringwald                 (void)memcpy(&conn->acl_recombination_buffer[HCI_INCOMING_PRE_BUFFER_SIZE],
12664ea43905SMatthias Ringwald                              packet, acl_length + 4u);
12674ea43905SMatthias Ringwald                 conn->acl_recombination_pos    = acl_length + 4u;
12687856c818Smatthias.ringwald                 conn->acl_recombination_length = l2cap_length;
12694ea43905SMatthias Ringwald                 little_endian_store_16(conn->acl_recombination_buffer, HCI_INCOMING_PRE_BUFFER_SIZE + 2u, l2cap_length +4u);
12707856c818Smatthias.ringwald             }
12717856c818Smatthias.ringwald             break;
12727856c818Smatthias.ringwald 
12737856c818Smatthias.ringwald         }
12747856c818Smatthias.ringwald         default:
1275c3b46f5aSMatthias Ringwald             log_error( "acl_handler called with invalid packet boundary flags %u", acl_flags & 0x03);
12767856c818Smatthias.ringwald             return;
12777856c818Smatthias.ringwald     }
127894ab26f8Smatthias.ringwald 
127994ab26f8Smatthias.ringwald     // execute main loop
128094ab26f8Smatthias.ringwald     hci_run();
128116833f0aSmatthias.ringwald }
128222909952Smatthias.ringwald 
12831ab2dc58SMatthias Ringwald static void hci_connection_stop_timer(hci_connection_t * conn){
12841ab2dc58SMatthias Ringwald     btstack_run_loop_remove_timer(&conn->timeout);
12851ab2dc58SMatthias Ringwald #ifdef ENABLE_CLASSIC
12861ab2dc58SMatthias Ringwald     btstack_run_loop_remove_timer(&conn->timeout_sco);
12871ab2dc58SMatthias Ringwald #endif
12881ab2dc58SMatthias Ringwald }
12891ab2dc58SMatthias Ringwald 
129067a3e8ecSmatthias.ringwald static void hci_shutdown_connection(hci_connection_t *conn){
12919da54300S[email protected]     log_info("Connection closed: handle 0x%x, %s", conn->con_handle, bd_addr_to_str(conn->address));
12923c4d4b90Smatthias.ringwald 
1293b3264428SMatthias Ringwald #ifdef ENABLE_CLASSIC
1294cb70c5abSMatthias Ringwald #if defined(ENABLE_SCO_OVER_HCI) || defined(HAVE_SCO_TRANSPORT)
1295cb70c5abSMatthias Ringwald     bd_addr_type_t addr_type = conn->address_type;
1296cb70c5abSMatthias Ringwald #endif
1297cb70c5abSMatthias Ringwald #ifdef HAVE_SCO_TRANSPORT
1298cb70c5abSMatthias Ringwald     hci_con_handle_t con_handle = conn->con_handle;
1299ee752bb8SMatthias Ringwald #endif
1300b3264428SMatthias Ringwald #endif
1301ee752bb8SMatthias Ringwald 
13021ab2dc58SMatthias Ringwald     hci_connection_stop_timer(conn);
1303c785ef68Smatthias.ringwald 
1304665d90f2SMatthias Ringwald     btstack_linked_list_remove(&hci_stack->connections, (btstack_linked_item_t *) conn);
1305a3b02b71Smatthias.ringwald     btstack_memory_hci_connection_free( conn );
13063c4d4b90Smatthias.ringwald 
13073c4d4b90Smatthias.ringwald     // now it's gone
1308c7e0c5f6Smatthias.ringwald     hci_emit_nr_connections_changed();
1309ee752bb8SMatthias Ringwald 
1310b3264428SMatthias Ringwald #ifdef ENABLE_CLASSIC
1311034e9b53SMatthias Ringwald #ifdef ENABLE_SCO_OVER_HCI
1312ee752bb8SMatthias Ringwald     // update SCO
1313cb70c5abSMatthias Ringwald     if ((addr_type == BD_ADDR_TYPE_SCO) && (hci_stack->hci_transport != NULL) && (hci_stack->hci_transport->set_sco_config != NULL)){
1314ee752bb8SMatthias Ringwald         hci_stack->hci_transport->set_sco_config(hci_stack->sco_voice_setting_active, hci_number_sco_connections());
1315ee752bb8SMatthias Ringwald     }
1316034e9b53SMatthias Ringwald #endif
1317cb70c5abSMatthias Ringwald #ifdef HAVE_SCO_TRANSPORT
1318cb70c5abSMatthias Ringwald     if ((addr_type == BD_ADDR_TYPE_SCO) && (hci_stack->sco_transport != NULL)){
1319cb70c5abSMatthias Ringwald         hci_stack->sco_transport->close(con_handle);
1320cb70c5abSMatthias Ringwald     }
1321cb70c5abSMatthias Ringwald #endif
1322b3264428SMatthias Ringwald #endif
1323c7e0c5f6Smatthias.ringwald }
1324c7e0c5f6Smatthias.ringwald 
132535454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
132635454696SMatthias Ringwald 
132729e39de4SMatthias Ringwald static const uint16_t hci_acl_packet_type_sizes[] = {
13288f8108aaSmatthias.ringwald     0, HCI_ACL_2DH1_SIZE, HCI_ACL_3DH1_SIZE, HCI_ACL_DM1_SIZE,
13298f8108aaSmatthias.ringwald     HCI_ACL_DH1_SIZE, 0, 0, 0,
13308f8108aaSmatthias.ringwald     HCI_ACL_2DH3_SIZE, HCI_ACL_3DH3_SIZE, HCI_ACL_DM3_SIZE, HCI_ACL_DH3_SIZE,
13318f8108aaSmatthias.ringwald     HCI_ACL_2DH5_SIZE, HCI_ACL_3DH5_SIZE, HCI_ACL_DM5_SIZE, HCI_ACL_DH5_SIZE
13328f8108aaSmatthias.ringwald };
133329e39de4SMatthias Ringwald static const uint8_t hci_acl_packet_type_feature_requirement_bit[] = {
133465389bfcS[email protected]      0, // 3 slot packets
133565389bfcS[email protected]      1, // 5 slot packets
133665389bfcS[email protected]     25, // EDR 2 mpbs
133765389bfcS[email protected]     26, // EDR 3 mbps
133865389bfcS[email protected]     39, // 3 slot EDR packts
133965389bfcS[email protected]     40, // 5 slot EDR packet
134065389bfcS[email protected] };
134129e39de4SMatthias Ringwald static const uint16_t hci_acl_packet_type_feature_packet_mask[] = {
134265389bfcS[email protected]     0x0f00, // 3 slot packets
134365389bfcS[email protected]     0xf000, // 5 slot packets
134465389bfcS[email protected]     0x1102, // EDR 2 mpbs
134565389bfcS[email protected]     0x2204, // EDR 3 mbps
134665389bfcS[email protected]     0x0300, // 3 slot EDR packts
134765389bfcS[email protected]     0x3000, // 5 slot EDR packet
134865389bfcS[email protected] };
13498f8108aaSmatthias.ringwald 
135065389bfcS[email protected] static uint16_t hci_acl_packet_types_for_buffer_size_and_local_features(uint16_t buffer_size, uint8_t * local_supported_features){
135165389bfcS[email protected]     // enable packet types based on size
13528f8108aaSmatthias.ringwald     uint16_t packet_types = 0;
1353f16a69bbS[email protected]     unsigned int i;
13548f8108aaSmatthias.ringwald     for (i=0;i<16;i++){
135529e39de4SMatthias Ringwald         if (hci_acl_packet_type_sizes[i] == 0) continue;
135629e39de4SMatthias Ringwald         if (hci_acl_packet_type_sizes[i] <= buffer_size){
13578f8108aaSmatthias.ringwald             packet_types |= 1 << i;
13588f8108aaSmatthias.ringwald         }
13598f8108aaSmatthias.ringwald     }
136065389bfcS[email protected]     // disable packet types due to missing local supported features
136129e39de4SMatthias Ringwald     for (i=0;i<sizeof(hci_acl_packet_type_feature_requirement_bit); i++){
136229e39de4SMatthias Ringwald         unsigned int bit_idx = hci_acl_packet_type_feature_requirement_bit[i];
136365389bfcS[email protected]         int feature_set = (local_supported_features[bit_idx >> 3] & (1<<(bit_idx & 7))) != 0;
136465389bfcS[email protected]         if (feature_set) continue;
136529e39de4SMatthias Ringwald         log_info("Features bit %02u is not set, removing packet types 0x%04x", bit_idx, hci_acl_packet_type_feature_packet_mask[i]);
136629e39de4SMatthias Ringwald         packet_types &= ~hci_acl_packet_type_feature_packet_mask[i];
136765389bfcS[email protected]     }
13688f8108aaSmatthias.ringwald     return packet_types;
13698f8108aaSmatthias.ringwald }
13708f8108aaSmatthias.ringwald 
13718f8108aaSmatthias.ringwald uint16_t hci_usable_acl_packet_types(void){
1372028ead5eSMatthias Ringwald     uint16_t active_packet_types = (hci_stack->usable_packet_types_acl &  hci_stack->enabled_packet_types_acl);
137329e39de4SMatthias Ringwald     // flip bits for "may not be used"
1374028ead5eSMatthias Ringwald     return  active_packet_types ^ 0x3306;
1375028ead5eSMatthias Ringwald }
1376028ead5eSMatthias Ringwald 
1377028ead5eSMatthias Ringwald void hci_enable_acl_packet_types(uint16_t packet_types){
1378028ead5eSMatthias Ringwald     hci_stack->enabled_packet_types_acl = packet_types;
13798f8108aaSmatthias.ringwald }
138029e39de4SMatthias Ringwald 
1381c92ca2c8SMatthias Ringwald static const struct {
1382c92ca2c8SMatthias Ringwald     uint8_t feature_index;
1383c92ca2c8SMatthias Ringwald     uint16_t feature_packet_mask;
1384c92ca2c8SMatthias Ringwald } hci_sco_packet_type_feature_requirements[] = {
1385c92ca2c8SMatthias Ringwald         { 12, SCO_PACKET_TYPES_HV2 },                           // HV2 packets
1386c92ca2c8SMatthias Ringwald         { 13, SCO_PACKET_TYPES_HV3 },                           // HV3 packets
1387c92ca2c8SMatthias Ringwald         { 31, SCO_PACKET_TYPES_ESCO },                          // eSCO links (EV3 packets)
1388c92ca2c8SMatthias Ringwald         { 32, SCO_PACKET_TYPES_EV4 },                           // EV4 packets
1389c92ca2c8SMatthias Ringwald         { 45, SCO_PACKET_TYPES_2EV3 | SCO_PACKET_TYPES_2EV5 },  // EDR eSCO 2 Mb/s
1390c92ca2c8SMatthias Ringwald         { 46, SCO_PACKET_TYPES_3EV3 | SCO_PACKET_TYPES_3EV5 },  // EDR eSCO 3 Mb/s
13916afff830SMatthias Ringwald         { 47, SCO_PACKET_TYPES_2EV5 | SCO_PACKET_TYPES_3EV5 },  // 3-slot EDR eSCO packets, 2-EV3/3-EV3 use single slot
1392c92ca2c8SMatthias Ringwald };
1393c92ca2c8SMatthias Ringwald 
1394d7891039SMatthias Ringwald // map packet types to payload length, prefer eSCO over SCO and large over small packets
1395d7891039SMatthias Ringwald static const struct {
1396d7891039SMatthias Ringwald     uint16_t type;
1397d7891039SMatthias Ringwald     uint16_t payload_length;
1398d7891039SMatthias Ringwald } hci_sco_packet_type_to_payload_length[] = {
1399d7891039SMatthias Ringwald         {SCO_PACKET_TYPES_3EV5, HCI_SCO_3EV5_SIZE}, // 540
1400d7891039SMatthias Ringwald         {SCO_PACKET_TYPES_2EV5, HCI_SCO_2EV5_SIZE}, // 360
1401d7891039SMatthias Ringwald         {SCO_PACKET_TYPES_EV5,  HCI_SCO_EV5_SIZE},  // 180
1402d7891039SMatthias Ringwald         {SCO_PACKET_TYPES_EV4,  HCI_SCO_EV4_SIZE},  // 120
1403d7891039SMatthias Ringwald         {SCO_PACKET_TYPES_3EV3, HCI_SCO_3EV3_SIZE}, //  90
1404d7891039SMatthias Ringwald         {SCO_PACKET_TYPES_2EV3, HCI_SCO_2EV3_SIZE}, //  60
1405d7891039SMatthias Ringwald         {SCO_PACKET_TYPES_EV3,  HCI_SCO_EV3_SIZE},  //  30
1406d7891039SMatthias Ringwald         {SCO_PACKET_TYPES_HV3,  HCI_SCO_HV3_SIZE},  //  30
1407d7891039SMatthias Ringwald         {SCO_PACKET_TYPES_HV2,  HCI_SCO_HV2_SIZE},  //  20
1408d7891039SMatthias Ringwald         {SCO_PACKET_TYPES_HV1,  HCI_SCO_HV1_SIZE}   //  10
1409d7891039SMatthias Ringwald };
1410d7891039SMatthias Ringwald 
1411c92ca2c8SMatthias Ringwald static uint16_t hci_sco_packet_types_for_features(const uint8_t * local_supported_features){
1412c92ca2c8SMatthias Ringwald     uint16_t packet_types = SCO_PACKET_TYPES_ALL;
1413c92ca2c8SMatthias Ringwald     unsigned int i;
1414c92ca2c8SMatthias Ringwald     // disable packet types due to missing local supported features
1415c92ca2c8SMatthias Ringwald     for (i=0;i<(sizeof(hci_sco_packet_type_feature_requirements)/sizeof(hci_sco_packet_type_feature_requirements[0])); i++){
1416c92ca2c8SMatthias Ringwald         unsigned int bit_idx = hci_sco_packet_type_feature_requirements[i].feature_index;
1417c92ca2c8SMatthias Ringwald         bool feature_set = (local_supported_features[bit_idx >> 3] & (1<<(bit_idx & 7))) != 0;
1418c92ca2c8SMatthias Ringwald         if (feature_set) continue;
1419c92ca2c8SMatthias Ringwald         log_info("Features bit %02u is not set, removing packet types 0x%04x", bit_idx, hci_sco_packet_type_feature_requirements[i].feature_packet_mask);
1420c92ca2c8SMatthias Ringwald         packet_types &= ~hci_sco_packet_type_feature_requirements[i].feature_packet_mask;
1421c92ca2c8SMatthias Ringwald     }
1422c92ca2c8SMatthias Ringwald     return packet_types;
1423c92ca2c8SMatthias Ringwald }
1424c92ca2c8SMatthias Ringwald 
1425c92ca2c8SMatthias Ringwald uint16_t hci_usable_sco_packet_types(void){
1426c92ca2c8SMatthias Ringwald     return hci_stack->usable_packet_types_sco;
1427c92ca2c8SMatthias Ringwald }
1428c92ca2c8SMatthias Ringwald 
1429d7891039SMatthias Ringwald static uint16_t hci_sco_payload_length_for_packet_types(uint16_t packet_types){
1430d7891039SMatthias Ringwald     uint8_t i;
1431d7891039SMatthias Ringwald     for (i=0;i<sizeof(hci_sco_packet_type_to_payload_length)/sizeof(hci_sco_packet_type_to_payload_length[0]);i++){
1432d7891039SMatthias Ringwald         if ((hci_sco_packet_type_to_payload_length[i].type & packet_types) != 0){
1433d7891039SMatthias Ringwald             return hci_sco_packet_type_to_payload_length[i].payload_length;
1434d7891039SMatthias Ringwald         }
1435d7891039SMatthias Ringwald     }
1436d7891039SMatthias Ringwald     return 0;
1437d7891039SMatthias Ringwald }
1438d7891039SMatthias Ringwald 
143935454696SMatthias Ringwald #endif
14408f8108aaSmatthias.ringwald 
1441facf93fdS[email protected] uint8_t* hci_get_outgoing_packet_buffer(void){
14427dc17943Smatthias.ringwald     // hci packet buffer is >= acl data packet length
14433a9fb326S[email protected]     return hci_stack->hci_packet_buffer;
14447dc17943Smatthias.ringwald }
14457dc17943Smatthias.ringwald 
1446f5d8d141S[email protected] uint16_t hci_max_acl_data_packet_length(void){
14473a9fb326S[email protected]     return hci_stack->acl_data_packet_length;
14487dc17943Smatthias.ringwald }
14497dc17943Smatthias.ringwald 
145006b9e820SMatthias Ringwald #ifdef ENABLE_CLASSIC
145120dcdd22SMatthias Ringwald bool hci_extended_sco_link_supported(void){
14523e68d23dSMatthias Ringwald     // No. 31, byte 3, bit 7
14533e68d23dSMatthias Ringwald     return (hci_stack->local_supported_features[3] & (1 << 7)) != 0;
14543e68d23dSMatthias Ringwald }
145506b9e820SMatthias Ringwald #endif
14563e68d23dSMatthias Ringwald 
145720dcdd22SMatthias Ringwald bool hci_non_flushable_packet_boundary_flag_supported(void){
14586ac9a97eS[email protected]     // No. 54, byte 6, bit 6
14594ea43905SMatthias Ringwald     return (hci_stack->local_supported_features[6u] & (1u << 6u)) != 0u;
14606ac9a97eS[email protected] }
14616ac9a97eS[email protected] 
14629885fb2dSMatthias Ringwald #ifdef ENABLE_CLASSIC
146357514786SMatthias Ringwald static bool gap_ssp_supported(void){
14646ac9a97eS[email protected]     // No. 51, byte 6, bit 3
14654ea43905SMatthias Ringwald     return (hci_stack->local_supported_features[6u] & (1u << 3u)) != 0u;
1466f5d8d141S[email protected] }
14679885fb2dSMatthias Ringwald #endif
1468f5d8d141S[email protected] 
1469ad58a385SMatthias Ringwald bool hci_classic_supported(void){
147035454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
14716ac9a97eS[email protected]     // No. 37, byte 4, bit 5, = No BR/EDR Support
14723a9fb326S[email protected]     return (hci_stack->local_supported_features[4] & (1 << 5)) == 0;
147335454696SMatthias Ringwald #else
147457514786SMatthias Ringwald     return false;
147535454696SMatthias Ringwald #endif
1476f5d8d141S[email protected] }
1477f5d8d141S[email protected] 
1478ad58a385SMatthias Ringwald bool hci_le_supported(void){
1479a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE
14806ac9a97eS[email protected]     // No. 37, byte 4, bit 6 = LE Supported (Controller)
14814ea43905SMatthias Ringwald     return (hci_stack->local_supported_features[4u] & (1u << 6u)) != 0u;
1482f5d8d141S[email protected] #else
148357514786SMatthias Ringwald     return false;
1484f5d8d141S[email protected] #endif
1485f5d8d141S[email protected] }
1486f5d8d141S[email protected] 
14871ffa425cSMatthias Ringwald static bool hci_command_supported(uint8_t command_index){
14881ffa425cSMatthias Ringwald     return (hci_stack->local_supported_commands & (1LU << command_index)) != 0;
14891ffa425cSMatthias Ringwald }
14901ffa425cSMatthias Ringwald 
1491b95a5a35SMatthias Ringwald #ifdef ENABLE_BLE
1492b95a5a35SMatthias Ringwald 
149363671e69SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
149422f987e4SMatthias Ringwald bool hci_le_extended_advertising_supported(void){
149563671e69SMatthias Ringwald     return hci_command_supported(SUPPORTED_HCI_COMMAND_LE_SET_EXTENDED_ADVERTISING_ENABLE);
149663671e69SMatthias Ringwald }
149763671e69SMatthias Ringwald #endif
149863671e69SMatthias Ringwald 
1499f5873674SMatthias Ringwald static void hci_get_own_address_for_addr_type(uint8_t own_addr_type, bd_addr_t own_addr){
15006bcfa632SMatthias Ringwald     if (own_addr_type == BD_ADDR_TYPE_LE_PUBLIC){
15016bcfa632SMatthias Ringwald         (void)memcpy(own_addr, hci_stack->local_bd_addr, 6);
150269a97523S[email protected]     } else {
15036bcfa632SMatthias Ringwald         (void)memcpy(own_addr, hci_stack->le_random_address, 6);
150469a97523S[email protected]     }
150569a97523S[email protected] }
150669a97523S[email protected] 
15076bcfa632SMatthias Ringwald void gap_le_get_own_address(uint8_t * addr_type, bd_addr_t addr){
15086bcfa632SMatthias Ringwald     *addr_type = hci_stack->le_own_addr_type;
15096bcfa632SMatthias Ringwald     hci_get_own_address_for_addr_type(hci_stack->le_own_addr_type, addr);
15106bcfa632SMatthias Ringwald }
15116bcfa632SMatthias Ringwald 
15126bcfa632SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
15136bcfa632SMatthias Ringwald void gap_le_get_own_advertisements_address(uint8_t * addr_type, bd_addr_t addr){
15146bcfa632SMatthias Ringwald     *addr_type = hci_stack->le_advertisements_own_addr_type;
15156bcfa632SMatthias Ringwald     hci_get_own_address_for_addr_type(hci_stack->le_advertisements_own_addr_type, addr);
15166bcfa632SMatthias Ringwald };
1517efc77985SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
1518efc77985SMatthias Ringwald void gap_le_get_own_advertising_set_address(uint8_t * addr_type, bd_addr_t addr, uint8_t advertising_handle){
1519efc77985SMatthias Ringwald     if (advertising_handle == 0){
1520efc77985SMatthias Ringwald         gap_le_get_own_advertisements_address(addr_type, addr);
1521efc77985SMatthias Ringwald     } else {
1522efc77985SMatthias Ringwald         le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(advertising_handle);
1523efc77985SMatthias Ringwald         if (advertising_set != NULL){
1524efc77985SMatthias Ringwald             switch (advertising_set->extended_params.own_address_type){
1525efc77985SMatthias Ringwald                 case BD_ADDR_TYPE_LE_PUBLIC:
1526efc77985SMatthias Ringwald                     *addr_type = BD_ADDR_TYPE_LE_PUBLIC;
1527efc77985SMatthias Ringwald                     memcpy(addr, hci_stack->local_bd_addr, 6);
1528efc77985SMatthias Ringwald                     break;
1529efc77985SMatthias Ringwald                 case BD_ADDR_TYPE_LE_RANDOM:
1530efc77985SMatthias Ringwald                     *addr_type = BD_ADDR_TYPE_LE_RANDOM;
1531efc77985SMatthias Ringwald                     memcpy(addr, advertising_set->random_address, 6);
1532efc77985SMatthias Ringwald                     break;
1533efc77985SMatthias Ringwald                 case BD_ADDR_TYPE_LE_PUBLIC_IDENTITY:
1534efc77985SMatthias Ringwald                 case BD_ADDR_TYPE_LE_RANDOM_IDENTITY:
1535efc77985SMatthias Ringwald                     // do nothing as random address was already set from enhanced connection complete
1536efc77985SMatthias Ringwald                     break;
1537efc77985SMatthias Ringwald                 default:
1538efc77985SMatthias Ringwald                     break;
1539efc77985SMatthias Ringwald             }
1540efc77985SMatthias Ringwald         }
1541efc77985SMatthias Ringwald     }
1542efc77985SMatthias Ringwald };
1543efc77985SMatthias Ringwald #endif
15446bcfa632SMatthias Ringwald #endif
15456bcfa632SMatthias Ringwald 
1546e8c8828eSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
15476bcfa632SMatthias Ringwald 
15486bcfa632SMatthias Ringwald /**
15496bcfa632SMatthias Ringwald  * @brief Get own addr type and address used for LE connections (Central)
15506bcfa632SMatthias Ringwald  */
15516bcfa632SMatthias Ringwald void gap_le_get_own_connection_address(uint8_t * addr_type, bd_addr_t addr){
15526bcfa632SMatthias Ringwald     *addr_type = hci_stack->le_connection_own_addr_type;
15536bcfa632SMatthias Ringwald     hci_get_own_address_for_addr_type(hci_stack->le_connection_own_addr_type, addr);
15546bcfa632SMatthias Ringwald }
15556bcfa632SMatthias Ringwald 
1556384b59deSMatthias Ringwald void le_handle_advertisement_report(uint8_t *packet, uint16_t size){
15579ec2630cSMatthias Ringwald 
1558a0698cb4SMatthias Ringwald     uint16_t offset = 3;
1559a0698cb4SMatthias Ringwald     uint8_t num_reports = packet[offset];
1560d1dc057bS[email protected]     offset += 1;
1561d1dc057bS[email protected] 
1562a0698cb4SMatthias Ringwald     uint16_t i;
156303fbe9c6S[email protected]     uint8_t event[12 + LE_ADVERTISING_DATA_SIZE]; // use upper bound to avoid var size automatic var
1564a1df452eSMatthias Ringwald     for (i=0; (i<num_reports) && (offset < size);i++){
156533e6948bSMatthias Ringwald         // sanity checks on data_length:
156633e6948bSMatthias Ringwald         uint8_t data_length = packet[offset + 8];
156733e6948bSMatthias Ringwald         if (data_length > LE_ADVERTISING_DATA_SIZE) return;
15684ea43905SMatthias Ringwald         if ((offset + 9u + data_length + 1u) > size)    return;
156933e6948bSMatthias Ringwald         // setup event
15704ea43905SMatthias Ringwald         uint8_t event_size = 10u + data_length;
1571a0698cb4SMatthias Ringwald         uint16_t pos = 0;
1572045013feSMatthias Ringwald         event[pos++] = GAP_EVENT_ADVERTISING_REPORT;
157357c9da5bS[email protected]         event[pos++] = event_size;
15746535961aSMatthias Ringwald         (void)memcpy(&event[pos], &packet[offset], 1 + 1 + 6); // event type + address type + address
1575d1dc057bS[email protected]         offset += 8;
1576d1dc057bS[email protected]         pos += 8;
1577d1dc057bS[email protected]         event[pos++] = packet[offset + 1 + data_length]; // rssi
157833e6948bSMatthias Ringwald         event[pos++] = data_length;
157933e6948bSMatthias Ringwald         offset++;
15806535961aSMatthias Ringwald         (void)memcpy(&event[pos], &packet[offset], data_length);
158157c9da5bS[email protected]         pos +=    data_length;
15824ea43905SMatthias Ringwald         offset += data_length + 1u; // rssi
1583d6b06661SMatthias Ringwald         hci_emit_event(event, pos, 1);
158457c9da5bS[email protected]     }
158557c9da5bS[email protected] }
1586a0698cb4SMatthias Ringwald 
1587a0698cb4SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
1588033393eeSBob Abeles static void le_handle_extended_advertisement_report(uint8_t *packet, uint16_t size) {
1589a0698cb4SMatthias Ringwald     uint16_t offset = 3;
1590a0698cb4SMatthias Ringwald     uint8_t num_reports = packet[offset++];
1591c95a0fc7SMatthias Ringwald     uint8_t event[2 + 255]; // use upper bound to avoid var size automatic var
1592a0698cb4SMatthias Ringwald     uint8_t i;
1593a0698cb4SMatthias Ringwald     for (i=0; (i<num_reports) && (offset < size);i++){
1594a0698cb4SMatthias Ringwald         // sanity checks on data_length:
1595a0698cb4SMatthias Ringwald         uint16_t data_length = packet[offset + 23];
159643ce0351SMatthias Ringwald         if (data_length > LE_EXTENDED_ADVERTISING_DATA_SIZE) return;
1597a0698cb4SMatthias Ringwald         if ((offset + 24u + data_length) > size)    return;
1598a0698cb4SMatthias Ringwald         uint16_t event_type = little_endian_read_16(packet, offset);
1599a0698cb4SMatthias Ringwald         offset += 2;
1600a0698cb4SMatthias Ringwald         if ((event_type & 0x10) != 0) {
1601a0698cb4SMatthias Ringwald            // setup legacy event
1602a0698cb4SMatthias Ringwald             uint8_t legacy_event_type;
1603a0698cb4SMatthias Ringwald             switch (event_type){
1604a0698cb4SMatthias Ringwald                 case 0b0010011:
1605a0698cb4SMatthias Ringwald                     // ADV_IND
1606a0698cb4SMatthias Ringwald                     legacy_event_type = 0;
1607a0698cb4SMatthias Ringwald                     break;
1608a0698cb4SMatthias Ringwald                 case 0b0010101:
1609a0698cb4SMatthias Ringwald                     // ADV_DIRECT_IND
1610a0698cb4SMatthias Ringwald                     legacy_event_type = 1;
1611a0698cb4SMatthias Ringwald                     break;
1612a0698cb4SMatthias Ringwald                 case 0b0010010:
1613a0698cb4SMatthias Ringwald                     // ADV_SCAN_IND
1614a0698cb4SMatthias Ringwald                     legacy_event_type = 2;
1615a0698cb4SMatthias Ringwald                     break;
1616a0698cb4SMatthias Ringwald                 case 0b0010000:
1617a0698cb4SMatthias Ringwald                     // ADV_NONCONN_IND
1618a0698cb4SMatthias Ringwald                     legacy_event_type = 3;
1619a0698cb4SMatthias Ringwald                     break;
1620a0698cb4SMatthias Ringwald                 case 0b0011011:
1621a0698cb4SMatthias Ringwald                 case 0b0011010:
1622a0698cb4SMatthias Ringwald                     // SCAN_RSP
1623a0698cb4SMatthias Ringwald                     legacy_event_type = 4;
1624a0698cb4SMatthias Ringwald                     break;
1625a0698cb4SMatthias Ringwald                 default:
1626a0698cb4SMatthias Ringwald                     legacy_event_type = 0;
1627a0698cb4SMatthias Ringwald                     break;
1628a0698cb4SMatthias Ringwald             }
1629a0698cb4SMatthias Ringwald             uint16_t pos = 0;
1630a0698cb4SMatthias Ringwald             event[pos++] = GAP_EVENT_ADVERTISING_REPORT;
1631a0698cb4SMatthias Ringwald             event[pos++] = 10u + data_length;
1632a0698cb4SMatthias Ringwald             event[pos++] = legacy_event_type;
1633a0698cb4SMatthias Ringwald             // copy address type + address
1634a0698cb4SMatthias Ringwald             (void) memcpy(&event[pos], &packet[offset], 1 + 6);
1635a0698cb4SMatthias Ringwald             offset += 7;
1636a0698cb4SMatthias Ringwald             pos += 7;
1637a0698cb4SMatthias Ringwald             // skip primary_phy, secondary_phy, advertising_sid, tx_power
1638a0698cb4SMatthias Ringwald             offset += 4;
1639a0698cb4SMatthias Ringwald             // copy rssi
1640a0698cb4SMatthias Ringwald             event[pos++] = packet[offset++];
1641a0698cb4SMatthias Ringwald             // skip periodic advertising interval and direct address
1642a0698cb4SMatthias Ringwald             offset += 9;
1643a0698cb4SMatthias Ringwald             // copy data len + data;
1644a0698cb4SMatthias Ringwald             (void) memcpy(&event[pos], &packet[offset], 1 + data_length);
1645a0698cb4SMatthias Ringwald             pos    += 1 +data_length;
1646a0698cb4SMatthias Ringwald             offset += 1+ data_length;
1647a0698cb4SMatthias Ringwald             hci_emit_event(event, pos, 1);
1648a0698cb4SMatthias Ringwald         } else {
1649c95a0fc7SMatthias Ringwald             event[0] = GAP_EVENT_EXTENDED_ADVERTISING_REPORT;
1650c95a0fc7SMatthias Ringwald             uint8_t report_len = 24 + data_length;
1651c95a0fc7SMatthias Ringwald             event[1] = report_len;
16520f7610adSMatthias Ringwald             little_endian_store_16(event, 2, event_type);
16530f7610adSMatthias Ringwald             memcpy(&event[4], &packet[offset], report_len);
1654c95a0fc7SMatthias Ringwald             offset += report_len;
1655c95a0fc7SMatthias Ringwald             hci_emit_event(event, 2 + report_len, 1);
1656a0698cb4SMatthias Ringwald         }
1657a0698cb4SMatthias Ringwald     }
1658a0698cb4SMatthias Ringwald }
1659a0698cb4SMatthias Ringwald #endif
1660a0698cb4SMatthias Ringwald 
1661b2f949feS[email protected] #endif
1662e8c8828eSMatthias Ringwald #endif
166357c9da5bS[email protected] 
16642b6ab3e6SMatthias Ringwald #ifdef ENABLE_BLE
16652b6ab3e6SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
1666bbc366e6SMatthias Ringwald static void hci_update_advertisements_enabled_for_current_roles(void){
1667a408e724SMatthias Ringwald     if ((hci_stack->le_advertisements_state & LE_ADVERTISEMENT_STATE_ENABLED) != 0){
16682b6ab3e6SMatthias Ringwald         // get number of active le slave connections
16692b6ab3e6SMatthias Ringwald         int num_slave_connections = 0;
16702b6ab3e6SMatthias Ringwald         btstack_linked_list_iterator_t it;
16712b6ab3e6SMatthias Ringwald         btstack_linked_list_iterator_init(&it, &hci_stack->connections);
16722b6ab3e6SMatthias Ringwald         while (btstack_linked_list_iterator_has_next(&it)){
16732b6ab3e6SMatthias Ringwald             hci_connection_t * con = (hci_connection_t*) btstack_linked_list_iterator_next(&it);
16742b6ab3e6SMatthias Ringwald             log_info("state %u, role %u, le_con %u", con->state, con->role, hci_is_le_connection(con));
16752b6ab3e6SMatthias Ringwald             if (con->state != OPEN) continue;
16762b6ab3e6SMatthias Ringwald             if (con->role  != HCI_ROLE_SLAVE) continue;
16772b6ab3e6SMatthias Ringwald             if (!hci_is_le_connection(con)) continue;
16782b6ab3e6SMatthias Ringwald             num_slave_connections++;
16792b6ab3e6SMatthias Ringwald         }
16802b6ab3e6SMatthias Ringwald         log_info("Num LE Peripheral roles: %u of %u", num_slave_connections, hci_stack->le_max_number_peripheral_connections);
1681bbc366e6SMatthias Ringwald         hci_stack->le_advertisements_enabled_for_current_roles = num_slave_connections < hci_stack->le_max_number_peripheral_connections;
1682bbc366e6SMatthias Ringwald     } else {
1683bbc366e6SMatthias Ringwald         hci_stack->le_advertisements_enabled_for_current_roles = false;
16842b6ab3e6SMatthias Ringwald     }
16852b6ab3e6SMatthias Ringwald }
16862b6ab3e6SMatthias Ringwald #endif
16872b6ab3e6SMatthias Ringwald #endif
16882b6ab3e6SMatthias Ringwald 
168959d59ecfSMatthias Ringwald #ifdef ENABLE_CLASSIC
169059d59ecfSMatthias Ringwald static void gap_run_set_local_name(void){
169159d59ecfSMatthias Ringwald     hci_reserve_packet_buffer();
169259d59ecfSMatthias Ringwald     uint8_t * packet = hci_stack->hci_packet_buffer;
169359d59ecfSMatthias Ringwald     // construct HCI Command and send
169459d59ecfSMatthias Ringwald     uint16_t opcode = hci_write_local_name.opcode;
169559d59ecfSMatthias Ringwald     packet[0] = opcode & 0xff;
169659d59ecfSMatthias Ringwald     packet[1] = opcode >> 8;
169759d59ecfSMatthias Ringwald     packet[2] = DEVICE_NAME_LEN;
169859d59ecfSMatthias Ringwald     memset(&packet[3], 0, DEVICE_NAME_LEN);
169959d59ecfSMatthias Ringwald     uint16_t name_len = (uint16_t) strlen(hci_stack->local_name);
170059d59ecfSMatthias Ringwald     uint16_t bytes_to_copy = btstack_min(name_len, DEVICE_NAME_LEN);
170159d59ecfSMatthias Ringwald     // if shorter than DEVICE_NAME_LEN, it's implicitly NULL-terminated by memset call
170259d59ecfSMatthias Ringwald     (void)memcpy(&packet[3], hci_stack->local_name, bytes_to_copy);
170359d59ecfSMatthias Ringwald     // expand '00:00:00:00:00:00' in name with bd_addr
170459d59ecfSMatthias Ringwald     btstack_replace_bd_addr_placeholder(&packet[3], bytes_to_copy, hci_stack->local_bd_addr);
1705ca6804fdSMatthias Ringwald     hci_send_prepared_cmd_packet();
170659d59ecfSMatthias Ringwald }
170759d59ecfSMatthias Ringwald 
170859d59ecfSMatthias Ringwald static void gap_run_set_eir_data(void){
170959d59ecfSMatthias Ringwald     hci_reserve_packet_buffer();
171059d59ecfSMatthias Ringwald     uint8_t * packet = hci_stack->hci_packet_buffer;
171159d59ecfSMatthias Ringwald     // construct HCI Command in-place and send
171259d59ecfSMatthias Ringwald     uint16_t opcode = hci_write_extended_inquiry_response.opcode;
171359d59ecfSMatthias Ringwald     uint16_t offset = 0;
171459d59ecfSMatthias Ringwald     packet[offset++] = opcode & 0xff;
171559d59ecfSMatthias Ringwald     packet[offset++] = opcode >> 8;
171659d59ecfSMatthias Ringwald     packet[offset++] = 1 + EXTENDED_INQUIRY_RESPONSE_DATA_LEN;
171759d59ecfSMatthias Ringwald     packet[offset++] = 0;  // FEC not required
171859d59ecfSMatthias Ringwald     memset(&packet[offset], 0, EXTENDED_INQUIRY_RESPONSE_DATA_LEN);
171959d59ecfSMatthias Ringwald     if (hci_stack->eir_data){
172059d59ecfSMatthias Ringwald         // copy items and expand '00:00:00:00:00:00' in name with bd_addr
172159d59ecfSMatthias Ringwald         ad_context_t context;
172259d59ecfSMatthias Ringwald         for (ad_iterator_init(&context, EXTENDED_INQUIRY_RESPONSE_DATA_LEN, hci_stack->eir_data) ; ad_iterator_has_more(&context) ; ad_iterator_next(&context)) {
172359d59ecfSMatthias Ringwald             uint8_t data_type   = ad_iterator_get_data_type(&context);
172459d59ecfSMatthias Ringwald             uint8_t size        = ad_iterator_get_data_len(&context);
172559d59ecfSMatthias Ringwald             const uint8_t *data = ad_iterator_get_data(&context);
172659d59ecfSMatthias Ringwald             // copy item
172759d59ecfSMatthias Ringwald             packet[offset++] = size + 1;
172859d59ecfSMatthias Ringwald             packet[offset++] = data_type;
172959d59ecfSMatthias Ringwald             memcpy(&packet[offset], data, size);
173059d59ecfSMatthias Ringwald             // update name item
173159d59ecfSMatthias Ringwald             if ((data_type == BLUETOOTH_DATA_TYPE_SHORTENED_LOCAL_NAME) || (data_type == BLUETOOTH_DATA_TYPE_COMPLETE_LOCAL_NAME)){
173259d59ecfSMatthias Ringwald                 btstack_replace_bd_addr_placeholder(&packet[offset], size, hci_stack->local_bd_addr);
173359d59ecfSMatthias Ringwald             }
173459d59ecfSMatthias Ringwald             offset += size;
173559d59ecfSMatthias Ringwald         }
173659d59ecfSMatthias Ringwald     } else {
173759d59ecfSMatthias Ringwald         uint16_t name_len = (uint16_t) strlen(hci_stack->local_name);
173859d59ecfSMatthias Ringwald         uint16_t bytes_to_copy = btstack_min(name_len, EXTENDED_INQUIRY_RESPONSE_DATA_LEN - 2);
173959d59ecfSMatthias Ringwald         packet[offset++] = bytes_to_copy + 1;
174059d59ecfSMatthias Ringwald         packet[offset++] = BLUETOOTH_DATA_TYPE_COMPLETE_LOCAL_NAME;
174159d59ecfSMatthias Ringwald         (void)memcpy(&packet[6], hci_stack->local_name, bytes_to_copy);
174259d59ecfSMatthias Ringwald         // expand '00:00:00:00:00:00' in name with bd_addr
174359d59ecfSMatthias Ringwald         btstack_replace_bd_addr_placeholder(&packet[offset], bytes_to_copy, hci_stack->local_bd_addr);
174459d59ecfSMatthias Ringwald     }
1745ca6804fdSMatthias Ringwald     hci_send_prepared_cmd_packet();
174659d59ecfSMatthias Ringwald }
1747ab4831a3SMatthias Ringwald 
1748ab4831a3SMatthias Ringwald static void hci_run_gap_tasks_classic(void){
1749baa4881eSMatthias Ringwald     if ((hci_stack->gap_tasks_classic & GAP_TASK_SET_CLASS_OF_DEVICE) != 0) {
1750baa4881eSMatthias Ringwald         hci_stack->gap_tasks_classic &= ~GAP_TASK_SET_CLASS_OF_DEVICE;
1751ab4831a3SMatthias Ringwald         hci_send_cmd(&hci_write_class_of_device, hci_stack->class_of_device);
1752ab4831a3SMatthias Ringwald         return;
1753ab4831a3SMatthias Ringwald     }
1754baa4881eSMatthias Ringwald     if ((hci_stack->gap_tasks_classic & GAP_TASK_SET_LOCAL_NAME) != 0) {
1755baa4881eSMatthias Ringwald         hci_stack->gap_tasks_classic &= ~GAP_TASK_SET_LOCAL_NAME;
1756ab4831a3SMatthias Ringwald         gap_run_set_local_name();
1757ab4831a3SMatthias Ringwald         return;
1758ab4831a3SMatthias Ringwald     }
1759baa4881eSMatthias Ringwald     if ((hci_stack->gap_tasks_classic & GAP_TASK_SET_EIR_DATA) != 0) {
1760baa4881eSMatthias Ringwald         hci_stack->gap_tasks_classic &= ~GAP_TASK_SET_EIR_DATA;
1761ab4831a3SMatthias Ringwald         gap_run_set_eir_data();
1762ab4831a3SMatthias Ringwald         return;
1763ab4831a3SMatthias Ringwald     }
1764baa4881eSMatthias Ringwald     if ((hci_stack->gap_tasks_classic & GAP_TASK_SET_DEFAULT_LINK_POLICY) != 0) {
1765baa4881eSMatthias Ringwald         hci_stack->gap_tasks_classic &= ~GAP_TASK_SET_DEFAULT_LINK_POLICY;
1766ab4831a3SMatthias Ringwald         hci_send_cmd(&hci_write_default_link_policy_setting, hci_stack->default_link_policy_settings);
1767ab4831a3SMatthias Ringwald         return;
1768ab4831a3SMatthias Ringwald     }
1769ab4831a3SMatthias Ringwald     // write page scan activity
1770baa4881eSMatthias Ringwald     if ((hci_stack->gap_tasks_classic & GAP_TASK_WRITE_PAGE_SCAN_ACTIVITY) != 0) {
1771baa4881eSMatthias Ringwald         hci_stack->gap_tasks_classic &= ~GAP_TASK_WRITE_PAGE_SCAN_ACTIVITY;
1772ab4831a3SMatthias Ringwald         hci_send_cmd(&hci_write_page_scan_activity, hci_stack->new_page_scan_interval, hci_stack->new_page_scan_window);
1773ab4831a3SMatthias Ringwald         return;
1774ab4831a3SMatthias Ringwald     }
1775ab4831a3SMatthias Ringwald     // write page scan type
1776baa4881eSMatthias Ringwald     if ((hci_stack->gap_tasks_classic & GAP_TASK_WRITE_PAGE_SCAN_TYPE) != 0) {
1777baa4881eSMatthias Ringwald         hci_stack->gap_tasks_classic &= ~GAP_TASK_WRITE_PAGE_SCAN_TYPE;
1778ab4831a3SMatthias Ringwald         hci_send_cmd(&hci_write_page_scan_type, hci_stack->new_page_scan_type);
1779ab4831a3SMatthias Ringwald         return;
1780ab4831a3SMatthias Ringwald     }
178132a12730SMatthias Ringwald     // write page timeout
1782baa4881eSMatthias Ringwald     if ((hci_stack->gap_tasks_classic & GAP_TASK_WRITE_PAGE_TIMEOUT) != 0) {
1783baa4881eSMatthias Ringwald         hci_stack->gap_tasks_classic &= ~GAP_TASK_WRITE_PAGE_TIMEOUT;
178432a12730SMatthias Ringwald         hci_send_cmd(&hci_write_page_timeout, hci_stack->page_timeout);
178532a12730SMatthias Ringwald         return;
178632a12730SMatthias Ringwald     }
1787ab4831a3SMatthias Ringwald     // send scan enable
1788baa4881eSMatthias Ringwald     if ((hci_stack->gap_tasks_classic & GAP_TASK_WRITE_SCAN_ENABLE) != 0) {
1789baa4881eSMatthias Ringwald         hci_stack->gap_tasks_classic &= ~GAP_TASK_WRITE_SCAN_ENABLE;
1790ab4831a3SMatthias Ringwald         hci_send_cmd(&hci_write_scan_enable, hci_stack->new_scan_enable_value);
1791ab4831a3SMatthias Ringwald         return;
1792ab4831a3SMatthias Ringwald     }
1793c0c8a829SMatthias Ringwald     // send write scan activity
1794baa4881eSMatthias Ringwald     if ((hci_stack->gap_tasks_classic & GAP_TASK_WRITE_INQUIRY_SCAN_ACTIVITY) != 0) {
1795baa4881eSMatthias Ringwald         hci_stack->gap_tasks_classic &= ~GAP_TASK_WRITE_INQUIRY_SCAN_ACTIVITY;
1796c0c8a829SMatthias Ringwald         hci_send_cmd(&hci_write_inquiry_scan_activity, hci_stack->inquiry_scan_interval, hci_stack->inquiry_scan_window);
1797c0c8a829SMatthias Ringwald         return;
1798c0c8a829SMatthias Ringwald     }
1799f50ed5acSAndrey Fominykh     // send write inquiry transmit power level
1800f50ed5acSAndrey Fominykh     if ((hci_stack->gap_tasks_classic & GAP_TASK_WRITE_INQUIRY_TX_POWER_LEVEL) != 0) {
1801f50ed5acSAndrey Fominykh         hci_stack->gap_tasks_classic &= ~GAP_TASK_WRITE_INQUIRY_TX_POWER_LEVEL;
1802f50ed5acSAndrey Fominykh         hci_send_cmd(&hci_write_inquiry_transmit_power_level, hci_stack->inquiry_tx_power_level);
1803f50ed5acSAndrey Fominykh         return;
1804f50ed5acSAndrey Fominykh     }
1805ab4831a3SMatthias Ringwald }
180659d59ecfSMatthias Ringwald #endif
180759d59ecfSMatthias Ringwald 
18086fad2c37SMatthias Ringwald #ifndef HAVE_HOST_CONTROLLER_API
180906b9e820SMatthias Ringwald 
181096b53536SMatthias Ringwald static uint32_t hci_transport_uart_get_main_baud_rate(void){
181196b53536SMatthias Ringwald     if (!hci_stack->config) return 0;
18129796ebeaSMatthias Ringwald     uint32_t baud_rate = ((hci_transport_config_uart_t *)hci_stack->config)->baudrate_main;
181396b53536SMatthias Ringwald     // Limit baud rate for Broadcom chipsets to 3 mbps
1814a1df452eSMatthias Ringwald     if ((hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_BROADCOM_CORPORATION) && (baud_rate > 3000000)){
181596b53536SMatthias Ringwald         baud_rate = 3000000;
181696b53536SMatthias Ringwald     }
181796b53536SMatthias Ringwald     return baud_rate;
181896b53536SMatthias Ringwald }
181996b53536SMatthias Ringwald 
1820ec820d77SMatthias Ringwald static void hci_initialization_timeout_handler(btstack_timer_source_t * ds){
18219ec2630cSMatthias Ringwald     UNUSED(ds);
18229ec2630cSMatthias Ringwald 
18230305bdeaSMatthias Ringwald     switch (hci_stack->substate){
18240305bdeaSMatthias Ringwald         case HCI_INIT_W4_SEND_RESET:
18257b0d7667SMatthias Ringwald             log_info("Resend HCI Reset");
18260305bdeaSMatthias Ringwald             hci_stack->substate = HCI_INIT_SEND_RESET;
18277b0d7667SMatthias Ringwald             hci_stack->num_cmd_packets = 1;
18280305bdeaSMatthias Ringwald             hci_run();
18290305bdeaSMatthias Ringwald             break;
18309f007422SMatthias Ringwald         case HCI_INIT_W4_CUSTOM_INIT_CSR_WARM_BOOT_LINK_RESET:
18319f007422SMatthias Ringwald             log_info("Resend HCI Reset - CSR Warm Boot with Link Reset");
18329f007422SMatthias Ringwald             if (hci_stack->hci_transport->reset_link){
18339f007422SMatthias Ringwald                 hci_stack->hci_transport->reset_link();
18349f007422SMatthias Ringwald             }
1835cf373d3aSMatthias Ringwald 
1836cf373d3aSMatthias Ringwald             /* fall through */
1837cf373d3aSMatthias Ringwald 
1838e47e68c7SMatthias Ringwald         case HCI_INIT_W4_CUSTOM_INIT_CSR_WARM_BOOT:
1839e47e68c7SMatthias Ringwald             log_info("Resend HCI Reset - CSR Warm Boot");
1840e47e68c7SMatthias Ringwald             hci_stack->substate = HCI_INIT_SEND_RESET_CSR_WARM_BOOT;
1841e47e68c7SMatthias Ringwald             hci_stack->num_cmd_packets = 1;
1842e47e68c7SMatthias Ringwald             hci_run();
1843688c2635SMatthias Ringwald             break;
18447224be7eSMatthias Ringwald         case HCI_INIT_W4_SEND_BAUD_CHANGE:
18457224be7eSMatthias Ringwald             if (hci_stack->hci_transport->set_baudrate){
184696b53536SMatthias Ringwald                 uint32_t baud_rate = hci_transport_uart_get_main_baud_rate();
1847cd724cb7SMatthias Ringwald                 log_info("Local baud rate change to %" PRIu32 "(timeout handler)", baud_rate);
18487dd9d0ecSMatthias Ringwald                 hci_stack->hci_transport->set_baudrate(baud_rate);
18497224be7eSMatthias Ringwald             }
1850834bce8cSMatthias Ringwald             // For CSR, HCI Reset is sent on new baud rate. Don't forget to reset link for H5/BCSP
185161f37892SMatthias Ringwald             if (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_CAMBRIDGE_SILICON_RADIO){
1852834bce8cSMatthias Ringwald                 if (hci_stack->hci_transport->reset_link){
1853834bce8cSMatthias Ringwald                     log_info("Link Reset");
1854834bce8cSMatthias Ringwald                     hci_stack->hci_transport->reset_link();
1855834bce8cSMatthias Ringwald                 }
1856772a36d3SMatthias Ringwald                 hci_stack->substate = HCI_INIT_SEND_RESET_CSR_WARM_BOOT;
1857772a36d3SMatthias Ringwald                 hci_run();
1858772a36d3SMatthias Ringwald             }
18594696bddbSMatthias Ringwald             break;
1860559961d0SMatthias Ringwald         case HCI_INIT_W4_CUSTOM_INIT_BCM_DELAY:
1861559961d0SMatthias Ringwald             // otherwise continue
1862559961d0SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_READ_LOCAL_SUPPORTED_COMMANDS;
1863559961d0SMatthias Ringwald             hci_send_cmd(&hci_read_local_supported_commands);
1864559961d0SMatthias Ringwald             break;
18650305bdeaSMatthias Ringwald         default:
18660305bdeaSMatthias Ringwald             break;
18670305bdeaSMatthias Ringwald     }
18680305bdeaSMatthias Ringwald }
186906b9e820SMatthias Ringwald #endif
18700305bdeaSMatthias Ringwald 
187171de195eSMatthias Ringwald static void hci_initializing_next_state(void){
187274b323a9SMatthias Ringwald     hci_stack->substate = (hci_substate_t )( ((int) hci_stack->substate) + 1);
187374b323a9SMatthias Ringwald }
187474b323a9SMatthias Ringwald 
1875f795c86eSMatthias Ringwald static void hci_init_done(void){
1876f795c86eSMatthias Ringwald     // done. tell the app
1877f795c86eSMatthias Ringwald     log_info("hci_init_done -> HCI_STATE_WORKING");
1878f795c86eSMatthias Ringwald     hci_stack->state = HCI_STATE_WORKING;
1879f795c86eSMatthias Ringwald     hci_emit_state();
1880f795c86eSMatthias Ringwald }
1881f795c86eSMatthias Ringwald 
188274b323a9SMatthias Ringwald // assumption: hci_can_send_command_packet_now() == true
188371de195eSMatthias Ringwald static void hci_initializing_run(void){
1884148ca237SMatthias Ringwald     log_debug("hci_initializing_run: substate %u, can send %u", hci_stack->substate, hci_can_send_command_packet_now());
1885f4c579d4SMatthias Ringwald 
18860d37aff3SMatthias Ringwald     if (!hci_can_send_command_packet_now()) return;
18870d37aff3SMatthias Ringwald 
1888f4c579d4SMatthias Ringwald #ifndef HAVE_HOST_CONTROLLER_API
1889f9fd20c2SMatthias Ringwald     bool need_baud_change = hci_stack->config
1890f4c579d4SMatthias Ringwald             && hci_stack->chipset
1891f4c579d4SMatthias Ringwald             && hci_stack->chipset->set_baudrate_command
1892f4c579d4SMatthias Ringwald             && hci_stack->hci_transport->set_baudrate
1893f4c579d4SMatthias Ringwald             && ((hci_transport_config_uart_t *)hci_stack->config)->baudrate_main;
1894f4c579d4SMatthias Ringwald #endif
1895f4c579d4SMatthias Ringwald 
189674b323a9SMatthias Ringwald     switch (hci_stack->substate){
189774b323a9SMatthias Ringwald         case HCI_INIT_SEND_RESET:
189874b323a9SMatthias Ringwald             hci_state_reset();
1899a0cf2f3fSMatthias Ringwald 
19006fad2c37SMatthias Ringwald #ifndef HAVE_HOST_CONTROLLER_API
19010305bdeaSMatthias Ringwald             // prepare reset if command complete not received in 100ms
1902659d758cSMatthias Ringwald             btstack_run_loop_set_timer(&hci_stack->timeout, HCI_RESET_RESEND_TIMEOUT_MS);
1903528a4a3bSMatthias Ringwald             btstack_run_loop_set_timer_handler(&hci_stack->timeout, hci_initialization_timeout_handler);
1904528a4a3bSMatthias Ringwald             btstack_run_loop_add_timer(&hci_stack->timeout);
1905a0cf2f3fSMatthias Ringwald #endif
19060305bdeaSMatthias Ringwald             // send command
190774b323a9SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_SEND_RESET;
19080305bdeaSMatthias Ringwald             hci_send_cmd(&hci_reset);
190974b323a9SMatthias Ringwald             break;
191076fcb19bSMatthias Ringwald         case HCI_INIT_SEND_READ_LOCAL_VERSION_INFORMATION:
191176fcb19bSMatthias Ringwald             hci_send_cmd(&hci_read_local_version_information);
191276fcb19bSMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_SEND_READ_LOCAL_VERSION_INFORMATION;
191376fcb19bSMatthias Ringwald             break;
1914e28e41c0SMatthias Ringwald 
1915e28e41c0SMatthias Ringwald #ifndef HAVE_HOST_CONTROLLER_API
1916e47e68c7SMatthias Ringwald         case HCI_INIT_SEND_RESET_CSR_WARM_BOOT:
1917e47e68c7SMatthias Ringwald             hci_state_reset();
1918e47e68c7SMatthias Ringwald             // prepare reset if command complete not received in 100ms
1919659d758cSMatthias Ringwald             btstack_run_loop_set_timer(&hci_stack->timeout, HCI_RESET_RESEND_TIMEOUT_MS);
1920528a4a3bSMatthias Ringwald             btstack_run_loop_set_timer_handler(&hci_stack->timeout, hci_initialization_timeout_handler);
1921528a4a3bSMatthias Ringwald             btstack_run_loop_add_timer(&hci_stack->timeout);
1922e47e68c7SMatthias Ringwald             // send command
1923e47e68c7SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_CUSTOM_INIT_CSR_WARM_BOOT;
1924e47e68c7SMatthias Ringwald             hci_send_cmd(&hci_reset);
1925e47e68c7SMatthias Ringwald             break;
19268d29070eSMatthias Ringwald         case HCI_INIT_SEND_RESET_ST_WARM_BOOT:
19278d29070eSMatthias Ringwald             hci_state_reset();
19288d29070eSMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_SEND_RESET_ST_WARM_BOOT;
19298d29070eSMatthias Ringwald             hci_send_cmd(&hci_reset);
19308d29070eSMatthias Ringwald             break;
1931f4c579d4SMatthias Ringwald         case HCI_INIT_SEND_BAUD_CHANGE_BCM: {
1932a784d71bSMatthias Ringwald             hci_reserve_packet_buffer();
1933f4c579d4SMatthias Ringwald             uint32_t baud_rate = hci_transport_uart_get_main_baud_rate();
1934f4c579d4SMatthias Ringwald             hci_stack->chipset->set_baudrate_command(baud_rate, hci_stack->hci_packet_buffer);
1935f4c579d4SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_SEND_BAUD_CHANGE_BCM;
1936ca6804fdSMatthias Ringwald             hci_send_prepared_cmd_packet();
1937f4c579d4SMatthias Ringwald             break;
1938f4c579d4SMatthias Ringwald         }
1939c97af506SMatthias Ringwald         case HCI_INIT_SET_BD_ADDR:
1940a784d71bSMatthias Ringwald             hci_reserve_packet_buffer();
1941c97af506SMatthias Ringwald             log_info("Set Public BD ADDR to %s", bd_addr_to_str(hci_stack->custom_bd_addr));
1942c97af506SMatthias Ringwald             hci_stack->chipset->set_bd_addr_command(hci_stack->custom_bd_addr, hci_stack->hci_packet_buffer);
1943c97af506SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_SET_BD_ADDR;
1944ca6804fdSMatthias Ringwald             hci_send_prepared_cmd_packet();
1945c97af506SMatthias Ringwald             break;
19468250c242SMatthias Ringwald         case HCI_INIT_SEND_READ_LOCAL_NAME:
19478250c242SMatthias Ringwald #ifdef ENABLE_CLASSIC
19488250c242SMatthias Ringwald             hci_send_cmd(&hci_read_local_name);
19498250c242SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_SEND_READ_LOCAL_NAME;
19508250c242SMatthias Ringwald             break;
19518250c242SMatthias Ringwald #endif
19528250c242SMatthias Ringwald             /* fall through */
19538250c242SMatthias Ringwald 
1954f4c579d4SMatthias Ringwald         case HCI_INIT_SEND_BAUD_CHANGE:
1955f4c579d4SMatthias Ringwald             if (need_baud_change) {
1956a784d71bSMatthias Ringwald                 hci_reserve_packet_buffer();
195796b53536SMatthias Ringwald                 uint32_t baud_rate = hci_transport_uart_get_main_baud_rate();
19583fb36a29SMatthias Ringwald                 hci_stack->chipset->set_baudrate_command(baud_rate, hci_stack->hci_packet_buffer);
195974b323a9SMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_SEND_BAUD_CHANGE;
1960ca6804fdSMatthias Ringwald                 hci_send_prepared_cmd_packet();
19614696bddbSMatthias Ringwald                 // STLC25000D: baudrate change happens within 0.5 s after command was send,
19624696bddbSMatthias Ringwald                 // use timer to update baud rate after 100 ms (knowing exactly, when command was sent is non-trivial)
196361f37892SMatthias Ringwald                 if (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_ST_MICROELECTRONICS){
1964659d758cSMatthias Ringwald                     btstack_run_loop_set_timer(&hci_stack->timeout, HCI_RESET_RESEND_TIMEOUT_MS);
1965528a4a3bSMatthias Ringwald                     btstack_run_loop_add_timer(&hci_stack->timeout);
19664696bddbSMatthias Ringwald                }
196774b323a9SMatthias Ringwald                break;
1968fab26ab3SMatthias Ringwald             }
19696fe16221SMatthias Ringwald             hci_stack->substate = HCI_INIT_CUSTOM_INIT;
1970f4c579d4SMatthias Ringwald 
1971f4c579d4SMatthias Ringwald             /* fall through */
1972f4c579d4SMatthias Ringwald 
197374b323a9SMatthias Ringwald         case HCI_INIT_CUSTOM_INIT:
19746fe16221SMatthias Ringwald         case HCI_INIT_CUSTOM_PRE_INIT:
197574b323a9SMatthias Ringwald             // Custom initialization
19763fb36a29SMatthias Ringwald             if (hci_stack->chipset && hci_stack->chipset->next_command){
1977ee418d0fSMatthias Ringwald                 hci_reserve_packet_buffer();
1978ae334e9eSMatthias Ringwald                 hci_stack->chipset_result = (*hci_stack->chipset->next_command)(hci_stack->hci_packet_buffer);
19791979f09cSMatthias Ringwald                 bool send_cmd = false;
1980ae334e9eSMatthias Ringwald                 switch (hci_stack->chipset_result){
1981f41911edSMatthias Ringwald                     case BTSTACK_CHIPSET_VALID_COMMAND:
19821979f09cSMatthias Ringwald                         send_cmd = true;
19836fe16221SMatthias Ringwald                         switch (hci_stack->substate){
19846fe16221SMatthias Ringwald                             case HCI_INIT_CUSTOM_INIT:
1985e47e68c7SMatthias Ringwald                                 hci_stack->substate = HCI_INIT_W4_CUSTOM_INIT;
1986e47e68c7SMatthias Ringwald                                 break;
19876fe16221SMatthias Ringwald                             case HCI_INIT_CUSTOM_PRE_INIT:
19886fe16221SMatthias Ringwald                                 hci_stack->substate = HCI_INIT_W4_CUSTOM_PRE_INIT;
19896fe16221SMatthias Ringwald                                 break;
19906fe16221SMatthias Ringwald                             default:
19916fe16221SMatthias Ringwald                                 btstack_assert(false);
19926fe16221SMatthias Ringwald                                 break;
19936fe16221SMatthias Ringwald                         }
19946fe16221SMatthias Ringwald                         break;
1995f41911edSMatthias Ringwald                     case BTSTACK_CHIPSET_WARMSTART_REQUIRED:
19961979f09cSMatthias Ringwald                         send_cmd = true;
1997f41911edSMatthias Ringwald                         // CSR Warm Boot: Wait a bit, then send HCI Reset until HCI Command Complete
1998e47e68c7SMatthias Ringwald                         log_info("CSR Warm Boot");
1999659d758cSMatthias Ringwald                         btstack_run_loop_set_timer(&hci_stack->timeout, HCI_RESET_RESEND_TIMEOUT_MS);
2000528a4a3bSMatthias Ringwald                         btstack_run_loop_set_timer_handler(&hci_stack->timeout, hci_initialization_timeout_handler);
2001528a4a3bSMatthias Ringwald                         btstack_run_loop_add_timer(&hci_stack->timeout);
2002a1df452eSMatthias Ringwald                         if ((hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_CAMBRIDGE_SILICON_RADIO)
2003772a36d3SMatthias Ringwald                             && hci_stack->config
20043fb36a29SMatthias Ringwald                             && hci_stack->chipset
20053fb36a29SMatthias Ringwald                             // && hci_stack->chipset->set_baudrate_command -- there's no such command
2006772a36d3SMatthias Ringwald                             && hci_stack->hci_transport->set_baudrate
20072caefae9SMatthias Ringwald                             && hci_transport_uart_get_main_baud_rate()){
2008772a36d3SMatthias Ringwald                             hci_stack->substate = HCI_INIT_W4_SEND_BAUD_CHANGE;
2009772a36d3SMatthias Ringwald                         } else {
20109f007422SMatthias Ringwald                            hci_stack->substate = HCI_INIT_W4_CUSTOM_INIT_CSR_WARM_BOOT_LINK_RESET;
2011772a36d3SMatthias Ringwald                         }
2012e47e68c7SMatthias Ringwald                         break;
2013f41911edSMatthias Ringwald                     default:
2014f41911edSMatthias Ringwald                         break;
2015e47e68c7SMatthias Ringwald                 }
2016ee720f3aSMatthias Ringwald 
2017ee720f3aSMatthias Ringwald                 if (send_cmd){
2018ca6804fdSMatthias Ringwald                     hci_send_prepared_cmd_packet();
201974b323a9SMatthias Ringwald                     break;
2020ee418d0fSMatthias Ringwald                 } else {
2021ee418d0fSMatthias Ringwald                     hci_release_packet_buffer();
202274b323a9SMatthias Ringwald                 }
2023148ca237SMatthias Ringwald                 log_info("Init script done");
202492a0d36dSMatthias Ringwald 
20256fe16221SMatthias Ringwald                 // Custom Pre-Init complete, start regular init with HCI Reset
20266fe16221SMatthias Ringwald                 if (hci_stack->substate == HCI_INIT_CUSTOM_PRE_INIT){
20276fe16221SMatthias Ringwald                     hci_stack->substate = HCI_INIT_W4_SEND_RESET;
20286fe16221SMatthias Ringwald                     hci_send_cmd(&hci_reset);
20296fe16221SMatthias Ringwald                     break;
20306fe16221SMatthias Ringwald                 }
20316fe16221SMatthias Ringwald 
2032559961d0SMatthias Ringwald                 // Init script download on Broadcom chipsets causes:
2033ae334e9eSMatthias Ringwald                 if ( (hci_stack->chipset_result != BTSTACK_CHIPSET_NO_INIT_SCRIPT) &&
2034a1df452eSMatthias Ringwald                    (  (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_BROADCOM_CORPORATION)
2035a1df452eSMatthias Ringwald                 ||    (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_EM_MICROELECTRONIC_MARIN_SA)) ){
2036e021ff1eSMatthias Ringwald 
2037559961d0SMatthias Ringwald                     // - baud rate to reset, restore UART baud rate if needed
203892a0d36dSMatthias Ringwald                     if (need_baud_change) {
20399796ebeaSMatthias Ringwald                         uint32_t baud_rate = ((hci_transport_config_uart_t *)hci_stack->config)->baudrate_init;
2040cd724cb7SMatthias Ringwald                         log_info("Local baud rate change to %" PRIu32 " after init script (bcm)", baud_rate);
204192a0d36dSMatthias Ringwald                         hci_stack->hci_transport->set_baudrate(baud_rate);
204292a0d36dSMatthias Ringwald                     }
2043559961d0SMatthias Ringwald 
2044f19b3c9eSMatthias Ringwald                     uint16_t bcm_delay_ms = 300;
2045f19b3c9eSMatthias Ringwald                     // - UART may or may not be disabled during update and Controller RTS may or may not be high during this time
2046f19b3c9eSMatthias Ringwald                     //   -> Work around: wait here.
2047f19b3c9eSMatthias Ringwald                     log_info("BCM delay (%u ms) after init script", bcm_delay_ms);
2048559961d0SMatthias Ringwald                     hci_stack->substate = HCI_INIT_W4_CUSTOM_INIT_BCM_DELAY;
2049f19b3c9eSMatthias Ringwald                     btstack_run_loop_set_timer(&hci_stack->timeout, bcm_delay_ms);
2050559961d0SMatthias Ringwald                     btstack_run_loop_set_timer_handler(&hci_stack->timeout, hci_initialization_timeout_handler);
2051559961d0SMatthias Ringwald                     btstack_run_loop_add_timer(&hci_stack->timeout);
2052559961d0SMatthias Ringwald                     break;
205392a0d36dSMatthias Ringwald                 }
205474b323a9SMatthias Ringwald             }
205506b9e820SMatthias Ringwald #endif
2056521bd5ffSMatthias Ringwald             /* fall through */
205706b9e820SMatthias Ringwald 
205806b9e820SMatthias Ringwald         case HCI_INIT_READ_LOCAL_SUPPORTED_COMMANDS:
205906b9e820SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_READ_LOCAL_SUPPORTED_COMMANDS;
206006b9e820SMatthias Ringwald             hci_send_cmd(&hci_read_local_supported_commands);
206106b9e820SMatthias Ringwald             break;
206253860077SMatthias Ringwald         case HCI_INIT_READ_BD_ADDR:
206353860077SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_READ_BD_ADDR;
206453860077SMatthias Ringwald             hci_send_cmd(&hci_read_bd_addr);
206553860077SMatthias Ringwald             break;
206674b323a9SMatthias Ringwald         case HCI_INIT_READ_BUFFER_SIZE:
20675ffe9d0bSMatthias Ringwald             // only read buffer size if supported
20681ffa425cSMatthias Ringwald             if (hci_command_supported(SUPPORTED_HCI_COMMAND_READ_BUFFER_SIZE)){
206974b323a9SMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_READ_BUFFER_SIZE;
20700305bdeaSMatthias Ringwald                 hci_send_cmd(&hci_read_buffer_size);
207174b323a9SMatthias Ringwald                 break;
20725ffe9d0bSMatthias Ringwald             }
2073521bd5ffSMatthias Ringwald 
20745ffe9d0bSMatthias Ringwald             /* fall through */
20755ffe9d0bSMatthias Ringwald 
207653860077SMatthias Ringwald         case HCI_INIT_READ_LOCAL_SUPPORTED_FEATURES:
207753860077SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_READ_LOCAL_SUPPORTED_FEATURES;
20780305bdeaSMatthias Ringwald             hci_send_cmd(&hci_read_local_supported_features);
207974b323a9SMatthias Ringwald             break;
20802b838201SMatthias Ringwald 
20812b838201SMatthias Ringwald #ifdef ENABLE_HCI_CONTROLLER_TO_HOST_FLOW_CONTROL
20822b838201SMatthias Ringwald         case HCI_INIT_SET_CONTROLLER_TO_HOST_FLOW_CONTROL:
20832b838201SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_SET_CONTROLLER_TO_HOST_FLOW_CONTROL;
20842b838201SMatthias Ringwald             hci_send_cmd(&hci_set_controller_to_host_flow_control, 3);  // ACL + SCO Flow Control
20852b838201SMatthias Ringwald             break;
20862b838201SMatthias Ringwald         case HCI_INIT_HOST_BUFFER_SIZE:
20872b838201SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_HOST_BUFFER_SIZE;
20882b838201SMatthias Ringwald             hci_send_cmd(&hci_host_buffer_size, HCI_HOST_ACL_PACKET_LEN, HCI_HOST_SCO_PACKET_LEN,
20892b838201SMatthias Ringwald                                                 HCI_HOST_ACL_PACKET_NUM, HCI_HOST_SCO_PACKET_NUM);
20902b838201SMatthias Ringwald             break;
20912b838201SMatthias Ringwald #endif
20922b838201SMatthias Ringwald 
209374b323a9SMatthias Ringwald         case HCI_INIT_SET_EVENT_MASK:
20940305bdeaSMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_SET_EVENT_MASK;
209574b323a9SMatthias Ringwald             if (hci_le_supported()){
20965ce1359eSMatthias Ringwald                 hci_send_cmd(&hci_set_event_mask,0xFFFFFFFFU, 0x3FFFFFFFU);
209774b323a9SMatthias Ringwald             } else {
209874b323a9SMatthias Ringwald                 // Kensington Bluetooth 2.1 USB Dongle (CSR Chipset) returns an error for 0xffff...
20995ce1359eSMatthias Ringwald                 hci_send_cmd(&hci_set_event_mask,0xFFFFFFFFU, 0x1FFFFFFFU);
210074b323a9SMatthias Ringwald             }
210174b323a9SMatthias Ringwald             break;
21022b838201SMatthias Ringwald 
2103ff7d1758SMatthias Ringwald         case HCI_INIT_SET_EVENT_MASK_2:
21048254e329SMatthias Ringwald             // On Bluettooth PTS dongle (BL 654) with PacketCraft HCI Firmware (LMP subversion) 0x5244,
21058254e329SMatthias Ringwald             // setting Event Mask 2 causes Controller to drop Encryption Change events.
21068254e329SMatthias Ringwald             if (hci_command_supported(SUPPORTED_HCI_COMMAND_SET_EVENT_MASK_PAGE_2)
21078254e329SMatthias Ringwald             && (hci_stack->manufacturer != BLUETOOTH_COMPANY_ID_PACKETCRAFT_INC)){
2108ff7d1758SMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_SET_EVENT_MASK_2;
2109ff7d1758SMatthias Ringwald                 // Encryption Change Event v2 - bit 25
2110ff7d1758SMatthias Ringwald                 hci_send_cmd(&hci_set_event_mask_2,0x02000000U, 0x0);
2111ff7d1758SMatthias Ringwald                 break;
2112ff7d1758SMatthias Ringwald             }
2113ff7d1758SMatthias Ringwald 
211435454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
2115ff7d1758SMatthias Ringwald             /* fall through */
2116ff7d1758SMatthias Ringwald 
211774b323a9SMatthias Ringwald         case HCI_INIT_WRITE_SIMPLE_PAIRING_MODE:
2118f795c86eSMatthias Ringwald             if (hci_classic_supported() && gap_ssp_supported()){
211974b323a9SMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_WRITE_SIMPLE_PAIRING_MODE;
21200305bdeaSMatthias Ringwald                 hci_send_cmd(&hci_write_simple_pairing_mode, hci_stack->ssp_enable);
212174b323a9SMatthias Ringwald                 break;
2122e7c662faSMatthias Ringwald             }
2123521bd5ffSMatthias Ringwald 
2124e7c662faSMatthias Ringwald             /* fall through */
2125e7c662faSMatthias Ringwald 
2126f6858d14SMatthias Ringwald         case HCI_INIT_WRITE_INQUIRY_MODE:
2127f795c86eSMatthias Ringwald             if (hci_classic_supported()){
2128f6858d14SMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_WRITE_INQUIRY_MODE;
21298a114470SMatthias Ringwald                 hci_send_cmd(&hci_write_inquiry_mode, (int) hci_stack->inquiry_mode);
2130f6858d14SMatthias Ringwald                 break;
2131f795c86eSMatthias Ringwald             }
2132521bd5ffSMatthias Ringwald 
2133f795c86eSMatthias Ringwald             /* fall through */
2134f795c86eSMatthias Ringwald 
21355d23aae8SMatthias Ringwald         case HCI_INIT_WRITE_SECURE_CONNECTIONS_HOST_ENABLE:
2136f3052906SMatthias Ringwald             // skip write secure connections host support if not supported or disabled
21371ffa425cSMatthias Ringwald             if (hci_classic_supported() && hci_stack->secure_connections_enable
21381ffa425cSMatthias Ringwald             && hci_command_supported(SUPPORTED_HCI_COMMAND_WRITE_SECURE_CONNECTIONS_HOST)) {
2139c214d65bSMatthias Ringwald                 hci_stack->secure_connections_active = true;
21405d23aae8SMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_WRITE_SECURE_CONNECTIONS_HOST_ENABLE;
21411ffa425cSMatthias Ringwald                 hci_send_cmd(&hci_write_secure_connections_host_support, 1);
21425d23aae8SMatthias Ringwald                 break;
2143f3052906SMatthias Ringwald             }
2144521bd5ffSMatthias Ringwald 
2145a391128dSMatthias Ringwald             /* fall through */
2146a391128dSMatthias Ringwald 
2147a391128dSMatthias Ringwald         case HCI_INIT_SET_MIN_ENCRYPTION_KEY_SIZE:
2148a391128dSMatthias Ringwald             // skip set min encryption key size
2149a391128dSMatthias Ringwald             if (hci_classic_supported() && hci_command_supported(SUPPORTED_HCI_COMMAND_SET_MIN_ENCRYPTION_KEY_SIZE)) {
2150a391128dSMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_SET_MIN_ENCRYPTION_KEY_SIZE;
2151a391128dSMatthias Ringwald                 hci_send_cmd(&hci_set_min_encryption_key_size, hci_stack->gap_required_encyrption_key_size);
2152a391128dSMatthias Ringwald                 break;
2153a391128dSMatthias Ringwald             }
2154a391128dSMatthias Ringwald 
2155e4c6114dSMatthias Ringwald #ifdef ENABLE_SCO_OVER_HCI
2156521bd5ffSMatthias Ringwald             /* fall through */
2157521bd5ffSMatthias Ringwald 
2158483c5078SMatthias Ringwald         // only sent if ENABLE_SCO_OVER_HCI is defined
2159729ed62eSMatthias Ringwald         case HCI_INIT_WRITE_SYNCHRONOUS_FLOW_CONTROL_ENABLE:
2160e4c6114dSMatthias Ringwald             // skip write synchronous flow control if not supported
21611ffa425cSMatthias Ringwald             if (hci_classic_supported()
21621ffa425cSMatthias Ringwald             && hci_command_supported(SUPPORTED_HCI_COMMAND_WRITE_SYNCHRONOUS_FLOW_CONTROL_ENABLE)) {
2163729ed62eSMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_WRITE_SYNCHRONOUS_FLOW_CONTROL_ENABLE;
2164729ed62eSMatthias Ringwald                 hci_send_cmd(&hci_write_synchronous_flow_control_enable, 1); // SCO tracking enabled
2165729ed62eSMatthias Ringwald                 break;
2166f795c86eSMatthias Ringwald             }
2167f795c86eSMatthias Ringwald             /* fall through */
2168f795c86eSMatthias Ringwald 
2169483c5078SMatthias Ringwald         case HCI_INIT_WRITE_DEFAULT_ERRONEOUS_DATA_REPORTING:
2170e4c6114dSMatthias Ringwald             // skip write default erroneous data reporting if not supported
21711ffa425cSMatthias Ringwald             if (hci_classic_supported()
21721ffa425cSMatthias Ringwald             && hci_command_supported(SUPPORTED_HCI_COMMAND_WRITE_DEFAULT_ERRONEOUS_DATA_REPORTING)) {
2173483c5078SMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_WRITE_DEFAULT_ERRONEOUS_DATA_REPORTING;
2174483c5078SMatthias Ringwald                 hci_send_cmd(&hci_write_default_erroneous_data_reporting, 1);
2175483c5078SMatthias Ringwald                 break;
2176f795c86eSMatthias Ringwald             }
2177e4c6114dSMatthias Ringwald #endif
2178f795c86eSMatthias Ringwald 
2179f795c86eSMatthias Ringwald #if defined(ENABLE_SCO_OVER_HCI) || defined(ENABLE_SCO_OVER_PCM)
2180521bd5ffSMatthias Ringwald             /* fall through */
2181521bd5ffSMatthias Ringwald 
21828051253fSMatthias Ringwald         // only sent if manufacturer is Broadcom and ENABLE_SCO_OVER_HCI or ENABLE_SCO_OVER_PCM is defined
2183a42798c3SMatthias Ringwald         case HCI_INIT_BCM_WRITE_SCO_PCM_INT:
2184e4c6114dSMatthias Ringwald             if (hci_classic_supported() && (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_BROADCOM_CORPORATION)){
2185a42798c3SMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_BCM_WRITE_SCO_PCM_INT;
21868051253fSMatthias Ringwald #ifdef ENABLE_SCO_OVER_HCI
2187a42798c3SMatthias Ringwald                 log_info("BCM: Route SCO data via HCI transport");
2188a42798c3SMatthias Ringwald                 hci_send_cmd(&hci_bcm_write_sco_pcm_int, 1, 0, 0, 0, 0);
21898051253fSMatthias Ringwald #endif
21908051253fSMatthias Ringwald #ifdef ENABLE_SCO_OVER_PCM
21918051253fSMatthias Ringwald                 log_info("BCM: Route SCO data via PCM interface");
21921d2bbd54SMatthias Ringwald #ifdef ENABLE_BCM_PCM_WBS
2193f795c86eSMatthias Ringwald                 // 512 kHz bit clock for 2 channels x 16 bit x 16 kHz
21941d2bbd54SMatthias Ringwald                 hci_send_cmd(&hci_bcm_write_sco_pcm_int, 0, 2, 0, 1, 1);
21951d2bbd54SMatthias Ringwald #else
21961d2bbd54SMatthias Ringwald                 // 256 kHz bit clock for 2 channels x 16 bit x 8 kHz
21971d2bbd54SMatthias Ringwald                 hci_send_cmd(&hci_bcm_write_sco_pcm_int, 0, 1, 0, 1, 1);
21981d2bbd54SMatthias Ringwald #endif
21998051253fSMatthias Ringwald #endif
2200a42798c3SMatthias Ringwald                 break;
2201f795c86eSMatthias Ringwald             }
2202f795c86eSMatthias Ringwald #endif
2203f795c86eSMatthias Ringwald 
22044e821764SMatthias Ringwald #ifdef ENABLE_SCO_OVER_PCM
2205521bd5ffSMatthias Ringwald             /* fall through */
2206521bd5ffSMatthias Ringwald 
22074e821764SMatthias Ringwald         case HCI_INIT_BCM_WRITE_I2SPCM_INTERFACE_PARAM:
2208e4c6114dSMatthias Ringwald             if (hci_classic_supported() && (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_BROADCOM_CORPORATION)){
22094e821764SMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_BCM_WRITE_I2SPCM_INTERFACE_PARAM;
22104e821764SMatthias Ringwald                 log_info("BCM: Config PCM interface for I2S");
22111d2bbd54SMatthias Ringwald #ifdef ENABLE_BCM_PCM_WBS
22121d2bbd54SMatthias Ringwald                 // 512 kHz bit clock for 2 channels x 16 bit x 8 kHz
22131d2bbd54SMatthias Ringwald                 hci_send_cmd(&hci_bcm_write_i2spcm_interface_param, 1, 1, 0, 2);
22141d2bbd54SMatthias Ringwald #else
22151d2bbd54SMatthias Ringwald                 // 256 kHz bit clock for 2 channels x 16 bit x 8 kHz
22161d2bbd54SMatthias Ringwald                 hci_send_cmd(&hci_bcm_write_i2spcm_interface_param, 1, 1, 0, 1);
22171d2bbd54SMatthias Ringwald #endif
22184e821764SMatthias Ringwald                 break;
2219f795c86eSMatthias Ringwald             }
22201be678e9SMatthias Ringwald         case HCI_INIT_BCM_WRITE_PCM_DATA_FORMAT_PARAM:
22211be678e9SMatthias Ringwald             if (hci_classic_supported() && (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_BROADCOM_CORPORATION)){
22221be678e9SMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_BCM_WRITE_PCM_DATA_FORMAT_PARAM;
22231be678e9SMatthias Ringwald                 log_info("BCM: Config PCM Data format");
22241be678e9SMatthias Ringwald                 // msb first, fill bits 0, left justified
22251be678e9SMatthias Ringwald                 hci_send_cmd(&hci_bcm_write_pcm_data_format_param, 0, 0, 3, 3, 0);
22261be678e9SMatthias Ringwald                 break;
22271be678e9SMatthias Ringwald             }
2228dd1f98b4SMatthias Ringwald #ifdef HAVE_BCM_PCM2
2229dd1f98b4SMatthias Ringwald         case HCI_INIT_BCM_PCM2_SETUP:
2230dd1f98b4SMatthias Ringwald             if (hci_classic_supported() && (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_BROADCOM_CORPORATION)) {
2231dd1f98b4SMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_BCM_PCM2_SETUP;
2232dd1f98b4SMatthias Ringwald                 uint8_t  op_mode = 0;  // Op_Mode = 0 = PCM, 1 = I2S
2233dd1f98b4SMatthias Ringwald                 uint32_t pcm_clock_freq;
2234dd1f98b4SMatthias Ringwald                 uint8_t  ch_0_period;
2235dd1f98b4SMatthias Ringwald #ifdef ENABLE_BCM_PCM_WBS
2236dd1f98b4SMatthias Ringwald                 // 512 kHz, resample 8 kHz to 16 khz
2237dd1f98b4SMatthias Ringwald                 pcm_clock_freq = 512000;
2238dd1f98b4SMatthias Ringwald                 ch_0_period = 1;
2239dd1f98b4SMatthias Ringwald #else
2240dd1f98b4SMatthias Ringwald                 // 256 khz, 8 khz output
2241dd1f98b4SMatthias Ringwald                 pcm_clock_freq = 256000;
2242dd1f98b4SMatthias Ringwald                 ch_0_period = 0;
224335454696SMatthias Ringwald #endif
2244dd1f98b4SMatthias Ringwald                 log_info("BCM: Config PCM2 - op mode %u, pcm clock %" PRIu32 ", ch0_period %u", op_mode, pcm_clock_freq, ch_0_period);
2245dd1f98b4SMatthias Ringwald                 hci_send_cmd(&hci_bcm_pcm2_setup,
2246dd1f98b4SMatthias Ringwald                              0x00, // Action = Write
2247dd1f98b4SMatthias Ringwald                              0x00, // Test_Options = None
2248dd1f98b4SMatthias Ringwald                              op_mode, // Op_Mode
2249dd1f98b4SMatthias Ringwald                              0x1D, // Sync_and_Clock_Options Sync = Signal | Sync Output Enable | Generate PCM_CLK | Tristate When Idle
2250dd1f98b4SMatthias Ringwald                              pcm_clock_freq, // PCM_Clock_Freq
2251dd1f98b4SMatthias Ringwald                              0x01, // Sync_Signal_Width
2252dd1f98b4SMatthias Ringwald                              0x0F, // Slot_Width
2253dd1f98b4SMatthias Ringwald                              0x01, // NumberOfSlots
2254dd1f98b4SMatthias Ringwald                              0x00, // Bank_0_Fill_Mode = 0s
2255dd1f98b4SMatthias Ringwald                              0x00, // Bank_0_Number_of_Fill_Bits
2256dd1f98b4SMatthias Ringwald                              0x00, // Bank_0_Programmable_Fill_Data
2257dd1f98b4SMatthias Ringwald                              0x00, // Bank_1_Fill_Mode = 0s
2258dd1f98b4SMatthias Ringwald                              0x00, // Bank_1_Number_of_Fill_Bits
2259dd1f98b4SMatthias Ringwald                              0x00, // Bank_1_Programmable_Fill_Data
2260dd1f98b4SMatthias Ringwald                              0x00, // Data_Justify_And_Bit_Order_Options = Left Justify
2261dd1f98b4SMatthias Ringwald                              0x00, // Ch_0_Slot_Number
2262dd1f98b4SMatthias Ringwald                              0x01, // Ch_1_Slot_Number
2263dd1f98b4SMatthias Ringwald                              0x02, // Ch_2_Slot_Number
2264dd1f98b4SMatthias Ringwald                              0x03, // Ch_3_Slot_Number
2265dd1f98b4SMatthias Ringwald                              0x04, // Ch_4_Slot_Number
2266dd1f98b4SMatthias Ringwald                              ch_0_period, // Ch_0_Period
2267dd1f98b4SMatthias Ringwald                              0x00, // Ch_1_Period
2268dd1f98b4SMatthias Ringwald                              0x00  // Ch_2_Period
2269dd1f98b4SMatthias Ringwald                 );
2270dd1f98b4SMatthias Ringwald                 break;
2271dd1f98b4SMatthias Ringwald             }
22724e821764SMatthias Ringwald #endif
2273dd1f98b4SMatthias Ringwald #endif /* ENABLE_SCO_OVER_PCM */
2274dd1f98b4SMatthias Ringwald #endif /* ENABLE_CLASSIC */
22754e821764SMatthias Ringwald 
2276a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE
2277521bd5ffSMatthias Ringwald             /* fall through */
2278521bd5ffSMatthias Ringwald 
227974b323a9SMatthias Ringwald         // LE INIT
228074b323a9SMatthias Ringwald         case HCI_INIT_LE_READ_BUFFER_SIZE:
2281f795c86eSMatthias Ringwald             if (hci_le_supported()){
228274b323a9SMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_LE_READ_BUFFER_SIZE;
228379b7ea2dSMatthias Ringwald                 if (hci_command_supported(SUPPORTED_HCI_COMMAND_LE_READ_BUFFER_SIZE_V2)){
228479b7ea2dSMatthias Ringwald                     hci_send_cmd(&hci_le_read_buffer_size_v2);
228579b7ea2dSMatthias Ringwald                 } else {
22860305bdeaSMatthias Ringwald                     hci_send_cmd(&hci_le_read_buffer_size);
228779b7ea2dSMatthias Ringwald                 }
228874b323a9SMatthias Ringwald                 break;
2289f795c86eSMatthias Ringwald             }
2290521bd5ffSMatthias Ringwald 
2291f795c86eSMatthias Ringwald             /* fall through */
2292f795c86eSMatthias Ringwald 
2293699a5fcaSMatthias Ringwald         case HCI_INIT_WRITE_LE_HOST_SUPPORTED:
2294699a5fcaSMatthias Ringwald             // skip write le host if not supported (e.g. on LE only EM9301)
22951ffa425cSMatthias Ringwald             if (hci_le_supported()
22961ffa425cSMatthias Ringwald             && hci_command_supported(SUPPORTED_HCI_COMMAND_WRITE_LE_HOST_SUPPORTED)) {
2297699a5fcaSMatthias Ringwald                 // LE Supported Host = 1, Simultaneous Host = 0
2298699a5fcaSMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_WRITE_LE_HOST_SUPPORTED;
2299699a5fcaSMatthias Ringwald                 hci_send_cmd(&hci_write_le_host_supported, 1, 0);
2300daabb8b8SMatthias Ringwald                 break;
2301f795c86eSMatthias Ringwald             }
2302521bd5ffSMatthias Ringwald 
2303f795c86eSMatthias Ringwald             /* fall through */
2304f795c86eSMatthias Ringwald 
2305699a5fcaSMatthias Ringwald         case HCI_INIT_LE_SET_EVENT_MASK:
2306f795c86eSMatthias Ringwald             if (hci_le_supported()){
2307699a5fcaSMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_LE_SET_EVENT_MASK;
23085d6688b0SMatthias Ringwald #ifdef ENABLE_LE_ENHANCED_CONNECTION_COMPLETE_EVENT
2309920a6ac5SMatthias Ringwald                 hci_send_cmd(&hci_le_set_event_mask, 0xffffffff, 0x0107); // all events from core v5.3
23105d6688b0SMatthias Ringwald #else
2311920a6ac5SMatthias Ringwald                 hci_send_cmd(&hci_le_set_event_mask, 0xfffffdff, 0x0007); // all events from core v5.3 without LE Enhanced Connection Complete
23125d6688b0SMatthias Ringwald #endif
231374b323a9SMatthias Ringwald                 break;
2314f795c86eSMatthias Ringwald             }
2315b435e062SMatthias Ringwald #endif
2316b435e062SMatthias Ringwald 
2317b435e062SMatthias Ringwald #ifdef ENABLE_LE_DATA_LENGTH_EXTENSION
2318521bd5ffSMatthias Ringwald             /* fall through */
2319521bd5ffSMatthias Ringwald 
2320dcd678baSMatthias Ringwald         case HCI_INIT_LE_READ_MAX_DATA_LENGTH:
23211ffa425cSMatthias Ringwald             if (hci_le_supported()
23221ffa425cSMatthias Ringwald             && hci_command_supported(SUPPORTED_HCI_COMMAND_LE_READ_MAXIMUM_DATA_LENGTH)) {
2323dcd678baSMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_LE_READ_MAX_DATA_LENGTH;
2324dcd678baSMatthias Ringwald                 hci_send_cmd(&hci_le_read_maximum_data_length);
2325dcd678baSMatthias Ringwald                 break;
2326f795c86eSMatthias Ringwald             }
2327521bd5ffSMatthias Ringwald 
2328f795c86eSMatthias Ringwald             /* fall through */
2329f795c86eSMatthias Ringwald 
2330dcd678baSMatthias Ringwald         case HCI_INIT_LE_WRITE_SUGGESTED_DATA_LENGTH:
23311ffa425cSMatthias Ringwald             if (hci_le_supported()
23321ffa425cSMatthias Ringwald             && hci_command_supported(SUPPORTED_HCI_COMMAND_LE_WRITE_SUGGESTED_DEFAULT_DATA_LENGTH)) {
2333dcd678baSMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_LE_WRITE_SUGGESTED_DATA_LENGTH;
2334b435e062SMatthias Ringwald                 hci_send_cmd(&hci_le_write_suggested_default_data_length, hci_stack->le_supported_max_tx_octets, hci_stack->le_supported_max_tx_time);
2335dcd678baSMatthias Ringwald                 break;
2336f795c86eSMatthias Ringwald             }
2337b435e062SMatthias Ringwald #endif
2338b435e062SMatthias Ringwald 
2339b95a5a35SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
2340521bd5ffSMatthias Ringwald             /* fall through */
2341521bd5ffSMatthias Ringwald 
23423b6d4121SMatthias Ringwald         case HCI_INIT_READ_WHITE_LIST_SIZE:
2343f795c86eSMatthias Ringwald             if (hci_le_supported()){
23443b6d4121SMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_READ_WHITE_LIST_SIZE;
23453b6d4121SMatthias Ringwald                 hci_send_cmd(&hci_le_read_white_list_size);
23463b6d4121SMatthias Ringwald                 break;
2347f795c86eSMatthias Ringwald             }
2348521bd5ffSMatthias Ringwald 
234974b323a9SMatthias Ringwald #endif
23504f982f31SMatthias Ringwald 
23513a74541eSMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
23523a74541eSMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
23533a74541eSMatthias Ringwald             /* fall through */
23543a74541eSMatthias Ringwald 
23553a74541eSMatthias Ringwald         case HCI_INIT_LE_READ_MAX_ADV_DATA_LEN:
235622f987e4SMatthias Ringwald             if (hci_le_extended_advertising_supported()){
23573a74541eSMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_LE_READ_MAX_ADV_DATA_LEN;
23583a74541eSMatthias Ringwald                 hci_send_cmd(&hci_le_read_maximum_advertising_data_length);
23593a74541eSMatthias Ringwald                 break;
23603a74541eSMatthias Ringwald             }
23613a74541eSMatthias Ringwald #endif
23623a74541eSMatthias Ringwald #endif
2363521bd5ffSMatthias Ringwald             /* fall through */
2364521bd5ffSMatthias Ringwald 
2365c63ee49aSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
2366c63ee49aSMatthias Ringwald     case HCI_INIT_LE_SET_HOST_FEATURE_CONNECTED_ISO_STREAMS:
2367c63ee49aSMatthias Ringwald             if (hci_le_supported()) {
2368c63ee49aSMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_LE_SET_HOST_FEATURE_CONNECTED_ISO_STREAMS;
2369c63ee49aSMatthias Ringwald                 hci_send_cmd(&hci_le_set_host_feature, 32, 1);
2370c63ee49aSMatthias Ringwald                 break;
2371c63ee49aSMatthias Ringwald             }
2372c63ee49aSMatthias Ringwald #endif
2373c63ee49aSMatthias Ringwald 
2374c63ee49aSMatthias Ringwald             /* fall through */
2375c63ee49aSMatthias Ringwald 
2376f795c86eSMatthias Ringwald         case HCI_INIT_DONE:
23774f982f31SMatthias Ringwald             hci_stack->substate = HCI_INIT_DONE;
237873799937SMatthias Ringwald             // main init sequence complete
23794f982f31SMatthias Ringwald #ifdef ENABLE_CLASSIC
238073799937SMatthias Ringwald             // check if initial Classic GAP Tasks are completed
2381baa4881eSMatthias Ringwald             if (hci_classic_supported() && (hci_stack->gap_tasks_classic != 0)) {
23824f982f31SMatthias Ringwald                 hci_run_gap_tasks_classic();
23834f982f31SMatthias Ringwald                 break;
23844f982f31SMatthias Ringwald             }
23854f982f31SMatthias Ringwald #endif
238673799937SMatthias Ringwald #ifdef ENABLE_BLE
238773799937SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
238873799937SMatthias Ringwald             // check if initial LE GAP Tasks are completed
238973799937SMatthias Ringwald             if (hci_le_supported() && hci_stack->le_scanning_param_update) {
239073799937SMatthias Ringwald                 hci_run_general_gap_le();
239173799937SMatthias Ringwald                 break;
239273799937SMatthias Ringwald             }
239373799937SMatthias Ringwald #endif
239473799937SMatthias Ringwald #endif
2395f795c86eSMatthias Ringwald             hci_init_done();
2396f795c86eSMatthias Ringwald             break;
2397f795c86eSMatthias Ringwald 
239874b323a9SMatthias Ringwald         default:
239974b323a9SMatthias Ringwald             return;
240074b323a9SMatthias Ringwald     }
240155975f88SMatthias Ringwald }
240255975f88SMatthias Ringwald 
240307fd2f31SMatthias Ringwald static bool hci_initializing_event_handler_command_completed(const uint8_t * packet){
240407fd2f31SMatthias Ringwald     bool command_completed = false;
24050e2df43fSMatthias Ringwald     if (hci_event_packet_get_type(packet) == HCI_EVENT_COMMAND_COMPLETE){
2406f8fbdce0SMatthias Ringwald         uint16_t opcode = little_endian_read_16(packet,3);
24076155b3d3S[email protected]         if (opcode == hci_stack->last_cmd_opcode){
240807fd2f31SMatthias Ringwald             command_completed = true;
2409148ca237SMatthias Ringwald             log_debug("Command complete for expected opcode %04x at substate %u", opcode, hci_stack->substate);
24106155b3d3S[email protected]         } else {
2411d58dd308SMatthias Ringwald             log_info("Command complete for different opcode %04x, expected %04x, at substate %u", opcode, hci_stack->last_cmd_opcode, hci_stack->substate);
24126155b3d3S[email protected]         }
24136155b3d3S[email protected]     }
24140f97eae7SMatthias Ringwald 
24150e2df43fSMatthias Ringwald     if (hci_event_packet_get_type(packet) == HCI_EVENT_COMMAND_STATUS){
24166155b3d3S[email protected]         uint8_t  status = packet[2];
2417f8fbdce0SMatthias Ringwald         uint16_t opcode = little_endian_read_16(packet,4);
24186155b3d3S[email protected]         if (opcode == hci_stack->last_cmd_opcode){
24196155b3d3S[email protected]             if (status){
242007fd2f31SMatthias Ringwald                 command_completed = true;
2421148ca237SMatthias Ringwald                 log_debug("Command status error 0x%02x for expected opcode %04x at substate %u", status, opcode, hci_stack->substate);
24226155b3d3S[email protected]             } else {
24236155b3d3S[email protected]                 log_info("Command status OK for expected opcode %04x, waiting for command complete", opcode);
24246155b3d3S[email protected]             }
24256155b3d3S[email protected]         } else {
2426148ca237SMatthias Ringwald             log_debug("Command status for opcode %04x, expected %04x", opcode, hci_stack->last_cmd_opcode);
24276155b3d3S[email protected]         }
24286155b3d3S[email protected]     }
24296fad2c37SMatthias Ringwald #ifndef HAVE_HOST_CONTROLLER_API
2430e47e68c7SMatthias Ringwald     // Vendor == CSR
24310e588213SMatthias Ringwald     if ((hci_stack->substate == HCI_INIT_W4_CUSTOM_INIT) && (hci_event_packet_get_type(packet) == HCI_EVENT_VENDOR_SPECIFIC)){
2432e47e68c7SMatthias Ringwald         // TODO: track actual command
243307fd2f31SMatthias Ringwald         command_completed = true;
2434e47e68c7SMatthias Ringwald     }
2435a2481739S[email protected] 
24364e9daa6fSMatthias Ringwald     // Vendor == Toshiba
24370e588213SMatthias Ringwald     if ((hci_stack->substate == HCI_INIT_W4_SEND_BAUD_CHANGE) && (hci_event_packet_get_type(packet) == HCI_EVENT_VENDOR_SPECIFIC)){
24384e9daa6fSMatthias Ringwald         // TODO: track actual command
243907fd2f31SMatthias Ringwald         command_completed = true;
2440004902f1SMatthias Ringwald         // Fix: no HCI Command Complete received, so num_cmd_packets not reset
2441004902f1SMatthias Ringwald         hci_stack->num_cmd_packets = 1;
24424e9daa6fSMatthias Ringwald     }
244307fd2f31SMatthias Ringwald #endif
244407fd2f31SMatthias Ringwald 
244507fd2f31SMatthias Ringwald     return command_completed;
244607fd2f31SMatthias Ringwald }
244707fd2f31SMatthias Ringwald 
244807fd2f31SMatthias Ringwald static void hci_initializing_event_handler(const uint8_t * packet, uint16_t size){
244907fd2f31SMatthias Ringwald 
245007fd2f31SMatthias Ringwald     UNUSED(size);   // ok: less than 6 bytes are read from our buffer
245107fd2f31SMatthias Ringwald 
245207fd2f31SMatthias Ringwald     bool command_completed =  hci_initializing_event_handler_command_completed(packet);
245307fd2f31SMatthias Ringwald 
24546fad2c37SMatthias Ringwald #ifndef HAVE_HOST_CONTROLLER_API
24554e9daa6fSMatthias Ringwald 
24560f97eae7SMatthias Ringwald     // Late response (> 100 ms) for HCI Reset e.g. on Toshiba TC35661:
24570f97eae7SMatthias Ringwald     // Command complete for HCI Reset arrives after we've resent the HCI Reset command
24580f97eae7SMatthias Ringwald     //
24590f97eae7SMatthias Ringwald     // HCI Reset
24600f97eae7SMatthias Ringwald     // Timeout 100 ms
24610f97eae7SMatthias Ringwald     // HCI Reset
24620f97eae7SMatthias Ringwald     // Command Complete Reset
24630f97eae7SMatthias Ringwald     // HCI Read Local Version Information
24640f97eae7SMatthias Ringwald     // Command Complete Reset - but we expected Command Complete Read Local Version Information
24650f97eae7SMatthias Ringwald     // hang...
24660f97eae7SMatthias Ringwald     //
24670f97eae7SMatthias Ringwald     // Fix: Command Complete for HCI Reset in HCI_INIT_W4_SEND_READ_LOCAL_VERSION_INFORMATION trigger resend
24680f97eae7SMatthias Ringwald     if (!command_completed
2469a1df452eSMatthias Ringwald             && (hci_event_packet_get_type(packet) == HCI_EVENT_COMMAND_COMPLETE)
24700e588213SMatthias Ringwald             && (hci_stack->substate == HCI_INIT_W4_SEND_READ_LOCAL_VERSION_INFORMATION)){
24710f97eae7SMatthias Ringwald 
2472f8fbdce0SMatthias Ringwald         uint16_t opcode = little_endian_read_16(packet,3);
24730f97eae7SMatthias Ringwald         if (opcode == hci_reset.opcode){
24740f97eae7SMatthias Ringwald             hci_stack->substate = HCI_INIT_SEND_READ_LOCAL_VERSION_INFORMATION;
24750f97eae7SMatthias Ringwald             return;
24760f97eae7SMatthias Ringwald         }
24770f97eae7SMatthias Ringwald     }
24780f97eae7SMatthias Ringwald 
24799f007422SMatthias Ringwald     // CSR & H5
24809f007422SMatthias Ringwald     // Fix: Command Complete for HCI Reset in HCI_INIT_W4_SEND_READ_LOCAL_VERSION_INFORMATION trigger resend
24819f007422SMatthias Ringwald     if (!command_completed
2482a1df452eSMatthias Ringwald             && (hci_event_packet_get_type(packet) == HCI_EVENT_COMMAND_COMPLETE)
24830e588213SMatthias Ringwald             && (hci_stack->substate == HCI_INIT_W4_READ_LOCAL_SUPPORTED_COMMANDS)){
24849f007422SMatthias Ringwald 
24859f007422SMatthias Ringwald         uint16_t opcode = little_endian_read_16(packet,3);
24869f007422SMatthias Ringwald         if (opcode == hci_reset.opcode){
24879f007422SMatthias Ringwald             hci_stack->substate = HCI_INIT_READ_LOCAL_SUPPORTED_COMMANDS;
24889f007422SMatthias Ringwald             return;
24899f007422SMatthias Ringwald         }
24909f007422SMatthias Ringwald     }
24919f007422SMatthias Ringwald 
24929f007422SMatthias 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
24939f007422SMatthias Ringwald     // fix: Correct substate and behave as command below
24949f007422SMatthias Ringwald     if (command_completed){
24959f007422SMatthias Ringwald         switch (hci_stack->substate){
24969f007422SMatthias Ringwald             case HCI_INIT_SEND_RESET:
24979f007422SMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_SEND_RESET;
24989f007422SMatthias Ringwald                 break;
24999f007422SMatthias Ringwald             case HCI_INIT_SEND_RESET_CSR_WARM_BOOT:
25009f007422SMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_CUSTOM_INIT_CSR_WARM_BOOT;
25019f007422SMatthias Ringwald                 break;
25029f007422SMatthias Ringwald             default:
25039f007422SMatthias Ringwald                 break;
25049f007422SMatthias Ringwald         }
25059f007422SMatthias Ringwald     }
25060f97eae7SMatthias Ringwald 
250706b9e820SMatthias Ringwald #endif
25080f97eae7SMatthias Ringwald 
2509a2481739S[email protected]     if (!command_completed) return;
2510a2481739S[email protected] 
251107fd2f31SMatthias Ringwald     bool need_baud_change = false;
251207fd2f31SMatthias Ringwald     bool need_addr_change = false;
251306b9e820SMatthias Ringwald 
25146fad2c37SMatthias Ringwald #ifndef HAVE_HOST_CONTROLLER_API
251506b9e820SMatthias Ringwald     need_baud_change = hci_stack->config
25163fb36a29SMatthias Ringwald                         && hci_stack->chipset
25173fb36a29SMatthias Ringwald                         && hci_stack->chipset->set_baudrate_command
2518db8bc6ffSMatthias Ringwald                         && hci_stack->hci_transport->set_baudrate
25199796ebeaSMatthias Ringwald                         && ((hci_transport_config_uart_t *)hci_stack->config)->baudrate_main;
2520db8bc6ffSMatthias Ringwald 
252106b9e820SMatthias Ringwald     need_addr_change = hci_stack->custom_bd_addr_set
25223fb36a29SMatthias Ringwald                         && hci_stack->chipset
25233fb36a29SMatthias Ringwald                         && hci_stack->chipset->set_bd_addr_command;
252406b9e820SMatthias Ringwald #endif
2525a80162e9SMatthias Ringwald 
25265c363727SMatthias Ringwald     switch(hci_stack->substate){
252706b9e820SMatthias Ringwald 
25286fad2c37SMatthias Ringwald #ifndef HAVE_HOST_CONTROLLER_API
25299f007422SMatthias Ringwald         case HCI_INIT_SEND_RESET:
2530d58dd308SMatthias Ringwald             // on CSR with BCSP/H5, resend triggers resend of HCI Reset and leads to substate == HCI_INIT_SEND_RESET
25319f007422SMatthias Ringwald             // fix: just correct substate and behave as command below
2532f4c579d4SMatthias Ringwald 
2533f4c579d4SMatthias Ringwald             /* fall through */
2534f4c579d4SMatthias Ringwald #endif
2535f4c579d4SMatthias Ringwald 
253674b323a9SMatthias Ringwald         case HCI_INIT_W4_SEND_RESET:
2537528a4a3bSMatthias Ringwald             btstack_run_loop_remove_timer(&hci_stack->timeout);
2538f4c579d4SMatthias Ringwald             hci_stack->substate = HCI_INIT_SEND_READ_LOCAL_VERSION_INFORMATION;
25392f48d920SMatthias Ringwald             return;
2540f4c579d4SMatthias Ringwald 
2541f4c579d4SMatthias Ringwald #ifndef HAVE_HOST_CONTROLLER_API
2542a80162e9SMatthias Ringwald         case HCI_INIT_W4_SEND_BAUD_CHANGE:
25434696bddbSMatthias Ringwald             // for STLC2500D, baud rate change already happened.
2544fab26ab3SMatthias Ringwald             // for others, baud rate gets changed now
254561f37892SMatthias Ringwald             if ((hci_stack->manufacturer != BLUETOOTH_COMPANY_ID_ST_MICROELECTRONICS) && need_baud_change){
254696b53536SMatthias Ringwald                 uint32_t baud_rate = hci_transport_uart_get_main_baud_rate();
2547cd724cb7SMatthias Ringwald                 log_info("Local baud rate change to %" PRIu32 "(w4_send_baud_change)", baud_rate);
2548fab26ab3SMatthias Ringwald                 hci_stack->hci_transport->set_baudrate(baud_rate);
25494696bddbSMatthias Ringwald             }
255074b323a9SMatthias Ringwald             hci_stack->substate = HCI_INIT_CUSTOM_INIT;
255174b323a9SMatthias Ringwald             return;
2552a80162e9SMatthias Ringwald         case HCI_INIT_W4_CUSTOM_INIT_CSR_WARM_BOOT:
2553528a4a3bSMatthias Ringwald             btstack_run_loop_remove_timer(&hci_stack->timeout);
2554a80162e9SMatthias Ringwald             hci_stack->substate = HCI_INIT_CUSTOM_INIT;
2555a80162e9SMatthias Ringwald             return;
255674b323a9SMatthias Ringwald         case HCI_INIT_W4_CUSTOM_INIT:
255774b323a9SMatthias Ringwald             // repeat custom init
255874b323a9SMatthias Ringwald             hci_stack->substate = HCI_INIT_CUSTOM_INIT;
255974b323a9SMatthias Ringwald             return;
25606fe16221SMatthias Ringwald         case HCI_INIT_W4_CUSTOM_PRE_INIT:
25616fe16221SMatthias Ringwald             // repeat custom init
25626fe16221SMatthias Ringwald             hci_stack->substate = HCI_INIT_CUSTOM_PRE_INIT;
25636fe16221SMatthias Ringwald             return;
256406b9e820SMatthias Ringwald #endif
256506b9e820SMatthias Ringwald 
2566a828a756SMatthias Ringwald         case HCI_INIT_W4_READ_LOCAL_SUPPORTED_COMMANDS:
25670e588213SMatthias Ringwald             if (need_baud_change && (hci_stack->chipset_result != BTSTACK_CHIPSET_NO_INIT_SCRIPT) &&
2568efd3b327SMatthias Ringwald               ((hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_BROADCOM_CORPORATION) ||
2569efd3b327SMatthias Ringwald                (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_EM_MICROELECTRONIC_MARIN_SA))) {
2570eb3a5314SMatthias Ringwald                 hci_stack->substate = HCI_INIT_SEND_BAUD_CHANGE_BCM;
2571eb3a5314SMatthias Ringwald                 return;
2572eb3a5314SMatthias Ringwald             }
257353860077SMatthias Ringwald             if (need_addr_change){
257453860077SMatthias Ringwald                 hci_stack->substate = HCI_INIT_SET_BD_ADDR;
257553860077SMatthias Ringwald                 return;
257653860077SMatthias Ringwald             }
257753860077SMatthias Ringwald             hci_stack->substate = HCI_INIT_READ_BD_ADDR;
257853860077SMatthias Ringwald             return;
25796fad2c37SMatthias Ringwald #ifndef HAVE_HOST_CONTROLLER_API
25807224be7eSMatthias Ringwald         case HCI_INIT_W4_SEND_BAUD_CHANGE_BCM:
25817224be7eSMatthias Ringwald             if (need_baud_change){
258296b53536SMatthias Ringwald                 uint32_t baud_rate = hci_transport_uart_get_main_baud_rate();
2583cd724cb7SMatthias Ringwald                 log_info("Local baud rate change to %" PRIu32 "(w4_send_baud_change_bcm))", baud_rate);
2584fab26ab3SMatthias Ringwald                 hci_stack->hci_transport->set_baudrate(baud_rate);
25857224be7eSMatthias Ringwald             }
2586eb3a5314SMatthias Ringwald             if (need_addr_change){
2587eb3a5314SMatthias Ringwald                 hci_stack->substate = HCI_INIT_SET_BD_ADDR;
2588eb3a5314SMatthias Ringwald                 return;
2589eb3a5314SMatthias Ringwald             }
2590eb3a5314SMatthias Ringwald             hci_stack->substate = HCI_INIT_READ_BD_ADDR;
2591eb3a5314SMatthias Ringwald             return;
259253860077SMatthias Ringwald         case HCI_INIT_W4_SET_BD_ADDR:
25936ca9a99aSMatthias Ringwald             // for STLC2500D + ATWILC3000, bd addr change only gets active after sending reset command
25946ca9a99aSMatthias Ringwald             if ((hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_ST_MICROELECTRONICS)
25956ca9a99aSMatthias Ringwald             ||  (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_ATMEL_CORPORATION)){
259653860077SMatthias Ringwald                 hci_stack->substate = HCI_INIT_SEND_RESET_ST_WARM_BOOT;
259753860077SMatthias Ringwald                 return;
259853860077SMatthias Ringwald             }
259953860077SMatthias Ringwald             // skipping st warm boot
260053860077SMatthias Ringwald             hci_stack->substate = HCI_INIT_READ_BD_ADDR;
260153860077SMatthias Ringwald             return;
260253860077SMatthias Ringwald         case HCI_INIT_W4_SEND_RESET_ST_WARM_BOOT:
260353860077SMatthias Ringwald             hci_stack->substate = HCI_INIT_READ_BD_ADDR;
260453860077SMatthias Ringwald             return;
260506b9e820SMatthias Ringwald #endif
2606e7c662faSMatthias Ringwald 
2607f795c86eSMatthias Ringwald         case HCI_INIT_DONE:
2608eb8d95caSMatthias Ringwald             // set state if we came here by fall through
2609eb8d95caSMatthias Ringwald             hci_stack->substate = HCI_INIT_DONE;
2610f795c86eSMatthias Ringwald             return;
2611a650ba4dSMatthias Ringwald 
26126155b3d3S[email protected]         default:
261374b323a9SMatthias Ringwald             break;
26146155b3d3S[email protected]     }
261555975f88SMatthias Ringwald     hci_initializing_next_state();
26166155b3d3S[email protected] }
26176155b3d3S[email protected] 
26180bbba85bSMatthias Ringwald static void hci_handle_connection_failed(hci_connection_t * conn, uint8_t status){
26193bb5ff27SMatthias Ringwald     // CC2564C might emit Connection Complete for rejected incoming SCO connection
26201a4fdac4SMatthias Ringwald     // To prevent accidentally free'ing the HCI connection for the ACL connection,
26211a4fdac4SMatthias Ringwald     // check if we have been aware of the HCI connection
26221f34df2cSMatthias Ringwald     switch (conn->state){
26231a4fdac4SMatthias Ringwald         case SENT_CREATE_CONNECTION:
26241f34df2cSMatthias Ringwald         case RECEIVED_CONNECTION_REQUEST:
26259071873aSMatthias Ringwald         case ACCEPTED_CONNECTION_REQUEST:
26261f34df2cSMatthias Ringwald             break;
26271f34df2cSMatthias Ringwald         default:
26281f34df2cSMatthias Ringwald             return;
26291f34df2cSMatthias Ringwald     }
26303bb5ff27SMatthias Ringwald 
2631229331c6SMatthias Ringwald     log_info("Outgoing connection to %s failed", bd_addr_to_str(conn->address));
26320bbba85bSMatthias Ringwald     bd_addr_t bd_address;
26336535961aSMatthias Ringwald     (void)memcpy(&bd_address, conn->address, 6);
26340bbba85bSMatthias Ringwald 
26356bc9fa5eSMatthias Ringwald #ifdef ENABLE_CLASSIC
26366bc9fa5eSMatthias Ringwald     // cache needed data
26376bc9fa5eSMatthias Ringwald     int notify_dedicated_bonding_failed = conn->bonding_flags & BONDING_DEDICATED;
26386bc9fa5eSMatthias Ringwald #endif
26396bc9fa5eSMatthias Ringwald 
26400bbba85bSMatthias Ringwald     // connection failed, remove entry
26410bbba85bSMatthias Ringwald     btstack_linked_list_remove(&hci_stack->connections, (btstack_linked_item_t *) conn);
26420bbba85bSMatthias Ringwald     btstack_memory_hci_connection_free( conn );
26430bbba85bSMatthias Ringwald 
26446bc9fa5eSMatthias Ringwald #ifdef ENABLE_CLASSIC
26450bbba85bSMatthias Ringwald     // notify client if dedicated bonding
26460bbba85bSMatthias Ringwald     if (notify_dedicated_bonding_failed){
26470bbba85bSMatthias Ringwald         log_info("hci notify_dedicated_bonding_failed");
26480bbba85bSMatthias Ringwald         hci_emit_dedicated_bonding_result(bd_address, status);
26490bbba85bSMatthias Ringwald     }
26500bbba85bSMatthias Ringwald 
26510bbba85bSMatthias Ringwald     // if authentication error, also delete link key
26520bbba85bSMatthias Ringwald     if (status == ERROR_CODE_AUTHENTICATION_FAILURE) {
26530bbba85bSMatthias Ringwald         gap_drop_link_key_for_bd_addr(bd_address);
26540bbba85bSMatthias Ringwald     }
26551c79b5e3SMatthias Ringwald #else
26561c79b5e3SMatthias Ringwald     UNUSED(status);
26576bc9fa5eSMatthias Ringwald #endif
26580bbba85bSMatthias Ringwald }
26590bbba85bSMatthias Ringwald 
2660be500194SMatthias Ringwald #ifdef ENABLE_CLASSIC
26612f5c44baSMatthias Ringwald static void hci_handle_remote_features_page_0(hci_connection_t * conn, const uint8_t * features){
26622f5c44baSMatthias Ringwald     // SSP Controller
26632f5c44baSMatthias Ringwald     if (features[6] & (1 << 3)){
26642f5c44baSMatthias Ringwald         conn->bonding_flags |= BONDING_REMOTE_SUPPORTS_SSP_CONTROLLER;
26652f5c44baSMatthias Ringwald     }
26662f5c44baSMatthias Ringwald     // eSCO
26672f5c44baSMatthias Ringwald     if (features[3] & (1<<7)){
26682f5c44baSMatthias Ringwald         conn->remote_supported_features[0] |= 1;
26692f5c44baSMatthias Ringwald     }
26702f5c44baSMatthias Ringwald     // Extended features
26712f5c44baSMatthias Ringwald     if (features[7] & (1<<7)){
26722f5c44baSMatthias Ringwald         conn->remote_supported_features[0] |= 2;
26732f5c44baSMatthias Ringwald     }
26740b78a447SMatthias Ringwald     // SCO packet types
26750b78a447SMatthias Ringwald     conn->remote_supported_sco_packets = hci_sco_packet_types_for_features(features);
26762f5c44baSMatthias Ringwald }
26772f5c44baSMatthias Ringwald 
26782f5c44baSMatthias Ringwald static void hci_handle_remote_features_page_1(hci_connection_t * conn, const uint8_t * features){
26792f5c44baSMatthias Ringwald     // SSP Host
26802f5c44baSMatthias Ringwald     if (features[0] & (1 << 0)){
26812f5c44baSMatthias Ringwald         conn->bonding_flags |= BONDING_REMOTE_SUPPORTS_SSP_HOST;
26822f5c44baSMatthias Ringwald     }
268350c51a77SMatthias Ringwald     // SC Host
268450c51a77SMatthias Ringwald     if (features[0] & (1 << 3)){
268550c51a77SMatthias Ringwald         conn->bonding_flags |= BONDING_REMOTE_SUPPORTS_SC_HOST;
268650c51a77SMatthias Ringwald     }
268750c51a77SMatthias Ringwald }
268850c51a77SMatthias Ringwald 
268950c51a77SMatthias Ringwald static void hci_handle_remote_features_page_2(hci_connection_t * conn, const uint8_t * features){
269050c51a77SMatthias Ringwald     // SC Controller
269150c51a77SMatthias Ringwald     if (features[1] & (1 << 0)){
269250c51a77SMatthias Ringwald         conn->bonding_flags |= BONDING_REMOTE_SUPPORTS_SC_CONTROLLER;
269350c51a77SMatthias Ringwald     }
26942f5c44baSMatthias Ringwald }
26952f5c44baSMatthias Ringwald 
2696de0df013SMatthias Ringwald static void hci_handle_remote_features_received(hci_connection_t * conn){
2697461a2bc4SMatthias Ringwald     conn->bonding_flags &= ~BONDING_REMOTE_FEATURES_QUERY_ACTIVE;
2698de0df013SMatthias Ringwald     conn->bonding_flags |= BONDING_RECEIVED_REMOTE_FEATURES;
2699cb7b3e6fSMatthias Ringwald     log_info("Remote features %02x, bonding flags %" PRIx32, conn->remote_supported_features[0], conn->bonding_flags);
2700de0df013SMatthias Ringwald     if (conn->bonding_flags & BONDING_DEDICATED){
2701de0df013SMatthias Ringwald         conn->bonding_flags |= BONDING_SEND_AUTHENTICATE_REQUEST;
2702de0df013SMatthias Ringwald     }
2703de0df013SMatthias Ringwald }
2704128825c3SMatthias Ringwald static bool hci_remote_sc_enabled(hci_connection_t * connection){
2705128825c3SMatthias Ringwald     const uint16_t sc_enabled_mask = BONDING_REMOTE_SUPPORTS_SC_HOST | BONDING_REMOTE_SUPPORTS_SC_CONTROLLER;
2706128825c3SMatthias Ringwald     return (connection->bonding_flags & sc_enabled_mask) == sc_enabled_mask;
2707128825c3SMatthias Ringwald }
2708128825c3SMatthias Ringwald 
2709be500194SMatthias Ringwald #endif
2710de0df013SMatthias Ringwald 
271167c6c9dcSMatthias Ringwald static void handle_event_for_current_stack_state(const uint8_t * packet, uint16_t size) {
271267c6c9dcSMatthias Ringwald     // handle BT initialization
271367c6c9dcSMatthias Ringwald     if (hci_stack->state == HCI_STATE_INITIALIZING) {
271467c6c9dcSMatthias Ringwald         hci_initializing_event_handler(packet, size);
271567c6c9dcSMatthias Ringwald     }
271667c6c9dcSMatthias Ringwald 
271767c6c9dcSMatthias Ringwald     // help with BT sleep
271867c6c9dcSMatthias Ringwald     if ((hci_stack->state == HCI_STATE_FALLING_ASLEEP)
271967c6c9dcSMatthias Ringwald         && (hci_stack->substate == HCI_FALLING_ASLEEP_W4_WRITE_SCAN_ENABLE)
272072a2585aSMatthias Ringwald         && (hci_event_packet_get_type(packet) == HCI_EVENT_COMMAND_COMPLETE)
272172a2585aSMatthias Ringwald         && (hci_event_command_complete_get_command_opcode(packet) == HCI_OPCODE_HCI_WRITE_SCAN_ENABLE)){
272267c6c9dcSMatthias Ringwald         hci_initializing_next_state();
272367c6c9dcSMatthias Ringwald     }
272467c6c9dcSMatthias Ringwald }
272567c6c9dcSMatthias Ringwald 
27269866fdc7SMatthias Ringwald #ifdef ENABLE_CLASSIC
27274aa2f135SMatthias Ringwald static void hci_handle_mutual_authentication_completed(hci_connection_t * conn){
27284aa2f135SMatthias Ringwald     // bonding complete if connection is authenticated (either initiated or BR/EDR SC)
27294aa2f135SMatthias Ringwald     conn->requested_security_level = LEVEL_0;
27304aa2f135SMatthias Ringwald     gap_security_level_t security_level = gap_security_level_for_connection(conn);
27314aa2f135SMatthias Ringwald     hci_emit_security_level(conn->con_handle, security_level);
27324aa2f135SMatthias Ringwald 
273367718330SMatthias Ringwald     // dedicated bonding
2734de9f0299SMatthias Ringwald     if ((conn->bonding_flags & BONDING_DEDICATED) != 0){
2735de9f0299SMatthias Ringwald         conn->bonding_flags &= ~BONDING_DEDICATED;
2736de9f0299SMatthias Ringwald         conn->bonding_status = security_level == 0 ? ERROR_CODE_INSUFFICIENT_SECURITY : ERROR_CODE_SUCCESS;
2737db3c1f89SMatthias Ringwald #ifdef ENABLE_EXPLICIT_DEDICATED_BONDING_DISCONNECT
2738db3c1f89SMatthias Ringwald         // emit dedicated bonding complete, don't disconnect
2739db3c1f89SMatthias Ringwald         hci_emit_dedicated_bonding_result(conn->address, conn->bonding_status);
2740db3c1f89SMatthias Ringwald #else
2741db3c1f89SMatthias Ringwald         // request disconnect, event is emitted after disconnect
2742db3c1f89SMatthias Ringwald         conn->bonding_flags |= BONDING_DISCONNECT_DEDICATED_DONE;
2743db3c1f89SMatthias Ringwald #endif
2744de9f0299SMatthias Ringwald     }
274567718330SMatthias Ringwald }
2746abdad579SMatthias Ringwald 
274767718330SMatthias Ringwald static void hci_handle_read_encryption_key_size_complete(hci_connection_t * conn, uint8_t encryption_key_size) {
274867718330SMatthias Ringwald     conn->authentication_flags |= AUTH_FLAG_CONNECTION_ENCRYPTED;
274967718330SMatthias Ringwald     conn->encryption_key_size = encryption_key_size;
275067718330SMatthias Ringwald 
275167718330SMatthias Ringwald     // mutual authentication complete if authenticated and we have retrieved the encryption key size
27528daf94bcSMatthias Ringwald     if ((conn->authentication_flags & AUTH_FLAG_CONNECTION_AUTHENTICATED) != 0) {
27534aa2f135SMatthias Ringwald         hci_handle_mutual_authentication_completed(conn);
27544cd03f8aSMatthias Ringwald     } else {
27554cd03f8aSMatthias Ringwald         // otherwise trigger remote feature request and send authentication request
2756dbe0d85cSMatthias Ringwald         hci_trigger_remote_features_for_connection(conn);
27574cd03f8aSMatthias Ringwald         if ((conn->bonding_flags & BONDING_SENT_AUTHENTICATE_REQUEST) == 0) {
2758abdad579SMatthias Ringwald             conn->bonding_flags |= BONDING_SEND_AUTHENTICATE_REQUEST;
27599866fdc7SMatthias Ringwald         }
27604cd03f8aSMatthias Ringwald     }
27614cd03f8aSMatthias Ringwald }
27629866fdc7SMatthias Ringwald #endif
27639866fdc7SMatthias Ringwald 
27643b631737SMatthias Ringwald static void hci_store_local_supported_commands(const uint8_t * packet){
276525e46151SMatthias Ringwald     // create mapping table
276625e46151SMatthias Ringwald #define X(name, offset, bit) { offset, bit },
276725e46151SMatthias Ringwald     static struct {
276825e46151SMatthias Ringwald         uint8_t byte_offset;
276925e46151SMatthias Ringwald         uint8_t bit_position;
277025e46151SMatthias Ringwald     } supported_hci_commands_map [] = {
277125e46151SMatthias Ringwald         SUPPORTED_HCI_COMMANDS
277225e46151SMatthias Ringwald     };
277325e46151SMatthias Ringwald #undef X
277425e46151SMatthias Ringwald 
277525e46151SMatthias Ringwald     // create names for debug purposes
277625e46151SMatthias Ringwald #ifdef ENABLE_LOG_DEBUG
277725e46151SMatthias Ringwald #define X(name, offset, bit) #name,
277825e46151SMatthias Ringwald     static const char * command_names[] = {
277925e46151SMatthias Ringwald         SUPPORTED_HCI_COMMANDS
278025e46151SMatthias Ringwald     };
278125e46151SMatthias Ringwald #undef X
278225e46151SMatthias Ringwald #endif
278325e46151SMatthias Ringwald 
27841ffa425cSMatthias Ringwald     hci_stack->local_supported_commands = 0;
278525e46151SMatthias Ringwald     const uint8_t * commands_map = &packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1];
278625e46151SMatthias Ringwald     uint16_t i;
278725e46151SMatthias Ringwald     for (i = 0 ; i < SUPPORTED_HCI_COMMANDS_COUNT ; i++){
278825e46151SMatthias Ringwald         if ((commands_map[supported_hci_commands_map[i].byte_offset] & (1 << supported_hci_commands_map[i].bit_position)) != 0){
278925e46151SMatthias Ringwald #ifdef ENABLE_LOG_DEBUG
279025e46151SMatthias Ringwald             log_info("Command %s (%u) supported %u/%u", command_names[i], i, supported_hci_commands_map[i].byte_offset, supported_hci_commands_map[i].bit_position);
279125e46151SMatthias Ringwald #else
27921ffa425cSMatthias Ringwald             log_info("Command 0x%02x supported %u/%u", i, supported_hci_commands_map[i].byte_offset, supported_hci_commands_map[i].bit_position);
279325e46151SMatthias Ringwald #endif
27941ffa425cSMatthias Ringwald             hci_stack->local_supported_commands |= (1LU << i);
279525e46151SMatthias Ringwald         }
279625e46151SMatthias Ringwald     }
2797cb7b3e6fSMatthias Ringwald     log_info("Local supported commands summary %08" PRIx32, hci_stack->local_supported_commands);
27983b631737SMatthias Ringwald }
27993b631737SMatthias Ringwald 
28004f781026SMatthias Ringwald static void handle_command_complete_event(uint8_t * packet, uint16_t size){
2801b08371a9SMilanka Ringwald     UNUSED(size);
2802e76a89eeS[email protected] 
28034781fa78SDirk Helbig     uint8_t status = 0;
28044781fa78SDirk Helbig     if( size > OFFSET_OF_DATA_IN_COMMAND_COMPLETE ) {
28054781fa78SDirk Helbig         status = hci_event_command_complete_get_return_parameters(packet)[0];
28064781fa78SDirk Helbig     }
28079cbd2215SMatthias Ringwald     uint16_t manufacturer;
28089cbd2215SMatthias Ringwald #ifdef ENABLE_CLASSIC
28091f7b95a1Smatthias.ringwald     hci_connection_t * conn;
2810c7a108afSMatthias Ringwald #endif
2811c7a108afSMatthias Ringwald #if defined(ENABLE_CLASSIC) || (defined(ENABLE_BLE) && defined(ENABLE_LE_ISOCHRONOUS_STREAMS))
28124781fa78SDirk Helbig     hci_con_handle_t handle;
28139cbd2215SMatthias Ringwald #endif
2814d3a89d91SMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
2815d3a89d91SMatthias Ringwald     le_audio_cig_t * cig;
2816d3a89d91SMatthias Ringwald #endif
281791036612SMatthias Ringwald #if defined(ENABLE_BLE) && defined(ENABLE_HCI_COMMAND_STATUS_DISCARDED_FOR_FAILED_CONNECTIONS_WORKAROUND)
2818f48a5586SMatthias Ringwald     hci_stack->hci_command_con_handle = HCI_CON_HANDLE_INVALID;
2819f48a5586SMatthias Ringwald #endif
2820d3a89d91SMatthias Ringwald 
28216bef4003SMatthias Ringwald     // get num cmd packets - limit to 1 to reduce complexity
28226bef4003SMatthias Ringwald     hci_stack->num_cmd_packets = packet[2] ? 1 : 0;
28237ec5eeaaSmatthias.ringwald 
2824645b7c25SMatthias Ringwald     uint16_t opcode = hci_event_command_complete_get_command_opcode(packet);
2825645b7c25SMatthias Ringwald     switch (opcode){
2826645b7c25SMatthias Ringwald         case HCI_OPCODE_HCI_READ_LOCAL_NAME:
28274781fa78SDirk Helbig             if (status) break;
28289e263bd7SMatthias Ringwald             // terminate, name 248 chars
28299e263bd7SMatthias Ringwald             packet[6+248] = 0;
28309e263bd7SMatthias Ringwald             log_info("local name: %s", &packet[6]);
2831645b7c25SMatthias Ringwald             break;
2832645b7c25SMatthias Ringwald         case HCI_OPCODE_HCI_READ_BUFFER_SIZE:
28331d279b20Smatthias.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"
2834c3b46f5aSMatthias Ringwald             if (hci_stack->state == HCI_STATE_INITIALIZING) {
2835429122ccSMatthias Ringwald                 uint16_t acl_len = little_endian_read_16(packet, 6);
2836429122ccSMatthias Ringwald                 uint16_t sco_len = packet[8];
2837429122ccSMatthias Ringwald 
2838429122ccSMatthias Ringwald                 // determine usable ACL/SCO payload size
2839429122ccSMatthias Ringwald                 hci_stack->acl_data_packet_length = btstack_min(acl_len, HCI_ACL_PAYLOAD_SIZE);
2840429122ccSMatthias Ringwald                 hci_stack->sco_data_packet_length = btstack_min(sco_len, HCI_ACL_PAYLOAD_SIZE);
2841429122ccSMatthias Ringwald 
2842616cfd90SMatthias Ringwald                 hci_stack->acl_packets_total_num = (uint8_t) btstack_min(little_endian_read_16(packet,  9), MAX_NR_CONTROLLER_ACL_BUFFERS);
2843616cfd90SMatthias Ringwald                 hci_stack->sco_packets_total_num = (uint8_t) btstack_min(little_endian_read_16(packet, 11), MAX_NR_CONTROLLER_SCO_PACKETS);
2844a8b12447S[email protected] 
2845429122ccSMatthias Ringwald                 log_info("hci_read_buffer_size: ACL size module %u -> used %u, count %u / SCO size %u, count %u",
2846429122ccSMatthias Ringwald                          acl_len, hci_stack->acl_data_packet_length, hci_stack->acl_packets_total_num,
28471a06f663S[email protected]                          hci_stack->sco_data_packet_length, hci_stack->sco_packets_total_num);
2848c3b46f5aSMatthias Ringwald             }
2849645b7c25SMatthias Ringwald             break;
2850645b7c25SMatthias Ringwald         case HCI_OPCODE_HCI_READ_RSSI:
28514781fa78SDirk Helbig             if (status == ERROR_CODE_SUCCESS){
2852891b9fc2SMatthias Ringwald                 uint8_t event[5];
2853891b9fc2SMatthias Ringwald                 event[0] = GAP_EVENT_RSSI_MEASUREMENT;
2854891b9fc2SMatthias Ringwald                 event[1] = 3;
28556535961aSMatthias Ringwald                 (void)memcpy(&event[2], &packet[6], 3);
2856891b9fc2SMatthias Ringwald                 hci_emit_event(event, sizeof(event), 1);
2857891b9fc2SMatthias Ringwald             }
2858645b7c25SMatthias Ringwald             break;
2859a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE
286079b7ea2dSMatthias Ringwald         case HCI_OPCODE_HCI_LE_READ_BUFFER_SIZE_V2:
286179b7ea2dSMatthias Ringwald             hci_stack->le_iso_packets_length = little_endian_read_16(packet, 9);
286279b7ea2dSMatthias Ringwald             hci_stack->le_iso_packets_total_num = packet[11];
286379b7ea2dSMatthias Ringwald             log_info("hci_le_read_buffer_size_v2: iso size %u, iso count %u",
286479b7ea2dSMatthias Ringwald                      hci_stack->le_iso_packets_length, hci_stack->le_iso_packets_total_num);
286579b7ea2dSMatthias Ringwald 
286679b7ea2dSMatthias Ringwald             /* fall through */
286779b7ea2dSMatthias Ringwald 
2868645b7c25SMatthias Ringwald         case HCI_OPCODE_HCI_LE_READ_BUFFER_SIZE:
2869f8fbdce0SMatthias Ringwald             hci_stack->le_data_packets_length = little_endian_read_16(packet, 6);
2870ee303eddS[email protected]             hci_stack->le_acl_packets_total_num = packet[8];
28716c26b087S[email protected]             // determine usable ACL payload size
28726c26b087S[email protected]             if (HCI_ACL_PAYLOAD_SIZE < hci_stack->le_data_packets_length){
28736c26b087S[email protected]                 hci_stack->le_data_packets_length = HCI_ACL_PAYLOAD_SIZE;
28746c26b087S[email protected]             }
287579b7ea2dSMatthias Ringwald             log_info("hci_le_read_buffer_size: acl size %u, acl count %u", hci_stack->le_data_packets_length, hci_stack->le_acl_packets_total_num);
2876645b7c25SMatthias Ringwald             break;
2877b435e062SMatthias Ringwald #endif
2878b435e062SMatthias Ringwald #ifdef ENABLE_LE_DATA_LENGTH_EXTENSION
2879645b7c25SMatthias Ringwald         case HCI_OPCODE_HCI_LE_READ_MAXIMUM_DATA_LENGTH:
2880dcd678baSMatthias Ringwald             hci_stack->le_supported_max_tx_octets = little_endian_read_16(packet, 6);
2881dcd678baSMatthias Ringwald             hci_stack->le_supported_max_tx_time = little_endian_read_16(packet, 8);
2882dcd678baSMatthias Ringwald             log_info("hci_le_read_maximum_data_length: tx octets %u, tx time %u us", hci_stack->le_supported_max_tx_octets, hci_stack->le_supported_max_tx_time);
2883645b7c25SMatthias Ringwald             break;
2884b435e062SMatthias Ringwald #endif
2885d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
2886645b7c25SMatthias Ringwald         case HCI_OPCODE_HCI_LE_READ_WHITE_LIST_SIZE:
2887e691bb38SMatthias Ringwald             hci_stack->le_whitelist_capacity = packet[6];
288815d0a15bSMatthias Ringwald             log_info("hci_le_read_white_list_size: size %u", hci_stack->le_whitelist_capacity);
2889645b7c25SMatthias Ringwald             break;
289065a46ef3S[email protected] #endif
28913a74541eSMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
28923a74541eSMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
28933a74541eSMatthias Ringwald         case HCI_OPCODE_HCI_LE_READ_MAXIMUM_ADVERTISING_DATA_LENGTH:
28943a74541eSMatthias Ringwald             hci_stack->le_maximum_advertising_data_length = little_endian_read_16(packet, 6);
28953a74541eSMatthias Ringwald             break;
289625df6c61SMatthias Ringwald         case HCI_OPCODE_HCI_LE_SET_EXTENDED_ADVERTISING_PARAMETERS:
289725df6c61SMatthias Ringwald             if (hci_stack->le_advertising_set_in_current_command != 0) {
289825df6c61SMatthias Ringwald                 le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(hci_stack->le_advertising_set_in_current_command);
289925df6c61SMatthias Ringwald                 hci_stack->le_advertising_set_in_current_command = 0;
290025df6c61SMatthias Ringwald                 if (advertising_set == NULL) break;
290125df6c61SMatthias Ringwald                 uint8_t adv_status = packet[6];
290225df6c61SMatthias Ringwald                 uint8_t tx_power   = packet[7];
290325df6c61SMatthias Ringwald                 uint8_t event[] = { HCI_EVENT_META_GAP, 4, GAP_SUBEVENT_ADVERTISING_SET_INSTALLED, hci_stack->le_advertising_set_in_current_command, adv_status, tx_power };
290425df6c61SMatthias Ringwald                 if (adv_status == 0){
290525df6c61SMatthias Ringwald                     advertising_set->state |= LE_ADVERTISEMENT_STATE_PARAMS_SET;
290625df6c61SMatthias Ringwald                 }
290725df6c61SMatthias Ringwald                 hci_emit_event(event, sizeof(event), 1);
290825df6c61SMatthias Ringwald             }
290925df6c61SMatthias Ringwald             break;
291025df6c61SMatthias Ringwald         case HCI_OPCODE_HCI_LE_REMOVE_ADVERTISING_SET:
291125df6c61SMatthias Ringwald             if (hci_stack->le_advertising_set_in_current_command != 0) {
291225df6c61SMatthias Ringwald                 le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(hci_stack->le_advertising_set_in_current_command);
291325df6c61SMatthias Ringwald                 hci_stack->le_advertising_set_in_current_command = 0;
291425df6c61SMatthias Ringwald                 if (advertising_set == NULL) break;
29154781fa78SDirk Helbig                 uint8_t event[] = { HCI_EVENT_META_GAP, 3, GAP_SUBEVENT_ADVERTISING_SET_REMOVED, hci_stack->le_advertising_set_in_current_command, status };
29164781fa78SDirk Helbig                 if (status == 0){
291725df6c61SMatthias Ringwald                     btstack_linked_list_remove(&hci_stack->le_advertising_sets, (btstack_linked_item_t *) advertising_set);
291825df6c61SMatthias Ringwald                 }
291925df6c61SMatthias Ringwald                 hci_emit_event(event, sizeof(event), 1);
292025df6c61SMatthias Ringwald             }
292125df6c61SMatthias Ringwald             break;
29223a74541eSMatthias Ringwald #endif
29233a74541eSMatthias Ringwald #endif
2924645b7c25SMatthias Ringwald         case HCI_OPCODE_HCI_READ_BD_ADDR:
2925645b7c25SMatthias Ringwald             reverse_bd_addr(&packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE + 1], hci_stack->local_bd_addr);
29264781fa78SDirk Helbig             log_info("Local Address, Status: 0x%02x: Addr: %s", status, bd_addr_to_str(hci_stack->local_bd_addr));
292733373e40SMatthias Ringwald #ifdef ENABLE_CLASSIC
29281624665aSMatthias Ringwald             if (hci_stack->link_key_db){
29291624665aSMatthias Ringwald                 hci_stack->link_key_db->set_local_bd_addr(hci_stack->local_bd_addr);
29301624665aSMatthias Ringwald             }
293133373e40SMatthias Ringwald #endif
2932645b7c25SMatthias Ringwald             break;
293335454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
2934645b7c25SMatthias Ringwald         case HCI_OPCODE_HCI_WRITE_SCAN_ENABLE:
293571fd255dSMatthias Ringwald             hci_emit_scan_mode_changed(hci_stack->discoverable, hci_stack->connectable);
2936645b7c25SMatthias Ringwald             break;
29373d1f2d24SMatthias Ringwald         case HCI_OPCODE_HCI_PERIODIC_INQUIRY_MODE:
29383d1f2d24SMatthias Ringwald             if (status == ERROR_CODE_SUCCESS) {
29393d1f2d24SMatthias Ringwald                 hci_stack->inquiry_state = GAP_INQUIRY_STATE_PERIODIC;
29403d1f2d24SMatthias Ringwald             } else {
29413d1f2d24SMatthias Ringwald                 hci_stack->inquiry_state = GAP_INQUIRY_STATE_IDLE;
29423d1f2d24SMatthias Ringwald             }
29433d1f2d24SMatthias Ringwald             break;
2944645b7c25SMatthias Ringwald         case HCI_OPCODE_HCI_INQUIRY_CANCEL:
294530199e24SMatthias Ringwald         case HCI_OPCODE_HCI_EXIT_PERIODIC_INQUIRY_MODE:
2946f5875de5SMatthias Ringwald             if (hci_stack->inquiry_state == GAP_INQUIRY_STATE_W4_CANCELLED){
2947f5875de5SMatthias Ringwald                 hci_stack->inquiry_state = GAP_INQUIRY_STATE_IDLE;
2948f5875de5SMatthias Ringwald                 uint8_t event[] = { GAP_EVENT_INQUIRY_COMPLETE, 1, 0};
2949f5875de5SMatthias Ringwald                 hci_emit_event(event, sizeof(event), 1);
2950f5875de5SMatthias Ringwald             }
2951645b7c25SMatthias Ringwald             break;
295235454696SMatthias Ringwald #endif
2953645b7c25SMatthias Ringwald         case HCI_OPCODE_HCI_READ_LOCAL_SUPPORTED_FEATURES:
29544f781026SMatthias Ringwald             (void)memcpy(hci_stack->local_supported_features, &packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE + 1], 8);
295565389bfcS[email protected] 
295635454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
2957a5a23fc2S[email protected]             // determine usable ACL packet types based on host buffer size and supported features
295829e39de4SMatthias Ringwald             hci_stack->usable_packet_types_acl = hci_acl_packet_types_for_buffer_size_and_local_features(HCI_ACL_PAYLOAD_SIZE, &hci_stack->local_supported_features[0]);
2959c92ca2c8SMatthias Ringwald             log_info("ACL Packet types %04x", hci_stack->usable_packet_types_acl);
2960c92ca2c8SMatthias Ringwald             // determine usable SCO packet types based on supported features
2961c92ca2c8SMatthias Ringwald             hci_stack->usable_packet_types_sco = hci_sco_packet_types_for_features(
2962c92ca2c8SMatthias Ringwald                     &hci_stack->local_supported_features[0]);
2963c92ca2c8SMatthias Ringwald             log_info("SCO Packet types %04x - eSCO %u", hci_stack->usable_packet_types_sco, hci_extended_sco_link_supported());
296435454696SMatthias Ringwald #endif
2965f5d8d141S[email protected]             // Classic/LE
2966f5d8d141S[email protected]             log_info("BR/EDR support %u, LE support %u", hci_classic_supported(), hci_le_supported());
2967645b7c25SMatthias Ringwald             break;
2968645b7c25SMatthias Ringwald         case HCI_OPCODE_HCI_READ_LOCAL_VERSION_INFORMATION:
2969645b7c25SMatthias Ringwald             manufacturer = little_endian_read_16(packet, 10);
2970547a29a6SMatthias Ringwald             // map Cypress & Infineon to Broadcom
2971547a29a6SMatthias Ringwald             switch (manufacturer){
2972547a29a6SMatthias Ringwald                 case BLUETOOTH_COMPANY_ID_CYPRESS_SEMICONDUCTOR:
2973547a29a6SMatthias Ringwald                 case BLUETOOTH_COMPANY_ID_INFINEON_TECHNOLOGIES_AG:
2974547a29a6SMatthias Ringwald                     log_info("Treat Cypress/Infineon as Broadcom");
2975c21d89f3SMatthias Ringwald                     manufacturer = BLUETOOTH_COMPANY_ID_BROADCOM_CORPORATION;
2976c21d89f3SMatthias Ringwald                     little_endian_store_16(packet, 10, manufacturer);
2977547a29a6SMatthias Ringwald                     break;
2978547a29a6SMatthias Ringwald                 default:
2979547a29a6SMatthias Ringwald                     break;
2980c21d89f3SMatthias Ringwald             }
2981c21d89f3SMatthias Ringwald             hci_stack->manufacturer = manufacturer;
29824696bddbSMatthias Ringwald             log_info("Manufacturer: 0x%04x", hci_stack->manufacturer);
2983645b7c25SMatthias Ringwald             break;
2984645b7c25SMatthias Ringwald         case HCI_OPCODE_HCI_READ_LOCAL_SUPPORTED_COMMANDS:
29853b631737SMatthias Ringwald             hci_store_local_supported_commands(packet);
2986645b7c25SMatthias Ringwald             break;
2987e8c8828eSMatthias Ringwald #ifdef ENABLE_CLASSIC
2988645b7c25SMatthias Ringwald         case HCI_OPCODE_HCI_WRITE_SYNCHRONOUS_FLOW_CONTROL_ENABLE:
29894781fa78SDirk Helbig             if (status) return;
29905b9b590fSMatthias Ringwald             hci_stack->synchronous_flow_control_enabled = 1;
2991645b7c25SMatthias Ringwald             break;
2992645b7c25SMatthias Ringwald         case HCI_OPCODE_HCI_READ_ENCRYPTION_KEY_SIZE:
2993573897a0SMatthias Ringwald             handle = little_endian_read_16(packet, OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1);
2994573897a0SMatthias Ringwald             conn   = hci_connection_for_handle(handle);
2995c3b46f5aSMatthias Ringwald             if (conn != NULL) {
29969866fdc7SMatthias Ringwald                 uint8_t key_size = 0;
2997573897a0SMatthias Ringwald                 if (status == 0){
29989866fdc7SMatthias Ringwald                     key_size = packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+3];
29994a659b0eSMatthias Ringwald                     log_info("Handle %04x key Size: %u", handle, key_size);
3000170fafaeSMatthias Ringwald                 } else {
3001e9f98c4aSMatthias Ringwald                     key_size = 1;
30029866fdc7SMatthias Ringwald                     log_info("Read Encryption Key Size failed 0x%02x-> assuming insecure connection with key size of 1", status);
3003573897a0SMatthias Ringwald                 }
30049866fdc7SMatthias Ringwald                 hci_handle_read_encryption_key_size_complete(conn, key_size);
3005c3b46f5aSMatthias Ringwald             }
3006645b7c25SMatthias Ringwald             break;
3007cc15bb2cSMatthias Ringwald         // assert pairing complete event is emitted.
3008cc15bb2cSMatthias Ringwald         // note: for SSP, Simple Pairing Complete Event is sufficient, but we want to be more robust
3009cc15bb2cSMatthias Ringwald         case HCI_OPCODE_HCI_PIN_CODE_REQUEST_NEGATIVE_REPLY:
3010cc15bb2cSMatthias Ringwald         case HCI_OPCODE_HCI_USER_PASSKEY_REQUEST_NEGATIVE_REPLY:
3011cc15bb2cSMatthias Ringwald         case HCI_OPCODE_HCI_USER_CONFIRMATION_REQUEST_NEGATIVE_REPLY:
30128cc1507eSMatthias Ringwald             hci_stack->gap_pairing_state = GAP_PAIRING_STATE_IDLE;
3013cc15bb2cSMatthias Ringwald             // lookup connection by gap pairing addr
3014cc15bb2cSMatthias Ringwald             conn = hci_connection_for_bd_addr_and_type(hci_stack->gap_pairing_addr, BD_ADDR_TYPE_ACL);
3015cc15bb2cSMatthias Ringwald             if (conn == NULL) break;
3016cc15bb2cSMatthias Ringwald             hci_pairing_complete(conn, ERROR_CODE_AUTHENTICATION_FAILURE);
3017cc15bb2cSMatthias Ringwald             break;
3018cc15bb2cSMatthias Ringwald 
301975a8e4faSMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB
302075a8e4faSMatthias Ringwald         case HCI_OPCODE_HCI_READ_LOCAL_OOB_DATA:
302175a8e4faSMatthias Ringwald         case HCI_OPCODE_HCI_READ_LOCAL_EXTENDED_OOB_DATA:{
302275a8e4faSMatthias Ringwald             uint8_t event[67];
302375a8e4faSMatthias Ringwald             event[0] = GAP_EVENT_LOCAL_OOB_DATA;
302475a8e4faSMatthias Ringwald             event[1] = 65;
302575a8e4faSMatthias Ringwald             (void)memset(&event[2], 0, 65);
30264781fa78SDirk Helbig             if (status == ERROR_CODE_SUCCESS){
302775a8e4faSMatthias Ringwald                 (void)memcpy(&event[3], &packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1], 32);
302875a8e4faSMatthias Ringwald                 if (opcode == HCI_OPCODE_HCI_READ_LOCAL_EXTENDED_OOB_DATA){
302975a8e4faSMatthias Ringwald                     event[2] = 3;
303075a8e4faSMatthias Ringwald                     (void)memcpy(&event[35], &packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+33], 32);
303175a8e4faSMatthias Ringwald                 } else {
303275a8e4faSMatthias Ringwald                     event[2] = 1;
303375a8e4faSMatthias Ringwald                 }
303475a8e4faSMatthias Ringwald             }
303575a8e4faSMatthias Ringwald             hci_emit_event(event, sizeof(event), 0);
303675a8e4faSMatthias Ringwald             break;
303775a8e4faSMatthias Ringwald         }
30381ae74bf3SMatthias Ringwald 
30391ae74bf3SMatthias Ringwald         // note: only needed if user does not provide OOB data
30401ae74bf3SMatthias Ringwald         case HCI_OPCODE_HCI_REMOTE_OOB_DATA_REQUEST_NEGATIVE_REPLY:
30411ae74bf3SMatthias Ringwald             conn = hci_connection_for_handle(hci_stack->classic_oob_con_handle);
30421ae74bf3SMatthias Ringwald             hci_stack->classic_oob_con_handle = HCI_CON_HANDLE_INVALID;
30431ae74bf3SMatthias Ringwald             if (conn == NULL) break;
30441ae74bf3SMatthias Ringwald             hci_pairing_complete(conn, ERROR_CODE_AUTHENTICATION_FAILURE);
30451ae74bf3SMatthias Ringwald             break;
3046e8c8828eSMatthias Ringwald #endif
304775a8e4faSMatthias Ringwald #endif
30484ae8623eSMatthias Ringwald #ifdef ENABLE_BLE
30494ae8623eSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
3050d3a89d91SMatthias Ringwald         case HCI_OPCODE_HCI_LE_SET_CIG_PARAMETERS:
3051d3a89d91SMatthias Ringwald             // lookup CIG
3052d3a89d91SMatthias Ringwald             cig = hci_cig_for_id(hci_stack->iso_active_operation_group_id);
3053d3a89d91SMatthias Ringwald             if (cig != NULL){
3054d3a89d91SMatthias Ringwald                 uint8_t i = 0;
3055d3a89d91SMatthias Ringwald                 if (status == ERROR_CODE_SUCCESS){
3056d3a89d91SMatthias Ringwald                     // assign CIS handles to pre-allocated CIS
3057d3a89d91SMatthias Ringwald                     btstack_linked_list_iterator_t it;
3058d3a89d91SMatthias Ringwald                     btstack_linked_list_iterator_init(&it, &hci_stack->iso_streams);
3059d3a89d91SMatthias Ringwald                     while (btstack_linked_list_iterator_has_next(&it) && (i < cig->num_cis)) {
3060d3a89d91SMatthias Ringwald                         hci_iso_stream_t *iso_stream = (hci_iso_stream_t *) btstack_linked_list_iterator_next(&it);
3061d3a89d91SMatthias Ringwald                         if ((iso_stream->group_id == hci_stack->iso_active_operation_group_id) &&
3062d3a89d91SMatthias Ringwald                             (iso_stream->iso_type == HCI_ISO_TYPE_CIS)){
3063d3a89d91SMatthias Ringwald                             hci_con_handle_t cis_handle = little_endian_read_16(packet, OFFSET_OF_DATA_IN_COMMAND_COMPLETE+3+(2*i));
3064969d876aSMatthias Ringwald                             iso_stream->cis_handle  = cis_handle;
3065d3a89d91SMatthias Ringwald                             cig->cis_con_handles[i] = cis_handle;
3066d3a89d91SMatthias Ringwald                             i++;
3067d3a89d91SMatthias Ringwald                         }
3068d3a89d91SMatthias Ringwald                     }
3069444e371eSMatthias Ringwald                     cig->state = LE_AUDIO_CIG_STATE_W4_CIS_REQUEST;
3070d3a89d91SMatthias Ringwald                     hci_emit_cig_created(cig, status);
3071d3a89d91SMatthias Ringwald                 } else {
3072d3a89d91SMatthias Ringwald                     hci_emit_cig_created(cig, status);
3073d3a89d91SMatthias Ringwald                     btstack_linked_list_remove(&hci_stack->le_audio_cigs, (btstack_linked_item_t *) cig);
3074d3a89d91SMatthias Ringwald                 }
3075d3a89d91SMatthias Ringwald             }
307626b93350SMatthias Ringwald             hci_stack->iso_active_operation_type = HCI_ISO_TYPE_INVALID;
3077d3a89d91SMatthias Ringwald             break;
30784ae8623eSMatthias Ringwald         case HCI_OPCODE_HCI_LE_CREATE_CIS:
30794ae8623eSMatthias Ringwald             if (status != ERROR_CODE_SUCCESS){
3080d75a6bbfSMatthias Ringwald                 hci_iso_stream_requested_finalize(HCI_ISO_GROUP_ID_INVALID);
30814ae8623eSMatthias Ringwald             }
30824ae8623eSMatthias Ringwald             break;
308342529435SMatthias Ringwald         case HCI_OPCODE_HCI_LE_ACCEPT_CIS_REQUEST:
308442529435SMatthias Ringwald             if (status != ERROR_CODE_SUCCESS){
3085d75a6bbfSMatthias Ringwald                 hci_iso_stream_requested_finalize(HCI_ISO_GROUP_ID_INVALID);
308642529435SMatthias Ringwald             }
308742529435SMatthias Ringwald             break;
30887aa35f6aSMatthias Ringwald         case HCI_OPCODE_HCI_LE_SETUP_ISO_DATA_PATH: {
30897aa35f6aSMatthias Ringwald             // lookup BIG by state
30907aa35f6aSMatthias Ringwald             btstack_linked_list_iterator_t it;
30917aa35f6aSMatthias Ringwald             btstack_linked_list_iterator_init(&it, &hci_stack->le_audio_bigs);
30927aa35f6aSMatthias Ringwald             while (btstack_linked_list_iterator_has_next(&it)) {
30937aa35f6aSMatthias Ringwald                 le_audio_big_t *big = (le_audio_big_t *) btstack_linked_list_iterator_next(&it);
30947aa35f6aSMatthias Ringwald                 if (big->state == LE_AUDIO_BIG_STATE_W4_SETUP_ISO_PATH){
30957aa35f6aSMatthias Ringwald                     if (status == ERROR_CODE_SUCCESS){
30967aa35f6aSMatthias Ringwald                         big->state_vars.next_bis++;
30977aa35f6aSMatthias Ringwald                         if (big->state_vars.next_bis == big->num_bis){
30987aa35f6aSMatthias Ringwald                             big->state = LE_AUDIO_BIG_STATE_ACTIVE;
30997aa35f6aSMatthias Ringwald                             hci_emit_big_created(big, ERROR_CODE_SUCCESS);
31007aa35f6aSMatthias Ringwald                         } else {
31017aa35f6aSMatthias Ringwald                             big->state = LE_AUDIO_BIG_STATE_SETUP_ISO_PATH;
31027aa35f6aSMatthias Ringwald                         }
31037aa35f6aSMatthias Ringwald                     } else {
31047aa35f6aSMatthias Ringwald                         big->state = LE_AUDIO_BIG_STATE_SETUP_ISO_PATHS_FAILED;
31057aa35f6aSMatthias Ringwald                         big->state_vars.status = status;
31062a6c0f82SMatthias Ringwald                     }
31072a6c0f82SMatthias Ringwald                     return;
31082a6c0f82SMatthias Ringwald                 }
31092a6c0f82SMatthias Ringwald             }
31102a6c0f82SMatthias Ringwald             btstack_linked_list_iterator_init(&it, &hci_stack->le_audio_big_syncs);
31112a6c0f82SMatthias Ringwald             while (btstack_linked_list_iterator_has_next(&it)) {
31122a6c0f82SMatthias Ringwald                 le_audio_big_sync_t *big_sync = (le_audio_big_sync_t *) btstack_linked_list_iterator_next(&it);
31132a6c0f82SMatthias Ringwald                 if (big_sync->state == LE_AUDIO_BIG_STATE_W4_SETUP_ISO_PATH){
31142a6c0f82SMatthias Ringwald                     if (status == ERROR_CODE_SUCCESS){
31152a6c0f82SMatthias Ringwald                         big_sync->state_vars.next_bis++;
31162a6c0f82SMatthias Ringwald                         if (big_sync->state_vars.next_bis == big_sync->num_bis){
31172a6c0f82SMatthias Ringwald                             big_sync->state = LE_AUDIO_BIG_STATE_ACTIVE;
31182a6c0f82SMatthias Ringwald                             hci_emit_big_sync_created(big_sync, ERROR_CODE_SUCCESS);
31192a6c0f82SMatthias Ringwald                         } else {
31202a6c0f82SMatthias Ringwald                             big_sync->state = LE_AUDIO_BIG_STATE_SETUP_ISO_PATH;
31212a6c0f82SMatthias Ringwald                         }
31222a6c0f82SMatthias Ringwald                     } else {
31232a6c0f82SMatthias Ringwald                         big_sync->state = LE_AUDIO_BIG_STATE_SETUP_ISO_PATHS_FAILED;
31242a6c0f82SMatthias Ringwald                         big_sync->state_vars.status = status;
31252a6c0f82SMatthias Ringwald                     }
31262a6c0f82SMatthias Ringwald                     return;
31272a6c0f82SMatthias Ringwald                 }
31282a6c0f82SMatthias Ringwald             }
3129f9306a1aSMatthias Ringwald             // Lookup CIS via active group operation
3130f9306a1aSMatthias Ringwald             if (hci_stack->iso_active_operation_type == HCI_ISO_TYPE_CIS){
313126b93350SMatthias Ringwald                 if (hci_stack->iso_active_operation_group_id == HCI_ISO_GROUP_ID_SINGLE_CIS){
313226b93350SMatthias Ringwald                     hci_stack->iso_active_operation_type = HCI_ISO_TYPE_INVALID;
313326b93350SMatthias Ringwald 
313426b93350SMatthias Ringwald                     // lookup CIS by state
313526b93350SMatthias Ringwald                     btstack_linked_list_iterator_init(&it, &hci_stack->iso_streams);
313626b93350SMatthias Ringwald                     while (btstack_linked_list_iterator_has_next(&it)){
313726b93350SMatthias Ringwald                         hci_iso_stream_t * iso_stream = (hci_iso_stream_t *) btstack_linked_list_iterator_next(&it);
3138969d876aSMatthias Ringwald                         handle = iso_stream->cis_handle;
3139532211feSMatthias Ringwald                         bool emit_cis_created = false;
314026b93350SMatthias Ringwald                         switch (iso_stream->state){
314126b93350SMatthias Ringwald                             case HCI_ISO_STREAM_STATE_W4_ISO_SETUP_INPUT:
314226b93350SMatthias Ringwald                                 if (status != ERROR_CODE_SUCCESS){
3143532211feSMatthias Ringwald                                     emit_cis_created = true;
314426b93350SMatthias Ringwald                                     break;
314526b93350SMatthias Ringwald                                 }
314626b93350SMatthias Ringwald                                 if (iso_stream->max_sdu_c_to_p > 0){
31471418332dSMatthias Ringwald                                     iso_stream->state = HCI_ISO_STREAM_STATE_W2_SETUP_ISO_OUTPUT;
314826b93350SMatthias Ringwald                                 } else {
3149532211feSMatthias Ringwald                                     emit_cis_created = true;
315026b93350SMatthias Ringwald                                 }
315126b93350SMatthias Ringwald                                 break;
315226b93350SMatthias Ringwald                             case HCI_ISO_STREAM_STATE_W4_ISO_SETUP_OUTPUT:
3153532211feSMatthias Ringwald                                 emit_cis_created = true;
315426b93350SMatthias Ringwald                                 break;
315526b93350SMatthias Ringwald                             default:
315626b93350SMatthias Ringwald                                 break;
315726b93350SMatthias Ringwald                         }
3158532211feSMatthias Ringwald                         if (emit_cis_created){
315914045fdbSMatthias Ringwald                             hci_cis_handle_created(iso_stream, status);
3160532211feSMatthias Ringwald                         }
316126b93350SMatthias Ringwald                     }
316226b93350SMatthias Ringwald                 } else {
3163f9306a1aSMatthias Ringwald                     cig = hci_cig_for_id(hci_stack->iso_active_operation_group_id);
3164532211feSMatthias Ringwald                     hci_stack->iso_active_operation_type = HCI_ISO_TYPE_INVALID;
3165f9306a1aSMatthias Ringwald                     if (cig != NULL) {
3166f9306a1aSMatthias Ringwald                         // emit cis created if all ISO Paths have been created
3167f9306a1aSMatthias Ringwald                         // assume we are central
3168f9306a1aSMatthias Ringwald                         uint8_t cis_index     = cig->state_vars.next_cis >> 1;
3169f9306a1aSMatthias Ringwald                         uint8_t cis_direction = cig->state_vars.next_cis & 1;
3170f9306a1aSMatthias Ringwald                         bool outgoing_needed  = cig->params->cis_params[cis_index].max_sdu_p_to_c > 0;
3171f9306a1aSMatthias Ringwald                         // if outgoing has been setup, or incoming was setup but outgoing not required
3172f9306a1aSMatthias Ringwald                         if ((cis_direction == 1) || (outgoing_needed == false)){
3173532211feSMatthias Ringwald                             // lookup iso stream by cig/cis
3174b5ecaedbSMatthias Ringwald                             btstack_linked_list_iterator_init(&it, &hci_stack->iso_streams);
3175532211feSMatthias Ringwald                             while (btstack_linked_list_iterator_has_next(&it)) {
3176532211feSMatthias Ringwald                                 hci_iso_stream_t *iso_stream = (hci_iso_stream_t *) btstack_linked_list_iterator_next(&it);
3177532211feSMatthias Ringwald                                 if ((iso_stream->group_id == cig->cig_id) && (iso_stream->stream_id == cis_index)){
317814045fdbSMatthias Ringwald                                     hci_cis_handle_created(iso_stream, status);
3179532211feSMatthias Ringwald                                 }
3180532211feSMatthias Ringwald                             }
3181f9306a1aSMatthias Ringwald                         }
3182f9306a1aSMatthias Ringwald                         // next state
3183f9306a1aSMatthias Ringwald                         cig->state_vars.next_cis++;
3184f9306a1aSMatthias Ringwald                         cig->state = LE_AUDIO_CIG_STATE_SETUP_ISO_PATH;
3185f9306a1aSMatthias Ringwald                     }
3186f9306a1aSMatthias Ringwald                 }
318726b93350SMatthias Ringwald             }
31882a6c0f82SMatthias Ringwald             break;
31892a6c0f82SMatthias Ringwald         }
31902a6c0f82SMatthias Ringwald         case HCI_OPCODE_HCI_LE_BIG_TERMINATE_SYNC: {
31912a6c0f82SMatthias Ringwald             // lookup BIG by state
31922a6c0f82SMatthias Ringwald             btstack_linked_list_iterator_t it;
31932a6c0f82SMatthias Ringwald             btstack_linked_list_iterator_init(&it, &hci_stack->le_audio_big_syncs);
31942a6c0f82SMatthias Ringwald             while (btstack_linked_list_iterator_has_next(&it)) {
31952a6c0f82SMatthias Ringwald                 le_audio_big_sync_t *big_sync = (le_audio_big_sync_t *) btstack_linked_list_iterator_next(&it);
3196d04a9afcSMatthias Ringwald                 uint8_t big_handle = big_sync->big_handle;
31972a6c0f82SMatthias Ringwald                 switch (big_sync->state){
31982a6c0f82SMatthias Ringwald                     case LE_AUDIO_BIG_STATE_W4_TERMINATED_AFTER_SETUP_FAILED:
3199d04a9afcSMatthias Ringwald                         btstack_linked_list_iterator_remove(&it);
32002a6c0f82SMatthias Ringwald                         hci_emit_big_sync_created(big_sync, big_sync->state_vars.status);
3201d04a9afcSMatthias Ringwald                         return;
32022a6c0f82SMatthias Ringwald                     default:
3203d04a9afcSMatthias Ringwald                         btstack_linked_list_iterator_remove(&it);
3204d04a9afcSMatthias Ringwald                         hci_emit_big_sync_stopped(big_handle);
32057aa35f6aSMatthias Ringwald                         return;
32067aa35f6aSMatthias Ringwald                 }
32077aa35f6aSMatthias Ringwald             }
32087aa35f6aSMatthias Ringwald             break;
32097aa35f6aSMatthias Ringwald         }
32104ae8623eSMatthias Ringwald #endif
32114ae8623eSMatthias Ringwald #endif
32126f35bb46SMatthias Ringwald         default:
32136f35bb46SMatthias Ringwald             break;
32144f781026SMatthias Ringwald     }
3215645b7c25SMatthias Ringwald }
32164f781026SMatthias Ringwald 
3217afbf1cd7SMatthias Ringwald static void handle_command_status_event(uint8_t * packet, uint16_t size) {
3218afbf1cd7SMatthias Ringwald     UNUSED(size);
3219afbf1cd7SMatthias Ringwald 
3220afbf1cd7SMatthias Ringwald     // get num cmd packets - limit to 1 to reduce complexity
3221afbf1cd7SMatthias Ringwald     hci_stack->num_cmd_packets = packet[3] ? 1 : 0;
3222afbf1cd7SMatthias Ringwald 
3223c70df5f8SMatthias Ringwald     // get opcode and command status
3224c70df5f8SMatthias Ringwald     uint16_t opcode = hci_event_command_status_get_command_opcode(packet);
3225c70df5f8SMatthias Ringwald 
3226c70df5f8SMatthias Ringwald #if defined(ENABLE_CLASSIC) || defined(ENABLE_LE_CENTRAL) || defined(ENABLE_LE_ISOCHRONOUS_STREAMS)
3227c70df5f8SMatthias Ringwald     uint8_t status = hci_event_command_status_get_status(packet);
3228c70df5f8SMatthias Ringwald #endif
3229c70df5f8SMatthias Ringwald 
3230c70df5f8SMatthias Ringwald #if defined(ENABLE_CLASSIC) || defined(ENABLE_LE_CENTRAL)
3231c70df5f8SMatthias Ringwald     bd_addr_type_t addr_type;
323273bccf35Slouislee91     bd_addr_t addr;
3233c70df5f8SMatthias Ringwald #endif
3234c70df5f8SMatthias Ringwald 
323591036612SMatthias Ringwald #if defined(ENABLE_BLE) && defined (ENABLE_HCI_COMMAND_STATUS_DISCARDED_FOR_FAILED_CONNECTIONS_WORKAROUND)
3236f48a5586SMatthias Ringwald     hci_stack->hci_command_con_handle = HCI_CON_HANDLE_INVALID;
3237f48a5586SMatthias Ringwald #endif
3238f48a5586SMatthias Ringwald 
3239c70df5f8SMatthias Ringwald     switch (opcode){
3240afbf1cd7SMatthias Ringwald #ifdef ENABLE_CLASSIC
3241c70df5f8SMatthias Ringwald         case HCI_OPCODE_HCI_CREATE_CONNECTION:
32429071873aSMatthias Ringwald         case HCI_OPCODE_HCI_SETUP_SYNCHRONOUS_CONNECTION:
3243c70df5f8SMatthias Ringwald         case HCI_OPCODE_HCI_ACCEPT_SYNCHRONOUS_CONNECTION:
3244afbf1cd7SMatthias Ringwald #endif
3245afbf1cd7SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
3246c70df5f8SMatthias Ringwald         case HCI_OPCODE_HCI_LE_CREATE_CONNECTION:
3247afbf1cd7SMatthias Ringwald #endif
3248c70df5f8SMatthias Ringwald #if defined(ENABLE_CLASSIC) || defined(ENABLE_LE_CENTRAL)
3249afbf1cd7SMatthias Ringwald             addr_type = hci_stack->outgoing_addr_type;
325073bccf35Slouislee91             memcpy(addr, hci_stack->outgoing_addr, 6);
3251afbf1cd7SMatthias Ringwald 
3252afbf1cd7SMatthias Ringwald             // reset outgoing address info
3253afbf1cd7SMatthias Ringwald             memset(hci_stack->outgoing_addr, 0, 6);
3254afbf1cd7SMatthias Ringwald             hci_stack->outgoing_addr_type = BD_ADDR_TYPE_UNKNOWN;
3255afbf1cd7SMatthias Ringwald 
3256afbf1cd7SMatthias Ringwald             // on error
3257afbf1cd7SMatthias Ringwald             if (status != ERROR_CODE_SUCCESS){
3258afbf1cd7SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
3259afbf1cd7SMatthias Ringwald                 if (hci_is_le_connection_type(addr_type)){
3260afbf1cd7SMatthias Ringwald                     hci_stack->le_connecting_state = LE_CONNECTING_IDLE;
3261afbf1cd7SMatthias Ringwald                     hci_stack->le_connecting_request = LE_CONNECTING_IDLE;
3262afbf1cd7SMatthias Ringwald                 }
3263afbf1cd7SMatthias Ringwald #endif
3264afbf1cd7SMatthias Ringwald                 // error => outgoing connection failed
326573bccf35Slouislee91                 hci_connection_t * conn = hci_connection_for_bd_addr_and_type(addr, addr_type);
3266afbf1cd7SMatthias Ringwald                 if (conn != NULL){
3267afbf1cd7SMatthias Ringwald                     hci_handle_connection_failed(conn, status);
3268afbf1cd7SMatthias Ringwald                 }
3269afbf1cd7SMatthias Ringwald             }
3270c70df5f8SMatthias Ringwald             break;
3271c70df5f8SMatthias Ringwald #endif
3272afbf1cd7SMatthias Ringwald #ifdef ENABLE_CLASSIC
3273c70df5f8SMatthias Ringwald         case HCI_OPCODE_HCI_INQUIRY:
3274afbf1cd7SMatthias Ringwald             if (status == ERROR_CODE_SUCCESS) {
3275afbf1cd7SMatthias Ringwald                 hci_stack->inquiry_state = GAP_INQUIRY_STATE_ACTIVE;
3276afbf1cd7SMatthias Ringwald             } else {
3277afbf1cd7SMatthias Ringwald                 hci_stack->inquiry_state = GAP_INQUIRY_STATE_IDLE;
3278afbf1cd7SMatthias Ringwald             }
3279c70df5f8SMatthias Ringwald             break;
3280c70df5f8SMatthias Ringwald #endif
3281afbf1cd7SMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
3282c70df5f8SMatthias Ringwald         case HCI_OPCODE_HCI_LE_CREATE_CIS:
3283c70df5f8SMatthias Ringwald         case HCI_OPCODE_HCI_LE_ACCEPT_CIS_REQUEST:
3284afbf1cd7SMatthias Ringwald             if (status == ERROR_CODE_SUCCESS){
3285d75a6bbfSMatthias Ringwald                 hci_iso_stream_requested_confirm(HCI_ISO_GROUP_ID_INVALID);
3286afbf1cd7SMatthias Ringwald             } else {
3287d75a6bbfSMatthias Ringwald                 hci_iso_stream_requested_finalize(HCI_ISO_GROUP_ID_INVALID);
3288afbf1cd7SMatthias Ringwald             }
3289c70df5f8SMatthias Ringwald             break;
3290afbf1cd7SMatthias Ringwald #endif /* ENABLE_LE_ISOCHRONOUS_STREAMS */
3291c70df5f8SMatthias Ringwald         default:
3292c70df5f8SMatthias Ringwald             break;
3293c70df5f8SMatthias Ringwald     }
3294afbf1cd7SMatthias Ringwald }
3295afbf1cd7SMatthias Ringwald 
32960ce3f217SMatthias Ringwald #ifdef ENABLE_BLE
3297e4def797SMatthias Ringwald static void hci_create_gap_connection_complete_event(const uint8_t * hci_event, uint8_t * gap_event) {
3298e4def797SMatthias Ringwald     gap_event[0] = HCI_EVENT_META_GAP;
3299e4def797SMatthias Ringwald     gap_event[1] = 36 - 2;
3300e4def797SMatthias Ringwald     gap_event[2] = GAP_SUBEVENT_LE_CONNECTION_COMPLETE;
3301bede2a55SMatthias Ringwald     switch (hci_event_le_meta_get_subevent_code(hci_event)){
3302a9212437SMatthias Ringwald         case HCI_SUBEVENT_LE_CONNECTION_COMPLETE:
3303e4def797SMatthias Ringwald             memcpy(&gap_event[3], &hci_event[3], 11);
3304e4def797SMatthias Ringwald             memset(&gap_event[14], 0, 12);
3305e4def797SMatthias Ringwald             memcpy(&gap_event[26], &hci_event[14], 7);
3306e4def797SMatthias Ringwald             memset(&gap_event[33], 0xff, 3);
3307a9212437SMatthias Ringwald             break;
3308a9212437SMatthias Ringwald         case HCI_SUBEVENT_LE_ENHANCED_CONNECTION_COMPLETE_V1:
3309e4def797SMatthias Ringwald             memcpy(&gap_event[3], &hci_event[3], 30);
3310e4def797SMatthias Ringwald             memset(&gap_event[33], 0xff, 3);
3311a9212437SMatthias Ringwald             break;
3312a9212437SMatthias Ringwald         case HCI_SUBEVENT_LE_ENHANCED_CONNECTION_COMPLETE_V2:
3313e4def797SMatthias Ringwald             memcpy(&gap_event[3], &hci_event[3], 33);
3314a9212437SMatthias Ringwald             break;
3315a9212437SMatthias Ringwald         default:
3316a9212437SMatthias Ringwald             btstack_unreachable();
3317a9212437SMatthias Ringwald             break;
3318a9212437SMatthias Ringwald     }
3319a9212437SMatthias Ringwald }
3320a9212437SMatthias Ringwald 
3321688bcdb4SMatthias Ringwald static void hci_handle_le_connection_complete_event(const uint8_t * hci_event){
33220ce3f217SMatthias Ringwald 	bd_addr_t addr;
33230ce3f217SMatthias Ringwald 	bd_addr_type_t addr_type;
33240ce3f217SMatthias Ringwald 	hci_connection_t * conn;
33250ce3f217SMatthias Ringwald 
332698e0165dSMatthias Ringwald     // create GAP_SUBEVENT_LE_CONNECTION_COMPLETE
3327a9212437SMatthias Ringwald     uint8_t gap_event[36];
3328a9212437SMatthias Ringwald     hci_create_gap_connection_complete_event(hci_event, gap_event);
332960fb273dSMatthias Ringwald 
333098e0165dSMatthias Ringwald     // read fields
3331a9212437SMatthias Ringwald     uint8_t status = gap_subevent_le_connection_complete_get_status(gap_event);
3332a9212437SMatthias Ringwald     hci_role_t role = (hci_role_t) gap_subevent_le_connection_complete_get_role(gap_event);
3333a9212437SMatthias Ringwald     uint16_t conn_interval = gap_subevent_le_connection_complete_get_conn_interval(gap_event);
333498e0165dSMatthias Ringwald 
33350ce3f217SMatthias Ringwald 	// Connection management
3336a9212437SMatthias Ringwald     gap_subevent_le_connection_complete_get_peer_address(gap_event, addr);
3337a9212437SMatthias Ringwald 	addr_type = (bd_addr_type_t) gap_subevent_le_connection_complete_get_peer_address_type(gap_event);
333860fb273dSMatthias Ringwald     log_info("LE Connection_complete (status=%u) type %u, %s", status, addr_type, bd_addr_to_str(addr));
33390ce3f217SMatthias Ringwald 	conn = hci_connection_for_bd_addr_and_type(addr, addr_type);
33400ce3f217SMatthias Ringwald 
33410ce3f217SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
33420ce3f217SMatthias Ringwald 	// handle error: error is reported only to the initiator -> outgoing connection
334360fb273dSMatthias Ringwald 	if (status){
33440ce3f217SMatthias Ringwald 
33450ce3f217SMatthias Ringwald 		// handle cancelled outgoing connection
33460ce3f217SMatthias Ringwald 		// "If the cancellation was successful then, after the Command Complete event for the LE_Create_Connection_Cancel command,
33470ce3f217SMatthias Ringwald 		//  either an LE Connection Complete or an LE Enhanced Connection Complete event shall be generated.
33480ce3f217SMatthias Ringwald 		//  In either case, the event shall be sent with the error code Unknown Connection Identifier (0x02)."
334960fb273dSMatthias Ringwald 		if (status == ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER){
33501f468175SMatthias Ringwald 		    // reset state
33510ce3f217SMatthias Ringwald             hci_stack->le_connecting_state = LE_CONNECTING_IDLE;
33520ce3f217SMatthias Ringwald 			// get outgoing connection conn struct for direct connect
33539fd274a1SMatthias Ringwald             if (hci_stack->le_connecting_request == LE_CONNECTING_DIRECT){
3354ca0d6e5aSMatthias Ringwald                 conn = gap_get_outgoing_le_connection();
33559fd274a1SMatthias Ringwald                 conn->state = SEND_CREATE_CONNECTION;
33569fd274a1SMatthias Ringwald             }
33570ce3f217SMatthias Ringwald 		}
33580ce3f217SMatthias Ringwald 
3359c1281a25SMatthias Ringwald 		// free connection if cancelled by user (request == IDLE)
3360c1281a25SMatthias Ringwald 		if ((conn != NULL) && (hci_stack->le_connecting_request == LE_CONNECTING_IDLE)){
33610ce3f217SMatthias Ringwald 			// remove entry
33620ce3f217SMatthias Ringwald 			btstack_linked_list_remove(&hci_stack->connections, (btstack_linked_item_t *) conn);
33630ce3f217SMatthias Ringwald 			btstack_memory_hci_connection_free( conn );
33640ce3f217SMatthias Ringwald 		}
3365*4dbe0476SMatthias Ringwald 
3366*4dbe0476SMatthias Ringwald         // emit GAP_SUBEVENT_LE_CONNECTION_COMPLETE for error case
3367*4dbe0476SMatthias Ringwald         hci_emit_event(gap_event, sizeof(gap_event), 1);
33680ce3f217SMatthias Ringwald         return;
33690ce3f217SMatthias Ringwald 	}
33700ce3f217SMatthias Ringwald #endif
33710ce3f217SMatthias Ringwald 
33720ce3f217SMatthias Ringwald 	// on success, both hosts receive connection complete event
337360fb273dSMatthias Ringwald     if (role == HCI_ROLE_MASTER){
33740ce3f217SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
33755bb205a5SMatthias Ringwald 		// if we're master, it was an outgoing connection
33760ce3f217SMatthias Ringwald 		// note: no hci_connection_t object exists yet for connect with whitelist
33775bb205a5SMatthias Ringwald 
337858babb64SMatthias Ringwald         // if a identity addresses was used without enhanced connection complete event,
337958babb64SMatthias Ringwald         // the connection complete event contains the current random address of the peer device.
338058babb64SMatthias Ringwald         // This random address is needed in the case of a re-pairing
338158babb64SMatthias Ringwald         if (hci_event_le_meta_get_subevent_code(hci_event) == HCI_SUBEVENT_LE_CONNECTION_COMPLETE){
33825bb205a5SMatthias Ringwald             conn = gap_get_outgoing_le_connection();
338358babb64SMatthias Ringwald             // if outgoing connection object is available, check if identity address was used.
338458babb64SMatthias Ringwald             // if yes, track resolved random address and provide rpa
33855bb205a5SMatthias Ringwald             // note: we don't update hci le subevent connection complete
33865bb205a5SMatthias Ringwald             if (conn != NULL){
338758babb64SMatthias Ringwald                 if (hci_is_le_identity_address_type(conn->address_type)){
338858babb64SMatthias Ringwald                     memcpy(&gap_event[20], &gap_event[8], 6);
33895bb205a5SMatthias Ringwald                     gap_event[7] = conn->address_type;
33905bb205a5SMatthias Ringwald                     reverse_bd_addr(conn->address, &gap_event[8]);
33915bb205a5SMatthias Ringwald                 }
339258babb64SMatthias Ringwald             }
339358babb64SMatthias Ringwald         }
33945bb205a5SMatthias Ringwald 
33955bb205a5SMatthias Ringwald         // we're done with it
33960ce3f217SMatthias Ringwald         hci_stack->le_connecting_state   = LE_CONNECTING_IDLE;
33970ce3f217SMatthias Ringwald         hci_stack->le_connecting_request = LE_CONNECTING_IDLE;
33980ce3f217SMatthias Ringwald #endif
33990ce3f217SMatthias Ringwald 	} else {
34000ce3f217SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
34010ce3f217SMatthias Ringwald 		// if we're slave, it was an incoming connection, advertisements have stopped
3402935aa76eSMatthias Ringwald         hci_stack->le_advertisements_state &= ~LE_ADVERTISEMENT_STATE_ACTIVE;
34030ce3f217SMatthias Ringwald #endif
34040ce3f217SMatthias Ringwald 	}
34050ce3f217SMatthias Ringwald 
34060ce3f217SMatthias Ringwald 	// LE connections are auto-accepted, so just create a connection if there isn't one already
34070ce3f217SMatthias Ringwald 	if (!conn){
340888f925b1SMatthias Ringwald 		conn = create_connection_for_bd_addr_and_type(addr, addr_type, role);
34090ce3f217SMatthias Ringwald 	}
34100ce3f217SMatthias Ringwald 
34110ce3f217SMatthias Ringwald 	// no memory, sorry.
34120ce3f217SMatthias Ringwald 	if (!conn){
34130ce3f217SMatthias Ringwald 		return;
34140ce3f217SMatthias Ringwald 	}
34150ce3f217SMatthias Ringwald 
34160ce3f217SMatthias Ringwald 	conn->state = OPEN;
3417a9212437SMatthias Ringwald 	conn->con_handle             = gap_subevent_le_connection_complete_get_connection_handle(gap_event);
341860fb273dSMatthias Ringwald     conn->le_connection_interval = conn_interval;
34190ce3f217SMatthias Ringwald 
34204639b1e4SMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
3421ac0f6b83SMatthias Ringwald     // workaround: PAST doesn't work without LE Read Remote Features on PacketCraft Controller with LMP 568B
34224639b1e4SMatthias Ringwald     if (hci_command_supported(SUPPORTED_HCI_COMMAND_LE_READ_REMOTE_FEATURES)){
3423ac0f6b83SMatthias Ringwald         conn->gap_connection_tasks = GAP_CONNECTION_TASK_LE_READ_REMOTE_FEATURES;
34244639b1e4SMatthias Ringwald     }
34254639b1e4SMatthias Ringwald #endif
3426ac0f6b83SMatthias Ringwald 
34270ce3f217SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
342860fb273dSMatthias Ringwald 	if (role == HCI_ROLE_SLAVE){
34290ce3f217SMatthias Ringwald 		hci_update_advertisements_enabled_for_current_roles();
34300ce3f217SMatthias Ringwald 	}
34310ce3f217SMatthias Ringwald #endif
34320ce3f217SMatthias Ringwald 
3433dde9ff1eSMatthias Ringwald     // init unenhanced att bearer mtu
3434dde9ff1eSMatthias Ringwald     conn->att_connection.mtu = ATT_DEFAULT_MTU;
3435dde9ff1eSMatthias Ringwald     conn->att_connection.mtu_exchanged = false;
3436dde9ff1eSMatthias Ringwald 
34370ce3f217SMatthias Ringwald     // TODO: store - role, peer address type, conn_interval, conn_latency, supervision timeout, master clock
34380ce3f217SMatthias Ringwald 
34390ce3f217SMatthias Ringwald 	// restart timer
34400ce3f217SMatthias Ringwald 	// btstack_run_loop_set_timer(&conn->timeout, HCI_CONNECTION_TIMEOUT_MS);
34410ce3f217SMatthias Ringwald 	// btstack_run_loop_add_timer(&conn->timeout);
34420ce3f217SMatthias Ringwald 
34430ce3f217SMatthias Ringwald 	log_info("New connection: handle %u, %s", conn->con_handle, bd_addr_to_str(conn->address));
34440ce3f217SMatthias Ringwald 
344598e0165dSMatthias Ringwald     // emit GAP_SUBEVENT_LE_CONNECTION_COMPLETE
3446a9212437SMatthias Ringwald     hci_emit_event(gap_event, sizeof(gap_event), 1);
344798e0165dSMatthias Ringwald 
344898e0165dSMatthias Ringwald     // emit BTSTACK_EVENT_NR_CONNECTIONS_CHANGED;
34490ce3f217SMatthias Ringwald 	hci_emit_nr_connections_changed();
34500ce3f217SMatthias Ringwald }
34510ce3f217SMatthias Ringwald #endif
34520ce3f217SMatthias Ringwald 
345317c6fe5cSMatthias Ringwald #ifdef ENABLE_CLASSIC
345417c6fe5cSMatthias Ringwald static bool hci_ssp_security_level_possible_for_io_cap(gap_security_level_t level, uint8_t io_cap_local, uint8_t io_cap_remote){
345517c6fe5cSMatthias Ringwald     if (io_cap_local == SSP_IO_CAPABILITY_UNKNOWN) return false;
345617c6fe5cSMatthias Ringwald     // LEVEL_4 is tested by l2cap
34579a8f78c1SMatthias Ringwald     // LEVEL 3 requires MITM protection -> check io capabilities if Authenticated is possible
34589a8f78c1SMatthias Ringwald     // @see: Core Spec v5.3, Vol 3, Part C, Table 5.7
345917c6fe5cSMatthias Ringwald     if (level >= LEVEL_3){
34609a8f78c1SMatthias Ringwald         // MITM not possible without keyboard or display
346117c6fe5cSMatthias Ringwald         if (io_cap_remote >= SSP_IO_CAPABILITY_NO_INPUT_NO_OUTPUT) return false;
346217c6fe5cSMatthias Ringwald         if (io_cap_local  >= SSP_IO_CAPABILITY_NO_INPUT_NO_OUTPUT) return false;
34639a8f78c1SMatthias Ringwald 
34649a8f78c1SMatthias Ringwald         // MITM possible if one side has keyboard and the other has keyboard or display
34659a8f78c1SMatthias Ringwald         if (io_cap_remote == SSP_IO_CAPABILITY_KEYBOARD_ONLY)      return true;
34669a8f78c1SMatthias Ringwald         if (io_cap_local  == SSP_IO_CAPABILITY_KEYBOARD_ONLY)      return true;
34679a8f78c1SMatthias Ringwald 
34689a8f78c1SMatthias Ringwald         // MITM not possible if one side has only display and other side has no keyboard
34699a8f78c1SMatthias Ringwald         if (io_cap_remote == SSP_IO_CAPABILITY_DISPLAY_ONLY)       return false;
34709a8f78c1SMatthias Ringwald         if (io_cap_local  == SSP_IO_CAPABILITY_DISPLAY_ONLY)       return false;
347117c6fe5cSMatthias Ringwald     }
347217c6fe5cSMatthias Ringwald     // LEVEL 2 requires SSP, which is a given
347317c6fe5cSMatthias Ringwald     return true;
347417c6fe5cSMatthias Ringwald }
34753817f9dfSMatthias Ringwald 
3476b3c4163bSMatthias Ringwald static void hci_ssp_assess_security_on_io_cap_request(hci_connection_t * conn){
34772dd8985bSMatthias Ringwald     // get requested security level
34782dd8985bSMatthias Ringwald     gap_security_level_t requested_security_level = conn->requested_security_level;
34792dd8985bSMatthias Ringwald     if (hci_stack->gap_secure_connections_only_mode){
34802dd8985bSMatthias Ringwald         requested_security_level = LEVEL_4;
34812dd8985bSMatthias Ringwald     }
34822dd8985bSMatthias Ringwald 
3483b3c4163bSMatthias Ringwald     // assess security: LEVEL 4 requires SC
34842dd8985bSMatthias Ringwald     // skip this preliminary test if remote features are not available yet to work around potential issue in ESP32 controller
34852dd8985bSMatthias Ringwald     if ((requested_security_level == LEVEL_4) &&
34862dd8985bSMatthias Ringwald         ((conn->bonding_flags & BONDING_RECEIVED_REMOTE_FEATURES) != 0) &&
34872dd8985bSMatthias Ringwald         !hci_remote_sc_enabled(conn)){
3488b3c4163bSMatthias Ringwald         log_info("Level 4 required, but SC not supported -> abort");
3489b3c4163bSMatthias Ringwald         hci_pairing_complete(conn, ERROR_CODE_INSUFFICIENT_SECURITY);
3490b3c4163bSMatthias Ringwald         connectionSetAuthenticationFlags(conn, AUTH_FLAG_SEND_IO_CAPABILITIES_NEGATIVE_REPLY);
3491b3c4163bSMatthias Ringwald         return;
3492b3c4163bSMatthias Ringwald     }
3493b3c4163bSMatthias Ringwald 
3494c2414c00SMatthias Ringwald     // assess bonding requirements: abort if remote in dedicated bonding mode but we are non-bonding
3495c2414c00SMatthias Ringwald     // - GAP/MOD/NBON/BV-02-C
3496c2414c00SMatthias Ringwald     // - GAP/DM/NBON/BV-01-C
3497c2414c00SMatthias Ringwald     if (conn->authentication_flags & AUTH_FLAG_RECV_IO_CAPABILITIES_RESPONSE){
3498c2414c00SMatthias Ringwald         switch (conn->io_cap_response_auth_req){
3499c2414c00SMatthias Ringwald             case SSP_IO_AUTHREQ_MITM_PROTECTION_NOT_REQUIRED_DEDICATED_BONDING:
3500c2414c00SMatthias Ringwald             case SSP_IO_AUTHREQ_MITM_PROTECTION_REQUIRED_DEDICATED_BONDING:
3501c2414c00SMatthias Ringwald                 if (hci_stack->bondable == false){
3502c2414c00SMatthias Ringwald                     log_info("Dedicated vs. non-bondable -> abort");
3503c2414c00SMatthias Ringwald                     hci_pairing_complete(conn, ERROR_CODE_INSUFFICIENT_SECURITY);
3504c2414c00SMatthias Ringwald                     connectionSetAuthenticationFlags(conn, AUTH_FLAG_SEND_IO_CAPABILITIES_NEGATIVE_REPLY);
3505c2414c00SMatthias Ringwald                     return;
3506c2414c00SMatthias Ringwald                 }
3507c2414c00SMatthias Ringwald             default:
3508c2414c00SMatthias Ringwald                 break;
3509c2414c00SMatthias Ringwald         }
3510c2414c00SMatthias Ringwald     }
3511c2414c00SMatthias Ringwald 
3512b3c4163bSMatthias Ringwald     // assess security based on io capabilities
3513b3c4163bSMatthias Ringwald     if (conn->authentication_flags & AUTH_FLAG_RECV_IO_CAPABILITIES_RESPONSE){
3514b3c4163bSMatthias Ringwald         // responder: fully validate io caps of both sides as well as OOB data
3515b3c4163bSMatthias Ringwald         bool security_possible = false;
3516b3c4163bSMatthias Ringwald         security_possible = hci_ssp_security_level_possible_for_io_cap(requested_security_level, hci_stack->ssp_io_capability, conn->io_cap_response_io);
3517b3c4163bSMatthias Ringwald 
3518b3c4163bSMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB
3519b3c4163bSMatthias Ringwald         // We assume that both Controller can reach LEVEL 4, if one side has received P-192 and the other has received P-256,
3520b3c4163bSMatthias Ringwald         // so we merge the OOB data availability
3521b3c4163bSMatthias Ringwald         uint8_t have_oob_data = conn->io_cap_response_oob_data;
3522b3c4163bSMatthias Ringwald         if (conn->classic_oob_c_192 != NULL){
3523b3c4163bSMatthias Ringwald             have_oob_data |= 1;
3524b3c4163bSMatthias Ringwald         }
3525b3c4163bSMatthias Ringwald         if (conn->classic_oob_c_256 != NULL){
3526b3c4163bSMatthias Ringwald             have_oob_data |= 2;
3527b3c4163bSMatthias Ringwald         }
3528b3c4163bSMatthias Ringwald         // for up to Level 3, either P-192 as well as P-256 will do
3529b3c4163bSMatthias Ringwald         // if we don't support SC, then a) conn->classic_oob_c_256 will be NULL and b) remote should not report P-256 available
3530b3c4163bSMatthias Ringwald         // if remote does not SC, we should not receive P-256 data either
3531b3c4163bSMatthias Ringwald         if ((requested_security_level <= LEVEL_3) && (have_oob_data != 0)){
3532b3c4163bSMatthias Ringwald             security_possible = true;
3533b3c4163bSMatthias Ringwald         }
3534b3c4163bSMatthias Ringwald         // for Level 4, P-256 is needed
3535b3c4163bSMatthias Ringwald         if ((requested_security_level == LEVEL_4 && ((have_oob_data & 2) != 0))){
3536b3c4163bSMatthias Ringwald             security_possible = true;
3537b3c4163bSMatthias Ringwald         }
3538b3c4163bSMatthias Ringwald #endif
3539b3c4163bSMatthias Ringwald 
3540b3c4163bSMatthias Ringwald         if (security_possible == false){
35412dd8985bSMatthias Ringwald             log_info("IOCap/OOB insufficient for level %u -> abort", requested_security_level);
3542b3c4163bSMatthias Ringwald             hci_pairing_complete(conn, ERROR_CODE_INSUFFICIENT_SECURITY);
3543b3c4163bSMatthias Ringwald             connectionSetAuthenticationFlags(conn, AUTH_FLAG_SEND_IO_CAPABILITIES_NEGATIVE_REPLY);
3544b3c4163bSMatthias Ringwald             return;
3545b3c4163bSMatthias Ringwald         }
3546b3c4163bSMatthias Ringwald     } else {
3547b3c4163bSMatthias Ringwald         // initiator: remote io cap not yet, only check if we have ability for MITM protection if requested and OOB is not supported
35481fe968f5SMatthias Ringwald #ifndef ENABLE_CLASSIC_PAIRING_OOB
35491fe968f5SMatthias Ringwald #ifndef ENABLE_EXPLICIT_IO_CAPABILITIES_REPLY
3550b3c4163bSMatthias Ringwald         if ((conn->requested_security_level >= LEVEL_3) && (hci_stack->ssp_io_capability >= SSP_IO_CAPABILITY_NO_INPUT_NO_OUTPUT)){
3551b3c4163bSMatthias Ringwald             log_info("Level 3+ required, but no input/output -> abort");
3552b3c4163bSMatthias Ringwald             hci_pairing_complete(conn, ERROR_CODE_INSUFFICIENT_SECURITY);
3553b3c4163bSMatthias Ringwald             connectionSetAuthenticationFlags(conn, AUTH_FLAG_SEND_IO_CAPABILITIES_NEGATIVE_REPLY);
3554b3c4163bSMatthias Ringwald             return;
3555b3c4163bSMatthias Ringwald         }
3556b3c4163bSMatthias Ringwald #endif
35571fe968f5SMatthias Ringwald #endif
3558b3c4163bSMatthias Ringwald     }
3559b3c4163bSMatthias Ringwald 
3560b3c4163bSMatthias Ringwald #ifndef ENABLE_EXPLICIT_IO_CAPABILITIES_REPLY
3561b3c4163bSMatthias Ringwald     if (hci_stack->ssp_io_capability != SSP_IO_CAPABILITY_UNKNOWN){
3562b3c4163bSMatthias Ringwald         connectionSetAuthenticationFlags(conn, AUTH_FLAG_SEND_IO_CAPABILITIES_REPLY);
3563b3c4163bSMatthias Ringwald     } else {
3564b3c4163bSMatthias Ringwald         connectionSetAuthenticationFlags(conn, AUTH_FLAG_SEND_IO_CAPABILITIES_NEGATIVE_REPLY);
3565b3c4163bSMatthias Ringwald     }
3566b3c4163bSMatthias Ringwald #endif
3567b3c4163bSMatthias Ringwald }
3568b3c4163bSMatthias Ringwald 
356917c6fe5cSMatthias Ringwald #endif
357017c6fe5cSMatthias Ringwald 
3571c3b46f5aSMatthias Ringwald static void event_handler(uint8_t *packet, uint16_t size){
35724f781026SMatthias Ringwald 
35734f781026SMatthias Ringwald     uint16_t event_length = packet[1];
35744f781026SMatthias Ringwald 
35754f781026SMatthias Ringwald     // assert packet is complete
35764ea43905SMatthias Ringwald     if (size != (event_length + 2u)){
35774f781026SMatthias Ringwald         log_error("event_handler called with packet of wrong size %d, expected %u => dropping packet", size, event_length + 2);
35784f781026SMatthias Ringwald         return;
35794f781026SMatthias Ringwald     }
35804f781026SMatthias Ringwald 
35814f781026SMatthias Ringwald     hci_con_handle_t handle;
35824f781026SMatthias Ringwald     hci_connection_t * conn;
35834f781026SMatthias Ringwald     int i;
35844f781026SMatthias Ringwald 
35854f781026SMatthias Ringwald #ifdef ENABLE_CLASSIC
35865e91d96cSMatthias Ringwald     hci_link_type_t link_type;
358748f33f37SMatthias Ringwald     bd_addr_t addr;
3588cef94710SMatthias Ringwald     bd_addr_type_t addr_type;
35894f781026SMatthias Ringwald #endif
35904ae8623eSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
35914ae8623eSMatthias Ringwald     hci_iso_stream_t * iso_stream;
35927aa35f6aSMatthias Ringwald     le_audio_big_t   * big;
35932a6c0f82SMatthias Ringwald     le_audio_big_sync_t * big_sync;
35944ae8623eSMatthias Ringwald #endif
359589254d99SMatthias Ringwald #if defined(ENABLE_LE_ISOCHRONOUS_STREAMS) || defined(ENABLE_LE_EXTENDED_ADVERTISING)
359689254d99SMatthias Ringwald     btstack_linked_list_iterator_t it;
359789254d99SMatthias Ringwald #endif
359889254d99SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
359989254d99SMatthias Ringwald     uint8_t advertising_handle;
360089254d99SMatthias Ringwald #endif
36014f781026SMatthias Ringwald 
36024f781026SMatthias Ringwald     // log_info("HCI:EVENT:%02x", hci_event_packet_get_type(packet));
36034f781026SMatthias Ringwald 
36044f781026SMatthias Ringwald     switch (hci_event_packet_get_type(packet)) {
36054f781026SMatthias Ringwald 
36064f781026SMatthias Ringwald         case HCI_EVENT_COMMAND_COMPLETE:
36074f781026SMatthias Ringwald             handle_command_complete_event(packet, size);
360856cf178bSmatthias.ringwald             break;
360956cf178bSmatthias.ringwald 
36107ec5eeaaSmatthias.ringwald         case HCI_EVENT_COMMAND_STATUS:
3611afbf1cd7SMatthias Ringwald             handle_command_status_event(packet, size);
36127ec5eeaaSmatthias.ringwald             break;
36137ec5eeaaSmatthias.ringwald 
36142e440c8aS[email protected]         case HCI_EVENT_NUMBER_OF_COMPLETED_PACKETS:{
36159784dac1SMatthias Ringwald             if (size < 3) return;
36169784dac1SMatthias Ringwald             uint16_t num_handles = packet[2];
36174ea43905SMatthias Ringwald             if (size != (3u + num_handles * 4u)) return;
3618d9a1d8edSMatthias Ringwald #ifdef ENABLE_CLASSIC
3619d9a1d8edSMatthias Ringwald             bool notify_sco = false;
3620d9a1d8edSMatthias Ringwald #endif
3621d9a1d8edSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
3622d9a1d8edSMatthias Ringwald             bool notify_iso = false;
3623d9a1d8edSMatthias Ringwald #endif
36249784dac1SMatthias Ringwald             uint16_t offset = 3;
36259784dac1SMatthias Ringwald             for (i=0; i<num_handles;i++){
36264ea43905SMatthias Ringwald                 handle = little_endian_read_16(packet, offset) & 0x0fffu;
36274ea43905SMatthias Ringwald                 offset += 2u;
3628f8fbdce0SMatthias Ringwald                 uint16_t num_packets = little_endian_read_16(packet, offset);
36294ea43905SMatthias Ringwald                 offset += 2u;
36302e440c8aS[email protected] 
36315061f3afS[email protected]                 conn = hci_connection_for_handle(handle);
3632e5413aa0SMatthias Ringwald                 if (conn != NULL) {
363323bed257S[email protected] 
3634ce41473eSMatthias Ringwald                     if (conn->num_packets_sent >= num_packets) {
3635ce41473eSMatthias Ringwald                         conn->num_packets_sent -= num_packets;
3636e35edcc1S[email protected]                     } else {
3637ce41473eSMatthias Ringwald                         log_error("hci_number_completed_packets, more packet slots freed then sent.");
3638ce41473eSMatthias Ringwald                         conn->num_packets_sent = 0;
3639e35edcc1S[email protected]                     }
3640ce41473eSMatthias Ringwald                     // log_info("hci_number_completed_packet %u processed for handle %u, outstanding %u", num_packets, handle, conn->num_packets_sent);
3641d9a1d8edSMatthias Ringwald #ifdef ENABLE_CLASSIC
3642d9a1d8edSMatthias Ringwald                     if (conn->address_type == BD_ADDR_TYPE_SCO){
3643d9a1d8edSMatthias Ringwald                         notify_sco = true;
3644d9a1d8edSMatthias Ringwald                     }
3645d9a1d8edSMatthias Ringwald #endif
3646e5413aa0SMatthias Ringwald                 }
3647e5413aa0SMatthias Ringwald 
36488ad9cf99SMatthias Ringwald #ifdef ENABLE_CONTROLLER_DUMP_PACKETS
36498ad9cf99SMatthias Ringwald                 hci_controller_dump_packets();
36508ad9cf99SMatthias Ringwald #endif
36518ad9cf99SMatthias Ringwald 
3652e5413aa0SMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
3653e5413aa0SMatthias Ringwald                 if (conn == NULL){
3654e5413aa0SMatthias Ringwald                     hci_iso_stream_t * iso_stream = hci_iso_stream_for_con_handle(handle);
3655e5413aa0SMatthias Ringwald                     if (iso_stream != NULL){
3656e5413aa0SMatthias Ringwald                         if (iso_stream->num_packets_sent >= num_packets) {
3657e5413aa0SMatthias Ringwald                             iso_stream->num_packets_sent -= num_packets;
3658e5413aa0SMatthias Ringwald                         } else {
3659e5413aa0SMatthias Ringwald                             log_error("hci_number_completed_packets, more packet slots freed then sent.");
3660e5413aa0SMatthias Ringwald                             iso_stream->num_packets_sent = 0;
3661e5413aa0SMatthias Ringwald                         }
36628d72db10SMatthias Ringwald                         if (iso_stream->iso_type == HCI_ISO_TYPE_BIS){
36638d72db10SMatthias Ringwald                             le_audio_big_t * big = hci_big_for_handle(iso_stream->group_id);
3664fe977b37SMatthias Ringwald                             if (big != NULL){
3665fe977b37SMatthias Ringwald                                 big->num_completed_timestamp_current_valid = true;
3666fe977b37SMatthias Ringwald                                 big->num_completed_timestamp_current_ms = btstack_run_loop_get_time_ms();
3667fe977b37SMatthias Ringwald                             }
3668fe977b37SMatthias Ringwald                         }
3669e5413aa0SMatthias Ringwald                         log_info("hci_number_completed_packet %u processed for handle %u, outstanding %u",
3670e5413aa0SMatthias Ringwald                                  num_packets, handle, iso_stream->num_packets_sent);
3671d9a1d8edSMatthias Ringwald                         notify_iso = true;
3672e5413aa0SMatthias Ringwald                     }
3673d9a1d8edSMatthias Ringwald                 }
3674d9a1d8edSMatthias Ringwald #endif
3675d9a1d8edSMatthias Ringwald             }
3676d9a1d8edSMatthias Ringwald 
3677d9a1d8edSMatthias Ringwald #ifdef ENABLE_CLASSIC
3678d9a1d8edSMatthias Ringwald             if (notify_sco){
3679d9a1d8edSMatthias Ringwald                 hci_notify_if_sco_can_send_now();
3680d9a1d8edSMatthias Ringwald             }
3681d9a1d8edSMatthias Ringwald #endif
3682d9a1d8edSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
3683d9a1d8edSMatthias Ringwald             if (notify_iso){
36845ade6657SMatthias Ringwald                 hci_iso_notify_can_send_now();
3685e5413aa0SMatthias Ringwald             }
3686e5413aa0SMatthias Ringwald #endif
36876772a24cSmatthias.ringwald             break;
36882e440c8aS[email protected]         }
368935454696SMatthias Ringwald 
369035454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
36919afaa4d4SMatthias Ringwald         case HCI_EVENT_FLUSH_OCCURRED:
36929afaa4d4SMatthias Ringwald             // flush occurs only if automatic flush has been enabled by gap_enable_link_watchdog()
36939afaa4d4SMatthias Ringwald             handle = hci_event_flush_occurred_get_handle(packet);
36949afaa4d4SMatthias Ringwald             conn = hci_connection_for_handle(handle);
36959afaa4d4SMatthias Ringwald             if (conn) {
36969afaa4d4SMatthias Ringwald                 log_info("Flush occurred, disconnect 0x%04x", handle);
36979afaa4d4SMatthias Ringwald                 conn->state = SEND_DISCONNECT;
36989afaa4d4SMatthias Ringwald             }
36999afaa4d4SMatthias Ringwald             break;
37009afaa4d4SMatthias Ringwald 
3701f5875de5SMatthias Ringwald         case HCI_EVENT_INQUIRY_COMPLETE:
3702f5875de5SMatthias Ringwald             if (hci_stack->inquiry_state == GAP_INQUIRY_STATE_ACTIVE){
3703f5875de5SMatthias Ringwald                 hci_stack->inquiry_state = GAP_INQUIRY_STATE_IDLE;
3704f5875de5SMatthias Ringwald                 uint8_t event[] = { GAP_EVENT_INQUIRY_COMPLETE, 1, 0};
3705f5875de5SMatthias Ringwald                 hci_emit_event(event, sizeof(event), 1);
3706f5875de5SMatthias Ringwald             }
3707f5875de5SMatthias Ringwald             break;
3708b7f1ee76SMatthias Ringwald         case HCI_EVENT_REMOTE_NAME_REQUEST_COMPLETE:
3709b7f1ee76SMatthias Ringwald             if (hci_stack->remote_name_state == GAP_REMOTE_NAME_STATE_W4_COMPLETE){
3710b7f1ee76SMatthias Ringwald                 hci_stack->remote_name_state = GAP_REMOTE_NAME_STATE_IDLE;
3711b7f1ee76SMatthias Ringwald             }
3712b7f1ee76SMatthias Ringwald             break;
37131f7b95a1Smatthias.ringwald         case HCI_EVENT_CONNECTION_REQUEST:
3714724d70a2SMatthias Ringwald             reverse_bd_addr(&packet[2], addr);
37155e91d96cSMatthias Ringwald             link_type = (hci_link_type_t) packet[11];
371672cf8859SMatthias Ringwald 
371772cf8859SMatthias Ringwald             // CVE-2020-26555: reject incoming connection from device with same BD ADDR
371872cf8859SMatthias Ringwald             if (memcmp(hci_stack->local_bd_addr, addr, 6) == 0){
371972cf8859SMatthias Ringwald                 hci_stack->decline_reason = ERROR_CODE_CONNECTION_REJECTED_DUE_TO_UNACCEPTABLE_BD_ADDR;
372072cf8859SMatthias Ringwald                 bd_addr_copy(hci_stack->decline_addr, addr);
372172cf8859SMatthias Ringwald                 break;
372272cf8859SMatthias Ringwald             }
372372cf8859SMatthias Ringwald 
372407e010b6SMilanka Ringwald             if (hci_stack->gap_classic_accept_callback != NULL){
37255e91d96cSMatthias Ringwald                 if ((*hci_stack->gap_classic_accept_callback)(addr, link_type) == 0){
3726d152b6c6SMatthias Ringwald                     hci_stack->decline_reason = ERROR_CODE_CONNECTION_REJECTED_DUE_TO_SECURITY_REASONS;
372707e010b6SMilanka Ringwald                     bd_addr_copy(hci_stack->decline_addr, addr);
372807e010b6SMilanka Ringwald                     break;
372907e010b6SMilanka Ringwald                 }
373007e010b6SMilanka Ringwald             }
373107e010b6SMilanka Ringwald 
373237eaa4cfSmatthias.ringwald             // TODO: eval COD 8-10
37335e91d96cSMatthias Ringwald             log_info("Connection_incoming: %s, type %u", bd_addr_to_str(addr), (unsigned int) link_type);
37345e91d96cSMatthias Ringwald             addr_type = (link_type == HCI_LINK_TYPE_ACL) ? BD_ADDR_TYPE_ACL : BD_ADDR_TYPE_SCO;
37352e77e513S[email protected]             conn = hci_connection_for_bd_addr_and_type(addr, addr_type);
37361f7b95a1Smatthias.ringwald             if (!conn) {
373788f925b1SMatthias Ringwald                 conn = create_connection_for_bd_addr_and_type(addr, addr_type, HCI_ROLE_SLAVE);
37381f7b95a1Smatthias.ringwald             }
3739ce4c8fabSmatthias.ringwald             if (!conn) {
3740ce4c8fabSmatthias.ringwald                 // CONNECTION REJECTED DUE TO LIMITED RESOURCES (0X0D)
37414536712cSMilanka Ringwald                 hci_stack->decline_reason = ERROR_CODE_CONNECTION_REJECTED_DUE_TO_LIMITED_RESOURCES;
3742058e3d6bSMatthias Ringwald                 bd_addr_copy(hci_stack->decline_addr, addr);
3743f23819bcSMatthias Ringwald                 hci_run();
3744f23819bcSMatthias Ringwald                 // avoid event to higher layer
3745f23819bcSMatthias Ringwald                 return;
3746ce4c8fabSmatthias.ringwald             }
374732ab9390Smatthias.ringwald             conn->state = RECEIVED_CONNECTION_REQUEST;
3748f3a16b9aSMatthias Ringwald             // store info about eSCO
37495e91d96cSMatthias Ringwald             if (link_type == HCI_LINK_TYPE_ESCO){
375076ccfb2aSMatthias Ringwald                 conn->remote_supported_features[0] |= 1;
3751f3a16b9aSMatthias Ringwald             }
3752d7891039SMatthias Ringwald             // propagate remote supported sco packet packets from existing ACL to new SCO connection
3753d7891039SMatthias Ringwald             if (addr_type == BD_ADDR_TYPE_SCO){
3754182d886dSMatthias Ringwald                 const hci_connection_t * acl_conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL);
3755182d886dSMatthias Ringwald                 // ACL exists unless fuzzing
3756182d886dSMatthias Ringwald                 if (acl_conn != NULL) {
3757d7891039SMatthias Ringwald                     conn->remote_supported_sco_packets = acl_conn->remote_supported_sco_packets;
3758d7891039SMatthias Ringwald                 }
3759182d886dSMatthias Ringwald             }
376032ab9390Smatthias.ringwald             hci_run();
37611f7b95a1Smatthias.ringwald             break;
37621f7b95a1Smatthias.ringwald 
37636772a24cSmatthias.ringwald         case HCI_EVENT_CONNECTION_COMPLETE:
3764fe1ed1b8Smatthias.ringwald             // Connection management
3765724d70a2SMatthias Ringwald             reverse_bd_addr(&packet[5], addr);
37669da54300S[email protected]             log_info("Connection_complete (status=%u) %s", packet[2], bd_addr_to_str(addr));
3767f16129ceSMatthias Ringwald             addr_type = BD_ADDR_TYPE_ACL;
37682e77e513S[email protected]             conn = hci_connection_for_bd_addr_and_type(addr, addr_type);
3769fe1ed1b8Smatthias.ringwald             if (conn) {
3770893b4ccdSMatthias Ringwald                 switch (conn->state){
3771893b4ccdSMatthias Ringwald                     // expected states
3772893b4ccdSMatthias Ringwald                     case ACCEPTED_CONNECTION_REQUEST:
3773893b4ccdSMatthias Ringwald                     case SENT_CREATE_CONNECTION:
3774893b4ccdSMatthias Ringwald                         break;
3775893b4ccdSMatthias Ringwald                     // unexpected state -> ignore
3776893b4ccdSMatthias Ringwald                     default:
3777893b4ccdSMatthias Ringwald                         // don't forward event to app
3778893b4ccdSMatthias Ringwald                         return;
3779893b4ccdSMatthias Ringwald                 }
3780b448a0e7Smatthias.ringwald                 if (!packet[2]){
3781c8e4258aSmatthias.ringwald                     conn->state = OPEN;
3782f8fbdce0SMatthias Ringwald                     conn->con_handle = little_endian_read_16(packet, 3);
37836909f064SMatthias Ringwald 
378422df2fe2SMatthias Ringwald                     // trigger write supervision timeout if we're master
3785d821984bSMatthias Ringwald                     if ((hci_stack->link_supervision_timeout != HCI_LINK_SUPERVISION_TIMEOUT_DEFAULT) && (conn->role == HCI_ROLE_MASTER)){
378622df2fe2SMatthias Ringwald                         conn->gap_connection_tasks |= GAP_CONNECTION_TASK_WRITE_SUPERVISION_TIMEOUT;
37876909f064SMatthias Ringwald                     }
37886909f064SMatthias Ringwald 
378922df2fe2SMatthias Ringwald                     // trigger write automatic flush timeout
37909afaa4d4SMatthias Ringwald                     if (hci_stack->automatic_flush_timeout != 0){
37919afaa4d4SMatthias Ringwald                         conn->gap_connection_tasks |= GAP_CONNECTION_TASK_WRITE_AUTOMATIC_FLUSH_TIMEOUT;
37929afaa4d4SMatthias Ringwald                     }
37939afaa4d4SMatthias Ringwald 
3794c785ef68Smatthias.ringwald                     // restart timer
3795528a4a3bSMatthias Ringwald                     btstack_run_loop_set_timer(&conn->timeout, HCI_CONNECTION_TIMEOUT_MS);
3796528a4a3bSMatthias Ringwald                     btstack_run_loop_add_timer(&conn->timeout);
3797c785ef68Smatthias.ringwald 
379818c4a0a3SMatthias Ringwald                     // trigger remote features for dedicated bonding
379918c4a0a3SMatthias Ringwald                     if ((conn->bonding_flags & BONDING_DEDICATED) != 0){
380018c4a0a3SMatthias Ringwald                         hci_trigger_remote_features_for_connection(conn);
380118c4a0a3SMatthias Ringwald                     }
380218c4a0a3SMatthias Ringwald 
38039da54300S[email protected]                     log_info("New connection: handle %u, %s", conn->con_handle, bd_addr_to_str(conn->address));
380443bfb1bdSmatthias.ringwald 
380543bfb1bdSmatthias.ringwald                     hci_emit_nr_connections_changed();
3806b448a0e7Smatthias.ringwald                 } else {
38070bbba85bSMatthias Ringwald                     // connection failed
38080bbba85bSMatthias Ringwald                     hci_handle_connection_failed(conn, packet[2]);
3809fe1ed1b8Smatthias.ringwald                 }
3810fe1ed1b8Smatthias.ringwald             }
38116772a24cSmatthias.ringwald             break;
3812fe1ed1b8Smatthias.ringwald 
381344d0e3d5S[email protected]         case HCI_EVENT_SYNCHRONOUS_CONNECTION_COMPLETE:
3814724d70a2SMatthias Ringwald             reverse_bd_addr(&packet[5], addr);
38151f34df2cSMatthias Ringwald             conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_SCO);
38161f34df2cSMatthias Ringwald             log_info("Synchronous Connection Complete for %p (status=%u) %s", conn, packet[2], bd_addr_to_str(addr));
3817182d886dSMatthias Ringwald 
3818182d886dSMatthias Ringwald             // SCO exists unless fuzzer
3819182d886dSMatthias Ringwald             if (conn == NULL) break;
38209071873aSMatthias Ringwald 
38219071873aSMatthias Ringwald             if (packet[2] != ERROR_CODE_SUCCESS){
38229071873aSMatthias Ringwald                 // connection failed, remove entry
38231f34df2cSMatthias Ringwald                 hci_handle_connection_failed(conn, packet[2]);
382444d0e3d5S[email protected]                 break;
382544d0e3d5S[email protected]             }
38269071873aSMatthias Ringwald 
38271a06f663S[email protected]             conn->state = OPEN;
3828f8fbdce0SMatthias Ringwald             conn->con_handle = little_endian_read_16(packet, 3);
3829ee752bb8SMatthias Ringwald 
3830d7891039SMatthias Ringwald             // update sco payload length for eSCO connections
3831d7891039SMatthias Ringwald             if (hci_event_synchronous_connection_complete_get_tx_packet_length(packet) > 0){
3832d7891039SMatthias Ringwald                 conn->sco_payload_length = hci_event_synchronous_connection_complete_get_tx_packet_length(packet);
3833d7891039SMatthias Ringwald                 log_info("eSCO Complete, set payload len %u", conn->sco_payload_length);
3834d7891039SMatthias Ringwald             }
3835d7891039SMatthias Ringwald 
3836ee752bb8SMatthias Ringwald #ifdef ENABLE_SCO_OVER_HCI
3837ee752bb8SMatthias Ringwald             // update SCO
3838ee752bb8SMatthias Ringwald             if (conn->address_type == BD_ADDR_TYPE_SCO && hci_stack->hci_transport && hci_stack->hci_transport->set_sco_config){
3839ee752bb8SMatthias Ringwald                 hci_stack->hci_transport->set_sco_config(hci_stack->sco_voice_setting_active, hci_number_sco_connections());
3840ee752bb8SMatthias Ringwald             }
3841f234b250SMatthias Ringwald             // trigger can send now
3842f234b250SMatthias Ringwald             if (hci_have_usb_transport()){
38431972f31fSMatthias Ringwald                 hci_stack->sco_can_send_now = true;
3844f234b250SMatthias Ringwald             }
3845fa7f2dfdSMatthias Ringwald 
3846fa7f2dfdSMatthias Ringwald             // setup implict sco flow control
3847fa7f2dfdSMatthias Ringwald             conn->sco_tx_ready = 0;
3848fa7f2dfdSMatthias Ringwald             conn->sco_tx_active  = 0;
3849fa7f2dfdSMatthias Ringwald             conn->sco_established_ms = btstack_run_loop_get_time_ms();
3850fa7f2dfdSMatthias Ringwald 
3851ee752bb8SMatthias Ringwald #endif
3852cb70c5abSMatthias Ringwald #ifdef HAVE_SCO_TRANSPORT
3853cb70c5abSMatthias Ringwald             // configure sco transport
3854cb70c5abSMatthias Ringwald             if (hci_stack->sco_transport != NULL){
3855cb70c5abSMatthias Ringwald                 sco_format_t sco_format = ((hci_stack->sco_voice_setting_active & 0x03) == 0x03) ? SCO_FORMAT_8_BIT : SCO_FORMAT_16_BIT;
3856cb70c5abSMatthias Ringwald                 hci_stack->sco_transport->open(conn->con_handle, sco_format);
3857cb70c5abSMatthias Ringwald             }
3858cb70c5abSMatthias Ringwald #endif
385944d0e3d5S[email protected]             break;
386044d0e3d5S[email protected] 
3861afd4e962S[email protected]         case HCI_EVENT_READ_REMOTE_SUPPORTED_FEATURES_COMPLETE:
3862f8fbdce0SMatthias Ringwald             handle = little_endian_read_16(packet, 3);
3863afd4e962S[email protected]             conn = hci_connection_for_handle(handle);
3864afd4e962S[email protected]             if (!conn) break;
3865afd4e962S[email protected]             if (!packet[2]){
38662f5c44baSMatthias Ringwald                 const uint8_t * features = &packet[5];
38672f5c44baSMatthias Ringwald                 hci_handle_remote_features_page_0(conn, features);
38682f5c44baSMatthias Ringwald 
38695ccef624SMatthias Ringwald                 // read extended features if possible
38701ffa425cSMatthias Ringwald                 if (hci_command_supported(SUPPORTED_HCI_COMMAND_READ_REMOTE_EXTENDED_FEATURES)
38711ffa425cSMatthias Ringwald                 && ((conn->remote_supported_features[0] & 2) != 0)) {
38725ccef624SMatthias Ringwald                     conn->bonding_flags |= BONDING_REQUEST_REMOTE_FEATURES_PAGE_1;
38735ccef624SMatthias Ringwald                     break;
38745ccef624SMatthias Ringwald                 }
38755ccef624SMatthias Ringwald             }
38765ccef624SMatthias Ringwald             hci_handle_remote_features_received(conn);
38775ccef624SMatthias Ringwald             break;
38785ccef624SMatthias Ringwald 
38795ccef624SMatthias Ringwald         case HCI_EVENT_READ_REMOTE_EXTENDED_FEATURES_COMPLETE:
38805ccef624SMatthias Ringwald             handle = little_endian_read_16(packet, 3);
38815ccef624SMatthias Ringwald             conn = hci_connection_for_handle(handle);
38825ccef624SMatthias Ringwald             if (!conn) break;
38835ccef624SMatthias Ringwald             // status = ok, page = 1
388450c51a77SMatthias Ringwald             if (!packet[2]) {
388550c51a77SMatthias Ringwald                 uint8_t page_number = packet[5];
388650c51a77SMatthias Ringwald                 uint8_t maximum_page_number = packet[6];
38875ccef624SMatthias Ringwald                 const uint8_t * features = &packet[7];
388850c51a77SMatthias Ringwald                 bool done = false;
388950c51a77SMatthias Ringwald                 switch (page_number){
389050c51a77SMatthias Ringwald                     case 1:
38912f5c44baSMatthias Ringwald                         hci_handle_remote_features_page_1(conn, features);
389250c51a77SMatthias Ringwald                         if (maximum_page_number >= 2){
389350c51a77SMatthias Ringwald                             // get Secure Connections (Controller) from Page 2 if available
389450c51a77SMatthias Ringwald                             conn->bonding_flags |= BONDING_REQUEST_REMOTE_FEATURES_PAGE_2;
389550c51a77SMatthias Ringwald                         } else {
389650c51a77SMatthias Ringwald                             // otherwise, assume SC (Controller) == SC (Host)
389750c51a77SMatthias Ringwald                             if ((conn->bonding_flags & BONDING_REMOTE_SUPPORTS_SC_HOST) != 0){
389850c51a77SMatthias Ringwald                                 conn->bonding_flags |= BONDING_REMOTE_SUPPORTS_SC_CONTROLLER;
389950c51a77SMatthias Ringwald                             }
390050c51a77SMatthias Ringwald                             done = true;
390150c51a77SMatthias Ringwald                         }
390250c51a77SMatthias Ringwald                         break;
390350c51a77SMatthias Ringwald                     case 2:
390450c51a77SMatthias Ringwald                         hci_handle_remote_features_page_2(conn, features);
390550c51a77SMatthias Ringwald                         done = true;
390650c51a77SMatthias Ringwald                         break;
390750c51a77SMatthias Ringwald                     default:
390850c51a77SMatthias Ringwald                         break;
390950c51a77SMatthias Ringwald                 }
391050c51a77SMatthias Ringwald                 if (!done) break;
3911afd4e962S[email protected]             }
3912de0df013SMatthias Ringwald             hci_handle_remote_features_received(conn);
3913afd4e962S[email protected]             break;
3914afd4e962S[email protected] 
39157fde4af9Smatthias.ringwald         case HCI_EVENT_LINK_KEY_REQUEST:
3916308eeaffSMatthias Ringwald #ifndef ENABLE_EXPLICIT_LINK_KEY_REPLY
391763c0b2fdSMatthias Ringwald             hci_event_link_key_request_get_bd_addr(packet, addr);
391863c0b2fdSMatthias Ringwald             conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL);
391963c0b2fdSMatthias Ringwald             if (!conn) break;
392063c0b2fdSMatthias Ringwald 
392163c0b2fdSMatthias Ringwald             // lookup link key in db if not cached
392263c0b2fdSMatthias Ringwald             if ((conn->link_key_type == INVALID_LINK_KEY) && (hci_stack->link_key_db != NULL)){
392363c0b2fdSMatthias Ringwald                 hci_stack->link_key_db->get_link_key(conn->address, conn->link_key, &conn->link_key_type);
392463c0b2fdSMatthias Ringwald             }
392563c0b2fdSMatthias Ringwald 
392663c0b2fdSMatthias Ringwald             // response sent by hci_run()
392763c0b2fdSMatthias Ringwald             conn->authentication_flags |= AUTH_FLAG_HANDLE_LINK_KEY_REQUEST;
392863c0b2fdSMatthias Ringwald #endif
3929608f51bbSMatthias Ringwald             break;
39307fde4af9Smatthias.ringwald 
39319ab95c90S[email protected]         case HCI_EVENT_LINK_KEY_NOTIFICATION: {
39321714cbbdSMatthias Ringwald             hci_event_link_key_request_get_bd_addr(packet, addr);
3933f16129ceSMatthias Ringwald             conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL);
39349ab95c90S[email protected]             if (!conn) break;
39351714cbbdSMatthias Ringwald 
39361714cbbdSMatthias Ringwald             hci_pairing_complete(conn, ERROR_CODE_SUCCESS);
39371714cbbdSMatthias Ringwald 
39383817f9dfSMatthias Ringwald             // CVE-2020-26555: ignore NULL link key
39393817f9dfSMatthias Ringwald             // default link_key_type = INVALID_LINK_KEY asserts that NULL key won't be used for encryption
39403817f9dfSMatthias Ringwald             if (btstack_is_null(&packet[8], 16)) break;
39413817f9dfSMatthias Ringwald 
39427bdc6798S[email protected]             link_key_type_t link_key_type = (link_key_type_t)packet[24];
39439ab95c90S[email protected]             // Change Connection Encryption keeps link key type
39449ab95c90S[email protected]             if (link_key_type != CHANGED_COMBINATION_KEY){
39459ab95c90S[email protected]                 conn->link_key_type = link_key_type;
39469ab95c90S[email protected]             }
39473817f9dfSMatthias Ringwald 
3948e9f98c4aSMatthias Ringwald             // cache link key. link keys stored in little-endian format for legacy reasons
3949e9f98c4aSMatthias Ringwald             memcpy(&conn->link_key, &packet[8], 16);
3950e9f98c4aSMatthias Ringwald 
3951bec5f683SMatthias Ringwald             // only store link key:
3952bec5f683SMatthias Ringwald             // - if bondable enabled
3953bec5f683SMatthias Ringwald             if (hci_stack->bondable == false) break;
39546edaed7fSMatthias Ringwald             // - if security level sufficient
39556edaed7fSMatthias Ringwald             if (gap_security_level_for_link_key_type(link_key_type) < conn->requested_security_level) break;
395655597469SMatthias Ringwald             gap_store_link_key_for_bd_addr(addr, &packet[8], conn->link_key_type);
39577fde4af9Smatthias.ringwald             break;
39589ab95c90S[email protected]         }
39597fde4af9Smatthias.ringwald 
39607fde4af9Smatthias.ringwald         case HCI_EVENT_PIN_CODE_REQUEST:
39611714cbbdSMatthias Ringwald             hci_event_pin_code_request_get_bd_addr(packet, addr);
39621714cbbdSMatthias Ringwald             conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL);
39631714cbbdSMatthias Ringwald             if (!conn) break;
39641714cbbdSMatthias Ringwald 
39651714cbbdSMatthias Ringwald             hci_pairing_started(conn, false);
3966a800d95eSMatthias Ringwald             // abort pairing if: non-bondable mode (pin code request is not forwarded to app)
39673a9fb326S[email protected]             if (!hci_stack->bondable ){
39688daf94bcSMatthias Ringwald                 conn->authentication_flags |= AUTH_FLAG_DENY_PIN_CODE_REQUEST;
39691714cbbdSMatthias Ringwald                 hci_pairing_complete(conn, ERROR_CODE_PAIRING_NOT_ALLOWED);
3970f8fb5f6eS[email protected]                 hci_run();
3971f8fb5f6eS[email protected]                 return;
39724c57c146S[email protected]             }
3973a800d95eSMatthias Ringwald             // abort pairing if: LEVEL_4 required (pin code request is not forwarded to app)
3974a800d95eSMatthias Ringwald             if ((hci_stack->gap_secure_connections_only_mode) || (conn->requested_security_level == LEVEL_4)){
3975a800d95eSMatthias Ringwald                 log_info("Level 4 required, but SC not supported -> abort");
397650dcc63cSMatthias Ringwald                 conn->authentication_flags |= AUTH_FLAG_DENY_PIN_CODE_REQUEST;
397750dcc63cSMatthias Ringwald                 hci_pairing_complete(conn, ERROR_CODE_INSUFFICIENT_SECURITY);
397850dcc63cSMatthias Ringwald                 hci_run();
397950dcc63cSMatthias Ringwald                 return;
398050dcc63cSMatthias Ringwald             }
39817fde4af9Smatthias.ringwald             break;
39827fde4af9Smatthias.ringwald 
398350d7398cSMatthias Ringwald         case HCI_EVENT_IO_CAPABILITY_RESPONSE:
398450d7398cSMatthias Ringwald             hci_event_io_capability_response_get_bd_addr(packet, addr);
398550d7398cSMatthias Ringwald             conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL);
398650d7398cSMatthias Ringwald             if (!conn) break;
39871714cbbdSMatthias Ringwald 
39888daf94bcSMatthias Ringwald             hci_add_connection_flags_for_flipped_bd_addr(&packet[2], AUTH_FLAG_RECV_IO_CAPABILITIES_RESPONSE);
39891714cbbdSMatthias Ringwald             hci_pairing_started(conn, true);
399050d7398cSMatthias Ringwald             conn->io_cap_response_auth_req = hci_event_io_capability_response_get_authentication_requirements(packet);
3991e276e383SMatthias Ringwald             conn->io_cap_response_io       = hci_event_io_capability_response_get_io_capability(packet);
3992d22b82d6SMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB
3993d22b82d6SMatthias Ringwald             conn->io_cap_response_oob_data = hci_event_io_capability_response_get_oob_data_present(packet);
3994d22b82d6SMatthias Ringwald #endif
399550d7398cSMatthias Ringwald             break;
399650d7398cSMatthias Ringwald 
39971d6b20aeS[email protected]         case HCI_EVENT_IO_CAPABILITY_REQUEST:
39981714cbbdSMatthias Ringwald             hci_event_io_capability_response_get_bd_addr(packet, addr);
39991714cbbdSMatthias Ringwald             conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL);
40001714cbbdSMatthias Ringwald             if (!conn) break;
40011714cbbdSMatthias Ringwald 
4002c950c316SMatthias Ringwald             hci_add_connection_flags_for_flipped_bd_addr(&packet[2], AUTH_FLAG_RECV_IO_CAPABILITIES_REQUEST);
40039671e615SMatthias Ringwald             hci_connection_timestamp(conn);
40041714cbbdSMatthias Ringwald             hci_pairing_started(conn, true);
4005dbe1a790S[email protected]             break;
4006dbe1a790S[email protected] 
40071849becdSMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB
40081849becdSMatthias Ringwald         case HCI_EVENT_REMOTE_OOB_DATA_REQUEST:
40097ca4a7edSMatthias Ringwald             hci_event_remote_oob_data_request_get_bd_addr(packet, addr);
40107ca4a7edSMatthias Ringwald             conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL);
40117ca4a7edSMatthias Ringwald             if (!conn) break;
40127ca4a7edSMatthias Ringwald 
40137ca4a7edSMatthias Ringwald             hci_connection_timestamp(conn);
40147ca4a7edSMatthias Ringwald 
40157ca4a7edSMatthias Ringwald             hci_pairing_started(conn, true);
40167ca4a7edSMatthias Ringwald 
40177ca4a7edSMatthias Ringwald             connectionSetAuthenticationFlags(conn, AUTH_FLAG_SEND_REMOTE_OOB_DATA_REPLY);
40181849becdSMatthias Ringwald             break;
40191849becdSMatthias Ringwald #endif
40201849becdSMatthias Ringwald 
4021dbe1a790S[email protected]         case HCI_EVENT_USER_CONFIRMATION_REQUEST:
402217c6fe5cSMatthias Ringwald             hci_event_user_confirmation_request_get_bd_addr(packet, addr);
4023367aedc0SMatthias Ringwald             conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL);
4024367aedc0SMatthias Ringwald             if (!conn) break;
4025367aedc0SMatthias Ringwald             if (hci_ssp_security_level_possible_for_io_cap(conn->requested_security_level, hci_stack->ssp_io_capability, conn->io_cap_response_io)) {
4026367aedc0SMatthias Ringwald                 if (hci_stack->ssp_auto_accept){
40278daf94bcSMatthias Ringwald                     hci_add_connection_flags_for_flipped_bd_addr(&packet[2], AUTH_FLAG_SEND_USER_CONFIRM_REPLY);
4028367aedc0SMatthias Ringwald                 };
4029367aedc0SMatthias Ringwald             } else {
4030367aedc0SMatthias Ringwald                 hci_pairing_complete(conn, ERROR_CODE_INSUFFICIENT_SECURITY);
4031367aedc0SMatthias Ringwald                 hci_add_connection_flags_for_flipped_bd_addr(&packet[2], AUTH_FLAG_SEND_USER_CONFIRM_NEGATIVE_REPLY);
4032367aedc0SMatthias Ringwald                 // don't forward event to app
4033367aedc0SMatthias Ringwald                 hci_run();
4034367aedc0SMatthias Ringwald                 return;
4035367aedc0SMatthias Ringwald             }
4036dbe1a790S[email protected]             break;
4037dbe1a790S[email protected] 
4038dbe1a790S[email protected]         case HCI_EVENT_USER_PASSKEY_REQUEST:
4039367aedc0SMatthias Ringwald             // Pairing using Passkey results in MITM protection. If Level 4 is required, support for SC is validated on IO Cap Request
4040367aedc0SMatthias Ringwald             if (hci_stack->ssp_auto_accept){
40418daf94bcSMatthias Ringwald                 hci_add_connection_flags_for_flipped_bd_addr(&packet[2], AUTH_FLAG_SEND_USER_PASSKEY_REPLY);
4042367aedc0SMatthias Ringwald             };
40431d6b20aeS[email protected]             break;
40441849becdSMatthias Ringwald 
40453dce6128SMatthias Ringwald         case HCI_EVENT_MODE_CHANGE:
40463dce6128SMatthias Ringwald             handle = hci_event_mode_change_get_handle(packet);
40473dce6128SMatthias Ringwald             conn = hci_connection_for_handle(handle);
40483dce6128SMatthias Ringwald             if (!conn) break;
40493dce6128SMatthias Ringwald             conn->connection_mode = hci_event_mode_change_get_mode(packet);
40503dce6128SMatthias Ringwald             log_info("HCI_EVENT_MODE_CHANGE, handle 0x%04x, mode %u", handle, conn->connection_mode);
40513dce6128SMatthias Ringwald             break;
405235454696SMatthias Ringwald #endif
40531d6b20aeS[email protected] 
4054f0944df2S[email protected]         case HCI_EVENT_ENCRYPTION_CHANGE:
4055a355334eSMatthias Ringwald         case HCI_EVENT_ENCRYPTION_CHANGE_V2:
4056254b78eeSMatthias Ringwald             handle = hci_event_encryption_change_get_connection_handle(packet);
4057f0944df2S[email protected]             conn = hci_connection_for_handle(handle);
4058f0944df2S[email protected]             if (!conn) break;
4059db3c1f89SMatthias Ringwald             if (hci_event_encryption_change_get_status(packet) == ERROR_CODE_SUCCESS) {
4060254b78eeSMatthias Ringwald                 uint8_t encryption_enabled = hci_event_encryption_change_get_encryption_enabled(packet);
4061254b78eeSMatthias Ringwald                 if (encryption_enabled){
4062573897a0SMatthias Ringwald                     if (hci_is_le_connection(conn)){
4063573897a0SMatthias Ringwald                         // For LE, we accept connection as encrypted
40648daf94bcSMatthias Ringwald                         conn->authentication_flags |= AUTH_FLAG_CONNECTION_ENCRYPTED;
4065573897a0SMatthias Ringwald                     }
4066573897a0SMatthias Ringwald #ifdef ENABLE_CLASSIC
4067573897a0SMatthias Ringwald                     else {
4068fcaf38b9SMatthias Ringwald 
4069254b78eeSMatthias Ringwald                         // Detect Secure Connection -> Legacy Connection Downgrade Attack (BIAS)
407036c3546bSMatthias Ringwald                         bool sc_used_during_pairing = gap_secure_connection_for_link_key_type(conn->link_key_type);
4071254b78eeSMatthias Ringwald                         bool connected_uses_aes_ccm = encryption_enabled == 2;
4072edc1ac20SMatthias Ringwald                         if (hci_stack->secure_connections_active && sc_used_during_pairing && !connected_uses_aes_ccm){
4073813a09c6SMatthias Ringwald #ifdef ENABLE_TESTING_SUPPORT
4074813a09c6SMatthias Ringwald                             // The following tests require to reject L2CAP connection as SC has been disabled on the remote
4075813a09c6SMatthias Ringwald                             // - GAP/SEC/SEM/BI-31-C
4076813a09c6SMatthias Ringwald                             // - GAP/SEC/SEM/BI-32-C
4077813a09c6SMatthias Ringwald                             // - GAP/SEC/SEM/BI-33-C
4078813a09c6SMatthias Ringwald 
4079813a09c6SMatthias Ringwald                             // Our release code (aggressively) disconnects the HCI connection, without a chance to respond to PTS
4080813a09c6SMatthias Ringwald                             // To pass the tests, we only downgrade the link key type instead of the more secure disconnect
408129d4766dSMatthias Ringwald                             link_key_type_t new_link_key_type = UNAUTHENTICATED_COMBINATION_KEY_GENERATED_FROM_P192;
408229d4766dSMatthias Ringwald                             if (conn->link_key_type == AUTHENTICATED_COMBINATION_KEY_GENERATED_FROM_P256){
4083813a09c6SMatthias Ringwald                                 new_link_key_type = AUTHENTICATED_COMBINATION_KEY_GENERATED_FROM_P192;
4084813a09c6SMatthias Ringwald                             }
4085813a09c6SMatthias Ringwald                             log_info("SC during pairing, but only E0 now -> downgrade link key type from %u to %u",
4086813a09c6SMatthias Ringwald                                      conn->link_key_type, new_link_key_type);
4087813a09c6SMatthias Ringwald                             conn->link_key_type = new_link_key_type;
4088813a09c6SMatthias Ringwald #else
4089254b78eeSMatthias Ringwald                             log_info("SC during pairing, but only E0 now -> abort");
40909ece71c2SMatthias Ringwald                             conn->bonding_flags |= BONDING_DISCONNECT_SECURITY_BLOCK;
4091254b78eeSMatthias Ringwald                             break;
4092813a09c6SMatthias Ringwald #endif
4093254b78eeSMatthias Ringwald                         }
4094254b78eeSMatthias Ringwald 
409562daa441SMatthias Ringwald #ifdef ENABLE_MUTUAL_AUTHENTICATION_FOR_LEGACY_SECURE_CONNECTIONS
4096aa2fe986SMatthias Ringwald                         // if AES-CCM is used, authentication used SC -> authentication was mutual and we can skip explicit authentication
4097aa2fe986SMatthias Ringwald                         if (connected_uses_aes_ccm){
4098aa2fe986SMatthias Ringwald                             conn->authentication_flags |= AUTH_FLAG_CONNECTION_AUTHENTICATED;
4099aa2fe986SMatthias Ringwald                         }
410062daa441SMatthias Ringwald #else
410162daa441SMatthias Ringwald                         // We consider even Legacy Secure Connections as authenticated as BTstack mandates encryption
410262daa441SMatthias Ringwald                         // with encryption key size > hci_stack->gap_required_encyrption_key_size
410362daa441SMatthias Ringwald                         // for all operations that require any security. See BIAS attacks.
4104aa2fe986SMatthias Ringwald                         conn->authentication_flags |= AUTH_FLAG_CONNECTION_AUTHENTICATED;
4105aa2fe986SMatthias Ringwald #endif
4106a355334eSMatthias Ringwald                         // validate encryption key size
4107a355334eSMatthias Ringwald                         if (hci_event_packet_get_type(packet) == HCI_EVENT_ENCRYPTION_CHANGE_V2) {
4108a355334eSMatthias Ringwald                             uint8_t encryption_key_size = hci_event_encryption_change_v2_get_encryption_key_size(packet);
4109a355334eSMatthias Ringwald                             // already got encryption key size
4110a355334eSMatthias Ringwald                             hci_handle_read_encryption_key_size_complete(conn, encryption_key_size);
4111a355334eSMatthias Ringwald                         } else {
41121ffa425cSMatthias Ringwald                             if (hci_command_supported(SUPPORTED_HCI_COMMAND_READ_ENCRYPTION_KEY_SIZE)) {
41136e058d3fSMatthias Ringwald                                 // For Classic, we need to validate encryption key size first, if possible (== supported by Controller)
4114573897a0SMatthias Ringwald                                 conn->bonding_flags |= BONDING_SEND_READ_ENCRYPTION_KEY_SIZE;
41156e058d3fSMatthias Ringwald                             } else {
41166e058d3fSMatthias Ringwald                                 // if not, pretend everything is perfect
41179866fdc7SMatthias Ringwald                                 hci_handle_read_encryption_key_size_complete(conn, 16);
41186e058d3fSMatthias Ringwald                             }
4119573897a0SMatthias Ringwald                         }
4120a355334eSMatthias Ringwald                     }
4121573897a0SMatthias Ringwald #endif
4122f0944df2S[email protected]                 } else {
41238daf94bcSMatthias Ringwald                     conn->authentication_flags &= ~AUTH_FLAG_CONNECTION_ENCRYPTED;
4124f0944df2S[email protected]                 }
41255999ee11SMatthias Ringwald             } else {
41268eae094cSMatthias Ringwald #ifdef ENABLE_CLASSIC
41278eae094cSMatthias Ringwald                 if (!hci_is_le_connection(conn)){
41285999ee11SMatthias Ringwald                     uint8_t status = hci_event_encryption_change_get_status(packet);
41295999ee11SMatthias Ringwald                     if ((conn->bonding_flags & BONDING_DEDICATED) != 0){
41305999ee11SMatthias Ringwald                         conn->bonding_flags &= ~BONDING_DEDICATED;
41315999ee11SMatthias Ringwald                         conn->bonding_flags |= BONDING_DISCONNECT_DEDICATED_DONE;
41325999ee11SMatthias Ringwald                         conn->bonding_status = status;
41335999ee11SMatthias Ringwald                     }
413427b992efSMatthias Ringwald                     // trigger security update -> level 0
413527b992efSMatthias Ringwald                     hci_handle_mutual_authentication_completed(conn);
4136ad83dc6aS[email protected]                 }
41378eae094cSMatthias Ringwald #endif
41388eae094cSMatthias Ringwald             }
4139573897a0SMatthias Ringwald 
4140f0944df2S[email protected]             break;
4141f0944df2S[email protected] 
414235454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
41431eb2563eS[email protected]         case HCI_EVENT_AUTHENTICATION_COMPLETE_EVENT:
4144abdad579SMatthias Ringwald             handle = hci_event_authentication_complete_get_connection_handle(packet);
41451eb2563eS[email protected]             conn = hci_connection_for_handle(handle);
41461eb2563eS[email protected]             if (!conn) break;
4147ad83dc6aS[email protected] 
4148dbd5dcc3SMatthias Ringwald             // clear authentication active flag
4149dbd5dcc3SMatthias Ringwald             conn->bonding_flags &= ~BONDING_SENT_AUTHENTICATE_REQUEST;
41501714cbbdSMatthias Ringwald             hci_pairing_complete(conn, hci_event_authentication_complete_get_status(packet));
4151dbd5dcc3SMatthias Ringwald 
4152abdad579SMatthias Ringwald             // authenticated only if auth status == 0
4153abdad579SMatthias Ringwald             if (hci_event_authentication_complete_get_status(packet) == 0){
4154abdad579SMatthias Ringwald                 // authenticated
41558daf94bcSMatthias Ringwald                 conn->authentication_flags |= AUTH_FLAG_CONNECTION_AUTHENTICATED;
4156abdad579SMatthias Ringwald 
4157131ef17aSMatthias Ringwald                 // If not already encrypted, start encryption
41588daf94bcSMatthias Ringwald                 if ((conn->authentication_flags & AUTH_FLAG_CONNECTION_ENCRYPTED) == 0){
41591eb2563eS[email protected]                     conn->bonding_flags |= BONDING_SEND_ENCRYPTION_REQUEST;
4160ad83dc6aS[email protected]                     break;
4161ad83dc6aS[email protected]                 }
4162abdad579SMatthias Ringwald             }
4163abdad579SMatthias Ringwald 
41644aa2f135SMatthias Ringwald             // emit updated security level (will be 0 if not authenticated)
41654aa2f135SMatthias Ringwald             hci_handle_mutual_authentication_completed(conn);
41661eb2563eS[email protected]             break;
41671714cbbdSMatthias Ringwald 
41681714cbbdSMatthias Ringwald         case HCI_EVENT_SIMPLE_PAIRING_COMPLETE:
41691714cbbdSMatthias Ringwald             hci_event_simple_pairing_complete_get_bd_addr(packet, addr);
41701714cbbdSMatthias Ringwald             conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL);
41711714cbbdSMatthias Ringwald             if (!conn) break;
41721714cbbdSMatthias Ringwald 
4173aa2fe986SMatthias Ringwald             // treat successfully paired connection as authenticated
4174aa2fe986SMatthias Ringwald             if (hci_event_simple_pairing_complete_get_status(packet) == ERROR_CODE_SUCCESS){
4175f3aafff1SMatthias Ringwald                 conn->authentication_flags |= AUTH_FLAG_CONNECTION_AUTHENTICATED;
4176aa2fe986SMatthias Ringwald             }
4177aa2fe986SMatthias Ringwald 
41781714cbbdSMatthias Ringwald             hci_pairing_complete(conn, hci_event_simple_pairing_complete_get_status(packet));
41791714cbbdSMatthias Ringwald             break;
418035454696SMatthias Ringwald #endif
418134d2123cS[email protected] 
418286805605S[email protected]         // HCI_EVENT_DISCONNECTION_COMPLETE
4183ccda6e14S[email protected]         // has been split, to first notify stack before shutting connection down
4184ccda6e14S[email protected]         // see end of function, too.
4185a4f30ec0S[email protected]         case HCI_EVENT_DISCONNECTION_COMPLETE:
4186a4f30ec0S[email protected]             if (packet[2]) break;   // status != 0
4187f8fbdce0SMatthias Ringwald             handle = little_endian_read_16(packet, 3);
418881d2bdb2SMatthias Ringwald             // drop outgoing ACL fragments if it is for closed connection and release buffer if tx not active
41894ea43905SMatthias Ringwald             if (hci_stack->acl_fragmentation_total_size > 0u) {
4190c6a37cfdSMatthias Ringwald                 if (handle == READ_ACL_CONNECTION_HANDLE(hci_stack->hci_packet_buffer)){
41914ea43905SMatthias Ringwald                     int release_buffer = hci_stack->acl_fragmentation_tx_active == 0u;
419281d2bdb2SMatthias Ringwald                     log_info("drop fragmented ACL data for closed connection, release buffer %u", release_buffer);
4193c6a37cfdSMatthias Ringwald                     hci_stack->acl_fragmentation_total_size = 0;
4194c6a37cfdSMatthias Ringwald                     hci_stack->acl_fragmentation_pos = 0;
419581d2bdb2SMatthias Ringwald                     if (release_buffer){
419681d2bdb2SMatthias Ringwald                         hci_release_packet_buffer();
419781d2bdb2SMatthias Ringwald                     }
4198c6a37cfdSMatthias Ringwald                 }
4199c6a37cfdSMatthias Ringwald             }
420035454696SMatthias Ringwald 
42014ae8623eSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
4202098c2716SMatthias Ringwald             // drop outgoing ISO fragments if it is for closed connection and release buffer if tx not active
4203098c2716SMatthias Ringwald             if (hci_stack->iso_fragmentation_total_size > 0u) {
4204098c2716SMatthias Ringwald                 if (handle == READ_ISO_CONNECTION_HANDLE(hci_stack->hci_packet_buffer)){
4205098c2716SMatthias Ringwald                     int release_buffer = hci_stack->iso_fragmentation_tx_active == 0u;
4206098c2716SMatthias Ringwald                     log_info("drop fragmented ISO data for closed connection, release buffer %u", release_buffer);
4207098c2716SMatthias Ringwald                     hci_stack->iso_fragmentation_total_size = 0;
4208098c2716SMatthias Ringwald                     hci_stack->iso_fragmentation_pos = 0;
4209098c2716SMatthias Ringwald                     if (release_buffer){
4210098c2716SMatthias Ringwald                         hci_release_packet_buffer();
4211098c2716SMatthias Ringwald                     }
4212098c2716SMatthias Ringwald                 }
4213098c2716SMatthias Ringwald             }
4214098c2716SMatthias Ringwald 
42156fd1d2c8SMatthias Ringwald             // finalize iso stream for CIS handle
421615a15be3SMatthias Ringwald             iso_stream = hci_iso_stream_for_con_handle(handle);
42174ae8623eSMatthias Ringwald             if (iso_stream != NULL){
42184ae8623eSMatthias Ringwald                 hci_iso_stream_finalize(iso_stream);
42194ae8623eSMatthias Ringwald                 break;
42204ae8623eSMatthias Ringwald             }
42216fd1d2c8SMatthias Ringwald 
42226fd1d2c8SMatthias Ringwald             // finalize iso stream(s) for ACL handle
42236fd1d2c8SMatthias Ringwald             btstack_linked_list_iterator_init(&it, &hci_stack->iso_streams);
42246fd1d2c8SMatthias Ringwald             while (btstack_linked_list_iterator_has_next(&it)){
42256fd1d2c8SMatthias Ringwald                 hci_iso_stream_t * iso_stream = (hci_iso_stream_t *) btstack_linked_list_iterator_next(&it);
42266fd1d2c8SMatthias Ringwald                 if (iso_stream->acl_handle == handle ) {
42276fd1d2c8SMatthias Ringwald                     hci_iso_stream_finalize(iso_stream);
42286fd1d2c8SMatthias Ringwald                 }
42296fd1d2c8SMatthias Ringwald             }
42304ae8623eSMatthias Ringwald #endif
42314ae8623eSMatthias Ringwald 
423291036612SMatthias Ringwald #if defined(ENABLE_BLE) && defined (ENABLE_HCI_COMMAND_STATUS_DISCARDED_FOR_FAILED_CONNECTIONS_WORKAROUND)
4233f48a5586SMatthias Ringwald             if ((handle != HCI_CON_HANDLE_INVALID) && (handle == hci_stack->hci_command_con_handle)){
4234f48a5586SMatthias Ringwald                 // we did not receive a HCI Command Complete or HCI Command Status event for the disconnected connection
4235f48a5586SMatthias Ringwald                 // if needed, we could also track the hci command opcode and simulate a hci command complete with status
4236f48a5586SMatthias Ringwald                 // but the connection has failed anyway, so for now, we only set the num hci commands back to 1
423705acf48bSMatthias Ringwald                 log_info("Disconnect for conn handle 0x%04x in pending HCI command, assume command failed", handle);
423805acf48bSMatthias Ringwald                 hci_stack->hci_command_con_handle = HCI_CON_HANDLE_INVALID;
4239f48a5586SMatthias Ringwald                 hci_stack->num_cmd_packets = 1;
4240f48a5586SMatthias Ringwald             }
4241f48a5586SMatthias Ringwald #endif
4242f48a5586SMatthias Ringwald 
4243c6a37cfdSMatthias Ringwald             conn = hci_connection_for_handle(handle);
4244c6a37cfdSMatthias Ringwald             if (!conn) break;
42451714cbbdSMatthias Ringwald #ifdef ENABLE_CLASSIC
42461714cbbdSMatthias Ringwald             // pairing failed if it was ongoing
42471714cbbdSMatthias Ringwald             hci_pairing_complete(conn, ERROR_CODE_REMOTE_USER_TERMINATED_CONNECTION);
42481714cbbdSMatthias Ringwald #endif
4249046ec007SMatthias Ringwald 
4250046ec007SMatthias Ringwald             // emit dedicatd bonding event
4251046ec007SMatthias Ringwald             if (conn->bonding_flags & BONDING_EMIT_COMPLETE_ON_DISCONNECT){
4252046ec007SMatthias Ringwald                 hci_emit_dedicated_bonding_result(conn->address, conn->bonding_status);
4253046ec007SMatthias Ringwald             }
4254046ec007SMatthias Ringwald 
4255459d27b9SMatthias Ringwald             // mark connection for shutdown, stop timers, reset state
4256459d27b9SMatthias Ringwald             conn->state = RECEIVED_DISCONNECTION_COMPLETE;
4257459d27b9SMatthias Ringwald             hci_connection_stop_timer(conn);
4258459d27b9SMatthias Ringwald             hci_connection_init(conn);
4259459d27b9SMatthias Ringwald 
426035454696SMatthias Ringwald #ifdef ENABLE_BLE
4261d70217a2SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
4262046ec007SMatthias Ringwald             // re-enable advertisements for le connections if active
42632b6ab3e6SMatthias Ringwald             if (hci_is_le_connection(conn)){
4264bbc366e6SMatthias Ringwald                 hci_update_advertisements_enabled_for_current_roles();
42659a2e4658SMatthias Ringwald             }
426635454696SMatthias Ringwald #endif
4267d70217a2SMatthias Ringwald #endif
4268ccda6e14S[email protected]             break;
42696772a24cSmatthias.ringwald 
4270c68bdf90Smatthias.ringwald         case HCI_EVENT_HARDWARE_ERROR:
4271313e5f9cSMatthias Ringwald             log_error("Hardware Error: 0x%02x", packet[2]);
4272d23838ecSMatthias Ringwald             if (hci_stack->hardware_error_callback){
4273c2e1fa60SMatthias Ringwald                 (*hci_stack->hardware_error_callback)(packet[2]);
42747586ee35S[email protected]             } else {
42757586ee35S[email protected]                 // if no special requests, just reboot stack
42767586ee35S[email protected]                 hci_power_control_off();
42777586ee35S[email protected]                 hci_power_control_on();
4278c68bdf90Smatthias.ringwald             }
4279c68bdf90Smatthias.ringwald             break;
4280c68bdf90Smatthias.ringwald 
42810e6f3837SMatthias Ringwald #ifdef ENABLE_CLASSIC
42825cf766e8SMatthias Ringwald         case HCI_EVENT_ROLE_CHANGE:
42835cf766e8SMatthias Ringwald             if (packet[2]) break;   // status != 0
4284c4c88f1bSJakob Krantz             reverse_bd_addr(&packet[3], addr);
4285f16129ceSMatthias Ringwald             addr_type = BD_ADDR_TYPE_ACL;
4286c4c88f1bSJakob Krantz             conn = hci_connection_for_bd_addr_and_type(addr, addr_type);
4287c4c88f1bSJakob Krantz             if (!conn) break;
428888f925b1SMatthias Ringwald             conn->role = (hci_role_t) packet[9];
42895cf766e8SMatthias Ringwald             break;
42900e6f3837SMatthias Ringwald #endif
42915cf766e8SMatthias Ringwald 
429263fa3374SMatthias Ringwald         case HCI_EVENT_TRANSPORT_PACKET_SENT:
4293098c2716SMatthias Ringwald             // release packet buffer only for asynchronous transport and if there are not further fragments
42944fa24b5fS[email protected]             if (hci_transport_synchronous()) {
429563fa3374SMatthias Ringwald                 log_error("Synchronous HCI Transport shouldn't send HCI_EVENT_TRANSPORT_PACKET_SENT");
42964fa24b5fS[email protected]                 return; // instead of break: to avoid re-entering hci_run()
42974fa24b5fS[email protected]             }
429881d2bdb2SMatthias Ringwald             hci_stack->acl_fragmentation_tx_active = 0;
4299098c2716SMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
4300098c2716SMatthias Ringwald             hci_stack->iso_fragmentation_tx_active = 0;
4301098c2716SMatthias Ringwald             if (hci_stack->iso_fragmentation_total_size) break;
4302098c2716SMatthias Ringwald #endif
4303d051460cS[email protected]             if (hci_stack->acl_fragmentation_total_size) break;
43045daaa52eSMatthias Ringwald 
43055daaa52eSMatthias Ringwald             // release packet buffer without HCI_EVENT_TRANSPORT_PACKET_SENT (as it will be later)
43065daaa52eSMatthias Ringwald             btstack_assert(hci_stack->hci_packet_buffer_reserved);
43075daaa52eSMatthias Ringwald             hci_stack->hci_packet_buffer_reserved = false;
4308701e3307SMatthias Ringwald 
43095ade6657SMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
43105ade6657SMatthias Ringwald             hci_iso_notify_can_send_now();
43115ade6657SMatthias Ringwald #endif
431263fa3374SMatthias Ringwald             // L2CAP receives this event via the hci_emit_event below
431363fa3374SMatthias Ringwald 
431435454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
431563fa3374SMatthias Ringwald             // For SCO, we do the can_send_now_check here
4316701e3307SMatthias Ringwald             hci_notify_if_sco_can_send_now();
431735454696SMatthias Ringwald #endif
43186b4af23dS[email protected]             break;
43196b4af23dS[email protected] 
432035454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
432163fa3374SMatthias Ringwald         case HCI_EVENT_SCO_CAN_SEND_NOW:
432263fa3374SMatthias Ringwald             // For SCO, we do the can_send_now_check here
43231972f31fSMatthias Ringwald             hci_stack->sco_can_send_now = true;
432463fa3374SMatthias Ringwald             hci_notify_if_sco_can_send_now();
432563fa3374SMatthias Ringwald             return;
43261cfb383eSMatthias Ringwald 
43271cfb383eSMatthias Ringwald         // explode inquriy results for easier consumption
43281cfb383eSMatthias Ringwald         case HCI_EVENT_INQUIRY_RESULT:
43291cfb383eSMatthias Ringwald         case HCI_EVENT_INQUIRY_RESULT_WITH_RSSI:
43301cfb383eSMatthias Ringwald         case HCI_EVENT_EXTENDED_INQUIRY_RESPONSE:
43319784dac1SMatthias Ringwald             gap_inquiry_explode(packet, size);
43321cfb383eSMatthias Ringwald             break;
433335454696SMatthias Ringwald #endif
433463fa3374SMatthias Ringwald 
4335a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE
43365909f7f2Smatthias.ringwald         case HCI_EVENT_LE_META:
43375909f7f2Smatthias.ringwald             switch (packet[2]){
4338d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
433957c9da5bS[email protected]                 case HCI_SUBEVENT_LE_ADVERTISING_REPORT:
43406fab74dbSMatthias Ringwald                     if (!hci_stack->le_scanning_enabled) break;
434157c9da5bS[email protected]                     le_handle_advertisement_report(packet, size);
43427bdc6798S[email protected]                     break;
4343a0698cb4SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
4344a0698cb4SMatthias Ringwald                 case HCI_SUBEVENT_LE_EXTENDED_ADVERTISING_REPORT:
4345a0698cb4SMatthias Ringwald                     if (!hci_stack->le_scanning_enabled) break;
4346a0698cb4SMatthias Ringwald                     le_handle_extended_advertisement_report(packet, size);
4347a0698cb4SMatthias Ringwald                     break;
4348ce56b945SMatthias Ringwald                 case HCI_SUBEVENT_LE_PERIODIC_ADVERTISING_SYNC_ESTABLISHMENT:
4349ce56b945SMatthias Ringwald                     hci_stack->le_periodic_sync_request = LE_CONNECTING_IDLE;
4350ce56b945SMatthias Ringwald                     hci_stack->le_periodic_sync_state = LE_CONNECTING_IDLE;
4351ce56b945SMatthias Ringwald                     break;
435289254d99SMatthias Ringwald                 case HCI_SUBEVENT_LE_ADVERTISING_SET_TERMINATED:
435389254d99SMatthias Ringwald                     advertising_handle = hci_subevent_le_advertising_set_terminated_get_advertising_handle(packet);
435489254d99SMatthias Ringwald                     btstack_linked_list_iterator_init(&it, &hci_stack->le_advertising_sets);
435589254d99SMatthias Ringwald                     while (btstack_linked_list_iterator_has_next(&it)) {
435689254d99SMatthias Ringwald                         le_advertising_set_t *advertising_set = (le_advertising_set_t *) btstack_linked_list_iterator_next(&it);
435789254d99SMatthias Ringwald                         if (advertising_set->advertising_handle == advertising_handle){
435889254d99SMatthias Ringwald                             advertising_set->state &= ~(LE_ADVERTISEMENT_STATE_ACTIVE | LE_ADVERTISEMENT_STATE_ENABLED);
435989254d99SMatthias Ringwald                         }
436089254d99SMatthias Ringwald                     }
436189254d99SMatthias Ringwald                     break;
4362a0698cb4SMatthias Ringwald #endif
4363d70217a2SMatthias Ringwald #endif
43645909f7f2Smatthias.ringwald                 case HCI_SUBEVENT_LE_CONNECTION_COMPLETE:
436560fb273dSMatthias Ringwald                 case HCI_SUBEVENT_LE_ENHANCED_CONNECTION_COMPLETE_V1:
436660fb273dSMatthias Ringwald                 case HCI_SUBEVENT_LE_ENHANCED_CONNECTION_COMPLETE_V2:
4367688bcdb4SMatthias Ringwald                     hci_handle_le_connection_complete_event(packet);
43685909f7f2Smatthias.ringwald                     break;
43695909f7f2Smatthias.ringwald 
4370f8fbdce0SMatthias Ringwald                 // log_info("LE buffer size: %u, count %u", little_endian_read_16(packet,6), packet[8]);
4371c9db5c21SMilanka Ringwald                 case HCI_SUBEVENT_LE_CONNECTION_UPDATE_COMPLETE:
4372c9db5c21SMilanka Ringwald                     handle = hci_subevent_le_connection_update_complete_get_connection_handle(packet);
4373c9db5c21SMilanka Ringwald                     conn = hci_connection_for_handle(handle);
4374c9db5c21SMilanka Ringwald                     if (!conn) break;
4375c9db5c21SMilanka Ringwald                     conn->le_connection_interval = hci_subevent_le_connection_update_complete_get_conn_interval(packet);
4376c9db5c21SMilanka Ringwald                     break;
437765a46ef3S[email protected] 
437873cd8a2aSMatthias Ringwald                 case HCI_SUBEVENT_LE_REMOTE_CONNECTION_PARAMETER_REQUEST:
437973cd8a2aSMatthias Ringwald                     // connection
438073cd8a2aSMatthias Ringwald                     handle = hci_subevent_le_remote_connection_parameter_request_get_connection_handle(packet);
438173cd8a2aSMatthias Ringwald                     conn = hci_connection_for_handle(handle);
438273cd8a2aSMatthias Ringwald                     if (conn) {
438373cd8a2aSMatthias Ringwald                         // read arguments
438473cd8a2aSMatthias Ringwald                         uint16_t le_conn_interval_min   = hci_subevent_le_remote_connection_parameter_request_get_interval_min(packet);
438573cd8a2aSMatthias Ringwald                         uint16_t le_conn_interval_max   = hci_subevent_le_remote_connection_parameter_request_get_interval_max(packet);
438673cd8a2aSMatthias Ringwald                         uint16_t le_conn_latency        = hci_subevent_le_remote_connection_parameter_request_get_latency(packet);
438773cd8a2aSMatthias Ringwald                         uint16_t le_supervision_timeout = hci_subevent_le_remote_connection_parameter_request_get_timeout(packet);
438873cd8a2aSMatthias Ringwald 
438973cd8a2aSMatthias Ringwald                         // validate against current connection parameter range
439073cd8a2aSMatthias Ringwald                         le_connection_parameter_range_t existing_range;
439173cd8a2aSMatthias Ringwald                         gap_get_connection_parameter_range(&existing_range);
439273cd8a2aSMatthias Ringwald                         int update_parameter = gap_connection_parameter_range_included(&existing_range, le_conn_interval_min, le_conn_interval_max, le_conn_latency, le_supervision_timeout);
439373cd8a2aSMatthias Ringwald                         if (update_parameter){
439473cd8a2aSMatthias Ringwald                             conn->le_con_parameter_update_state = CON_PARAMETER_UPDATE_REPLY;
439573cd8a2aSMatthias Ringwald                             conn->le_conn_interval_min = le_conn_interval_min;
439673cd8a2aSMatthias Ringwald                             conn->le_conn_interval_max = le_conn_interval_max;
439773cd8a2aSMatthias Ringwald                             conn->le_conn_latency = le_conn_latency;
439873cd8a2aSMatthias Ringwald                             conn->le_supervision_timeout = le_supervision_timeout;
439973cd8a2aSMatthias Ringwald                         } else {
4400c3898ca4SMatthias Ringwald                             conn->le_con_parameter_update_state = CON_PARAMETER_UPDATE_NEGATIVE_REPLY;
440173cd8a2aSMatthias Ringwald                         }
440273cd8a2aSMatthias Ringwald                     }
440373cd8a2aSMatthias Ringwald                     break;
44040f3b27c5SMatthias Ringwald #ifdef ENABLE_LE_LIMIT_ACL_FRAGMENT_BY_MAX_OCTETS
44050f3b27c5SMatthias Ringwald                 case HCI_SUBEVENT_LE_DATA_LENGTH_CHANGE:
44060f3b27c5SMatthias Ringwald                     handle = hci_subevent_le_data_length_change_get_connection_handle(packet);
44070f3b27c5SMatthias Ringwald                     conn = hci_connection_for_handle(handle);
44080f3b27c5SMatthias Ringwald                     if (conn) {
44090f3b27c5SMatthias Ringwald                         conn->le_max_tx_octets = hci_subevent_le_data_length_change_get_max_tx_octets(packet);
44100f3b27c5SMatthias Ringwald                     }
44110f3b27c5SMatthias Ringwald                     break;
44120f3b27c5SMatthias Ringwald #endif
44134ae8623eSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
44146fd1d2c8SMatthias Ringwald                 case HCI_SUBEVENT_LE_CIS_REQUEST:
44156fd1d2c8SMatthias Ringwald                     // incoming CIS request, allocate iso stream object and cache metadata
44166fd1d2c8SMatthias Ringwald                     iso_stream = hci_iso_stream_create(HCI_ISO_TYPE_CIS, HCI_ISO_STREAM_W4_USER,
44176fd1d2c8SMatthias Ringwald                                                        hci_subevent_le_cis_request_get_cig_id(packet),
44186fd1d2c8SMatthias Ringwald                                                        hci_subevent_le_cis_request_get_cis_id(packet));
44196fd1d2c8SMatthias Ringwald                     // if there's no memory, gap_cis_accept/gap_cis_reject will fail
44206fd1d2c8SMatthias Ringwald                     if (iso_stream != NULL){
44216fd1d2c8SMatthias Ringwald                         iso_stream->cis_handle = hci_subevent_le_cis_request_get_cis_connection_handle(packet);
44226fd1d2c8SMatthias Ringwald                         iso_stream->acl_handle = hci_subevent_le_cis_request_get_acl_connection_handle(packet);
44236fd1d2c8SMatthias Ringwald                     }
44246fd1d2c8SMatthias Ringwald                     break;
44254ae8623eSMatthias Ringwald                 case HCI_SUBEVENT_LE_CIS_ESTABLISHED:
44268e58e4f7SMatthias Ringwald                     if (hci_stack->iso_active_operation_type == HCI_ISO_TYPE_CIS){
44274ae8623eSMatthias Ringwald                         handle = hci_subevent_le_cis_established_get_connection_handle(packet);
44284ae8623eSMatthias Ringwald                         uint8_t status = hci_subevent_le_cis_established_get_status(packet);
44298e58e4f7SMatthias Ringwald                         iso_stream = hci_iso_stream_for_con_handle(handle);
44308e58e4f7SMatthias Ringwald                         btstack_assert(iso_stream != NULL);
44317dd97f73SMatthias Ringwald                         // track connection info
44327dd97f73SMatthias Ringwald                         iso_stream->number_of_subevents  = hci_subevent_le_cis_established_get_nse(packet);
44337dd97f73SMatthias Ringwald                         iso_stream->burst_number_c_to_p  = hci_subevent_le_cis_established_get_bn_c_to_p(packet);
44347dd97f73SMatthias Ringwald                         iso_stream->burst_number_p_to_c  = hci_subevent_le_cis_established_get_bn_p_to_c(packet);
44357dd97f73SMatthias Ringwald                         iso_stream->flush_timeout_c_to_p = hci_subevent_le_cis_established_get_ft_c_to_p(packet);
44367dd97f73SMatthias Ringwald                         iso_stream->flush_timeout_p_to_c = hci_subevent_le_cis_established_get_ft_p_to_c(packet);
443726b93350SMatthias Ringwald                         iso_stream->max_sdu_c_to_p       = hci_subevent_le_cis_established_get_max_pdu_c_to_p(packet);
443826b93350SMatthias Ringwald                         iso_stream->max_sdu_p_to_c       = hci_subevent_le_cis_established_get_max_pdu_p_to_c(packet);
44397dd97f73SMatthias Ringwald                         iso_stream->iso_interval_1250us  = hci_subevent_le_cis_established_get_iso_interval(packet);
444026b93350SMatthias Ringwald                         if (hci_stack->iso_active_operation_group_id == HCI_ISO_GROUP_ID_SINGLE_CIS){
444126b93350SMatthias Ringwald                             // CIS Accept by Peripheral
444226b93350SMatthias Ringwald                             if (status == ERROR_CODE_SUCCESS){
444326b93350SMatthias Ringwald                                 if (iso_stream->max_sdu_p_to_c > 0){
444426b93350SMatthias Ringwald                                     // we're peripheral and we will send data
444526b93350SMatthias Ringwald                                     iso_stream->state = HCI_ISO_STREAM_STATE_W2_SETUP_ISO_INPUT;
444626b93350SMatthias Ringwald                                 } else {
444726b93350SMatthias Ringwald                                     // we're peripheral and we will only receive data
444826b93350SMatthias Ringwald                                     iso_stream->state = HCI_ISO_STREAM_STATE_W2_SETUP_ISO_OUTPUT;
444926b93350SMatthias Ringwald                                 }
445026b93350SMatthias Ringwald                             } else {
445114045fdbSMatthias Ringwald                                 hci_cis_handle_created(iso_stream, status);
445226b93350SMatthias Ringwald                             }
445326b93350SMatthias Ringwald                             hci_stack->iso_active_operation_type = HCI_ISO_TYPE_INVALID;
445426b93350SMatthias Ringwald                         } else {
445526b93350SMatthias Ringwald                             // CIG Setup by Central
445626b93350SMatthias Ringwald                             le_audio_cig_t * cig = hci_cig_for_id(hci_stack->iso_active_operation_group_id);
445726b93350SMatthias Ringwald                             btstack_assert(cig != NULL);
445826b93350SMatthias Ringwald                             // update iso stream state
44594ae8623eSMatthias Ringwald                             if (status == ERROR_CODE_SUCCESS){
44604ae8623eSMatthias Ringwald                                 iso_stream->state = HCI_ISO_STREAM_STATE_ESTABLISHED;
44614ae8623eSMatthias Ringwald                             } else {
44628e58e4f7SMatthias Ringwald                                 iso_stream->state = HCI_ISO_STREAM_STATE_IDLE;
44634ae8623eSMatthias Ringwald                             }
44648e58e4f7SMatthias Ringwald                             // update cig state
4465f06bb90fSMatthias Ringwald                             uint8_t i;
4466f06bb90fSMatthias Ringwald                             for (i=0;i<cig->num_cis;i++){
4467f06bb90fSMatthias Ringwald                                 if (cig->cis_con_handles[i] == handle){
44683abcd16cSMatthias Ringwald                                     cig->cis_setup_active[i] = false;
4469f9306a1aSMatthias Ringwald                                     if (status == ERROR_CODE_SUCCESS){
4470f9306a1aSMatthias Ringwald                                         cig->cis_established[i] = true;
4471f9306a1aSMatthias Ringwald                                     } else {
447214045fdbSMatthias Ringwald                                         hci_cis_handle_created(iso_stream, status);
4473f06bb90fSMatthias Ringwald                                     }
4474f06bb90fSMatthias Ringwald                                 }
4475f06bb90fSMatthias Ringwald                             }
44768e58e4f7SMatthias Ringwald 
44778e58e4f7SMatthias Ringwald                             // trigger iso path setup if complete
44780f0ba168SMatthias Ringwald                             bool cis_setup_active = false;
4479f9306a1aSMatthias Ringwald                             for (i=0;i<cig->num_cis;i++){
44800f0ba168SMatthias Ringwald                                 cis_setup_active |= cig->cis_setup_active[i];
4481f9306a1aSMatthias Ringwald                             }
44820f0ba168SMatthias Ringwald                             if (cis_setup_active == false){
4483f9306a1aSMatthias Ringwald                                 cig->state_vars.next_cis = 0;
4484f9306a1aSMatthias Ringwald                                 cig->state = LE_AUDIO_CIG_STATE_SETUP_ISO_PATH;
448526b93350SMatthias Ringwald                                 hci_stack->iso_active_operation_type = HCI_ISO_TYPE_INVALID;
448626b93350SMatthias Ringwald                             }
4487f06bb90fSMatthias Ringwald                         }
44884ae8623eSMatthias Ringwald                     }
44897aa35f6aSMatthias Ringwald                     break;
44907aa35f6aSMatthias Ringwald                 case HCI_SUBEVENT_LE_CREATE_BIG_COMPLETE:
449126b93350SMatthias Ringwald                     hci_stack->iso_active_operation_type = HCI_ISO_TYPE_INVALID;
44927aa35f6aSMatthias Ringwald                     big = hci_big_for_handle(packet[4]);
44937aa35f6aSMatthias Ringwald                     if (big != NULL){
44947aa35f6aSMatthias Ringwald                         uint8_t status = packet[3];
44957aa35f6aSMatthias Ringwald                         if (status == ERROR_CODE_SUCCESS){
44967aa35f6aSMatthias Ringwald                             // store bis_con_handles and trigger iso path setup
44975fd415a6SMatthias Ringwald                             uint8_t num_bis = btstack_min(big->num_bis, packet[20]);
44987aa35f6aSMatthias Ringwald                             uint8_t i;
44997aa35f6aSMatthias Ringwald                             for (i=0;i<num_bis;i++){
4500fb16346aSMatthias Ringwald                                 hci_con_handle_t bis_handle = (hci_con_handle_t) little_endian_read_16(packet, 21 + (2 * i));
4501fb16346aSMatthias Ringwald                                 big->bis_con_handles[i] = bis_handle;
4502fb16346aSMatthias Ringwald                                 // assign bis handle
4503fb16346aSMatthias Ringwald                                 btstack_linked_list_iterator_t it;
4504fb16346aSMatthias Ringwald                                 btstack_linked_list_iterator_init(&it, &hci_stack->iso_streams);
4505fb16346aSMatthias Ringwald                                 while (btstack_linked_list_iterator_has_next(&it)){
4506fb16346aSMatthias Ringwald                                     hci_iso_stream_t * iso_stream = (hci_iso_stream_t *) btstack_linked_list_iterator_next(&it);
4507fb16346aSMatthias Ringwald                                     if ((iso_stream->state == HCI_ISO_STREAM_STATE_REQUESTED ) &&
45088d72db10SMatthias Ringwald                                         (iso_stream->group_id == big->big_handle)){
4509969d876aSMatthias Ringwald                                         iso_stream->cis_handle = bis_handle;
4510fb16346aSMatthias Ringwald                                         iso_stream->state = HCI_ISO_STREAM_STATE_ESTABLISHED;
4511cd1139aaSMatthias Ringwald                                         break;
4512fb16346aSMatthias Ringwald                                     }
4513fb16346aSMatthias Ringwald                                 }
45147aa35f6aSMatthias Ringwald                             }
45152a6c0f82SMatthias Ringwald                             if (big->state == LE_AUDIO_BIG_STATE_W4_ESTABLISHED) {
45167aa35f6aSMatthias Ringwald                                 big->state = LE_AUDIO_BIG_STATE_SETUP_ISO_PATH;
45177aa35f6aSMatthias Ringwald                                 big->state_vars.next_bis = 0;
45182a6c0f82SMatthias Ringwald                             }
45197aa35f6aSMatthias Ringwald                         } else {
45202a6c0f82SMatthias Ringwald                             // create BIG failed or has been stopped by us
4521778463d0SMatthias Ringwald                             hci_iso_stream_finalize_by_type_and_group_id(HCI_ISO_TYPE_BIS, big->big_handle);
45227aa35f6aSMatthias Ringwald                             btstack_linked_list_remove(&hci_stack->le_audio_bigs, (btstack_linked_item_t *) big);
45232a6c0f82SMatthias Ringwald                             if (big->state == LE_AUDIO_BIG_STATE_W4_ESTABLISHED){
45247aa35f6aSMatthias Ringwald                                 hci_emit_big_created(big, status);
45252a6c0f82SMatthias Ringwald                             } else {
45262a6c0f82SMatthias Ringwald                                 hci_emit_big_terminated(big);
45272a6c0f82SMatthias Ringwald                             }
45287aa35f6aSMatthias Ringwald                         }
45297aa35f6aSMatthias Ringwald                     }
45307aa35f6aSMatthias Ringwald                     break;
45317aa35f6aSMatthias Ringwald                 case HCI_SUBEVENT_LE_TERMINATE_BIG_COMPLETE:
4532c45ca112SMatthias Ringwald                     hci_stack->iso_active_operation_type = HCI_ISO_TYPE_INVALID;
45337aa35f6aSMatthias Ringwald                     big = hci_big_for_handle(hci_subevent_le_terminate_big_complete_get_big_handle(packet));
45347aa35f6aSMatthias Ringwald                     if (big != NULL){
4535fb16346aSMatthias Ringwald                         // finalize associated ISO streams
4536fb16346aSMatthias Ringwald                         btstack_linked_list_iterator_t it;
4537fb16346aSMatthias Ringwald                         btstack_linked_list_iterator_init(&it, &hci_stack->iso_streams);
4538fb16346aSMatthias Ringwald                         while (btstack_linked_list_iterator_has_next(&it)){
4539fb16346aSMatthias Ringwald                             hci_iso_stream_t * iso_stream = (hci_iso_stream_t *) btstack_linked_list_iterator_next(&it);
45408d72db10SMatthias Ringwald                             if (iso_stream->group_id == big->big_handle){
4541969d876aSMatthias Ringwald                                 log_info("BIG Terminated, big_handle 0x%02x, con handle 0x%04x", iso_stream->group_id, iso_stream->cis_handle);
4542fb16346aSMatthias Ringwald                                 btstack_linked_list_iterator_remove(&it);
4543fb16346aSMatthias Ringwald                                 btstack_memory_hci_iso_stream_free(iso_stream);
4544fb16346aSMatthias Ringwald                             }
4545fb16346aSMatthias Ringwald                         }
45467aa35f6aSMatthias Ringwald                         btstack_linked_list_remove(&hci_stack->le_audio_bigs, (btstack_linked_item_t *) big);
45477aa35f6aSMatthias Ringwald                         switch (big->state){
45487aa35f6aSMatthias Ringwald                             case LE_AUDIO_BIG_STATE_W4_TERMINATED_AFTER_SETUP_FAILED:
45497aa35f6aSMatthias Ringwald                                 hci_emit_big_created(big, big->state_vars.status);
45507aa35f6aSMatthias Ringwald                                 break;
45517aa35f6aSMatthias Ringwald                             default:
45527aa35f6aSMatthias Ringwald                                 hci_emit_big_terminated(big);
45537aa35f6aSMatthias Ringwald                                 break;
45547aa35f6aSMatthias Ringwald                         }
45557aa35f6aSMatthias Ringwald                     }
45567aa35f6aSMatthias Ringwald                     break;
45572a6c0f82SMatthias Ringwald                 case HCI_SUBEVENT_LE_BIG_SYNC_ESTABLISHED:
4558c45ca112SMatthias Ringwald                     hci_stack->iso_active_operation_type = HCI_ISO_TYPE_INVALID;
45592a6c0f82SMatthias Ringwald                     big_sync = hci_big_sync_for_handle(packet[4]);
45602a6c0f82SMatthias Ringwald                     if (big_sync != NULL){
45612a6c0f82SMatthias Ringwald                         uint8_t status = packet[3];
45628282d308SMatthias Ringwald                         uint8_t big_handle = packet[4];
45632a6c0f82SMatthias Ringwald                         if (status == ERROR_CODE_SUCCESS){
45642a6c0f82SMatthias Ringwald                             // store bis_con_handles and trigger iso path setup
45655fd415a6SMatthias Ringwald                             uint8_t num_bis = btstack_min(big_sync->num_bis, packet[16]);
45668282d308SMatthias Ringwald                             uint8_t i;
45672a6c0f82SMatthias Ringwald                             for (i=0;i<num_bis;i++){
456802e19895SMatthias Ringwald                                 hci_con_handle_t bis_handle = little_endian_read_16(packet, 17 + (2 * i));
456902e19895SMatthias Ringwald                                 big_sync->bis_con_handles[i] = bis_handle;
457002e19895SMatthias Ringwald                                 // setup iso_stream_t
457102e19895SMatthias Ringwald                                 btstack_linked_list_iterator_t it;
457202e19895SMatthias Ringwald                                 btstack_linked_list_iterator_init(&it, &hci_stack->iso_streams);
457302e19895SMatthias Ringwald                                 while (btstack_linked_list_iterator_has_next(&it)){
457402e19895SMatthias Ringwald                                     hci_iso_stream_t * iso_stream = (hci_iso_stream_t *) btstack_linked_list_iterator_next(&it);
457502e19895SMatthias Ringwald                                     if ((iso_stream->state == HCI_ISO_STREAM_STATE_REQUESTED ) &&
457602e19895SMatthias Ringwald                                         (iso_stream->group_id == big_sync->big_handle)){
457702e19895SMatthias Ringwald                                         iso_stream->cis_handle = bis_handle;
457802e19895SMatthias Ringwald                                         iso_stream->state = HCI_ISO_STREAM_STATE_ESTABLISHED;
457902e19895SMatthias Ringwald                                         break;
458002e19895SMatthias Ringwald                                     }
458102e19895SMatthias Ringwald                                 }
45822a6c0f82SMatthias Ringwald                             }
45832a6c0f82SMatthias Ringwald                             if (big_sync->state == LE_AUDIO_BIG_STATE_W4_ESTABLISHED) {
45842a6c0f82SMatthias Ringwald                                 // trigger iso path setup
45852a6c0f82SMatthias Ringwald                                 big_sync->state = LE_AUDIO_BIG_STATE_SETUP_ISO_PATH;
45862a6c0f82SMatthias Ringwald                                 big_sync->state_vars.next_bis = 0;
45872a6c0f82SMatthias Ringwald                             }
45882a6c0f82SMatthias Ringwald                         } else {
45892a6c0f82SMatthias Ringwald                             // create BIG Sync failed or has been stopped by us
45902a6c0f82SMatthias Ringwald                             btstack_linked_list_remove(&hci_stack->le_audio_big_syncs, (btstack_linked_item_t *) big_sync);
45912a6c0f82SMatthias Ringwald                             if (big_sync->state == LE_AUDIO_BIG_STATE_W4_ESTABLISHED) {
45922a6c0f82SMatthias Ringwald                                 hci_emit_big_sync_created(big_sync, status);
45932a6c0f82SMatthias Ringwald                             } else {
4594d04a9afcSMatthias Ringwald                                 hci_emit_big_sync_stopped(big_handle);
45952a6c0f82SMatthias Ringwald                             }
45962a6c0f82SMatthias Ringwald                         }
45972a6c0f82SMatthias Ringwald                     }
45982a6c0f82SMatthias Ringwald                     break;
45992a6c0f82SMatthias Ringwald                 case HCI_SUBEVENT_LE_BIG_SYNC_LOST:
4600c45ca112SMatthias Ringwald                     hci_stack->iso_active_operation_type = HCI_ISO_TYPE_INVALID;
46012a6c0f82SMatthias Ringwald                     big_sync = hci_big_sync_for_handle(packet[4]);
46022a6c0f82SMatthias Ringwald                     if (big_sync != NULL){
4603d04a9afcSMatthias Ringwald                         uint8_t big_handle = packet[4];
46042a6c0f82SMatthias Ringwald                         btstack_linked_list_remove(&hci_stack->le_audio_big_syncs, (btstack_linked_item_t *) big_sync);
4605d04a9afcSMatthias Ringwald                         hci_emit_big_sync_stopped(big_handle);
46062a6c0f82SMatthias Ringwald                     }
46072a6c0f82SMatthias Ringwald                     break;
46084ae8623eSMatthias Ringwald #endif
46095909f7f2Smatthias.ringwald                 default:
46105909f7f2Smatthias.ringwald                     break;
46115909f7f2Smatthias.ringwald             }
46125909f7f2Smatthias.ringwald             break;
46135909f7f2Smatthias.ringwald #endif
46140b36101dSMatthias Ringwald         case HCI_EVENT_VENDOR_SPECIFIC:
46150b36101dSMatthias Ringwald             // Vendor specific commands often create vendor specific event instead of num completed packets
46160b36101dSMatthias Ringwald             // To avoid getting stuck as num_cmds_packets is zero, reset it to 1 for controllers with this behaviour
46170b36101dSMatthias Ringwald             switch (hci_stack->manufacturer){
46180b36101dSMatthias Ringwald                 case BLUETOOTH_COMPANY_ID_CAMBRIDGE_SILICON_RADIO:
46190b36101dSMatthias Ringwald                     hci_stack->num_cmd_packets = 1;
46200b36101dSMatthias Ringwald                     break;
46210b36101dSMatthias Ringwald                 default:
46220b36101dSMatthias Ringwald                     break;
46230b36101dSMatthias Ringwald             }
46240b36101dSMatthias Ringwald             break;
46256772a24cSmatthias.ringwald         default:
46266772a24cSmatthias.ringwald             break;
4627fe1ed1b8Smatthias.ringwald     }
4628fe1ed1b8Smatthias.ringwald 
462967c6c9dcSMatthias Ringwald     handle_event_for_current_stack_state(packet, size);
463089db417bSmatthias.ringwald 
463186805605S[email protected]     // notify upper stack
4632d6b06661SMatthias Ringwald 	hci_emit_event(packet, size, 0);   // don't dump, already happened in packet handler
463394ab26f8Smatthias.ringwald 
463486805605S[email protected]     // moved here to give upper stack a chance to close down everything with hci_connection_t intact
4635797b2a3fSMatthias Ringwald     if ((hci_event_packet_get_type(packet) == HCI_EVENT_DISCONNECTION_COMPLETE) && (packet[2] == 0)){
4636f8fbdce0SMatthias Ringwald 		handle = little_endian_read_16(packet, 3);
463705ae8de3SMatthias Ringwald 		hci_connection_t * aConn = hci_connection_for_handle(handle);
4638046ec007SMatthias Ringwald 		// discard connection if app did not trigger a reconnect in the event handler
4639797b2a3fSMatthias Ringwald 		if (aConn && aConn->state == RECEIVED_DISCONNECTION_COMPLETE){
464005ae8de3SMatthias Ringwald 			hci_shutdown_connection(aConn);
4641b0136355SMatthias Ringwald 		}
46428ad9cf99SMatthias Ringwald #ifdef ENABLE_CONTROLLER_DUMP_PACKETS
46438ad9cf99SMatthias Ringwald         hci_controller_dump_packets();
46448ad9cf99SMatthias Ringwald #endif
464586805605S[email protected]     }
464686805605S[email protected] 
464794ab26f8Smatthias.ringwald 	// execute main loop
464894ab26f8Smatthias.ringwald 	hci_run();
464916833f0aSmatthias.ringwald }
465016833f0aSmatthias.ringwald 
465135454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
46526f28d2eeSMatthias Ringwald 
4653c91d150bS[email protected] static void sco_handler(uint8_t * packet, uint16_t size){
46540b3f95dfSMatthias Ringwald     // lookup connection struct
46552b838201SMatthias Ringwald     hci_con_handle_t con_handle = READ_SCO_CONNECTION_HANDLE(packet);
46562b838201SMatthias Ringwald     hci_connection_t * conn     = hci_connection_for_handle(con_handle);
46570b3f95dfSMatthias Ringwald     if (!conn) return;
46580b3f95dfSMatthias Ringwald 
46596be3cf7fSMatthias Ringwald #ifdef ENABLE_SCO_OVER_HCI
4660760b20efSMatthias Ringwald     // CSR 8811 prefixes 60 byte SCO packet in transparent mode with 20 zero bytes -> skip first 20 payload bytes
4661760b20efSMatthias Ringwald     if (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_CAMBRIDGE_SILICON_RADIO){
4662a1df452eSMatthias Ringwald         if ((size == 83) && ((hci_stack->sco_voice_setting_active & 0x03) == 0x03)){
4663760b20efSMatthias Ringwald             packet[2] = 0x3c;
4664760b20efSMatthias Ringwald             memmove(&packet[3], &packet[23], 63);
4665760b20efSMatthias Ringwald             size = 63;
46660b3f95dfSMatthias Ringwald         }
46670b3f95dfSMatthias Ringwald     }
4668760b20efSMatthias Ringwald 
4669f234b250SMatthias Ringwald     if (hci_have_usb_transport()){
4670f234b250SMatthias Ringwald         // Nothing to do
4671f234b250SMatthias Ringwald     } else {
467249205f5dSMatthias Ringwald         // log_debug("sco flow %u, handle 0x%04x, packets sent %u, bytes send %u", hci_stack->synchronous_flow_control_enabled, (int) con_handle, conn->num_packets_sent, conn->num_sco_bytes_sent);
4673760b20efSMatthias Ringwald         if (hci_stack->synchronous_flow_control_enabled == 0){
4674fa7f2dfdSMatthias Ringwald             // ignore received SCO packets for the first 10 ms, then allow for max two HCI_SCO_2EV3_SIZE packets
4675b1202089SMatthias Ringwald             uint8_t max_sco_packets = (uint8_t) btstack_min(2 * HCI_SCO_2EV3_SIZE / conn->sco_payload_length, hci_stack->sco_packets_total_num);
4676fa7f2dfdSMatthias Ringwald             if (conn->sco_tx_active == 0){
4677fa7f2dfdSMatthias Ringwald                 if (btstack_time_delta(btstack_run_loop_get_time_ms(), conn->sco_established_ms) > 10){
4678fa7f2dfdSMatthias Ringwald                     conn->sco_tx_active = 1;
4679fa7f2dfdSMatthias Ringwald                     conn->sco_tx_ready = max_sco_packets;
4680fa7f2dfdSMatthias Ringwald                     log_info("Start SCO sending, %u packets", conn->sco_tx_ready);
4681fa7f2dfdSMatthias Ringwald                     hci_notify_if_sco_can_send_now();
468259c33575SMatthias Ringwald                 }
468359c33575SMatthias Ringwald             } else {
4684fa7f2dfdSMatthias Ringwald                 if (conn->sco_tx_ready < max_sco_packets){
4685fa7f2dfdSMatthias Ringwald                     conn->sco_tx_ready++;
468659c33575SMatthias Ringwald                 }
4687fa7f2dfdSMatthias Ringwald                 hci_notify_if_sco_can_send_now();
46886f28d2eeSMatthias Ringwald             }
4689760b20efSMatthias Ringwald         }
4690f234b250SMatthias Ringwald     }
46916be3cf7fSMatthias Ringwald #endif
46926be3cf7fSMatthias Ringwald 
46930b3f95dfSMatthias Ringwald     // deliver to app
46940b3f95dfSMatthias Ringwald     if (hci_stack->sco_packet_handler) {
46950b3f95dfSMatthias Ringwald         hci_stack->sco_packet_handler(HCI_SCO_DATA_PACKET, 0, packet, size);
46960b3f95dfSMatthias Ringwald     }
46970b3f95dfSMatthias Ringwald 
4698ed325439SMatthias Ringwald #ifdef HAVE_SCO_TRANSPORT
4699ed325439SMatthias Ringwald     // We can send one packet for each received packet
4700ed325439SMatthias Ringwald     conn->sco_tx_ready++;
4701ed325439SMatthias Ringwald     hci_notify_if_sco_can_send_now();
4702ed325439SMatthias Ringwald #endif
4703ed325439SMatthias Ringwald 
47040b3f95dfSMatthias Ringwald #ifdef ENABLE_HCI_CONTROLLER_TO_HOST_FLOW_CONTROL
47052b838201SMatthias Ringwald     conn->num_packets_completed++;
47062b838201SMatthias Ringwald     hci_stack->host_completed_packets = 1;
47072b838201SMatthias Ringwald     hci_run();
47082b838201SMatthias Ringwald #endif
4709c91d150bS[email protected] }
471035454696SMatthias Ringwald #endif
4711c91d150bS[email protected] 
47120a57e69fSmatthias.ringwald static void packet_handler(uint8_t packet_type, uint8_t *packet, uint16_t size){
47134248f37eSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
47144248f37eSMatthias Ringwald     // propagate ISO packets received as ACL
4715062276f9SMatthias Ringwald     hci_iso_stream_t * iso_stream = NULL;
47164248f37eSMatthias Ringwald     if ((packet_type == HCI_ACL_DATA_PACKET) && (size >= HCI_ACL_HEADER_SIZE)){
47174248f37eSMatthias Ringwald         hci_con_handle_t con_handle = READ_ACL_CONNECTION_HANDLE(packet);
47184248f37eSMatthias Ringwald         iso_stream = hci_iso_stream_for_con_handle(con_handle);
47194248f37eSMatthias Ringwald         if (iso_stream != NULL){
47204248f37eSMatthias Ringwald             packet_type = HCI_ISO_DATA_PACKET;
47214248f37eSMatthias Ringwald         }
47224248f37eSMatthias Ringwald     }
47234248f37eSMatthias Ringwald #endif
47244248f37eSMatthias Ringwald 
47255bb5bc3eS[email protected]     hci_dump_packet(packet_type, 1, packet, size);
472610e830c9Smatthias.ringwald     switch (packet_type) {
472710e830c9Smatthias.ringwald         case HCI_EVENT_PACKET:
472810e830c9Smatthias.ringwald             event_handler(packet, size);
472910e830c9Smatthias.ringwald             break;
473010e830c9Smatthias.ringwald         case HCI_ACL_DATA_PACKET:
473110e830c9Smatthias.ringwald             acl_handler(packet, size);
473210e830c9Smatthias.ringwald             break;
473335454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
4734c91d150bS[email protected]         case HCI_SCO_DATA_PACKET:
4735c91d150bS[email protected]             sco_handler(packet, size);
4736202c8a4cSMatthias Ringwald             break;
473735454696SMatthias Ringwald #endif
47380a8cccd5SMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
47395027c498SMatthias Ringwald         case HCI_ISO_DATA_PACKET:
4740750818acSMatthias Ringwald             if ((iso_stream == NULL) && (size >= HCI_ISO_HEADER_SIZE)){
4741750818acSMatthias Ringwald                 hci_con_handle_t con_handle = READ_ISO_CONNECTION_HANDLE(packet);
4742750818acSMatthias Ringwald                 iso_stream = hci_iso_stream_for_con_handle(con_handle);
4743750818acSMatthias Ringwald             }
4744750818acSMatthias Ringwald             hci_iso_packet_handler(iso_stream, packet, size);
47455027c498SMatthias Ringwald             break;
47465027c498SMatthias Ringwald #endif
474710e830c9Smatthias.ringwald         default:
474810e830c9Smatthias.ringwald             break;
474910e830c9Smatthias.ringwald     }
475010e830c9Smatthias.ringwald }
475110e830c9Smatthias.ringwald 
4752d6b06661SMatthias Ringwald /**
4753d6b06661SMatthias Ringwald  * @brief Add event packet handler.
4754d6b06661SMatthias Ringwald  */
4755d6b06661SMatthias Ringwald void hci_add_event_handler(btstack_packet_callback_registration_t * callback_handler){
4756d6b06661SMatthias Ringwald     btstack_linked_list_add_tail(&hci_stack->event_handlers, (btstack_linked_item_t*) callback_handler);
4757d6b06661SMatthias Ringwald }
4758d6b06661SMatthias Ringwald 
475967f708e0SMatthias Ringwald /**
476067f708e0SMatthias Ringwald  * @brief Remove event packet handler.
476167f708e0SMatthias Ringwald  */
476267f708e0SMatthias Ringwald void hci_remove_event_handler(btstack_packet_callback_registration_t * callback_handler){
476367f708e0SMatthias Ringwald     btstack_linked_list_remove(&hci_stack->event_handlers, (btstack_linked_item_t*) callback_handler);
476467f708e0SMatthias Ringwald }
4765d6b06661SMatthias Ringwald 
4766fcadd0caSmatthias.ringwald /** Register HCI packet handlers */
47673d50b4baSMatthias Ringwald void hci_register_acl_packet_handler(btstack_packet_handler_t handler){
4768fb37a842SMatthias Ringwald     hci_stack->acl_packet_handler = handler;
476916833f0aSmatthias.ringwald }
477016833f0aSmatthias.ringwald 
477135454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
47728abbe8b5SMatthias Ringwald /**
47738abbe8b5SMatthias Ringwald  * @brief Registers a packet handler for SCO data. Used for HSP and HFP profiles.
47748abbe8b5SMatthias Ringwald  */
47753d50b4baSMatthias Ringwald void hci_register_sco_packet_handler(btstack_packet_handler_t handler){
47768abbe8b5SMatthias Ringwald     hci_stack->sco_packet_handler = handler;
47778abbe8b5SMatthias Ringwald }
477835454696SMatthias Ringwald #endif
47798abbe8b5SMatthias Ringwald 
47800a8cccd5SMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
47815027c498SMatthias Ringwald void hci_register_iso_packet_handler(btstack_packet_handler_t handler){
47825027c498SMatthias Ringwald     hci_stack->iso_packet_handler = handler;
47835027c498SMatthias Ringwald }
47845027c498SMatthias Ringwald #endif
47855027c498SMatthias Ringwald 
478671de195eSMatthias Ringwald static void hci_state_reset(void){
4787595bdbfbS[email protected]     // no connections yet
4788595bdbfbS[email protected]     hci_stack->connections = NULL;
478974308b23Smatthias.ringwald 
479074308b23Smatthias.ringwald     // keep discoverable/connectable as this has been requested by the client(s)
479174308b23Smatthias.ringwald     // hci_stack->discoverable = 0;
479274308b23Smatthias.ringwald     // hci_stack->connectable = 0;
479374308b23Smatthias.ringwald     // hci_stack->bondable = 1;
4794b95a5a35SMatthias Ringwald     // hci_stack->own_addr_type = 0;
4795595bdbfbS[email protected] 
479644935e40S[email protected]     // buffer is free
479702c7fc01SMatthias Ringwald     hci_stack->hci_packet_buffer_reserved = false;
479844935e40S[email protected] 
4799595bdbfbS[email protected]     // no pending cmds
4800595bdbfbS[email protected]     hci_stack->decline_reason = 0;
4801595bdbfbS[email protected] 
4802c214d65bSMatthias Ringwald     hci_stack->secure_connections_active = false;
4803c214d65bSMatthias Ringwald 
4804bea424a5SMatthias Ringwald #ifdef ENABLE_CLASSIC
4805496bb884SMatthias Ringwald     hci_stack->inquiry_lap = GAP_IAC_GENERAL_INQUIRY;
480632a12730SMatthias Ringwald 
4807baa4881eSMatthias Ringwald     hci_stack->gap_tasks_classic =
480859d59ecfSMatthias Ringwald             GAP_TASK_SET_DEFAULT_LINK_POLICY |
480959d59ecfSMatthias Ringwald             GAP_TASK_SET_CLASS_OF_DEVICE |
481059d59ecfSMatthias Ringwald             GAP_TASK_SET_LOCAL_NAME |
4811bc2dcc03SMatthias Ringwald             GAP_TASK_SET_EIR_DATA |
481232a12730SMatthias Ringwald             GAP_TASK_WRITE_SCAN_ENABLE |
481332a12730SMatthias Ringwald             GAP_TASK_WRITE_PAGE_TIMEOUT;
4814bea424a5SMatthias Ringwald #endif
4815bea424a5SMatthias Ringwald 
4816cf01e888SMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB
48178d5f0979SMatthias Ringwald     hci_stack->classic_read_local_oob_data = false;
48181ae74bf3SMatthias Ringwald     hci_stack->classic_oob_con_handle = HCI_CON_HANDLE_INVALID;
4819cf01e888SMatthias Ringwald #endif
4820cf01e888SMatthias Ringwald 
4821595bdbfbS[email protected]     // LE
4822b95a5a35SMatthias Ringwald #ifdef ENABLE_BLE
4823b95a5a35SMatthias Ringwald     memset(hci_stack->le_random_address, 0, 6);
4824b95a5a35SMatthias Ringwald     hci_stack->le_random_address_set = 0;
4825d70217a2SMatthias Ringwald #endif
4826d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
4827a61834b6SMatthias Ringwald     hci_stack->le_scanning_active  = false;
482873799937SMatthias Ringwald     hci_stack->le_scanning_param_update = true;
4829b04dfa37SMatthias Ringwald     hci_stack->le_connecting_state = LE_CONNECTING_IDLE;
4830d5b1a89eSMatthias Ringwald     hci_stack->le_connecting_request = LE_CONNECTING_IDLE;
4831e83201bcSMatthias Ringwald     hci_stack->le_whitelist_capacity = 0;
48324bafedd5SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
48334bafedd5SMatthias Ringwald     hci_stack->le_periodic_terminate_sync_handle = HCI_CON_HANDLE_INVALID;
48344bafedd5SMatthias Ringwald #endif
4835d70217a2SMatthias Ringwald #endif
4836a61834b6SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
4837935aa76eSMatthias Ringwald     hci_stack->le_advertisements_state &= ~LE_ADVERTISEMENT_STATE_ACTIVE;
48386bf435a6SMatthias Ringwald     if ((hci_stack->le_advertisements_state & LE_ADVERTISEMENT_STATE_PARAMS_SET) != 0){
4839a61834b6SMatthias Ringwald         hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_SET_PARAMS;
4840a61834b6SMatthias Ringwald     }
4841a61834b6SMatthias Ringwald     if (hci_stack->le_advertisements_data != NULL){
4842a61834b6SMatthias Ringwald         hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_SET_ADV_DATA;
4843a61834b6SMatthias Ringwald     }
4844a61834b6SMatthias Ringwald #endif
4845d320e123SMatthias Ringwald #ifdef ENABLE_LE_PRIVACY_ADDRESS_RESOLUTION
4846d320e123SMatthias Ringwald     hci_stack->le_resolving_list_state = LE_RESOLVING_LIST_SEND_ENABLE_ADDRESS_RESOLUTION;
4847d320e123SMatthias Ringwald #endif
484840f86dfdSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
484926b93350SMatthias Ringwald     hci_stack->iso_active_operation_type = HCI_ISO_TYPE_INVALID;
4850d75a6bbfSMatthias Ringwald     hci_stack->iso_active_operation_group_id = HCI_ISO_GROUP_ID_INVALID;
485140f86dfdSMatthias Ringwald #endif
485291036612SMatthias Ringwald #ifdef ENABLE_HCI_COMMAND_STATUS_DISCARDED_FOR_FAILED_CONNECTIONS_WORKAROUND
4853f48a5586SMatthias Ringwald     hci_stack->hci_command_con_handle = HCI_CON_HANDLE_INVALID;
4854f48a5586SMatthias Ringwald #endif
4855595bdbfbS[email protected] }
4856595bdbfbS[email protected] 
485735454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
48582d5e09d6SMatthias Ringwald /**
48592d5e09d6SMatthias Ringwald  * @brief Configure Bluetooth hardware control. Has to be called before power on.
48602d5e09d6SMatthias Ringwald  */
48612d5e09d6SMatthias Ringwald void hci_set_link_key_db(btstack_link_key_db_t const * link_key_db){
48622d5e09d6SMatthias Ringwald     // store and open remote device db
48632d5e09d6SMatthias Ringwald     hci_stack->link_key_db = link_key_db;
48642d5e09d6SMatthias Ringwald     if (hci_stack->link_key_db) {
48652d5e09d6SMatthias Ringwald         hci_stack->link_key_db->open();
48662d5e09d6SMatthias Ringwald     }
48672d5e09d6SMatthias Ringwald }
486835454696SMatthias Ringwald #endif
48692d5e09d6SMatthias Ringwald 
48702d5e09d6SMatthias Ringwald void hci_init(const hci_transport_t *transport, const void *config){
4871475c8125Smatthias.ringwald 
48723a9fb326S[email protected] #ifdef HAVE_MALLOC
48733a9fb326S[email protected]     if (!hci_stack) {
48743a9fb326S[email protected]         hci_stack = (hci_stack_t*) malloc(sizeof(hci_stack_t));
48753a9fb326S[email protected]     }
4876b1202089SMatthias Ringwald     btstack_assert(hci_stack != NULL);
48773a9fb326S[email protected] #else
48783a9fb326S[email protected]     hci_stack = &hci_stack_static;
48793a9fb326S[email protected] #endif
488066fb9560S[email protected]     memset(hci_stack, 0, sizeof(hci_stack_t));
48813a9fb326S[email protected] 
4882475c8125Smatthias.ringwald     // reference to use transport layer implementation
48833a9fb326S[email protected]     hci_stack->hci_transport = transport;
4884475c8125Smatthias.ringwald 
488511e23e5fSmatthias.ringwald     // reference to used config
48863a9fb326S[email protected]     hci_stack->config = config;
488711e23e5fSmatthias.ringwald 
488826a9b6daSMatthias Ringwald     // setup pointer for outgoing packet buffer
488926a9b6daSMatthias Ringwald     hci_stack->hci_packet_buffer = &hci_stack->hci_packet_buffer_data[HCI_OUTGOING_PRE_BUFFER_SIZE];
489026a9b6daSMatthias Ringwald 
48918fcba05dSmatthias.ringwald     // max acl payload size defined in config.h
48923a9fb326S[email protected]     hci_stack->acl_data_packet_length = HCI_ACL_PAYLOAD_SIZE;
48938fcba05dSmatthias.ringwald 
489416833f0aSmatthias.ringwald     // register packet handlers with transport
489510e830c9Smatthias.ringwald     transport->register_packet_handler(&packet_handler);
4896f5454fc6Smatthias.ringwald 
48973a9fb326S[email protected]     hci_stack->state = HCI_STATE_OFF;
4898e2386ba1S[email protected] 
4899e2386ba1S[email protected]     // class of device
49003a9fb326S[email protected]     hci_stack->class_of_device = 0x007a020c; // Smartphone
4901a45d6b9fS[email protected] 
4902f20168b8Smatthias.ringwald     // bondable by default
4903f20168b8Smatthias.ringwald     hci_stack->bondable = 1;
4904f20168b8Smatthias.ringwald 
4905e9f343c8SMatthias Ringwald #ifdef ENABLE_CLASSIC
490663168530SMatthias Ringwald     // classic name
490763168530SMatthias Ringwald     hci_stack->local_name = default_classic_name;
4908c4c88f1bSJakob Krantz 
4909c4c88f1bSJakob Krantz     // Master slave policy
4910c4c88f1bSJakob Krantz     hci_stack->master_slave_policy = 1;
4911170fafaeSMatthias Ringwald 
4912b4eb4420SMatthias Ringwald     // Allow Role Switch
4913b4eb4420SMatthias Ringwald     hci_stack->allow_role_switch = 1;
4914b4eb4420SMatthias Ringwald 
491578315a58SMatthias Ringwald     // Default / minimum security level = 2
491678315a58SMatthias Ringwald     hci_stack->gap_security_level = LEVEL_2;
491778315a58SMatthias Ringwald 
49185dbec6b3SMatthias Ringwald     // Default Security Mode 4
49195dbec6b3SMatthias Ringwald     hci_stack->gap_security_mode = GAP_SECURITY_MODE_4;
49205dbec6b3SMatthias Ringwald 
4921cd345294SMatthias Ringwald     // Errata-11838 mandates 7 bytes for GAP Security Level 1-3
4922cd345294SMatthias Ringwald     hci_stack->gap_required_encyrption_key_size = 7;
4923d821984bSMatthias Ringwald 
4924d821984bSMatthias Ringwald     // Link Supervision Timeout
4925d821984bSMatthias Ringwald     hci_stack->link_supervision_timeout = HCI_LINK_SUPERVISION_TIMEOUT_DEFAULT;
4926d821984bSMatthias Ringwald 
4927c874aa46SMatthias Ringwald     // Page Timeout
4928c874aa46SMatthias Ringwald     hci_stack->page_timeout = 0x6000;  // ca. 15 sec
4929c874aa46SMatthias Ringwald 
4930028ead5eSMatthias Ringwald     // All ACL packet types are enabledh
4931028ead5eSMatthias Ringwald     hci_stack->enabled_packet_types_acl = ACL_PACKET_TYPES_ALL;
4932e9f343c8SMatthias Ringwald #endif
493363168530SMatthias Ringwald 
493463048403S[email protected]     // Secure Simple Pairing default: enable, no I/O capabilities, general bonding, mitm not required, auto accept
49353a9fb326S[email protected]     hci_stack->ssp_enable = 1;
49363a9fb326S[email protected]     hci_stack->ssp_io_capability = SSP_IO_CAPABILITY_NO_INPUT_NO_OUTPUT;
49373a9fb326S[email protected]     hci_stack->ssp_authentication_requirement = SSP_IO_AUTHREQ_MITM_PROTECTION_NOT_REQUIRED_GENERAL_BONDING;
49383a9fb326S[email protected]     hci_stack->ssp_auto_accept = 1;
493969a97523S[email protected] 
49405d23aae8SMatthias Ringwald     // Secure Connections: enable (requires support from Controller)
49415d23aae8SMatthias Ringwald     hci_stack->secure_connections_enable = true;
49425d23aae8SMatthias Ringwald 
4943fac2e2feSMatthias Ringwald     // voice setting - signed 16 bit pcm data with CVSD over the air
4944fac2e2feSMatthias Ringwald     hci_stack->sco_voice_setting = 0x60;
4945d950d659SMatthias Ringwald 
49460c2c5f79SMatthias Ringwald #ifdef ENABLE_BLE
4947cbe54ab2SJakob Krantz     hci_stack->le_connection_scan_interval = 0x0060;   //    60 ms
4948cbe54ab2SJakob Krantz     hci_stack->le_connection_scan_window   = 0x0030;    //   30 ms
4949831711daSMatthias Ringwald     hci_stack->le_connection_interval_min  = 0x0008;    //   10 ms
4950831711daSMatthias Ringwald     hci_stack->le_connection_interval_max  = 0x0018;    //   30 ms
4951831711daSMatthias Ringwald     hci_stack->le_connection_latency       =      4;    //    4
4952831711daSMatthias Ringwald     hci_stack->le_supervision_timeout      = 0x0048;    //  720 ms
495324d14ae3SMatthias Ringwald     hci_stack->le_minimum_ce_length        =      0;    //    0 ms
495424d14ae3SMatthias Ringwald     hci_stack->le_maximum_ce_length        =      0;    //    0 ms
49550c2c5f79SMatthias Ringwald #endif
49560c2c5f79SMatthias Ringwald 
49570c2c5f79SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
49587eb5b27eSMatthias Ringwald     hci_stack->le_connection_phys          =   0x01;    // LE 1M PHY
49597261e5d8SMatthias Ringwald 
49607261e5d8SMatthias Ringwald     // default LE Scanning
49617eb5b27eSMatthias Ringwald     hci_stack->le_scan_type     =  0x01; // active
49628b69e4c7SMatthias Ringwald     hci_stack->le_scan_interval = 0x1e0; // 300 ms
49638b69e4c7SMatthias Ringwald     hci_stack->le_scan_window   =  0x30; //  30 ms
49647eb5b27eSMatthias Ringwald     hci_stack->le_scan_phys     =  0x01; // LE 1M PHY
4965831711daSMatthias Ringwald #endif
4966831711daSMatthias Ringwald 
49672b6ab3e6SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
49682b6ab3e6SMatthias Ringwald     hci_stack->le_max_number_peripheral_connections = 1; // only single connection as peripheral
4969ee605458SMatthias Ringwald 
4970ee605458SMatthias Ringwald     // default advertising parameters from Core v5.4 -- needed to use random address without prior adv setup
4971ee605458SMatthias Ringwald     hci_stack->le_advertisements_interval_min =                         0x0800;
4972ee605458SMatthias Ringwald     hci_stack->le_advertisements_interval_max =                         0x0800;
4973ee605458SMatthias Ringwald     hci_stack->le_advertisements_type =                                      0;
4974ee605458SMatthias Ringwald     hci_stack->le_own_addr_type =                       BD_ADDR_TYPE_LE_PUBLIC;
4975ee605458SMatthias Ringwald     hci_stack->le_advertisements_direct_address_type =  BD_ADDR_TYPE_LE_PUBLIC;
4976ee605458SMatthias Ringwald     hci_stack->le_advertisements_channel_map =                            0x07;
4977ee605458SMatthias Ringwald     hci_stack->le_advertisements_filter_policy =                             0;
49782b6ab3e6SMatthias Ringwald #endif
49792b6ab3e6SMatthias Ringwald 
4980831711daSMatthias Ringwald     // connection parameter range used to answer connection parameter update requests in l2cap
4981831711daSMatthias Ringwald     hci_stack->le_connection_parameter_range.le_conn_interval_min =          6;
4982831711daSMatthias Ringwald     hci_stack->le_connection_parameter_range.le_conn_interval_max =       3200;
4983831711daSMatthias Ringwald     hci_stack->le_connection_parameter_range.le_conn_latency_min =           0;
4984831711daSMatthias Ringwald     hci_stack->le_connection_parameter_range.le_conn_latency_max =         500;
4985831711daSMatthias Ringwald     hci_stack->le_connection_parameter_range.le_supervision_timeout_min =   10;
4986831711daSMatthias Ringwald     hci_stack->le_connection_parameter_range.le_supervision_timeout_max = 3200;
4987831711daSMatthias Ringwald 
498801d4f05fSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
498901d4f05fSMatthias Ringwald     hci_stack->iso_packets_to_queue = 1;
499001d4f05fSMatthias Ringwald #endif
499101d4f05fSMatthias Ringwald 
4992c3d19a30SMatthias Ringwald #ifdef ENABLE_LE_PRIVACY_ADDRESS_RESOLUTION
4993c3d19a30SMatthias Ringwald     hci_stack->le_privacy_mode = LE_PRIVACY_MODE_DEVICE;
4994c3d19a30SMatthias Ringwald #endif
4995c3d19a30SMatthias Ringwald 
4996595bdbfbS[email protected]     hci_state_reset();
4997475c8125Smatthias.ringwald }
4998475c8125Smatthias.ringwald 
49994688f216SMatthias Ringwald void hci_deinit(void){
5000b02cfc15SMatthias Ringwald     btstack_run_loop_remove_timer(&hci_stack->timeout);
50014688f216SMatthias Ringwald #ifdef HAVE_MALLOC
50024688f216SMatthias Ringwald     if (hci_stack) {
50034688f216SMatthias Ringwald         free(hci_stack);
50044688f216SMatthias Ringwald     }
50054688f216SMatthias Ringwald #endif
50064688f216SMatthias Ringwald     hci_stack = NULL;
5007b5bbcbf4SMatthias Ringwald 
5008b5bbcbf4SMatthias Ringwald #ifdef ENABLE_CLASSIC
50094688f216SMatthias Ringwald     disable_l2cap_timeouts = 0;
5010b5bbcbf4SMatthias Ringwald #endif
50114688f216SMatthias Ringwald }
50124688f216SMatthias Ringwald 
50133fb36a29SMatthias Ringwald /**
50143fb36a29SMatthias Ringwald  * @brief Configure Bluetooth chipset driver. Has to be called before power on, or right after receiving the local version information
50153fb36a29SMatthias Ringwald  */
50163fb36a29SMatthias Ringwald void hci_set_chipset(const btstack_chipset_t *chipset_driver){
50173fb36a29SMatthias Ringwald     hci_stack->chipset = chipset_driver;
50183fb36a29SMatthias Ringwald 
50193fb36a29SMatthias Ringwald     // reset chipset driver - init is also called on power_up
50203fb36a29SMatthias Ringwald     if (hci_stack->chipset && hci_stack->chipset->init){
50213fb36a29SMatthias Ringwald         hci_stack->chipset->init(hci_stack->config);
50223fb36a29SMatthias Ringwald     }
50233fb36a29SMatthias Ringwald }
50243fb36a29SMatthias Ringwald 
50256fe16221SMatthias Ringwald void hci_enable_custom_pre_init(void){
50266fe16221SMatthias Ringwald     hci_stack->chipset_pre_init = true;
50276fe16221SMatthias Ringwald }
50286fe16221SMatthias Ringwald 
5029fb55bd0aSMatthias Ringwald /**
5030d0b87befSMatthias Ringwald  * @brief Configure Bluetooth hardware control. Has to be called after hci_init() but before power on.
5031fb55bd0aSMatthias Ringwald  */
5032fb55bd0aSMatthias Ringwald void hci_set_control(const btstack_control_t *hardware_control){
5033fb55bd0aSMatthias Ringwald     // references to used control implementation
5034fb55bd0aSMatthias Ringwald     hci_stack->control = hardware_control;
5035d0b87befSMatthias Ringwald     // init with transport config
5036d0b87befSMatthias Ringwald     hardware_control->init(hci_stack->config);
5037fb55bd0aSMatthias Ringwald }
5038fb55bd0aSMatthias Ringwald 
50391f9eb2ccSMatthias Ringwald static void hci_discard_connections(void){
5040346f8c2cSMatthias Ringwald     btstack_linked_list_iterator_t it;
5041346f8c2cSMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->connections);
5042346f8c2cSMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
50431f9eb2ccSMatthias Ringwald         // cancel all l2cap connections by emitting dicsconnection complete before shutdown (free) connection
5044346f8c2cSMatthias Ringwald         hci_connection_t * connection = (hci_connection_t*) btstack_linked_list_iterator_next(&it);
50451f9eb2ccSMatthias Ringwald         hci_emit_disconnection_complete(connection->con_handle, 0x16); // terminated by local host
50461f9eb2ccSMatthias Ringwald         hci_shutdown_connection(connection);
50471f9eb2ccSMatthias Ringwald     }
5048346f8c2cSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
5049346f8c2cSMatthias Ringwald     while (hci_stack->iso_streams != NULL){
5050346f8c2cSMatthias Ringwald         hci_iso_stream_finalize((hci_iso_stream_t *) hci_stack->iso_streams);
5051346f8c2cSMatthias Ringwald     }
5052346f8c2cSMatthias Ringwald #endif
50531f9eb2ccSMatthias Ringwald }
50541f9eb2ccSMatthias Ringwald 
505571de195eSMatthias Ringwald void hci_close(void){
5056e6d6524dSMatthias Ringwald 
5057e6d6524dSMatthias Ringwald #ifdef ENABLE_CLASSIC
5058404843c1Smatthias.ringwald     // close remote device db
5059a98592bcSMatthias Ringwald     if (hci_stack->link_key_db) {
5060a98592bcSMatthias Ringwald         hci_stack->link_key_db->close();
5061404843c1Smatthias.ringwald     }
5062e6d6524dSMatthias Ringwald #endif
50637224be7eSMatthias Ringwald 
50641f9eb2ccSMatthias Ringwald     hci_discard_connections();
50657224be7eSMatthias Ringwald 
5066f5454fc6Smatthias.ringwald     hci_power_control(HCI_POWER_OFF);
50673a9fb326S[email protected] 
50683a9fb326S[email protected] #ifdef HAVE_MALLOC
50693a9fb326S[email protected]     free(hci_stack);
50703a9fb326S[email protected] #endif
50713a9fb326S[email protected]     hci_stack = NULL;
5072404843c1Smatthias.ringwald }
5073404843c1Smatthias.ringwald 
5074cb70c5abSMatthias Ringwald #ifdef HAVE_SCO_TRANSPORT
5075cb70c5abSMatthias Ringwald void hci_set_sco_transport(const btstack_sco_transport_t *sco_transport){
5076cb70c5abSMatthias Ringwald     hci_stack->sco_transport = sco_transport;
5077cb70c5abSMatthias Ringwald     sco_transport->register_packet_handler(&packet_handler);
5078cb70c5abSMatthias Ringwald }
5079cb70c5abSMatthias Ringwald #endif
5080cb70c5abSMatthias Ringwald 
508135454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
5082170fafaeSMatthias Ringwald void gap_set_required_encryption_key_size(uint8_t encryption_key_size){
5083170fafaeSMatthias Ringwald     // validate ranage and set
5084170fafaeSMatthias Ringwald     if (encryption_key_size < 7)  return;
5085170fafaeSMatthias Ringwald     if (encryption_key_size > 16) return;
5086170fafaeSMatthias Ringwald     hci_stack->gap_required_encyrption_key_size = encryption_key_size;
5087170fafaeSMatthias Ringwald }
508878315a58SMatthias Ringwald 
5089137715ebSMatthias Ringwald uint8_t gap_set_security_mode(gap_security_mode_t security_mode){
5090137715ebSMatthias Ringwald     if ((security_mode == GAP_SECURITY_MODE_4) || (security_mode == GAP_SECURITY_MODE_2)){
50915dbec6b3SMatthias Ringwald         hci_stack->gap_security_mode = security_mode;
5092137715ebSMatthias Ringwald         return ERROR_CODE_SUCCESS;
5093137715ebSMatthias Ringwald     } else {
5094137715ebSMatthias Ringwald         return ERROR_CODE_UNSUPPORTED_FEATURE_OR_PARAMETER_VALUE;
5095137715ebSMatthias Ringwald     }
50965dbec6b3SMatthias Ringwald }
50975dbec6b3SMatthias Ringwald 
50985dbec6b3SMatthias Ringwald gap_security_mode_t gap_get_security_mode(void){
50995dbec6b3SMatthias Ringwald     return hci_stack->gap_security_mode;
51005dbec6b3SMatthias Ringwald }
51015dbec6b3SMatthias Ringwald 
510278315a58SMatthias Ringwald void gap_set_security_level(gap_security_level_t security_level){
510378315a58SMatthias Ringwald     hci_stack->gap_security_level = security_level;
510478315a58SMatthias Ringwald }
510578315a58SMatthias Ringwald 
510678315a58SMatthias Ringwald gap_security_level_t gap_get_security_level(void){
5107d7387af3SMatthias Ringwald     if (hci_stack->gap_secure_connections_only_mode){
5108d7387af3SMatthias Ringwald         return LEVEL_4;
5109d7387af3SMatthias Ringwald     }
511078315a58SMatthias Ringwald     return hci_stack->gap_security_level;
511178315a58SMatthias Ringwald }
511230cdf3c6SMatthias Ringwald 
51138ad4dfffSMatthias Ringwald void gap_set_minimal_service_security_level(gap_security_level_t security_level){
51148ad4dfffSMatthias Ringwald     hci_stack->gap_minimal_service_security_level = security_level;
51158ad4dfffSMatthias Ringwald }
51168ad4dfffSMatthias Ringwald 
511730cdf3c6SMatthias Ringwald void gap_set_secure_connections_only_mode(bool enable){
511830cdf3c6SMatthias Ringwald     hci_stack->gap_secure_connections_only_mode = enable;
511930cdf3c6SMatthias Ringwald }
512030cdf3c6SMatthias Ringwald 
512130cdf3c6SMatthias Ringwald bool gap_get_secure_connections_only_mode(void){
512230cdf3c6SMatthias Ringwald     return hci_stack->gap_secure_connections_only_mode;
512330cdf3c6SMatthias Ringwald }
5124170fafaeSMatthias Ringwald #endif
5125170fafaeSMatthias Ringwald 
5126170fafaeSMatthias Ringwald #ifdef ENABLE_CLASSIC
512760b9e82fSMatthias Ringwald void gap_set_class_of_device(uint32_t class_of_device){
51289e61646fS[email protected]     hci_stack->class_of_device = class_of_device;
5129baa4881eSMatthias Ringwald     hci_stack->gap_tasks_classic |= GAP_TASK_SET_CLASS_OF_DEVICE;
513059d59ecfSMatthias Ringwald     hci_run();
51319e61646fS[email protected] }
513276f27cffSMatthias Ringwald 
5133c33e56d3SMatthias Ringwald void gap_set_default_link_policy_settings(uint16_t default_link_policy_settings){
5134c33e56d3SMatthias Ringwald     hci_stack->default_link_policy_settings = default_link_policy_settings;
5135baa4881eSMatthias Ringwald     hci_stack->gap_tasks_classic |= GAP_TASK_SET_DEFAULT_LINK_POLICY;
513659d59ecfSMatthias Ringwald     hci_run();
5137c33e56d3SMatthias Ringwald }
5138c33e56d3SMatthias Ringwald 
5139b4eb4420SMatthias Ringwald void gap_set_allow_role_switch(bool allow_role_switch){
5140b4eb4420SMatthias Ringwald     hci_stack->allow_role_switch = allow_role_switch ? 1 : 0;
5141b4eb4420SMatthias Ringwald }
5142b4eb4420SMatthias Ringwald 
5143b4eb4420SMatthias Ringwald uint8_t hci_get_allow_role_switch(void){
5144b4eb4420SMatthias Ringwald     return  hci_stack->allow_role_switch;
5145b4eb4420SMatthias Ringwald }
5146b4eb4420SMatthias Ringwald 
51470c3eb48dSMatthias Ringwald void gap_set_link_supervision_timeout(uint16_t link_supervision_timeout){
51480c3eb48dSMatthias Ringwald     hci_stack->link_supervision_timeout = link_supervision_timeout;
51490c3eb48dSMatthias Ringwald }
51500c3eb48dSMatthias Ringwald 
51519afaa4d4SMatthias Ringwald void gap_enable_link_watchdog(uint16_t timeout_ms){
51529afaa4d4SMatthias Ringwald     hci_stack->automatic_flush_timeout = btstack_min(timeout_ms, 1280) * 8 / 5; // divide by 0.625
51539afaa4d4SMatthias Ringwald }
51549afaa4d4SMatthias Ringwald 
51559afaa4d4SMatthias Ringwald uint16_t hci_automatic_flush_timeout(void){
51569afaa4d4SMatthias Ringwald     return hci_stack->automatic_flush_timeout;
51579afaa4d4SMatthias Ringwald }
51589afaa4d4SMatthias Ringwald 
515976f27cffSMatthias Ringwald void hci_disable_l2cap_timeout_check(void){
516076f27cffSMatthias Ringwald     disable_l2cap_timeouts = 1;
516176f27cffSMatthias Ringwald }
516235454696SMatthias Ringwald #endif
51639e61646fS[email protected] 
51646fad2c37SMatthias Ringwald #ifndef HAVE_HOST_CONTROLLER_API
5165f456b2d0S[email protected] // Set Public BD ADDR - passed on to Bluetooth chipset if supported in bt_control_h
5166f456b2d0S[email protected] void hci_set_bd_addr(bd_addr_t addr){
51676535961aSMatthias Ringwald     (void)memcpy(hci_stack->custom_bd_addr, addr, 6);
5168f456b2d0S[email protected]     hci_stack->custom_bd_addr_set = 1;
5169f456b2d0S[email protected] }
517076f27cffSMatthias Ringwald #endif
5171f456b2d0S[email protected] 
51728d213e1aSmatthias.ringwald // State-Module-Driver overview
51738d213e1aSmatthias.ringwald // state                    module  low-level
51748d213e1aSmatthias.ringwald // HCI_STATE_OFF             off      close
51758d213e1aSmatthias.ringwald // HCI_STATE_INITIALIZING,   on       open
51768d213e1aSmatthias.ringwald // HCI_STATE_WORKING,        on       open
51778d213e1aSmatthias.ringwald // HCI_STATE_HALTING,        on       open
5178d661ed19Smatthias.ringwald // HCI_STATE_SLEEPING,    off/sleep   close
5179d661ed19Smatthias.ringwald // HCI_STATE_FALLING_ASLEEP  on       open
5180c7e0c5f6Smatthias.ringwald 
518140d1c7a4Smatthias.ringwald static int hci_power_control_on(void){
51827301ad89Smatthias.ringwald 
5183038bc64cSmatthias.ringwald     // power on
5184f9a30166Smatthias.ringwald     int err = 0;
51853a9fb326S[email protected]     if (hci_stack->control && hci_stack->control->on){
5186d0b87befSMatthias Ringwald         err = (*hci_stack->control->on)();
5187f9a30166Smatthias.ringwald     }
5188038bc64cSmatthias.ringwald     if (err){
51899da54300S[email protected]         log_error( "POWER_ON failed");
5190038bc64cSmatthias.ringwald         hci_emit_hci_open_failed();
5191038bc64cSmatthias.ringwald         return err;
5192038bc64cSmatthias.ringwald     }
5193038bc64cSmatthias.ringwald 
519424b3c629SMatthias Ringwald     // int chipset driver
51953fb36a29SMatthias Ringwald     if (hci_stack->chipset && hci_stack->chipset->init){
51963fb36a29SMatthias Ringwald         hci_stack->chipset->init(hci_stack->config);
51973fb36a29SMatthias Ringwald     }
51983fb36a29SMatthias Ringwald 
519924b3c629SMatthias Ringwald     // init transport
520024b3c629SMatthias Ringwald     if (hci_stack->hci_transport->init){
520124b3c629SMatthias Ringwald         hci_stack->hci_transport->init(hci_stack->config);
520224b3c629SMatthias Ringwald     }
520324b3c629SMatthias Ringwald 
520424b3c629SMatthias Ringwald     // open transport
520524b3c629SMatthias Ringwald     err = hci_stack->hci_transport->open();
5206038bc64cSmatthias.ringwald     if (err){
52079da54300S[email protected]         log_error( "HCI_INIT failed, turning Bluetooth off again");
52083a9fb326S[email protected]         if (hci_stack->control && hci_stack->control->off){
5209d0b87befSMatthias Ringwald             (*hci_stack->control->off)();
5210f9a30166Smatthias.ringwald         }
5211038bc64cSmatthias.ringwald         hci_emit_hci_open_failed();
5212038bc64cSmatthias.ringwald         return err;
5213038bc64cSmatthias.ringwald     }
52148d213e1aSmatthias.ringwald     return 0;
52158d213e1aSmatthias.ringwald }
5216038bc64cSmatthias.ringwald 
521740d1c7a4Smatthias.ringwald static void hci_power_control_off(void){
52188d213e1aSmatthias.ringwald 
52199da54300S[email protected]     log_info("hci_power_control_off");
52209418f9c9Smatthias.ringwald 
52218d213e1aSmatthias.ringwald     // close low-level device
522224b3c629SMatthias Ringwald     hci_stack->hci_transport->close();
52238d213e1aSmatthias.ringwald 
52249da54300S[email protected]     log_info("hci_power_control_off - hci_transport closed");
52259418f9c9Smatthias.ringwald 
52268d213e1aSmatthias.ringwald     // power off
52273a9fb326S[email protected]     if (hci_stack->control && hci_stack->control->off){
5228d0b87befSMatthias Ringwald         (*hci_stack->control->off)();
52298d213e1aSmatthias.ringwald     }
52309418f9c9Smatthias.ringwald 
52319da54300S[email protected]     log_info("hci_power_control_off - control closed");
52329418f9c9Smatthias.ringwald 
52333a9fb326S[email protected]     hci_stack->state = HCI_STATE_OFF;
523472ea5239Smatthias.ringwald }
523572ea5239Smatthias.ringwald 
523640d1c7a4Smatthias.ringwald static void hci_power_control_sleep(void){
523772ea5239Smatthias.ringwald 
52389da54300S[email protected]     log_info("hci_power_control_sleep");
52393144bce4Smatthias.ringwald 
5240b429b9b7Smatthias.ringwald #if 0
5241b429b9b7Smatthias.ringwald     // don't close serial port during sleep
5242b429b9b7Smatthias.ringwald 
524372ea5239Smatthias.ringwald     // close low-level device
52443a9fb326S[email protected]     hci_stack->hci_transport->close(hci_stack->config);
5245b429b9b7Smatthias.ringwald #endif
524672ea5239Smatthias.ringwald 
524772ea5239Smatthias.ringwald     // sleep mode
52483a9fb326S[email protected]     if (hci_stack->control && hci_stack->control->sleep){
5249d0b87befSMatthias Ringwald         (*hci_stack->control->sleep)();
525072ea5239Smatthias.ringwald     }
5251b429b9b7Smatthias.ringwald 
52523a9fb326S[email protected]     hci_stack->state = HCI_STATE_SLEEPING;
52538d213e1aSmatthias.ringwald }
52548d213e1aSmatthias.ringwald 
525540d1c7a4Smatthias.ringwald static int hci_power_control_wake(void){
5256b429b9b7Smatthias.ringwald 
52579da54300S[email protected]     log_info("hci_power_control_wake");
5258b429b9b7Smatthias.ringwald 
5259b429b9b7Smatthias.ringwald     // wake on
52603a9fb326S[email protected]     if (hci_stack->control && hci_stack->control->wake){
5261d0b87befSMatthias Ringwald         (*hci_stack->control->wake)();
5262b429b9b7Smatthias.ringwald     }
5263b429b9b7Smatthias.ringwald 
5264b429b9b7Smatthias.ringwald #if 0
5265b429b9b7Smatthias.ringwald     // open low-level device
52663a9fb326S[email protected]     int err = hci_stack->hci_transport->open(hci_stack->config);
5267b429b9b7Smatthias.ringwald     if (err){
52689da54300S[email protected]         log_error( "HCI_INIT failed, turning Bluetooth off again");
52693a9fb326S[email protected]         if (hci_stack->control && hci_stack->control->off){
5270d0b87befSMatthias Ringwald             (*hci_stack->control->off)();
5271b429b9b7Smatthias.ringwald         }
5272b429b9b7Smatthias.ringwald         hci_emit_hci_open_failed();
5273b429b9b7Smatthias.ringwald         return err;
5274b429b9b7Smatthias.ringwald     }
5275b429b9b7Smatthias.ringwald #endif
5276b429b9b7Smatthias.ringwald 
5277b429b9b7Smatthias.ringwald     return 0;
5278b429b9b7Smatthias.ringwald }
5279b429b9b7Smatthias.ringwald 
52800c88d5efSMatthias Ringwald static void hci_power_enter_initializing_state(void){
528144935e40S[email protected]     // set up state machine
528244935e40S[email protected]     hci_stack->num_cmd_packets = 1; // assume that one cmd can be sent
528302c7fc01SMatthias Ringwald     hci_stack->hci_packet_buffer_reserved = false;
528444935e40S[email protected]     hci_stack->state = HCI_STATE_INITIALIZING;
52856fe16221SMatthias Ringwald 
52860535e08cSMatthias Ringwald #ifndef HAVE_HOST_CONTROLLER_API
52876fe16221SMatthias Ringwald     if (hci_stack->chipset_pre_init) {
52886fe16221SMatthias Ringwald         hci_stack->substate = HCI_INIT_CUSTOM_PRE_INIT;
52890535e08cSMatthias Ringwald     } else
52900535e08cSMatthias Ringwald #endif
52910535e08cSMatthias Ringwald     {
52925c363727SMatthias Ringwald         hci_stack->substate = HCI_INIT_SEND_RESET;
529344935e40S[email protected]     }
52946fe16221SMatthias Ringwald }
5295b429b9b7Smatthias.ringwald 
52960c88d5efSMatthias Ringwald static void hci_power_enter_halting_state(void){
52970c88d5efSMatthias Ringwald #ifdef ENABLE_BLE
52981e907691SMatthias Ringwald     // drop entries scheduled for removal, mark others for re-adding
52991e907691SMatthias Ringwald     btstack_linked_list_iterator_t it;
53001e907691SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->le_whitelist);
53011e907691SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
53021e907691SMatthias Ringwald         whitelist_entry_t * entry = (whitelist_entry_t*) btstack_linked_list_iterator_next(&it);
53031e907691SMatthias Ringwald         if ((entry->state & (LE_WHITELIST_REMOVE_FROM_CONTROLLER | LE_WHITELIST_ADD_TO_CONTROLLER)) == LE_WHITELIST_REMOVE_FROM_CONTROLLER){
53041e907691SMatthias Ringwald             btstack_linked_list_iterator_remove(&it);
53051e907691SMatthias Ringwald             btstack_memory_whitelist_entry_free(entry);
53061e907691SMatthias Ringwald         } else {
53071e907691SMatthias Ringwald             entry->state = LE_WHITELIST_ADD_TO_CONTROLLER;
53081e907691SMatthias Ringwald         }
53091e907691SMatthias Ringwald     }
5310a2c9d908SMatthias Ringwald #ifdef ENABLE_LE_PERIODIC_ADVERTISING
5311e8d160b3SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->le_periodic_advertiser_list);
5312e8d160b3SMatthias Ringwald     const uint8_t mask = LE_PERIODIC_ADVERTISER_LIST_ENTRY_REMOVE_FROM_CONTROLLER | LE_PERIODIC_ADVERTISER_LIST_ENTRY_REMOVE_FROM_CONTROLLER;
5313e8d160b3SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
5314e8d160b3SMatthias Ringwald         periodic_advertiser_list_entry_t * entry = (periodic_advertiser_list_entry_t*) btstack_linked_list_iterator_next(&it);
5315e8d160b3SMatthias Ringwald         if ((entry->state & mask) == LE_PERIODIC_ADVERTISER_LIST_ENTRY_REMOVE_FROM_CONTROLLER) {
5316e8d160b3SMatthias Ringwald             btstack_linked_list_iterator_remove(&it);
5317e8d160b3SMatthias Ringwald             btstack_memory_periodic_advertiser_list_entry_free(entry);
5318e8d160b3SMatthias Ringwald         } else {
5319e8d160b3SMatthias Ringwald             entry->state |= LE_PERIODIC_ADVERTISER_LIST_ENTRY_ADD_TO_CONTROLLER;
5320e8d160b3SMatthias Ringwald             continue;
5321e8d160b3SMatthias Ringwald         }
5322e8d160b3SMatthias Ringwald     }
5323a2c9d908SMatthias Ringwald #endif
53240c88d5efSMatthias Ringwald #endif
5325184dbe2fSMatthias Ringwald     // see hci_run
5326184dbe2fSMatthias Ringwald     hci_stack->state = HCI_STATE_HALTING;
53270c88d5efSMatthias Ringwald     hci_stack->substate = HCI_HALTING_CLASSIC_STOP;
5328184dbe2fSMatthias Ringwald     // setup watchdog timer for disconnect - only triggers if Controller does not respond anymore
5329184dbe2fSMatthias Ringwald     btstack_run_loop_set_timer(&hci_stack->timeout, 1000);
5330184dbe2fSMatthias Ringwald     btstack_run_loop_set_timer_handler(&hci_stack->timeout, hci_halting_timeout_handler);
5331184dbe2fSMatthias Ringwald     btstack_run_loop_add_timer(&hci_stack->timeout);
5332184dbe2fSMatthias Ringwald }
5333184dbe2fSMatthias Ringwald 
533442bd3d77SMatthias Ringwald // returns error
533542bd3d77SMatthias Ringwald static int hci_power_control_state_off(HCI_POWER_MODE power_mode){
533642bd3d77SMatthias Ringwald     int err;
53378d213e1aSmatthias.ringwald     switch (power_mode){
53388d213e1aSmatthias.ringwald         case HCI_POWER_ON:
53398d213e1aSmatthias.ringwald             err = hci_power_control_on();
534042bd3d77SMatthias Ringwald             if (err != 0) {
5341f04a0c31SMatthias Ringwald                 log_error("hci_power_control_on() error %d", err);
534297b61c7bS[email protected]                 return err;
534397b61c7bS[email protected]             }
53440c88d5efSMatthias Ringwald             hci_power_enter_initializing_state();
53458d213e1aSmatthias.ringwald             break;
53468d213e1aSmatthias.ringwald         case HCI_POWER_OFF:
53478d213e1aSmatthias.ringwald             // do nothing
53488d213e1aSmatthias.ringwald             break;
53498d213e1aSmatthias.ringwald         case HCI_POWER_SLEEP:
5350b546ac54Smatthias.ringwald             // do nothing (with SLEEP == OFF)
53518d213e1aSmatthias.ringwald             break;
53527bbeb3adSMilanka Ringwald         default:
53537bbeb3adSMilanka Ringwald             btstack_assert(false);
53547bbeb3adSMilanka Ringwald             break;
53558d213e1aSmatthias.ringwald     }
535642bd3d77SMatthias Ringwald     return ERROR_CODE_SUCCESS;
535742bd3d77SMatthias Ringwald }
53587301ad89Smatthias.ringwald 
535942bd3d77SMatthias Ringwald static int hci_power_control_state_initializing(HCI_POWER_MODE power_mode){
53608d213e1aSmatthias.ringwald     switch (power_mode){
53618d213e1aSmatthias.ringwald         case HCI_POWER_ON:
53628d213e1aSmatthias.ringwald             // do nothing
53638d213e1aSmatthias.ringwald             break;
53648d213e1aSmatthias.ringwald         case HCI_POWER_OFF:
53658d213e1aSmatthias.ringwald             // no connections yet, just turn it off
53668d213e1aSmatthias.ringwald             hci_power_control_off();
53678d213e1aSmatthias.ringwald             break;
53688d213e1aSmatthias.ringwald         case HCI_POWER_SLEEP:
5369b546ac54Smatthias.ringwald             // no connections yet, just turn it off
537072ea5239Smatthias.ringwald             hci_power_control_sleep();
53718d213e1aSmatthias.ringwald             break;
53727bbeb3adSMilanka Ringwald         default:
53737bbeb3adSMilanka Ringwald             btstack_assert(false);
53747bbeb3adSMilanka Ringwald             break;
53758d213e1aSmatthias.ringwald     }
537642bd3d77SMatthias Ringwald     return ERROR_CODE_SUCCESS;
537742bd3d77SMatthias Ringwald }
53787301ad89Smatthias.ringwald 
537942bd3d77SMatthias Ringwald static int hci_power_control_state_working(HCI_POWER_MODE power_mode) {
53808d213e1aSmatthias.ringwald     switch (power_mode){
53818d213e1aSmatthias.ringwald         case HCI_POWER_ON:
53828d213e1aSmatthias.ringwald             // do nothing
53838d213e1aSmatthias.ringwald             break;
53848d213e1aSmatthias.ringwald         case HCI_POWER_OFF:
53850c88d5efSMatthias Ringwald             hci_power_enter_halting_state();
53868d213e1aSmatthias.ringwald             break;
53878d213e1aSmatthias.ringwald         case HCI_POWER_SLEEP:
5388b546ac54Smatthias.ringwald             // see hci_run
53893a9fb326S[email protected]             hci_stack->state = HCI_STATE_FALLING_ASLEEP;
539074b323a9SMatthias Ringwald             hci_stack->substate = HCI_FALLING_ASLEEP_DISCONNECT;
53918d213e1aSmatthias.ringwald             break;
53927bbeb3adSMilanka Ringwald         default:
53937bbeb3adSMilanka Ringwald             btstack_assert(false);
53947bbeb3adSMilanka Ringwald             break;
53958d213e1aSmatthias.ringwald     }
539642bd3d77SMatthias Ringwald     return ERROR_CODE_SUCCESS;
539742bd3d77SMatthias Ringwald }
53987301ad89Smatthias.ringwald 
539942bd3d77SMatthias Ringwald static int hci_power_control_state_halting(HCI_POWER_MODE power_mode) {
54008d213e1aSmatthias.ringwald     switch (power_mode){
54018d213e1aSmatthias.ringwald         case HCI_POWER_ON:
54020c88d5efSMatthias Ringwald             hci_power_enter_initializing_state();
54038d213e1aSmatthias.ringwald             break;
54048d213e1aSmatthias.ringwald         case HCI_POWER_OFF:
54058d213e1aSmatthias.ringwald             // do nothing
54068d213e1aSmatthias.ringwald             break;
54078d213e1aSmatthias.ringwald         case HCI_POWER_SLEEP:
5408b546ac54Smatthias.ringwald             // see hci_run
54093a9fb326S[email protected]             hci_stack->state = HCI_STATE_FALLING_ASLEEP;
541074b323a9SMatthias Ringwald             hci_stack->substate = HCI_FALLING_ASLEEP_DISCONNECT;
54118d213e1aSmatthias.ringwald             break;
54127bbeb3adSMilanka Ringwald         default:
54137bbeb3adSMilanka Ringwald             btstack_assert(false);
54147bbeb3adSMilanka Ringwald             break;
54158d213e1aSmatthias.ringwald     }
541600278272SMatthias Ringwald     return ERROR_CODE_SUCCESS;
541742bd3d77SMatthias Ringwald }
54188d213e1aSmatthias.ringwald 
541942bd3d77SMatthias Ringwald static int hci_power_control_state_falling_asleep(HCI_POWER_MODE power_mode) {
54208d213e1aSmatthias.ringwald     switch (power_mode){
54218d213e1aSmatthias.ringwald         case HCI_POWER_ON:
54220c88d5efSMatthias Ringwald             hci_power_enter_initializing_state();
54238d213e1aSmatthias.ringwald             break;
54248d213e1aSmatthias.ringwald         case HCI_POWER_OFF:
54250c88d5efSMatthias Ringwald             hci_power_enter_halting_state();
54268d213e1aSmatthias.ringwald             break;
54278d213e1aSmatthias.ringwald         case HCI_POWER_SLEEP:
5428b546ac54Smatthias.ringwald             // do nothing
54298d213e1aSmatthias.ringwald             break;
54307bbeb3adSMilanka Ringwald         default:
54317bbeb3adSMilanka Ringwald             btstack_assert(false);
54327bbeb3adSMilanka Ringwald             break;
54338d213e1aSmatthias.ringwald     }
543442bd3d77SMatthias Ringwald     return ERROR_CODE_SUCCESS;
543542bd3d77SMatthias Ringwald }
54368d213e1aSmatthias.ringwald 
543742bd3d77SMatthias Ringwald static int hci_power_control_state_sleeping(HCI_POWER_MODE power_mode) {
543842bd3d77SMatthias Ringwald     int err;
54398d213e1aSmatthias.ringwald     switch (power_mode){
54408d213e1aSmatthias.ringwald         case HCI_POWER_ON:
54413144bce4Smatthias.ringwald             err = hci_power_control_wake();
54423144bce4Smatthias.ringwald             if (err) return err;
54430c88d5efSMatthias Ringwald             hci_power_enter_initializing_state();
54448d213e1aSmatthias.ringwald             break;
54458d213e1aSmatthias.ringwald         case HCI_POWER_OFF:
54460c88d5efSMatthias Ringwald             hci_power_enter_halting_state();
54478d213e1aSmatthias.ringwald             break;
54488d213e1aSmatthias.ringwald         case HCI_POWER_SLEEP:
5449b546ac54Smatthias.ringwald             // do nothing
54508d213e1aSmatthias.ringwald             break;
54517bbeb3adSMilanka Ringwald         default:
54527bbeb3adSMilanka Ringwald             btstack_assert(false);
54537bbeb3adSMilanka Ringwald             break;
54548d213e1aSmatthias.ringwald     }
545542bd3d77SMatthias Ringwald     return ERROR_CODE_SUCCESS;
545642bd3d77SMatthias Ringwald }
54577bbeb3adSMilanka Ringwald 
545842bd3d77SMatthias Ringwald int hci_power_control(HCI_POWER_MODE power_mode){
545942bd3d77SMatthias Ringwald     log_info("hci_power_control: %d, current mode %u", power_mode, hci_stack->state);
5460bef627f1SMatthias Ringwald     btstack_run_loop_remove_timer(&hci_stack->timeout);
546124f87726SMatthias Ringwald     int err = 0;
546242bd3d77SMatthias Ringwald     switch (hci_stack->state){
546342bd3d77SMatthias Ringwald         case HCI_STATE_OFF:
546442bd3d77SMatthias Ringwald             err = hci_power_control_state_off(power_mode);
546542bd3d77SMatthias Ringwald             break;
546642bd3d77SMatthias Ringwald         case HCI_STATE_INITIALIZING:
546742bd3d77SMatthias Ringwald             err = hci_power_control_state_initializing(power_mode);
546842bd3d77SMatthias Ringwald             break;
546942bd3d77SMatthias Ringwald         case HCI_STATE_WORKING:
547042bd3d77SMatthias Ringwald             err = hci_power_control_state_working(power_mode);
547142bd3d77SMatthias Ringwald             break;
547242bd3d77SMatthias Ringwald         case HCI_STATE_HALTING:
547342bd3d77SMatthias Ringwald             err = hci_power_control_state_halting(power_mode);
547442bd3d77SMatthias Ringwald             break;
547542bd3d77SMatthias Ringwald         case HCI_STATE_FALLING_ASLEEP:
547642bd3d77SMatthias Ringwald             err = hci_power_control_state_falling_asleep(power_mode);
547742bd3d77SMatthias Ringwald             break;
547842bd3d77SMatthias Ringwald         case HCI_STATE_SLEEPING:
547942bd3d77SMatthias Ringwald             err = hci_power_control_state_sleeping(power_mode);
548042bd3d77SMatthias Ringwald             break;
54817bbeb3adSMilanka Ringwald         default:
54827bbeb3adSMilanka Ringwald             btstack_assert(false);
54837bbeb3adSMilanka Ringwald             break;
548411e23e5fSmatthias.ringwald     }
548524f87726SMatthias Ringwald     if (err != 0){
548642bd3d77SMatthias Ringwald         return err;
548742bd3d77SMatthias Ringwald     }
548868d92d03Smatthias.ringwald 
5489038bc64cSmatthias.ringwald     // create internal event
5490ee8bf225Smatthias.ringwald 	hci_emit_state();
5491ee8bf225Smatthias.ringwald 
549268d92d03Smatthias.ringwald 	// trigger next/first action
549368d92d03Smatthias.ringwald 	hci_run();
549468d92d03Smatthias.ringwald 
5495475c8125Smatthias.ringwald     return 0;
5496475c8125Smatthias.ringwald }
5497475c8125Smatthias.ringwald 
549835454696SMatthias Ringwald 
5499091e35e3SMatthias Ringwald static void hci_halting_run(void) {
5500091e35e3SMatthias Ringwald 
5501091e35e3SMatthias Ringwald     log_info("HCI_STATE_HALTING, substate %x\n", hci_stack->substate);
5502091e35e3SMatthias Ringwald 
5503091e35e3SMatthias Ringwald     hci_connection_t *connection;
5504d5f71a7eSMatthias Ringwald #ifdef ENABLE_BLE
5505d5f71a7eSMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
5506911801caSMatthias Ringwald     bool stop_advertismenets;
5507d5f71a7eSMatthias Ringwald #endif
5508d5f71a7eSMatthias Ringwald #endif
5509091e35e3SMatthias Ringwald 
5510091e35e3SMatthias Ringwald     switch (hci_stack->substate) {
55110c88d5efSMatthias Ringwald         case HCI_HALTING_CLASSIC_STOP:
55120c88d5efSMatthias Ringwald #ifdef ENABLE_CLASSIC
5513911801caSMatthias Ringwald             if (!hci_can_send_command_packet_now()) return;
5514911801caSMatthias Ringwald 
55150c88d5efSMatthias Ringwald             if (hci_stack->connectable || hci_stack->discoverable){
55160c88d5efSMatthias Ringwald                 hci_stack->substate = HCI_HALTING_LE_ADV_STOP;
55170c88d5efSMatthias Ringwald                 hci_send_cmd(&hci_write_scan_enable, 0);
55180c88d5efSMatthias Ringwald                 return;
55190c88d5efSMatthias Ringwald             }
55200c88d5efSMatthias Ringwald #endif
55210c88d5efSMatthias Ringwald             /* fall through */
55220c88d5efSMatthias Ringwald 
55230c88d5efSMatthias Ringwald         case HCI_HALTING_LE_ADV_STOP:
55240c88d5efSMatthias Ringwald             hci_stack->substate = HCI_HALTING_LE_ADV_STOP;
55250c88d5efSMatthias Ringwald 
55260c88d5efSMatthias Ringwald #ifdef ENABLE_BLE
55270c88d5efSMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
5528911801caSMatthias Ringwald             if (!hci_can_send_command_packet_now()) return;
5529911801caSMatthias Ringwald 
5530911801caSMatthias Ringwald             stop_advertismenets = (hci_stack->le_advertisements_state & LE_ADVERTISEMENT_STATE_ACTIVE) != 0;
5531911801caSMatthias Ringwald 
5532911801caSMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
553322f987e4SMatthias Ringwald             if (hci_le_extended_advertising_supported()){
5534c814a904SMatthias Ringwald #ifdef ENABLE_LE_PERIODIC_ADVERTISING
5535911801caSMatthias Ringwald                 btstack_linked_list_iterator_t it;
5536911801caSMatthias Ringwald                 btstack_linked_list_iterator_init(&it, &hci_stack->le_advertising_sets);
5537911801caSMatthias Ringwald                 // stop all periodic advertisements and check if an extended set is active
5538911801caSMatthias Ringwald                 while (btstack_linked_list_iterator_has_next(&it)){
5539911801caSMatthias Ringwald                     le_advertising_set_t * advertising_set = (le_advertising_set_t*) btstack_linked_list_iterator_next(&it);
5540911801caSMatthias Ringwald                     if ((advertising_set->state & LE_ADVERTISEMENT_STATE_PERIODIC_ACTIVE) != 0) {
5541911801caSMatthias Ringwald                         advertising_set->state &= ~LE_ADVERTISEMENT_STATE_PERIODIC_ACTIVE;
5542911801caSMatthias Ringwald                         hci_send_cmd(&hci_le_set_periodic_advertising_enable, 0, advertising_set->advertising_handle);
55430c88d5efSMatthias Ringwald                         return;
55440c88d5efSMatthias Ringwald                     }
5545911801caSMatthias Ringwald                     if ((advertising_set->state & LE_ADVERTISEMENT_STATE_ACTIVE) != 0) {
5546911801caSMatthias Ringwald                         stop_advertismenets = true;
5547911801caSMatthias Ringwald                         advertising_set->state &= ~LE_ADVERTISEMENT_STATE_ACTIVE;
5548911801caSMatthias Ringwald                     }
5549911801caSMatthias Ringwald                 }
5550c814a904SMatthias Ringwald #endif /* ENABLE_LE_PERIODIC_ADVERTISING */
5551911801caSMatthias Ringwald                 if (stop_advertismenets){
5552911801caSMatthias Ringwald                     hci_stack->le_advertisements_state &= ~LE_ADVERTISEMENT_STATE_ACTIVE;
5553911801caSMatthias Ringwald                     hci_send_cmd(&hci_le_set_extended_advertising_enable, 0, 0, NULL, NULL, NULL);
5554911801caSMatthias Ringwald                     return;
5555911801caSMatthias Ringwald                 }
5556d935373dSMatthias Ringwald             } else
5557a2c9d908SMatthias Ringwald #else /* ENABLE_LE_PERIPHERAL */
5558911801caSMatthias Ringwald             {
5559911801caSMatthias Ringwald                 if (stop_advertismenets) {
5560911801caSMatthias Ringwald                     hci_stack->le_advertisements_state &= ~LE_ADVERTISEMENT_STATE_ACTIVE;
5561911801caSMatthias Ringwald                     hci_send_cmd(&hci_le_set_advertise_enable, 0);
5562911801caSMatthias Ringwald                     return;
5563911801caSMatthias Ringwald                 }
5564911801caSMatthias Ringwald             }
5565911801caSMatthias Ringwald #endif  /* ENABLE_LE_EXTENDED_ADVERTISING*/
5566911801caSMatthias Ringwald #endif  /* ENABLE_LE_PERIPHERAL */
5567911801caSMatthias Ringwald #endif  /* ENABLE_BLE */
5568911801caSMatthias Ringwald 
55690c88d5efSMatthias Ringwald             /* fall through */
55700c88d5efSMatthias Ringwald 
55710c88d5efSMatthias Ringwald         case HCI_HALTING_LE_SCAN_STOP:
55720c88d5efSMatthias Ringwald             hci_stack->substate = HCI_HALTING_LE_SCAN_STOP;
5573911801caSMatthias Ringwald             if (!hci_can_send_command_packet_now()) return;
5574091e35e3SMatthias Ringwald 
5575091e35e3SMatthias Ringwald #ifdef ENABLE_BLE
5576091e35e3SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
55770c88d5efSMatthias Ringwald             if (hci_stack->le_scanning_active){
5578c42da3bcSMatthias Ringwald                 hci_le_scan_stop();
55790c88d5efSMatthias Ringwald                 hci_stack->substate = HCI_HALTING_DISCONNECT_ALL;
55800c88d5efSMatthias Ringwald                 return;
55810c88d5efSMatthias Ringwald             }
5582091e35e3SMatthias Ringwald #endif
5583091e35e3SMatthias Ringwald #endif
55840c88d5efSMatthias Ringwald 
55850c88d5efSMatthias Ringwald             /* fall through */
55860c88d5efSMatthias Ringwald 
55870c88d5efSMatthias Ringwald         case HCI_HALTING_DISCONNECT_ALL:
55880c88d5efSMatthias Ringwald             hci_stack->substate = HCI_HALTING_DISCONNECT_ALL;
5589911801caSMatthias Ringwald             if (!hci_can_send_command_packet_now()) return;
55900c88d5efSMatthias Ringwald 
5591091e35e3SMatthias Ringwald             // close all open connections
5592091e35e3SMatthias Ringwald             connection = (hci_connection_t *) hci_stack->connections;
5593091e35e3SMatthias Ringwald             if (connection) {
5594091e35e3SMatthias Ringwald                 hci_con_handle_t con_handle = (uint16_t) connection->con_handle;
5595091e35e3SMatthias Ringwald 
559603270f05SMatthias Ringwald                 log_info("HCI_STATE_HALTING, connection %p, handle %u, state %u", connection, con_handle, connection->state);
5597091e35e3SMatthias Ringwald 
559803270f05SMatthias Ringwald                 // check state
559903270f05SMatthias Ringwald                 switch(connection->state) {
560003270f05SMatthias Ringwald                     case SENT_DISCONNECT:
560103270f05SMatthias Ringwald                     case RECEIVED_DISCONNECTION_COMPLETE:
560203270f05SMatthias Ringwald                         // wait until connection is gone
560303270f05SMatthias Ringwald                         return;
560403270f05SMatthias Ringwald                     default:
560503270f05SMatthias Ringwald                         break;
560603270f05SMatthias Ringwald                 }
5607091e35e3SMatthias Ringwald 
5608091e35e3SMatthias Ringwald                 // finally, send the disconnect command
560903270f05SMatthias Ringwald                 connection->state = SENT_DISCONNECT;
5610091e35e3SMatthias Ringwald                 hci_send_cmd(&hci_disconnect, con_handle, ERROR_CODE_REMOTE_USER_TERMINATED_CONNECTION);
5611091e35e3SMatthias Ringwald                 return;
5612091e35e3SMatthias Ringwald             }
5613091e35e3SMatthias Ringwald 
5614346f8c2cSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
5615346f8c2cSMatthias Ringwald             // stop BIGs and BIG Syncs
5616346f8c2cSMatthias Ringwald             if (hci_stack->le_audio_bigs != NULL){
5617346f8c2cSMatthias Ringwald                 le_audio_big_t * big = (le_audio_big_t*) hci_stack->le_audio_bigs;
5618346f8c2cSMatthias Ringwald                 if (big->state == LE_AUDIO_BIG_STATE_W4_TERMINATED) return;
5619346f8c2cSMatthias Ringwald                 big->state = LE_AUDIO_BIG_STATE_W4_TERMINATED;
5620346f8c2cSMatthias Ringwald                 hci_send_cmd(&hci_le_terminate_big, big->big_handle);
5621346f8c2cSMatthias Ringwald                 return;
5622346f8c2cSMatthias Ringwald             }
5623346f8c2cSMatthias Ringwald             if (hci_stack->le_audio_big_syncs != NULL){
5624346f8c2cSMatthias Ringwald                 le_audio_big_sync_t * big_sync = (le_audio_big_sync_t*) hci_stack->le_audio_big_syncs;
5625346f8c2cSMatthias Ringwald                 if (big_sync->state == LE_AUDIO_BIG_STATE_W4_TERMINATED) return;
5626346f8c2cSMatthias Ringwald                 big_sync->state = LE_AUDIO_BIG_STATE_W4_TERMINATED;
5627346f8c2cSMatthias Ringwald                 hci_send_cmd(&hci_le_big_terminate_sync, big_sync->big_handle);
5628346f8c2cSMatthias Ringwald                 return;
5629346f8c2cSMatthias Ringwald             }
5630346f8c2cSMatthias Ringwald #endif
5631346f8c2cSMatthias Ringwald 
5632091e35e3SMatthias Ringwald             btstack_run_loop_remove_timer(&hci_stack->timeout);
5633091e35e3SMatthias Ringwald 
5634091e35e3SMatthias Ringwald             // no connections left, wait a bit to assert that btstack_cyrpto isn't waiting for an HCI event
5635091e35e3SMatthias Ringwald             log_info("HCI_STATE_HALTING: wait 50 ms");
56360c88d5efSMatthias Ringwald             hci_stack->substate = HCI_HALTING_W4_CLOSE_TIMER;
5637091e35e3SMatthias Ringwald             btstack_run_loop_set_timer(&hci_stack->timeout, 50);
5638091e35e3SMatthias Ringwald             btstack_run_loop_set_timer_handler(&hci_stack->timeout, hci_halting_timeout_handler);
5639091e35e3SMatthias Ringwald             btstack_run_loop_add_timer(&hci_stack->timeout);
5640091e35e3SMatthias Ringwald             break;
5641091e35e3SMatthias Ringwald 
5642b188b5fcSMatthias Ringwald         case HCI_HALTING_W4_CLOSE_TIMER:
5643b188b5fcSMatthias Ringwald             // keep waiting
5644b188b5fcSMatthias Ringwald             break;
5645b188b5fcSMatthias Ringwald 
5646091e35e3SMatthias Ringwald         case HCI_HALTING_CLOSE:
5647091e35e3SMatthias Ringwald             // close left over connections (that had not been properly closed before)
5648b188b5fcSMatthias Ringwald             hci_stack->substate = HCI_HALTING_CLOSE_DISCARDING_CONNECTIONS;
5649091e35e3SMatthias Ringwald             hci_discard_connections();
5650091e35e3SMatthias Ringwald 
5651091e35e3SMatthias Ringwald             log_info("HCI_STATE_HALTING, calling off");
5652091e35e3SMatthias Ringwald 
5653091e35e3SMatthias Ringwald             // switch mode
5654091e35e3SMatthias Ringwald             hci_power_control_off();
5655091e35e3SMatthias Ringwald 
5656091e35e3SMatthias Ringwald             log_info("HCI_STATE_HALTING, emitting state");
5657091e35e3SMatthias Ringwald             hci_emit_state();
5658091e35e3SMatthias Ringwald             log_info("HCI_STATE_HALTING, done");
5659091e35e3SMatthias Ringwald             break;
5660091e35e3SMatthias Ringwald 
5661091e35e3SMatthias Ringwald         default:
5662091e35e3SMatthias Ringwald             break;
5663091e35e3SMatthias Ringwald     }
5664091e35e3SMatthias Ringwald };
5665091e35e3SMatthias Ringwald 
5666091e35e3SMatthias Ringwald static void hci_falling_asleep_run(void){
5667091e35e3SMatthias Ringwald     hci_connection_t * connection;
5668091e35e3SMatthias Ringwald     switch(hci_stack->substate) {
5669091e35e3SMatthias Ringwald         case HCI_FALLING_ASLEEP_DISCONNECT:
5670091e35e3SMatthias Ringwald             log_info("HCI_STATE_FALLING_ASLEEP");
5671091e35e3SMatthias Ringwald             // close all open connections
5672091e35e3SMatthias Ringwald             connection =  (hci_connection_t *) hci_stack->connections;
5673091e35e3SMatthias Ringwald             if (connection){
5674091e35e3SMatthias Ringwald 
5675091e35e3SMatthias Ringwald                 // send disconnect
5676091e35e3SMatthias Ringwald                 if (!hci_can_send_command_packet_now()) return;
5677091e35e3SMatthias Ringwald 
5678091e35e3SMatthias Ringwald                 log_info("HCI_STATE_FALLING_ASLEEP, connection %p, handle %u", connection, (uint16_t)connection->con_handle);
5679091e35e3SMatthias Ringwald                 hci_send_cmd(&hci_disconnect, connection->con_handle, ERROR_CODE_REMOTE_USER_TERMINATED_CONNECTION);
5680091e35e3SMatthias Ringwald 
5681091e35e3SMatthias Ringwald                 // send disconnected event right away - causes higher layer connections to get closed, too.
5682091e35e3SMatthias Ringwald                 hci_shutdown_connection(connection);
5683091e35e3SMatthias Ringwald                 return;
5684091e35e3SMatthias Ringwald             }
5685091e35e3SMatthias Ringwald 
5686091e35e3SMatthias Ringwald             if (hci_classic_supported()){
5687091e35e3SMatthias Ringwald                 // disable page and inquiry scan
5688091e35e3SMatthias Ringwald                 if (!hci_can_send_command_packet_now()) return;
5689091e35e3SMatthias Ringwald 
5690091e35e3SMatthias Ringwald                 log_info("HCI_STATE_HALTING, disabling inq scans");
5691091e35e3SMatthias Ringwald                 hci_send_cmd(&hci_write_scan_enable, hci_stack->connectable << 1); // drop inquiry scan but keep page scan
5692091e35e3SMatthias Ringwald 
5693091e35e3SMatthias Ringwald                 // continue in next sub state
5694091e35e3SMatthias Ringwald                 hci_stack->substate = HCI_FALLING_ASLEEP_W4_WRITE_SCAN_ENABLE;
5695091e35e3SMatthias Ringwald                 break;
5696091e35e3SMatthias Ringwald             }
5697091e35e3SMatthias Ringwald 
5698091e35e3SMatthias Ringwald             /* fall through */
5699091e35e3SMatthias Ringwald 
5700091e35e3SMatthias Ringwald             case HCI_FALLING_ASLEEP_COMPLETE:
5701091e35e3SMatthias Ringwald                 log_info("HCI_STATE_HALTING, calling sleep");
5702091e35e3SMatthias Ringwald                 // switch mode
5703091e35e3SMatthias Ringwald                 hci_power_control_sleep();  // changes hci_stack->state to SLEEP
5704091e35e3SMatthias Ringwald                 hci_emit_state();
5705091e35e3SMatthias Ringwald                 break;
5706091e35e3SMatthias Ringwald 
5707091e35e3SMatthias Ringwald                 default:
5708091e35e3SMatthias Ringwald                     break;
5709091e35e3SMatthias Ringwald     }
5710091e35e3SMatthias Ringwald }
5711091e35e3SMatthias Ringwald 
571235454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
571335454696SMatthias Ringwald 
5714758b46ceSmatthias.ringwald static void hci_update_scan_enable(void){
5715758b46ceSmatthias.ringwald     // 2 = page scan, 1 = inq scan
5716a1df452eSMatthias Ringwald     hci_stack->new_scan_enable_value  = (hci_stack->connectable << 1) | hci_stack->discoverable;
5717baa4881eSMatthias Ringwald     hci_stack->gap_tasks_classic |= GAP_TASK_WRITE_SCAN_ENABLE;
5718758b46ceSmatthias.ringwald     hci_run();
5719758b46ceSmatthias.ringwald }
5720758b46ceSmatthias.ringwald 
572115a95bd5SMatthias Ringwald void gap_discoverable_control(uint8_t enable){
5722381fbed8Smatthias.ringwald     if (enable) enable = 1; // normalize argument
5723381fbed8Smatthias.ringwald 
57243a9fb326S[email protected]     if (hci_stack->discoverable == enable){
572571fd255dSMatthias Ringwald         hci_emit_scan_mode_changed(hci_stack->discoverable, hci_stack->connectable);
5726381fbed8Smatthias.ringwald         return;
5727381fbed8Smatthias.ringwald     }
5728381fbed8Smatthias.ringwald 
57293a9fb326S[email protected]     hci_stack->discoverable = enable;
5730758b46ceSmatthias.ringwald     hci_update_scan_enable();
5731758b46ceSmatthias.ringwald }
5732b031bebbSmatthias.ringwald 
573315a95bd5SMatthias Ringwald void gap_connectable_control(uint8_t enable){
5734758b46ceSmatthias.ringwald     if (enable) enable = 1; // normalize argument
5735758b46ceSmatthias.ringwald 
5736758b46ceSmatthias.ringwald     // don't emit event
57373a9fb326S[email protected]     if (hci_stack->connectable == enable) return;
5738758b46ceSmatthias.ringwald 
57393a9fb326S[email protected]     hci_stack->connectable = enable;
5740758b46ceSmatthias.ringwald     hci_update_scan_enable();
5741381fbed8Smatthias.ringwald }
574235454696SMatthias Ringwald #endif
5743381fbed8Smatthias.ringwald 
574415a95bd5SMatthias Ringwald void gap_local_bd_addr(bd_addr_t address_buffer){
57456535961aSMatthias Ringwald     (void)memcpy(address_buffer, hci_stack->local_bd_addr, 6);
57465061f3afS[email protected] }
57475061f3afS[email protected] 
57482b838201SMatthias Ringwald #ifdef ENABLE_HCI_CONTROLLER_TO_HOST_FLOW_CONTROL
57492b838201SMatthias Ringwald static void hci_host_num_completed_packets(void){
57502b838201SMatthias Ringwald 
57512b838201SMatthias Ringwald     // create packet manually as arrays are not supported and num_commands should not get reduced
57522b838201SMatthias Ringwald     hci_reserve_packet_buffer();
57532b838201SMatthias Ringwald     uint8_t * packet = hci_get_outgoing_packet_buffer();
57542b838201SMatthias Ringwald 
57552b838201SMatthias Ringwald     uint16_t size = 0;
57562b838201SMatthias Ringwald     uint16_t num_handles = 0;
57572b838201SMatthias Ringwald     packet[size++] = 0x35;
57582b838201SMatthias Ringwald     packet[size++] = 0x0c;
57592b838201SMatthias Ringwald     size++;  // skip param len
57602b838201SMatthias Ringwald     size++;  // skip num handles
57612b838201SMatthias Ringwald 
57622b838201SMatthias Ringwald     // add { handle, packets } entries
57632b838201SMatthias Ringwald     btstack_linked_item_t * it;
57642b838201SMatthias Ringwald     for (it = (btstack_linked_item_t *) hci_stack->connections; it ; it = it->next){
57652b838201SMatthias Ringwald         hci_connection_t * connection = (hci_connection_t *) it;
57662b838201SMatthias Ringwald         if (connection->num_packets_completed){
57672b838201SMatthias Ringwald             little_endian_store_16(packet, size, connection->con_handle);
57682b838201SMatthias Ringwald             size += 2;
57692b838201SMatthias Ringwald             little_endian_store_16(packet, size, connection->num_packets_completed);
57702b838201SMatthias Ringwald             size += 2;
57712b838201SMatthias Ringwald             //
57722b838201SMatthias Ringwald             num_handles++;
57732b838201SMatthias Ringwald             connection->num_packets_completed = 0;
57742b838201SMatthias Ringwald         }
57752b838201SMatthias Ringwald     }
57762b838201SMatthias Ringwald 
57772b838201SMatthias Ringwald     packet[2] = size - 3;
57782b838201SMatthias Ringwald     packet[3] = num_handles;
57792b838201SMatthias Ringwald 
57802b838201SMatthias Ringwald     hci_stack->host_completed_packets = 0;
57812b838201SMatthias Ringwald 
57822b838201SMatthias Ringwald     hci_dump_packet(HCI_COMMAND_DATA_PACKET, 0, packet, size);
57832b838201SMatthias Ringwald     hci_stack->hci_transport->send_packet(HCI_COMMAND_DATA_PACKET, packet, size);
57842b838201SMatthias Ringwald 
57852b838201SMatthias Ringwald     // release packet buffer for synchronous transport implementations
57862b838201SMatthias Ringwald     if (hci_transport_synchronous()){
5787e2d22487SMatthias Ringwald         hci_release_packet_buffer();
5788068b8592SMatthias Ringwald         hci_emit_transport_packet_sent();
57892b838201SMatthias Ringwald     }
57902b838201SMatthias Ringwald }
57912b838201SMatthias Ringwald #endif
57922b838201SMatthias Ringwald 
579326fe9592SMatthias Ringwald static void hci_halting_timeout_handler(btstack_timer_source_t * ds){
579426fe9592SMatthias Ringwald     UNUSED(ds);
579526fe9592SMatthias Ringwald     hci_stack->substate = HCI_HALTING_CLOSE;
5796f021201aSMatthias Ringwald     hci_halting_run();
579726fe9592SMatthias Ringwald }
579826fe9592SMatthias Ringwald 
5799f30077b7SMatthias Ringwald static bool hci_run_acl_fragments(void){
58004ea43905SMatthias Ringwald     if (hci_stack->acl_fragmentation_total_size > 0u) {
5801b5d8b22bS[email protected]         hci_con_handle_t con_handle = READ_ACL_CONNECTION_HANDLE(hci_stack->hci_packet_buffer);
5802b5d8b22bS[email protected]         hci_connection_t *connection = hci_connection_for_handle(con_handle);
5803b5d8b22bS[email protected]         if (connection) {
580428a0332dSMatthias Ringwald             if (hci_can_send_prepared_acl_packet_now(con_handle)){
5805b5d8b22bS[email protected]                 hci_send_acl_packet_fragments(connection);
5806f30077b7SMatthias Ringwald                 return true;
5807b5d8b22bS[email protected]             }
580828a0332dSMatthias Ringwald         } else {
5809b5d8b22bS[email protected]             // connection gone -> discard further fragments
581028a0332dSMatthias Ringwald             log_info("hci_run: fragmented ACL packet no connection -> discard fragment");
5811b5d8b22bS[email protected]             hci_stack->acl_fragmentation_total_size = 0;
5812b5d8b22bS[email protected]             hci_stack->acl_fragmentation_pos = 0;
5813b5d8b22bS[email protected]         }
5814b5d8b22bS[email protected]     }
5815f30077b7SMatthias Ringwald     return false;
58162b838201SMatthias Ringwald }
5817b031bebbSmatthias.ringwald 
581868ab6207SMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
581968ab6207SMatthias Ringwald static bool hci_run_iso_fragments(void){
582068ab6207SMatthias Ringwald     if (hci_stack->iso_fragmentation_total_size > 0u) {
582168ab6207SMatthias Ringwald         // TODO: flow control
582268ab6207SMatthias Ringwald         if (hci_transport_can_send_prepared_packet_now(HCI_ISO_DATA_PACKET)){
582368ab6207SMatthias Ringwald             hci_send_iso_packet_fragments();
582468ab6207SMatthias Ringwald             return true;
582568ab6207SMatthias Ringwald         }
582668ab6207SMatthias Ringwald     }
582768ab6207SMatthias Ringwald     return false;
582868ab6207SMatthias Ringwald }
582968ab6207SMatthias Ringwald #endif
583068ab6207SMatthias Ringwald 
583135454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
58326c0d5426SMatthias Ringwald 
58336c0d5426SMatthias Ringwald #ifdef ENABLE_HCI_SERIALIZED_CONTROLLER_OPERATIONS
58346c0d5426SMatthias Ringwald static bool hci_classic_operation_active(void) {
58356c0d5426SMatthias Ringwald     if (hci_stack->inquiry_state >= GAP_INQUIRY_STATE_W4_ACTIVE){
58366c0d5426SMatthias Ringwald         return true;
58376c0d5426SMatthias Ringwald     }
58386c0d5426SMatthias Ringwald     if (hci_stack->remote_name_state == GAP_REMOTE_NAME_STATE_W4_COMPLETE){
58396c0d5426SMatthias Ringwald         return true;
58406c0d5426SMatthias Ringwald     }
58416c0d5426SMatthias Ringwald     btstack_linked_item_t * it;
58426c0d5426SMatthias Ringwald     for (it = (btstack_linked_item_t *) hci_stack->connections; it != NULL; it = it->next) {
58436c0d5426SMatthias Ringwald         hci_connection_t *connection = (hci_connection_t *) it;
58446c0d5426SMatthias Ringwald         switch (connection->state) {
58456c0d5426SMatthias Ringwald             case SENT_CREATE_CONNECTION:
58466c0d5426SMatthias Ringwald             case SENT_CANCEL_CONNECTION:
58476c0d5426SMatthias Ringwald             case SENT_DISCONNECT:
58486c0d5426SMatthias Ringwald                 return true;
58496c0d5426SMatthias Ringwald             default:
58506c0d5426SMatthias Ringwald                 break;
58516c0d5426SMatthias Ringwald         }
58526c0d5426SMatthias Ringwald     }
58536c0d5426SMatthias Ringwald     return false;
58546c0d5426SMatthias Ringwald }
58556c0d5426SMatthias Ringwald #endif
58566c0d5426SMatthias Ringwald 
5857f30077b7SMatthias Ringwald static bool hci_run_general_gap_classic(void){
5858f30077b7SMatthias Ringwald 
585959d59ecfSMatthias Ringwald     // assert stack is working and classic is active
586059d59ecfSMatthias Ringwald     if (hci_classic_supported() == false)      return false;
586159d59ecfSMatthias Ringwald     if (hci_stack->state != HCI_STATE_WORKING) return false;
586259d59ecfSMatthias Ringwald 
5863b031bebbSmatthias.ringwald     // decline incoming connections
58643a9fb326S[email protected]     if (hci_stack->decline_reason){
58653a9fb326S[email protected]         uint8_t reason = hci_stack->decline_reason;
58663a9fb326S[email protected]         hci_stack->decline_reason = 0;
58673a9fb326S[email protected]         hci_send_cmd(&hci_reject_connection_request, hci_stack->decline_addr, reason);
5868f30077b7SMatthias Ringwald         return true;
5869ce4c8fabSmatthias.ringwald     }
587059d59ecfSMatthias Ringwald 
5871baa4881eSMatthias Ringwald     if (hci_stack->gap_tasks_classic != 0){
5872ab4831a3SMatthias Ringwald         hci_run_gap_tasks_classic();
5873f30077b7SMatthias Ringwald         return true;
5874b031bebbSmatthias.ringwald     }
587527741fe7SMatthias Ringwald 
5876f5875de5SMatthias Ringwald     // start/stop inquiry
5877a1df452eSMatthias Ringwald     if ((hci_stack->inquiry_state >= GAP_INQUIRY_DURATION_MIN) && (hci_stack->inquiry_state <= GAP_INQUIRY_DURATION_MAX)){
58786c0d5426SMatthias Ringwald #ifdef ENABLE_HCI_SERIALIZED_CONTROLLER_OPERATIONS
58796c0d5426SMatthias Ringwald         if (hci_classic_operation_active() == false)
58806c0d5426SMatthias Ringwald #endif
58816c0d5426SMatthias Ringwald         {
5882f5875de5SMatthias Ringwald             uint8_t duration = hci_stack->inquiry_state;
5883beb3c81dSMatthias Ringwald             hci_stack->inquiry_state = GAP_INQUIRY_STATE_W4_ACTIVE;
588430199e24SMatthias Ringwald             if (hci_stack->inquiry_max_period_length != 0){
588530199e24SMatthias Ringwald                 hci_send_cmd(&hci_periodic_inquiry_mode, hci_stack->inquiry_max_period_length, hci_stack->inquiry_min_period_length, hci_stack->inquiry_lap, duration, 0);
588630199e24SMatthias Ringwald             } else {
5887496bb884SMatthias Ringwald                 hci_send_cmd(&hci_inquiry, hci_stack->inquiry_lap, duration, 0);
588830199e24SMatthias Ringwald             }
5889f30077b7SMatthias Ringwald             return true;
5890f5875de5SMatthias Ringwald         }
58916c0d5426SMatthias Ringwald     }
5892f5875de5SMatthias Ringwald     if (hci_stack->inquiry_state == GAP_INQUIRY_STATE_W2_CANCEL){
5893f5875de5SMatthias Ringwald         hci_stack->inquiry_state = GAP_INQUIRY_STATE_W4_CANCELLED;
5894f5875de5SMatthias Ringwald         hci_send_cmd(&hci_inquiry_cancel);
5895f30077b7SMatthias Ringwald         return true;
5896f5875de5SMatthias Ringwald     }
589730199e24SMatthias Ringwald 
589830199e24SMatthias Ringwald     if (hci_stack->inquiry_state == GAP_INQUIRY_STATE_W2_EXIT_PERIODIC){
5899bc06f564SMatthias Ringwald         hci_stack->inquiry_state = GAP_INQUIRY_STATE_W4_CANCELLED;
590030199e24SMatthias Ringwald         hci_send_cmd(&hci_exit_periodic_inquiry_mode);
590130199e24SMatthias Ringwald         return true;
590230199e24SMatthias Ringwald     }
590330199e24SMatthias Ringwald 
5904b7f1ee76SMatthias Ringwald     // remote name request
5905b7f1ee76SMatthias Ringwald     if (hci_stack->remote_name_state == GAP_REMOTE_NAME_STATE_W2_SEND){
59066c0d5426SMatthias Ringwald #ifdef ENABLE_HCI_SERIALIZED_CONTROLLER_OPERATIONS
59076c0d5426SMatthias Ringwald         if (hci_classic_operation_active() == false)
59086c0d5426SMatthias Ringwald #endif
59096c0d5426SMatthias Ringwald         {
5910b7f1ee76SMatthias Ringwald             hci_stack->remote_name_state = GAP_REMOTE_NAME_STATE_W4_COMPLETE;
5911b7f1ee76SMatthias Ringwald             hci_send_cmd(&hci_remote_name_request, hci_stack->remote_name_addr,
5912ee8a36c8SMatthias Ringwald                          hci_stack->remote_name_page_scan_repetition_mode, 0, hci_stack->remote_name_clock_offset);
5913f30077b7SMatthias Ringwald             return true;
5914b7f1ee76SMatthias Ringwald         }
59156c0d5426SMatthias Ringwald     }
5916cf01e888SMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB
5917cf01e888SMatthias Ringwald     // Local OOB data
591859d59ecfSMatthias Ringwald     if (hci_stack->classic_read_local_oob_data){
5919cf01e888SMatthias Ringwald         hci_stack->classic_read_local_oob_data = false;
59201e83575aSMatthias Ringwald         if (hci_command_supported(SUPPORTED_HCI_COMMAND_READ_LOCAL_OOB_EXTENDED_DATA_COMMAND)){
5921cf01e888SMatthias Ringwald             hci_send_cmd(&hci_read_local_extended_oob_data);
5922cf01e888SMatthias Ringwald         } else {
5923cf01e888SMatthias Ringwald             hci_send_cmd(&hci_read_local_oob_data);
5924cf01e888SMatthias Ringwald         }
5925cf01e888SMatthias Ringwald     }
5926cf01e888SMatthias Ringwald #endif
59270a51f88bSMatthias Ringwald     // pairing
59280a51f88bSMatthias Ringwald     if (hci_stack->gap_pairing_state != GAP_PAIRING_STATE_IDLE){
59290a51f88bSMatthias Ringwald         uint8_t state = hci_stack->gap_pairing_state;
5930c26f2c7bSMatthias Ringwald         uint8_t pin_code[PIN_CODE_LEN];
59310a51f88bSMatthias Ringwald         switch (state){
59320a51f88bSMatthias Ringwald             case GAP_PAIRING_STATE_SEND_PIN:
5933cc15bb2cSMatthias Ringwald                 hci_stack->gap_pairing_state = GAP_PAIRING_STATE_IDLE;
59343f659ee4SMilanka Ringwald                 memset(pin_code, 0, 16);
59353f659ee4SMilanka Ringwald                 memcpy(pin_code, hci_stack->gap_pairing_input.gap_pairing_pin, hci_stack->gap_pairing_pin_len);
59363f659ee4SMilanka Ringwald                 hci_send_cmd(&hci_pin_code_request_reply, hci_stack->gap_pairing_addr, hci_stack->gap_pairing_pin_len, pin_code);
59370a51f88bSMatthias Ringwald                 break;
59380a51f88bSMatthias Ringwald             case GAP_PAIRING_STATE_SEND_PIN_NEGATIVE:
5939cc15bb2cSMatthias Ringwald                 hci_stack->gap_pairing_state = GAP_PAIRING_STATE_WAIT_FOR_COMMAND_COMPLETE;
59400a51f88bSMatthias Ringwald                 hci_send_cmd(&hci_pin_code_request_negative_reply, hci_stack->gap_pairing_addr);
59410a51f88bSMatthias Ringwald                 break;
59420a51f88bSMatthias Ringwald             case GAP_PAIRING_STATE_SEND_PASSKEY:
5943cc15bb2cSMatthias Ringwald                 hci_stack->gap_pairing_state = GAP_PAIRING_STATE_IDLE;
5944d504181aSMatthias Ringwald                 hci_send_cmd(&hci_user_passkey_request_reply, hci_stack->gap_pairing_addr, hci_stack->gap_pairing_input.gap_pairing_passkey);
59450a51f88bSMatthias Ringwald                 break;
59460a51f88bSMatthias Ringwald             case GAP_PAIRING_STATE_SEND_PASSKEY_NEGATIVE:
5947cc15bb2cSMatthias Ringwald                 hci_stack->gap_pairing_state = GAP_PAIRING_STATE_WAIT_FOR_COMMAND_COMPLETE;
59480a51f88bSMatthias Ringwald                 hci_send_cmd(&hci_user_passkey_request_negative_reply, hci_stack->gap_pairing_addr);
59490a51f88bSMatthias Ringwald                 break;
59500a51f88bSMatthias Ringwald             case GAP_PAIRING_STATE_SEND_CONFIRMATION:
5951cc15bb2cSMatthias Ringwald                 hci_stack->gap_pairing_state = GAP_PAIRING_STATE_IDLE;
59520a51f88bSMatthias Ringwald                 hci_send_cmd(&hci_user_confirmation_request_reply, hci_stack->gap_pairing_addr);
59530a51f88bSMatthias Ringwald                 break;
59540a51f88bSMatthias Ringwald             case GAP_PAIRING_STATE_SEND_CONFIRMATION_NEGATIVE:
5955cc15bb2cSMatthias Ringwald                 hci_stack->gap_pairing_state = GAP_PAIRING_STATE_WAIT_FOR_COMMAND_COMPLETE;
59560a51f88bSMatthias Ringwald                 hci_send_cmd(&hci_user_confirmation_request_negative_reply, hci_stack->gap_pairing_addr);
59570a51f88bSMatthias Ringwald                 break;
59580a51f88bSMatthias Ringwald             default:
59590a51f88bSMatthias Ringwald                 break;
59600a51f88bSMatthias Ringwald         }
5961f30077b7SMatthias Ringwald         return true;
5962f30077b7SMatthias Ringwald     }
5963f30077b7SMatthias Ringwald     return false;
59640a51f88bSMatthias Ringwald }
596535454696SMatthias Ringwald #endif
5966b031bebbSmatthias.ringwald 
5967a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE
5968be7ef9d8SMatthias Ringwald 
59697eb5b27eSMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
59707eb5b27eSMatthias Ringwald static uint8_t hci_le_num_phys(uint8_t phys){
59717eb5b27eSMatthias Ringwald     const uint8_t num_bits_set[] = { 0, 1, 1, 2, 1, 2, 2, 3 };
59727eb5b27eSMatthias Ringwald     btstack_assert(phys);
59737eb5b27eSMatthias Ringwald     return num_bits_set[phys];
59747eb5b27eSMatthias Ringwald }
59757eb5b27eSMatthias Ringwald #endif
59767eb5b27eSMatthias Ringwald 
5977c42da3bcSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
5978c42da3bcSMatthias Ringwald static void hci_le_scan_stop(void){
5979c42da3bcSMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
598022f987e4SMatthias Ringwald     if (hci_le_extended_advertising_supported()) {
5981c42da3bcSMatthias Ringwald             hci_send_cmd(&hci_le_set_extended_scan_enable, 0, 0, 0, 0);
5982c42da3bcSMatthias Ringwald     } else
5983c42da3bcSMatthias Ringwald #endif
5984c42da3bcSMatthias Ringwald     {
5985c42da3bcSMatthias Ringwald         hci_send_cmd(&hci_le_set_scan_enable, 0, 0);
5986c42da3bcSMatthias Ringwald     }
5987c42da3bcSMatthias Ringwald }
5988327f7f07SMatthias Ringwald 
5989f346015eSMatthias Ringwald static void
5990f346015eSMatthias Ringwald hci_send_le_create_connection(uint8_t initiator_filter_policy, bd_addr_type_t address_type, uint8_t *address) {
5991327f7f07SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
599222f987e4SMatthias Ringwald     if (hci_le_extended_advertising_supported()) {
59937eb5b27eSMatthias Ringwald         // prepare arrays for all phys (LE Coded, LE 1M, LE 2M PHY)
59947eb5b27eSMatthias Ringwald         uint16_t le_connection_scan_interval[3];
59957eb5b27eSMatthias Ringwald         uint16_t le_connection_scan_window[3];
59967eb5b27eSMatthias Ringwald         uint16_t le_connection_interval_min[3];
59977eb5b27eSMatthias Ringwald         uint16_t le_connection_interval_max[3];
59987eb5b27eSMatthias Ringwald         uint16_t le_connection_latency[3];
59997eb5b27eSMatthias Ringwald         uint16_t le_supervision_timeout[3];
60007eb5b27eSMatthias Ringwald         uint16_t le_minimum_ce_length[3];
60017eb5b27eSMatthias Ringwald         uint16_t le_maximum_ce_length[3];
60027eb5b27eSMatthias Ringwald 
60037eb5b27eSMatthias Ringwald         uint8_t i;
60047eb5b27eSMatthias Ringwald         uint8_t num_phys = hci_le_num_phys(hci_stack->le_connection_phys);
60057eb5b27eSMatthias Ringwald         for (i=0;i<num_phys;i++){
60067eb5b27eSMatthias Ringwald             le_connection_scan_interval[i] = hci_stack->le_connection_scan_interval;
60077eb5b27eSMatthias Ringwald             le_connection_scan_window[i]   = hci_stack->le_connection_scan_window;
60087eb5b27eSMatthias Ringwald             le_connection_interval_min[i]  = hci_stack->le_connection_interval_min;
60097eb5b27eSMatthias Ringwald             le_connection_interval_max[i]  = hci_stack->le_connection_interval_max;
60107eb5b27eSMatthias Ringwald             le_connection_latency[i]       = hci_stack->le_connection_latency;
60117eb5b27eSMatthias Ringwald             le_supervision_timeout[i]      = hci_stack->le_supervision_timeout;
60127eb5b27eSMatthias Ringwald             le_minimum_ce_length[i]        = hci_stack->le_minimum_ce_length;
60137eb5b27eSMatthias Ringwald             le_maximum_ce_length[i]        = hci_stack->le_maximum_ce_length;
60147eb5b27eSMatthias Ringwald         }
6015327f7f07SMatthias Ringwald         hci_send_cmd(&hci_le_extended_create_connection,
6016f346015eSMatthias Ringwald                      initiator_filter_policy,
6017327f7f07SMatthias Ringwald                      hci_stack->le_connection_own_addr_type,   // our addr type:
6018f346015eSMatthias Ringwald                      address_type,                  // peer address type
6019f346015eSMatthias Ringwald                      address,                       // peer bd addr
60207eb5b27eSMatthias Ringwald                      hci_stack->le_connection_phys, // initiating PHY
6021327f7f07SMatthias Ringwald                      le_connection_scan_interval,   // conn scan interval
6022327f7f07SMatthias Ringwald                      le_connection_scan_window,     // conn scan windows
6023327f7f07SMatthias Ringwald                      le_connection_interval_min,    // conn interval min
6024327f7f07SMatthias Ringwald                      le_connection_interval_max,    // conn interval max
6025327f7f07SMatthias Ringwald                      le_connection_latency,         // conn latency
6026327f7f07SMatthias Ringwald                      le_supervision_timeout,        // conn latency
6027327f7f07SMatthias Ringwald                      le_minimum_ce_length,          // min ce length
6028327f7f07SMatthias Ringwald                      le_maximum_ce_length           // max ce length
6029327f7f07SMatthias Ringwald         );
6030d935373dSMatthias Ringwald     } else
6031327f7f07SMatthias Ringwald #endif
6032327f7f07SMatthias Ringwald     {
6033327f7f07SMatthias Ringwald         hci_send_cmd(&hci_le_create_connection,
6034327f7f07SMatthias Ringwald                      hci_stack->le_connection_scan_interval,  // conn scan interval
6035327f7f07SMatthias Ringwald                      hci_stack->le_connection_scan_window,    // conn scan windows
6036f346015eSMatthias Ringwald                      initiator_filter_policy,                 // don't use whitelist
6037f346015eSMatthias Ringwald                      address_type,                            // peer address type
6038f346015eSMatthias Ringwald                      address,                                 // peer bd addr
6039327f7f07SMatthias Ringwald                      hci_stack->le_connection_own_addr_type,  // our addr type:
6040327f7f07SMatthias Ringwald                      hci_stack->le_connection_interval_min,   // conn interval min
6041327f7f07SMatthias Ringwald                      hci_stack->le_connection_interval_max,   // conn interval max
6042327f7f07SMatthias Ringwald                      hci_stack->le_connection_latency,        // conn latency
6043327f7f07SMatthias Ringwald                      hci_stack->le_supervision_timeout,       // conn latency
6044327f7f07SMatthias Ringwald                      hci_stack->le_minimum_ce_length,         // min ce length
6045327f7f07SMatthias Ringwald                      hci_stack->le_maximum_ce_length          // max ce length
6046327f7f07SMatthias Ringwald         );
6047327f7f07SMatthias Ringwald     }
6048327f7f07SMatthias Ringwald }
6049c42da3bcSMatthias Ringwald #endif
6050c42da3bcSMatthias Ringwald 
6051be7ef9d8SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
6052be7ef9d8SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
6053033393eeSBob Abeles static uint8_t hci_le_extended_advertising_operation_for_chunk(uint16_t pos, uint16_t len){
6054be7ef9d8SMatthias Ringwald     uint8_t  operation = 0;
6055be7ef9d8SMatthias Ringwald     if (pos == 0){
6056be7ef9d8SMatthias Ringwald         // first fragment or complete data
6057be7ef9d8SMatthias Ringwald         operation |= 1;
6058be7ef9d8SMatthias Ringwald     }
6059be7ef9d8SMatthias Ringwald     if (pos + LE_EXTENDED_ADVERTISING_MAX_CHUNK_LEN >= len){
6060be7ef9d8SMatthias Ringwald         // last fragment or complete data
6061be7ef9d8SMatthias Ringwald         operation |= 2;
6062be7ef9d8SMatthias Ringwald     }
6063be7ef9d8SMatthias Ringwald     return operation;
6064be7ef9d8SMatthias Ringwald }
6065be7ef9d8SMatthias Ringwald #endif
6066be7ef9d8SMatthias Ringwald #endif
6067be7ef9d8SMatthias Ringwald 
6068f30077b7SMatthias Ringwald static bool hci_run_general_gap_le(void){
6069f30077b7SMatthias Ringwald 
6070f40c73b4SMatthias Ringwald     btstack_linked_list_iterator_t lit;
6071f40c73b4SMatthias Ringwald 
60722052d96cSMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
60732052d96cSMatthias Ringwald     if (hci_stack->le_resolvable_private_address_update_s > 0){
60742052d96cSMatthias Ringwald         uint16_t update_s = hci_stack->le_resolvable_private_address_update_s;
60752052d96cSMatthias Ringwald         hci_stack->le_resolvable_private_address_update_s = 0;
60762052d96cSMatthias Ringwald         hci_send_cmd(&hci_le_set_resolvable_private_address_timeout, update_s);
60772052d96cSMatthias Ringwald         return true;
60782052d96cSMatthias Ringwald     }
60792052d96cSMatthias Ringwald #endif
60802052d96cSMatthias Ringwald 
6081a41310b7SMatthias Ringwald     // Phase 1: collect what to stop
6082a41310b7SMatthias Ringwald 
608349a6c69cSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
6084a41310b7SMatthias Ringwald     bool scanning_stop = false;
6085a41310b7SMatthias Ringwald     bool connecting_stop = false;
6086be7ef9d8SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
6087c814a904SMatthias Ringwald #ifdef ENABLE_LE_PERIODIC_ADVERTISING
60884bafedd5SMatthias Ringwald     bool periodic_sync_stop = false;
60894bafedd5SMatthias Ringwald #endif
6090be7ef9d8SMatthias Ringwald #endif
6091c814a904SMatthias Ringwald #endif
6092be7ef9d8SMatthias Ringwald 
609349a6c69cSMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
609449a6c69cSMatthias Ringwald     bool advertising_stop = false;
609549a6c69cSMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
609649a6c69cSMatthias Ringwald     le_advertising_set_t * advertising_stop_set = NULL;
609749a6c69cSMatthias Ringwald #ifdef ENABLE_LE_PERIODIC_ADVERTISING
609849a6c69cSMatthias Ringwald     bool periodic_advertising_stop = false;
6099a41310b7SMatthias Ringwald #endif
610049a6c69cSMatthias Ringwald #endif
6101a41310b7SMatthias Ringwald #endif
6102a41310b7SMatthias Ringwald 
61039136bde8SMatthias Ringwald     // check if own address changes
61049ce6dfa1SMatthias Ringwald     uint8_t address_change_mask = LE_ADVERTISEMENT_TASKS_SET_ADDRESS | LE_ADVERTISEMENT_TASKS_SET_ADDRESS_SET_0;
61059ce6dfa1SMatthias Ringwald     bool random_address_change = (hci_stack->le_advertisements_todo & address_change_mask) != 0;
61069136bde8SMatthias Ringwald 
610729c24bebSMatthias Ringwald     // check if whitelist needs modification
610829c24bebSMatthias Ringwald     bool whitelist_modification_pending = false;
610929c24bebSMatthias Ringwald     btstack_linked_list_iterator_init(&lit, &hci_stack->le_whitelist);
611029c24bebSMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&lit)){
611129c24bebSMatthias Ringwald         whitelist_entry_t * entry = (whitelist_entry_t*) btstack_linked_list_iterator_next(&lit);
611229c24bebSMatthias Ringwald         if (entry->state & (LE_WHITELIST_REMOVE_FROM_CONTROLLER | LE_WHITELIST_ADD_TO_CONTROLLER)){
611329c24bebSMatthias Ringwald             whitelist_modification_pending = true;
611429c24bebSMatthias Ringwald             break;
611529c24bebSMatthias Ringwald         }
611629c24bebSMatthias Ringwald     }
6117f40c73b4SMatthias Ringwald 
611821debf25SMatthias Ringwald     // check if resolving list needs modification
611921debf25SMatthias Ringwald     bool resolving_list_modification_pending = false;
612021debf25SMatthias Ringwald #ifdef ENABLE_LE_PRIVACY_ADDRESS_RESOLUTION
61211ffa425cSMatthias Ringwald     bool resolving_list_supported = hci_command_supported(SUPPORTED_HCI_COMMAND_LE_SET_ADDRESS_RESOLUTION_ENABLE);
6122ea151974SMatthias Ringwald 	if (resolving_list_supported && hci_stack->le_resolving_list_state != LE_RESOLVING_LIST_DONE){
612321debf25SMatthias Ringwald         resolving_list_modification_pending = true;
612421debf25SMatthias Ringwald     }
612521debf25SMatthias Ringwald #endif
612629c24bebSMatthias Ringwald 
6127f40c73b4SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
612849a6c69cSMatthias Ringwald 
6129f40c73b4SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
613049a6c69cSMatthias Ringwald     // check if periodic advertiser list needs modification
6131f40c73b4SMatthias Ringwald     bool periodic_list_modification_pending = false;
6132f40c73b4SMatthias Ringwald     btstack_linked_list_iterator_init(&lit, &hci_stack->le_periodic_advertiser_list);
6133f40c73b4SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&lit)){
6134f40c73b4SMatthias Ringwald         periodic_advertiser_list_entry_t * entry = (periodic_advertiser_list_entry_t*) btstack_linked_list_iterator_next(&lit);
6135f40c73b4SMatthias Ringwald         if (entry->state & (LE_PERIODIC_ADVERTISER_LIST_ENTRY_ADD_TO_CONTROLLER | LE_PERIODIC_ADVERTISER_LIST_ENTRY_REMOVE_FROM_CONTROLLER)){
6136f40c73b4SMatthias Ringwald             periodic_list_modification_pending = true;
6137f40c73b4SMatthias Ringwald             break;
6138f40c73b4SMatthias Ringwald         }
6139f40c73b4SMatthias Ringwald     }
6140f40c73b4SMatthias Ringwald #endif
6141f40c73b4SMatthias Ringwald 
6142fde725feSMatthias Ringwald     // scanning control
61433251a108SMatthias Ringwald     if (hci_stack->le_scanning_active) {
614429c24bebSMatthias Ringwald         // stop if:
614529c24bebSMatthias Ringwald         // - parameter change required
614629c24bebSMatthias Ringwald         // - it's disabled
614729c24bebSMatthias Ringwald         // - whitelist change required but used for scanning
614821debf25SMatthias Ringwald         // - resolving list modified
614951e51a58SMatthias Ringwald         // - own address changes
615029c24bebSMatthias Ringwald         bool scanning_uses_whitelist = (hci_stack->le_scan_filter_policy & 1) == 1;
615121debf25SMatthias Ringwald         if ((hci_stack->le_scanning_param_update) ||
615221debf25SMatthias Ringwald             !hci_stack->le_scanning_enabled ||
6153d54b2c94SMatthias Ringwald             (scanning_uses_whitelist && whitelist_modification_pending) ||
615451e51a58SMatthias Ringwald             resolving_list_modification_pending ||
615551e51a58SMatthias Ringwald             random_address_change){
615621debf25SMatthias Ringwald 
61572d5c2a27SMatthias Ringwald             scanning_stop = true;
6158fde725feSMatthias Ringwald         }
6159fde725feSMatthias Ringwald     }
6160fde725feSMatthias Ringwald 
616129c24bebSMatthias Ringwald     // connecting control
6162f496d06eSMatthias Ringwald     bool connecting_with_whitelist;
6163f496d06eSMatthias Ringwald     switch (hci_stack->le_connecting_state){
6164f496d06eSMatthias Ringwald         case LE_CONNECTING_DIRECT:
6165f496d06eSMatthias Ringwald         case LE_CONNECTING_WHITELIST:
6166af64f147SMatthias Ringwald             // stop connecting if:
6167af64f147SMatthias Ringwald             // - connecting uses white and whitelist modification pending
6168af64f147SMatthias Ringwald             // - if it got disabled
616921debf25SMatthias Ringwald             // - resolving list modified
617051e51a58SMatthias Ringwald             // - own address changes
6171f496d06eSMatthias Ringwald             connecting_with_whitelist = hci_stack->le_connecting_state == LE_CONNECTING_WHITELIST;
6172f496d06eSMatthias Ringwald             if ((connecting_with_whitelist && whitelist_modification_pending) ||
617321debf25SMatthias Ringwald                 (hci_stack->le_connecting_request == LE_CONNECTING_IDLE) ||
617451e51a58SMatthias Ringwald                 resolving_list_modification_pending ||
617551e51a58SMatthias Ringwald                 random_address_change) {
617621debf25SMatthias Ringwald 
617729c24bebSMatthias Ringwald                 connecting_stop = true;
617829c24bebSMatthias Ringwald             }
6179f496d06eSMatthias Ringwald             break;
6180f496d06eSMatthias Ringwald         default:
6181f496d06eSMatthias Ringwald             break;
618229c24bebSMatthias Ringwald     }
618349a6c69cSMatthias Ringwald 
61844bafedd5SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
618549a6c69cSMatthias Ringwald #ifdef ENABLE_LE_PERIODIC_ADVERTISING
61864bafedd5SMatthias Ringwald     // periodic sync control
61874bafedd5SMatthias Ringwald     bool sync_with_advertiser_list;
61884bafedd5SMatthias Ringwald     switch(hci_stack->le_periodic_sync_state){
61894bafedd5SMatthias Ringwald         case LE_CONNECTING_DIRECT:
61904bafedd5SMatthias Ringwald         case LE_CONNECTING_WHITELIST:
619149a6c69cSMatthias Ringwald             // stop sync if:
61924bafedd5SMatthias Ringwald             // - sync with advertiser list and advertiser list modification pending
619349a6c69cSMatthias Ringwald             // - if it got disabled
61944bafedd5SMatthias Ringwald             sync_with_advertiser_list = hci_stack->le_periodic_sync_state == LE_CONNECTING_WHITELIST;
61954bafedd5SMatthias Ringwald             if ((sync_with_advertiser_list && periodic_list_modification_pending) ||
61964bafedd5SMatthias Ringwald                     (hci_stack->le_periodic_sync_request == LE_CONNECTING_IDLE)){
61974bafedd5SMatthias Ringwald                 periodic_sync_stop = true;
61984bafedd5SMatthias Ringwald             }
61994bafedd5SMatthias Ringwald             break;
62004bafedd5SMatthias Ringwald         default:
62014bafedd5SMatthias Ringwald             break;
62024bafedd5SMatthias Ringwald     }
62034bafedd5SMatthias Ringwald #endif
6204d70217a2SMatthias Ringwald #endif
620529c24bebSMatthias Ringwald 
620649a6c69cSMatthias Ringwald #endif /* ENABLE_LE_CENTRAL */
620749a6c69cSMatthias Ringwald 
6208d70217a2SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
620945c102fdSMatthias Ringwald     // le advertisement control
6210935aa76eSMatthias Ringwald     if ((hci_stack->le_advertisements_state & LE_ADVERTISEMENT_STATE_ACTIVE) != 0){
621129c24bebSMatthias Ringwald         // stop if:
621229c24bebSMatthias Ringwald         // - parameter change required
62139136bde8SMatthias Ringwald         // - random address used in advertising and changes
621429c24bebSMatthias Ringwald         // - it's disabled
6215ba44ad41SMatthias Ringwald         // - whitelist change required but used for advertisement filter policy
621621debf25SMatthias Ringwald         // - resolving list modified
621751e51a58SMatthias Ringwald         // - own address changes
6218a61834b6SMatthias Ringwald         bool advertising_uses_whitelist = hci_stack->le_advertisements_filter_policy != 0;
62199136bde8SMatthias Ringwald         bool advertising_uses_random_address = hci_stack->le_own_addr_type != BD_ADDR_TYPE_LE_PUBLIC;
62204e5d21eaSMatthias Ringwald         bool advertising_change    = (hci_stack->le_advertisements_todo & LE_ADVERTISEMENT_TASKS_SET_PARAMS)  != 0;
6221a61834b6SMatthias Ringwald         if (advertising_change ||
62229136bde8SMatthias Ringwald             (advertising_uses_random_address && random_address_change) ||
6223a61834b6SMatthias Ringwald             (hci_stack->le_advertisements_enabled_for_current_roles == 0) ||
62249136bde8SMatthias Ringwald             (advertising_uses_whitelist && whitelist_modification_pending) ||
622551e51a58SMatthias Ringwald             resolving_list_modification_pending ||
622651e51a58SMatthias Ringwald             random_address_change) {
622721debf25SMatthias Ringwald 
6228fde725feSMatthias Ringwald             advertising_stop = true;
6229fde725feSMatthias Ringwald         }
6230fde725feSMatthias Ringwald     }
6231be7ef9d8SMatthias Ringwald 
6232be7ef9d8SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
623322f987e4SMatthias Ringwald     if (hci_le_extended_advertising_supported() && (advertising_stop == false)){
6234be7ef9d8SMatthias Ringwald         btstack_linked_list_iterator_t it;
6235be7ef9d8SMatthias Ringwald         btstack_linked_list_iterator_init(&it, &hci_stack->le_advertising_sets);
6236be7ef9d8SMatthias Ringwald         while (btstack_linked_list_iterator_has_next(&it)){
6237be7ef9d8SMatthias Ringwald             le_advertising_set_t * advertising_set = (le_advertising_set_t*) btstack_linked_list_iterator_next(&it);
623853f240c0SMatthias Ringwald             if ((advertising_set->state & LE_ADVERTISEMENT_STATE_ACTIVE) != 0) {
6239be7ef9d8SMatthias Ringwald                 // stop if:
6240be7ef9d8SMatthias Ringwald                 // - parameter change required
6241be7ef9d8SMatthias Ringwald                 // - random address used in connectable advertising and changes
6242be7ef9d8SMatthias Ringwald                 // - it's disabled
6243be7ef9d8SMatthias Ringwald                 // - whitelist change required but used for advertisement filter policy
6244be7ef9d8SMatthias Ringwald                 // - resolving list modified
6245be7ef9d8SMatthias Ringwald                 // - own address changes
6246be7ef9d8SMatthias Ringwald                 // - advertisement set will be removed
624757a04237SMatthias Ringwald                 bool advertising_uses_whitelist = advertising_set->extended_params.advertising_filter_policy != 0;
624857a04237SMatthias Ringwald                 bool advertising_connectable = (advertising_set->extended_params.advertising_event_properties & 1) != 0;
624953f240c0SMatthias Ringwald                 bool advertising_uses_random_address =
625053f240c0SMatthias Ringwald                         (advertising_set->extended_params.own_address_type != BD_ADDR_TYPE_LE_PUBLIC) &&
625153f240c0SMatthias Ringwald                         advertising_connectable;
6252be7ef9d8SMatthias Ringwald                 bool advertising_parameter_change = (advertising_set->tasks & LE_ADVERTISEMENT_TASKS_SET_PARAMS) != 0;
6253be7ef9d8SMatthias Ringwald                 bool advertising_enabled = (advertising_set->state & LE_ADVERTISEMENT_STATE_ENABLED) != 0;
625453f240c0SMatthias Ringwald                 bool advertising_set_random_address_change =
625553f240c0SMatthias Ringwald                         (advertising_set->tasks & LE_ADVERTISEMENT_TASKS_SET_ADDRESS) != 0;
625653f240c0SMatthias Ringwald                 bool advertising_set_will_be_removed =
625753f240c0SMatthias Ringwald                         (advertising_set->state & LE_ADVERTISEMENT_TASKS_REMOVE_SET) != 0;
6258be7ef9d8SMatthias Ringwald                 if (advertising_parameter_change ||
6259be7ef9d8SMatthias Ringwald                     (advertising_uses_random_address && advertising_set_random_address_change) ||
6260be7ef9d8SMatthias Ringwald                     (advertising_enabled == false) ||
6261be7ef9d8SMatthias Ringwald                     (advertising_uses_whitelist && whitelist_modification_pending) ||
6262be7ef9d8SMatthias Ringwald                     resolving_list_modification_pending ||
6263be7ef9d8SMatthias Ringwald                     advertising_set_will_be_removed) {
6264be7ef9d8SMatthias Ringwald 
6265be7ef9d8SMatthias Ringwald                     advertising_stop = true;
6266be7ef9d8SMatthias Ringwald                     advertising_stop_set = advertising_set;
6267be7ef9d8SMatthias Ringwald                     break;
6268be7ef9d8SMatthias Ringwald                 }
6269be7ef9d8SMatthias Ringwald             }
6270c814a904SMatthias Ringwald #ifdef ENABLE_LE_PERIODIC_ADVERTISING
627153f240c0SMatthias Ringwald             if ((advertising_set->state & LE_ADVERTISEMENT_STATE_PERIODIC_ACTIVE) != 0) {
627253f240c0SMatthias Ringwald                 // stop if:
627353f240c0SMatthias Ringwald                 // - it's disabled
627453f240c0SMatthias Ringwald                 // - parameter change required
627553f240c0SMatthias Ringwald                 bool periodic_enabled = (advertising_set->state & LE_ADVERTISEMENT_STATE_PERIODIC_ENABLED) != 0;
627653f240c0SMatthias Ringwald                 bool periodic_parameter_change = (advertising_set->tasks & LE_ADVERTISEMENT_TASKS_SET_PERIODIC_PARAMS) != 0;
627753f240c0SMatthias Ringwald                 if ((periodic_enabled == false) || periodic_parameter_change){
627849a6c69cSMatthias Ringwald                     periodic_advertising_stop = true;
627953f240c0SMatthias Ringwald                     advertising_stop_set = advertising_set;
628053f240c0SMatthias Ringwald                 }
628153f240c0SMatthias Ringwald             }
628249a6c69cSMatthias Ringwald #endif /* ENABLE_LE_PERIODIC_ADVERTISING */
628353f240c0SMatthias Ringwald         }
6284be7ef9d8SMatthias Ringwald     }
6285be7ef9d8SMatthias Ringwald #endif
6286be7ef9d8SMatthias Ringwald 
6287a41310b7SMatthias Ringwald #endif
6288fde725feSMatthias Ringwald 
6289a41310b7SMatthias Ringwald 
6290a41310b7SMatthias Ringwald     // Phase 2: stop everything that should be off during modifications
6291a41310b7SMatthias Ringwald 
6292131d4778SMatthias Ringwald 
6293131d4778SMatthias Ringwald     // 2.1 Outgoing connection
6294131d4778SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
6295131d4778SMatthias Ringwald     if (connecting_stop){
6296131d4778SMatthias Ringwald         hci_send_cmd(&hci_le_create_connection_cancel);
6297131d4778SMatthias Ringwald         return true;
6298131d4778SMatthias Ringwald     }
6299131d4778SMatthias Ringwald #endif
6300131d4778SMatthias Ringwald 
6301131d4778SMatthias Ringwald     // 2.2 Scanning
6302a41310b7SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
6303a41310b7SMatthias Ringwald     if (scanning_stop){
63045226d7f2SMatthias Ringwald         hci_stack->le_scanning_active = false;
6305c42da3bcSMatthias Ringwald         hci_le_scan_stop();
6306a41310b7SMatthias Ringwald         return true;
6307a41310b7SMatthias Ringwald     }
6308a41310b7SMatthias Ringwald 
6309131d4778SMatthias Ringwald     // 2.3 Periodic Sync
63104bafedd5SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
631149a6c69cSMatthias Ringwald     if (hci_stack->le_periodic_terminate_sync_handle != HCI_CON_HANDLE_INVALID){
631249a6c69cSMatthias Ringwald         uint16_t sync_handle = hci_stack->le_periodic_terminate_sync_handle;
631349a6c69cSMatthias Ringwald         hci_stack->le_periodic_terminate_sync_handle = HCI_CON_HANDLE_INVALID;
631449a6c69cSMatthias Ringwald         hci_send_cmd(&hci_le_periodic_advertising_terminate_sync, sync_handle);
631549a6c69cSMatthias Ringwald         return true;
631649a6c69cSMatthias Ringwald     }
631749a6c69cSMatthias Ringwald #ifdef ENABLE_LE_PERIODIC_ADVERTISING
63184bafedd5SMatthias Ringwald     if (periodic_sync_stop){
63194bafedd5SMatthias Ringwald         hci_stack->le_periodic_sync_state = LE_CONNECTING_CANCEL;
63204bafedd5SMatthias Ringwald         hci_send_cmd(&hci_le_periodic_advertising_create_sync_cancel);
63214bafedd5SMatthias Ringwald         return true;
63224bafedd5SMatthias Ringwald     }
632349a6c69cSMatthias Ringwald #endif /* ENABLE_LE_PERIODIC_ADVERTISING */
6324a8016f96SMatthias Ringwald #endif /* ENABLE_LE_EXTENDED_ADVERTISING */
6325a8016f96SMatthias Ringwald #endif /* ENABLE_LE_CENTRAL */
6326a41310b7SMatthias Ringwald 
6327131d4778SMatthias Ringwald     // 2.4 Advertising: legacy, extended, periodic
6328a41310b7SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
6329fde725feSMatthias Ringwald     if (advertising_stop){
6330e464cd48SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
633122f987e4SMatthias Ringwald         if (hci_le_extended_advertising_supported()) {
6332be7ef9d8SMatthias Ringwald             uint8_t advertising_stop_handle;
6333be7ef9d8SMatthias Ringwald             if (advertising_stop_set != NULL){
6334be7ef9d8SMatthias Ringwald                 advertising_stop_handle = advertising_stop_set->advertising_handle;
6335be7ef9d8SMatthias Ringwald                 advertising_stop_set->state &= ~LE_ADVERTISEMENT_STATE_ACTIVE;
6336be7ef9d8SMatthias Ringwald             } else {
6337be7ef9d8SMatthias Ringwald                 advertising_stop_handle = 0;
6338be7ef9d8SMatthias Ringwald                 hci_stack->le_advertisements_state &= ~LE_ADVERTISEMENT_STATE_ACTIVE;
6339be7ef9d8SMatthias Ringwald             }
6340be7ef9d8SMatthias Ringwald             const uint8_t advertising_handles[] = { advertising_stop_handle };
6341e464cd48SMatthias Ringwald             const uint16_t durations[] = { 0 };
6342e464cd48SMatthias Ringwald             const uint16_t max_events[] = { 0 };
6343e464cd48SMatthias Ringwald             hci_send_cmd(&hci_le_set_extended_advertising_enable, 0, 1, advertising_handles, durations, max_events);
6344e464cd48SMatthias Ringwald         } else
6345e464cd48SMatthias Ringwald #endif
6346e464cd48SMatthias Ringwald         {
6347be7ef9d8SMatthias Ringwald             hci_stack->le_advertisements_state &= ~LE_ADVERTISEMENT_STATE_ACTIVE;
634845c102fdSMatthias Ringwald             hci_send_cmd(&hci_le_set_advertise_enable, 0);
6349e464cd48SMatthias Ringwald         }
6350f30077b7SMatthias Ringwald         return true;
635145c102fdSMatthias Ringwald     }
635253f240c0SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
6353c814a904SMatthias Ringwald #ifdef ENABLE_LE_PERIODIC_ADVERTISING
635449a6c69cSMatthias Ringwald     if (periodic_advertising_stop){
635553f240c0SMatthias Ringwald         advertising_stop_set->state &= ~LE_ADVERTISEMENT_STATE_PERIODIC_ACTIVE;
635653f240c0SMatthias Ringwald         hci_send_cmd(&hci_le_set_periodic_advertising_enable, 0, advertising_stop_set->advertising_handle);
635753f240c0SMatthias Ringwald         return true;
635853f240c0SMatthias Ringwald     }
6359c814a904SMatthias Ringwald #endif /* ENABLE_LE_PERIODIC_ADVERTISING */
6360c814a904SMatthias Ringwald #endif /* ENABLE_LE_EXTENDED_ADVERTISING */
6361a8016f96SMatthias Ringwald #endif /* ENABLE_LE_PERIPHERAL */
6362fde725feSMatthias Ringwald 
6363131d4778SMatthias Ringwald 
6364a41310b7SMatthias Ringwald     // Phase 3: modify
6365a41310b7SMatthias Ringwald 
6366137a570aSMatthias Ringwald     if (hci_stack->le_advertisements_todo & LE_ADVERTISEMENT_TASKS_PRIVACY_NOTIFY) {
6367137a570aSMatthias Ringwald         hci_stack->le_advertisements_todo &= ~LE_ADVERTISEMENT_TASKS_PRIVACY_NOTIFY;
6368137a570aSMatthias Ringwald         // GAP Privacy, notify clients upon upcoming random address change
6369137a570aSMatthias Ringwald         hci_stack->le_advertisements_state |= LE_ADVERTISEMENT_STATE_PRIVACY_PENDING;
63701fa7a4bbSMatthias Ringwald         // notify might cause hci_run to get executed, check if we still can send
6371137a570aSMatthias Ringwald         gap_privacy_clients_notify(hci_stack->le_random_address);
63721fa7a4bbSMatthias Ringwald         if (!hci_can_send_command_packet_now()) {
63731fa7a4bbSMatthias Ringwald             return true;
63741fa7a4bbSMatthias Ringwald         }
6375137a570aSMatthias Ringwald     }
6376137a570aSMatthias Ringwald 
6377137a570aSMatthias Ringwald     // - wait until privacy update completed
6378137a570aSMatthias Ringwald     if ((hci_stack->le_advertisements_state & LE_ADVERTISEMENT_STATE_PRIVACY_PENDING) != 0){
6379137a570aSMatthias Ringwald         return false;
6380137a570aSMatthias Ringwald     }
6381137a570aSMatthias Ringwald 
638264f9dabaSMatthias Ringwald     if (hci_stack->le_advertisements_todo & LE_ADVERTISEMENT_TASKS_SET_ADDRESS){
63839136bde8SMatthias Ringwald         hci_stack->le_advertisements_todo &= ~LE_ADVERTISEMENT_TASKS_SET_ADDRESS;
63849136bde8SMatthias Ringwald         hci_send_cmd(&hci_le_set_random_address, hci_stack->le_random_address);
6385ae35a99cSMatthias Ringwald #ifdef ENABLE_LE_SET_ADV_PARAMS_ON_RANDOM_ADDRESS_CHANGE
6386ae35a99cSMatthias Ringwald         // workaround: on some Controllers, address in advertisements is updated only after next dv params set
6387ae35a99cSMatthias Ringwald         hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_SET_PARAMS;
6388ae35a99cSMatthias Ringwald #endif
63899136bde8SMatthias Ringwald         return true;
63909136bde8SMatthias Ringwald     }
63919136bde8SMatthias Ringwald 
6392a41310b7SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
6393a41310b7SMatthias Ringwald     if (hci_stack->le_scanning_param_update){
6394a41310b7SMatthias Ringwald         hci_stack->le_scanning_param_update = false;
639563671e69SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
639622f987e4SMatthias Ringwald         if (hci_le_extended_advertising_supported()){
63977eb5b27eSMatthias Ringwald             // prepare arrays for all phys (LE Coded and LE 1M PHY)
63987eb5b27eSMatthias Ringwald             uint8_t  scan_types[2];
63997eb5b27eSMatthias Ringwald             uint16_t scan_intervals[2];
64007eb5b27eSMatthias Ringwald             uint16_t scan_windows[2];
64017eb5b27eSMatthias Ringwald 
64027eb5b27eSMatthias Ringwald             uint8_t i;
64037eb5b27eSMatthias Ringwald             uint8_t num_phys = hci_le_num_phys(hci_stack->le_scan_phys);
64047eb5b27eSMatthias Ringwald             for (i=0;i<num_phys;i++){
64057eb5b27eSMatthias Ringwald                 scan_types[i]     = hci_stack->le_scan_type;
64067eb5b27eSMatthias Ringwald                 scan_intervals[i] = hci_stack->le_scan_interval;
64077eb5b27eSMatthias Ringwald                 scan_windows[i]   = hci_stack->le_scan_window;
64087eb5b27eSMatthias Ringwald             }
640963671e69SMatthias Ringwald             hci_send_cmd(&hci_le_set_extended_scan_parameters, hci_stack->le_own_addr_type,
64107eb5b27eSMatthias Ringwald                          hci_stack->le_scan_filter_policy, hci_stack->le_scan_phys, scan_types, scan_intervals, scan_windows);
641163671e69SMatthias Ringwald         } else
641263671e69SMatthias Ringwald #endif
641363671e69SMatthias Ringwald         {
6414a41310b7SMatthias Ringwald             hci_send_cmd(&hci_le_set_scan_parameters, hci_stack->le_scan_type, hci_stack->le_scan_interval, hci_stack->le_scan_window,
6415a41310b7SMatthias Ringwald                          hci_stack->le_own_addr_type, hci_stack->le_scan_filter_policy);
641663671e69SMatthias Ringwald         }
6417a41310b7SMatthias Ringwald         return true;
6418a41310b7SMatthias Ringwald     }
6419a41310b7SMatthias Ringwald #endif
6420a41310b7SMatthias Ringwald 
6421a41310b7SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
642245c102fdSMatthias Ringwald     if (hci_stack->le_advertisements_todo & LE_ADVERTISEMENT_TASKS_SET_PARAMS){
642345c102fdSMatthias Ringwald         hci_stack->le_advertisements_todo &= ~LE_ADVERTISEMENT_TASKS_SET_PARAMS;
64246bcfa632SMatthias Ringwald         hci_stack->le_advertisements_own_addr_type = hci_stack->le_own_addr_type;
6425e464cd48SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
642622f987e4SMatthias Ringwald         if (hci_le_extended_advertising_supported()){
6427e464cd48SMatthias Ringwald             // map advertisment type to advertising event properties
6428e464cd48SMatthias Ringwald             uint16_t adv_event_properties = 0;
6429e464cd48SMatthias Ringwald             const uint16_t mapping[] = { 0b00010011, 0b00010101, 0b00011101, 0b00010010, 0b00010000};
6430e464cd48SMatthias Ringwald             if (hci_stack->le_advertisements_type < (sizeof(mapping)/sizeof(uint16_t))){
6431e464cd48SMatthias Ringwald                 adv_event_properties = mapping[hci_stack->le_advertisements_type];
6432e464cd48SMatthias Ringwald             }
6433174b4d21SMatthias Ringwald             hci_stack->le_advertising_set_in_current_command = 0;
6434e464cd48SMatthias Ringwald             hci_send_cmd(&hci_le_set_extended_advertising_parameters,
6435e464cd48SMatthias Ringwald                          0,
6436e464cd48SMatthias Ringwald                          adv_event_properties,
6437e464cd48SMatthias Ringwald                          hci_stack->le_advertisements_interval_min,
6438e464cd48SMatthias Ringwald                          hci_stack->le_advertisements_interval_max,
6439e464cd48SMatthias Ringwald                          hci_stack->le_advertisements_channel_map,
6440e464cd48SMatthias Ringwald                          hci_stack->le_advertisements_own_addr_type,
6441e464cd48SMatthias Ringwald                          hci_stack->le_advertisements_direct_address_type,
6442e464cd48SMatthias Ringwald                          hci_stack->le_advertisements_direct_address,
6443e464cd48SMatthias Ringwald                          hci_stack->le_advertisements_filter_policy,
6444e464cd48SMatthias Ringwald                          0x7f,  // tx power: no preference
6445e464cd48SMatthias Ringwald                          0x01,  // primary adv phy: LE 1M
6446e464cd48SMatthias Ringwald                          0,     // secondary adv max skip
64475375ad13SMatthias Ringwald                          0x01,  // secondary adv phy
6448e464cd48SMatthias Ringwald                          0,     // adv sid
6449e464cd48SMatthias Ringwald                          0      // scan request notification
6450e464cd48SMatthias Ringwald                          );
6451d935373dSMatthias Ringwald         } else
6452e464cd48SMatthias Ringwald #endif
6453e464cd48SMatthias Ringwald         {
645445c102fdSMatthias Ringwald             hci_send_cmd(&hci_le_set_advertising_parameters,
645545c102fdSMatthias Ringwald                          hci_stack->le_advertisements_interval_min,
645645c102fdSMatthias Ringwald                          hci_stack->le_advertisements_interval_max,
645745c102fdSMatthias Ringwald                          hci_stack->le_advertisements_type,
64586bcfa632SMatthias Ringwald                          hci_stack->le_advertisements_own_addr_type,
645945c102fdSMatthias Ringwald                          hci_stack->le_advertisements_direct_address_type,
646045c102fdSMatthias Ringwald                          hci_stack->le_advertisements_direct_address,
646145c102fdSMatthias Ringwald                          hci_stack->le_advertisements_channel_map,
646245c102fdSMatthias Ringwald                          hci_stack->le_advertisements_filter_policy);
6463e464cd48SMatthias Ringwald         }
6464f30077b7SMatthias Ringwald         return true;
646545c102fdSMatthias Ringwald     }
6466be7ef9d8SMatthias Ringwald 
64679ce6dfa1SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
64689ce6dfa1SMatthias Ringwald     // assumption: only set if extended advertising is supported
64699ce6dfa1SMatthias Ringwald     if ((hci_stack->le_advertisements_todo & LE_ADVERTISEMENT_TASKS_SET_ADDRESS_SET_0) != 0){
64709ce6dfa1SMatthias Ringwald         hci_stack->le_advertisements_todo &= ~LE_ADVERTISEMENT_TASKS_SET_ADDRESS_SET_0;
64719ce6dfa1SMatthias Ringwald         hci_send_cmd(&hci_le_set_advertising_set_random_address, 0, hci_stack->le_random_address);
64729ce6dfa1SMatthias Ringwald         return true;
64739ce6dfa1SMatthias Ringwald     }
64749ce6dfa1SMatthias Ringwald #endif
64759ce6dfa1SMatthias Ringwald 
6476501f56b3SMatthias Ringwald     if (hci_stack->le_advertisements_todo & LE_ADVERTISEMENT_TASKS_SET_ADV_DATA){
6477501f56b3SMatthias Ringwald         hci_stack->le_advertisements_todo &= ~LE_ADVERTISEMENT_TASKS_SET_ADV_DATA;
64787a85e4f5SMatthias Ringwald         uint8_t adv_data_clean[31];
64797a85e4f5SMatthias Ringwald         memset(adv_data_clean, 0, sizeof(adv_data_clean));
64806535961aSMatthias Ringwald         (void)memcpy(adv_data_clean, hci_stack->le_advertisements_data,
64816535961aSMatthias Ringwald                      hci_stack->le_advertisements_data_len);
64823c9da642SMatthias Ringwald         btstack_replace_bd_addr_placeholder(adv_data_clean, hci_stack->le_advertisements_data_len, hci_stack->local_bd_addr);
6483e464cd48SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
648422f987e4SMatthias Ringwald         if (hci_le_extended_advertising_supported()){
6485174b4d21SMatthias Ringwald             hci_stack->le_advertising_set_in_current_command = 0;
6486e464cd48SMatthias Ringwald             hci_send_cmd(&hci_le_set_extended_advertising_data, 0, 0x03, 0x01, hci_stack->le_advertisements_data_len, adv_data_clean);
6487e464cd48SMatthias Ringwald         } else
6488e464cd48SMatthias Ringwald #endif
6489e464cd48SMatthias Ringwald         {
64907a85e4f5SMatthias Ringwald             hci_send_cmd(&hci_le_set_advertising_data, hci_stack->le_advertisements_data_len, adv_data_clean);
6491e464cd48SMatthias Ringwald         }
6492f30077b7SMatthias Ringwald         return true;
649345c102fdSMatthias Ringwald     }
6494be7ef9d8SMatthias Ringwald 
6495501f56b3SMatthias Ringwald     if (hci_stack->le_advertisements_todo & LE_ADVERTISEMENT_TASKS_SET_SCAN_DATA){
6496501f56b3SMatthias Ringwald         hci_stack->le_advertisements_todo &= ~LE_ADVERTISEMENT_TASKS_SET_SCAN_DATA;
6497f868b059SMatthias Ringwald         uint8_t scan_data_clean[31];
6498f868b059SMatthias Ringwald         memset(scan_data_clean, 0, sizeof(scan_data_clean));
64996535961aSMatthias Ringwald         (void)memcpy(scan_data_clean, hci_stack->le_scan_response_data,
65006535961aSMatthias Ringwald                      hci_stack->le_scan_response_data_len);
65013c9da642SMatthias Ringwald         btstack_replace_bd_addr_placeholder(scan_data_clean, hci_stack->le_scan_response_data_len, hci_stack->local_bd_addr);
6502e464cd48SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
650322f987e4SMatthias Ringwald         if (hci_le_extended_advertising_supported()){
6504174b4d21SMatthias Ringwald             hci_stack->le_advertising_set_in_current_command = 0;
6505e464cd48SMatthias Ringwald             hci_send_cmd(&hci_le_set_extended_scan_response_data, 0, 0x03, 0x01, hci_stack->le_scan_response_data_len, scan_data_clean);
6506e464cd48SMatthias Ringwald         } else
6507e464cd48SMatthias Ringwald #endif
6508e464cd48SMatthias Ringwald         {
6509214bfd60SMatthias Ringwald             hci_send_cmd(&hci_le_set_scan_response_data, hci_stack->le_scan_response_data_len, scan_data_clean);
6510e464cd48SMatthias Ringwald         }
6511f30077b7SMatthias Ringwald         return true;
6512501f56b3SMatthias Ringwald     }
6513be7ef9d8SMatthias Ringwald 
6514be7ef9d8SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
651522f987e4SMatthias Ringwald     if (hci_le_extended_advertising_supported()) {
6516be7ef9d8SMatthias Ringwald         btstack_linked_list_iterator_t it;
6517be7ef9d8SMatthias Ringwald         btstack_linked_list_iterator_init(&it, &hci_stack->le_advertising_sets);
6518be7ef9d8SMatthias Ringwald         while (btstack_linked_list_iterator_has_next(&it)){
6519be7ef9d8SMatthias Ringwald             le_advertising_set_t * advertising_set = (le_advertising_set_t*) btstack_linked_list_iterator_next(&it);
6520be7ef9d8SMatthias Ringwald             if ((advertising_set->tasks & LE_ADVERTISEMENT_TASKS_REMOVE_SET) != 0) {
6521be7ef9d8SMatthias Ringwald                 advertising_set->tasks &= ~LE_ADVERTISEMENT_TASKS_REMOVE_SET;
6522174b4d21SMatthias Ringwald                 hci_stack->le_advertising_set_in_current_command = advertising_set->advertising_handle;
6523be7ef9d8SMatthias Ringwald                 hci_send_cmd(&hci_le_remove_advertising_set, advertising_set->advertising_handle);
6524be7ef9d8SMatthias Ringwald                 return true;
6525be7ef9d8SMatthias Ringwald             }
6526be7ef9d8SMatthias Ringwald             if ((advertising_set->tasks & LE_ADVERTISEMENT_TASKS_SET_PARAMS) != 0){
6527be7ef9d8SMatthias Ringwald                 advertising_set->tasks &= ~LE_ADVERTISEMENT_TASKS_SET_PARAMS;
6528174b4d21SMatthias Ringwald                 hci_stack->le_advertising_set_in_current_command = advertising_set->advertising_handle;
6529be7ef9d8SMatthias Ringwald                 hci_send_cmd(&hci_le_set_extended_advertising_parameters,
6530be7ef9d8SMatthias Ringwald                              advertising_set->advertising_handle,
653157a04237SMatthias Ringwald                              advertising_set->extended_params.advertising_event_properties,
653257a04237SMatthias Ringwald                              advertising_set->extended_params.primary_advertising_interval_min,
653357a04237SMatthias Ringwald                              advertising_set->extended_params.primary_advertising_interval_max,
653457a04237SMatthias Ringwald                              advertising_set->extended_params.primary_advertising_channel_map,
653557a04237SMatthias Ringwald                              advertising_set->extended_params.own_address_type,
653657a04237SMatthias Ringwald                              advertising_set->extended_params.peer_address_type,
653757a04237SMatthias Ringwald                              advertising_set->extended_params.peer_address,
653857a04237SMatthias Ringwald                              advertising_set->extended_params.advertising_filter_policy,
653957a04237SMatthias Ringwald                              advertising_set->extended_params.advertising_tx_power,
654057a04237SMatthias Ringwald                              advertising_set->extended_params.primary_advertising_phy,
654157a04237SMatthias Ringwald                              advertising_set->extended_params.secondary_advertising_max_skip,
654257a04237SMatthias Ringwald                              advertising_set->extended_params.secondary_advertising_phy,
654357a04237SMatthias Ringwald                              advertising_set->extended_params.advertising_sid,
654457a04237SMatthias Ringwald                              advertising_set->extended_params.scan_request_notification_enable
6545be7ef9d8SMatthias Ringwald                 );
6546be7ef9d8SMatthias Ringwald                 return true;
6547be7ef9d8SMatthias Ringwald             }
65480f54aa8dSMatthias Ringwald             if ((advertising_set->tasks & LE_ADVERTISEMENT_TASKS_SET_ADDRESS) != 0){
65490f54aa8dSMatthias Ringwald                 advertising_set->tasks &= ~LE_ADVERTISEMENT_TASKS_SET_ADDRESS;
65500f54aa8dSMatthias Ringwald                 hci_send_cmd(&hci_le_set_advertising_set_random_address, advertising_set->advertising_handle, advertising_set->random_address);
65510f54aa8dSMatthias Ringwald                 return true;
65520f54aa8dSMatthias Ringwald             }
6553be7ef9d8SMatthias Ringwald             if ((advertising_set->tasks & LE_ADVERTISEMENT_TASKS_SET_ADV_DATA) != 0) {
6554be7ef9d8SMatthias Ringwald                 uint16_t pos = advertising_set->adv_data_pos;
6555be7ef9d8SMatthias Ringwald                 uint8_t  operation = hci_le_extended_advertising_operation_for_chunk(pos, advertising_set->adv_data_len);
6556be7ef9d8SMatthias Ringwald                 uint16_t data_to_upload = btstack_min(advertising_set->adv_data_len - pos, LE_EXTENDED_ADVERTISING_MAX_CHUNK_LEN);
6557be7ef9d8SMatthias Ringwald                 if ((operation & 0x02) != 0){
6558be7ef9d8SMatthias Ringwald                     // last fragment or complete data
6559be7ef9d8SMatthias Ringwald                     operation |= 2;
6560be7ef9d8SMatthias Ringwald                     advertising_set->adv_data_pos = 0;
6561be7ef9d8SMatthias Ringwald                     advertising_set->tasks &= ~LE_ADVERTISEMENT_TASKS_SET_ADV_DATA;
6562be7ef9d8SMatthias Ringwald                 } else {
6563be7ef9d8SMatthias Ringwald                     advertising_set->adv_data_pos += data_to_upload;
6564be7ef9d8SMatthias Ringwald                 }
6565174b4d21SMatthias Ringwald                 hci_stack->le_advertising_set_in_current_command = advertising_set->advertising_handle;
65660cbe4690SMatthias Ringwald                 hci_send_cmd(&hci_le_set_extended_advertising_data, advertising_set->advertising_handle, operation, 0x01, data_to_upload, &advertising_set->adv_data[pos]);
6567be7ef9d8SMatthias Ringwald                 return true;
6568be7ef9d8SMatthias Ringwald             }
6569be7ef9d8SMatthias Ringwald             if ((advertising_set->tasks & LE_ADVERTISEMENT_TASKS_SET_SCAN_DATA) != 0) {
6570be7ef9d8SMatthias Ringwald                 uint16_t pos = advertising_set->scan_data_pos;
6571be7ef9d8SMatthias Ringwald                 uint8_t  operation = hci_le_extended_advertising_operation_for_chunk(pos, advertising_set->scan_data_len);
6572be7ef9d8SMatthias Ringwald                 uint16_t data_to_upload = btstack_min(advertising_set->scan_data_len - pos, LE_EXTENDED_ADVERTISING_MAX_CHUNK_LEN);
6573be7ef9d8SMatthias Ringwald                 if ((operation & 0x02) != 0){
6574be7ef9d8SMatthias Ringwald                     advertising_set->scan_data_pos = 0;
6575be7ef9d8SMatthias Ringwald                     advertising_set->tasks &= ~LE_ADVERTISEMENT_TASKS_SET_SCAN_DATA;
6576be7ef9d8SMatthias Ringwald                 } else {
6577be7ef9d8SMatthias Ringwald                     advertising_set->scan_data_pos += data_to_upload;
6578be7ef9d8SMatthias Ringwald                 }
6579174b4d21SMatthias Ringwald                 hci_stack->le_advertising_set_in_current_command = advertising_set->advertising_handle;
65808ef6d15fSMatthias Ringwald                 hci_send_cmd(&hci_le_set_extended_scan_response_data, advertising_set->advertising_handle, operation, 0x01, data_to_upload, &advertising_set->scan_data[pos]);
6581be7ef9d8SMatthias Ringwald                 return true;
6582be7ef9d8SMatthias Ringwald             }
6583c814a904SMatthias Ringwald #ifdef ENABLE_LE_PERIODIC_ADVERTISING
658453f240c0SMatthias Ringwald             if ((advertising_set->tasks & LE_ADVERTISEMENT_TASKS_SET_PERIODIC_PARAMS) != 0){
658553f240c0SMatthias Ringwald                 advertising_set->tasks &= ~LE_ADVERTISEMENT_TASKS_SET_PERIODIC_PARAMS;
658653f240c0SMatthias Ringwald                 hci_stack->le_advertising_set_in_current_command = advertising_set->advertising_handle;
658753f240c0SMatthias Ringwald                 hci_send_cmd(&hci_le_set_periodic_advertising_parameters,
658853f240c0SMatthias Ringwald                              advertising_set->advertising_handle,
658953f240c0SMatthias Ringwald                              advertising_set->periodic_params.periodic_advertising_interval_min,
659053f240c0SMatthias Ringwald                              advertising_set->periodic_params.periodic_advertising_interval_max,
659153f240c0SMatthias Ringwald                              advertising_set->periodic_params.periodic_advertising_properties);
659253f240c0SMatthias Ringwald                 return true;
659353f240c0SMatthias Ringwald             }
659453f240c0SMatthias Ringwald             if ((advertising_set->tasks & LE_ADVERTISEMENT_TASKS_SET_PERIODIC_DATA) != 0) {
65950cbe4690SMatthias Ringwald                 uint16_t pos = advertising_set->periodic_data_pos;
659653f240c0SMatthias Ringwald                 uint8_t  operation = hci_le_extended_advertising_operation_for_chunk(pos, advertising_set->periodic_data_len);
659753f240c0SMatthias Ringwald                 uint16_t data_to_upload = btstack_min(advertising_set->periodic_data_len - pos, LE_EXTENDED_ADVERTISING_MAX_CHUNK_LEN);
659853f240c0SMatthias Ringwald                 if ((operation & 0x02) != 0){
659953f240c0SMatthias Ringwald                     // last fragment or complete data
660053f240c0SMatthias Ringwald                     operation |= 2;
66010cbe4690SMatthias Ringwald                     advertising_set->periodic_data_pos = 0;
660253f240c0SMatthias Ringwald                     advertising_set->tasks &= ~LE_ADVERTISEMENT_TASKS_SET_PERIODIC_DATA;
660353f240c0SMatthias Ringwald                 } else {
66040cbe4690SMatthias Ringwald                     advertising_set->periodic_data_pos += data_to_upload;
660553f240c0SMatthias Ringwald                 }
660653f240c0SMatthias Ringwald                 hci_stack->le_advertising_set_in_current_command = advertising_set->advertising_handle;
66070cbe4690SMatthias Ringwald                 hci_send_cmd(&hci_le_set_periodic_advertising_data, advertising_set->advertising_handle, operation, data_to_upload, &advertising_set->periodic_data[pos]);
660853f240c0SMatthias Ringwald                 return true;
660953f240c0SMatthias Ringwald             }
6610c814a904SMatthias Ringwald #endif /* ENABLE_LE_PERIODIC_ADVERTISING */
6611be7ef9d8SMatthias Ringwald         }
6612be7ef9d8SMatthias Ringwald     }
6613be7ef9d8SMatthias Ringwald #endif
6614be7ef9d8SMatthias Ringwald 
6615d70217a2SMatthias Ringwald #endif
66169956955bSMatthias Ringwald 
6617057ab60cSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
6618a41310b7SMatthias Ringwald     // if connect with whitelist was active and is not cancelled yet, wait until next time
6619a41310b7SMatthias Ringwald     if (hci_stack->le_connecting_state == LE_CONNECTING_CANCEL) return false;
66204bafedd5SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
66214bafedd5SMatthias Ringwald     // if periodic sync with advertiser list was active and is not cancelled yet, wait until next time
66224bafedd5SMatthias Ringwald     if (hci_stack->le_periodic_sync_state == LE_CONNECTING_CANCEL) return false;
66234bafedd5SMatthias Ringwald #endif
6624057ab60cSMatthias Ringwald #endif
6625057ab60cSMatthias Ringwald 
6626a41310b7SMatthias Ringwald     // LE Whitelist Management
6627a41310b7SMatthias Ringwald     if (whitelist_modification_pending){
66289956955bSMatthias Ringwald         // add/remove entries
6629665d90f2SMatthias Ringwald         btstack_linked_list_iterator_init(&lit, &hci_stack->le_whitelist);
6630665d90f2SMatthias Ringwald         while (btstack_linked_list_iterator_has_next(&lit)){
6631665d90f2SMatthias Ringwald             whitelist_entry_t * entry = (whitelist_entry_t*) btstack_linked_list_iterator_next(&lit);
6632453459ddSMatthias Ringwald 			if (entry->state & LE_WHITELIST_REMOVE_FROM_CONTROLLER){
6633453459ddSMatthias Ringwald 				entry->state &= ~LE_WHITELIST_REMOVE_FROM_CONTROLLER;
6634334e35acSMatthias Ringwald                 entry->state &= ~LE_WHITELIST_ON_CONTROLLER;
6635334e35acSMatthias Ringwald                 bd_addr_type_t address_type = entry->address_type;
6636334e35acSMatthias Ringwald                 bd_addr_t address;
6637334e35acSMatthias Ringwald                 memcpy(address, entry->address, 6);
6638334e35acSMatthias Ringwald                 if ((entry->state & LE_WHITELIST_ADD_TO_CONTROLLER) == 0){
6639334e35acSMatthias Ringwald                     // remove from whitelist if not scheduled for re-addition
6640334e35acSMatthias Ringwald                     btstack_linked_list_remove(&hci_stack->le_whitelist, (btstack_linked_item_t *) entry);
6641334e35acSMatthias Ringwald                     btstack_memory_whitelist_entry_free(entry);
6642334e35acSMatthias Ringwald                 }
6643334e35acSMatthias Ringwald 				hci_send_cmd(&hci_le_remove_device_from_white_list, address_type, address);
6644453459ddSMatthias Ringwald 				return true;
6645453459ddSMatthias Ringwald 			}
66469956955bSMatthias Ringwald             if (entry->state & LE_WHITELIST_ADD_TO_CONTROLLER){
6647453459ddSMatthias Ringwald 				entry->state &= ~LE_WHITELIST_ADD_TO_CONTROLLER;
6648453459ddSMatthias Ringwald                 entry->state |= LE_WHITELIST_ON_CONTROLLER;
66499956955bSMatthias Ringwald                 hci_send_cmd(&hci_le_add_device_to_white_list, entry->address_type, entry->address);
6650f30077b7SMatthias Ringwald                 return true;
66519956955bSMatthias Ringwald             }
66529956955bSMatthias Ringwald         }
665391915b0bSMatthias Ringwald     }
66549956955bSMatthias Ringwald 
665521debf25SMatthias Ringwald #ifdef ENABLE_LE_PRIVACY_ADDRESS_RESOLUTION
665621debf25SMatthias Ringwald     // LE Resolving List Management
66572fbf0ed0SMatthias Ringwald     if (resolving_list_modification_pending) {
665821debf25SMatthias Ringwald 		uint16_t i;
66598dc1b1d0SMatthias Ringwald         uint8_t null_16[16];
66608dc1b1d0SMatthias Ringwald         uint8_t local_irk_flipped[16];
66618dc1b1d0SMatthias Ringwald         const uint8_t *local_irk;
666221debf25SMatthias Ringwald 		switch (hci_stack->le_resolving_list_state) {
666321debf25SMatthias Ringwald 			case LE_RESOLVING_LIST_SEND_ENABLE_ADDRESS_RESOLUTION:
666421debf25SMatthias Ringwald 				hci_stack->le_resolving_list_state = LE_RESOLVING_LIST_READ_SIZE;
666521debf25SMatthias Ringwald 				hci_send_cmd(&hci_le_set_address_resolution_enabled, 1);
666621debf25SMatthias Ringwald 				return true;
666721debf25SMatthias Ringwald 			case LE_RESOLVING_LIST_READ_SIZE:
666821debf25SMatthias Ringwald 				hci_stack->le_resolving_list_state = LE_RESOLVING_LIST_SEND_CLEAR;
666921debf25SMatthias Ringwald 				hci_send_cmd(&hci_le_read_resolving_list_size);
667021debf25SMatthias Ringwald 				return true;
667121debf25SMatthias Ringwald 			case LE_RESOLVING_LIST_SEND_CLEAR:
66728dc1b1d0SMatthias Ringwald 				hci_stack->le_resolving_list_state = LE_RESOLVING_LIST_SET_IRK;
6673ea151974SMatthias Ringwald 				(void) memset(hci_stack->le_resolving_list_add_entries, 0xff,
6674ea151974SMatthias Ringwald 							  sizeof(hci_stack->le_resolving_list_add_entries));
6675e8ca66c6SMatthias Ringwald                 (void) memset(hci_stack->le_resolving_list_set_privacy_mode, 0xff,
6676e8ca66c6SMatthias Ringwald                               sizeof(hci_stack->le_resolving_list_set_privacy_mode));
6677ea151974SMatthias Ringwald 				(void) memset(hci_stack->le_resolving_list_remove_entries, 0,
6678ea151974SMatthias Ringwald 							  sizeof(hci_stack->le_resolving_list_remove_entries));
667921debf25SMatthias Ringwald 				hci_send_cmd(&hci_le_clear_resolving_list);
668021debf25SMatthias Ringwald 				return true;
66818dc1b1d0SMatthias Ringwald             case LE_RESOLVING_LIST_SET_IRK:
66828dc1b1d0SMatthias Ringwald                 // set IRK used by RPA for undirected advertising
66838dc1b1d0SMatthias Ringwald                 hci_stack->le_resolving_list_state = LE_RESOLVING_LIST_UPDATES_ENTRIES;
66848dc1b1d0SMatthias Ringwald                 local_irk = gap_get_persistent_irk();
66858dc1b1d0SMatthias Ringwald                 reverse_128(local_irk, local_irk_flipped);
66868dc1b1d0SMatthias Ringwald                 memset(null_16, 0, sizeof(null_16));
66878dc1b1d0SMatthias Ringwald                 hci_send_cmd(&hci_le_add_device_to_resolving_list, BD_ADDR_TYPE_LE_PUBLIC, null_16,
66888dc1b1d0SMatthias Ringwald                              null_16, local_irk_flipped);
66898dc1b1d0SMatthias Ringwald                 return true;
66905f3ccd83SMatthias Ringwald 			case LE_RESOLVING_LIST_UPDATES_ENTRIES:
66915f3ccd83SMatthias Ringwald                 // first remove old entries
669202b02cffSMatthias Ringwald 				for (i = 0; i < MAX_NUM_RESOLVING_LIST_ENTRIES && i < le_device_db_max_count(); i++) {
669302b02cffSMatthias Ringwald 					uint8_t offset = i >> 3;
669402b02cffSMatthias Ringwald 					uint8_t mask = 1 << (i & 7);
669502b02cffSMatthias Ringwald 					if ((hci_stack->le_resolving_list_remove_entries[offset] & mask) == 0) continue;
669602b02cffSMatthias Ringwald 					hci_stack->le_resolving_list_remove_entries[offset] &= ~mask;
669702b02cffSMatthias Ringwald 					bd_addr_t peer_identity_addreses;
669802b02cffSMatthias Ringwald 					int peer_identity_addr_type = (int) BD_ADDR_TYPE_UNKNOWN;
669902b02cffSMatthias Ringwald 					sm_key_t peer_irk;
670002b02cffSMatthias Ringwald 					le_device_db_info(i, &peer_identity_addr_type, peer_identity_addreses, peer_irk);
670102b02cffSMatthias Ringwald 					if (peer_identity_addr_type == BD_ADDR_TYPE_UNKNOWN) continue;
6702f5228c62SMatthias Ringwald 
6703f5228c62SMatthias Ringwald #ifdef ENABLE_LE_WHITELIST_TOUCH_AFTER_RESOLVING_LIST_UPDATE
6704f5228c62SMatthias Ringwald 					// trigger whitelist entry 'update' (work around for controller bug)
6705f5228c62SMatthias Ringwald 					btstack_linked_list_iterator_init(&lit, &hci_stack->le_whitelist);
6706f5228c62SMatthias Ringwald 					while (btstack_linked_list_iterator_has_next(&lit)) {
6707f5228c62SMatthias Ringwald 						whitelist_entry_t *entry = (whitelist_entry_t *) btstack_linked_list_iterator_next(&lit);
6708f5228c62SMatthias Ringwald 						if (entry->address_type != peer_identity_addr_type) continue;
6709f5228c62SMatthias Ringwald 						if (memcmp(entry->address, peer_identity_addreses, 6) != 0) continue;
6710f5228c62SMatthias Ringwald 						log_info("trigger whitelist update %s", bd_addr_to_str(peer_identity_addreses));
6711f5228c62SMatthias Ringwald 						entry->state |= LE_WHITELIST_REMOVE_FROM_CONTROLLER | LE_WHITELIST_ADD_TO_CONTROLLER;
6712f5228c62SMatthias Ringwald 					}
6713f5228c62SMatthias Ringwald #endif
6714f5228c62SMatthias Ringwald 
6715ea151974SMatthias Ringwald 					hci_send_cmd(&hci_le_remove_device_from_resolving_list, peer_identity_addr_type,
6716ea151974SMatthias Ringwald 								 peer_identity_addreses);
671702b02cffSMatthias Ringwald 					return true;
671802b02cffSMatthias Ringwald 				}
671902b02cffSMatthias Ringwald 
67205f3ccd83SMatthias Ringwald                 // then add new entries
672121debf25SMatthias Ringwald 				for (i = 0; i < MAX_NUM_RESOLVING_LIST_ENTRIES && i < le_device_db_max_count(); i++) {
672221debf25SMatthias Ringwald 					uint8_t offset = i >> 3;
672321debf25SMatthias Ringwald 					uint8_t mask = 1 << (i & 7);
672402b02cffSMatthias Ringwald 					if ((hci_stack->le_resolving_list_add_entries[offset] & mask) == 0) continue;
672502b02cffSMatthias Ringwald 					hci_stack->le_resolving_list_add_entries[offset] &= ~mask;
672621debf25SMatthias Ringwald 					bd_addr_t peer_identity_addreses;
672721debf25SMatthias Ringwald 					int peer_identity_addr_type = (int) BD_ADDR_TYPE_UNKNOWN;
672821debf25SMatthias Ringwald 					sm_key_t peer_irk;
672921debf25SMatthias Ringwald 					le_device_db_info(i, &peer_identity_addr_type, peer_identity_addreses, peer_irk);
673021debf25SMatthias Ringwald 					if (peer_identity_addr_type == BD_ADDR_TYPE_UNKNOWN) continue;
6731e938c062SMatthias Ringwald                     if (btstack_is_null(peer_irk, 16)) continue;
67322b6efc4dSMatthias Ringwald 					local_irk = gap_get_persistent_irk();
673321debf25SMatthias Ringwald 					// command uses format specifier 'P' that stores 16-byte value without flip
673421debf25SMatthias Ringwald 					uint8_t peer_irk_flipped[16];
673521debf25SMatthias Ringwald 					reverse_128(local_irk, local_irk_flipped);
673621debf25SMatthias Ringwald 					reverse_128(peer_irk, peer_irk_flipped);
6737ea151974SMatthias Ringwald 					hci_send_cmd(&hci_le_add_device_to_resolving_list, peer_identity_addr_type, peer_identity_addreses,
6738ea151974SMatthias Ringwald 								 peer_irk_flipped, local_irk_flipped);
673921debf25SMatthias Ringwald 					return true;
674021debf25SMatthias Ringwald 				}
6741e8ca66c6SMatthias Ringwald 
6742e8ca66c6SMatthias Ringwald                 // finally, set privacy mode
6743e8ca66c6SMatthias Ringwald                 for (i = 0; i < MAX_NUM_RESOLVING_LIST_ENTRIES && i < le_device_db_max_count(); i++) {
6744e8ca66c6SMatthias Ringwald                     uint8_t offset = i >> 3;
6745e8ca66c6SMatthias Ringwald                     uint8_t mask = 1 << (i & 7);
6746e8ca66c6SMatthias Ringwald                     if ((hci_stack->le_resolving_list_set_privacy_mode[offset] & mask) == 0) continue;
6747e8ca66c6SMatthias Ringwald                     hci_stack->le_resolving_list_set_privacy_mode[offset] &= ~mask;
6748e8ca66c6SMatthias Ringwald                     if (hci_stack->le_privacy_mode == LE_PRIVACY_MODE_NETWORK) {
6749e8ca66c6SMatthias Ringwald                         // Network Privacy Mode is default
6750e8ca66c6SMatthias Ringwald                         continue;
6751e8ca66c6SMatthias Ringwald                     }
6752e8ca66c6SMatthias Ringwald                     bd_addr_t peer_identity_address;
6753e8ca66c6SMatthias Ringwald                     int peer_identity_addr_type = (int) BD_ADDR_TYPE_UNKNOWN;
6754e8ca66c6SMatthias Ringwald                     sm_key_t peer_irk;
6755e8ca66c6SMatthias Ringwald                     le_device_db_info(i, &peer_identity_addr_type, peer_identity_address, peer_irk);
6756e8ca66c6SMatthias Ringwald                     if (peer_identity_addr_type == BD_ADDR_TYPE_UNKNOWN) continue;
6757e8ca66c6SMatthias Ringwald                     if (btstack_is_null(peer_irk, 16)) continue;
6758e8ca66c6SMatthias Ringwald                     // command uses format specifier 'P' that stores 16-byte value without flip
6759e8ca66c6SMatthias Ringwald                     uint8_t peer_irk_flipped[16];
6760e8ca66c6SMatthias Ringwald                     reverse_128(peer_irk, peer_irk_flipped);
6761e8ca66c6SMatthias Ringwald                     hci_send_cmd(&hci_le_set_privacy_mode, peer_identity_addr_type, peer_identity_address, hci_stack->le_privacy_mode);
6762e8ca66c6SMatthias Ringwald                     return true;
6763e8ca66c6SMatthias Ringwald                 }
676421debf25SMatthias Ringwald 				break;
676502b02cffSMatthias Ringwald 
676621debf25SMatthias Ringwald 			default:
676721debf25SMatthias Ringwald 				break;
676821debf25SMatthias Ringwald 		}
676921debf25SMatthias Ringwald         hci_stack->le_resolving_list_state = LE_RESOLVING_LIST_DONE;
67702fbf0ed0SMatthias Ringwald 	}
677121debf25SMatthias Ringwald #endif
6772a41310b7SMatthias Ringwald 
6773f40c73b4SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
6774f40c73b4SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
6775f40c73b4SMatthias Ringwald     // LE Whitelist Management
6776f40c73b4SMatthias Ringwald     if (periodic_list_modification_pending){
6777f40c73b4SMatthias Ringwald         // add/remove entries
6778f40c73b4SMatthias Ringwald         btstack_linked_list_iterator_init(&lit, &hci_stack->le_periodic_advertiser_list);
6779f40c73b4SMatthias Ringwald         while (btstack_linked_list_iterator_has_next(&lit)){
6780f40c73b4SMatthias Ringwald             periodic_advertiser_list_entry_t * entry = (periodic_advertiser_list_entry_t*) btstack_linked_list_iterator_next(&lit);
6781f40c73b4SMatthias Ringwald             if (entry->state & LE_PERIODIC_ADVERTISER_LIST_ENTRY_REMOVE_FROM_CONTROLLER){
6782f40c73b4SMatthias Ringwald                 entry->state &= ~LE_PERIODIC_ADVERTISER_LIST_ENTRY_REMOVE_FROM_CONTROLLER;
6783d946a741SMatthias Ringwald                 hci_send_cmd(&hci_le_remove_device_from_periodic_advertiser_list, entry->address_type, entry->address, entry->sid);
6784f40c73b4SMatthias Ringwald                 return true;
6785f40c73b4SMatthias Ringwald             }
6786f40c73b4SMatthias Ringwald             if (entry->state & LE_PERIODIC_ADVERTISER_LIST_ENTRY_ADD_TO_CONTROLLER){
6787f40c73b4SMatthias Ringwald                 entry->state &= ~LE_PERIODIC_ADVERTISER_LIST_ENTRY_ADD_TO_CONTROLLER;
6788f40c73b4SMatthias Ringwald                 entry->state |= LE_PERIODIC_ADVERTISER_LIST_ENTRY_ON_CONTROLLER;
67899e88556bSMatthias Ringwald                 hci_send_cmd(&hci_le_add_device_to_periodic_advertiser_list, entry->address_type, entry->address, entry->sid);
6790f40c73b4SMatthias Ringwald                 return true;
6791f40c73b4SMatthias Ringwald             }
6792f40c73b4SMatthias Ringwald             if ((entry->state & LE_PERIODIC_ADVERTISER_LIST_ENTRY_ON_CONTROLLER) == 0){
6793f40c73b4SMatthias Ringwald                 btstack_linked_list_remove(&hci_stack->le_periodic_advertiser_list, (btstack_linked_item_t *) entry);
6794f40c73b4SMatthias Ringwald                 btstack_memory_periodic_advertiser_list_entry_free(entry);
6795f40c73b4SMatthias Ringwald             }
6796f40c73b4SMatthias Ringwald         }
6797f40c73b4SMatthias Ringwald     }
6798f40c73b4SMatthias Ringwald #endif
6799f40c73b4SMatthias Ringwald #endif
6800f40c73b4SMatthias Ringwald 
680198aa715fSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
680298aa715fSMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
680398aa715fSMatthias Ringwald #ifdef ENABLE_LE_PERIODIC_ADVERTISING
680498aa715fSMatthias Ringwald     if (hci_stack->le_past_set_default_params){
680598aa715fSMatthias Ringwald         hci_stack->le_past_set_default_params = false;
680698aa715fSMatthias Ringwald         hci_send_cmd(&hci_le_set_default_periodic_advertising_sync_transfer_parameters,
680798aa715fSMatthias Ringwald                      hci_stack->le_past_mode,
680898aa715fSMatthias Ringwald                      hci_stack->le_past_skip,
680998aa715fSMatthias Ringwald                      hci_stack->le_past_sync_timeout,
681098aa715fSMatthias Ringwald                      hci_stack->le_past_cte_type);
681198aa715fSMatthias Ringwald         return true;
681298aa715fSMatthias Ringwald     }
681398aa715fSMatthias Ringwald #endif
681498aa715fSMatthias Ringwald #endif
681598aa715fSMatthias Ringwald #endif
681698aa715fSMatthias Ringwald 
681773799937SMatthias Ringwald     // post-pone all actions until stack is fully working
681873799937SMatthias Ringwald     if (hci_stack->state != HCI_STATE_WORKING) return false;
681973799937SMatthias Ringwald 
682073799937SMatthias Ringwald     // advertisements, active scanning, and creating connections requires random address to be set if using private address
682173799937SMatthias Ringwald     if ( (hci_stack->le_own_addr_type != BD_ADDR_TYPE_LE_PUBLIC) && (hci_stack->le_random_address_set == 0u) ) return false;
682273799937SMatthias Ringwald 
6823a41310b7SMatthias Ringwald     // Phase 4: restore state
682429c24bebSMatthias Ringwald 
682529c24bebSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
6826af64f147SMatthias Ringwald     // re-start scanning
682729c24bebSMatthias Ringwald     if ((hci_stack->le_scanning_enabled && !hci_stack->le_scanning_active)){
682829c24bebSMatthias Ringwald         hci_stack->le_scanning_active = true;
682963671e69SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
683022f987e4SMatthias Ringwald         if (hci_le_extended_advertising_supported()){
68314856283bSMatthias Ringwald             hci_send_cmd(&hci_le_set_extended_scan_enable, 1, hci_stack->le_scan_filter_duplicates, 0, 0);
683263671e69SMatthias Ringwald         } else
683363671e69SMatthias Ringwald #endif
683463671e69SMatthias Ringwald         {
68354856283bSMatthias Ringwald             hci_send_cmd(&hci_le_set_scan_enable, 1, hci_stack->le_scan_filter_duplicates);
683663671e69SMatthias Ringwald         }
683729c24bebSMatthias Ringwald         return true;
683829c24bebSMatthias Ringwald     }
683929c24bebSMatthias Ringwald #endif
684029c24bebSMatthias Ringwald 
684113eb2a2eSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
6842af64f147SMatthias Ringwald     // re-start connecting
6843af64f147SMatthias Ringwald     if ( (hci_stack->le_connecting_state == LE_CONNECTING_IDLE) && (hci_stack->le_connecting_request == LE_CONNECTING_WHITELIST)){
68449956955bSMatthias Ringwald         bd_addr_t null_addr;
68459956955bSMatthias Ringwald         memset(null_addr, 0, 6);
68466bcfa632SMatthias Ringwald         hci_stack->le_connection_own_addr_type =  hci_stack->le_own_addr_type;
68476bcfa632SMatthias Ringwald         hci_get_own_address_for_addr_type(hci_stack->le_connection_own_addr_type, hci_stack->le_connection_own_address);
68486f34e9d6SMatthias Ringwald         hci_send_le_create_connection(1, 0, null_addr);
6849f30077b7SMatthias Ringwald         return true;
68509956955bSMatthias Ringwald     }
68514bafedd5SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
68524bafedd5SMatthias Ringwald     if (hci_stack->le_periodic_sync_state == LE_CONNECTING_IDLE){
68534bafedd5SMatthias Ringwald         switch(hci_stack->le_periodic_sync_request){
68544bafedd5SMatthias Ringwald             case LE_CONNECTING_DIRECT:
68554bafedd5SMatthias Ringwald             case LE_CONNECTING_WHITELIST:
68564bafedd5SMatthias Ringwald                 hci_stack->le_periodic_sync_state = ((hci_stack->le_periodic_sync_options & 1) != 0) ? LE_CONNECTING_WHITELIST : LE_CONNECTING_DIRECT;
68574bafedd5SMatthias Ringwald                 hci_send_cmd(&hci_le_periodic_advertising_create_sync,
68584bafedd5SMatthias Ringwald                              hci_stack->le_periodic_sync_options,
68594bafedd5SMatthias Ringwald                              hci_stack->le_periodic_sync_advertising_sid,
68604bafedd5SMatthias Ringwald                              hci_stack->le_periodic_sync_advertiser_address_type,
68614bafedd5SMatthias Ringwald                              hci_stack->le_periodic_sync_advertiser_address,
68624bafedd5SMatthias Ringwald                              hci_stack->le_periodic_sync_skip,
68634bafedd5SMatthias Ringwald                              hci_stack->le_periodic_sync_timeout,
68644bafedd5SMatthias Ringwald                              hci_stack->le_periodic_sync_cte_type);
68654bafedd5SMatthias Ringwald                 return true;
68664bafedd5SMatthias Ringwald             default:
68674bafedd5SMatthias Ringwald                 break;
68684bafedd5SMatthias Ringwald         }
68694bafedd5SMatthias Ringwald     }
68704bafedd5SMatthias Ringwald #endif
6871d70217a2SMatthias Ringwald #endif
6872a41310b7SMatthias Ringwald 
6873a41310b7SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
6874a41310b7SMatthias Ringwald     // re-start advertising
6875935aa76eSMatthias Ringwald     if (hci_stack->le_advertisements_enabled_for_current_roles && ((hci_stack->le_advertisements_state & LE_ADVERTISEMENT_STATE_ACTIVE) == 0)){
6876a41310b7SMatthias Ringwald         // check if advertisements should be enabled given
6877935aa76eSMatthias Ringwald         hci_stack->le_advertisements_state |= LE_ADVERTISEMENT_STATE_ACTIVE;
6878b892db1cSMatthias Ringwald         hci_get_own_address_for_addr_type(hci_stack->le_advertisements_own_addr_type, hci_stack->le_advertisements_own_address);
6879e464cd48SMatthias Ringwald 
6880e464cd48SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
688122f987e4SMatthias Ringwald         if (hci_le_extended_advertising_supported()){
6882e464cd48SMatthias Ringwald             const uint8_t advertising_handles[] = { 0 };
6883e464cd48SMatthias Ringwald             const uint16_t durations[] = { 0 };
6884e464cd48SMatthias Ringwald             const uint16_t max_events[] = { 0 };
6885e464cd48SMatthias Ringwald             hci_send_cmd(&hci_le_set_extended_advertising_enable, 1, 1, advertising_handles, durations, max_events);
6886e464cd48SMatthias Ringwald         } else
6887e464cd48SMatthias Ringwald #endif
6888e464cd48SMatthias Ringwald         {
6889a41310b7SMatthias Ringwald             hci_send_cmd(&hci_le_set_advertise_enable, 1);
6890e464cd48SMatthias Ringwald         }
6891a41310b7SMatthias Ringwald         return true;
6892a41310b7SMatthias Ringwald     }
6893be7ef9d8SMatthias Ringwald 
6894be7ef9d8SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
689522f987e4SMatthias Ringwald     if (hci_le_extended_advertising_supported()) {
6896be7ef9d8SMatthias Ringwald         btstack_linked_list_iterator_t it;
6897be7ef9d8SMatthias Ringwald         btstack_linked_list_iterator_init(&it, &hci_stack->le_advertising_sets);
6898be7ef9d8SMatthias Ringwald         while (btstack_linked_list_iterator_has_next(&it)) {
6899be7ef9d8SMatthias Ringwald             le_advertising_set_t *advertising_set = (le_advertising_set_t *) btstack_linked_list_iterator_next(&it);
6900be7ef9d8SMatthias Ringwald             if (((advertising_set->state & LE_ADVERTISEMENT_STATE_ENABLED) != 0) && ((advertising_set->state & LE_ADVERTISEMENT_STATE_ACTIVE) == 0)){
69018caa405cSMatthias Ringwald                 advertising_set->state |= LE_ADVERTISEMENT_STATE_ACTIVE;
6902be7ef9d8SMatthias Ringwald                 const uint8_t advertising_handles[] = { advertising_set->advertising_handle };
6903be7ef9d8SMatthias Ringwald                 const uint16_t durations[] = { advertising_set->enable_timeout };
6904be7ef9d8SMatthias Ringwald                 const uint16_t max_events[] = { advertising_set->enable_max_scan_events };
6905be7ef9d8SMatthias Ringwald                 hci_send_cmd(&hci_le_set_extended_advertising_enable, 1, 1, advertising_handles, durations, max_events);
6906be7ef9d8SMatthias Ringwald                 return true;
6907be7ef9d8SMatthias Ringwald             }
6908c814a904SMatthias Ringwald #ifdef ENABLE_LE_PERIODIC_ADVERTISING
690953f240c0SMatthias Ringwald             if (((advertising_set->state & LE_ADVERTISEMENT_STATE_PERIODIC_ENABLED) != 0) && ((advertising_set->state & LE_ADVERTISEMENT_STATE_PERIODIC_ACTIVE) == 0)){
691053f240c0SMatthias Ringwald                 advertising_set->state |= LE_ADVERTISEMENT_STATE_PERIODIC_ACTIVE;
691153f240c0SMatthias Ringwald                 uint8_t enable = 1;
691253f240c0SMatthias Ringwald                 if (advertising_set->periodic_include_adi){
691353f240c0SMatthias Ringwald                     enable |= 2;
691453f240c0SMatthias Ringwald                 }
691553f240c0SMatthias Ringwald                 hci_send_cmd(&hci_le_set_periodic_advertising_enable, enable, advertising_set->advertising_handle);
691653f240c0SMatthias Ringwald                 return true;
691753f240c0SMatthias Ringwald             }
6918c814a904SMatthias Ringwald #endif /* ENABLE_LE_PERIODIC_ADVERTISING */
6919be7ef9d8SMatthias Ringwald         }
6920be7ef9d8SMatthias Ringwald     }
6921be7ef9d8SMatthias Ringwald #endif
6922a41310b7SMatthias Ringwald #endif
6923a41310b7SMatthias Ringwald 
6924f30077b7SMatthias Ringwald     return false;
69257bdc6798S[email protected] }
69267aa35f6aSMatthias Ringwald 
69277aa35f6aSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
69287aa35f6aSMatthias Ringwald static bool hci_run_iso_tasks(void){
69297aa35f6aSMatthias Ringwald     btstack_linked_list_iterator_t it;
69302a6c0f82SMatthias Ringwald 
693126b93350SMatthias Ringwald     if (hci_stack->iso_active_operation_type != HCI_ISO_TYPE_INVALID) {
693240f86dfdSMatthias Ringwald         return false;
693340f86dfdSMatthias Ringwald     }
693440f86dfdSMatthias Ringwald 
69352a6c0f82SMatthias Ringwald     // BIG
69367aa35f6aSMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->le_audio_bigs);
69377aa35f6aSMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
69387aa35f6aSMatthias Ringwald         le_audio_big_t * big = (le_audio_big_t *) btstack_linked_list_iterator_next(&it);
69397aa35f6aSMatthias Ringwald         switch (big->state){
69407aa35f6aSMatthias Ringwald             case LE_AUDIO_BIG_STATE_CREATE:
694140f86dfdSMatthias Ringwald                 hci_stack->iso_active_operation_group_id = big->params->big_handle;
694240f86dfdSMatthias Ringwald                 hci_stack->iso_active_operation_type = HCI_ISO_TYPE_BIS;
69437aa35f6aSMatthias Ringwald                 big->state = LE_AUDIO_BIG_STATE_W4_ESTABLISHED;
69447aa35f6aSMatthias Ringwald                 hci_send_cmd(&hci_le_create_big,
69457aa35f6aSMatthias Ringwald                              big->params->big_handle,
69467aa35f6aSMatthias Ringwald                              big->params->advertising_handle,
69477aa35f6aSMatthias Ringwald                              big->params->num_bis,
69487aa35f6aSMatthias Ringwald                              big->params->sdu_interval_us,
69497aa35f6aSMatthias Ringwald                              big->params->max_sdu,
69507aa35f6aSMatthias Ringwald                              big->params->max_transport_latency_ms,
69517aa35f6aSMatthias Ringwald                              big->params->rtn,
69527aa35f6aSMatthias Ringwald                              big->params->phy,
69537aa35f6aSMatthias Ringwald                              big->params->packing,
69547aa35f6aSMatthias Ringwald                              big->params->framing,
69557aa35f6aSMatthias Ringwald                              big->params->encryption,
69567aa35f6aSMatthias Ringwald                              big->params->broadcast_code);
69577aa35f6aSMatthias Ringwald                 return true;
69587aa35f6aSMatthias Ringwald             case LE_AUDIO_BIG_STATE_SETUP_ISO_PATH:
69597aa35f6aSMatthias Ringwald                 big->state = LE_AUDIO_BIG_STATE_W4_SETUP_ISO_PATH;
696085dc435bSDirk Helbig                 hci_send_cmd(&hci_le_setup_iso_data_path, big->bis_con_handles[big->state_vars.next_bis], 0, 0, HCI_AUDIO_CODING_FORMAT_TRANSPARENT, 0, 0,  0, 0, NULL);
69617aa35f6aSMatthias Ringwald                 return true;
69627aa35f6aSMatthias Ringwald             case LE_AUDIO_BIG_STATE_SETUP_ISO_PATHS_FAILED:
69637aa35f6aSMatthias Ringwald                 big->state = LE_AUDIO_BIG_STATE_W4_TERMINATED_AFTER_SETUP_FAILED;
69642a6c0f82SMatthias Ringwald                 hci_send_cmd(&hci_le_terminate_big, big->big_handle, big->state_vars.status);
6965c1f83111SMatthias Ringwald                 return true;
69667aa35f6aSMatthias Ringwald             case LE_AUDIO_BIG_STATE_TERMINATE:
69677aa35f6aSMatthias Ringwald                 big->state = LE_AUDIO_BIG_STATE_W4_TERMINATED;
69682a6c0f82SMatthias Ringwald                 hci_send_cmd(&hci_le_terminate_big, big->big_handle, ERROR_CODE_SUCCESS);
69697aa35f6aSMatthias Ringwald                 return true;
69707aa35f6aSMatthias Ringwald             default:
69717aa35f6aSMatthias Ringwald                 break;
69727aa35f6aSMatthias Ringwald         }
69737aa35f6aSMatthias Ringwald     }
69742a6c0f82SMatthias Ringwald 
69752a6c0f82SMatthias Ringwald     // BIG Sync
69762a6c0f82SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->le_audio_big_syncs);
69772a6c0f82SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
69782a6c0f82SMatthias Ringwald         le_audio_big_sync_t * big_sync = (le_audio_big_sync_t *) btstack_linked_list_iterator_next(&it);
69792a6c0f82SMatthias Ringwald         switch (big_sync->state){
69802a6c0f82SMatthias Ringwald             case LE_AUDIO_BIG_STATE_CREATE:
698140f86dfdSMatthias Ringwald                 hci_stack->iso_active_operation_group_id = big_sync->params->big_handle;
698240f86dfdSMatthias Ringwald                 hci_stack->iso_active_operation_type = HCI_ISO_TYPE_BIS;
69832a6c0f82SMatthias Ringwald                 big_sync->state = LE_AUDIO_BIG_STATE_W4_ESTABLISHED;
69842a6c0f82SMatthias Ringwald                 hci_send_cmd(&hci_le_big_create_sync,
69852a6c0f82SMatthias Ringwald                              big_sync->params->big_handle,
69862a6c0f82SMatthias Ringwald                              big_sync->params->sync_handle,
69872a6c0f82SMatthias Ringwald                              big_sync->params->encryption,
69882a6c0f82SMatthias Ringwald                              big_sync->params->broadcast_code,
69892a6c0f82SMatthias Ringwald                              big_sync->params->mse,
69902a6c0f82SMatthias Ringwald                              big_sync->params->big_sync_timeout_10ms,
69912a6c0f82SMatthias Ringwald                              big_sync->params->num_bis,
69922a6c0f82SMatthias Ringwald                              big_sync->params->bis_indices);
69932a6c0f82SMatthias Ringwald                 return true;
69942a6c0f82SMatthias Ringwald             case LE_AUDIO_BIG_STATE_SETUP_ISO_PATH:
69952a6c0f82SMatthias Ringwald                 big_sync->state = LE_AUDIO_BIG_STATE_W4_SETUP_ISO_PATH;
699685dc435bSDirk Helbig                 hci_send_cmd(&hci_le_setup_iso_data_path, big_sync->bis_con_handles[big_sync->state_vars.next_bis], 1, 0, HCI_AUDIO_CODING_FORMAT_TRANSPARENT, 0, 0, 0, 0, NULL);
69972a6c0f82SMatthias Ringwald                 return true;
69982a6c0f82SMatthias Ringwald             case LE_AUDIO_BIG_STATE_SETUP_ISO_PATHS_FAILED:
69992a6c0f82SMatthias Ringwald                 big_sync->state = LE_AUDIO_BIG_STATE_W4_TERMINATED_AFTER_SETUP_FAILED;
70002a6c0f82SMatthias Ringwald                 hci_send_cmd(&hci_le_big_terminate_sync, big_sync->big_handle);
7001c1f83111SMatthias Ringwald                 return true;
70022a6c0f82SMatthias Ringwald             case LE_AUDIO_BIG_STATE_TERMINATE:
70032a6c0f82SMatthias Ringwald                 big_sync->state = LE_AUDIO_BIG_STATE_W4_TERMINATED;
70042a6c0f82SMatthias Ringwald                 hci_send_cmd(&hci_le_big_terminate_sync, big_sync->big_handle);
70052a6c0f82SMatthias Ringwald                 return true;
70062a6c0f82SMatthias Ringwald             default:
70072a6c0f82SMatthias Ringwald                 break;
70082a6c0f82SMatthias Ringwald         }
70092a6c0f82SMatthias Ringwald     }
70102a6c0f82SMatthias Ringwald 
7011d3a89d91SMatthias Ringwald     // CIG
7012d90722d4SMatthias Ringwald     bool cig_active;
7013d3a89d91SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->le_audio_cigs);
7014d3a89d91SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)) {
7015d3a89d91SMatthias Ringwald         le_audio_cig_t *cig = (le_audio_cig_t *) btstack_linked_list_iterator_next(&it);
7016d3a89d91SMatthias Ringwald         uint8_t i;
7017444e371eSMatthias Ringwald         // Set CIG Parameters
7018d3a89d91SMatthias Ringwald         uint8_t cis_id[MAX_NR_CIS];
7019d3a89d91SMatthias Ringwald         uint16_t max_sdu_c_to_p[MAX_NR_CIS];
7020d3a89d91SMatthias Ringwald         uint16_t max_sdu_p_to_c[MAX_NR_CIS];
7021d3a89d91SMatthias Ringwald         uint8_t phy_c_to_p[MAX_NR_CIS];
7022d3a89d91SMatthias Ringwald         uint8_t phy_p_to_c[MAX_NR_CIS];
7023d3a89d91SMatthias Ringwald         uint8_t rtn_c_to_p[MAX_NR_CIS];
7024d3a89d91SMatthias Ringwald         uint8_t rtn_p_to_c[MAX_NR_CIS];
7025d3a89d91SMatthias Ringwald         switch (cig->state) {
7026d3a89d91SMatthias Ringwald             case LE_AUDIO_CIG_STATE_CREATE:
7027d3a89d91SMatthias Ringwald                 hci_stack->iso_active_operation_group_id = cig->params->cig_id;
7028d3a89d91SMatthias Ringwald                 hci_stack->iso_active_operation_type = HCI_ISO_TYPE_CIS;
7029d3a89d91SMatthias Ringwald                 cig->state = LE_AUDIO_CIG_STATE_W4_ESTABLISHED;
7030d3a89d91SMatthias Ringwald                 le_audio_cig_params_t * params = cig->params;
7031d3a89d91SMatthias Ringwald                 for (i = 0; i < params->num_cis; i++) {
7032d3a89d91SMatthias Ringwald                     le_audio_cis_params_t * cis_params = &cig->params->cis_params[i];
7033d3a89d91SMatthias Ringwald                     cis_id[i]         = cis_params->cis_id;
7034d3a89d91SMatthias Ringwald                     max_sdu_c_to_p[i] = cis_params->max_sdu_c_to_p;
7035d3a89d91SMatthias Ringwald                     max_sdu_p_to_c[i] = cis_params->max_sdu_p_to_c;
7036d3a89d91SMatthias Ringwald                     phy_c_to_p[i]     = cis_params->phy_c_to_p;
7037d3a89d91SMatthias Ringwald                     phy_p_to_c[i]     = cis_params->phy_p_to_c;
7038d3a89d91SMatthias Ringwald                     rtn_c_to_p[i]     = cis_params->rtn_c_to_p;
7039d3a89d91SMatthias Ringwald                     rtn_p_to_c[i]     = cis_params->rtn_p_to_c;
7040d3a89d91SMatthias Ringwald                 }
7041d3a89d91SMatthias Ringwald                 hci_send_cmd(&hci_le_set_cig_parameters,
7042d3a89d91SMatthias Ringwald                              cig->cig_id,
7043d3a89d91SMatthias Ringwald                              params->sdu_interval_c_to_p,
7044d3a89d91SMatthias Ringwald                              params->sdu_interval_p_to_c,
7045d3a89d91SMatthias Ringwald                              params->worst_case_sca,
7046d3a89d91SMatthias Ringwald                              params->packing,
7047d3a89d91SMatthias Ringwald                              params->framing,
7048d3a89d91SMatthias Ringwald                              params->max_transport_latency_c_to_p,
7049d3a89d91SMatthias Ringwald                              params->max_transport_latency_p_to_c,
7050d3a89d91SMatthias Ringwald                              params->num_cis,
7051d3a89d91SMatthias Ringwald                              cis_id,
7052d3a89d91SMatthias Ringwald                              max_sdu_c_to_p,
7053d3a89d91SMatthias Ringwald                              max_sdu_p_to_c,
7054d3a89d91SMatthias Ringwald                              phy_c_to_p,
7055d3a89d91SMatthias Ringwald                              phy_p_to_c,
7056d3a89d91SMatthias Ringwald                              rtn_c_to_p,
7057d3a89d91SMatthias Ringwald                              rtn_p_to_c
7058d3a89d91SMatthias Ringwald                 );
7059bb42b5c0SMatthias Ringwald                 return true;
7060444e371eSMatthias Ringwald             case LE_AUDIO_CIG_STATE_CREATE_CIS:
7061bb42b5c0SMatthias Ringwald                 hci_stack->iso_active_operation_group_id = cig->params->cig_id;
7062bb42b5c0SMatthias Ringwald                 hci_stack->iso_active_operation_type = HCI_ISO_TYPE_CIS;
7063444e371eSMatthias Ringwald                 cig->state = LE_AUDIO_CIG_STATE_W4_CREATE_CIS;
70643abcd16cSMatthias Ringwald                 for (i=0;i<cig->num_cis;i++){
70653abcd16cSMatthias Ringwald                     cig->cis_setup_active[i] = true;
70663abcd16cSMatthias Ringwald                 }
7067444e371eSMatthias Ringwald                 hci_send_cmd(&hci_le_create_cis, cig->num_cis, cig->cis_con_handles, cig->acl_con_handles);
7068bb42b5c0SMatthias Ringwald                 return true;
7069f9306a1aSMatthias Ringwald             case LE_AUDIO_CIG_STATE_SETUP_ISO_PATH:
7070f9306a1aSMatthias Ringwald                 while (cig->state_vars.next_cis < (cig->num_cis * 2)){
7071f9306a1aSMatthias Ringwald                     // find next path to setup
7072f9306a1aSMatthias Ringwald                     uint8_t cis_index = cig->state_vars.next_cis >> 1;
7073f9306a1aSMatthias Ringwald                     if (cig->cis_established[cis_index] == false) {
7074f9306a1aSMatthias Ringwald                         continue;
7075f9306a1aSMatthias Ringwald                     }
7076f9306a1aSMatthias Ringwald                     uint8_t cis_direction = cig->state_vars.next_cis & 1;
7077f9306a1aSMatthias Ringwald                     bool setup = true;
70788e58e4f7SMatthias Ringwald                     if (cis_direction == 0){
7079f9306a1aSMatthias Ringwald                         // 0 - input - host to controller
7080f9306a1aSMatthias Ringwald                         // we are central => central to peripheral
7081f9306a1aSMatthias Ringwald                         setup &= cig->params->cis_params[cis_index].max_sdu_c_to_p > 0;
7082f9306a1aSMatthias Ringwald                     } else {
7083f9306a1aSMatthias Ringwald                         // 1 - output - controller to host
7084f9306a1aSMatthias Ringwald                         // we are central => peripheral to central
7085f9306a1aSMatthias Ringwald                         setup &= cig->params->cis_params[cis_index].max_sdu_p_to_c > 0;
7086f9306a1aSMatthias Ringwald                     }
7087f9306a1aSMatthias Ringwald                     if (setup){
7088f9306a1aSMatthias Ringwald                         hci_stack->iso_active_operation_group_id = cig->params->cig_id;
7089f9306a1aSMatthias Ringwald                         hci_stack->iso_active_operation_type = HCI_ISO_TYPE_CIS;
7090f9306a1aSMatthias Ringwald                         cig->state = LE_AUDIO_CIG_STATE_W4_SETUP_ISO_PATH;
709185dc435bSDirk Helbig                         hci_send_cmd(&hci_le_setup_iso_data_path, cig->cis_con_handles[cis_index], cis_direction, 0, HCI_AUDIO_CODING_FORMAT_TRANSPARENT, 0, 0, 0, 0, NULL);
7092f9306a1aSMatthias Ringwald                         return true;
7093f9306a1aSMatthias Ringwald                     }
70948e58e4f7SMatthias Ringwald                     cig->state_vars.next_cis++;
7095f9306a1aSMatthias Ringwald                 }
7096f9306a1aSMatthias Ringwald                 // emit done
7097f9306a1aSMatthias Ringwald                 cig->state = LE_AUDIO_CIG_STATE_ACTIVE;
7098d90722d4SMatthias Ringwald                 break;
7099d90722d4SMatthias Ringwald             case LE_AUDIO_CIG_STATE_REMOVE:
7100d90722d4SMatthias Ringwald                 // check if CIG Active
7101d90722d4SMatthias Ringwald                 cig_active = false;
7102d90722d4SMatthias Ringwald                 for (i = 0; i < cig->num_cis; i++) {
7103d90722d4SMatthias Ringwald                     if (cig->cis_con_handles[i] != HCI_CON_HANDLE_INVALID){
7104d90722d4SMatthias Ringwald                         hci_iso_stream_t * stream = hci_iso_stream_for_con_handle(cig->cis_con_handles[i]);
7105d90722d4SMatthias Ringwald                         if (stream != NULL){
7106d90722d4SMatthias Ringwald                             cig_active = true;
7107d90722d4SMatthias Ringwald                             break;
7108d90722d4SMatthias Ringwald                         }
7109d90722d4SMatthias Ringwald                     }
7110d90722d4SMatthias Ringwald                 }
7111d90722d4SMatthias Ringwald                 if (cig_active == false){
7112d90722d4SMatthias Ringwald                     btstack_linked_list_iterator_remove(&it);
7113d90722d4SMatthias Ringwald                     hci_send_cmd(&hci_le_remove_cig, cig->cig_id);
7114d90722d4SMatthias Ringwald                     return true;
7115d90722d4SMatthias Ringwald                 }
7116d3a89d91SMatthias Ringwald             default:
7117d3a89d91SMatthias Ringwald                 break;
7118d3a89d91SMatthias Ringwald         }
7119d3a89d91SMatthias Ringwald     }
7120d3a89d91SMatthias Ringwald 
7121d90722d4SMatthias Ringwald     // CIS Accept/Reject/Setup ISO Path/Close
712226b93350SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->iso_streams);
712326b93350SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)) {
712426b93350SMatthias Ringwald         hci_iso_stream_t *iso_stream = (hci_iso_stream_t *) btstack_linked_list_iterator_next(&it);
712526b93350SMatthias Ringwald         hci_con_handle_t con_handle;
712626b93350SMatthias Ringwald         switch (iso_stream->state){
712726b93350SMatthias Ringwald             case HCI_ISO_STREAM_W2_ACCEPT:
712826b93350SMatthias Ringwald                 iso_stream->state = HCI_ISO_STREAM_STATE_W4_ESTABLISHED;
712926b93350SMatthias Ringwald                 hci_stack->iso_active_operation_type = HCI_ISO_TYPE_CIS;
713026b93350SMatthias Ringwald                 hci_stack->iso_active_operation_group_id = HCI_ISO_GROUP_ID_SINGLE_CIS;
7131969d876aSMatthias Ringwald                 hci_send_cmd(&hci_le_accept_cis_request, iso_stream->cis_handle);
713226b93350SMatthias Ringwald                 return true;
713326b93350SMatthias Ringwald             case HCI_ISO_STREAM_W2_REJECT:
7134969d876aSMatthias Ringwald                 con_handle = iso_stream->cis_handle;
713526b93350SMatthias Ringwald                 hci_stack->iso_active_operation_type = HCI_ISO_TYPE_CIS;
713626b93350SMatthias Ringwald                 hci_stack->iso_active_operation_group_id = HCI_ISO_GROUP_ID_SINGLE_CIS;
713726b93350SMatthias Ringwald                 hci_iso_stream_finalize(iso_stream);
713826b93350SMatthias Ringwald                 hci_send_cmd(&hci_le_reject_cis_request, con_handle, ERROR_CODE_REMOTE_DEVICE_TERMINATED_CONNECTION_DUE_TO_LOW_RESOURCES);
713926b93350SMatthias Ringwald                 return true;
714026b93350SMatthias Ringwald             case HCI_ISO_STREAM_STATE_W2_SETUP_ISO_INPUT:
714126b93350SMatthias Ringwald                 hci_stack->iso_active_operation_group_id = HCI_ISO_GROUP_ID_SINGLE_CIS;
714226b93350SMatthias Ringwald                 hci_stack->iso_active_operation_type = HCI_ISO_TYPE_CIS;
714326b93350SMatthias Ringwald                 iso_stream->state = HCI_ISO_STREAM_STATE_W4_ISO_SETUP_INPUT;
714485dc435bSDirk Helbig                 hci_send_cmd(&hci_le_setup_iso_data_path, iso_stream->cis_handle, 0, 0, HCI_AUDIO_CODING_FORMAT_TRANSPARENT, 0, 0, 0, 0, NULL);
714526b93350SMatthias Ringwald                 break;
714626b93350SMatthias Ringwald             case HCI_ISO_STREAM_STATE_W2_SETUP_ISO_OUTPUT:
714726b93350SMatthias Ringwald                 hci_stack->iso_active_operation_group_id = HCI_ISO_GROUP_ID_SINGLE_CIS;
714826b93350SMatthias Ringwald                 hci_stack->iso_active_operation_type = HCI_ISO_TYPE_CIS;
714926b93350SMatthias Ringwald                 iso_stream->state = HCI_ISO_STREAM_STATE_W4_ISO_SETUP_OUTPUT;
715085dc435bSDirk Helbig                 hci_send_cmd(&hci_le_setup_iso_data_path, iso_stream->cis_handle, 1, 0, HCI_AUDIO_CODING_FORMAT_TRANSPARENT, 0, 0, 0, 0, NULL);
715126b93350SMatthias Ringwald                 break;
7152d90722d4SMatthias Ringwald             case HCI_ISO_STREAM_STATE_W2_CLOSE:
7153d90722d4SMatthias Ringwald                 iso_stream->state = HCI_ISO_STREAM_STATE_W4_DISCONNECTED;
7154d90722d4SMatthias Ringwald                 hci_send_cmd(&hci_disconnect, iso_stream->cis_handle);
7155d90722d4SMatthias Ringwald                 break;
715626b93350SMatthias Ringwald             default:
715726b93350SMatthias Ringwald                 break;
715826b93350SMatthias Ringwald         }
715926b93350SMatthias Ringwald     }
716026b93350SMatthias Ringwald 
71617aa35f6aSMatthias Ringwald     return false;
71627aa35f6aSMatthias Ringwald }
71637aa35f6aSMatthias Ringwald #endif /* ENABLE_LE_ISOCHRONOUS_STREAMS */
7164b2f949feS[email protected] #endif
71657bdc6798S[email protected] 
716688a03c8dSMatthias Ringwald static bool hci_run_general_pending_commands(void){
7167f30077b7SMatthias Ringwald     btstack_linked_item_t * it;
7168a0da043fSMatthias Ringwald     for (it = (btstack_linked_item_t *) hci_stack->connections; it != NULL; it = it->next){
716905ae8de3SMatthias Ringwald         hci_connection_t * connection = (hci_connection_t *) it;
717032ab9390Smatthias.ringwald 
71710bf6344aS[email protected]         switch(connection->state){
71720bf6344aS[email protected]             case SEND_CREATE_CONNECTION:
71734f3229d8S[email protected]                 switch(connection->address_type){
717435454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
7175f16129ceSMatthias Ringwald                     case BD_ADDR_TYPE_ACL:
71769da54300S[email protected]                         log_info("sending hci_create_connection");
7177b4eb4420SMatthias Ringwald                         hci_send_cmd(&hci_create_connection, connection->address, hci_usable_acl_packet_types(), 0, 0, 0, hci_stack->allow_role_switch);
71784f3229d8S[email protected]                         break;
717935454696SMatthias Ringwald #endif
71804f3229d8S[email protected]                     default:
7181a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE
7182d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
71839da54300S[email protected]                         log_info("sending hci_le_create_connection");
71846bcfa632SMatthias Ringwald                         hci_stack->le_connection_own_addr_type =  hci_stack->le_own_addr_type;
71856bcfa632SMatthias Ringwald                         hci_get_own_address_for_addr_type(hci_stack->le_connection_own_addr_type, hci_stack->le_connection_own_address);
7186f346015eSMatthias Ringwald                         hci_send_le_create_connection(0, connection->address_type, connection->address);
71874f3229d8S[email protected]                         connection->state = SENT_CREATE_CONNECTION;
7188b2f949feS[email protected] #endif
7189d70217a2SMatthias Ringwald #endif
71904f3229d8S[email protected]                         break;
71914f3229d8S[email protected]                 }
7192f30077b7SMatthias Ringwald                 return true;
7193ad83dc6aS[email protected] 
719435454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
71950bf6344aS[email protected]             case RECEIVED_CONNECTION_REQUEST:
7196f16129ceSMatthias Ringwald                 if (connection->address_type == BD_ADDR_TYPE_ACL){
719776ccfb2aSMatthias Ringwald                     log_info("sending hci_accept_connection_request");
7198895f6685SMilanka Ringwald                     connection->state = ACCEPTED_CONNECTION_REQUEST;
7199c4c88f1bSJakob Krantz                     hci_send_cmd(&hci_accept_connection_request, connection->address, hci_stack->master_slave_policy);
7200f30077b7SMatthias Ringwald                     return true;
7201ee025741SMatthias Ringwald                 }
7202ee025741SMatthias Ringwald                 break;
720335454696SMatthias Ringwald #endif
72040bf6344aS[email protected]             case SEND_DISCONNECT:
72050bf6344aS[email protected]                 connection->state = SENT_DISCONNECT;
72066ef3696aSMatthias Ringwald                 hci_send_cmd(&hci_disconnect, connection->con_handle, ERROR_CODE_REMOTE_USER_TERMINATED_CONNECTION);
7207f30077b7SMatthias Ringwald                 return true;
72080bf6344aS[email protected] 
72090bf6344aS[email protected]             default:
72100bf6344aS[email protected]                 break;
7211c7e0c5f6Smatthias.ringwald         }
7212c7e0c5f6Smatthias.ringwald 
7213cabf004eSMatthias Ringwald         // no further commands if connection is about to get shut down
7214cabf004eSMatthias Ringwald         if (connection->state == SENT_DISCONNECT) continue;
7215cabf004eSMatthias Ringwald 
721694418890SMatthias Ringwald #ifdef ENABLE_CLASSIC
721794418890SMatthias Ringwald 
7218ad20f0c8SMatthias Ringwald         // Handling link key request requires remote supported features
721950f49832SMatthias Ringwald         if (((connection->authentication_flags & AUTH_FLAG_HANDLE_LINK_KEY_REQUEST) != 0)){
7220608f51bbSMatthias Ringwald             log_info("responding to link key request, have link key db: %u", hci_stack->link_key_db != NULL);
72218daf94bcSMatthias Ringwald             connectionClearAuthenticationFlags(connection, AUTH_FLAG_HANDLE_LINK_KEY_REQUEST);
722230e72d78SMatthias Ringwald 
7223e9f98c4aSMatthias Ringwald             bool have_link_key = connection->link_key_type != INVALID_LINK_KEY;
7224e9f98c4aSMatthias Ringwald             bool security_level_sufficient = have_link_key && (gap_security_level_for_link_key_type(connection->link_key_type) >= connection->requested_security_level);
722530e72d78SMatthias Ringwald             if (have_link_key && security_level_sufficient){
7226e9f98c4aSMatthias Ringwald                 hci_send_cmd(&hci_link_key_request_reply, connection->address, &connection->link_key);
722732ab9390Smatthias.ringwald             } else {
722832ab9390Smatthias.ringwald                 hci_send_cmd(&hci_link_key_request_negative_reply, connection->address);
722932ab9390Smatthias.ringwald             }
7230f30077b7SMatthias Ringwald             return true;
723132ab9390Smatthias.ringwald         }
72321d6b20aeS[email protected] 
72338daf94bcSMatthias Ringwald         if (connection->authentication_flags & AUTH_FLAG_DENY_PIN_CODE_REQUEST){
72349da54300S[email protected]             log_info("denying to pin request");
72358daf94bcSMatthias Ringwald             connectionClearAuthenticationFlags(connection, AUTH_FLAG_DENY_PIN_CODE_REQUEST);
723634d2123cS[email protected]             hci_send_cmd(&hci_pin_code_request_negative_reply, connection->address);
7237f30077b7SMatthias Ringwald             return true;
72384c57c146S[email protected]         }
72394c57c146S[email protected] 
7240c950c316SMatthias Ringwald         // security assessment requires remote features
72412dd8985bSMatthias Ringwald         if ((connection->authentication_flags & AUTH_FLAG_RECV_IO_CAPABILITIES_REQUEST) != 0){
7242c950c316SMatthias Ringwald             connectionClearAuthenticationFlags(connection, AUTH_FLAG_RECV_IO_CAPABILITIES_REQUEST);
7243c950c316SMatthias Ringwald             hci_ssp_assess_security_on_io_cap_request(connection);
7244c950c316SMatthias Ringwald             // no return here as hci_ssp_assess_security_on_io_cap_request only sets AUTH_FLAG_SEND_IO_CAPABILITIES_REPLY or AUTH_FLAG_SEND_IO_CAPABILITIES_NEGATIVE_REPLY
7245c950c316SMatthias Ringwald         }
7246c950c316SMatthias Ringwald 
72478daf94bcSMatthias Ringwald         if (connection->authentication_flags & AUTH_FLAG_SEND_IO_CAPABILITIES_REPLY){
72488daf94bcSMatthias Ringwald             connectionClearAuthenticationFlags(connection, AUTH_FLAG_SEND_IO_CAPABILITIES_REPLY);
7249a8d20135SMatthias Ringwald             // set authentication requirements:
7250a8d20135SMatthias Ringwald             // - MITM = ssp_authentication_requirement (USER) | requested_security_level (dynamic)
7251532454f9SMatthias Ringwald             // - BONDING MODE: dedicated if requested, bondable otherwise. Drop bondable if not set for remote
7252a8d20135SMatthias Ringwald             uint8_t authreq = hci_stack->ssp_authentication_requirement & 1;
72539faad3abS[email protected]             if (gap_mitm_protection_required_for_security_level(connection->requested_security_level)){
72549faad3abS[email protected]                 authreq |= 1;
7255106d6d11S[email protected]             }
7256532454f9SMatthias Ringwald             bool bonding = hci_stack->bondable;
72578daf94bcSMatthias Ringwald             if (connection->authentication_flags & AUTH_FLAG_RECV_IO_CAPABILITIES_RESPONSE){
7258532454f9SMatthias Ringwald                 // if we have received IO Cap Response, we're in responder role
7259532454f9SMatthias Ringwald                 bool remote_bonding = connection->io_cap_response_auth_req >= SSP_IO_AUTHREQ_MITM_PROTECTION_NOT_REQUIRED_DEDICATED_BONDING;
7260532454f9SMatthias Ringwald                 if (bonding && !remote_bonding){
7261532454f9SMatthias Ringwald                     log_info("Remote not bonding, dropping local flag");
7262532454f9SMatthias Ringwald                     bonding = false;
7263532454f9SMatthias Ringwald                 }
7264532454f9SMatthias Ringwald             }
7265532454f9SMatthias Ringwald             if (bonding){
7266a8d20135SMatthias Ringwald                 if (connection->bonding_flags & BONDING_DEDICATED){
7267a8d20135SMatthias Ringwald                     authreq |= SSP_IO_AUTHREQ_MITM_PROTECTION_NOT_REQUIRED_DEDICATED_BONDING;
7268532454f9SMatthias Ringwald                 } else {
7269a8d20135SMatthias Ringwald                     authreq |= SSP_IO_AUTHREQ_MITM_PROTECTION_NOT_REQUIRED_GENERAL_BONDING;
7270a8d20135SMatthias Ringwald                 }
7271532454f9SMatthias Ringwald             }
72721849becdSMatthias Ringwald             uint8_t have_oob_data = 0;
72731849becdSMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB
72741849becdSMatthias Ringwald             if (connection->classic_oob_c_192 != NULL){
72751849becdSMatthias Ringwald                     have_oob_data |= 1;
72761849becdSMatthias Ringwald             }
72771849becdSMatthias Ringwald             if (connection->classic_oob_c_256 != NULL){
72781849becdSMatthias Ringwald                 have_oob_data |= 2;
72791849becdSMatthias Ringwald             }
72801849becdSMatthias Ringwald #endif
72811849becdSMatthias Ringwald             hci_send_cmd(&hci_io_capability_request_reply, &connection->address, hci_stack->ssp_io_capability, have_oob_data, authreq);
728211b03efaSMatthias Ringwald             return true;
7283f8fb5f6eS[email protected]         }
728411b03efaSMatthias Ringwald 
72858daf94bcSMatthias Ringwald         if (connection->authentication_flags & AUTH_FLAG_SEND_IO_CAPABILITIES_NEGATIVE_REPLY) {
72868daf94bcSMatthias Ringwald             connectionClearAuthenticationFlags(connection, AUTH_FLAG_SEND_IO_CAPABILITIES_NEGATIVE_REPLY);
728711b03efaSMatthias Ringwald             hci_send_cmd(&hci_io_capability_request_negative_reply, &connection->address, ERROR_CODE_PAIRING_NOT_ALLOWED);
7288f30077b7SMatthias Ringwald             return true;
728932ab9390Smatthias.ringwald         }
729032ab9390Smatthias.ringwald 
72911849becdSMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB
72927ca4a7edSMatthias Ringwald         if (connection->authentication_flags & AUTH_FLAG_SEND_REMOTE_OOB_DATA_REPLY){
72937ca4a7edSMatthias Ringwald             connectionClearAuthenticationFlags(connection, AUTH_FLAG_SEND_REMOTE_OOB_DATA_REPLY);
72941849becdSMatthias Ringwald             const uint8_t zero[16] = { 0 };
72951849becdSMatthias Ringwald             const uint8_t * r_192 = zero;
72961849becdSMatthias Ringwald             const uint8_t * c_192 = zero;
72971849becdSMatthias Ringwald             const uint8_t * r_256 = zero;
72981849becdSMatthias Ringwald             const uint8_t * c_256 = zero;
72991849becdSMatthias Ringwald             // verify P-256 OOB
73001e83575aSMatthias Ringwald             if ((connection->classic_oob_c_256 != NULL) && hci_command_supported(SUPPORTED_HCI_COMMAND_REMOTE_OOB_EXTENDED_DATA_REQUEST_REPLY)) {
73011849becdSMatthias Ringwald                 c_256 = connection->classic_oob_c_256;
73021849becdSMatthias Ringwald                 if (connection->classic_oob_r_256 != NULL) {
73031849becdSMatthias Ringwald                     r_256 = connection->classic_oob_r_256;
73041849becdSMatthias Ringwald                 }
73051849becdSMatthias Ringwald             }
73061849becdSMatthias Ringwald             // verify P-192 OOB
73071849becdSMatthias Ringwald             if ((connection->classic_oob_c_192 != NULL)) {
73081849becdSMatthias Ringwald                 c_192 = connection->classic_oob_c_192;
73091849becdSMatthias Ringwald                 if (connection->classic_oob_r_192 != NULL) {
73101849becdSMatthias Ringwald                     r_192 = connection->classic_oob_r_192;
73111849becdSMatthias Ringwald                 }
73121849becdSMatthias Ringwald             }
73137ca4a7edSMatthias Ringwald 
73147ca4a7edSMatthias Ringwald             // assess security
73157ca4a7edSMatthias Ringwald             bool need_level_4 = hci_stack->gap_secure_connections_only_mode || (connection->requested_security_level == LEVEL_4);
73167ca4a7edSMatthias Ringwald             bool can_reach_level_4 = hci_remote_sc_enabled(connection) && (c_256 != NULL);
73177ca4a7edSMatthias Ringwald             if (need_level_4 && !can_reach_level_4){
73187ca4a7edSMatthias Ringwald                 log_info("Level 4 required, but not possible -> abort");
73197ca4a7edSMatthias Ringwald                 hci_pairing_complete(connection, ERROR_CODE_INSUFFICIENT_SECURITY);
73207ca4a7edSMatthias Ringwald                 // send oob negative reply
73217ca4a7edSMatthias Ringwald                 c_256 = NULL;
73227ca4a7edSMatthias Ringwald                 c_192 = NULL;
73237ca4a7edSMatthias Ringwald             }
73247ca4a7edSMatthias Ringwald 
73251849becdSMatthias Ringwald             // Reply
73261849becdSMatthias Ringwald             if (c_256 != zero) {
73271849becdSMatthias Ringwald                 hci_send_cmd(&hci_remote_oob_extended_data_request_reply, &connection->address, c_192, r_192, c_256, r_256);
73281849becdSMatthias Ringwald             } else if (c_192 != zero){
73291849becdSMatthias Ringwald                 hci_send_cmd(&hci_remote_oob_data_request_reply, &connection->address, c_192, r_192);
73301849becdSMatthias Ringwald             } else {
73311ae74bf3SMatthias Ringwald                 hci_stack->classic_oob_con_handle = connection->con_handle;
73321849becdSMatthias Ringwald                 hci_send_cmd(&hci_remote_oob_data_request_negative_reply, &connection->address);
73331849becdSMatthias Ringwald             }
73341849becdSMatthias Ringwald             return true;
73351849becdSMatthias Ringwald         }
73361849becdSMatthias Ringwald #endif
73371849becdSMatthias Ringwald 
73388daf94bcSMatthias Ringwald         if (connection->authentication_flags & AUTH_FLAG_SEND_USER_CONFIRM_REPLY){
73398daf94bcSMatthias Ringwald             connectionClearAuthenticationFlags(connection, AUTH_FLAG_SEND_USER_CONFIRM_REPLY);
734034d2123cS[email protected]             hci_send_cmd(&hci_user_confirmation_request_reply, &connection->address);
7341f30077b7SMatthias Ringwald             return true;
7342dbe1a790S[email protected]         }
7343dbe1a790S[email protected] 
7344367aedc0SMatthias Ringwald         if (connection->authentication_flags & AUTH_FLAG_SEND_USER_CONFIRM_NEGATIVE_REPLY){
7345367aedc0SMatthias Ringwald             connectionClearAuthenticationFlags(connection, AUTH_FLAG_SEND_USER_CONFIRM_NEGATIVE_REPLY);
7346367aedc0SMatthias Ringwald             hci_send_cmd(&hci_user_confirmation_request_negative_reply, &connection->address);
7347367aedc0SMatthias Ringwald             return true;
7348367aedc0SMatthias Ringwald         }
7349367aedc0SMatthias Ringwald 
73508daf94bcSMatthias Ringwald         if (connection->authentication_flags & AUTH_FLAG_SEND_USER_PASSKEY_REPLY){
73518daf94bcSMatthias Ringwald             connectionClearAuthenticationFlags(connection, AUTH_FLAG_SEND_USER_PASSKEY_REPLY);
735234d2123cS[email protected]             hci_send_cmd(&hci_user_passkey_request_reply, &connection->address, 000000);
7353f30077b7SMatthias Ringwald             return true;
7354dbe1a790S[email protected]         }
7355afd4e962S[email protected] 
7356ab0c69a9SMatthias Ringwald         if ((connection->bonding_flags & (BONDING_DISCONNECT_DEDICATED_DONE | BONDING_DEDICATED_DEFER_DISCONNECT)) == BONDING_DISCONNECT_DEDICATED_DONE){
7357ad83dc6aS[email protected]             connection->bonding_flags &= ~BONDING_DISCONNECT_DEDICATED_DONE;
73581bd5283dS[email protected]             connection->bonding_flags |= BONDING_EMIT_COMPLETE_ON_DISCONNECT;
73596ef3696aSMatthias Ringwald             connection->state = SENT_DISCONNECT;
73606ef3696aSMatthias Ringwald             hci_send_cmd(&hci_disconnect, connection->con_handle, ERROR_CODE_REMOTE_USER_TERMINATED_CONNECTION);
7361f30077b7SMatthias Ringwald             return true;
7362ad83dc6aS[email protected]         }
736376f27cffSMatthias Ringwald 
73642a75353aSMatthias Ringwald         if ((connection->bonding_flags & BONDING_SEND_AUTHENTICATE_REQUEST) && ((connection->bonding_flags & BONDING_RECEIVED_REMOTE_FEATURES) != 0)){
736534d2123cS[email protected]             connection->bonding_flags &= ~BONDING_SEND_AUTHENTICATE_REQUEST;
7366abdad579SMatthias Ringwald             connection->bonding_flags |= BONDING_SENT_AUTHENTICATE_REQUEST;
736734d2123cS[email protected]             hci_send_cmd(&hci_authentication_requested, connection->con_handle);
7368f30077b7SMatthias Ringwald             return true;
7369afd4e962S[email protected]         }
737076f27cffSMatthias Ringwald 
7371dce78009S[email protected]         if (connection->bonding_flags & BONDING_SEND_ENCRYPTION_REQUEST){
7372dce78009S[email protected]             connection->bonding_flags &= ~BONDING_SEND_ENCRYPTION_REQUEST;
7373dce78009S[email protected]             hci_send_cmd(&hci_set_connection_encryption, connection->con_handle, 1);
7374f30077b7SMatthias Ringwald             return true;
7375dce78009S[email protected]         }
7376447016ffSMatthias Ringwald 
7377573897a0SMatthias Ringwald         if (connection->bonding_flags & BONDING_SEND_READ_ENCRYPTION_KEY_SIZE){
7378573897a0SMatthias Ringwald             connection->bonding_flags &= ~BONDING_SEND_READ_ENCRYPTION_KEY_SIZE;
7379573897a0SMatthias Ringwald             hci_send_cmd(&hci_read_encryption_key_size, connection->con_handle, 1);
7380f30077b7SMatthias Ringwald             return true;
7381573897a0SMatthias Ringwald         }
7382447016ffSMatthias Ringwald 
7383447016ffSMatthias Ringwald         if (connection->bonding_flags & BONDING_REQUEST_REMOTE_FEATURES_PAGE_0){
7384447016ffSMatthias Ringwald             connection->bonding_flags &= ~BONDING_REQUEST_REMOTE_FEATURES_PAGE_0;
7385447016ffSMatthias Ringwald             hci_send_cmd(&hci_read_remote_supported_features_command, connection->con_handle);
7386447016ffSMatthias Ringwald             return true;
7387447016ffSMatthias Ringwald         }
7388447016ffSMatthias Ringwald 
7389447016ffSMatthias Ringwald         if (connection->bonding_flags & BONDING_REQUEST_REMOTE_FEATURES_PAGE_1){
7390447016ffSMatthias Ringwald             connection->bonding_flags &= ~BONDING_REQUEST_REMOTE_FEATURES_PAGE_1;
7391447016ffSMatthias Ringwald             hci_send_cmd(&hci_read_remote_extended_features_command, connection->con_handle, 1);
7392447016ffSMatthias Ringwald             return true;
7393447016ffSMatthias Ringwald         }
7394447016ffSMatthias Ringwald 
7395447016ffSMatthias Ringwald         if (connection->bonding_flags & BONDING_REQUEST_REMOTE_FEATURES_PAGE_2){
7396447016ffSMatthias Ringwald             connection->bonding_flags &= ~BONDING_REQUEST_REMOTE_FEATURES_PAGE_2;
7397447016ffSMatthias Ringwald             hci_send_cmd(&hci_read_remote_extended_features_command, connection->con_handle, 2);
7398447016ffSMatthias Ringwald             return true;
7399447016ffSMatthias Ringwald         }
740076f27cffSMatthias Ringwald #endif
740176f27cffSMatthias Ringwald 
740276f27cffSMatthias Ringwald         if (connection->bonding_flags & BONDING_DISCONNECT_SECURITY_BLOCK){
740376f27cffSMatthias Ringwald             connection->bonding_flags &= ~BONDING_DISCONNECT_SECURITY_BLOCK;
74041714cbbdSMatthias Ringwald #ifdef ENABLE_CLASSIC
74051714cbbdSMatthias Ringwald             hci_pairing_complete(connection, ERROR_CODE_CONNECTION_REJECTED_DUE_TO_SECURITY_REASONS);
74061714cbbdSMatthias Ringwald #endif
74076ef3696aSMatthias Ringwald             if (connection->state != SENT_DISCONNECT){
74086ef3696aSMatthias Ringwald                 connection->state = SENT_DISCONNECT;
74096ef3696aSMatthias Ringwald                 hci_send_cmd(&hci_disconnect, connection->con_handle, ERROR_CODE_AUTHENTICATION_FAILURE);
7410f30077b7SMatthias Ringwald                 return true;
741176f27cffSMatthias Ringwald             }
74126ef3696aSMatthias Ringwald         }
7413da886c03S[email protected] 
74146cdc2862SMatthias Ringwald #ifdef ENABLE_CLASSIC
7415f8ee3071SMatthias Ringwald         uint16_t sniff_min_interval;
7416f8ee3071SMatthias Ringwald         switch (connection->sniff_min_interval){
7417f8ee3071SMatthias Ringwald             case 0:
7418f8ee3071SMatthias Ringwald                 break;
7419f8ee3071SMatthias Ringwald             case 0xffff:
7420f8ee3071SMatthias Ringwald                 connection->sniff_min_interval = 0;
7421f8ee3071SMatthias Ringwald                 hci_send_cmd(&hci_exit_sniff_mode, connection->con_handle);
7422f30077b7SMatthias Ringwald                 return true;
7423f8ee3071SMatthias Ringwald             default:
7424f8ee3071SMatthias Ringwald                 sniff_min_interval = connection->sniff_min_interval;
7425f8ee3071SMatthias Ringwald                 connection->sniff_min_interval = 0;
7426f8ee3071SMatthias Ringwald                 hci_send_cmd(&hci_sniff_mode, connection->con_handle, connection->sniff_max_interval, sniff_min_interval, connection->sniff_attempt, connection->sniff_timeout);
7427f30077b7SMatthias Ringwald                 return true;
7428f8ee3071SMatthias Ringwald         }
742988a03c8dSMatthias Ringwald 
7430140c0557SMatthias Ringwald         if (connection->sniff_subrating_max_latency != 0xffff){
7431140c0557SMatthias Ringwald             uint16_t max_latency = connection->sniff_subrating_max_latency;
7432140c0557SMatthias Ringwald             connection->sniff_subrating_max_latency = 0;
7433140c0557SMatthias Ringwald             hci_send_cmd(&hci_sniff_subrating, connection->con_handle, max_latency, connection->sniff_subrating_min_remote_timeout, connection->sniff_subrating_min_local_timeout);
7434140c0557SMatthias Ringwald             return true;
7435140c0557SMatthias Ringwald         }
7436140c0557SMatthias Ringwald 
7437965a4ccfSMatthias Ringwald         if (connection->qos_service_type != HCI_SERVICE_TYPE_INVALID){
7438278ff8a9SMatthias Ringwald             uint8_t service_type = (uint8_t) connection->qos_service_type;
7439965a4ccfSMatthias Ringwald             connection->qos_service_type = HCI_SERVICE_TYPE_INVALID;
7440278ff8a9SMatthias Ringwald             hci_send_cmd(&hci_qos_setup, connection->con_handle, 0, service_type, connection->qos_token_rate, connection->qos_peak_bandwidth, connection->qos_latency, connection->qos_delay_variation);
7441278ff8a9SMatthias Ringwald             return true;
7442278ff8a9SMatthias Ringwald         }
7443278ff8a9SMatthias Ringwald 
744488a03c8dSMatthias Ringwald         if (connection->request_role != HCI_ROLE_INVALID){
744588a03c8dSMatthias Ringwald             hci_role_t role = connection->request_role;
744688a03c8dSMatthias Ringwald             connection->request_role = HCI_ROLE_INVALID;
744788a03c8dSMatthias Ringwald             hci_send_cmd(&hci_switch_role_command, connection->address, role);
744888a03c8dSMatthias Ringwald             return true;
744988a03c8dSMatthias Ringwald         }
745022df2fe2SMatthias Ringwald #endif
74519afaa4d4SMatthias Ringwald 
74529afaa4d4SMatthias Ringwald         if (connection->gap_connection_tasks != 0){
745322df2fe2SMatthias Ringwald #ifdef ENABLE_CLASSIC
74549afaa4d4SMatthias Ringwald             if ((connection->gap_connection_tasks & GAP_CONNECTION_TASK_WRITE_AUTOMATIC_FLUSH_TIMEOUT) != 0){
74559afaa4d4SMatthias Ringwald                 connection->gap_connection_tasks &= ~GAP_CONNECTION_TASK_WRITE_AUTOMATIC_FLUSH_TIMEOUT;
74569afaa4d4SMatthias Ringwald                 hci_send_cmd(&hci_write_automatic_flush_timeout, connection->con_handle, hci_stack->automatic_flush_timeout);
74579afaa4d4SMatthias Ringwald                 return true;
74589afaa4d4SMatthias Ringwald             }
745922df2fe2SMatthias Ringwald             if (connection->gap_connection_tasks & GAP_CONNECTION_TASK_WRITE_SUPERVISION_TIMEOUT){
746022df2fe2SMatthias Ringwald                 connection->gap_connection_tasks &= ~GAP_CONNECTION_TASK_WRITE_SUPERVISION_TIMEOUT;
746122df2fe2SMatthias Ringwald                 hci_send_cmd(&hci_write_link_supervision_timeout, connection->con_handle, hci_stack->link_supervision_timeout);
746222df2fe2SMatthias Ringwald                 return true;
74639afaa4d4SMatthias Ringwald             }
74646cdc2862SMatthias Ringwald #endif
746522df2fe2SMatthias Ringwald             if (connection->gap_connection_tasks & GAP_CONNECTION_TASK_READ_RSSI){
746622df2fe2SMatthias Ringwald                 connection->gap_connection_tasks &= ~GAP_CONNECTION_TASK_READ_RSSI;
746722df2fe2SMatthias Ringwald                 hci_send_cmd(&hci_read_rssi, connection->con_handle);
746822df2fe2SMatthias Ringwald                 return true;
746922df2fe2SMatthias Ringwald             }
7470ac0f6b83SMatthias Ringwald #ifdef ENABLE_BLE
7471ac0f6b83SMatthias Ringwald             if (connection->gap_connection_tasks & GAP_CONNECTION_TASK_LE_READ_REMOTE_FEATURES){
7472ac0f6b83SMatthias Ringwald                 connection->gap_connection_tasks &= ~GAP_CONNECTION_TASK_LE_READ_REMOTE_FEATURES;
7473ac0f6b83SMatthias Ringwald                 hci_send_cmd(&hci_le_read_remote_used_features, connection->con_handle);
7474ac0f6b83SMatthias Ringwald                 return true;
7475ac0f6b83SMatthias Ringwald             }
7476ac0f6b83SMatthias Ringwald #endif
747722df2fe2SMatthias Ringwald         }
7478f8ee3071SMatthias Ringwald 
7479a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE
748073cd8a2aSMatthias Ringwald         switch (connection->le_con_parameter_update_state){
748173cd8a2aSMatthias Ringwald             // response to L2CAP CON PARAMETER UPDATE REQUEST
748273cd8a2aSMatthias Ringwald             case CON_PARAMETER_UPDATE_CHANGE_HCI_CON_PARAMETERS:
7483da886c03S[email protected]                 connection->le_con_parameter_update_state = CON_PARAMETER_UPDATE_NONE;
748473cd8a2aSMatthias Ringwald                 hci_send_cmd(&hci_le_connection_update, connection->con_handle, connection->le_conn_interval_min,
7485c37a3166S[email protected]                              connection->le_conn_interval_max, connection->le_conn_latency, connection->le_supervision_timeout,
7486d4876126SMatthias Ringwald                              hci_stack->le_minimum_ce_length, hci_stack->le_maximum_ce_length);
7487f30077b7SMatthias Ringwald                 return true;
748873cd8a2aSMatthias Ringwald             case CON_PARAMETER_UPDATE_REPLY:
748973cd8a2aSMatthias Ringwald                 connection->le_con_parameter_update_state = CON_PARAMETER_UPDATE_NONE;
749073cd8a2aSMatthias Ringwald                 hci_send_cmd(&hci_le_remote_connection_parameter_request_reply, connection->con_handle, connection->le_conn_interval_min,
749173cd8a2aSMatthias Ringwald                              connection->le_conn_interval_max, connection->le_conn_latency, connection->le_supervision_timeout,
7492d4876126SMatthias Ringwald                              hci_stack->le_minimum_ce_length, hci_stack->le_maximum_ce_length);
7493f30077b7SMatthias Ringwald                 return true;
749473cd8a2aSMatthias Ringwald             case CON_PARAMETER_UPDATE_NEGATIVE_REPLY:
749573cd8a2aSMatthias Ringwald                 connection->le_con_parameter_update_state = CON_PARAMETER_UPDATE_NONE;
74961e0338ebSMatthias Ringwald                 hci_send_cmd(&hci_le_remote_connection_parameter_request_negative_reply, connection->con_handle,
74971e0338ebSMatthias Ringwald                              ERROR_CODE_UNACCEPTABLE_CONNECTION_PARAMETERS);
7498f30077b7SMatthias Ringwald                 return true;
749973cd8a2aSMatthias Ringwald             default:
750073cd8a2aSMatthias Ringwald                 break;
7501c37a3166S[email protected]         }
75024ea43905SMatthias Ringwald         if (connection->le_phy_update_all_phys != 0xffu){
7503b90f6e0aSMatthias Ringwald             uint8_t all_phys = connection->le_phy_update_all_phys;
7504b90f6e0aSMatthias Ringwald             connection->le_phy_update_all_phys = 0xff;
7505b90f6e0aSMatthias Ringwald             hci_send_cmd(&hci_le_set_phy, connection->con_handle, all_phys, connection->le_phy_update_tx_phys, connection->le_phy_update_rx_phys, connection->le_phy_update_phy_options);
7506f30077b7SMatthias Ringwald             return true;
7507b90f6e0aSMatthias Ringwald         }
75083bd96807SMatthias Ringwald #ifdef ENABLE_LE_PERIODIC_ADVERTISING
75093bd96807SMatthias Ringwald         if (connection->le_past_sync_handle != HCI_CON_HANDLE_INVALID){
75103bd96807SMatthias Ringwald             hci_con_handle_t sync_handle = connection->le_past_sync_handle;
75113bd96807SMatthias Ringwald             connection->le_past_sync_handle = HCI_CON_HANDLE_INVALID;
75123bd96807SMatthias Ringwald             hci_send_cmd(&hci_le_periodic_advertising_sync_transfer, connection->con_handle, connection->le_past_service_data, sync_handle);
75133bd96807SMatthias Ringwald             return true;
75143bd96807SMatthias Ringwald         }
7515027f4677SMatthias Ringwald         if (connection->le_past_advertising_handle != 0xff){
7516027f4677SMatthias Ringwald             uint8_t advertising_handle = connection->le_past_advertising_handle;
7517027f4677SMatthias Ringwald             connection->le_past_advertising_handle = 0xff;
7518027f4677SMatthias Ringwald             hci_send_cmd(&hci_le_periodic_advertising_set_info_transfer, connection->con_handle, connection->le_past_service_data, advertising_handle);
7519027f4677SMatthias Ringwald             return true;
7520027f4677SMatthias Ringwald         }
75213bd96807SMatthias Ringwald #endif
7522c37a3166S[email protected] #endif
7523dbe1a790S[email protected]     }
7524f30077b7SMatthias Ringwald     return false;
7525f30077b7SMatthias Ringwald }
7526c7e0c5f6Smatthias.ringwald 
7527f30077b7SMatthias Ringwald static void hci_run(void){
7528f30077b7SMatthias Ringwald 
7529df9e2780SMatthias Ringwald     // stack state sub statemachines
7530df9e2780SMatthias Ringwald     switch (hci_stack->state) {
7531df9e2780SMatthias Ringwald         case HCI_STATE_INITIALIZING:
7532df9e2780SMatthias Ringwald             hci_initializing_run();
7533d0dea5fbSMatthias Ringwald             break;
7534df9e2780SMatthias Ringwald         case HCI_STATE_HALTING:
7535df9e2780SMatthias Ringwald             hci_halting_run();
7536d0dea5fbSMatthias Ringwald             break;
7537df9e2780SMatthias Ringwald         case HCI_STATE_FALLING_ASLEEP:
7538df9e2780SMatthias Ringwald             hci_falling_asleep_run();
7539d0dea5fbSMatthias Ringwald             break;
7540df9e2780SMatthias Ringwald         default:
7541df9e2780SMatthias Ringwald             break;
7542df9e2780SMatthias Ringwald     }
7543df9e2780SMatthias Ringwald 
7544d0dea5fbSMatthias Ringwald     // allow to run after initialization to working transition
7545d0dea5fbSMatthias Ringwald     if (hci_stack->state != HCI_STATE_WORKING){
7546d0dea5fbSMatthias Ringwald         return;
7547d0dea5fbSMatthias Ringwald     }
7548d0dea5fbSMatthias Ringwald 
7549f30077b7SMatthias Ringwald     bool done;
7550f30077b7SMatthias Ringwald 
7551f30077b7SMatthias Ringwald     // send continuation fragments first, as they block the prepared packet buffer
7552f30077b7SMatthias Ringwald     done = hci_run_acl_fragments();
7553f30077b7SMatthias Ringwald     if (done) return;
7554f30077b7SMatthias Ringwald 
755568ab6207SMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
755668ab6207SMatthias Ringwald     done = hci_run_iso_fragments();
755768ab6207SMatthias Ringwald     if (done) return;
755868ab6207SMatthias Ringwald #endif
755968ab6207SMatthias Ringwald 
7560f30077b7SMatthias Ringwald #ifdef ENABLE_HCI_CONTROLLER_TO_HOST_FLOW_CONTROL
7561f30077b7SMatthias Ringwald     // send host num completed packets next as they don't require num_cmd_packets > 0
7562f30077b7SMatthias Ringwald     if (!hci_can_send_comand_packet_transport()) return;
7563f30077b7SMatthias Ringwald     if (hci_stack->host_completed_packets){
7564f30077b7SMatthias Ringwald         hci_host_num_completed_packets();
7565f30077b7SMatthias Ringwald         return;
7566f30077b7SMatthias Ringwald     }
7567f30077b7SMatthias Ringwald #endif
7568f30077b7SMatthias Ringwald 
7569f30077b7SMatthias Ringwald     if (!hci_can_send_command_packet_now()) return;
7570f30077b7SMatthias Ringwald 
7571f30077b7SMatthias Ringwald     // global/non-connection oriented commands
7572f30077b7SMatthias Ringwald 
7573f30077b7SMatthias Ringwald 
7574f30077b7SMatthias Ringwald #ifdef ENABLE_CLASSIC
7575f30077b7SMatthias Ringwald     // general gap classic
7576f30077b7SMatthias Ringwald     done = hci_run_general_gap_classic();
7577f30077b7SMatthias Ringwald     if (done) return;
7578f30077b7SMatthias Ringwald #endif
7579f30077b7SMatthias Ringwald 
7580f30077b7SMatthias Ringwald #ifdef ENABLE_BLE
7581f30077b7SMatthias Ringwald     // general gap le
7582f30077b7SMatthias Ringwald     done = hci_run_general_gap_le();
7583f30077b7SMatthias Ringwald     if (done) return;
75847aa35f6aSMatthias Ringwald 
75857aa35f6aSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
75867aa35f6aSMatthias Ringwald     // ISO related tasks, e.g. BIG create/terminate/sync
75877aa35f6aSMatthias Ringwald     done = hci_run_iso_tasks();
75887aa35f6aSMatthias Ringwald     if (done) return;
75897aa35f6aSMatthias Ringwald #endif
7590f30077b7SMatthias Ringwald #endif
7591f30077b7SMatthias Ringwald 
7592f30077b7SMatthias Ringwald     // send pending HCI commands
7593df9e2780SMatthias Ringwald     hci_run_general_pending_commands();
75943429f56bSmatthias.ringwald }
759516833f0aSmatthias.ringwald 
75960f076adeSMatthias Ringwald #ifdef ENABLE_CLASSIC
7597d7891039SMatthias Ringwald static void hci_set_sco_payload_length_for_flipped_packet_types(hci_connection_t * hci_connection, uint16_t flipped_packet_types){
7598d7891039SMatthias Ringwald     // bits 6-9 are 'don't use'
7599d7891039SMatthias Ringwald     uint16_t packet_types = flipped_packet_types ^ 0x03c0;
7600d7891039SMatthias Ringwald 
7601d7891039SMatthias Ringwald     // restrict packet types to local and remote supported
7602d7891039SMatthias Ringwald     packet_types &= hci_connection->remote_supported_sco_packets & hci_stack->usable_packet_types_sco;
7603d7891039SMatthias Ringwald     hci_connection->sco_payload_length = hci_sco_payload_length_for_packet_types(packet_types);
7604d7891039SMatthias Ringwald     log_info("Possible SCO packet types 0x%04x => payload length %u", packet_types, hci_connection->sco_payload_length);
7605d7891039SMatthias Ringwald }
76060f076adeSMatthias Ringwald #endif
7607d7891039SMatthias Ringwald 
7608ca6804fdSMatthias Ringwald // funnel for sending cmd packet using single outgoing buffer
7609ed208344SMatthias Ringwald static uint8_t hci_send_prepared_cmd_packet(void) {
7610ca6804fdSMatthias Ringwald     btstack_assert(hci_stack->hci_packet_buffer_reserved);
7611f91accd3SMatthias Ringwald     // cache opcode
7612f91accd3SMatthias Ringwald     hci_stack->last_cmd_opcode = little_endian_read_16(hci_stack->hci_packet_buffer, 0);
7613f91accd3SMatthias Ringwald     // get size
7614ca6804fdSMatthias Ringwald     uint16_t size = 3u + hci_stack->hci_packet_buffer[2u];
7615f91accd3SMatthias Ringwald     // send packet
7616ca6804fdSMatthias Ringwald     uint8_t status = hci_send_cmd_packet(hci_stack->hci_packet_buffer, size);
7617ca6804fdSMatthias Ringwald     // release packet buffer on error or for synchronous transport implementations
7618ca6804fdSMatthias Ringwald     if ((status != ERROR_CODE_SUCCESS) || hci_transport_synchronous()){
7619ca6804fdSMatthias Ringwald         hci_release_packet_buffer();
7620ca6804fdSMatthias Ringwald     }
7621ca6804fdSMatthias Ringwald     return status;
7622ca6804fdSMatthias Ringwald }
7623ca6804fdSMatthias Ringwald 
76243e2050f7SMatthias Ringwald uint8_t hci_send_cmd_packet(uint8_t *packet, int size){
762535454696SMatthias Ringwald     // house-keeping
762635454696SMatthias Ringwald 
762735454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
7628c8e4258aSmatthias.ringwald     bd_addr_t addr;
7629c8e4258aSmatthias.ringwald     hci_connection_t * conn;
7630c123d999SMatthias Ringwald #endif
7631c123d999SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
76326f35bb46SMatthias Ringwald     uint8_t initiator_filter_policy;
76339cbd2215SMatthias Ringwald #endif
7634c8e4258aSmatthias.ringwald 
76356f35bb46SMatthias Ringwald     uint16_t opcode = little_endian_read_16(packet, 0);
76366f35bb46SMatthias Ringwald     switch (opcode) {
76379cbd2215SMatthias Ringwald         case HCI_OPCODE_HCI_WRITE_LOOPBACK_MODE:
76389cbd2215SMatthias Ringwald             hci_stack->loopback_mode = packet[3];
76399cbd2215SMatthias Ringwald             break;
76409cbd2215SMatthias Ringwald 
76419cbd2215SMatthias Ringwald #ifdef ENABLE_CLASSIC
76426f35bb46SMatthias Ringwald         case HCI_OPCODE_HCI_CREATE_CONNECTION:
7643724d70a2SMatthias Ringwald             reverse_bd_addr(&packet[3], addr);
76449da54300S[email protected]             log_info("Create_connection to %s", bd_addr_to_str(addr));
7645c8e4258aSmatthias.ringwald 
764672cf8859SMatthias Ringwald             // CVE-2020-26555: reject outgoing connection to device with same BD ADDR
764772cf8859SMatthias Ringwald             if (memcmp(hci_stack->local_bd_addr, addr, 6) == 0) {
764879e0fa07SMatthias Ringwald                 hci_emit_connection_complete(addr, 0, ERROR_CODE_CONNECTION_REJECTED_DUE_TO_UNACCEPTABLE_BD_ADDR);
76493e2050f7SMatthias Ringwald                 return ERROR_CODE_CONNECTION_REJECTED_DUE_TO_UNACCEPTABLE_BD_ADDR;
765072cf8859SMatthias Ringwald             }
765172cf8859SMatthias Ringwald 
7652f16129ceSMatthias Ringwald             conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL);
7653ad83dc6aS[email protected]             if (!conn) {
765488f925b1SMatthias Ringwald                 conn = create_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL, HCI_ROLE_MASTER);
765517f1ba2aSmatthias.ringwald                 if (!conn) {
765617f1ba2aSmatthias.ringwald                     // notify client that alloc failed
76572deddeceSMatthias Ringwald                     hci_emit_connection_complete(addr, 0, BTSTACK_MEMORY_ALLOC_FAILED);
76583e2050f7SMatthias Ringwald                     return BTSTACK_MEMORY_ALLOC_FAILED; // packet not sent to controller
765917f1ba2aSmatthias.ringwald                 }
7660ad83dc6aS[email protected]                 conn->state = SEND_CREATE_CONNECTION;
7661ad83dc6aS[email protected]             }
7662aee5d5c1SMatthias Ringwald 
7663ad83dc6aS[email protected]             log_info("conn state %u", conn->state);
76643e2050f7SMatthias Ringwald             // TODO: L2CAP should not send create connection command, instead a (new) gap function should be used
7665ad83dc6aS[email protected]             switch (conn->state) {
7666ad83dc6aS[email protected]                 // if connection active exists
7667ad83dc6aS[email protected]                 case OPEN:
7668f5e5741dSMatthias Ringwald                     // and OPEN, emit connection complete command
766972cf8859SMatthias Ringwald                     hci_emit_connection_complete(addr, conn->con_handle, ERROR_CODE_SUCCESS);
76703e2050f7SMatthias Ringwald                     // packet not sent to controller
76713e2050f7SMatthias Ringwald                     return ERROR_CODE_ACL_CONNECTION_ALREADY_EXISTS;
7672672e36abSMatthias Ringwald                 case RECEIVED_DISCONNECTION_COMPLETE:
7673672e36abSMatthias Ringwald                     // create connection triggered in disconnect complete event, let's do it now
7674672e36abSMatthias Ringwald                     break;
7675ad83dc6aS[email protected]                 case SEND_CREATE_CONNECTION:
76766c0d5426SMatthias Ringwald #ifdef ENABLE_HCI_SERIALIZED_CONTROLLER_OPERATIONS
76776c0d5426SMatthias Ringwald                     if (hci_classic_operation_active()){
76786c0d5426SMatthias Ringwald                         return ERROR_CODE_SUCCESS;
76796c0d5426SMatthias Ringwald                     }
76806c0d5426SMatthias Ringwald #endif
7681532f91a5SMatthias Ringwald                     // connection created by hci, e.g. dedicated bonding, but not executed yet, let's do it now
7682532f91a5SMatthias Ringwald                     break;
7683ad83dc6aS[email protected]                 default:
7684ad83dc6aS[email protected]                     // otherwise, just ignore as it is already in the open process
76853e2050f7SMatthias Ringwald                     // packet not sent to controller
76863e2050f7SMatthias Ringwald                     return ERROR_CODE_ACL_CONNECTION_ALREADY_EXISTS;
7687ad83dc6aS[email protected]             }
7688c8e4258aSmatthias.ringwald             conn->state = SENT_CREATE_CONNECTION;
7689229331c6SMatthias Ringwald 
7690229331c6SMatthias Ringwald             // track outgoing connection
7691f16129ceSMatthias Ringwald             hci_stack->outgoing_addr_type = BD_ADDR_TYPE_ACL;
76926535961aSMatthias Ringwald             (void) memcpy(hci_stack->outgoing_addr, addr, 6);
76936f35bb46SMatthias Ringwald             break;
7694ee752bb8SMatthias Ringwald 
76956f35bb46SMatthias Ringwald         case HCI_OPCODE_HCI_SETUP_SYNCHRONOUS_CONNECTION:
76969071873aSMatthias Ringwald             conn = hci_connection_for_handle(little_endian_read_16(packet, 3));
76979071873aSMatthias Ringwald             if (conn == NULL) {
76989071873aSMatthias Ringwald                 // neither SCO nor ACL connection for con handle
76999071873aSMatthias Ringwald                 return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
77009071873aSMatthias Ringwald             } else {
7701d7891039SMatthias Ringwald                 uint16_t remote_supported_sco_packets;
77029071873aSMatthias Ringwald                 switch (conn->address_type){
77039071873aSMatthias Ringwald                     case BD_ADDR_TYPE_ACL:
77049071873aSMatthias Ringwald                         // assert SCO connection does not exit
7705d9290e95SMatthias Ringwald                         if (hci_connection_for_bd_addr_and_type(conn->address, BD_ADDR_TYPE_SCO) != NULL){
77069071873aSMatthias Ringwald                             return ERROR_CODE_COMMAND_DISALLOWED;
77079071873aSMatthias Ringwald                         }
7708d7891039SMatthias Ringwald                         // cache remote sco packet types
7709d7891039SMatthias Ringwald                         remote_supported_sco_packets = conn->remote_supported_sco_packets;
7710d7891039SMatthias Ringwald 
77119071873aSMatthias Ringwald                         // allocate connection struct
771288f925b1SMatthias Ringwald                         conn = create_connection_for_bd_addr_and_type(conn->address, BD_ADDR_TYPE_SCO,
771388f925b1SMatthias Ringwald                                                                       HCI_ROLE_MASTER);
77149071873aSMatthias Ringwald                         if (!conn) {
77159071873aSMatthias Ringwald                             return ERROR_CODE_MEMORY_CAPACITY_EXCEEDED;
77169071873aSMatthias Ringwald                         }
7717d7891039SMatthias Ringwald                         conn->remote_supported_sco_packets = remote_supported_sco_packets;
77189071873aSMatthias Ringwald                         break;
77199071873aSMatthias Ringwald                     case BD_ADDR_TYPE_SCO:
77209071873aSMatthias Ringwald                         // update of existing SCO connection
77219071873aSMatthias Ringwald                         break;
77229071873aSMatthias Ringwald                     default:
77239071873aSMatthias Ringwald                         return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS;
77249071873aSMatthias Ringwald                 }
77259071873aSMatthias Ringwald             }
7726d9290e95SMatthias Ringwald 
7727d9290e95SMatthias Ringwald             // conn refers to hci connection of type sco now
7728d9290e95SMatthias Ringwald 
77299071873aSMatthias Ringwald             conn->state = SENT_CREATE_CONNECTION;
77309071873aSMatthias Ringwald 
77319071873aSMatthias Ringwald             // track outgoing connection to handle command status with error
77329071873aSMatthias Ringwald             hci_stack->outgoing_addr_type = BD_ADDR_TYPE_SCO;
7733f728a932SMatthias Ringwald             (void) memcpy(hci_stack->outgoing_addr, conn->address, 6);
77349071873aSMatthias Ringwald 
7735ee752bb8SMatthias Ringwald             // setup_synchronous_connection? Voice setting at offset 22
7736ee752bb8SMatthias Ringwald             // TODO: compare to current setting if sco connection already active
7737ee752bb8SMatthias Ringwald             hci_stack->sco_voice_setting_active = little_endian_read_16(packet, 15);
7738d7891039SMatthias Ringwald 
7739d7891039SMatthias Ringwald             // derive sco payload length from packet types
7740d7891039SMatthias Ringwald             hci_set_sco_payload_length_for_flipped_packet_types(conn, little_endian_read_16(packet, 18));
77416f35bb46SMatthias Ringwald             break;
77429071873aSMatthias Ringwald 
77436f35bb46SMatthias Ringwald         case HCI_OPCODE_HCI_ACCEPT_SYNCHRONOUS_CONNECTION:
77449071873aSMatthias Ringwald             // get SCO connection
77459071873aSMatthias Ringwald             reverse_bd_addr(&packet[3], addr);
77469071873aSMatthias Ringwald             conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_SCO);
77479071873aSMatthias Ringwald             if (conn == NULL){
77489071873aSMatthias Ringwald                 return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
77499071873aSMatthias Ringwald             }
77509071873aSMatthias Ringwald 
77519071873aSMatthias Ringwald             conn->state = ACCEPTED_CONNECTION_REQUEST;
77529071873aSMatthias Ringwald 
77539071873aSMatthias Ringwald             // track outgoing connection to handle command status with error
77549071873aSMatthias Ringwald             hci_stack->outgoing_addr_type = BD_ADDR_TYPE_SCO;
77559071873aSMatthias Ringwald             (void) memcpy(hci_stack->outgoing_addr, addr, 6);
77569071873aSMatthias Ringwald 
7757c91e6e4fSMatthias Ringwald             // accept_synchronous_connection? Voice setting at offset 18
7758ee752bb8SMatthias Ringwald             // TODO: compare to current setting if sco connection already active
7759ee752bb8SMatthias Ringwald             hci_stack->sco_voice_setting_active = little_endian_read_16(packet, 19);
7760d7891039SMatthias Ringwald 
7761d7891039SMatthias Ringwald             // derive sco payload length from packet types
7762d7891039SMatthias Ringwald             hci_set_sco_payload_length_for_flipped_packet_types(conn, little_endian_read_16(packet, 22));
77636f35bb46SMatthias Ringwald             break;
7764ee752bb8SMatthias Ringwald #endif
77654b3e1e19SMatthias Ringwald 
7766a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE
7767d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
77686f35bb46SMatthias Ringwald         case HCI_OPCODE_HCI_LE_CREATE_CONNECTION:
7769b04dfa37SMatthias Ringwald             // white list used?
77706f35bb46SMatthias Ringwald             initiator_filter_policy = packet[7];
7771b04dfa37SMatthias Ringwald             switch (initiator_filter_policy) {
7772b04dfa37SMatthias Ringwald                 case 0:
7773b04dfa37SMatthias Ringwald                     // whitelist not used
7774b04dfa37SMatthias Ringwald                     hci_stack->le_connecting_state = LE_CONNECTING_DIRECT;
7775b04dfa37SMatthias Ringwald                     break;
7776b04dfa37SMatthias Ringwald                 case 1:
7777b04dfa37SMatthias Ringwald                     hci_stack->le_connecting_state = LE_CONNECTING_WHITELIST;
7778b04dfa37SMatthias Ringwald                     break;
7779b04dfa37SMatthias Ringwald                 default:
7780b04dfa37SMatthias Ringwald                     log_error("Invalid initiator_filter_policy in LE Create Connection %u", initiator_filter_policy);
7781b04dfa37SMatthias Ringwald                     break;
7782b04dfa37SMatthias Ringwald             }
7783c163146eSMatthias Ringwald             // track outgoing connection
77848f7da641SMatthias Ringwald             hci_stack->outgoing_addr_type = (bd_addr_type_t) packet[8]; // peer address type
7785c163146eSMatthias Ringwald             reverse_bd_addr( &packet[9], hci_stack->outgoing_addr); // peer address
77866f35bb46SMatthias Ringwald             break;
77878f7da641SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
77888f7da641SMatthias Ringwald         case HCI_OPCODE_HCI_LE_EXTENDED_CREATE_CONNECTION:
77898f7da641SMatthias Ringwald             // white list used?
77908f7da641SMatthias Ringwald             initiator_filter_policy = packet[3];
77918f7da641SMatthias Ringwald             switch (initiator_filter_policy) {
77928f7da641SMatthias Ringwald                 case 0:
77938f7da641SMatthias Ringwald                     // whitelist not used
77948f7da641SMatthias Ringwald                     hci_stack->le_connecting_state = LE_CONNECTING_DIRECT;
77958f7da641SMatthias Ringwald                     break;
77968f7da641SMatthias Ringwald                 case 1:
77978f7da641SMatthias Ringwald                     hci_stack->le_connecting_state = LE_CONNECTING_WHITELIST;
77988f7da641SMatthias Ringwald                     break;
77998f7da641SMatthias Ringwald                 default:
78008f7da641SMatthias Ringwald                     log_error("Invalid initiator_filter_policy in LE Create Connection %u", initiator_filter_policy);
78018f7da641SMatthias Ringwald                     break;
78028f7da641SMatthias Ringwald             }
78038f7da641SMatthias Ringwald             // track outgoing connection
78048f7da641SMatthias Ringwald             hci_stack->outgoing_addr_type = (bd_addr_type_t) packet[5]; // peer address type
78058f7da641SMatthias Ringwald             reverse_bd_addr( &packet[6], hci_stack->outgoing_addr); // peer address
78068f7da641SMatthias Ringwald             break;
78078f7da641SMatthias Ringwald #endif
78086f35bb46SMatthias Ringwald         case HCI_OPCODE_HCI_LE_CREATE_CONNECTION_CANCEL:
78096ea9315cSMatthias Ringwald             hci_stack->le_connecting_state = LE_CONNECTING_CANCEL;
78106f35bb46SMatthias Ringwald             break;
78119cbd2215SMatthias Ringwald #endif
781291036612SMatthias Ringwald #ifdef ENABLE_HCI_COMMAND_STATUS_DISCARDED_FOR_FAILED_CONNECTIONS_WORKAROUND
7813f48a5586SMatthias Ringwald         case HCI_OPCODE_HCI_LE_CONNECTION_UPDATE:
7814f48a5586SMatthias Ringwald         case HCI_OPCODE_HCI_LE_READ_REMOTE_USED_FEATURES:
7815f48a5586SMatthias Ringwald         case HCI_OPCODE_HCI_LE_START_ENCRYPTION:
7816f48a5586SMatthias Ringwald         case HCI_OPCODE_HCI_LE_LONG_TERM_KEY_REQUEST_REPLY:
7817f48a5586SMatthias Ringwald         case HCI_OPCODE_HCI_LE_LONG_TERM_KEY_NEGATIVE_REPLY:
7818f48a5586SMatthias Ringwald         case HCI_OPCODE_HCI_LE_REMOTE_CONNECTION_PARAMETER_REQUEST_REPLY:
7819f48a5586SMatthias Ringwald         case HCI_OPCODE_HCI_LE_REMOTE_CONNECTION_PARAMETER_REQUEST_NEGATIVE_REPLY:
7820f48a5586SMatthias Ringwald         case HCI_OPCODE_HCI_LE_SET_DATA_LENGTH:
7821f48a5586SMatthias Ringwald         case HCI_OPCODE_HCI_LE_READ_PHY:
7822f48a5586SMatthias Ringwald         case HCI_OPCODE_HCI_LE_SET_PHY:
7823f48a5586SMatthias Ringwald             // conection handle is first command parameter
7824f48a5586SMatthias Ringwald             hci_stack->hci_command_con_handle = little_endian_read_16(packet, 3);
7825f48a5586SMatthias Ringwald             break;
7826f48a5586SMatthias Ringwald #endif
78274ae8623eSMatthias Ringwald #endif /* ENABLE_BLE */
78286f35bb46SMatthias Ringwald         default:
78296f35bb46SMatthias Ringwald             break;
7830b04dfa37SMatthias Ringwald     }
783169a97523S[email protected] 
78323a9fb326S[email protected]     hci_stack->num_cmd_packets--;
78335bb5bc3eS[email protected] 
78345bb5bc3eS[email protected]     hci_dump_packet(HCI_COMMAND_DATA_PACKET, 0, packet, size);
78353e2050f7SMatthias Ringwald     int err = hci_stack->hci_transport->send_packet(HCI_COMMAND_DATA_PACKET, packet, size);
7836a84946b2SMatthias Ringwald     uint8_t status;
7837a84946b2SMatthias Ringwald     if (err == 0){
7838a84946b2SMatthias Ringwald         status = ERROR_CODE_SUCCESS;
7839a84946b2SMatthias Ringwald     } else {
7840a84946b2SMatthias Ringwald         status = ERROR_CODE_HARDWARE_FAILURE;
78413e2050f7SMatthias Ringwald     }
7842a84946b2SMatthias Ringwald     return status;
784331452debSmatthias.ringwald }
78448adf0ddaSmatthias.ringwald 
78452bd8b7e7S[email protected] // disconnect because of security block
78462bd8b7e7S[email protected] void hci_disconnect_security_block(hci_con_handle_t con_handle){
78472bd8b7e7S[email protected]     hci_connection_t * connection = hci_connection_for_handle(con_handle);
78482bd8b7e7S[email protected]     if (!connection) return;
78492bd8b7e7S[email protected]     connection->bonding_flags |= BONDING_DISCONNECT_SECURITY_BLOCK;
78502bd8b7e7S[email protected] }
78512bd8b7e7S[email protected] 
78522bd8b7e7S[email protected] 
7853dbe1a790S[email protected] // Configure Secure Simple Pairing
7854dbe1a790S[email protected] 
785535454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
785635454696SMatthias Ringwald 
7857dbe1a790S[email protected] // enable will enable SSP during init
785815a95bd5SMatthias Ringwald void gap_ssp_set_enable(int enable){
78593a9fb326S[email protected]     hci_stack->ssp_enable = enable;
7860dbe1a790S[email protected] }
7861dbe1a790S[email protected] 
786295d71764SMatthias Ringwald static int hci_local_ssp_activated(void){
786315a95bd5SMatthias Ringwald     return gap_ssp_supported() && hci_stack->ssp_enable;
78642bd8b7e7S[email protected] }
78652bd8b7e7S[email protected] 
7866dbe1a790S[email protected] // if set, BTstack will respond to io capability request using authentication requirement
786715a95bd5SMatthias Ringwald void gap_ssp_set_io_capability(int io_capability){
78683a9fb326S[email protected]     hci_stack->ssp_io_capability = io_capability;
7869dbe1a790S[email protected] }
787015a95bd5SMatthias Ringwald void gap_ssp_set_authentication_requirement(int authentication_requirement){
78713a9fb326S[email protected]     hci_stack->ssp_authentication_requirement = authentication_requirement;
7872dbe1a790S[email protected] }
7873dbe1a790S[email protected] 
7874dbe1a790S[email protected] // if set, BTstack will confirm a numberic comparion and enter '000000' if requested
787515a95bd5SMatthias Ringwald void gap_ssp_set_auto_accept(int auto_accept){
78763a9fb326S[email protected]     hci_stack->ssp_auto_accept = auto_accept;
7877dbe1a790S[email protected] }
78785d23aae8SMatthias Ringwald 
78795d23aae8SMatthias Ringwald void gap_secure_connections_enable(bool enable){
78805d23aae8SMatthias Ringwald     hci_stack->secure_connections_enable = enable;
78815d23aae8SMatthias Ringwald }
788222d445d8SMatthias Ringwald bool gap_secure_connections_active(void){
7883eaf85bc8SMatthias Ringwald     return hci_stack->secure_connections_active;
788422d445d8SMatthias Ringwald }
78855d23aae8SMatthias Ringwald 
788635454696SMatthias Ringwald #endif
7887dbe1a790S[email protected] 
788894be1a66SMatthias Ringwald // va_list part of hci_send_cmd
78893e2050f7SMatthias Ringwald uint8_t hci_send_cmd_va_arg(const hci_cmd_t * cmd, va_list argptr){
7890d94d3cafS[email protected]     if (!hci_can_send_command_packet_now()){
78919d14b626S[email protected]         log_error("hci_send_cmd called but cannot send packet now");
78923e2050f7SMatthias Ringwald         return ERROR_CODE_COMMAND_DISALLOWED;
78939d14b626S[email protected]     }
78949d14b626S[email protected] 
78959d14b626S[email protected]     hci_reserve_packet_buffer();
7896f91accd3SMatthias Ringwald     hci_cmd_create_from_template(hci_stack->hci_packet_buffer, cmd, argptr);
7897ca6804fdSMatthias Ringwald     return hci_send_prepared_cmd_packet();
789894be1a66SMatthias Ringwald }
78999d14b626S[email protected] 
790094be1a66SMatthias Ringwald /**
790194be1a66SMatthias Ringwald  * pre: numcmds >= 0 - it's allowed to send a command to the controller
790294be1a66SMatthias Ringwald  */
79033e2050f7SMatthias Ringwald uint8_t hci_send_cmd(const hci_cmd_t * cmd, ...){
79041cd208adSmatthias.ringwald     va_list argptr;
79051cd208adSmatthias.ringwald     va_start(argptr, cmd);
79063e2050f7SMatthias Ringwald     uint8_t status = hci_send_cmd_va_arg(cmd, argptr);
79071cd208adSmatthias.ringwald     va_end(argptr);
79083e2050f7SMatthias Ringwald     return status;
790993b8dc03Smatthias.ringwald }
7910c8e4258aSmatthias.ringwald 
7911ee091cf1Smatthias.ringwald // Create various non-HCI events.
7912ee091cf1Smatthias.ringwald // TODO: generalize, use table similar to hci_create_command
7913ee091cf1Smatthias.ringwald 
7914d6b06661SMatthias Ringwald static void hci_emit_event(uint8_t * event, uint16_t size, int dump){
7915fb37a842SMatthias Ringwald     // dump packet
7916d6b06661SMatthias Ringwald     if (dump) {
791792da54c4SMatthias Ringwald         hci_dump_packet( HCI_EVENT_PACKET, 1, event, size);
7918d6b06661SMatthias Ringwald     }
79191ef6bb52SMatthias Ringwald 
7920fb37a842SMatthias Ringwald     // dispatch to all event handlers
79211ef6bb52SMatthias Ringwald     btstack_linked_list_iterator_t it;
79221ef6bb52SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->event_handlers);
79231ef6bb52SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
79241ef6bb52SMatthias Ringwald         btstack_packet_callback_registration_t * entry = (btstack_packet_callback_registration_t*) btstack_linked_list_iterator_next(&it);
7925d9a7306aSMatthias Ringwald         entry->callback(HCI_EVENT_PACKET, 0, event, size);
79261ef6bb52SMatthias Ringwald     }
7927d6b06661SMatthias Ringwald }
7928d6b06661SMatthias Ringwald 
7929d6b06661SMatthias Ringwald static void hci_emit_acl_packet(uint8_t * packet, uint16_t size){
7930fb37a842SMatthias Ringwald     if (!hci_stack->acl_packet_handler) return;
79313d50b4baSMatthias Ringwald     hci_stack->acl_packet_handler(HCI_ACL_DATA_PACKET, 0, packet, size);
7932d6b06661SMatthias Ringwald }
7933d6b06661SMatthias Ringwald 
793435454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
7935701e3307SMatthias Ringwald static void hci_notify_if_sco_can_send_now(void){
79363bc639ceSMatthias Ringwald     // notify SCO sender if waiting
7937701e3307SMatthias Ringwald     if (!hci_stack->sco_waiting_for_can_send_now) return;
7938701e3307SMatthias Ringwald     if (hci_can_send_sco_packet_now()){
79393bc639ceSMatthias Ringwald         hci_stack->sco_waiting_for_can_send_now = 0;
7940701e3307SMatthias Ringwald         uint8_t event[2] = { HCI_EVENT_SCO_CAN_SEND_NOW, 0 };
7941701e3307SMatthias Ringwald         hci_dump_packet(HCI_EVENT_PACKET, 1, event, sizeof(event));
79423d50b4baSMatthias Ringwald         hci_stack->sco_packet_handler(HCI_EVENT_PACKET, 0, event, sizeof(event));
79433bc639ceSMatthias Ringwald     }
79443bc639ceSMatthias Ringwald }
79451cfb383eSMatthias Ringwald 
79461cfb383eSMatthias Ringwald // parsing end emitting has been merged to reduce code size
79479784dac1SMatthias Ringwald static void gap_inquiry_explode(uint8_t *packet, uint16_t size) {
7948ac9136ccSMatthias Ringwald     uint8_t event[28+GAP_INQUIRY_MAX_NAME_LEN];
79491cfb383eSMatthias Ringwald 
79501cfb383eSMatthias Ringwald     uint8_t * eir_data;
79511cfb383eSMatthias Ringwald     ad_context_t context;
79521cfb383eSMatthias Ringwald     const uint8_t * name;
79531cfb383eSMatthias Ringwald     uint8_t         name_len;
79541cfb383eSMatthias Ringwald 
79559784dac1SMatthias Ringwald     if (size < 3) return;
79569784dac1SMatthias Ringwald 
79571cfb383eSMatthias Ringwald     int event_type = hci_event_packet_get_type(packet);
7958a1df452eSMatthias Ringwald     int num_reserved_fields = (event_type == HCI_EVENT_INQUIRY_RESULT) ? 2 : 1;    // 2 for old event, 1 otherwise
79591cfb383eSMatthias Ringwald     int num_responses       = hci_event_inquiry_result_get_num_responses(packet);
79601cfb383eSMatthias Ringwald 
79619784dac1SMatthias Ringwald     switch (event_type){
79629784dac1SMatthias Ringwald         case HCI_EVENT_INQUIRY_RESULT:
79639784dac1SMatthias Ringwald         case HCI_EVENT_INQUIRY_RESULT_WITH_RSSI:
79649784dac1SMatthias Ringwald             if (size != (3 + (num_responses * 14))) return;
79659784dac1SMatthias Ringwald             break;
79669784dac1SMatthias Ringwald         case HCI_EVENT_EXTENDED_INQUIRY_RESPONSE:
79679784dac1SMatthias Ringwald             if (size != 257) return;
79689784dac1SMatthias Ringwald             if (num_responses != 1) return;
79699784dac1SMatthias Ringwald             break;
79709784dac1SMatthias Ringwald         default:
79719784dac1SMatthias Ringwald             return;
79729784dac1SMatthias Ringwald     }
79739784dac1SMatthias Ringwald 
79741cfb383eSMatthias Ringwald     // event[1] is set at the end
79751cfb383eSMatthias Ringwald     int i;
79761cfb383eSMatthias Ringwald     for (i=0; i<num_responses;i++){
79771cfb383eSMatthias Ringwald         memset(event, 0, sizeof(event));
79781cfb383eSMatthias Ringwald         event[0] = GAP_EVENT_INQUIRY_RESULT;
7979ac973fd6SMatthias Ringwald         uint8_t event_size = 27;    // if name is not set by EIR
79801cfb383eSMatthias Ringwald 
79816535961aSMatthias Ringwald         (void)memcpy(&event[2], &packet[3 + (i * 6)], 6); // bd_addr
79820e588213SMatthias Ringwald         event[8] =          packet[3 + (num_responses*(6))                         + (i*1)];     // page_scan_repetition_mode
79836535961aSMatthias Ringwald         (void)memcpy(&event[9],
79846535961aSMatthias Ringwald                      &packet[3 + (num_responses * (6 + 1 + num_reserved_fields)) + (i * 3)],
79856535961aSMatthias Ringwald                      3); // class of device
79866535961aSMatthias Ringwald         (void)memcpy(&event[12],
79876535961aSMatthias Ringwald                      &packet[3 + (num_responses * (6 + 1 + num_reserved_fields + 3)) + (i * 2)],
79886535961aSMatthias Ringwald                      2); // clock offset
79891cfb383eSMatthias Ringwald 
79901cfb383eSMatthias Ringwald         switch (event_type){
79911cfb383eSMatthias Ringwald             case HCI_EVENT_INQUIRY_RESULT:
79921cfb383eSMatthias Ringwald                 // 14,15,16,17 = 0, size 18
79931cfb383eSMatthias Ringwald                 break;
79941cfb383eSMatthias Ringwald             case HCI_EVENT_INQUIRY_RESULT_WITH_RSSI:
79951cfb383eSMatthias Ringwald                 event[14] = 1;
7996a1df452eSMatthias Ringwald                 event[15] = packet [3 + (num_responses*(6+1+num_reserved_fields+3+2)) + (i*1)]; // rssi
79971cfb383eSMatthias Ringwald                 // 16,17 = 0, size 18
79981cfb383eSMatthias Ringwald                 break;
79991cfb383eSMatthias Ringwald             case HCI_EVENT_EXTENDED_INQUIRY_RESPONSE:
80001cfb383eSMatthias Ringwald                 event[14] = 1;
8001a1df452eSMatthias Ringwald                 event[15] = packet [3 + (num_responses*(6+1+num_reserved_fields+3+2)) + (i*1)]; // rssi
800279186815SMatthias Ringwald                 // EIR packets only contain a single inquiry response
80031cfb383eSMatthias Ringwald                 eir_data = &packet[3 + (6+1+num_reserved_fields+3+2+1)];
80041cfb383eSMatthias Ringwald                 name = NULL;
8005a8c4e5adSMatthias Ringwald                 // Iterate over EIR data
8006a8c4e5adSMatthias Ringwald                 for (ad_iterator_init(&context, EXTENDED_INQUIRY_RESPONSE_DATA_LEN, eir_data) ; ad_iterator_has_more(&context) ; ad_iterator_next(&context)){
80071cfb383eSMatthias Ringwald                     uint8_t data_type    = ad_iterator_get_data_type(&context);
80081cfb383eSMatthias Ringwald                     uint8_t data_size    = ad_iterator_get_data_len(&context);
80091cfb383eSMatthias Ringwald                     const uint8_t * data = ad_iterator_get_data(&context);
8010ac9136ccSMatthias Ringwald                     // Prefer Complete Local Name over Shortened Local Name
80111cfb383eSMatthias Ringwald                     switch (data_type){
80121cfb383eSMatthias Ringwald                         case BLUETOOTH_DATA_TYPE_SHORTENED_LOCAL_NAME:
80131cfb383eSMatthias Ringwald                             if (name) continue;
8014cf373d3aSMatthias Ringwald                             /* fall through */
80151cfb383eSMatthias Ringwald                         case BLUETOOTH_DATA_TYPE_COMPLETE_LOCAL_NAME:
80161cfb383eSMatthias Ringwald                             name = data;
80171cfb383eSMatthias Ringwald                             name_len = data_size;
80181cfb383eSMatthias Ringwald                             break;
8019ac9136ccSMatthias Ringwald                         case BLUETOOTH_DATA_TYPE_DEVICE_ID:
8020ac9136ccSMatthias Ringwald                             if (data_size != 8) break;
8021ac9136ccSMatthias Ringwald                             event[16] = 1;
80223c0c7fefSMatthias Ringwald                             memcpy(&event[17], data, 8);
8023ac9136ccSMatthias Ringwald                             break;
80241cfb383eSMatthias Ringwald                         default:
80251cfb383eSMatthias Ringwald                             break;
80261cfb383eSMatthias Ringwald                     }
80271cfb383eSMatthias Ringwald                 }
80281cfb383eSMatthias Ringwald                 if (name){
8029ac9136ccSMatthias Ringwald                     event[25] = 1;
80301cfb383eSMatthias Ringwald                     // truncate name if needed
80311cfb383eSMatthias Ringwald                     int len = btstack_min(name_len, GAP_INQUIRY_MAX_NAME_LEN);
8032ac9136ccSMatthias Ringwald                     event[26] = len;
8033ac9136ccSMatthias Ringwald                     (void)memcpy(&event[27], name, len);
80341cfb383eSMatthias Ringwald                     event_size += len;
80351cfb383eSMatthias Ringwald                 }
80361cfb383eSMatthias Ringwald                 break;
80377bbeb3adSMilanka Ringwald             default:
80387bbeb3adSMilanka Ringwald                 return;
80391cfb383eSMatthias Ringwald         }
80401cfb383eSMatthias Ringwald         event[1] = event_size - 2;
80411cfb383eSMatthias Ringwald         hci_emit_event(event, event_size, 1);
80421cfb383eSMatthias Ringwald     }
80431cfb383eSMatthias Ringwald }
804435454696SMatthias Ringwald #endif
80453bc639ceSMatthias Ringwald 
804671de195eSMatthias Ringwald void hci_emit_state(void){
80473a9fb326S[email protected]     log_info("BTSTACK_EVENT_STATE %u", hci_stack->state);
8048425d1371Smatthias.ringwald     uint8_t event[3];
804980d52d6bSmatthias.ringwald     event[0] = BTSTACK_EVENT_STATE;
80504ea43905SMatthias Ringwald     event[1] = sizeof(event) - 2u;
80513a9fb326S[email protected]     event[2] = hci_stack->state;
8052d6b06661SMatthias Ringwald     hci_emit_event(event, sizeof(event), 1);
8053c8e4258aSmatthias.ringwald }
8054c8e4258aSmatthias.ringwald 
805535454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
80562deddeceSMatthias Ringwald static void hci_emit_connection_complete(bd_addr_t address, hci_con_handle_t con_handle, uint8_t status){
8057425d1371Smatthias.ringwald     uint8_t event[13];
8058c8e4258aSmatthias.ringwald     event[0] = HCI_EVENT_CONNECTION_COMPLETE;
8059425d1371Smatthias.ringwald     event[1] = sizeof(event) - 2;
806017f1ba2aSmatthias.ringwald     event[2] = status;
80612deddeceSMatthias Ringwald     little_endian_store_16(event, 3, con_handle);
80622deddeceSMatthias Ringwald     reverse_bd_addr(address, &event[5]);
8063c8e4258aSmatthias.ringwald     event[11] = 1; // ACL connection
8064c8e4258aSmatthias.ringwald     event[12] = 0; // encryption disabled
8065d6b06661SMatthias Ringwald     hci_emit_event(event, sizeof(event), 1);
8066c8e4258aSmatthias.ringwald }
806752db98b2SMatthias Ringwald static void hci_emit_l2cap_check_timeout(hci_connection_t *conn){
806852db98b2SMatthias Ringwald     if (disable_l2cap_timeouts) return;
806952db98b2SMatthias Ringwald     log_info("L2CAP_EVENT_TIMEOUT_CHECK");
807052db98b2SMatthias Ringwald     uint8_t event[4];
807152db98b2SMatthias Ringwald     event[0] = L2CAP_EVENT_TIMEOUT_CHECK;
807252db98b2SMatthias Ringwald     event[1] = sizeof(event) - 2;
807352db98b2SMatthias Ringwald     little_endian_store_16(event, 2, conn->con_handle);
807452db98b2SMatthias Ringwald     hci_emit_event(event, sizeof(event), 1);
807552db98b2SMatthias Ringwald }
807635454696SMatthias Ringwald #endif
8077c8e4258aSmatthias.ringwald 
807835454696SMatthias Ringwald #ifdef ENABLE_BLE
8079d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
8080667ba9d1SMatthias Ringwald static void hci_emit_le_connection_complete(uint8_t address_type, const bd_addr_t address, hci_con_handle_t con_handle, uint8_t status){
8081ebd1b979SMatthias Ringwald     uint8_t hci_event[21];
8082ebd1b979SMatthias Ringwald     hci_event[0] = HCI_EVENT_LE_META;
8083ebd1b979SMatthias Ringwald     hci_event[1] = sizeof(hci_event) - 2u;
8084ebd1b979SMatthias Ringwald     hci_event[2] = HCI_SUBEVENT_LE_CONNECTION_COMPLETE;
8085ebd1b979SMatthias Ringwald     hci_event[3] = status;
8086ebd1b979SMatthias Ringwald     little_endian_store_16(hci_event, 4, con_handle);
8087ebd1b979SMatthias Ringwald     hci_event[6] = 0; // TODO: role
8088ebd1b979SMatthias Ringwald     hci_event[7] = address_type;
8089ebd1b979SMatthias Ringwald     reverse_bd_addr(address, &hci_event[8]);
8090ebd1b979SMatthias Ringwald     little_endian_store_16(hci_event, 14, 0); // interval
8091ebd1b979SMatthias Ringwald     little_endian_store_16(hci_event, 16, 0); // latency
8092ebd1b979SMatthias Ringwald     little_endian_store_16(hci_event, 18, 0); // supervision timeout
8093ebd1b979SMatthias Ringwald     hci_event[20] = 0; // master clock accuracy
8094ebd1b979SMatthias Ringwald     hci_emit_event(hci_event, sizeof(hci_event), 1);
8095ebd1b979SMatthias Ringwald     // emit GAP event, too
8096ebd1b979SMatthias Ringwald     uint8_t gap_event[36];
8097ebd1b979SMatthias Ringwald     hci_create_gap_connection_complete_event(hci_event, gap_event);
8098ebd1b979SMatthias Ringwald     hci_emit_event(gap_event, sizeof(gap_event), 1);
80994f3229d8S[email protected] }
810035454696SMatthias Ringwald #endif
8101d70217a2SMatthias Ringwald #endif
81024f3229d8S[email protected] 
8103fd43c0e0SMatthias Ringwald static void hci_emit_transport_packet_sent(void){
8104fd43c0e0SMatthias Ringwald     // notify upper stack that it might be possible to send again
8105fd43c0e0SMatthias Ringwald     uint8_t event[] = { HCI_EVENT_TRANSPORT_PACKET_SENT, 0};
8106fd43c0e0SMatthias Ringwald     hci_emit_event(&event[0], sizeof(event), 0);  // don't dump
8107fd43c0e0SMatthias Ringwald }
8108fd43c0e0SMatthias Ringwald 
8109fc64f94aSMatthias Ringwald static void hci_emit_disconnection_complete(hci_con_handle_t con_handle, uint8_t reason){
8110425d1371Smatthias.ringwald     uint8_t event[6];
81113c4d4b90Smatthias.ringwald     event[0] = HCI_EVENT_DISCONNECTION_COMPLETE;
81124ea43905SMatthias Ringwald     event[1] = sizeof(event) - 2u;
81133c4d4b90Smatthias.ringwald     event[2] = 0; // status = OK
8114fc64f94aSMatthias Ringwald     little_endian_store_16(event, 3, con_handle);
81153c4d4b90Smatthias.ringwald     event[5] = reason;
8116d6b06661SMatthias Ringwald     hci_emit_event(event, sizeof(event), 1);
81173c4d4b90Smatthias.ringwald }
81183c4d4b90Smatthias.ringwald 
8119b83d5eabSMatthias Ringwald static void hci_emit_nr_connections_changed(void){
8120e0abb8e7S[email protected]     log_info("BTSTACK_EVENT_NR_CONNECTIONS_CHANGED %u", nr_hci_connections());
8121425d1371Smatthias.ringwald     uint8_t event[3];
812280d52d6bSmatthias.ringwald     event[0] = BTSTACK_EVENT_NR_CONNECTIONS_CHANGED;
81234ea43905SMatthias Ringwald     event[1] = sizeof(event) - 2u;
812443bfb1bdSmatthias.ringwald     event[2] = nr_hci_connections();
8125d6b06661SMatthias Ringwald     hci_emit_event(event, sizeof(event), 1);
812643bfb1bdSmatthias.ringwald }
8127038bc64cSmatthias.ringwald 
8128b83d5eabSMatthias Ringwald static void hci_emit_hci_open_failed(void){
8129e0abb8e7S[email protected]     log_info("BTSTACK_EVENT_POWERON_FAILED");
8130425d1371Smatthias.ringwald     uint8_t event[2];
813180d52d6bSmatthias.ringwald     event[0] = BTSTACK_EVENT_POWERON_FAILED;
81324ea43905SMatthias Ringwald     event[1] = sizeof(event) - 2u;
8133d6b06661SMatthias Ringwald     hci_emit_event(event, sizeof(event), 1);
8134038bc64cSmatthias.ringwald }
81351b0e3922Smatthias.ringwald 
813635454696SMatthias Ringwald static void hci_emit_dedicated_bonding_result(bd_addr_t address, uint8_t status){
813735454696SMatthias Ringwald     log_info("hci_emit_dedicated_bonding_result %u ", status);
813835454696SMatthias Ringwald     uint8_t event[9];
813935454696SMatthias Ringwald     int pos = 0;
814035454696SMatthias Ringwald     event[pos++] = GAP_EVENT_DEDICATED_BONDING_COMPLETED;
81414ea43905SMatthias Ringwald     event[pos++] = sizeof(event) - 2u;
814235454696SMatthias Ringwald     event[pos++] = status;
814335454696SMatthias Ringwald     reverse_bd_addr(address, &event[pos]);
8144d6b06661SMatthias Ringwald     hci_emit_event(event, sizeof(event), 1);
8145381fbed8Smatthias.ringwald }
8146458bf4e8S[email protected] 
814735454696SMatthias Ringwald 
814835454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
814935454696SMatthias Ringwald 
8150b83d5eabSMatthias Ringwald static void hci_emit_security_level(hci_con_handle_t con_handle, gap_security_level_t level){
8151df3354fcS[email protected]     log_info("hci_emit_security_level %u for handle %x", level, con_handle);
8152a00031e2S[email protected]     uint8_t event[5];
8153e00caf9cS[email protected]     int pos = 0;
81545611a760SMatthias Ringwald     event[pos++] = GAP_EVENT_SECURITY_LEVEL;
8155e00caf9cS[email protected]     event[pos++] = sizeof(event) - 2;
8156f8fbdce0SMatthias Ringwald     little_endian_store_16(event, 2, con_handle);
8157e00caf9cS[email protected]     pos += 2;
8158e00caf9cS[email protected]     event[pos++] = level;
8159d6b06661SMatthias Ringwald     hci_emit_event(event, sizeof(event), 1);
8160e00caf9cS[email protected] }
8161e00caf9cS[email protected] 
816235454696SMatthias Ringwald static gap_security_level_t gap_security_level_for_connection(hci_connection_t * connection){
816335454696SMatthias Ringwald     if (!connection) return LEVEL_0;
81648daf94bcSMatthias Ringwald     if ((connection->authentication_flags & AUTH_FLAG_CONNECTION_ENCRYPTED) == 0) return LEVEL_0;
8165fcaf38b9SMatthias Ringwald     // BIAS: we only consider Authenticated if the connection is already encrypted, which requires that both sides have link key
81668daf94bcSMatthias Ringwald     if ((connection->authentication_flags & AUTH_FLAG_CONNECTION_AUTHENTICATED) == 0) return LEVEL_0;
8167170fafaeSMatthias Ringwald     if (connection->encryption_key_size < hci_stack->gap_required_encyrption_key_size) return LEVEL_0;
81684051b7ffSMatthias Ringwald     gap_security_level_t security_level = gap_security_level_for_link_key_type(connection->link_key_type);
8169170fafaeSMatthias Ringwald     // LEVEL 4 always requires 128 bit encrytion key size
81700e588213SMatthias Ringwald     if ((security_level == LEVEL_4) && (connection->encryption_key_size < 16)){
8171170fafaeSMatthias Ringwald         security_level = LEVEL_3;
8172170fafaeSMatthias Ringwald     }
8173170fafaeSMatthias Ringwald     return security_level;
817435454696SMatthias Ringwald }
817535454696SMatthias Ringwald 
817671fd255dSMatthias Ringwald static void hci_emit_scan_mode_changed(uint8_t discoverable, uint8_t connectable){
817771fd255dSMatthias Ringwald     uint8_t event[4];
817871fd255dSMatthias Ringwald     event[0] = BTSTACK_EVENT_SCAN_MODE_CHANGED;
817935454696SMatthias Ringwald     event[1] = sizeof(event) - 2;
818071fd255dSMatthias Ringwald     event[2] = discoverable;
818171fd255dSMatthias Ringwald     event[3] = connectable;
8182d6b06661SMatthias Ringwald     hci_emit_event(event, sizeof(event), 1);
8183ad83dc6aS[email protected] }
8184ad83dc6aS[email protected] 
818598a2fd1cSMatthias Ringwald // query if remote side supports eSCO
818620dcdd22SMatthias Ringwald bool hci_remote_esco_supported(hci_con_handle_t con_handle){
818798a2fd1cSMatthias Ringwald     hci_connection_t * connection = hci_connection_for_handle(con_handle);
818820dcdd22SMatthias Ringwald     if (!connection) return false;
818976ccfb2aSMatthias Ringwald     return (connection->remote_supported_features[0] & 1) != 0;
819098a2fd1cSMatthias Ringwald }
819198a2fd1cSMatthias Ringwald 
81920b78a447SMatthias Ringwald uint16_t hci_remote_sco_packet_types(hci_con_handle_t con_handle){
81930b78a447SMatthias Ringwald     hci_connection_t * connection = hci_connection_for_handle(con_handle);
81940b78a447SMatthias Ringwald     if (!connection) return 0;
81950b78a447SMatthias Ringwald     return connection->remote_supported_sco_packets;
81960b78a447SMatthias Ringwald }
81970b78a447SMatthias Ringwald 
819867aae551SMatthias Ringwald static bool hci_ssp_supported(hci_connection_t * connection){
819967aae551SMatthias Ringwald     const uint8_t mask = BONDING_REMOTE_SUPPORTS_SSP_CONTROLLER | BONDING_REMOTE_SUPPORTS_SSP_HOST;
820067aae551SMatthias Ringwald     return (connection->bonding_flags & mask) == mask;
820167aae551SMatthias Ringwald }
820267aae551SMatthias Ringwald 
82032bd8b7e7S[email protected] // query if remote side supports SSP
820420dcdd22SMatthias Ringwald bool hci_remote_ssp_supported(hci_con_handle_t con_handle){
82052bd8b7e7S[email protected]     hci_connection_t * connection = hci_connection_for_handle(con_handle);
820620dcdd22SMatthias Ringwald     if (!connection) return false;
820767aae551SMatthias Ringwald     return hci_ssp_supported(connection) ? 1 : 0;
82082bd8b7e7S[email protected] }
82092bd8b7e7S[email protected] 
821020dcdd22SMatthias Ringwald bool gap_ssp_supported_on_both_sides(hci_con_handle_t handle){
8211df3354fcS[email protected]     return hci_local_ssp_activated() && hci_remote_ssp_supported(handle);
8212df3354fcS[email protected] }
8213df3354fcS[email protected] 
82146ffc78ceSMatthias Ringwald /**
82156ffc78ceSMatthias Ringwald  * Check if remote supported features query has completed
82166ffc78ceSMatthias Ringwald  */
82176ffc78ceSMatthias Ringwald bool hci_remote_features_available(hci_con_handle_t handle){
82186ffc78ceSMatthias Ringwald     hci_connection_t * connection = hci_connection_for_handle(handle);
82196ffc78ceSMatthias Ringwald     if (!connection) return false;
82206ffc78ceSMatthias Ringwald     return (connection->bonding_flags & BONDING_RECEIVED_REMOTE_FEATURES) != 0;
82216ffc78ceSMatthias Ringwald }
82226ffc78ceSMatthias Ringwald 
8223d6596031SMatthias Ringwald /**
8224d6596031SMatthias Ringwald  * Trigger remote supported features query
8225d6596031SMatthias Ringwald  */
8226c9742cd1SMatthias Ringwald 
8227c9742cd1SMatthias Ringwald static void hci_trigger_remote_features_for_connection(hci_connection_t * connection){
8228c9742cd1SMatthias Ringwald     if ((connection->bonding_flags & (BONDING_REMOTE_FEATURES_QUERY_ACTIVE | BONDING_RECEIVED_REMOTE_FEATURES)) == 0){
8229c9742cd1SMatthias Ringwald         connection->bonding_flags |= BONDING_REMOTE_FEATURES_QUERY_ACTIVE | BONDING_REQUEST_REMOTE_FEATURES_PAGE_0;
8230c9742cd1SMatthias Ringwald     }
8231c9742cd1SMatthias Ringwald }
8232c9742cd1SMatthias Ringwald 
8233d6596031SMatthias Ringwald void hci_remote_features_query(hci_con_handle_t con_handle){
8234d6596031SMatthias Ringwald     hci_connection_t * connection = hci_connection_for_handle(con_handle);
8235d6596031SMatthias Ringwald     if (!connection) return;
8236c9742cd1SMatthias Ringwald     hci_trigger_remote_features_for_connection(connection);
8237d6596031SMatthias Ringwald     hci_run();
8238d6596031SMatthias Ringwald }
8239d6596031SMatthias Ringwald 
8240458bf4e8S[email protected] // GAP API
8241458bf4e8S[email protected] /**
8242458bf4e8S[email protected]  * @bbrief enable/disable bonding. default is enabled
8243458bf4e8S[email protected]  * @praram enabled
8244458bf4e8S[email protected]  */
82454c57c146S[email protected] void gap_set_bondable_mode(int enable){
82463a9fb326S[email protected]     hci_stack->bondable = enable ? 1 : 0;
8247458bf4e8S[email protected] }
82484ef6443cSMatthias Ringwald /**
82494ef6443cSMatthias Ringwald  * @brief Get bondable mode.
82504ef6443cSMatthias Ringwald  * @return 1 if bondable
82514ef6443cSMatthias Ringwald  */
82524ef6443cSMatthias Ringwald int gap_get_bondable_mode(void){
82534ef6443cSMatthias Ringwald     return hci_stack->bondable;
82544ef6443cSMatthias Ringwald }
8255cb230b9dS[email protected] 
8256cb230b9dS[email protected] /**
825734d2123cS[email protected]  * @brief map link keys to security levels
8258cb230b9dS[email protected]  */
825934d2123cS[email protected] gap_security_level_t gap_security_level_for_link_key_type(link_key_type_t link_key_type){
826034d2123cS[email protected]     switch (link_key_type){
82613c68dfa9S[email protected]         case AUTHENTICATED_COMBINATION_KEY_GENERATED_FROM_P256:
82623c68dfa9S[email protected]             return LEVEL_4;
82633c68dfa9S[email protected]         case COMBINATION_KEY:
82643c68dfa9S[email protected]         case AUTHENTICATED_COMBINATION_KEY_GENERATED_FROM_P192:
82653c68dfa9S[email protected]             return LEVEL_3;
82663c68dfa9S[email protected]         default:
82673c68dfa9S[email protected]             return LEVEL_2;
82683c68dfa9S[email protected]     }
8269cb230b9dS[email protected] }
8270cb230b9dS[email protected] 
82718b35e16aSMatthias Ringwald /**
82728b35e16aSMatthias Ringwald  * @brief map link keys to secure connection yes/no
82738b35e16aSMatthias Ringwald  */
827436c3546bSMatthias Ringwald bool gap_secure_connection_for_link_key_type(link_key_type_t link_key_type){
82758b35e16aSMatthias Ringwald     switch (link_key_type){
82768b35e16aSMatthias Ringwald         case AUTHENTICATED_COMBINATION_KEY_GENERATED_FROM_P256:
82778b35e16aSMatthias Ringwald         case UNAUTHENTICATED_COMBINATION_KEY_GENERATED_FROM_P256:
827836c3546bSMatthias Ringwald             return true;
82798b35e16aSMatthias Ringwald         default:
828036c3546bSMatthias Ringwald             return false;
82818b35e16aSMatthias Ringwald     }
82828b35e16aSMatthias Ringwald }
82838b35e16aSMatthias Ringwald 
82848b35e16aSMatthias Ringwald /**
82858b35e16aSMatthias Ringwald  * @brief map link keys to authenticated
82868b35e16aSMatthias Ringwald  */
82877040ba26SMatthias Ringwald bool gap_authenticated_for_link_key_type(link_key_type_t link_key_type){
82888b35e16aSMatthias Ringwald     switch (link_key_type){
82898b35e16aSMatthias Ringwald         case AUTHENTICATED_COMBINATION_KEY_GENERATED_FROM_P256:
82908b35e16aSMatthias Ringwald         case AUTHENTICATED_COMBINATION_KEY_GENERATED_FROM_P192:
82917040ba26SMatthias Ringwald             return true;
82928b35e16aSMatthias Ringwald         default:
82937040ba26SMatthias Ringwald             return false;
82948b35e16aSMatthias Ringwald     }
82958b35e16aSMatthias Ringwald }
82968b35e16aSMatthias Ringwald 
8297552b9260SMatthias Ringwald bool gap_mitm_protection_required_for_security_level(gap_security_level_t level){
82985127cc62S[email protected]     log_info("gap_mitm_protection_required_for_security_level %u", level);
8299106d6d11S[email protected]     return level > LEVEL_2;
8300106d6d11S[email protected] }
8301106d6d11S[email protected] 
830234d2123cS[email protected] /**
830334d2123cS[email protected]  * @brief get current security level
830434d2123cS[email protected]  */
830534d2123cS[email protected] gap_security_level_t gap_security_level(hci_con_handle_t con_handle){
830634d2123cS[email protected]     hci_connection_t * connection = hci_connection_for_handle(con_handle);
830734d2123cS[email protected]     if (!connection) return LEVEL_0;
830834d2123cS[email protected]     return gap_security_level_for_connection(connection);
830934d2123cS[email protected] }
831034d2123cS[email protected] 
8311cb230b9dS[email protected] /**
8312cb230b9dS[email protected]  * @brief request connection to device to
8313cb230b9dS[email protected]  * @result GAP_AUTHENTICATION_RESULT
8314cb230b9dS[email protected]  */
831534d2123cS[email protected] void gap_request_security_level(hci_con_handle_t con_handle, gap_security_level_t requested_level){
831634d2123cS[email protected]     hci_connection_t * connection = hci_connection_for_handle(con_handle);
831734d2123cS[email protected]     if (!connection){
8318a00031e2S[email protected]         hci_emit_security_level(con_handle, LEVEL_0);
831934d2123cS[email protected]         return;
832034d2123cS[email protected]     }
8321defbf200SMatthias Ringwald 
8322defbf200SMatthias Ringwald     btstack_assert(hci_is_le_connection(connection) == false);
8323defbf200SMatthias Ringwald 
8324bc00e12cSMatthias Ringwald     // Core Spec 5.2, GAP 5.2.2: "When in Secure Connections Only mode, all services (except those allowed to have Security Mode 4, Level 0)
8325bc00e12cSMatthias Ringwald     // available on the BR/EDR physical transport require Security Mode 4, Level 4 "
8326bc00e12cSMatthias Ringwald     if (hci_stack->gap_secure_connections_only_mode && (requested_level != LEVEL_0)){
8327bc00e12cSMatthias Ringwald         requested_level = LEVEL_4;
8328bc00e12cSMatthias Ringwald     }
8329bc00e12cSMatthias Ringwald 
833034d2123cS[email protected]     gap_security_level_t current_level = gap_security_level(con_handle);
833183d08d7cSMatthias Ringwald     log_info("gap_request_security_level requested level %u, planned level %u, current level %u",
833283d08d7cSMatthias Ringwald         requested_level, connection->requested_security_level, current_level);
833383d08d7cSMatthias Ringwald 
8334dbd5dcc3SMatthias Ringwald     // authentication active if authentication request was sent or planned level > 0
8335dbd5dcc3SMatthias Ringwald     bool authentication_active = ((connection->bonding_flags & BONDING_SENT_AUTHENTICATE_REQUEST) != 0) || (connection->requested_security_level > LEVEL_0);
8336dbd5dcc3SMatthias Ringwald     if (authentication_active){
83371cf0a6c8SMatthias Ringwald         // authentication already active
833883d08d7cSMatthias Ringwald         if (connection->requested_security_level < requested_level){
833983d08d7cSMatthias Ringwald             // increase requested level as new level is higher
834083d08d7cSMatthias Ringwald             // TODO: handle re-authentication when done
834183d08d7cSMatthias Ringwald             connection->requested_security_level = requested_level;
834283d08d7cSMatthias Ringwald         }
83431cf0a6c8SMatthias Ringwald     } else {
834483d08d7cSMatthias Ringwald         // no request active, notify if security sufficient
834583d08d7cSMatthias Ringwald         if (requested_level <= current_level){
8346a00031e2S[email protected]             hci_emit_security_level(con_handle, current_level);
834734d2123cS[email protected]             return;
834834d2123cS[email protected]         }
8349a00031e2S[email protected] 
8350e060c07dSMatthias Ringwald         // store request
835134d2123cS[email protected]         connection->requested_security_level = requested_level;
8352a00031e2S[email protected] 
83531cf0a6c8SMatthias Ringwald         // start to authenticate connection
83541eb2563eS[email protected]         connection->bonding_flags |= BONDING_SEND_AUTHENTICATE_REQUEST;
83557fdbaf79SMatthias Ringwald 
83567fdbaf79SMatthias Ringwald         // request remote features if not already active, also trigger hci_run
83577fdbaf79SMatthias Ringwald         hci_remote_features_query(con_handle);
8358e00caf9cS[email protected]     }
83591cf0a6c8SMatthias Ringwald }
8360ad83dc6aS[email protected] 
8361ad83dc6aS[email protected] /**
8362ad83dc6aS[email protected]  * @brief start dedicated bonding with device. disconnect after bonding
8363ad83dc6aS[email protected]  * @param device
8364ad83dc6aS[email protected]  * @param request MITM protection
8365ad83dc6aS[email protected]  * @result GAP_DEDICATED_BONDING_COMPLETE
8366ad83dc6aS[email protected]  */
8367ad83dc6aS[email protected] int gap_dedicated_bonding(bd_addr_t device, int mitm_protection_required){
8368ad83dc6aS[email protected] 
8369ad83dc6aS[email protected]     // create connection state machine
837088f925b1SMatthias Ringwald     hci_connection_t * connection = create_connection_for_bd_addr_and_type(device, BD_ADDR_TYPE_ACL, HCI_ROLE_MASTER);
8371ad83dc6aS[email protected] 
8372ad83dc6aS[email protected]     if (!connection){
8373ad83dc6aS[email protected]         return BTSTACK_MEMORY_ALLOC_FAILED;
8374ad83dc6aS[email protected]     }
8375ad83dc6aS[email protected] 
83764cd03f8aSMatthias Ringwald     // delete link key
837715a95bd5SMatthias Ringwald     gap_drop_link_key_for_bd_addr(device);
8378ad83dc6aS[email protected] 
8379ad83dc6aS[email protected]     // configure LEVEL_2/3, dedicated bonding
8380ad83dc6aS[email protected]     connection->state = SEND_CREATE_CONNECTION;
8381ad83dc6aS[email protected]     connection->requested_security_level = mitm_protection_required ? LEVEL_3 : LEVEL_2;
8382f04a0c31SMatthias Ringwald     log_info("gap_dedicated_bonding, mitm %d -> level %u", mitm_protection_required, connection->requested_security_level);
8383ad83dc6aS[email protected]     connection->bonding_flags = BONDING_DEDICATED;
8384ad83dc6aS[email protected] 
8385ad83dc6aS[email protected]     hci_run();
8386ad83dc6aS[email protected] 
8387ad83dc6aS[email protected]     return 0;
8388ad83dc6aS[email protected] }
83898e618f72S[email protected] 
8390f82b8f4bSMatthias Ringwald uint8_t hci_dedicated_bonding_defer_disconnect(hci_con_handle_t con_handle, bool defer){
8391ab0c69a9SMatthias Ringwald     hci_connection_t * connection = hci_connection_for_handle(con_handle);
8392ab0c69a9SMatthias Ringwald     if (connection == NULL){
8393ab0c69a9SMatthias Ringwald         return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
8394ab0c69a9SMatthias Ringwald     }
8395ab0c69a9SMatthias Ringwald     if (defer){
8396ab0c69a9SMatthias Ringwald         connection->bonding_flags |= BONDING_DEDICATED_DEFER_DISCONNECT;
8397ab0c69a9SMatthias Ringwald     } else {
8398ab0c69a9SMatthias Ringwald         connection->bonding_flags &= ~BONDING_DEDICATED_DEFER_DISCONNECT;
8399ab0c69a9SMatthias Ringwald         // trigger disconnect
8400ab0c69a9SMatthias Ringwald         hci_run();
8401ab0c69a9SMatthias Ringwald     }
8402ab0c69a9SMatthias Ringwald     return ERROR_CODE_SUCCESS;
8403ab0c69a9SMatthias Ringwald }
8404ab0c69a9SMatthias Ringwald 
84058e618f72S[email protected] void gap_set_local_name(const char * local_name){
84068e618f72S[email protected]     hci_stack->local_name = local_name;
8407baa4881eSMatthias Ringwald     hci_stack->gap_tasks_classic |= GAP_TASK_SET_LOCAL_NAME;
840859d59ecfSMatthias Ringwald     // also update EIR if not set by user
840959d59ecfSMatthias Ringwald     if (hci_stack->eir_data == NULL){
8410baa4881eSMatthias Ringwald         hci_stack->gap_tasks_classic |= GAP_TASK_SET_EIR_DATA;
841159d59ecfSMatthias Ringwald     }
841259d59ecfSMatthias Ringwald     hci_run();
84138e618f72S[email protected] }
84141aeec2ebSMatthias Ringwald #endif
84158e618f72S[email protected] 
841635454696SMatthias Ringwald 
841735454696SMatthias Ringwald #ifdef ENABLE_BLE
841835454696SMatthias Ringwald 
8419d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
8420d8e8f12aSMatthias Ringwald void gap_start_scan(void){
8421fde725feSMatthias Ringwald     hci_stack->le_scanning_enabled = true;
84227bdc6798S[email protected]     hci_run();
84237bdc6798S[email protected] }
84248e618f72S[email protected] 
8425d8e8f12aSMatthias Ringwald void gap_stop_scan(void){
8426fde725feSMatthias Ringwald     hci_stack->le_scanning_enabled = false;
84277bdc6798S[email protected]     hci_run();
84287bdc6798S[email protected] }
84294f3229d8S[email protected] 
8430a7a719e9SMatthias Ringwald void gap_set_scan_params(uint8_t scan_type, uint16_t scan_interval, uint16_t scan_window, uint8_t scanning_filter_policy){
8431ef11999fSmatthias.ringwald     hci_stack->le_scan_type          = scan_type;
8432a7a719e9SMatthias Ringwald     hci_stack->le_scan_filter_policy = scanning_filter_policy;
8433ef11999fSmatthias.ringwald     hci_stack->le_scan_interval      = scan_interval;
8434ef11999fSmatthias.ringwald     hci_stack->le_scan_window        = scan_window;
84358b69e4c7SMatthias Ringwald     hci_stack->le_scanning_param_update = true;
8436ef11999fSmatthias.ringwald     hci_run();
8437ef11999fSmatthias.ringwald }
84384f3229d8S[email protected] 
8439a7a719e9SMatthias Ringwald void gap_set_scan_parameters(uint8_t scan_type, uint16_t scan_interval, uint16_t scan_window){
8440a7a719e9SMatthias Ringwald     gap_set_scan_params(scan_type, scan_interval, scan_window, 0);
8441a7a719e9SMatthias Ringwald }
8442a7a719e9SMatthias Ringwald 
84434856283bSMatthias Ringwald void gap_set_scan_duplicate_filter(bool enabled){
84444856283bSMatthias Ringwald     hci_stack->le_scan_filter_duplicates = enabled ? 1 : 0;
84454856283bSMatthias Ringwald }
84464856283bSMatthias Ringwald 
84477eb5b27eSMatthias Ringwald void gap_set_scan_phys(uint8_t phys){
84487eb5b27eSMatthias Ringwald     // LE Coded and LE 1M PHY
84497eb5b27eSMatthias Ringwald     hci_stack->le_scan_phys = phys & 0x05;
84507eb5b27eSMatthias Ringwald }
84517eb5b27eSMatthias Ringwald 
8452667ba9d1SMatthias Ringwald uint8_t gap_connect(const bd_addr_t addr, bd_addr_type_t addr_type) {
84539cb52963SMatthias Ringwald     // disallow le connection if outgoing already active
8454d32b3f05SMatthias Ringwald     if (hci_is_le_connection_type(addr_type) && hci_stack->le_connecting_request != LE_CONNECTING_IDLE){
84559cb52963SMatthias Ringwald         log_error("le connect already active");
8456d32b3f05SMatthias Ringwald         return ERROR_CODE_COMMAND_DISALLOWED;
8457d32b3f05SMatthias Ringwald     }
8458d32b3f05SMatthias Ringwald 
84599cb52963SMatthias Ringwald     hci_connection_t * conn = hci_connection_for_bd_addr_and_type(addr, addr_type);
84609cb52963SMatthias Ringwald     if (conn == NULL) {
846188f925b1SMatthias Ringwald         conn = create_connection_for_bd_addr_and_type(addr, addr_type, HCI_ROLE_MASTER);
84629cb52963SMatthias Ringwald         if (conn == false){
84639cb52963SMatthias Ringwald             // alloc failed
8464d8e8f12aSMatthias Ringwald             log_info("gap_connect: failed to alloc hci_connection_t");
84659cb52963SMatthias Ringwald             return BTSTACK_MEMORY_ALLOC_FAILED;
84669cb52963SMatthias Ringwald         }
84679cb52963SMatthias Ringwald     } else {
84689cb52963SMatthias Ringwald         switch (conn->state) {
84699cb52963SMatthias Ringwald             case RECEIVED_DISCONNECTION_COMPLETE:
84709cb52963SMatthias Ringwald                 // connection was just disconnected, reset state and allow re-connect
84719cb52963SMatthias Ringwald                 conn->role = HCI_ROLE_MASTER;
84729cb52963SMatthias Ringwald                 break;
84739cb52963SMatthias Ringwald             default:
84749cb52963SMatthias Ringwald                 return ERROR_CODE_COMMAND_DISALLOWED;
84759cb52963SMatthias Ringwald         }
84764f3229d8S[email protected]     }
8477d5b1a89eSMatthias Ringwald 
8478d5b1a89eSMatthias Ringwald     // set le connecting state
8479d5b1a89eSMatthias Ringwald     if (hci_is_le_connection_type(addr_type)){
8480d5b1a89eSMatthias Ringwald         hci_stack->le_connecting_request = LE_CONNECTING_DIRECT;
8481d5b1a89eSMatthias Ringwald     }
8482d5b1a89eSMatthias Ringwald 
84839cb52963SMatthias Ringwald     // trigger connect
8484d8e8f12aSMatthias Ringwald     log_info("gap_connect: send create connection next");
8485b0136355SMatthias Ringwald     conn->state = SEND_CREATE_CONNECTION;
8486b0136355SMatthias Ringwald     hci_run();
8487b0136355SMatthias Ringwald     return ERROR_CODE_SUCCESS;
8488b0136355SMatthias Ringwald }
8489b0136355SMatthias Ringwald 
84907851196eSmatthias.ringwald // @assumption: only a single outgoing LE Connection exists
8491ca0d6e5aSMatthias Ringwald static hci_connection_t * gap_get_outgoing_le_connection(void){
8492665d90f2SMatthias Ringwald     btstack_linked_item_t *it;
8493a0da043fSMatthias Ringwald     for (it = (btstack_linked_item_t *) hci_stack->connections; it != NULL; it = it->next){
84940bf6344aS[email protected]         hci_connection_t * conn = (hci_connection_t *) it;
8495ca0d6e5aSMatthias Ringwald         if (hci_is_le_connection(conn)){
84960bf6344aS[email protected]             switch (conn->state){
8497a6725849S[email protected]                 case SEND_CREATE_CONNECTION:
84987851196eSmatthias.ringwald                 case SENT_CREATE_CONNECTION:
84997851196eSmatthias.ringwald                     return conn;
85007851196eSmatthias.ringwald                 default:
85017851196eSmatthias.ringwald                     break;
85027851196eSmatthias.ringwald             };
85037851196eSmatthias.ringwald         }
8504ca0d6e5aSMatthias Ringwald     }
85057851196eSmatthias.ringwald     return NULL;
85067851196eSmatthias.ringwald }
85077851196eSmatthias.ringwald 
8508d8e8f12aSMatthias Ringwald uint8_t gap_connect_cancel(void){
850914f2d8f0SMatthias Ringwald     hci_connection_t * conn;
851014f2d8f0SMatthias Ringwald     switch (hci_stack->le_connecting_request){
851114f2d8f0SMatthias Ringwald         case LE_CONNECTING_IDLE:
851214f2d8f0SMatthias Ringwald             break;
851314f2d8f0SMatthias Ringwald         case LE_CONNECTING_WHITELIST:
851414f2d8f0SMatthias Ringwald             hci_stack->le_connecting_request = LE_CONNECTING_IDLE;
851514f2d8f0SMatthias Ringwald             hci_run();
851614f2d8f0SMatthias Ringwald             break;
851714f2d8f0SMatthias Ringwald         case LE_CONNECTING_DIRECT:
851814f2d8f0SMatthias Ringwald             hci_stack->le_connecting_request = LE_CONNECTING_IDLE;
8519ca0d6e5aSMatthias Ringwald             conn = gap_get_outgoing_le_connection();
852014f2d8f0SMatthias Ringwald             if (conn == NULL){
852114f2d8f0SMatthias Ringwald                 hci_run();
852214f2d8f0SMatthias Ringwald             } else {
85237851196eSmatthias.ringwald                 switch (conn->state){
85247851196eSmatthias.ringwald                     case SEND_CREATE_CONNECTION:
85257851196eSmatthias.ringwald                         // skip sending create connection and emit event instead
85262e77e513S[email protected]                         hci_emit_le_connection_complete(conn->address_type, conn->address, 0, ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER);
8527665d90f2SMatthias Ringwald                         btstack_linked_list_remove(&hci_stack->connections, (btstack_linked_item_t *) conn);
85287851196eSmatthias.ringwald                         btstack_memory_hci_connection_free( conn );
85290bf6344aS[email protected]                         break;
8530a6725849S[email protected]                     case SENT_CREATE_CONNECTION:
8531ea04fbd8SMatthias Ringwald                         // let hci_run_general_gap_le cancel outgoing connection
85320bf6344aS[email protected]                         hci_run();
85330bf6344aS[email protected]                         break;
85340bf6344aS[email protected]                     default:
85350bf6344aS[email protected]                         break;
85360bf6344aS[email protected]                 }
853714f2d8f0SMatthias Ringwald             }
853814f2d8f0SMatthias Ringwald             break;
853943dfd98aSMatthias Ringwald         default:
854014f2d8f0SMatthias Ringwald             btstack_unreachable();
854114f2d8f0SMatthias Ringwald             break;
854214f2d8f0SMatthias Ringwald     }
854314f2d8f0SMatthias Ringwald     return ERROR_CODE_SUCCESS;
8544e31f89a7S[email protected] }
85454f3229d8S[email protected] 
8546c37a3166S[email protected] /**
85476012052bSMatthias Ringwald  * @brief Set connection parameters for outgoing connections
8548cbe54ab2SJakob Krantz  * @param conn_scan_interval (unit: 0.625 msec), default: 60 ms
8549cbe54ab2SJakob Krantz  * @param conn_scan_window (unit: 0.625 msec), default: 30 ms
85506012052bSMatthias Ringwald  * @param conn_interval_min (unit: 1.25ms), default: 10 ms
85516012052bSMatthias Ringwald  * @param conn_interval_max (unit: 1.25ms), default: 30 ms
85526012052bSMatthias Ringwald  * @param conn_latency, default: 4
85536012052bSMatthias Ringwald  * @param supervision_timeout (unit: 10ms), default: 720 ms
85546012052bSMatthias Ringwald  * @param min_ce_length (unit: 0.625ms), default: 10 ms
85556012052bSMatthias Ringwald  * @param max_ce_length (unit: 0.625ms), default: 30 ms
85566012052bSMatthias Ringwald  */
85576012052bSMatthias Ringwald 
85580c2c5f79SMatthias Ringwald void gap_set_connection_phys(uint8_t phys){
85590c2c5f79SMatthias Ringwald     // LE Coded, LE 1M, LE 2M PHY
85600c2c5f79SMatthias Ringwald     hci_stack->le_connection_phys = phys & 7;
85610c2c5f79SMatthias Ringwald }
85620c2c5f79SMatthias Ringwald 
85630c2c5f79SMatthias Ringwald #endif
85640c2c5f79SMatthias Ringwald 
8565cbe54ab2SJakob Krantz void gap_set_connection_parameters(uint16_t conn_scan_interval, uint16_t conn_scan_window,
8566cbe54ab2SJakob Krantz                                    uint16_t conn_interval_min, uint16_t conn_interval_max, uint16_t conn_latency,
8567cbe54ab2SJakob Krantz                                    uint16_t supervision_timeout, uint16_t min_ce_length, uint16_t max_ce_length){
8568cbe54ab2SJakob Krantz     hci_stack->le_connection_scan_interval = conn_scan_interval;
8569cbe54ab2SJakob Krantz     hci_stack->le_connection_scan_window = conn_scan_window;
85706012052bSMatthias Ringwald     hci_stack->le_connection_interval_min = conn_interval_min;
85716012052bSMatthias Ringwald     hci_stack->le_connection_interval_max = conn_interval_max;
85726012052bSMatthias Ringwald     hci_stack->le_connection_latency = conn_latency;
85736012052bSMatthias Ringwald     hci_stack->le_supervision_timeout = supervision_timeout;
85746012052bSMatthias Ringwald     hci_stack->le_minimum_ce_length = min_ce_length;
85756012052bSMatthias Ringwald     hci_stack->le_maximum_ce_length = max_ce_length;
85766012052bSMatthias Ringwald }
85777eb5b27eSMatthias Ringwald 
85786012052bSMatthias Ringwald /**
8579c37a3166S[email protected]  * @brief Updates the connection parameters for a given LE connection
8580c37a3166S[email protected]  * @param handle
8581c37a3166S[email protected]  * @param conn_interval_min (unit: 1.25ms)
8582c37a3166S[email protected]  * @param conn_interval_max (unit: 1.25ms)
8583c37a3166S[email protected]  * @param conn_latency
8584c37a3166S[email protected]  * @param supervision_timeout (unit: 10ms)
85856b65794dSMilanka Ringwald  * @return 0 if ok
8586c37a3166S[email protected]  */
8587c37a3166S[email protected] int gap_update_connection_parameters(hci_con_handle_t con_handle, uint16_t conn_interval_min,
8588c37a3166S[email protected]     uint16_t conn_interval_max, uint16_t conn_latency, uint16_t supervision_timeout){
8589c37a3166S[email protected]     hci_connection_t * connection = hci_connection_for_handle(con_handle);
8590c37a3166S[email protected]     if (!connection) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
8591c37a3166S[email protected]     connection->le_conn_interval_min = conn_interval_min;
8592c37a3166S[email protected]     connection->le_conn_interval_max = conn_interval_max;
8593c37a3166S[email protected]     connection->le_conn_latency = conn_latency;
8594c37a3166S[email protected]     connection->le_supervision_timeout = supervision_timeout;
859584cf6d83SMatthias Ringwald     connection->le_con_parameter_update_state = CON_PARAMETER_UPDATE_CHANGE_HCI_CON_PARAMETERS;
8596cfc59f1bSMatthias Ringwald     hci_run();
8597c37a3166S[email protected]     return 0;
8598c37a3166S[email protected] }
8599c37a3166S[email protected] 
860045c102fdSMatthias Ringwald /**
8601b68d7bc3SMatthias Ringwald  * @brief Request an update of the connection parameter for a given LE connection
8602b68d7bc3SMatthias Ringwald  * @param handle
8603b68d7bc3SMatthias Ringwald  * @param conn_interval_min (unit: 1.25ms)
8604b68d7bc3SMatthias Ringwald  * @param conn_interval_max (unit: 1.25ms)
8605b68d7bc3SMatthias Ringwald  * @param conn_latency
8606b68d7bc3SMatthias Ringwald  * @param supervision_timeout (unit: 10ms)
86076b65794dSMilanka Ringwald  * @return 0 if ok
8608b68d7bc3SMatthias Ringwald  */
8609b68d7bc3SMatthias Ringwald int gap_request_connection_parameter_update(hci_con_handle_t con_handle, uint16_t conn_interval_min,
8610b68d7bc3SMatthias Ringwald     uint16_t conn_interval_max, uint16_t conn_latency, uint16_t supervision_timeout){
8611b68d7bc3SMatthias Ringwald     hci_connection_t * connection = hci_connection_for_handle(con_handle);
8612b68d7bc3SMatthias Ringwald     if (!connection) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
8613b68d7bc3SMatthias Ringwald     connection->le_conn_interval_min = conn_interval_min;
8614b68d7bc3SMatthias Ringwald     connection->le_conn_interval_max = conn_interval_max;
8615b68d7bc3SMatthias Ringwald     connection->le_conn_latency = conn_latency;
8616b68d7bc3SMatthias Ringwald     connection->le_supervision_timeout = supervision_timeout;
8617b68d7bc3SMatthias Ringwald     connection->le_con_parameter_update_state = CON_PARAMETER_UPDATE_SEND_REQUEST;
861809c9c963SMatthias Ringwald     uint8_t l2cap_trigger_run_event[2] = { L2CAP_EVENT_TRIGGER_RUN, 0};
861909c9c963SMatthias Ringwald     hci_emit_event(l2cap_trigger_run_event, sizeof(l2cap_trigger_run_event), 0);
8620b68d7bc3SMatthias Ringwald     return 0;
8621b68d7bc3SMatthias Ringwald }
8622b68d7bc3SMatthias Ringwald 
8623d70217a2SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
8624d70217a2SMatthias Ringwald 
86255e05c0afSMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
86265e05c0afSMatthias Ringwald static void hci_assert_advertisement_set_0_ready(void){
86275e05c0afSMatthias Ringwald     // force advertising set creation for legacy LE Advertising
86285e05c0afSMatthias Ringwald     if ((hci_stack->le_advertisements_state & LE_ADVERTISEMENT_STATE_PARAMS_SET) == 0){
86295e05c0afSMatthias Ringwald         hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_SET_PARAMS;
86305e05c0afSMatthias Ringwald     }
86315e05c0afSMatthias Ringwald }
86325e05c0afSMatthias Ringwald #endif
86335e05c0afSMatthias Ringwald 
8634b68d7bc3SMatthias Ringwald /**
863545c102fdSMatthias Ringwald  * @brief Set Advertisement Data
863645c102fdSMatthias Ringwald  * @param advertising_data_length
863745c102fdSMatthias Ringwald  * @param advertising_data (max 31 octets)
863845c102fdSMatthias Ringwald  * @note data is not copied, pointer has to stay valid
863945c102fdSMatthias Ringwald  */
864045c102fdSMatthias Ringwald void gap_advertisements_set_data(uint8_t advertising_data_length, uint8_t * advertising_data){
864145c102fdSMatthias Ringwald     hci_stack->le_advertisements_data_len = advertising_data_length;
864245c102fdSMatthias Ringwald     hci_stack->le_advertisements_data = advertising_data;
8643501f56b3SMatthias Ringwald     hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_SET_ADV_DATA;
86445e05c0afSMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
86455e05c0afSMatthias Ringwald     hci_assert_advertisement_set_0_ready();
86465e05c0afSMatthias Ringwald #endif
8647bbc366e6SMatthias Ringwald     hci_run();
864845c102fdSMatthias Ringwald }
8649501f56b3SMatthias Ringwald 
8650501f56b3SMatthias Ringwald /**
8651501f56b3SMatthias Ringwald  * @brief Set Scan Response Data
8652501f56b3SMatthias Ringwald  * @param advertising_data_length
8653501f56b3SMatthias Ringwald  * @param advertising_data (max 31 octets)
8654501f56b3SMatthias Ringwald  * @note data is not copied, pointer has to stay valid
8655501f56b3SMatthias Ringwald  */
8656501f56b3SMatthias Ringwald void gap_scan_response_set_data(uint8_t scan_response_data_length, uint8_t * scan_response_data){
8657501f56b3SMatthias Ringwald     hci_stack->le_scan_response_data_len = scan_response_data_length;
8658501f56b3SMatthias Ringwald     hci_stack->le_scan_response_data = scan_response_data;
8659501f56b3SMatthias Ringwald     hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_SET_SCAN_DATA;
86605e05c0afSMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
86615e05c0afSMatthias Ringwald     hci_assert_advertisement_set_0_ready();
86625e05c0afSMatthias Ringwald #endif
8663bbc366e6SMatthias Ringwald     hci_run();
866445c102fdSMatthias Ringwald }
866545c102fdSMatthias Ringwald 
866645c102fdSMatthias Ringwald /**
866745c102fdSMatthias Ringwald  * @brief Set Advertisement Parameters
866845c102fdSMatthias Ringwald  * @param adv_int_min
866945c102fdSMatthias Ringwald  * @param adv_int_max
867045c102fdSMatthias Ringwald  * @param adv_type
867145c102fdSMatthias Ringwald  * @param direct_address_type
867245c102fdSMatthias Ringwald  * @param direct_address
867345c102fdSMatthias Ringwald  * @param channel_map
867445c102fdSMatthias Ringwald  * @param filter_policy
867545c102fdSMatthias Ringwald  *
867645c102fdSMatthias Ringwald  * @note internal use. use gap_advertisements_set_params from gap_le.h instead.
867745c102fdSMatthias Ringwald  */
867845c102fdSMatthias Ringwald  void hci_le_advertisements_set_params(uint16_t adv_int_min, uint16_t adv_int_max, uint8_t adv_type,
8679b95a5a35SMatthias Ringwald     uint8_t direct_address_typ, bd_addr_t direct_address,
868045c102fdSMatthias Ringwald     uint8_t channel_map, uint8_t filter_policy) {
868145c102fdSMatthias Ringwald 
868245c102fdSMatthias Ringwald     hci_stack->le_advertisements_interval_min = adv_int_min;
868345c102fdSMatthias Ringwald     hci_stack->le_advertisements_interval_max = adv_int_max;
868445c102fdSMatthias Ringwald     hci_stack->le_advertisements_type = adv_type;
868545c102fdSMatthias Ringwald     hci_stack->le_advertisements_direct_address_type = direct_address_typ;
868645c102fdSMatthias Ringwald     hci_stack->le_advertisements_channel_map = channel_map;
868745c102fdSMatthias Ringwald     hci_stack->le_advertisements_filter_policy = filter_policy;
86886535961aSMatthias Ringwald     (void)memcpy(hci_stack->le_advertisements_direct_address, direct_address,
86896535961aSMatthias Ringwald                  6);
869045c102fdSMatthias Ringwald 
86916bf435a6SMatthias Ringwald     hci_stack->le_advertisements_todo  |= LE_ADVERTISEMENT_TASKS_SET_PARAMS;
86926bf435a6SMatthias Ringwald     hci_stack->le_advertisements_state |= LE_ADVERTISEMENT_STATE_PARAMS_SET;
8693bbc366e6SMatthias Ringwald     hci_run();
869445c102fdSMatthias Ringwald  }
869545c102fdSMatthias Ringwald 
869645c102fdSMatthias Ringwald /**
869745c102fdSMatthias Ringwald  * @brief Enable/Disable Advertisements
869845c102fdSMatthias Ringwald  * @param enabled
869945c102fdSMatthias Ringwald  */
870045c102fdSMatthias Ringwald void gap_advertisements_enable(int enabled){
8701a408e724SMatthias Ringwald     if (enabled == 0){
8702a408e724SMatthias Ringwald         hci_stack->le_advertisements_state &= ~LE_ADVERTISEMENT_STATE_ENABLED;
8703a408e724SMatthias Ringwald     } else {
8704a408e724SMatthias Ringwald         hci_stack->le_advertisements_state |= LE_ADVERTISEMENT_STATE_ENABLED;
8705a408e724SMatthias Ringwald     }
8706bbc366e6SMatthias Ringwald     hci_update_advertisements_enabled_for_current_roles();
8707cfc59f1bSMatthias Ringwald     hci_run();
870845c102fdSMatthias Ringwald }
870945c102fdSMatthias Ringwald 
8710a5770ecbSMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
8711a5770ecbSMatthias Ringwald static le_advertising_set_t * hci_advertising_set_for_handle(uint8_t advertising_handle){
8712a5770ecbSMatthias Ringwald     btstack_linked_list_iterator_t it;
8713a5770ecbSMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->le_advertising_sets);
8714a5770ecbSMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
8715a5770ecbSMatthias Ringwald         le_advertising_set_t * item = (le_advertising_set_t *) btstack_linked_list_iterator_next(&it);
8716a5770ecbSMatthias Ringwald         if ( item->advertising_handle == advertising_handle ) {
8717a5770ecbSMatthias Ringwald             return item;
8718a5770ecbSMatthias Ringwald         }
8719a5770ecbSMatthias Ringwald     }
8720a5770ecbSMatthias Ringwald     return NULL;
8721a5770ecbSMatthias Ringwald }
8722a5770ecbSMatthias Ringwald 
87232052d96cSMatthias Ringwald uint8_t gap_extended_advertising_set_resolvable_private_address_update(uint16_t update_s){
87242052d96cSMatthias Ringwald     hci_stack->le_resolvable_private_address_update_s = update_s;
87252052d96cSMatthias Ringwald     hci_run();
87262052d96cSMatthias Ringwald     return ERROR_CODE_SUCCESS;
87272052d96cSMatthias Ringwald }
87282052d96cSMatthias Ringwald 
8729a5770ecbSMatthias Ringwald uint8_t gap_extended_advertising_setup(le_advertising_set_t * storage, const le_extended_advertising_parameters_t * advertising_parameters, uint8_t * out_advertising_handle){
8730a5770ecbSMatthias Ringwald     // find free advertisement handle
8731a5770ecbSMatthias Ringwald     uint8_t advertisement_handle;
8732a5770ecbSMatthias Ringwald     for (advertisement_handle = 1; advertisement_handle <= LE_EXTENDED_ADVERTISING_MAX_HANDLE; advertisement_handle++){
8733a5770ecbSMatthias Ringwald         if (hci_advertising_set_for_handle(advertisement_handle) == NULL) break;
8734a5770ecbSMatthias Ringwald     }
8735a5770ecbSMatthias Ringwald     if (advertisement_handle > LE_EXTENDED_ADVERTISING_MAX_HANDLE) return ERROR_CODE_MEMORY_CAPACITY_EXCEEDED;
8736a5770ecbSMatthias Ringwald     // clear
8737a5770ecbSMatthias Ringwald     memset(storage, 0, sizeof(le_advertising_set_t));
8738a5770ecbSMatthias Ringwald     // copy params
87390cbe4690SMatthias Ringwald     storage->advertising_handle = advertisement_handle;
874057a04237SMatthias Ringwald     memcpy(&storage->extended_params, advertising_parameters, sizeof(le_extended_advertising_parameters_t));
8741a5770ecbSMatthias Ringwald     // add to list
8742a5770ecbSMatthias Ringwald     bool add_ok = btstack_linked_list_add(&hci_stack->le_advertising_sets, (btstack_linked_item_t *) storage);
8743a5770ecbSMatthias Ringwald     if (!add_ok) return ERROR_CODE_ACL_CONNECTION_ALREADY_EXISTS;
87440cbe4690SMatthias Ringwald     *out_advertising_handle = advertisement_handle;
8745a5770ecbSMatthias Ringwald     // set tasks and start
8746a5770ecbSMatthias Ringwald     storage->tasks = LE_ADVERTISEMENT_TASKS_SET_PARAMS;
8747a5770ecbSMatthias Ringwald     hci_run();
8748a5770ecbSMatthias Ringwald     return ERROR_CODE_SUCCESS;
8749a5770ecbSMatthias Ringwald }
8750a5770ecbSMatthias Ringwald 
8751a5770ecbSMatthias Ringwald uint8_t gap_extended_advertising_set_params(uint8_t advertising_handle, const le_extended_advertising_parameters_t * advertising_parameters){
8752a5770ecbSMatthias Ringwald     le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(advertising_handle);
8753a5770ecbSMatthias Ringwald     if (advertising_set == NULL) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
875457a04237SMatthias Ringwald     memcpy(&advertising_set->extended_params, advertising_parameters, sizeof(le_extended_advertising_parameters_t));
8755a5770ecbSMatthias Ringwald     // set tasks and start
8756a5770ecbSMatthias Ringwald     advertising_set->tasks |= LE_ADVERTISEMENT_TASKS_SET_PARAMS;
8757a5770ecbSMatthias Ringwald     hci_run();
8758a5770ecbSMatthias Ringwald     return ERROR_CODE_SUCCESS;
8759a5770ecbSMatthias Ringwald }
8760a5770ecbSMatthias Ringwald 
8761a5770ecbSMatthias Ringwald uint8_t gap_extended_advertising_get_params(uint8_t advertising_handle, le_extended_advertising_parameters_t * advertising_parameters){
8762a5770ecbSMatthias Ringwald     le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(advertising_handle);
8763a5770ecbSMatthias Ringwald     if (advertising_set == NULL) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
876457a04237SMatthias Ringwald     memcpy(advertising_parameters, &advertising_set->extended_params, sizeof(le_extended_advertising_parameters_t));
8765a5770ecbSMatthias Ringwald     return ERROR_CODE_SUCCESS;
8766a5770ecbSMatthias Ringwald }
8767a5770ecbSMatthias Ringwald 
8768a5770ecbSMatthias Ringwald uint8_t gap_extended_advertising_set_random_address(uint8_t advertising_handle, bd_addr_t random_address){
8769a5770ecbSMatthias Ringwald     le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(advertising_handle);
8770a5770ecbSMatthias Ringwald     if (advertising_set == NULL) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
8771a5770ecbSMatthias Ringwald     memcpy(advertising_set->random_address, random_address, 6);
8772a5770ecbSMatthias Ringwald     // set tasks and start
8773a5770ecbSMatthias Ringwald     advertising_set->tasks |= LE_ADVERTISEMENT_TASKS_SET_ADDRESS;
8774a5770ecbSMatthias Ringwald     hci_run();
8775a5770ecbSMatthias Ringwald     return ERROR_CODE_SUCCESS;
8776a5770ecbSMatthias Ringwald }
8777a5770ecbSMatthias Ringwald 
87782e4aaf70SMatthias Ringwald uint8_t gap_extended_advertising_set_adv_data(uint8_t advertising_handle, uint16_t advertising_data_length, const uint8_t * advertising_data){
8779a5770ecbSMatthias Ringwald     le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(advertising_handle);
8780a5770ecbSMatthias Ringwald     if (advertising_set == NULL) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
8781a5770ecbSMatthias Ringwald     advertising_set->adv_data = advertising_data;
8782a5770ecbSMatthias Ringwald     advertising_set->adv_data_len = advertising_data_length;
8783a5770ecbSMatthias Ringwald     // set tasks and start
8784a5770ecbSMatthias Ringwald     advertising_set->tasks |= LE_ADVERTISEMENT_TASKS_SET_ADV_DATA;
8785a5770ecbSMatthias Ringwald     hci_run();
8786a5770ecbSMatthias Ringwald     return ERROR_CODE_SUCCESS;
8787a5770ecbSMatthias Ringwald }
8788a5770ecbSMatthias Ringwald 
87892e4aaf70SMatthias Ringwald uint8_t gap_extended_advertising_set_scan_response_data(uint8_t advertising_handle, uint16_t scan_response_data_length, const uint8_t * scan_response_data){
8790a5770ecbSMatthias Ringwald     le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(advertising_handle);
8791a5770ecbSMatthias Ringwald     if (advertising_set == NULL) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
8792a5770ecbSMatthias Ringwald     advertising_set->scan_data = scan_response_data;
8793a5770ecbSMatthias Ringwald     advertising_set->scan_data_len = scan_response_data_length;
8794a5770ecbSMatthias Ringwald     // set tasks and start
8795a5770ecbSMatthias Ringwald     advertising_set->tasks |= LE_ADVERTISEMENT_TASKS_SET_SCAN_DATA;
8796a5770ecbSMatthias Ringwald     hci_run();
8797a5770ecbSMatthias Ringwald     return ERROR_CODE_SUCCESS;
8798a5770ecbSMatthias Ringwald }
8799a5770ecbSMatthias Ringwald 
8800a5770ecbSMatthias Ringwald uint8_t gap_extended_advertising_start(uint8_t advertising_handle, uint16_t timeout, uint8_t num_extended_advertising_events){
8801a5770ecbSMatthias Ringwald     le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(advertising_handle);
8802a5770ecbSMatthias Ringwald     if (advertising_set == NULL) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
8803a5770ecbSMatthias Ringwald     advertising_set->enable_timeout = timeout;
8804a5770ecbSMatthias Ringwald     advertising_set->enable_max_scan_events = num_extended_advertising_events;
8805a5770ecbSMatthias Ringwald     // set tasks and start
8806a5770ecbSMatthias Ringwald     advertising_set->state |= LE_ADVERTISEMENT_STATE_ENABLED;
8807a5770ecbSMatthias Ringwald     hci_run();
8808a5770ecbSMatthias Ringwald     return ERROR_CODE_SUCCESS;
8809a5770ecbSMatthias Ringwald }
8810a5770ecbSMatthias Ringwald 
8811a5770ecbSMatthias Ringwald uint8_t gap_extended_advertising_stop(uint8_t advertising_handle){
8812a5770ecbSMatthias Ringwald     le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(advertising_handle);
8813a5770ecbSMatthias Ringwald     if (advertising_set == NULL) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
8814a5770ecbSMatthias Ringwald     // set tasks and start
8815a5770ecbSMatthias Ringwald     advertising_set->state &= ~LE_ADVERTISEMENT_STATE_ENABLED;
8816a5770ecbSMatthias Ringwald     hci_run();
8817a5770ecbSMatthias Ringwald     return ERROR_CODE_SUCCESS;
8818a5770ecbSMatthias Ringwald }
8819a5770ecbSMatthias Ringwald 
8820c814a904SMatthias Ringwald uint8_t gap_extended_advertising_remove(uint8_t advertising_handle){
8821c814a904SMatthias Ringwald     le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(advertising_handle);
8822c814a904SMatthias Ringwald     if (advertising_set == NULL) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
8823c814a904SMatthias Ringwald     // set tasks and start
8824c814a904SMatthias Ringwald     advertising_set->tasks |= LE_ADVERTISEMENT_TASKS_REMOVE_SET;
8825c814a904SMatthias Ringwald     hci_run();
8826c814a904SMatthias Ringwald     return ERROR_CODE_SUCCESS;
8827c814a904SMatthias Ringwald }
8828c814a904SMatthias Ringwald 
8829c814a904SMatthias Ringwald #ifdef ENABLE_LE_PERIODIC_ADVERTISING
8830c814a904SMatthias Ringwald uint8_t gap_periodic_advertising_set_params(uint8_t advertising_handle, const le_periodic_advertising_parameters_t * advertising_parameters){
8831c814a904SMatthias Ringwald     le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(advertising_handle);
8832c814a904SMatthias Ringwald     if (advertising_set == NULL) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
8833c814a904SMatthias Ringwald     // periodic advertising requires neither connectable, scannable, legacy or anonymous
8834c814a904SMatthias Ringwald     if ((advertising_set->extended_params.advertising_event_properties & 0x1f) != 0) return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS;
8835c814a904SMatthias Ringwald     memcpy(&advertising_set->periodic_params, advertising_parameters, sizeof(le_periodic_advertising_parameters_t));
8836c814a904SMatthias Ringwald     // set tasks and start
8837c814a904SMatthias Ringwald     advertising_set->tasks |= LE_ADVERTISEMENT_TASKS_SET_PERIODIC_PARAMS;
8838c814a904SMatthias Ringwald     hci_run();
8839c814a904SMatthias Ringwald     return ERROR_CODE_SUCCESS;
8840c814a904SMatthias Ringwald }
8841c814a904SMatthias Ringwald 
8842c814a904SMatthias Ringwald uint8_t gap_periodic_advertising_get_params(uint8_t advertising_handle, le_periodic_advertising_parameters_t * advertising_parameters){
8843c814a904SMatthias Ringwald     le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(advertising_handle);
8844c814a904SMatthias Ringwald     if (advertising_set == NULL) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
8845c814a904SMatthias Ringwald     memcpy(advertising_parameters, &advertising_set->extended_params, sizeof(le_periodic_advertising_parameters_t));
8846c814a904SMatthias Ringwald     return ERROR_CODE_SUCCESS;
8847c814a904SMatthias Ringwald }
8848c814a904SMatthias Ringwald 
8849c814a904SMatthias Ringwald uint8_t gap_periodic_advertising_set_data(uint8_t advertising_handle, uint16_t periodic_data_length, const uint8_t * periodic_data){
8850c814a904SMatthias Ringwald     le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(advertising_handle);
8851c814a904SMatthias Ringwald     if (advertising_set == NULL) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
8852c814a904SMatthias Ringwald     advertising_set->periodic_data = periodic_data;
8853c814a904SMatthias Ringwald     advertising_set->periodic_data_len = periodic_data_length;
8854c814a904SMatthias Ringwald     // set tasks and start
8855c814a904SMatthias Ringwald     advertising_set->tasks |= LE_ADVERTISEMENT_TASKS_SET_PERIODIC_DATA;
8856c814a904SMatthias Ringwald     hci_run();
8857c814a904SMatthias Ringwald     return ERROR_CODE_SUCCESS;
8858c814a904SMatthias Ringwald }
8859c814a904SMatthias Ringwald 
886053f240c0SMatthias Ringwald uint8_t gap_periodic_advertising_start(uint8_t advertising_handle, bool include_adi){
886153f240c0SMatthias Ringwald     le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(advertising_handle);
886253f240c0SMatthias Ringwald     if (advertising_set == NULL) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
886353f240c0SMatthias Ringwald     // set tasks and start
886453f240c0SMatthias Ringwald     advertising_set->periodic_include_adi = include_adi;
886553f240c0SMatthias Ringwald     advertising_set->state |= LE_ADVERTISEMENT_STATE_PERIODIC_ENABLED;
886653f240c0SMatthias Ringwald     hci_run();
886753f240c0SMatthias Ringwald     return ERROR_CODE_SUCCESS;
886853f240c0SMatthias Ringwald }
886953f240c0SMatthias Ringwald 
887053f240c0SMatthias Ringwald uint8_t gap_periodic_advertising_stop(uint8_t advertising_handle){
887153f240c0SMatthias Ringwald     le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(advertising_handle);
887253f240c0SMatthias Ringwald     if (advertising_set == NULL) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
887353f240c0SMatthias Ringwald     // set tasks and start
887453f240c0SMatthias Ringwald     advertising_set->state &= ~LE_ADVERTISEMENT_STATE_PERIODIC_ENABLED;
887553f240c0SMatthias Ringwald     hci_run();
887653f240c0SMatthias Ringwald     return ERROR_CODE_SUCCESS;
887753f240c0SMatthias Ringwald }
887898aa715fSMatthias Ringwald 
887998aa715fSMatthias Ringwald uint8_t gap_periodic_advertising_sync_transfer_set_default_parameters(uint8_t mode, uint16_t skip, uint16_t sync_timeout, uint8_t cte_type){
888098aa715fSMatthias Ringwald     hci_stack->le_past_mode = mode;
888198aa715fSMatthias Ringwald     hci_stack->le_past_skip = skip;
888298aa715fSMatthias Ringwald     hci_stack->le_past_sync_timeout = sync_timeout;
888398aa715fSMatthias Ringwald     hci_stack->le_past_cte_type = cte_type;
888498aa715fSMatthias Ringwald     hci_stack->le_past_set_default_params = true;
888598aa715fSMatthias Ringwald     hci_run();
888698aa715fSMatthias Ringwald     return ERROR_CODE_SUCCESS;
888798aa715fSMatthias Ringwald }
888898aa715fSMatthias Ringwald 
88893bd96807SMatthias Ringwald uint8_t gap_periodic_advertising_sync_transfer_send(hci_con_handle_t con_handle, uint16_t service_data, hci_con_handle_t sync_handle){
88903bd96807SMatthias Ringwald     hci_connection_t * hci_connection = hci_connection_for_handle(con_handle);
88913bd96807SMatthias Ringwald     if (hci_connection == NULL){
88923bd96807SMatthias Ringwald         return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
88933bd96807SMatthias Ringwald     }
88943bd96807SMatthias Ringwald     hci_connection->le_past_sync_handle = sync_handle;
88953bd96807SMatthias Ringwald     hci_connection->le_past_service_data = service_data;
88963bd96807SMatthias Ringwald     hci_run();
88973bd96807SMatthias Ringwald     return ERROR_CODE_SUCCESS;
88983bd96807SMatthias Ringwald }
88993bd96807SMatthias Ringwald 
8900027f4677SMatthias Ringwald uint8_t gap_periodic_advertising_set_info_transfer_send(hci_con_handle_t con_handle, uint16_t service_data, uint8_t advertising_handle){
8901027f4677SMatthias Ringwald     hci_connection_t * hci_connection = hci_connection_for_handle(con_handle);
8902027f4677SMatthias Ringwald     if (hci_connection == NULL){
8903027f4677SMatthias Ringwald         return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
8904027f4677SMatthias Ringwald     }
8905027f4677SMatthias Ringwald     hci_connection->le_past_advertising_handle = advertising_handle;
8906027f4677SMatthias Ringwald     hci_connection->le_past_service_data = service_data;
8907027f4677SMatthias Ringwald     hci_run();
8908027f4677SMatthias Ringwald     return ERROR_CODE_SUCCESS;
8909027f4677SMatthias Ringwald }
8910027f4677SMatthias Ringwald 
8911c814a904SMatthias Ringwald #endif /* ENABLE_LE_PERIODIC_ADVERTISING */
891253f240c0SMatthias Ringwald 
8913a5770ecbSMatthias Ringwald #endif
8914a5770ecbSMatthias Ringwald 
891535454696SMatthias Ringwald #endif
891606e5cf96SMatthias Ringwald 
891706e5cf96SMatthias Ringwald void hci_le_set_own_address_type(uint8_t own_address_type){
891806e5cf96SMatthias Ringwald     log_info("hci_le_set_own_address_type: old %u, new %u", hci_stack->le_own_addr_type, own_address_type);
891906e5cf96SMatthias Ringwald     if (own_address_type == hci_stack->le_own_addr_type) return;
892006e5cf96SMatthias Ringwald     hci_stack->le_own_addr_type = own_address_type;
892106e5cf96SMatthias Ringwald 
892264068776SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
892306e5cf96SMatthias Ringwald     // update advertisement parameters, too
892406e5cf96SMatthias Ringwald     hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_SET_PARAMS;
8925bbc366e6SMatthias Ringwald     hci_run();
892664068776SMatthias Ringwald #endif
892764068776SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
892806e5cf96SMatthias Ringwald     // note: we don't update scan parameters or modify ongoing connection attempts
892964068776SMatthias Ringwald #endif
893006e5cf96SMatthias Ringwald }
893106e5cf96SMatthias Ringwald 
89329136bde8SMatthias Ringwald void hci_le_random_address_set(const bd_addr_t random_address){
8933137a570aSMatthias Ringwald     log_info("gap_privacy: hci_le_random_address_set %s", bd_addr_to_str(random_address));
89349136bde8SMatthias Ringwald     memcpy(hci_stack->le_random_address, random_address, 6);
89359136bde8SMatthias Ringwald     hci_stack->le_random_address_set = true;
8936137a570aSMatthias Ringwald     hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_SET_ADDRESS | LE_ADVERTISEMENT_TASKS_PRIVACY_NOTIFY;
89379ce6dfa1SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
893822f987e4SMatthias Ringwald     if (hci_le_extended_advertising_supported()){
89395e05c0afSMatthias Ringwald         hci_assert_advertisement_set_0_ready();
89409ce6dfa1SMatthias Ringwald         hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_SET_ADDRESS_SET_0;
89419ce6dfa1SMatthias Ringwald     }
89429ce6dfa1SMatthias Ringwald #endif
89439136bde8SMatthias Ringwald     hci_run();
89449136bde8SMatthias Ringwald }
89459136bde8SMatthias Ringwald 
8946d70217a2SMatthias Ringwald #endif
894745c102fdSMatthias Ringwald 
8948616edd56SMatthias Ringwald uint8_t gap_disconnect(hci_con_handle_t handle){
89495917a5c5S[email protected]     hci_connection_t * conn = hci_connection_for_handle(handle);
89505917a5c5S[email protected]     if (!conn){
89517851196eSmatthias.ringwald         hci_emit_disconnection_complete(handle, 0);
8952616edd56SMatthias Ringwald         return 0;
89535917a5c5S[email protected]     }
89547fd7aa6fSMatthias Ringwald     // ignore if already disconnected
89557fd7aa6fSMatthias Ringwald     if (conn->state == RECEIVED_DISCONNECTION_COMPLETE){
89567fd7aa6fSMatthias Ringwald         return 0;
89577fd7aa6fSMatthias Ringwald     }
89585917a5c5S[email protected]     conn->state = SEND_DISCONNECT;
89595917a5c5S[email protected]     hci_run();
8960616edd56SMatthias Ringwald     return 0;
89614f3229d8S[email protected] }
896204a6ef8cSmatthias.ringwald 
8963228e430cSMatthias Ringwald int gap_read_rssi(hci_con_handle_t con_handle){
8964228e430cSMatthias Ringwald     hci_connection_t * hci_connection = hci_connection_for_handle(con_handle);
8965228e430cSMatthias Ringwald     if (hci_connection == NULL) return 0;
896622df2fe2SMatthias Ringwald     hci_connection->gap_connection_tasks |= GAP_CONNECTION_TASK_READ_RSSI;
8967228e430cSMatthias Ringwald     hci_run();
8968228e430cSMatthias Ringwald     return 1;
8969228e430cSMatthias Ringwald }
8970228e430cSMatthias Ringwald 
8971a1bf5ae7SMatthias Ringwald /**
8972a1bf5ae7SMatthias Ringwald  * @brief Get connection type
8973a1bf5ae7SMatthias Ringwald  * @param con_handle
8974a1bf5ae7SMatthias Ringwald  * @result connection_type
8975a1bf5ae7SMatthias Ringwald  */
8976a1bf5ae7SMatthias Ringwald gap_connection_type_t gap_get_connection_type(hci_con_handle_t connection_handle){
8977a1bf5ae7SMatthias Ringwald     hci_connection_t * conn = hci_connection_for_handle(connection_handle);
8978a1bf5ae7SMatthias Ringwald     if (!conn) return GAP_CONNECTION_INVALID;
8979a1bf5ae7SMatthias Ringwald     switch (conn->address_type){
8980a1bf5ae7SMatthias Ringwald         case BD_ADDR_TYPE_LE_PUBLIC:
8981a1bf5ae7SMatthias Ringwald         case BD_ADDR_TYPE_LE_RANDOM:
8982ad9f3530SMatthias Ringwald         case BD_ADDR_TYPE_LE_PUBLIC_IDENTITY:
8983ad9f3530SMatthias Ringwald         case BD_ADDR_TYPE_LE_RANDOM_IDENTITY:
8984a1bf5ae7SMatthias Ringwald             return GAP_CONNECTION_LE;
8985a1bf5ae7SMatthias Ringwald         case BD_ADDR_TYPE_SCO:
8986a1bf5ae7SMatthias Ringwald             return GAP_CONNECTION_SCO;
8987f16129ceSMatthias Ringwald         case BD_ADDR_TYPE_ACL:
8988a1bf5ae7SMatthias Ringwald             return GAP_CONNECTION_ACL;
8989a1bf5ae7SMatthias Ringwald         default:
8990a1bf5ae7SMatthias Ringwald             return GAP_CONNECTION_INVALID;
8991a1bf5ae7SMatthias Ringwald     }
8992a1bf5ae7SMatthias Ringwald }
8993a1bf5ae7SMatthias Ringwald 
89942dceb1d6SMatthias Ringwald hci_role_t gap_get_role(hci_con_handle_t connection_handle){
89952dceb1d6SMatthias Ringwald     hci_connection_t * conn = hci_connection_for_handle(connection_handle);
89962dceb1d6SMatthias Ringwald     if (!conn) return HCI_ROLE_INVALID;
89972dceb1d6SMatthias Ringwald     return (hci_role_t) conn->role;
89982dceb1d6SMatthias Ringwald }
89992dceb1d6SMatthias Ringwald 
90002dceb1d6SMatthias Ringwald 
900144f858f3SMatthias Ringwald #ifdef ENABLE_CLASSIC
9002667ba9d1SMatthias Ringwald uint8_t gap_request_role(const bd_addr_t addr, hci_role_t role){
900388a03c8dSMatthias Ringwald     hci_connection_t * conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL);
900488a03c8dSMatthias Ringwald     if (!conn) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
900588a03c8dSMatthias Ringwald     conn->request_role = role;
900688a03c8dSMatthias Ringwald     hci_run();
9007d04a455eSMatthias Ringwald     return ERROR_CODE_SUCCESS;
900888a03c8dSMatthias Ringwald }
900944f858f3SMatthias Ringwald #endif
901088a03c8dSMatthias Ringwald 
9011a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE
90124f551432SMatthias Ringwald 
90139d8be771SMatthias Ringwald uint8_t gap_le_set_phy(hci_con_handle_t con_handle, uint8_t all_phys, uint8_t tx_phys, uint8_t rx_phys, uint16_t phy_options){
9014b45b7749SMilanka Ringwald     hci_connection_t * conn = hci_connection_for_handle(con_handle);
9015b90f6e0aSMatthias Ringwald     if (!conn) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
9016b90f6e0aSMatthias Ringwald 
9017b90f6e0aSMatthias Ringwald     conn->le_phy_update_all_phys    = all_phys;
9018b90f6e0aSMatthias Ringwald     conn->le_phy_update_tx_phys     = tx_phys;
9019b90f6e0aSMatthias Ringwald     conn->le_phy_update_rx_phys     = rx_phys;
90209d8be771SMatthias Ringwald     conn->le_phy_update_phy_options = (uint8_t) phy_options;
9021b90f6e0aSMatthias Ringwald 
9022b90f6e0aSMatthias Ringwald     hci_run();
9023b90f6e0aSMatthias Ringwald 
9024b90f6e0aSMatthias Ringwald     return 0;
9025b90f6e0aSMatthias Ringwald }
9026b90f6e0aSMatthias Ringwald 
9027667ba9d1SMatthias Ringwald static uint8_t hci_whitelist_add(bd_addr_type_t address_type, const bd_addr_t address){
9028100da355SMatthias Ringwald 
9029100da355SMatthias Ringwald #if !defined(HAVE_MALLOC) && (!defined(MAX_NR_WHITELIST_ENTRIES) || (MAX_NR_WHITELIST_ENTRIES == 0))
9030100da355SMatthias Ringwald     // incorrect configuration:
9031100da355SMatthias Ringwald     // - as MAX_NR_WHITELIST_ENTRIES is not defined or zero this function always fails
9032100da355SMatthias Ringwald     // - please set MAX_NR_WHITELIST_ENTRIES in btstack_config.h
9033100da355SMatthias Ringwald     btstack_assert(false);
9034100da355SMatthias Ringwald #endif
9035100da355SMatthias Ringwald 
90367a92a9dbSMatthias Ringwald     // check if already in list
90377a92a9dbSMatthias Ringwald     btstack_linked_list_iterator_t it;
90387a92a9dbSMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->le_whitelist);
90397a92a9dbSMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)) {
90407a92a9dbSMatthias Ringwald         whitelist_entry_t *entry = (whitelist_entry_t *) btstack_linked_list_iterator_next(&it);
90417a92a9dbSMatthias Ringwald         if (entry->address_type != address_type) {
90427a92a9dbSMatthias Ringwald             continue;
90437a92a9dbSMatthias Ringwald         }
90447a92a9dbSMatthias Ringwald         if (memcmp(entry->address, address, 6) != 0) {
90457a92a9dbSMatthias Ringwald             continue;
90467a92a9dbSMatthias Ringwald         }
9047caaf5151SMilanka Ringwald 
9048caaf5151SMilanka Ringwald         // if already on controller:
9049caaf5151SMilanka Ringwald         if ((entry->state & LE_WHITELIST_ON_CONTROLLER) != 0){
9050caaf5151SMilanka Ringwald             if ((entry->state & LE_WHITELIST_REMOVE_FROM_CONTROLLER) != 0){
9051caaf5151SMilanka Ringwald                 // drop remove request
9052caaf5151SMilanka Ringwald                 entry->state = LE_WHITELIST_ON_CONTROLLER;
9053caaf5151SMilanka Ringwald                 return ERROR_CODE_SUCCESS;
9054caaf5151SMilanka Ringwald             } else {
9055caaf5151SMilanka Ringwald                 // disallow as already on controller
90567a92a9dbSMatthias Ringwald                 return ERROR_CODE_COMMAND_DISALLOWED;
90577a92a9dbSMatthias Ringwald             }
9058287379ccSMatthias Ringwald         }
9059caaf5151SMilanka Ringwald 
9060caaf5151SMilanka Ringwald         // assume scheduled to add
9061caaf5151SMilanka Ringwald 		return ERROR_CODE_COMMAND_DISALLOWED;
9062caaf5151SMilanka Ringwald     }
9063caaf5151SMilanka Ringwald 
90647a92a9dbSMatthias Ringwald     // alloc and add to list
9065e83201bcSMatthias Ringwald     whitelist_entry_t * entry = btstack_memory_whitelist_entry_get();
9066e83201bcSMatthias Ringwald     if (!entry) return BTSTACK_MEMORY_ALLOC_FAILED;
9067e83201bcSMatthias Ringwald     entry->address_type = address_type;
90686535961aSMatthias Ringwald     (void)memcpy(entry->address, address, 6);
9069e83201bcSMatthias Ringwald     entry->state = LE_WHITELIST_ADD_TO_CONTROLLER;
9070665d90f2SMatthias Ringwald     btstack_linked_list_add(&hci_stack->le_whitelist, (btstack_linked_item_t*) entry);
9071226db5efSMatthias Ringwald     return ERROR_CODE_SUCCESS;
9072ac9c45e0SMatthias Ringwald }
9073ac9c45e0SMatthias Ringwald 
9074667ba9d1SMatthias Ringwald static uint8_t hci_whitelist_remove(bd_addr_type_t address_type, const bd_addr_t address){
9075665d90f2SMatthias Ringwald     btstack_linked_list_iterator_t it;
9076665d90f2SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->le_whitelist);
9077665d90f2SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
9078665d90f2SMatthias Ringwald         whitelist_entry_t * entry = (whitelist_entry_t*) btstack_linked_list_iterator_next(&it);
90797a92a9dbSMatthias Ringwald         if (entry->address_type != address_type) {
90807a92a9dbSMatthias Ringwald             continue;
90817a92a9dbSMatthias Ringwald         }
90827a92a9dbSMatthias Ringwald         if (memcmp(entry->address, address, 6) != 0) {
90837a92a9dbSMatthias Ringwald             continue;
90847a92a9dbSMatthias Ringwald         }
9085e83201bcSMatthias Ringwald         if (entry->state & LE_WHITELIST_ON_CONTROLLER){
9086e83201bcSMatthias Ringwald             // remove from controller if already present
9087e83201bcSMatthias Ringwald             entry->state |= LE_WHITELIST_REMOVE_FROM_CONTROLLER;
9088a3b69fdeSMatthias Ringwald         }  else {
9089226db5efSMatthias Ringwald             // directly remove entry from whitelist
9090665d90f2SMatthias Ringwald             btstack_linked_list_iterator_remove(&it);
9091e83201bcSMatthias Ringwald             btstack_memory_whitelist_entry_free(entry);
9092e83201bcSMatthias Ringwald         }
9093a3b69fdeSMatthias Ringwald         return ERROR_CODE_SUCCESS;
9094a3b69fdeSMatthias Ringwald     }
9095a3b69fdeSMatthias Ringwald     return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
909642ff5ba1SMatthias Ringwald }
909742ff5ba1SMatthias Ringwald 
9098226db5efSMatthias Ringwald static void hci_whitelist_clear(void){
9099665d90f2SMatthias Ringwald     btstack_linked_list_iterator_t it;
9100665d90f2SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->le_whitelist);
9101665d90f2SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
9102665d90f2SMatthias Ringwald         whitelist_entry_t * entry = (whitelist_entry_t*) btstack_linked_list_iterator_next(&it);
9103e83201bcSMatthias Ringwald         if (entry->state & LE_WHITELIST_ON_CONTROLLER){
9104e83201bcSMatthias Ringwald             // remove from controller if already present
9105e83201bcSMatthias Ringwald             entry->state |= LE_WHITELIST_REMOVE_FROM_CONTROLLER;
9106e83201bcSMatthias Ringwald             continue;
9107e83201bcSMatthias Ringwald         }
910891915b0bSMatthias Ringwald         // directly remove entry from whitelist
9109665d90f2SMatthias Ringwald         btstack_linked_list_iterator_remove(&it);
9110e83201bcSMatthias Ringwald         btstack_memory_whitelist_entry_free(entry);
9111e83201bcSMatthias Ringwald     }
9112226db5efSMatthias Ringwald }
9113226db5efSMatthias Ringwald 
9114a3b69fdeSMatthias Ringwald /**
9115a3b69fdeSMatthias Ringwald  * @brief Clear Whitelist
91166b65794dSMilanka Ringwald  * @return 0 if ok
9117a3b69fdeSMatthias Ringwald  */
9118a3b69fdeSMatthias Ringwald uint8_t gap_whitelist_clear(void){
9119a3b69fdeSMatthias Ringwald     hci_whitelist_clear();
9120a3b69fdeSMatthias Ringwald     hci_run();
9121a3b69fdeSMatthias Ringwald     return ERROR_CODE_SUCCESS;
9122a3b69fdeSMatthias Ringwald }
9123a3b69fdeSMatthias Ringwald 
9124a3b69fdeSMatthias Ringwald /**
9125a3b69fdeSMatthias Ringwald  * @brief Add Device to Whitelist
9126a3b69fdeSMatthias Ringwald  * @param address_typ
9127a3b69fdeSMatthias Ringwald  * @param address
91286b65794dSMilanka Ringwald  * @return 0 if ok
9129a3b69fdeSMatthias Ringwald  */
9130667ba9d1SMatthias Ringwald uint8_t gap_whitelist_add(bd_addr_type_t address_type, const bd_addr_t address){
9131a3b69fdeSMatthias Ringwald     uint8_t status = hci_whitelist_add(address_type, address);
9132a3b69fdeSMatthias Ringwald     if (status){
9133a3b69fdeSMatthias Ringwald         return status;
9134a3b69fdeSMatthias Ringwald     }
9135a3b69fdeSMatthias Ringwald     hci_run();
9136a3b69fdeSMatthias Ringwald     return ERROR_CODE_SUCCESS;
9137a3b69fdeSMatthias Ringwald }
9138a3b69fdeSMatthias Ringwald 
9139a3b69fdeSMatthias Ringwald /**
9140a3b69fdeSMatthias Ringwald  * @brief Remove Device from Whitelist
9141a3b69fdeSMatthias Ringwald  * @param address_typ
9142a3b69fdeSMatthias Ringwald  * @param address
91436b65794dSMilanka Ringwald  * @return 0 if ok
9144a3b69fdeSMatthias Ringwald  */
9145667ba9d1SMatthias Ringwald uint8_t gap_whitelist_remove(bd_addr_type_t address_type, const bd_addr_t address){
9146a3b69fdeSMatthias Ringwald     uint8_t status = hci_whitelist_remove(address_type, address);
9147a3b69fdeSMatthias Ringwald     if (status){
9148a3b69fdeSMatthias Ringwald         return status;
9149a3b69fdeSMatthias Ringwald     }
9150a3b69fdeSMatthias Ringwald     hci_run();
9151a3b69fdeSMatthias Ringwald     return ERROR_CODE_SUCCESS;
9152a3b69fdeSMatthias Ringwald }
9153a3b69fdeSMatthias Ringwald 
9154226db5efSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
9155226db5efSMatthias Ringwald /**
915695e257d9SMatthias Ringwald  * @brief Connect with Whitelist
915795e257d9SMatthias Ringwald  * @note Explicit whitelist management and this connect with whitelist replace deprecated gap_auto_connection_* functions
91586b65794dSMilanka Ringwald  * @return - if ok
915995e257d9SMatthias Ringwald  */
916095e257d9SMatthias Ringwald uint8_t gap_connect_with_whitelist(void){
916195e257d9SMatthias Ringwald     if (hci_stack->le_connecting_request != LE_CONNECTING_IDLE){
916295e257d9SMatthias Ringwald         return ERROR_CODE_COMMAND_DISALLOWED;
916395e257d9SMatthias Ringwald     }
916495e257d9SMatthias Ringwald     hci_stack->le_connecting_request = LE_CONNECTING_WHITELIST;
916595e257d9SMatthias Ringwald     hci_run();
916695e257d9SMatthias Ringwald     return ERROR_CODE_SUCCESS;
916795e257d9SMatthias Ringwald }
916895e257d9SMatthias Ringwald 
916995e257d9SMatthias Ringwald /**
9170226db5efSMatthias Ringwald  * @brief Auto Connection Establishment - Start Connecting to device
9171226db5efSMatthias Ringwald  * @param address_typ
9172226db5efSMatthias Ringwald  * @param address
91736b65794dSMilanka Ringwald  * @return 0 if ok
9174226db5efSMatthias Ringwald  */
9175667ba9d1SMatthias Ringwald uint8_t gap_auto_connection_start(bd_addr_type_t address_type, const bd_addr_t address){
917695e257d9SMatthias Ringwald     if (hci_stack->le_connecting_request == LE_CONNECTING_DIRECT){
9177226db5efSMatthias Ringwald         return ERROR_CODE_COMMAND_DISALLOWED;
9178226db5efSMatthias Ringwald     }
9179226db5efSMatthias Ringwald 
9180226db5efSMatthias Ringwald     uint8_t status = hci_whitelist_add(address_type, address);
918163f2efc9SMatthias Ringwald     if (status == BTSTACK_MEMORY_ALLOC_FAILED) {
9182226db5efSMatthias Ringwald         return status;
9183226db5efSMatthias Ringwald     }
9184226db5efSMatthias Ringwald 
9185226db5efSMatthias Ringwald     hci_stack->le_connecting_request = LE_CONNECTING_WHITELIST;
9186226db5efSMatthias Ringwald 
9187226db5efSMatthias Ringwald     hci_run();
918895e257d9SMatthias Ringwald     return ERROR_CODE_SUCCESS;
9189226db5efSMatthias Ringwald }
9190226db5efSMatthias Ringwald 
9191226db5efSMatthias Ringwald /**
9192226db5efSMatthias Ringwald  * @brief Auto Connection Establishment - Stop Connecting to device
9193226db5efSMatthias Ringwald  * @param address_typ
9194226db5efSMatthias Ringwald  * @param address
91956b65794dSMilanka Ringwald  * @return 0 if ok
9196226db5efSMatthias Ringwald  */
9197667ba9d1SMatthias Ringwald uint8_t gap_auto_connection_stop(bd_addr_type_t address_type, const bd_addr_t address){
919895e257d9SMatthias Ringwald     if (hci_stack->le_connecting_request == LE_CONNECTING_DIRECT){
919995e257d9SMatthias Ringwald         return ERROR_CODE_COMMAND_DISALLOWED;
920095e257d9SMatthias Ringwald     }
920195e257d9SMatthias Ringwald 
9202226db5efSMatthias Ringwald     hci_whitelist_remove(address_type, address);
920395e257d9SMatthias Ringwald     if (btstack_linked_list_empty(&hci_stack->le_whitelist)){
920495e257d9SMatthias Ringwald         hci_stack->le_connecting_request = LE_CONNECTING_IDLE;
920595e257d9SMatthias Ringwald     }
9206226db5efSMatthias Ringwald     hci_run();
9207226db5efSMatthias Ringwald     return 0;
9208226db5efSMatthias Ringwald }
9209226db5efSMatthias Ringwald 
9210226db5efSMatthias Ringwald /**
9211226db5efSMatthias Ringwald  * @brief Auto Connection Establishment - Stop everything
9212226db5efSMatthias Ringwald  * @note  Convenience function to stop all active auto connection attempts
9213226db5efSMatthias Ringwald  */
921495e257d9SMatthias Ringwald uint8_t gap_auto_connection_stop_all(void){
921595e257d9SMatthias Ringwald     if (hci_stack->le_connecting_request == LE_CONNECTING_DIRECT) {
921695e257d9SMatthias Ringwald         return ERROR_CODE_COMMAND_DISALLOWED;
921795e257d9SMatthias Ringwald     }
9218226db5efSMatthias Ringwald     hci_whitelist_clear();
9219226db5efSMatthias Ringwald     hci_stack->le_connecting_request = LE_CONNECTING_IDLE;
9220e83201bcSMatthias Ringwald     hci_run();
922195e257d9SMatthias Ringwald     return ERROR_CODE_SUCCESS;
9222ac9c45e0SMatthias Ringwald }
9223c9db5c21SMilanka Ringwald 
9224b45b7749SMilanka Ringwald uint16_t gap_le_connection_interval(hci_con_handle_t con_handle){
9225b45b7749SMilanka Ringwald     hci_connection_t * conn = hci_connection_for_handle(con_handle);
9226c9db5c21SMilanka Ringwald     if (!conn) return 0;
9227c9db5c21SMilanka Ringwald     return conn->le_connection_interval;
9228c9db5c21SMilanka Ringwald }
9229d70217a2SMatthias Ringwald #endif
92304f551432SMatthias Ringwald #endif
92314f551432SMatthias Ringwald 
923235454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
9233ac9c45e0SMatthias Ringwald /**
9234ff00ed1cSMatthias Ringwald  * @brief Set Extended Inquiry Response data
9235a8c4e5adSMatthias Ringwald  * @param eir_data size HCI_EXTENDED_INQUIRY_RESPONSE_DATA_LEN (240) bytes, is not copied make sure memory is accessible during stack startup
9236ff00ed1cSMatthias Ringwald  * @note has to be done before stack starts up
9237ff00ed1cSMatthias Ringwald  */
9238ff00ed1cSMatthias Ringwald void gap_set_extended_inquiry_response(const uint8_t * data){
9239ff00ed1cSMatthias Ringwald     hci_stack->eir_data = data;
9240baa4881eSMatthias Ringwald     hci_stack->gap_tasks_classic |= GAP_TASK_SET_EIR_DATA;
924159d59ecfSMatthias Ringwald     hci_run();
9242ff00ed1cSMatthias Ringwald }
9243ff00ed1cSMatthias Ringwald 
9244ff00ed1cSMatthias Ringwald /**
9245f5875de5SMatthias Ringwald  * @brief Start GAP Classic Inquiry
9246f5875de5SMatthias Ringwald  * @param duration in 1.28s units
9247f5875de5SMatthias Ringwald  * @return 0 if ok
9248f5875de5SMatthias Ringwald  * @events: GAP_EVENT_INQUIRY_RESULT, GAP_EVENT_INQUIRY_COMPLETE
9249f5875de5SMatthias Ringwald  */
9250f5875de5SMatthias Ringwald int gap_inquiry_start(uint8_t duration_in_1280ms_units){
925199449554SMatthias Ringwald     if (hci_stack->state != HCI_STATE_WORKING) return ERROR_CODE_COMMAND_DISALLOWED;
9252f5875de5SMatthias Ringwald     if (hci_stack->inquiry_state != GAP_INQUIRY_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED;
9253a1df452eSMatthias Ringwald     if ((duration_in_1280ms_units < GAP_INQUIRY_DURATION_MIN) || (duration_in_1280ms_units > GAP_INQUIRY_DURATION_MAX)){
9254f5875de5SMatthias Ringwald         return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS;
9255f5875de5SMatthias Ringwald     }
9256f5875de5SMatthias Ringwald     hci_stack->inquiry_state = duration_in_1280ms_units;
925730199e24SMatthias Ringwald     hci_stack->inquiry_max_period_length = 0;
925830199e24SMatthias Ringwald     hci_stack->inquiry_min_period_length = 0;
925930199e24SMatthias Ringwald     hci_run();
926030199e24SMatthias Ringwald     return 0;
926130199e24SMatthias Ringwald }
926230199e24SMatthias Ringwald 
926330199e24SMatthias Ringwald uint8_t gap_inquiry_periodic_start(uint8_t duration, uint16_t max_period_length, uint16_t min_period_length){
926430199e24SMatthias Ringwald     if (hci_stack->state != HCI_STATE_WORKING)                return ERROR_CODE_COMMAND_DISALLOWED;
926530199e24SMatthias Ringwald     if (hci_stack->inquiry_state != GAP_INQUIRY_STATE_IDLE)   return ERROR_CODE_COMMAND_DISALLOWED;
926630199e24SMatthias Ringwald     if (duration < GAP_INQUIRY_DURATION_MIN)                  return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS;
926730199e24SMatthias Ringwald     if (duration > GAP_INQUIRY_DURATION_MAX)                  return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS;
926830199e24SMatthias Ringwald     if (max_period_length < GAP_INQUIRY_MAX_PERIODIC_LEN_MIN) return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS;;
926930199e24SMatthias Ringwald     if (min_period_length < GAP_INQUIRY_MIN_PERIODIC_LEN_MIN) return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS;;
927030199e24SMatthias Ringwald 
927130199e24SMatthias Ringwald     hci_stack->inquiry_state = duration;
927230199e24SMatthias Ringwald     hci_stack->inquiry_max_period_length = max_period_length;
927330199e24SMatthias Ringwald     hci_stack->inquiry_min_period_length = min_period_length;
9274f5875de5SMatthias Ringwald     hci_run();
9275f5875de5SMatthias Ringwald     return 0;
9276f5875de5SMatthias Ringwald }
9277f5875de5SMatthias Ringwald 
9278f5875de5SMatthias Ringwald /**
9279f5875de5SMatthias Ringwald  * @brief Stop GAP Classic Inquiry
92806b65794dSMilanka Ringwald  * @return 0 if ok
9281f5875de5SMatthias Ringwald  */
9282f5875de5SMatthias Ringwald int gap_inquiry_stop(void){
9283a1df452eSMatthias Ringwald     if ((hci_stack->inquiry_state >= GAP_INQUIRY_DURATION_MIN) && (hci_stack->inquiry_state <= GAP_INQUIRY_DURATION_MAX)) {
9284f5875de5SMatthias Ringwald         // emit inquiry complete event, before it even started
9285f5875de5SMatthias Ringwald         uint8_t event[] = { GAP_EVENT_INQUIRY_COMPLETE, 1, 0};
9286f5875de5SMatthias Ringwald         hci_emit_event(event, sizeof(event), 1);
9287f5875de5SMatthias Ringwald         return 0;
9288f5875de5SMatthias Ringwald     }
928930199e24SMatthias Ringwald     switch (hci_stack->inquiry_state){
929030199e24SMatthias Ringwald         case GAP_INQUIRY_STATE_ACTIVE:
9291f5875de5SMatthias Ringwald             hci_stack->inquiry_state = GAP_INQUIRY_STATE_W2_CANCEL;
9292f5875de5SMatthias Ringwald             hci_run();
929330199e24SMatthias Ringwald             return ERROR_CODE_SUCCESS;
929430199e24SMatthias Ringwald         case GAP_INQUIRY_STATE_PERIODIC:
929530199e24SMatthias Ringwald             hci_stack->inquiry_state = GAP_INQUIRY_STATE_W2_EXIT_PERIODIC;
929630199e24SMatthias Ringwald             hci_run();
929730199e24SMatthias Ringwald             return ERROR_CODE_SUCCESS;
929830199e24SMatthias Ringwald         default:
929930199e24SMatthias Ringwald             return ERROR_CODE_COMMAND_DISALLOWED;
930030199e24SMatthias Ringwald     }
9301f5875de5SMatthias Ringwald }
9302f5875de5SMatthias Ringwald 
9303496bb884SMatthias Ringwald void gap_inquiry_set_lap(uint32_t lap){
9304496bb884SMatthias Ringwald     hci_stack->inquiry_lap = lap;
9305496bb884SMatthias Ringwald }
9306496bb884SMatthias Ringwald 
93071dc973e7SMatthias Ringwald void gap_inquiry_set_scan_activity(uint16_t inquiry_scan_interval, uint16_t inquiry_scan_window){
9308c0c8a829SMatthias Ringwald     hci_stack->inquiry_scan_interval = inquiry_scan_interval;
9309c0c8a829SMatthias Ringwald     hci_stack->inquiry_scan_window   = inquiry_scan_window;
9310baa4881eSMatthias Ringwald     hci_stack->gap_tasks_classic |= GAP_TASK_WRITE_INQUIRY_SCAN_ACTIVITY;
9311c0c8a829SMatthias Ringwald     hci_run();
9312c0c8a829SMatthias Ringwald }
9313c0c8a829SMatthias Ringwald 
9314f50ed5acSAndrey Fominykh void gap_inquiry_set_transmit_power_level(int8_t tx_power)
9315f50ed5acSAndrey Fominykh {
9316f50ed5acSAndrey Fominykh     hci_stack->inquiry_tx_power_level = tx_power;
9317f50ed5acSAndrey Fominykh     hci_stack->gap_tasks_classic |= GAP_TASK_WRITE_INQUIRY_TX_POWER_LEVEL;
9318f50ed5acSAndrey Fominykh     hci_run();
9319f50ed5acSAndrey Fominykh }
9320f50ed5acSAndrey Fominykh 
9321b7f1ee76SMatthias Ringwald 
9322b7f1ee76SMatthias Ringwald /**
9323b7f1ee76SMatthias Ringwald  * @brief Remote Name Request
9324b7f1ee76SMatthias Ringwald  * @param addr
9325b7f1ee76SMatthias Ringwald  * @param page_scan_repetition_mode
9326b7f1ee76SMatthias Ringwald  * @param clock_offset only used when bit 15 is set
9327b7f1ee76SMatthias Ringwald  * @events: HCI_EVENT_REMOTE_NAME_REQUEST_COMPLETE
9328b7f1ee76SMatthias Ringwald  */
9329667ba9d1SMatthias Ringwald int gap_remote_name_request(const bd_addr_t addr, uint8_t page_scan_repetition_mode, uint16_t clock_offset){
9330b7f1ee76SMatthias Ringwald     if (hci_stack->remote_name_state != GAP_REMOTE_NAME_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED;
93316535961aSMatthias Ringwald     (void)memcpy(hci_stack->remote_name_addr, addr, 6);
9332b7f1ee76SMatthias Ringwald     hci_stack->remote_name_page_scan_repetition_mode = page_scan_repetition_mode;
9333b7f1ee76SMatthias Ringwald     hci_stack->remote_name_clock_offset = clock_offset;
9334b7f1ee76SMatthias Ringwald     hci_stack->remote_name_state = GAP_REMOTE_NAME_STATE_W2_SEND;
9335b7f1ee76SMatthias Ringwald     hci_run();
9336b7f1ee76SMatthias Ringwald     return 0;
9337b7f1ee76SMatthias Ringwald }
9338b7f1ee76SMatthias Ringwald 
9339667ba9d1SMatthias Ringwald static int gap_pairing_set_state_and_run(const bd_addr_t addr, uint8_t state){
93400a51f88bSMatthias Ringwald     hci_stack->gap_pairing_state = state;
93416535961aSMatthias Ringwald     (void)memcpy(hci_stack->gap_pairing_addr, addr, 6);
93420a51f88bSMatthias Ringwald     hci_run();
93430a51f88bSMatthias Ringwald     return 0;
93440a51f88bSMatthias Ringwald }
93450a51f88bSMatthias Ringwald 
93460a51f88bSMatthias Ringwald /**
9347aad97216SMatthias Ringwald  * @brief Legacy Pairing Pin Code Response for binary data / non-strings
9348aad97216SMatthias Ringwald  * @param addr
9349aad97216SMatthias Ringwald  * @param pin_data
9350aad97216SMatthias Ringwald  * @param pin_len
9351aad97216SMatthias Ringwald  * @return 0 if ok
9352aad97216SMatthias Ringwald  */
9353667ba9d1SMatthias Ringwald int gap_pin_code_response_binary(const bd_addr_t addr, const uint8_t * pin_data, uint8_t pin_len){
9354aad97216SMatthias Ringwald     if (hci_stack->gap_pairing_state != GAP_PAIRING_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED;
9355c26f2c7bSMatthias Ringwald     if (pin_len > PIN_CODE_LEN) return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS;
9356aad97216SMatthias Ringwald     hci_stack->gap_pairing_input.gap_pairing_pin = pin_data;
9357aad97216SMatthias Ringwald     hci_stack->gap_pairing_pin_len = pin_len;
9358aad97216SMatthias Ringwald     return gap_pairing_set_state_and_run(addr, GAP_PAIRING_STATE_SEND_PIN);
9359aad97216SMatthias Ringwald }
9360aad97216SMatthias Ringwald 
9361aad97216SMatthias Ringwald /**
93620a51f88bSMatthias Ringwald  * @brief Legacy Pairing Pin Code Response
93630a51f88bSMatthias Ringwald  * @param addr
93640a51f88bSMatthias Ringwald  * @param pin
93650a51f88bSMatthias Ringwald  * @return 0 if ok
93660a51f88bSMatthias Ringwald  */
9367667ba9d1SMatthias Ringwald int gap_pin_code_response(const bd_addr_t addr, const char * pin){
93689d78a7ecSMatthias Ringwald     return gap_pin_code_response_binary(addr, (const uint8_t*) pin, (uint8_t) strlen(pin));
93690a51f88bSMatthias Ringwald }
93700a51f88bSMatthias Ringwald 
93710a51f88bSMatthias Ringwald /**
93720a51f88bSMatthias Ringwald  * @brief Abort Legacy Pairing
93730a51f88bSMatthias Ringwald  * @param addr
93740a51f88bSMatthias Ringwald  * @param pin
93750a51f88bSMatthias Ringwald  * @return 0 if ok
93760a51f88bSMatthias Ringwald  */
93770a51f88bSMatthias Ringwald int gap_pin_code_negative(bd_addr_t addr){
9378cd74063aSMatthias Ringwald     if (hci_stack->gap_pairing_state != GAP_PAIRING_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED;
93790a51f88bSMatthias Ringwald     return gap_pairing_set_state_and_run(addr, GAP_PAIRING_STATE_SEND_PIN_NEGATIVE);
93800a51f88bSMatthias Ringwald }
93810a51f88bSMatthias Ringwald 
93820a51f88bSMatthias Ringwald /**
93830a51f88bSMatthias Ringwald  * @brief SSP Passkey Response
93840a51f88bSMatthias Ringwald  * @param addr
93850a51f88bSMatthias Ringwald  * @param passkey
93860a51f88bSMatthias Ringwald  * @return 0 if ok
93870a51f88bSMatthias Ringwald  */
9388667ba9d1SMatthias Ringwald int gap_ssp_passkey_response(const bd_addr_t addr, uint32_t passkey){
9389cd74063aSMatthias Ringwald     if (hci_stack->gap_pairing_state != GAP_PAIRING_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED;
9390d504181aSMatthias Ringwald     hci_stack->gap_pairing_input.gap_pairing_passkey = passkey;
93910a51f88bSMatthias Ringwald     return gap_pairing_set_state_and_run(addr, GAP_PAIRING_STATE_SEND_PASSKEY);
93920a51f88bSMatthias Ringwald }
93930a51f88bSMatthias Ringwald 
93940a51f88bSMatthias Ringwald /**
93950a51f88bSMatthias Ringwald  * @brief Abort SSP Passkey Entry/Pairing
93960a51f88bSMatthias Ringwald  * @param addr
93970a51f88bSMatthias Ringwald  * @param pin
93980a51f88bSMatthias Ringwald  * @return 0 if ok
93990a51f88bSMatthias Ringwald  */
9400667ba9d1SMatthias Ringwald int gap_ssp_passkey_negative(const bd_addr_t addr){
9401cd74063aSMatthias Ringwald     if (hci_stack->gap_pairing_state != GAP_PAIRING_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED;
94020a51f88bSMatthias Ringwald     return gap_pairing_set_state_and_run(addr, GAP_PAIRING_STATE_SEND_PASSKEY_NEGATIVE);
94030a51f88bSMatthias Ringwald }
94040a51f88bSMatthias Ringwald 
94050a51f88bSMatthias Ringwald /**
94060a51f88bSMatthias Ringwald  * @brief Accept SSP Numeric Comparison
94070a51f88bSMatthias Ringwald  * @param addr
94080a51f88bSMatthias Ringwald  * @param passkey
94090a51f88bSMatthias Ringwald  * @return 0 if ok
94100a51f88bSMatthias Ringwald  */
9411667ba9d1SMatthias Ringwald int gap_ssp_confirmation_response(const bd_addr_t addr){
9412cd74063aSMatthias Ringwald     if (hci_stack->gap_pairing_state != GAP_PAIRING_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED;
94130a51f88bSMatthias Ringwald     return gap_pairing_set_state_and_run(addr, GAP_PAIRING_STATE_SEND_CONFIRMATION);
94140a51f88bSMatthias Ringwald }
94150a51f88bSMatthias Ringwald 
94160a51f88bSMatthias Ringwald /**
94170a51f88bSMatthias Ringwald  * @brief Abort SSP Numeric Comparison/Pairing
94180a51f88bSMatthias Ringwald  * @param addr
94190a51f88bSMatthias Ringwald  * @param pin
94200a51f88bSMatthias Ringwald  * @return 0 if ok
94210a51f88bSMatthias Ringwald  */
9422667ba9d1SMatthias Ringwald int gap_ssp_confirmation_negative(const bd_addr_t addr){
9423cd74063aSMatthias Ringwald     if (hci_stack->gap_pairing_state != GAP_PAIRING_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED;
94240a51f88bSMatthias Ringwald     return gap_pairing_set_state_and_run(addr, GAP_PAIRING_STATE_SEND_CONFIRMATION_NEGATIVE);
94250a51f88bSMatthias Ringwald }
94260a51f88bSMatthias Ringwald 
9427308eeaffSMatthias Ringwald #if defined(ENABLE_EXPLICIT_IO_CAPABILITIES_REPLY) || defined(ENABLE_EXPLICIT_LINK_KEY_REPLY)
942844565b0cSMatthias Ringwald static uint8_t gap_set_auth_flag_and_run(const bd_addr_t addr, hci_authentication_flags_t flag){
942944565b0cSMatthias Ringwald     hci_connection_t * conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL);
943044565b0cSMatthias Ringwald     if (!conn) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
943144565b0cSMatthias Ringwald     connectionSetAuthenticationFlags(conn, flag);
943244565b0cSMatthias Ringwald     hci_run();
943344565b0cSMatthias Ringwald     return ERROR_CODE_SUCCESS;
943444565b0cSMatthias Ringwald }
9435308eeaffSMatthias Ringwald #endif
943644565b0cSMatthias Ringwald 
9437308eeaffSMatthias Ringwald #ifdef ENABLE_EXPLICIT_IO_CAPABILITIES_REPLY
943844565b0cSMatthias Ringwald uint8_t gap_ssp_io_capabilities_response(const bd_addr_t addr){
94397ca4a7edSMatthias Ringwald     return gap_set_auth_flag_and_run(addr, AUTH_FLAG_SEND_IO_CAPABILITIES_REPLY);
944044565b0cSMatthias Ringwald }
944144565b0cSMatthias Ringwald 
944244565b0cSMatthias Ringwald uint8_t gap_ssp_io_capabilities_negative(const bd_addr_t addr){
94437ca4a7edSMatthias Ringwald     return gap_set_auth_flag_and_run(addr, AUTH_FLAG_SEND_IO_CAPABILITIES_NEGATIVE_REPLY);
944444565b0cSMatthias Ringwald }
944544565b0cSMatthias Ringwald #endif
944644565b0cSMatthias Ringwald 
94471849becdSMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB
94481849becdSMatthias Ringwald /**
94491849becdSMatthias Ringwald  * @brief Report Remote OOB Data
94501849becdSMatthias Ringwald  * @param bd_addr
94511849becdSMatthias Ringwald  * @param c_192 Simple Pairing Hash C derived from P-192 public key
94521849becdSMatthias Ringwald  * @param r_192 Simple Pairing Randomizer derived from P-192 public key
94531849becdSMatthias Ringwald  * @param c_256 Simple Pairing Hash C derived from P-256 public key
94541849becdSMatthias Ringwald  * @param r_256 Simple Pairing Randomizer derived from P-256 public key
94551849becdSMatthias Ringwald  */
94561849becdSMatthias Ringwald uint8_t gap_ssp_remote_oob_data(const bd_addr_t addr, const uint8_t * c_192, const uint8_t * r_192, const uint8_t * c_256, const uint8_t * r_256){
94571849becdSMatthias Ringwald     hci_connection_t * connection = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL);
94581849becdSMatthias Ringwald     if (connection == NULL) {
94591849becdSMatthias Ringwald         return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
94601849becdSMatthias Ringwald     }
94611849becdSMatthias Ringwald     connection->classic_oob_c_192 = c_192;
94621849becdSMatthias Ringwald     connection->classic_oob_r_192 = r_192;
9463204e8f1dSMatthias Ringwald 
9464204e8f1dSMatthias Ringwald     // ignore P-256 if not supported by us
9465204e8f1dSMatthias Ringwald     if (hci_stack->secure_connections_active){
94661849becdSMatthias Ringwald         connection->classic_oob_c_256 = c_256;
94671849becdSMatthias Ringwald         connection->classic_oob_r_256 = r_256;
9468204e8f1dSMatthias Ringwald     }
9469204e8f1dSMatthias Ringwald 
94701849becdSMatthias Ringwald     return ERROR_CODE_SUCCESS;
94711849becdSMatthias Ringwald }
9472cf01e888SMatthias Ringwald /**
9473cf01e888SMatthias Ringwald  * @brief Generate new OOB data
9474cf01e888SMatthias Ringwald  * @note OOB data will be provided in GAP_EVENT_LOCAL_OOB_DATA and be used in future pairing procedures
9475cf01e888SMatthias Ringwald  */
9476cf01e888SMatthias Ringwald void gap_ssp_generate_oob_data(void){
9477cf01e888SMatthias Ringwald     hci_stack->classic_read_local_oob_data = true;
9478cf01e888SMatthias Ringwald     hci_run();
9479cf01e888SMatthias Ringwald }
9480cf01e888SMatthias Ringwald 
94811849becdSMatthias Ringwald #endif
94821849becdSMatthias Ringwald 
9483308eeaffSMatthias Ringwald #ifdef ENABLE_EXPLICIT_LINK_KEY_REPLY
9484308eeaffSMatthias Ringwald uint8_t gap_send_link_key_response(const bd_addr_t addr, link_key_t link_key, link_key_type_t type){
9485308eeaffSMatthias Ringwald     hci_connection_t * connection = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL);
9486308eeaffSMatthias Ringwald     if (connection == NULL) {
9487308eeaffSMatthias Ringwald         return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
9488308eeaffSMatthias Ringwald     }
9489308eeaffSMatthias Ringwald 
9490308eeaffSMatthias Ringwald     memcpy(connection->link_key, link_key, sizeof(link_key_t));
9491308eeaffSMatthias Ringwald     connection->link_key_type = type;
9492308eeaffSMatthias Ringwald 
9493308eeaffSMatthias Ringwald     return gap_set_auth_flag_and_run(addr, AUTH_FLAG_HANDLE_LINK_KEY_REQUEST);
9494308eeaffSMatthias Ringwald }
9495308eeaffSMatthias Ringwald 
9496308eeaffSMatthias Ringwald #endif // ENABLE_EXPLICIT_LINK_KEY_REPLY
9497f5875de5SMatthias Ringwald /**
9498f6858d14SMatthias Ringwald  * @brief Set inquiry mode: standard, with RSSI, with RSSI + Extended Inquiry Results. Has to be called before power on.
9499f5875de5SMatthias Ringwald  * @param inquiry_mode see bluetooth_defines.h
9500f6858d14SMatthias Ringwald  */
9501b45b7749SMilanka Ringwald void hci_set_inquiry_mode(inquiry_mode_t inquiry_mode){
9502b45b7749SMilanka Ringwald     hci_stack->inquiry_mode = inquiry_mode;
9503f6858d14SMatthias Ringwald }
9504f6858d14SMatthias Ringwald 
9505f6858d14SMatthias Ringwald /**
9506d950d659SMatthias Ringwald  * @brief Configure Voice Setting for use with SCO data in HSP/HFP
9507d950d659SMatthias Ringwald  */
9508d950d659SMatthias Ringwald void hci_set_sco_voice_setting(uint16_t voice_setting){
9509d950d659SMatthias Ringwald     hci_stack->sco_voice_setting = voice_setting;
9510d950d659SMatthias Ringwald }
9511d950d659SMatthias Ringwald 
9512d950d659SMatthias Ringwald /**
9513d950d659SMatthias Ringwald  * @brief Get SCO Voice Setting
9514d950d659SMatthias Ringwald  * @return current voice setting
9515d950d659SMatthias Ringwald  */
95160cb5b971SMatthias Ringwald uint16_t hci_get_sco_voice_setting(void){
9517d950d659SMatthias Ringwald     return hci_stack->sco_voice_setting;
9518d950d659SMatthias Ringwald }
9519d950d659SMatthias Ringwald 
9520400ff5abSMatthias Ringwald static int hci_have_usb_transport(void){
9521400ff5abSMatthias Ringwald     if (!hci_stack->hci_transport) return 0;
9522400ff5abSMatthias Ringwald     const char * transport_name = hci_stack->hci_transport->name;
9523400ff5abSMatthias Ringwald     if (!transport_name) return 0;
9524400ff5abSMatthias Ringwald     return (transport_name[0] == 'H') && (transport_name[1] == '2');
9525400ff5abSMatthias Ringwald }
9526400ff5abSMatthias Ringwald 
95279427aeb5SMatthias Ringwald static uint16_t hci_sco_packet_length_for_payload_length(uint16_t payload_size){
952820dcdd22SMatthias Ringwald     uint16_t sco_packet_length = 0;
9529cf119f3bSMatthias Ringwald 
953091dfed7eSMatthias Ringwald #if defined(ENABLE_SCO_OVER_HCI) || defined (HAVE_SCO_TRANSPORT)
95316f28d2eeSMatthias Ringwald     // Transparent = mSBC => 1, CVSD with 16-bit samples requires twice as much bytes
953273f498e7SMatthias Ringwald     int multiplier;
953373f498e7SMatthias Ringwald     if (((hci_stack->sco_voice_setting_active & 0x03) != 0x03) &&
953473f498e7SMatthias Ringwald         ((hci_stack->sco_voice_setting_active & 0x20) == 0x20)) {
953573f498e7SMatthias Ringwald         multiplier = 2;
953673f498e7SMatthias Ringwald     } else {
953773f498e7SMatthias Ringwald         multiplier = 1;
953873f498e7SMatthias Ringwald     }
953991dfed7eSMatthias Ringwald #endif
954091dfed7eSMatthias Ringwald 
95419427aeb5SMatthias Ringwald #ifdef ENABLE_SCO_OVER_HCI
9542400ff5abSMatthias Ringwald     if (hci_have_usb_transport()){
9543400ff5abSMatthias Ringwald         // see Core Spec for H2 USB Transfer.
9544cf119f3bSMatthias Ringwald         // 3 byte SCO header + 24 bytes per connection
95459427aeb5SMatthias Ringwald         // @note multiple sco connections not supported currently
95469427aeb5SMatthias Ringwald         sco_packet_length = 3 + 24 * multiplier;
9547400ff5abSMatthias Ringwald     } else {
95489427aeb5SMatthias Ringwald         // 3 byte SCO header + SCO packet length over the air
95499427aeb5SMatthias Ringwald         sco_packet_length = 3 + payload_size * multiplier;
9550d966a453SMatthias Ringwald         // assert that it still fits inside an SCO buffer
9551ad915196SMatthias Ringwald         if (sco_packet_length > (hci_stack->sco_data_packet_length + 3)){
95529427aeb5SMatthias Ringwald             sco_packet_length = 3 + hci_stack->sco_data_packet_length;
9553d966a453SMatthias Ringwald         }
9554400ff5abSMatthias Ringwald     }
9555a3069afeSMatthias Ringwald #endif
95565b7087c7SMatthias Ringwald #ifdef HAVE_SCO_TRANSPORT
95579427aeb5SMatthias Ringwald     // 3 byte SCO header + SCO packet length over the air
95589427aeb5SMatthias Ringwald     sco_packet_length = 3 + payload_size * multiplier;
95599427aeb5SMatthias Ringwald     // assert that it still fits inside an SCO buffer
95609427aeb5SMatthias Ringwald     if (sco_packet_length > (hci_stack->sco_data_packet_length + 3)){
95619427aeb5SMatthias Ringwald         sco_packet_length = 3 + hci_stack->sco_data_packet_length;
95629427aeb5SMatthias Ringwald     }
95635b7087c7SMatthias Ringwald #endif
9564a3069afeSMatthias Ringwald     return sco_packet_length;
9565b3aad8daSMatthias Ringwald }
9566b3aad8daSMatthias Ringwald 
95679427aeb5SMatthias Ringwald uint16_t hci_get_sco_packet_length_for_connection(hci_con_handle_t sco_con_handle){
95689427aeb5SMatthias Ringwald     hci_connection_t * connection = hci_connection_for_handle(sco_con_handle);
95699427aeb5SMatthias Ringwald     if (connection != NULL){
95709427aeb5SMatthias Ringwald         return hci_sco_packet_length_for_payload_length(connection->sco_payload_length);
95719427aeb5SMatthias Ringwald     }
95729427aeb5SMatthias Ringwald     return 0;
95739427aeb5SMatthias Ringwald }
95749427aeb5SMatthias Ringwald 
95759427aeb5SMatthias Ringwald uint16_t hci_get_sco_packet_length(void){
95769427aeb5SMatthias Ringwald     btstack_linked_list_iterator_t it;
95779427aeb5SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->connections);
95789427aeb5SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
95799427aeb5SMatthias Ringwald         hci_connection_t * connection = (hci_connection_t *) btstack_linked_list_iterator_next(&it);
95809427aeb5SMatthias Ringwald         if ( connection->address_type == BD_ADDR_TYPE_SCO ) {
95819427aeb5SMatthias Ringwald             return hci_sco_packet_length_for_payload_length(connection->sco_payload_length);;
95829427aeb5SMatthias Ringwald         }
95839427aeb5SMatthias Ringwald     }
95849427aeb5SMatthias Ringwald     return 0;
95859427aeb5SMatthias Ringwald }
95869427aeb5SMatthias Ringwald 
9587c4c88f1bSJakob Krantz /**
9588c4c88f1bSJakob Krantz * @brief Sets the master/slave policy
9589c4c88f1bSJakob Krantz * @param policy (0: attempt to become master, 1: let connecting device decide)
9590c4c88f1bSJakob Krantz */
9591c4c88f1bSJakob Krantz void hci_set_master_slave_policy(uint8_t policy){
9592c4c88f1bSJakob Krantz     hci_stack->master_slave_policy = policy;
9593c4c88f1bSJakob Krantz }
9594c4c88f1bSJakob Krantz 
9595c4c88f1bSJakob Krantz #endif
9596ec111c8bSMatthias Ringwald 
9597ec111c8bSMatthias Ringwald HCI_STATE hci_get_state(void){
9598ec111c8bSMatthias Ringwald     return hci_stack->state;
9599ec111c8bSMatthias Ringwald }
9600ec111c8bSMatthias Ringwald 
960107e010b6SMilanka Ringwald #ifdef ENABLE_CLASSIC
96025e91d96cSMatthias Ringwald void gap_register_classic_connection_filter(int (*accept_callback)(bd_addr_t addr, hci_link_type_t link_type)){
960307e010b6SMilanka Ringwald     hci_stack->gap_classic_accept_callback = accept_callback;
960407e010b6SMilanka Ringwald }
960507e010b6SMilanka Ringwald #endif
9606ec111c8bSMatthias Ringwald 
9607d950d659SMatthias Ringwald /**
9608d23838ecSMatthias Ringwald  * @brief Set callback for Bluetooth Hardware Error
9609d23838ecSMatthias Ringwald  */
9610c2e1fa60SMatthias Ringwald void hci_set_hardware_error_callback(void (*fn)(uint8_t error)){
9611d23838ecSMatthias Ringwald     hci_stack->hardware_error_callback = fn;
9612d23838ecSMatthias Ringwald }
9613d23838ecSMatthias Ringwald 
961471de195eSMatthias Ringwald void hci_disconnect_all(void){
9615665d90f2SMatthias Ringwald     btstack_linked_list_iterator_t it;
9616665d90f2SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->connections);
9617665d90f2SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
9618665d90f2SMatthias Ringwald         hci_connection_t * con = (hci_connection_t*) btstack_linked_list_iterator_next(&it);
961904a6ef8cSmatthias.ringwald         if (con->state == SENT_DISCONNECT) continue;
962004a6ef8cSmatthias.ringwald         con->state = SEND_DISCONNECT;
962104a6ef8cSmatthias.ringwald     }
9622d31fba26S[email protected]     hci_run();
962304a6ef8cSmatthias.ringwald }
962433373e40SMatthias Ringwald 
962533373e40SMatthias Ringwald uint16_t hci_get_manufacturer(void){
962633373e40SMatthias Ringwald     return hci_stack->manufacturer;
962733373e40SMatthias Ringwald }
96289c6e867eSMatthias Ringwald 
96293e329ddfSandryblack #ifdef ENABLE_BLE
96309c6e867eSMatthias Ringwald static sm_connection_t * sm_get_connection_for_handle(hci_con_handle_t con_handle){
96319c6e867eSMatthias Ringwald     hci_connection_t * hci_con = hci_connection_for_handle(con_handle);
96329c6e867eSMatthias Ringwald     if (!hci_con) return NULL;
96339c6e867eSMatthias Ringwald     return &hci_con->sm_connection;
96349c6e867eSMatthias Ringwald }
96359c6e867eSMatthias Ringwald 
96369c6e867eSMatthias Ringwald // extracted from sm.c to allow enabling of l2cap le data channels without adding sm.c to the build
96379c6e867eSMatthias Ringwald // without sm.c default values from create_connection_for_bd_addr_and_type() resulg in non-encrypted, not-authenticated
96386a79f6baSMatthias Ringwald #endif
96399c6e867eSMatthias Ringwald 
96406d105c71SMatthias Ringwald uint8_t gap_encryption_key_size(hci_con_handle_t con_handle){
9641c5fb5ca4SMatthias Ringwald     hci_connection_t * hci_connection = hci_connection_for_handle(con_handle);
9642c5fb5ca4SMatthias Ringwald     if (hci_connection == NULL) return 0;
9643c5fb5ca4SMatthias Ringwald     if (hci_is_le_connection(hci_connection)){
96446a79f6baSMatthias Ringwald #ifdef ENABLE_BLE
9645c5fb5ca4SMatthias Ringwald         sm_connection_t * sm_conn = &hci_connection->sm_connection;
9646c7bead46SMatthias Ringwald         if (sm_conn->sm_connection_encrypted != 0u) {
96479c6e867eSMatthias Ringwald             return sm_conn->sm_actual_encryption_key_size;
96489c6e867eSMatthias Ringwald         }
96496a79f6baSMatthias Ringwald #endif
96506a79f6baSMatthias Ringwald     } else {
9651c5fb5ca4SMatthias Ringwald #ifdef ENABLE_CLASSIC
96528daf94bcSMatthias Ringwald         if ((hci_connection->authentication_flags & AUTH_FLAG_CONNECTION_ENCRYPTED)){
9653c5fb5ca4SMatthias Ringwald             return hci_connection->encryption_key_size;
9654c5fb5ca4SMatthias Ringwald         }
9655c5fb5ca4SMatthias Ringwald #endif
96566a79f6baSMatthias Ringwald     }
9657c5fb5ca4SMatthias Ringwald     return 0;
9658c5fb5ca4SMatthias Ringwald }
96599c6e867eSMatthias Ringwald 
9660ff3f1026SMatthias Ringwald bool gap_authenticated(hci_con_handle_t con_handle){
9661c5fb5ca4SMatthias Ringwald     hci_connection_t * hci_connection = hci_connection_for_handle(con_handle);
9662ff3f1026SMatthias Ringwald     if (hci_connection == NULL) return false;
96635f3981bfSMatthias Ringwald 
9664c5fb5ca4SMatthias Ringwald     switch (hci_connection->address_type){
96656a79f6baSMatthias Ringwald #ifdef ENABLE_BLE
96665f3981bfSMatthias Ringwald         case BD_ADDR_TYPE_LE_PUBLIC:
96675f3981bfSMatthias Ringwald         case BD_ADDR_TYPE_LE_RANDOM:
9668d9e1bf33SMatthias Ringwald         case BD_ADDR_TYPE_LE_PUBLIC_IDENTITY:
9669d9e1bf33SMatthias Ringwald         case BD_ADDR_TYPE_LE_RANDOM_IDENTITY:
9670c5fb5ca4SMatthias Ringwald             if (hci_connection->sm_connection.sm_connection_encrypted == 0) return 0; // unencrypted connection cannot be authenticated
9671ff3f1026SMatthias Ringwald             return hci_connection->sm_connection.sm_connection_authenticated != 0;
96726a79f6baSMatthias Ringwald #endif
967359a1a47aSMatthias Ringwald #ifdef ENABLE_CLASSIC
96745f3981bfSMatthias Ringwald         case BD_ADDR_TYPE_SCO:
9675f16129ceSMatthias Ringwald         case BD_ADDR_TYPE_ACL:
9676ff3f1026SMatthias Ringwald             return gap_authenticated_for_link_key_type(hci_connection->link_key_type);
967759a1a47aSMatthias Ringwald #endif
96785f3981bfSMatthias Ringwald         default:
9679ff3f1026SMatthias Ringwald             return false;
96805f3981bfSMatthias Ringwald     }
96819c6e867eSMatthias Ringwald }
96829c6e867eSMatthias Ringwald 
9683f461b3dfSMatthias Ringwald bool gap_secure_connection(hci_con_handle_t con_handle){
9684c5fb5ca4SMatthias Ringwald     hci_connection_t * hci_connection = hci_connection_for_handle(con_handle);
9685c5fb5ca4SMatthias Ringwald     if (hci_connection == NULL) return 0;
96868b35e16aSMatthias Ringwald 
9687c5fb5ca4SMatthias Ringwald     switch (hci_connection->address_type){
96886a79f6baSMatthias Ringwald #ifdef ENABLE_BLE
96898b35e16aSMatthias Ringwald         case BD_ADDR_TYPE_LE_PUBLIC:
96908b35e16aSMatthias Ringwald         case BD_ADDR_TYPE_LE_RANDOM:
9691d9e1bf33SMatthias Ringwald         case BD_ADDR_TYPE_LE_PUBLIC_IDENTITY:
9692d9e1bf33SMatthias Ringwald         case BD_ADDR_TYPE_LE_RANDOM_IDENTITY:
9693f461b3dfSMatthias Ringwald             if (hci_connection->sm_connection.sm_connection_encrypted == 0) return false; // unencrypted connection cannot be authenticated
9694d7dbf891SMatthias Ringwald             return hci_connection->sm_connection.sm_connection_sc;
96956a79f6baSMatthias Ringwald #endif
969659a1a47aSMatthias Ringwald #ifdef ENABLE_CLASSIC
96978b35e16aSMatthias Ringwald         case BD_ADDR_TYPE_SCO:
9698f16129ceSMatthias Ringwald         case BD_ADDR_TYPE_ACL:
9699f461b3dfSMatthias Ringwald             return gap_secure_connection_for_link_key_type(hci_connection->link_key_type);
970059a1a47aSMatthias Ringwald #endif
97018b35e16aSMatthias Ringwald         default:
9702f461b3dfSMatthias Ringwald             return false;
97038b35e16aSMatthias Ringwald     }
9704f1dfbe18SMatthias Ringwald }
9705f1dfbe18SMatthias Ringwald 
97061e122704SMatthias Ringwald bool gap_bonded(hci_con_handle_t con_handle){
97071e122704SMatthias Ringwald 	hci_connection_t * hci_connection = hci_connection_for_handle(con_handle);
97081e122704SMatthias Ringwald 	if (hci_connection == NULL) return 0;
97091e122704SMatthias Ringwald 
971048f33f37SMatthias Ringwald #ifdef ENABLE_CLASSIC
97111e122704SMatthias Ringwald 	link_key_t link_key;
97121e122704SMatthias Ringwald 	link_key_type_t link_key_type;
971348f33f37SMatthias Ringwald #endif
97141e122704SMatthias Ringwald 	switch (hci_connection->address_type){
97156a79f6baSMatthias Ringwald #ifdef ENABLE_BLE
97161e122704SMatthias Ringwald 		case BD_ADDR_TYPE_LE_PUBLIC:
97171e122704SMatthias Ringwald 		case BD_ADDR_TYPE_LE_RANDOM:
9718d9e1bf33SMatthias Ringwald 	    case BD_ADDR_TYPE_LE_PUBLIC_IDENTITY:
9719d9e1bf33SMatthias Ringwald         case BD_ADDR_TYPE_LE_RANDOM_IDENTITY:
97201e122704SMatthias Ringwald             return hci_connection->sm_connection.sm_le_db_index >= 0;
97216a79f6baSMatthias Ringwald #endif
97221e122704SMatthias Ringwald #ifdef ENABLE_CLASSIC
97231e122704SMatthias Ringwald 		case BD_ADDR_TYPE_SCO:
97241e122704SMatthias Ringwald 		case BD_ADDR_TYPE_ACL:
97251e122704SMatthias Ringwald 			return hci_stack->link_key_db && hci_stack->link_key_db->get_link_key(hci_connection->address, link_key, &link_key_type);
97261e122704SMatthias Ringwald #endif
97271e122704SMatthias Ringwald 		default:
97281e122704SMatthias Ringwald 			return false;
97291e122704SMatthias Ringwald 	}
97301e122704SMatthias Ringwald }
97311e122704SMatthias Ringwald 
97326a79f6baSMatthias Ringwald #ifdef ENABLE_BLE
97339c6e867eSMatthias Ringwald authorization_state_t gap_authorization_state(hci_con_handle_t con_handle){
97349c6e867eSMatthias Ringwald     sm_connection_t * sm_conn = sm_get_connection_for_handle(con_handle);
9735c7bead46SMatthias Ringwald     if (sm_conn == NULL)                             return AUTHORIZATION_UNKNOWN; // wrong connection
9736c7bead46SMatthias Ringwald     if (sm_conn->sm_connection_encrypted == 0u)      return AUTHORIZATION_UNKNOWN; // unencrypted connection cannot be authorized
9737c7bead46SMatthias Ringwald     if (sm_conn->sm_connection_authenticated == 0u)  return AUTHORIZATION_UNKNOWN; // unauthenticatd connection cannot be authorized
97389c6e867eSMatthias Ringwald     return sm_conn->sm_connection_authorization_state;
97399c6e867eSMatthias Ringwald }
97409c6e867eSMatthias Ringwald #endif
9741f8ee3071SMatthias Ringwald 
9742f8ee3071SMatthias Ringwald #ifdef ENABLE_CLASSIC
9743f8ee3071SMatthias Ringwald uint8_t gap_sniff_mode_enter(hci_con_handle_t con_handle, uint16_t sniff_min_interval, uint16_t sniff_max_interval, uint16_t sniff_attempt, uint16_t sniff_timeout){
9744f8ee3071SMatthias Ringwald     hci_connection_t * conn = hci_connection_for_handle(con_handle);
97457f839e2cSMatthias Ringwald     if (!conn) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
9746f8ee3071SMatthias Ringwald     conn->sniff_min_interval = sniff_min_interval;
9747f8ee3071SMatthias Ringwald     conn->sniff_max_interval = sniff_max_interval;
9748f8ee3071SMatthias Ringwald     conn->sniff_attempt = sniff_attempt;
9749f8ee3071SMatthias Ringwald     conn->sniff_timeout = sniff_timeout;
9750f8ee3071SMatthias Ringwald     hci_run();
9751f8ee3071SMatthias Ringwald     return 0;
9752f8ee3071SMatthias Ringwald }
9753f8ee3071SMatthias Ringwald 
9754f8ee3071SMatthias Ringwald /**
9755f8ee3071SMatthias Ringwald  * @brief Exit Sniff mode
9756f8ee3071SMatthias Ringwald  * @param con_handle
9757f8ee3071SMatthias Ringwald  @ @return 0 if ok
9758f8ee3071SMatthias Ringwald  */
9759f8ee3071SMatthias Ringwald uint8_t gap_sniff_mode_exit(hci_con_handle_t con_handle){
9760f8ee3071SMatthias Ringwald     hci_connection_t * conn = hci_connection_for_handle(con_handle);
97617f839e2cSMatthias Ringwald     if (!conn) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
9762f8ee3071SMatthias Ringwald     conn->sniff_min_interval = 0xffff;
9763f8ee3071SMatthias Ringwald     hci_run();
9764f8ee3071SMatthias Ringwald     return 0;
9765f8ee3071SMatthias Ringwald }
9766bea424a5SMatthias Ringwald 
9767140c0557SMatthias Ringwald uint8_t gap_sniff_subrating_configure(hci_con_handle_t con_handle, uint16_t max_latency, uint16_t min_remote_timeout, uint16_t min_local_timeout){
9768140c0557SMatthias Ringwald     hci_connection_t * conn = hci_connection_for_handle(con_handle);
97697f839e2cSMatthias Ringwald     if (!conn) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
9770140c0557SMatthias Ringwald     conn->sniff_subrating_max_latency = max_latency;
9771140c0557SMatthias Ringwald     conn->sniff_subrating_min_remote_timeout = min_remote_timeout;
9772140c0557SMatthias Ringwald     conn->sniff_subrating_min_local_timeout = min_local_timeout;
9773140c0557SMatthias Ringwald     hci_run();
9774dc8d5bd3SMatthias Ringwald     return ERROR_CODE_SUCCESS;
9775140c0557SMatthias Ringwald }
9776140c0557SMatthias Ringwald 
9777278ff8a9SMatthias Ringwald uint8_t gap_qos_set(hci_con_handle_t con_handle, hci_service_type_t service_type, uint32_t token_rate, uint32_t peak_bandwidth, uint32_t latency, uint32_t delay_variation){
9778278ff8a9SMatthias Ringwald     hci_connection_t * conn = hci_connection_for_handle(con_handle);
97797f839e2cSMatthias Ringwald     if (!conn) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
9780278ff8a9SMatthias Ringwald     conn->qos_service_type = service_type;
9781278ff8a9SMatthias Ringwald     conn->qos_token_rate = token_rate;
9782278ff8a9SMatthias Ringwald     conn->qos_peak_bandwidth = peak_bandwidth;
9783278ff8a9SMatthias Ringwald     conn->qos_latency = latency;
9784278ff8a9SMatthias Ringwald     conn->qos_delay_variation = delay_variation;
9785278ff8a9SMatthias Ringwald     hci_run();
9786278ff8a9SMatthias Ringwald     return ERROR_CODE_SUCCESS;
9787278ff8a9SMatthias Ringwald }
9788278ff8a9SMatthias Ringwald 
9789bea424a5SMatthias Ringwald void gap_set_page_scan_activity(uint16_t page_scan_interval, uint16_t page_scan_window){
9790bea424a5SMatthias Ringwald     hci_stack->new_page_scan_interval = page_scan_interval;
9791bea424a5SMatthias Ringwald     hci_stack->new_page_scan_window = page_scan_window;
9792baa4881eSMatthias Ringwald     hci_stack->gap_tasks_classic |= GAP_TASK_WRITE_PAGE_SCAN_ACTIVITY;
9793bea424a5SMatthias Ringwald     hci_run();
9794bea424a5SMatthias Ringwald }
9795bea424a5SMatthias Ringwald 
9796bea424a5SMatthias Ringwald void gap_set_page_scan_type(page_scan_type_t page_scan_type){
9797bea424a5SMatthias Ringwald     hci_stack->new_page_scan_type = (uint8_t) page_scan_type;
9798baa4881eSMatthias Ringwald     hci_stack->gap_tasks_classic |= GAP_TASK_WRITE_PAGE_SCAN_TYPE;
9799bea424a5SMatthias Ringwald     hci_run();
9800bea424a5SMatthias Ringwald }
9801bea424a5SMatthias Ringwald 
980232a12730SMatthias Ringwald void gap_set_page_timeout(uint16_t page_timeout){
980332a12730SMatthias Ringwald     hci_stack->page_timeout = page_timeout;
9804baa4881eSMatthias Ringwald     hci_stack->gap_tasks_classic |= GAP_TASK_WRITE_PAGE_TIMEOUT;
980532a12730SMatthias Ringwald     hci_run();
980632a12730SMatthias Ringwald }
980732a12730SMatthias Ringwald 
9808f8ee3071SMatthias Ringwald #endif
9809beceeddeSMatthias Ringwald 
981021debf25SMatthias Ringwald #ifdef ENABLE_LE_PRIVACY_ADDRESS_RESOLUTION
981121debf25SMatthias Ringwald void hci_load_le_device_db_entry_into_resolving_list(uint16_t le_device_db_index){
981221debf25SMatthias Ringwald     if (le_device_db_index >= MAX_NUM_RESOLVING_LIST_ENTRIES) return;
981321debf25SMatthias Ringwald     if (le_device_db_index >= le_device_db_max_count()) return;
981421debf25SMatthias Ringwald     uint8_t offset = le_device_db_index >> 3;
981521debf25SMatthias Ringwald     uint8_t mask = 1 << (le_device_db_index & 7);
981602b02cffSMatthias Ringwald     hci_stack->le_resolving_list_add_entries[offset] |= mask;
9817e8ca66c6SMatthias Ringwald     hci_stack->le_resolving_list_set_privacy_mode[offset] |= mask;
981821debf25SMatthias Ringwald     if (hci_stack->le_resolving_list_state == LE_RESOLVING_LIST_DONE){
981902b02cffSMatthias Ringwald     	// note: go back to remove entries, otherwise, a remove + add will skip the add
98205f3ccd83SMatthias Ringwald         hci_stack->le_resolving_list_state = LE_RESOLVING_LIST_UPDATES_ENTRIES;
982102b02cffSMatthias Ringwald     }
982202b02cffSMatthias Ringwald }
982302b02cffSMatthias Ringwald 
982402b02cffSMatthias Ringwald void hci_remove_le_device_db_entry_from_resolving_list(uint16_t le_device_db_index){
982502b02cffSMatthias Ringwald 	if (le_device_db_index >= MAX_NUM_RESOLVING_LIST_ENTRIES) return;
982602b02cffSMatthias Ringwald 	if (le_device_db_index >= le_device_db_max_count()) return;
982702b02cffSMatthias Ringwald 	uint8_t offset = le_device_db_index >> 3;
982802b02cffSMatthias Ringwald 	uint8_t mask = 1 << (le_device_db_index & 7);
982902b02cffSMatthias Ringwald 	hci_stack->le_resolving_list_remove_entries[offset] |= mask;
983002b02cffSMatthias Ringwald 	if (hci_stack->le_resolving_list_state == LE_RESOLVING_LIST_DONE){
98315f3ccd83SMatthias Ringwald 		hci_stack->le_resolving_list_state = LE_RESOLVING_LIST_UPDATES_ENTRIES;
983221debf25SMatthias Ringwald 	}
983321debf25SMatthias Ringwald }
9834cf38a091SMatthias Ringwald 
9835cf38a091SMatthias Ringwald uint8_t gap_load_resolving_list_from_le_device_db(void){
98361ffa425cSMatthias Ringwald     if (hci_command_supported(SUPPORTED_HCI_COMMAND_LE_SET_ADDRESS_RESOLUTION_ENABLE) == false){
9837cf38a091SMatthias Ringwald 		return ERROR_CODE_UNSUPPORTED_FEATURE_OR_PARAMETER_VALUE;
9838cf38a091SMatthias Ringwald 	}
9839cf38a091SMatthias Ringwald 	if (hci_stack->le_resolving_list_state != LE_RESOLVING_LIST_SEND_ENABLE_ADDRESS_RESOLUTION){
9840cf38a091SMatthias Ringwald 		// restart le resolving list update
9841cf38a091SMatthias Ringwald 		hci_stack->le_resolving_list_state = LE_RESOLVING_LIST_READ_SIZE;
9842cf38a091SMatthias Ringwald 	}
9843cf38a091SMatthias Ringwald 	return ERROR_CODE_SUCCESS;
9844cf38a091SMatthias Ringwald }
9845c3d19a30SMatthias Ringwald 
9846c3d19a30SMatthias Ringwald void gap_set_peer_privacy_mode(le_privacy_mode_t privacy_mode ){
9847c3d19a30SMatthias Ringwald     hci_stack->le_privacy_mode = privacy_mode;
9848c3d19a30SMatthias Ringwald }
984921debf25SMatthias Ringwald #endif
985021debf25SMatthias Ringwald 
9851f40c73b4SMatthias Ringwald #ifdef ENABLE_BLE
9852f40c73b4SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
9853f40c73b4SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
9854f40c73b4SMatthias Ringwald 
9855f40c73b4SMatthias Ringwald static uint8_t hci_periodic_advertiser_list_add(bd_addr_type_t address_type, const bd_addr_t address, uint8_t advertising_sid){
9856100da355SMatthias Ringwald 
9857100da355SMatthias Ringwald #if !defined(HAVE_MALLOC) && (!defined(MAX_NR_PERIODIC_ADVERTISER_LIST_ENTRIES) || (MAX_NR_PERIODIC_ADVERTISER_LIST_ENTRIES == 0))
9858100da355SMatthias Ringwald     // incorrect configuration:
9859100da355SMatthias Ringwald     // - as MAX_NR_PERIODIC_ADVERTISER_LIST_ENTRIES is not defined or zero this function always fails
9860100da355SMatthias Ringwald     // - please set MAX_NR_PERIODIC_ADVERTISER_LIST_ENTRIES in btstack_config.h
9861100da355SMatthias Ringwald     btstack_assert(false);
9862100da355SMatthias Ringwald #endif
9863100da355SMatthias Ringwald 
9864f40c73b4SMatthias Ringwald     // check if already in list
9865f40c73b4SMatthias Ringwald     btstack_linked_list_iterator_t it;
9866f40c73b4SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->le_periodic_advertiser_list);
9867f40c73b4SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)) {
9868f40c73b4SMatthias Ringwald         periodic_advertiser_list_entry_t *entry = (periodic_advertiser_list_entry_t *) btstack_linked_list_iterator_next(&it);
9869f40c73b4SMatthias Ringwald         if (entry->sid != advertising_sid) {
9870f40c73b4SMatthias Ringwald             continue;
9871f40c73b4SMatthias Ringwald         }
9872f40c73b4SMatthias Ringwald         if (entry->address_type != address_type) {
9873f40c73b4SMatthias Ringwald             continue;
9874f40c73b4SMatthias Ringwald         }
9875f40c73b4SMatthias Ringwald         if (memcmp(entry->address, address, 6) != 0) {
9876f40c73b4SMatthias Ringwald             continue;
9877f40c73b4SMatthias Ringwald         }
9878f40c73b4SMatthias Ringwald         // disallow if already scheduled to add
9879f40c73b4SMatthias Ringwald         if ((entry->state & LE_PERIODIC_ADVERTISER_LIST_ENTRY_ADD_TO_CONTROLLER) != 0){
9880f40c73b4SMatthias Ringwald             return ERROR_CODE_COMMAND_DISALLOWED;
9881f40c73b4SMatthias Ringwald         }
9882f40c73b4SMatthias Ringwald         // still on controller, but scheduled to remove -> re-add
9883f40c73b4SMatthias Ringwald         entry->state |= LE_PERIODIC_ADVERTISER_LIST_ENTRY_ADD_TO_CONTROLLER;
9884f40c73b4SMatthias Ringwald         return ERROR_CODE_SUCCESS;
9885f40c73b4SMatthias Ringwald     }
9886f40c73b4SMatthias Ringwald     // alloc and add to list
9887f40c73b4SMatthias Ringwald     periodic_advertiser_list_entry_t * entry = btstack_memory_periodic_advertiser_list_entry_get();
9888f40c73b4SMatthias Ringwald     if (!entry) return BTSTACK_MEMORY_ALLOC_FAILED;
9889f40c73b4SMatthias Ringwald     entry->sid = advertising_sid;
9890f40c73b4SMatthias Ringwald     entry->address_type = address_type;
9891f40c73b4SMatthias Ringwald     (void)memcpy(entry->address, address, 6);
9892f40c73b4SMatthias Ringwald     entry->state = LE_PERIODIC_ADVERTISER_LIST_ENTRY_ADD_TO_CONTROLLER;
9893f40c73b4SMatthias Ringwald     btstack_linked_list_add(&hci_stack->le_periodic_advertiser_list, (btstack_linked_item_t*) entry);
9894f40c73b4SMatthias Ringwald     return ERROR_CODE_SUCCESS;
9895f40c73b4SMatthias Ringwald }
9896f40c73b4SMatthias Ringwald 
9897f40c73b4SMatthias Ringwald static uint8_t hci_periodic_advertiser_list_remove(bd_addr_type_t address_type, const bd_addr_t address, uint8_t advertising_sid){
9898f40c73b4SMatthias Ringwald     btstack_linked_list_iterator_t it;
9899f40c73b4SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->le_periodic_advertiser_list);
9900f40c73b4SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
9901f40c73b4SMatthias Ringwald         periodic_advertiser_list_entry_t * entry = (periodic_advertiser_list_entry_t*) btstack_linked_list_iterator_next(&it);
9902f40c73b4SMatthias Ringwald         if (entry->sid != advertising_sid) {
9903f40c73b4SMatthias Ringwald             continue;
9904f40c73b4SMatthias Ringwald         }
9905f40c73b4SMatthias Ringwald         if (entry->address_type != address_type) {
9906f40c73b4SMatthias Ringwald             continue;
9907f40c73b4SMatthias Ringwald         }
9908f40c73b4SMatthias Ringwald         if (memcmp(entry->address, address, 6) != 0) {
9909f40c73b4SMatthias Ringwald             continue;
9910f40c73b4SMatthias Ringwald         }
9911f40c73b4SMatthias Ringwald         if (entry->state & LE_PERIODIC_ADVERTISER_LIST_ENTRY_ON_CONTROLLER){
9912f40c73b4SMatthias Ringwald             // remove from controller if already present
9913f40c73b4SMatthias Ringwald             entry->state |= LE_PERIODIC_ADVERTISER_LIST_ENTRY_REMOVE_FROM_CONTROLLER;
9914f40c73b4SMatthias Ringwald         }  else {
9915f40c73b4SMatthias Ringwald             // directly remove entry from whitelist
9916f40c73b4SMatthias Ringwald             btstack_linked_list_iterator_remove(&it);
9917f40c73b4SMatthias Ringwald             btstack_memory_periodic_advertiser_list_entry_free(entry);
9918f40c73b4SMatthias Ringwald         }
9919f40c73b4SMatthias Ringwald         return ERROR_CODE_SUCCESS;
9920f40c73b4SMatthias Ringwald     }
9921f40c73b4SMatthias Ringwald     return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
9922f40c73b4SMatthias Ringwald }
9923f40c73b4SMatthias Ringwald 
9924f40c73b4SMatthias Ringwald static void hci_periodic_advertiser_list_clear(void){
9925f40c73b4SMatthias Ringwald     btstack_linked_list_iterator_t it;
9926f40c73b4SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->le_periodic_advertiser_list);
9927f40c73b4SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
9928f40c73b4SMatthias Ringwald         periodic_advertiser_list_entry_t * entry = (periodic_advertiser_list_entry_t*) btstack_linked_list_iterator_next(&it);
9929f40c73b4SMatthias Ringwald         if (entry->state & LE_PERIODIC_ADVERTISER_LIST_ENTRY_ON_CONTROLLER){
9930f40c73b4SMatthias Ringwald             // remove from controller if already present
9931f40c73b4SMatthias Ringwald             entry->state |= LE_PERIODIC_ADVERTISER_LIST_ENTRY_REMOVE_FROM_CONTROLLER;
9932f40c73b4SMatthias Ringwald             continue;
9933f40c73b4SMatthias Ringwald         }
9934f40c73b4SMatthias Ringwald         // directly remove entry from whitelist
9935f40c73b4SMatthias Ringwald         btstack_linked_list_iterator_remove(&it);
9936f40c73b4SMatthias Ringwald         btstack_memory_periodic_advertiser_list_entry_free(entry);
9937f40c73b4SMatthias Ringwald     }
9938f40c73b4SMatthias Ringwald }
9939f40c73b4SMatthias Ringwald 
9940f40c73b4SMatthias Ringwald uint8_t gap_periodic_advertiser_list_clear(void){
9941f40c73b4SMatthias Ringwald     hci_periodic_advertiser_list_clear();
9942f40c73b4SMatthias Ringwald     hci_run();
9943f40c73b4SMatthias Ringwald     return ERROR_CODE_SUCCESS;
9944f40c73b4SMatthias Ringwald }
9945f40c73b4SMatthias Ringwald 
9946f40c73b4SMatthias Ringwald uint8_t gap_periodic_advertiser_list_add(bd_addr_type_t address_type, const bd_addr_t address, uint8_t advertising_sid){
9947f40c73b4SMatthias Ringwald     uint8_t status = hci_periodic_advertiser_list_add(address_type, address, advertising_sid);
9948f40c73b4SMatthias Ringwald     if (status){
9949f40c73b4SMatthias Ringwald         return status;
9950f40c73b4SMatthias Ringwald     }
9951f40c73b4SMatthias Ringwald     hci_run();
9952f40c73b4SMatthias Ringwald     return ERROR_CODE_SUCCESS;
9953f40c73b4SMatthias Ringwald }
9954f40c73b4SMatthias Ringwald 
9955f40c73b4SMatthias Ringwald uint8_t gap_periodic_advertiser_list_remove(bd_addr_type_t address_type, const bd_addr_t address, uint8_t advertising_sid){
9956f40c73b4SMatthias Ringwald     uint8_t status = hci_periodic_advertiser_list_remove(address_type, address, advertising_sid);
9957f40c73b4SMatthias Ringwald     if (status){
9958f40c73b4SMatthias Ringwald         return status;
9959f40c73b4SMatthias Ringwald     }
9960f40c73b4SMatthias Ringwald     hci_run();
9961f40c73b4SMatthias Ringwald     return ERROR_CODE_SUCCESS;
9962f40c73b4SMatthias Ringwald }
99634bafedd5SMatthias Ringwald 
99644bafedd5SMatthias Ringwald uint8_t gap_periodic_advertising_create_sync(uint8_t options, uint8_t advertising_sid, bd_addr_type_t advertiser_address_type,
99654bafedd5SMatthias Ringwald                                              bd_addr_t advertiser_address, uint16_t skip, uint16_t sync_timeout, uint8_t sync_cte_type){
99664bafedd5SMatthias Ringwald     // abort if already active
99674bafedd5SMatthias Ringwald     if (hci_stack->le_periodic_sync_request != LE_CONNECTING_IDLE) {
99684bafedd5SMatthias Ringwald         return ERROR_CODE_COMMAND_DISALLOWED;
99694bafedd5SMatthias Ringwald     }
99704bafedd5SMatthias Ringwald     // store request
99714bafedd5SMatthias Ringwald     hci_stack->le_periodic_sync_request = ((options & 0) != 0) ? LE_CONNECTING_WHITELIST : LE_CONNECTING_DIRECT;
99724bafedd5SMatthias Ringwald     hci_stack->le_periodic_sync_options = options;
99734bafedd5SMatthias Ringwald     hci_stack->le_periodic_sync_advertising_sid = advertising_sid;
99744bafedd5SMatthias Ringwald     hci_stack->le_periodic_sync_advertiser_address_type = advertiser_address_type;
99754bafedd5SMatthias Ringwald     memcpy(hci_stack->le_periodic_sync_advertiser_address, advertiser_address, 6);
99764bafedd5SMatthias Ringwald     hci_stack->le_periodic_sync_skip = skip;
99774bafedd5SMatthias Ringwald     hci_stack->le_periodic_sync_timeout = sync_timeout;
99784bafedd5SMatthias Ringwald     hci_stack->le_periodic_sync_cte_type = sync_cte_type;
99794bafedd5SMatthias Ringwald 
99804bafedd5SMatthias Ringwald     hci_run();
99814bafedd5SMatthias Ringwald     return ERROR_CODE_SUCCESS;
99824bafedd5SMatthias Ringwald }
99834bafedd5SMatthias Ringwald 
99844bafedd5SMatthias Ringwald uint8_t gap_periodic_advertising_create_sync_cancel(void){
99854bafedd5SMatthias Ringwald     // abort if not requested
99864bafedd5SMatthias Ringwald     if (hci_stack->le_periodic_sync_request == LE_CONNECTING_IDLE) {
99874bafedd5SMatthias Ringwald         return ERROR_CODE_COMMAND_DISALLOWED;
99884bafedd5SMatthias Ringwald     }
99894bafedd5SMatthias Ringwald     hci_stack->le_periodic_sync_request = LE_CONNECTING_IDLE;
99904bafedd5SMatthias Ringwald     hci_run();
99914bafedd5SMatthias Ringwald     return ERROR_CODE_SUCCESS;
99924bafedd5SMatthias Ringwald }
99934bafedd5SMatthias Ringwald 
99944bafedd5SMatthias Ringwald uint8_t gap_periodic_advertising_terminate_sync(uint16_t sync_handle){
999549a6c69cSMatthias Ringwald     if (hci_stack->le_periodic_terminate_sync_handle != HCI_CON_HANDLE_INVALID){
999649a6c69cSMatthias Ringwald         return ERROR_CODE_COMMAND_DISALLOWED;
999749a6c69cSMatthias Ringwald     }
999849a6c69cSMatthias Ringwald     hci_stack->le_periodic_terminate_sync_handle = sync_handle;
999949a6c69cSMatthias Ringwald     hci_run();
1000049a6c69cSMatthias Ringwald     return ERROR_CODE_SUCCESS;
100014bafedd5SMatthias Ringwald }
100024bafedd5SMatthias Ringwald 
10003f40c73b4SMatthias Ringwald #endif
10004f40c73b4SMatthias Ringwald #endif
100054ae8623eSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
10006969d876aSMatthias Ringwald static hci_iso_stream_t *
10007969d876aSMatthias Ringwald hci_iso_stream_create(hci_iso_type_t iso_type, hci_iso_stream_state_t state, uint8_t group_id, uint8_t stream_id) {
100084ae8623eSMatthias Ringwald     hci_iso_stream_t * iso_stream = btstack_memory_hci_iso_stream_get();
10009969d876aSMatthias Ringwald     if (iso_stream != NULL){
100108d72db10SMatthias Ringwald         iso_stream->iso_type = iso_type;
1001126b93350SMatthias Ringwald         iso_stream->state = state;
100128d72db10SMatthias Ringwald         iso_stream->group_id = group_id;
10013969d876aSMatthias Ringwald         iso_stream->stream_id = stream_id;
10014969d876aSMatthias Ringwald         iso_stream->cis_handle = HCI_CON_HANDLE_INVALID;
10015969d876aSMatthias Ringwald         iso_stream->acl_handle = HCI_CON_HANDLE_INVALID;
100164ae8623eSMatthias Ringwald         btstack_linked_list_add(&hci_stack->iso_streams, (btstack_linked_item_t*) iso_stream);
100174ae8623eSMatthias Ringwald     }
10018969d876aSMatthias Ringwald     return iso_stream;
100194ae8623eSMatthias Ringwald }
100204ae8623eSMatthias Ringwald 
1002115a15be3SMatthias Ringwald static hci_iso_stream_t * hci_iso_stream_for_con_handle(hci_con_handle_t con_handle){
100224ae8623eSMatthias Ringwald     btstack_linked_list_iterator_t it;
100234ae8623eSMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->iso_streams);
100244ae8623eSMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
100254ae8623eSMatthias Ringwald         hci_iso_stream_t * iso_stream = (hci_iso_stream_t *) btstack_linked_list_iterator_next(&it);
10026969d876aSMatthias Ringwald         if (iso_stream->cis_handle == con_handle ) {
100274ae8623eSMatthias Ringwald             return iso_stream;
100284ae8623eSMatthias Ringwald         }
100294ae8623eSMatthias Ringwald     }
100304ae8623eSMatthias Ringwald     return NULL;
100314ae8623eSMatthias Ringwald }
100324ae8623eSMatthias Ringwald 
100334ae8623eSMatthias Ringwald static void hci_iso_stream_finalize(hci_iso_stream_t * iso_stream){
10034969d876aSMatthias Ringwald     log_info("hci_iso_stream_finalize con_handle 0x%04x, group_id 0x%02x", iso_stream->cis_handle, iso_stream->group_id);
100354ae8623eSMatthias Ringwald     btstack_linked_list_remove(&hci_stack->iso_streams, (btstack_linked_item_t*) iso_stream);
100364ae8623eSMatthias Ringwald     btstack_memory_hci_iso_stream_free(iso_stream);
100374ae8623eSMatthias Ringwald }
100384ae8623eSMatthias Ringwald 
10039778463d0SMatthias Ringwald static void hci_iso_stream_finalize_by_type_and_group_id(hci_iso_type_t iso_type, uint8_t group_id) {
10040778463d0SMatthias Ringwald     btstack_linked_list_iterator_t it;
10041778463d0SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->iso_streams);
10042778463d0SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
10043778463d0SMatthias Ringwald         hci_iso_stream_t * iso_stream = (hci_iso_stream_t *) btstack_linked_list_iterator_next(&it);
10044778463d0SMatthias Ringwald         if ((iso_stream->group_id == group_id) &&
10045778463d0SMatthias Ringwald             (iso_stream->iso_type == iso_type)){
10046778463d0SMatthias Ringwald             btstack_linked_list_iterator_remove(&it);
10047778463d0SMatthias Ringwald             btstack_memory_hci_iso_stream_free(iso_stream);
10048778463d0SMatthias Ringwald         }
10049778463d0SMatthias Ringwald     }
10050778463d0SMatthias Ringwald }
10051778463d0SMatthias Ringwald 
100528d72db10SMatthias Ringwald static void hci_iso_stream_requested_finalize(uint8_t group_id) {
100534ae8623eSMatthias Ringwald     btstack_linked_list_iterator_t it;
100544ae8623eSMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->iso_streams);
100554ae8623eSMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
100564ae8623eSMatthias Ringwald         hci_iso_stream_t * iso_stream = (hci_iso_stream_t *) btstack_linked_list_iterator_next(&it);
10057a90016deSMatthias Ringwald         if ((iso_stream->state == HCI_ISO_STREAM_STATE_REQUESTED ) &&
100588d72db10SMatthias Ringwald             (iso_stream->group_id == group_id)){
100594ae8623eSMatthias Ringwald             btstack_linked_list_iterator_remove(&it);
100604ae8623eSMatthias Ringwald             btstack_memory_hci_iso_stream_free(iso_stream);
100614ae8623eSMatthias Ringwald         }
100624ae8623eSMatthias Ringwald     }
100634ae8623eSMatthias Ringwald }
10064a90016deSMatthias Ringwald static void hci_iso_stream_requested_confirm(uint8_t big_handle){
100654ae8623eSMatthias Ringwald     btstack_linked_list_iterator_t it;
100664ae8623eSMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->iso_streams);
100674ae8623eSMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
100684ae8623eSMatthias Ringwald         hci_iso_stream_t * iso_stream = (hci_iso_stream_t *) btstack_linked_list_iterator_next(&it);
100694ae8623eSMatthias Ringwald         if ( iso_stream->state == HCI_ISO_STREAM_STATE_REQUESTED ) {
100704ae8623eSMatthias Ringwald             iso_stream->state = HCI_ISO_STREAM_STATE_W4_ESTABLISHED;
100714ae8623eSMatthias Ringwald         }
100724ae8623eSMatthias Ringwald     }
100734ae8623eSMatthias Ringwald }
10074d39e4f95SMatthias Ringwald 
10075d39e4f95SMatthias Ringwald static bool hci_iso_sdu_complete(uint8_t * packet, uint16_t size){
10076d39e4f95SMatthias Ringwald     uint8_t  sdu_ts_flag = (packet[1] >> 6) & 1;
10077d39e4f95SMatthias Ringwald     uint16_t sdu_len_offset = 6 + (sdu_ts_flag * 4);
10078d39e4f95SMatthias Ringwald     uint16_t sdu_len = little_endian_read_16(packet, sdu_len_offset) & 0x0fff;
10079d39e4f95SMatthias Ringwald     return (sdu_len_offset + 2 + sdu_len) == size;
10080d39e4f95SMatthias Ringwald }
10081d39e4f95SMatthias Ringwald 
10082750818acSMatthias Ringwald static void hci_iso_packet_handler(hci_iso_stream_t *iso_stream, uint8_t *packet, uint16_t size) {
10083750818acSMatthias Ringwald     if (iso_stream == NULL){
10084750818acSMatthias Ringwald         log_error("acl_handler called with non-registered handle %u!" , READ_ISO_CONNECTION_HANDLE(packet));
10085d39e4f95SMatthias Ringwald         return;
10086d39e4f95SMatthias Ringwald     }
10087750818acSMatthias Ringwald 
10088750818acSMatthias Ringwald     if (hci_stack->iso_packet_handler == NULL) {
10089d39e4f95SMatthias Ringwald         return;
10090d39e4f95SMatthias Ringwald     }
10091d39e4f95SMatthias Ringwald 
10092d39e4f95SMatthias Ringwald     // parse header
10093a14c18deSMatthias Ringwald     uint16_t con_handle_and_flags = little_endian_read_16(packet, 0);
10094a14c18deSMatthias Ringwald     uint16_t data_total_length = little_endian_read_16(packet, 2);
10095a14c18deSMatthias Ringwald     uint8_t  pb_flag = (con_handle_and_flags >> 12) & 3;
10096d39e4f95SMatthias Ringwald 
10097d39e4f95SMatthias Ringwald     // assert packet is complete
10098a14c18deSMatthias Ringwald     if ((data_total_length + 4u) != size){
10099d39e4f95SMatthias Ringwald         return;
10100d39e4f95SMatthias Ringwald     }
10101d39e4f95SMatthias Ringwald 
10102d39e4f95SMatthias Ringwald     if ((pb_flag & 0x01) == 0){
10103d39e4f95SMatthias Ringwald         if (pb_flag == 0x02){
10104a14c18deSMatthias Ringwald             // The ISO_SDU_Fragment field contains a header and a complete SDU.
10105d39e4f95SMatthias Ringwald             if (hci_iso_sdu_complete(packet, size)) {
10106d39e4f95SMatthias Ringwald                 (hci_stack->iso_packet_handler)(HCI_ISO_DATA_PACKET, 0, packet, size);
10107d39e4f95SMatthias Ringwald             }
10108d39e4f95SMatthias Ringwald         } else {
10109d39e4f95SMatthias Ringwald             // The ISO_Data_Load field contains a header and the first fragment of a fragmented SDU.
1011060468fb4SMatthias Ringwald             if (size > sizeof(iso_stream->reassembly_buffer)){
10111d39e4f95SMatthias Ringwald                 return;
10112d39e4f95SMatthias Ringwald             }
10113d39e4f95SMatthias Ringwald             memcpy(iso_stream->reassembly_buffer, packet, size);
10114d39e4f95SMatthias Ringwald             // fix pb_flag
10115d39e4f95SMatthias Ringwald             iso_stream->reassembly_buffer[1] = (iso_stream->reassembly_buffer[1] & 0xcf) | 0x20;
10116d39e4f95SMatthias Ringwald             iso_stream->reassembly_pos = size;
10117d39e4f95SMatthias Ringwald         }
10118d39e4f95SMatthias Ringwald     } else {
10119a14c18deSMatthias Ringwald         // ISO_SDU_Fragment contains continuation or last fragment of an SDU
10120a14c18deSMatthias Ringwald         uint8_t ts_flag = (con_handle_and_flags >> 14) & 1;
10121d39e4f95SMatthias Ringwald         if (ts_flag != 0){
10122d39e4f95SMatthias Ringwald            return;
10123d39e4f95SMatthias Ringwald         }
10124d39e4f95SMatthias Ringwald         // append fragment
10125d39e4f95SMatthias Ringwald         if (iso_stream->reassembly_pos == 0){
10126d39e4f95SMatthias Ringwald             return;
10127d39e4f95SMatthias Ringwald         }
1012860468fb4SMatthias Ringwald 
10129a14c18deSMatthias Ringwald         if ((iso_stream->reassembly_pos + data_total_length) > sizeof(iso_stream->reassembly_buffer)){
10130d39e4f95SMatthias Ringwald             // reset reassembly buffer
10131d39e4f95SMatthias Ringwald             iso_stream->reassembly_pos = 0;
10132d39e4f95SMatthias Ringwald             return;
10133d39e4f95SMatthias Ringwald         }
10134a14c18deSMatthias Ringwald         memcpy(&iso_stream->reassembly_buffer[iso_stream->reassembly_pos], &packet[4], data_total_length);
10135a14c18deSMatthias Ringwald         iso_stream->reassembly_pos += data_total_length;
10136d39e4f95SMatthias Ringwald 
10137d39e4f95SMatthias Ringwald         // deliver if last fragment and SDU complete
10138d39e4f95SMatthias Ringwald         if (pb_flag == 0x03){
10139d39e4f95SMatthias Ringwald             if (hci_iso_sdu_complete(iso_stream->reassembly_buffer, iso_stream->reassembly_pos)){
10140a14c18deSMatthias Ringwald                 // fix data_total_length
1014160468fb4SMatthias Ringwald                 little_endian_store_16(iso_stream->reassembly_buffer, 2, iso_stream->reassembly_pos - HCI_ISO_HEADER_SIZE);
10142d39e4f95SMatthias Ringwald                 (hci_stack->iso_packet_handler)(HCI_ISO_DATA_PACKET, 0, iso_stream->reassembly_buffer, iso_stream->reassembly_pos);
10143d39e4f95SMatthias Ringwald             }
10144a14c18deSMatthias Ringwald             // reset reassembly buffer
10145d39e4f95SMatthias Ringwald             iso_stream->reassembly_pos = 0;
10146d39e4f95SMatthias Ringwald         }
10147d39e4f95SMatthias Ringwald     }
10148d39e4f95SMatthias Ringwald }
10149d39e4f95SMatthias Ringwald 
101507aa35f6aSMatthias Ringwald static void hci_emit_big_created(const le_audio_big_t * big, uint8_t status){
101517aa35f6aSMatthias Ringwald     uint8_t event [6 + (MAX_NR_BIS * 2)];
101527aa35f6aSMatthias Ringwald     uint16_t pos = 0;
101537aa35f6aSMatthias Ringwald     event[pos++] = HCI_EVENT_META_GAP;
101547aa35f6aSMatthias Ringwald     event[pos++] = 4 + (2 * big->num_bis);
101557aa35f6aSMatthias Ringwald     event[pos++] = GAP_SUBEVENT_BIG_CREATED;
101567aa35f6aSMatthias Ringwald     event[pos++] = status;
101577aa35f6aSMatthias Ringwald     event[pos++] = big->big_handle;
101587aa35f6aSMatthias Ringwald     event[pos++] = big->num_bis;
101597aa35f6aSMatthias Ringwald     uint8_t i;
101607aa35f6aSMatthias Ringwald     for (i=0;i<big->num_bis;i++){
101617aa35f6aSMatthias Ringwald         little_endian_store_16(event, pos, big->bis_con_handles[i]);
101627aa35f6aSMatthias Ringwald         pos += 2;
101637aa35f6aSMatthias Ringwald     }
101647aa35f6aSMatthias Ringwald     hci_emit_event(event, pos, 0);
101657aa35f6aSMatthias Ringwald }
101667aa35f6aSMatthias Ringwald 
10167d3a89d91SMatthias Ringwald static void hci_emit_cig_created(const le_audio_cig_t * cig, uint8_t status){
10168d3a89d91SMatthias Ringwald     uint8_t event [6 + (MAX_NR_CIS * 2)];
10169d3a89d91SMatthias Ringwald     uint16_t pos = 0;
10170d3a89d91SMatthias Ringwald     event[pos++] = HCI_EVENT_META_GAP;
10171d3a89d91SMatthias Ringwald     event[pos++] = 4 + (2 * cig->num_cis);
10172d3a89d91SMatthias Ringwald     event[pos++] = GAP_SUBEVENT_CIG_CREATED;
10173d3a89d91SMatthias Ringwald     event[pos++] = status;
10174d3a89d91SMatthias Ringwald     event[pos++] = cig->cig_id;
10175d3a89d91SMatthias Ringwald     event[pos++] = cig->num_cis;
10176d3a89d91SMatthias Ringwald     uint8_t i;
10177d3a89d91SMatthias Ringwald     for (i=0;i<cig->num_cis;i++){
10178d3a89d91SMatthias Ringwald         little_endian_store_16(event, pos, cig->cis_con_handles[i]);
10179d3a89d91SMatthias Ringwald         pos += 2;
10180d3a89d91SMatthias Ringwald     }
10181d3a89d91SMatthias Ringwald     hci_emit_event(event, pos, 0);
10182d3a89d91SMatthias Ringwald }
10183f06bb90fSMatthias Ringwald 
10184620553bdSMatthias Ringwald static uint16_t hci_setup_cis_created(uint8_t * event, hci_iso_stream_t * iso_stream, uint8_t status) {
10185f06bb90fSMatthias Ringwald     uint16_t pos = 0;
10186f06bb90fSMatthias Ringwald     event[pos++] = HCI_EVENT_META_GAP;
10187cf439c63SMatthias Ringwald     event[pos++] = 8;
10188f06bb90fSMatthias Ringwald     event[pos++] = GAP_SUBEVENT_CIS_CREATED;
10189f06bb90fSMatthias Ringwald     event[pos++] = status;
10190620553bdSMatthias Ringwald     event[pos++] = iso_stream->group_id;
10191620553bdSMatthias Ringwald     event[pos++] = iso_stream->stream_id;
10192620553bdSMatthias Ringwald     little_endian_store_16(event, pos, iso_stream->cis_handle);
10193f06bb90fSMatthias Ringwald     pos += 2;
10194620553bdSMatthias Ringwald     little_endian_store_16(event, pos, iso_stream->acl_handle);
10195cf439c63SMatthias Ringwald     pos += 2;
101967dd97f73SMatthias Ringwald     little_endian_store_16(event, pos, iso_stream->iso_interval_1250us);
101977dd97f73SMatthias Ringwald     pos += 2;
101987dd97f73SMatthias Ringwald     event[pos++] = iso_stream->number_of_subevents;
101997dd97f73SMatthias Ringwald     event[pos++] = iso_stream->burst_number_c_to_p;
102007dd97f73SMatthias Ringwald     event[pos++] = iso_stream->burst_number_p_to_c;
102017dd97f73SMatthias Ringwald     event[pos++] = iso_stream->flush_timeout_c_to_p;
102027dd97f73SMatthias Ringwald     event[pos++] = iso_stream->flush_timeout_p_to_c;
10203620553bdSMatthias Ringwald     return pos;
10204f06bb90fSMatthias Ringwald }
10205f06bb90fSMatthias Ringwald 
1020614045fdbSMatthias Ringwald // emits GAP_SUBEVENT_CIS_CREATED after calling hci_iso_finalize
1020714045fdbSMatthias Ringwald static void hci_cis_handle_created(hci_iso_stream_t * iso_stream, uint8_t status){
1020814045fdbSMatthias Ringwald     // cache data before finalizing struct
102097dd97f73SMatthias Ringwald     uint8_t event [17];
10210620553bdSMatthias Ringwald     uint16_t pos = hci_setup_cis_created(event, iso_stream, status);
10211620553bdSMatthias Ringwald     btstack_assert(pos <= sizeof(event));
1021214045fdbSMatthias Ringwald     if (status != ERROR_CODE_SUCCESS){
1021314045fdbSMatthias Ringwald         hci_iso_stream_finalize(iso_stream);
1021414045fdbSMatthias Ringwald     }
10215620553bdSMatthias Ringwald     hci_emit_event(event, pos, 0);
1021614045fdbSMatthias Ringwald }
1021714045fdbSMatthias Ringwald 
102187aa35f6aSMatthias Ringwald static void hci_emit_big_terminated(const le_audio_big_t * big){
102197aa35f6aSMatthias Ringwald     uint8_t event [4];
102207aa35f6aSMatthias Ringwald     uint16_t pos = 0;
102217aa35f6aSMatthias Ringwald     event[pos++] = HCI_EVENT_META_GAP;
102227aa35f6aSMatthias Ringwald     event[pos++] = 2;
102237aa35f6aSMatthias Ringwald     event[pos++] = GAP_SUBEVENT_BIG_TERMINATED;
102247aa35f6aSMatthias Ringwald     event[pos++] = big->big_handle;
102257aa35f6aSMatthias Ringwald     hci_emit_event(event, pos, 0);
102267aa35f6aSMatthias Ringwald }
102277aa35f6aSMatthias Ringwald 
102282a6c0f82SMatthias Ringwald static void hci_emit_big_sync_created(const le_audio_big_sync_t * big_sync, uint8_t status){
102292a6c0f82SMatthias Ringwald     uint8_t event [6 + (MAX_NR_BIS * 2)];
102302a6c0f82SMatthias Ringwald     uint16_t pos = 0;
102312a6c0f82SMatthias Ringwald     event[pos++] = HCI_EVENT_META_GAP;
102322a6c0f82SMatthias Ringwald     event[pos++] = 4;
102332a6c0f82SMatthias Ringwald     event[pos++] = GAP_SUBEVENT_BIG_SYNC_CREATED;
102342a6c0f82SMatthias Ringwald     event[pos++] = status;
102352a6c0f82SMatthias Ringwald     event[pos++] = big_sync->big_handle;
102362a6c0f82SMatthias Ringwald     event[pos++] = big_sync->num_bis;
102372a6c0f82SMatthias Ringwald     uint8_t i;
102382a6c0f82SMatthias Ringwald     for (i=0;i<big_sync->num_bis;i++){
102392a6c0f82SMatthias Ringwald         little_endian_store_16(event, pos, big_sync->bis_con_handles[i]);
102402a6c0f82SMatthias Ringwald         pos += 2;
102412a6c0f82SMatthias Ringwald     }
102422a6c0f82SMatthias Ringwald     hci_emit_event(event, pos, 0);
102432a6c0f82SMatthias Ringwald }
102442a6c0f82SMatthias Ringwald 
10245d04a9afcSMatthias Ringwald static void hci_emit_big_sync_stopped(uint8_t big_handle){
102462a6c0f82SMatthias Ringwald     uint8_t event [4];
102472a6c0f82SMatthias Ringwald     uint16_t pos = 0;
102482a6c0f82SMatthias Ringwald     event[pos++] = HCI_EVENT_META_GAP;
102492a6c0f82SMatthias Ringwald     event[pos++] = 2;
102502a6c0f82SMatthias Ringwald     event[pos++] = GAP_SUBEVENT_BIG_SYNC_STOPPED;
10251d04a9afcSMatthias Ringwald     event[pos++] = big_handle;
102522a6c0f82SMatthias Ringwald     hci_emit_event(event, pos, 0);
102532a6c0f82SMatthias Ringwald }
102542a6c0f82SMatthias Ringwald 
102555ade6657SMatthias Ringwald static void hci_emit_bis_can_send_now(const le_audio_big_t *big, uint8_t bis_index) {
102565ade6657SMatthias Ringwald     uint8_t event[6];
102575ade6657SMatthias Ringwald     uint16_t pos = 0;
102585ade6657SMatthias Ringwald     event[pos++] = HCI_EVENT_BIS_CAN_SEND_NOW;
102595ade6657SMatthias Ringwald     event[pos++] = sizeof(event) - 2;
102605ade6657SMatthias Ringwald     event[pos++] = big->big_handle;
102615ade6657SMatthias Ringwald     event[pos++] = bis_index;
102625ade6657SMatthias Ringwald     little_endian_store_16(event, pos, big->bis_con_handles[bis_index]);
102635ade6657SMatthias Ringwald     hci_emit_event(&event[0], sizeof(event), 0);  // don't dump
102645ade6657SMatthias Ringwald }
102655ade6657SMatthias Ringwald 
102662c077771SMatthias Ringwald static void hci_emit_cis_can_send_now(hci_con_handle_t cis_con_handle) {
102672c077771SMatthias Ringwald     uint8_t event[4];
102682c077771SMatthias Ringwald     uint16_t pos = 0;
102692c077771SMatthias Ringwald     event[pos++] = HCI_EVENT_CIS_CAN_SEND_NOW;
102702c077771SMatthias Ringwald     event[pos++] = sizeof(event) - 2;
102712c077771SMatthias Ringwald     little_endian_store_16(event, pos, cis_con_handle);
102722c077771SMatthias Ringwald     hci_emit_event(&event[0], sizeof(event), 0);  // don't dump
102732c077771SMatthias Ringwald }
102742c077771SMatthias Ringwald 
102757aa35f6aSMatthias Ringwald static le_audio_big_t * hci_big_for_handle(uint8_t big_handle){
102767aa35f6aSMatthias Ringwald     btstack_linked_list_iterator_t it;
102777aa35f6aSMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->le_audio_bigs);
102787aa35f6aSMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
102797aa35f6aSMatthias Ringwald         le_audio_big_t * big = (le_audio_big_t *) btstack_linked_list_iterator_next(&it);
102807aa35f6aSMatthias Ringwald         if ( big->big_handle == big_handle ) {
102817aa35f6aSMatthias Ringwald             return big;
102827aa35f6aSMatthias Ringwald         }
102837aa35f6aSMatthias Ringwald     }
102847aa35f6aSMatthias Ringwald     return NULL;
102857aa35f6aSMatthias Ringwald }
102867aa35f6aSMatthias Ringwald 
102872a6c0f82SMatthias Ringwald static le_audio_big_sync_t * hci_big_sync_for_handle(uint8_t big_handle){
102882a6c0f82SMatthias Ringwald     btstack_linked_list_iterator_t it;
102892a6c0f82SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->le_audio_big_syncs);
102902a6c0f82SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
102912a6c0f82SMatthias Ringwald         le_audio_big_sync_t * big_sync = (le_audio_big_sync_t *) btstack_linked_list_iterator_next(&it);
102922a6c0f82SMatthias Ringwald         if ( big_sync->big_handle == big_handle ) {
102932a6c0f82SMatthias Ringwald             return big_sync;
102942a6c0f82SMatthias Ringwald         }
102952a6c0f82SMatthias Ringwald     }
102962a6c0f82SMatthias Ringwald     return NULL;
102972a6c0f82SMatthias Ringwald }
102982a6c0f82SMatthias Ringwald 
1029901d4f05fSMatthias Ringwald void hci_set_num_iso_packets_to_queue(uint8_t num_packets){
1030001d4f05fSMatthias Ringwald     hci_stack->iso_packets_to_queue = num_packets;
1030101d4f05fSMatthias Ringwald }
1030201d4f05fSMatthias Ringwald 
10303d3a89d91SMatthias Ringwald static le_audio_cig_t * hci_cig_for_id(uint8_t cig_id){
10304d3a89d91SMatthias Ringwald     btstack_linked_list_iterator_t it;
10305d3a89d91SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->le_audio_cigs);
10306d3a89d91SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
10307d3a89d91SMatthias Ringwald         le_audio_cig_t * cig = (le_audio_cig_t *) btstack_linked_list_iterator_next(&it);
10308d3a89d91SMatthias Ringwald         if ( cig->cig_id == cig_id ) {
10309d3a89d91SMatthias Ringwald             return cig;
10310d3a89d91SMatthias Ringwald         }
10311d3a89d91SMatthias Ringwald     }
10312d3a89d91SMatthias Ringwald     return NULL;
10313d3a89d91SMatthias Ringwald }
10314d3a89d91SMatthias Ringwald 
103155ade6657SMatthias Ringwald static void hci_iso_notify_can_send_now(void){
103162c077771SMatthias Ringwald 
103172c077771SMatthias Ringwald     // BIG
103182c077771SMatthias Ringwald 
103195ade6657SMatthias Ringwald     btstack_linked_list_iterator_t it;
103205ade6657SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->le_audio_bigs);
103215ade6657SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
103225ade6657SMatthias Ringwald         le_audio_big_t * big = (le_audio_big_t *) btstack_linked_list_iterator_next(&it);
10323aacb1081SMatthias Ringwald         // track number completed packet timestamps
10324aacb1081SMatthias Ringwald         if (big->num_completed_timestamp_current_valid){
10325aacb1081SMatthias Ringwald             big->num_completed_timestamp_current_valid = false;
10326aacb1081SMatthias Ringwald             if (big->num_completed_timestamp_previous_valid){
10327aacb1081SMatthias Ringwald                 // detect delayed sending of all BIS: tolerate up to 50% delayed event handling
10328aacb1081SMatthias Ringwald                 uint32_t iso_interval_missed_threshold_ms = big->params->sdu_interval_us * 3 / 2000;
10329aacb1081SMatthias Ringwald                 int32_t  num_completed_timestamp_delta_ms = btstack_time_delta(big->num_completed_timestamp_current_ms,
10330aacb1081SMatthias Ringwald                                                                                big->num_completed_timestamp_previous_ms);
10331aacb1081SMatthias Ringwald                 if (num_completed_timestamp_delta_ms > iso_interval_missed_threshold_ms){
10332aacb1081SMatthias Ringwald                     // to catch up, skip packet on all BIS
10333aacb1081SMatthias Ringwald                     uint8_t i;
10334aacb1081SMatthias Ringwald                     for (i=0;i<big->num_bis;i++){
10335aacb1081SMatthias Ringwald                         hci_iso_stream_t * iso_stream = hci_iso_stream_for_con_handle(big->bis_con_handles[i]);
10336aacb1081SMatthias Ringwald                         if (iso_stream){
10337aacb1081SMatthias Ringwald                             iso_stream->num_packets_to_skip++;
10338aacb1081SMatthias Ringwald                         }
10339aacb1081SMatthias Ringwald                     }
10340aacb1081SMatthias Ringwald                 }
10341aacb1081SMatthias Ringwald             }
10342aacb1081SMatthias Ringwald             big->num_completed_timestamp_previous_valid = true;
10343aacb1081SMatthias Ringwald             big->num_completed_timestamp_previous_ms = big->num_completed_timestamp_current_ms;
10344aacb1081SMatthias Ringwald         }
10345aacb1081SMatthias Ringwald 
103465ade6657SMatthias Ringwald         if (big->can_send_now_requested){
10347d4e5d4faSMatthias Ringwald             // check if no outgoing iso packets pending and no can send now have to be emitted
103485ade6657SMatthias Ringwald             uint8_t i;
103495ade6657SMatthias Ringwald             bool can_send = true;
10350aacb1081SMatthias Ringwald             uint8_t num_iso_queued_minimum = 0;
103515ade6657SMatthias Ringwald             for (i=0;i<big->num_bis;i++){
103525ade6657SMatthias Ringwald                 hci_iso_stream_t * iso_stream = hci_iso_stream_for_con_handle(big->bis_con_handles[i]);
10353aacb1081SMatthias Ringwald                 if (iso_stream == NULL) continue;
10354aacb1081SMatthias Ringwald                 // handle case where individual ISO packet was sent too late:
10355aacb1081SMatthias Ringwald                 // for each additionally queued packet, a new one needs to get skipped
10356aacb1081SMatthias Ringwald                 if (i==0){
10357aacb1081SMatthias Ringwald                     num_iso_queued_minimum = iso_stream->num_packets_sent;
10358aacb1081SMatthias Ringwald                 } else if (iso_stream->num_packets_sent > num_iso_queued_minimum){
10359aacb1081SMatthias Ringwald                     uint8_t num_packets_to_skip = iso_stream->num_packets_sent - num_iso_queued_minimum;
10360aacb1081SMatthias Ringwald                     iso_stream->num_packets_to_skip += num_packets_to_skip;
10361aacb1081SMatthias Ringwald                     iso_stream->num_packets_sent    -= num_packets_to_skip;
10362aacb1081SMatthias Ringwald                 }
10363aacb1081SMatthias Ringwald                 // check if we can send now
10364aacb1081SMatthias Ringwald                 if  ((iso_stream->num_packets_sent >= hci_stack->iso_packets_to_queue) || (iso_stream->emit_ready_to_send)){
103655ade6657SMatthias Ringwald                     can_send = false;
103665ade6657SMatthias Ringwald                     break;
103675ade6657SMatthias Ringwald                 }
103685ade6657SMatthias Ringwald             }
103695ade6657SMatthias Ringwald             if (can_send){
103705ade6657SMatthias Ringwald                 // propagate can send now to individual streams
103715ade6657SMatthias Ringwald                 big->can_send_now_requested = false;
103725ade6657SMatthias Ringwald                 for (i=0;i<big->num_bis;i++){
103735ade6657SMatthias Ringwald                     hci_iso_stream_t * iso_stream = hci_iso_stream_for_con_handle(big->bis_con_handles[i]);
103745ade6657SMatthias Ringwald                     iso_stream->emit_ready_to_send = true;
103755ade6657SMatthias Ringwald                 }
103765ade6657SMatthias Ringwald             }
103775ade6657SMatthias Ringwald         }
103785ade6657SMatthias Ringwald     }
103795ade6657SMatthias Ringwald 
103805ade6657SMatthias Ringwald     if (hci_stack->hci_packet_buffer_reserved) return;
103815ade6657SMatthias Ringwald 
103825ade6657SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->le_audio_bigs);
103835ade6657SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
103845ade6657SMatthias Ringwald         le_audio_big_t * big = (le_audio_big_t *) btstack_linked_list_iterator_next(&it);
103855ade6657SMatthias Ringwald         // report bis ready
103865ade6657SMatthias Ringwald         uint8_t i;
103875ade6657SMatthias Ringwald         for (i=0;i<big->num_bis;i++){
103885ade6657SMatthias Ringwald             hci_iso_stream_t * iso_stream = hci_iso_stream_for_con_handle(big->bis_con_handles[i]);
103895ade6657SMatthias Ringwald             if ((iso_stream != NULL) && iso_stream->emit_ready_to_send){
103905ade6657SMatthias Ringwald                 iso_stream->emit_ready_to_send = false;
103915ade6657SMatthias Ringwald                 hci_emit_bis_can_send_now(big, i);
103925ade6657SMatthias Ringwald                 break;
103935ade6657SMatthias Ringwald             }
103945ade6657SMatthias Ringwald         }
103955ade6657SMatthias Ringwald     }
103962c077771SMatthias Ringwald 
103972c077771SMatthias Ringwald     // CIS
103982c077771SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->iso_streams);
103992c077771SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)) {
104002c077771SMatthias Ringwald         hci_iso_stream_t *iso_stream = (hci_iso_stream_t *) btstack_linked_list_iterator_next(&it);
104012c077771SMatthias Ringwald         if ((iso_stream->can_send_now_requested) &&
104022c077771SMatthias Ringwald             (iso_stream->num_packets_sent < hci_stack->iso_packets_to_queue)){
104032c077771SMatthias Ringwald             iso_stream->can_send_now_requested = false;
10404969d876aSMatthias Ringwald             hci_emit_cis_can_send_now(iso_stream->cis_handle);
104052c077771SMatthias Ringwald         }
104062c077771SMatthias Ringwald     }
104075ade6657SMatthias Ringwald }
104085ade6657SMatthias Ringwald 
10409c7308688SMatthias Ringwald static uint8_t gap_big_setup_iso_streams(uint8_t num_bis, uint8_t big_handle){
10410d034696aSMatthias Ringwald     // make big handle unique and usuable for big and big sync
10411c7308688SMatthias Ringwald     if (hci_big_for_handle(big_handle) != NULL){
104127aa35f6aSMatthias Ringwald         return ERROR_CODE_ACL_CONNECTION_ALREADY_EXISTS;
104137aa35f6aSMatthias Ringwald     }
10414c7308688SMatthias Ringwald     if (hci_big_sync_for_handle(big_handle) != NULL){
10415d034696aSMatthias Ringwald         return ERROR_CODE_ACL_CONNECTION_ALREADY_EXISTS;
10416d034696aSMatthias Ringwald     }
10417c7308688SMatthias Ringwald     if (num_bis == 0){
104187aa35f6aSMatthias Ringwald         return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS;
104197aa35f6aSMatthias Ringwald     }
10420c7308688SMatthias Ringwald     if (num_bis > MAX_NR_BIS){
104217aa35f6aSMatthias Ringwald         return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS;
104227aa35f6aSMatthias Ringwald     }
104237aa35f6aSMatthias Ringwald 
10424fb16346aSMatthias Ringwald     // reserve ISO Streams
10425fb16346aSMatthias Ringwald     uint8_t i;
10426fb16346aSMatthias Ringwald     uint8_t status = ERROR_CODE_SUCCESS;
10427c7308688SMatthias Ringwald     for (i=0;i<num_bis;i++){
10428c7308688SMatthias Ringwald         hci_iso_stream_t * iso_stream = hci_iso_stream_create(HCI_ISO_TYPE_BIS, HCI_ISO_STREAM_STATE_REQUESTED, big_handle, i);
10429969d876aSMatthias Ringwald         if (iso_stream == NULL) {
10430969d876aSMatthias Ringwald             status = ERROR_CODE_MEMORY_CAPACITY_EXCEEDED;
10431fb16346aSMatthias Ringwald             break;
10432fb16346aSMatthias Ringwald         }
10433fb16346aSMatthias Ringwald     }
10434fb16346aSMatthias Ringwald 
10435fb16346aSMatthias Ringwald     // free structs on error
10436fb16346aSMatthias Ringwald     if (status != ERROR_CODE_SUCCESS){
10437c7308688SMatthias Ringwald         hci_iso_stream_finalize_by_type_and_group_id(HCI_ISO_TYPE_BIS, big_handle);
10438c7308688SMatthias Ringwald     }
10439c7308688SMatthias Ringwald 
10440c7308688SMatthias Ringwald     return status;
10441c7308688SMatthias Ringwald }
10442c7308688SMatthias Ringwald 
10443c7308688SMatthias Ringwald uint8_t gap_big_create(le_audio_big_t * storage, le_audio_big_params_t * big_params){
10444c7308688SMatthias Ringwald     uint8_t status = gap_big_setup_iso_streams(big_params->num_bis, big_params->big_handle);
10445c7308688SMatthias Ringwald     if (status != ERROR_CODE_SUCCESS){
10446fb16346aSMatthias Ringwald         return status;
10447fb16346aSMatthias Ringwald     }
10448fb16346aSMatthias Ringwald 
104497aa35f6aSMatthias Ringwald     le_audio_big_t * big = storage;
104507aa35f6aSMatthias Ringwald     big->big_handle = big_params->big_handle;
104517aa35f6aSMatthias Ringwald     big->params = big_params;
104527aa35f6aSMatthias Ringwald     big->state = LE_AUDIO_BIG_STATE_CREATE;
104537aa35f6aSMatthias Ringwald     big->num_bis = big_params->num_bis;
104547aa35f6aSMatthias Ringwald     btstack_linked_list_add(&hci_stack->le_audio_bigs, (btstack_linked_item_t *) big);
104557aa35f6aSMatthias Ringwald 
104567aa35f6aSMatthias Ringwald     hci_run();
104577aa35f6aSMatthias Ringwald 
104587aa35f6aSMatthias Ringwald     return ERROR_CODE_SUCCESS;
104597aa35f6aSMatthias Ringwald }
104607aa35f6aSMatthias Ringwald 
104612a6c0f82SMatthias Ringwald uint8_t gap_big_sync_create(le_audio_big_sync_t * storage, le_audio_big_sync_params_t * big_sync_params){
10462c7308688SMatthias Ringwald     uint8_t status = gap_big_setup_iso_streams(big_sync_params->num_bis, big_sync_params->big_handle);
1046302e19895SMatthias Ringwald     if (status != ERROR_CODE_SUCCESS){
1046402e19895SMatthias Ringwald         return status;
1046502e19895SMatthias Ringwald     }
1046602e19895SMatthias Ringwald 
104672a6c0f82SMatthias Ringwald     le_audio_big_sync_t * big_sync = storage;
104682a6c0f82SMatthias Ringwald     big_sync->big_handle = big_sync_params->big_handle;
104692a6c0f82SMatthias Ringwald     big_sync->params = big_sync_params;
104702a6c0f82SMatthias Ringwald     big_sync->state = LE_AUDIO_BIG_STATE_CREATE;
104712a6c0f82SMatthias Ringwald     big_sync->num_bis = big_sync_params->num_bis;
104722a6c0f82SMatthias Ringwald     btstack_linked_list_add(&hci_stack->le_audio_big_syncs, (btstack_linked_item_t *) big_sync);
104732a6c0f82SMatthias Ringwald 
104742a6c0f82SMatthias Ringwald     hci_run();
104752a6c0f82SMatthias Ringwald 
104762a6c0f82SMatthias Ringwald     return ERROR_CODE_SUCCESS;
104772a6c0f82SMatthias Ringwald }
104782a6c0f82SMatthias Ringwald 
104797aa35f6aSMatthias Ringwald uint8_t gap_big_terminate(uint8_t big_handle){
104807aa35f6aSMatthias Ringwald     le_audio_big_t * big = hci_big_for_handle(big_handle);
104817aa35f6aSMatthias Ringwald     if (big == NULL){
104827aa35f6aSMatthias Ringwald         return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
104837aa35f6aSMatthias Ringwald     }
104847aa35f6aSMatthias Ringwald     switch (big->state){
104857aa35f6aSMatthias Ringwald         case LE_AUDIO_BIG_STATE_CREATE:
104867aa35f6aSMatthias Ringwald             btstack_linked_list_remove(&hci_stack->le_audio_bigs, (btstack_linked_item_t *) big);
104872a6c0f82SMatthias Ringwald             hci_emit_big_terminated(big);
104882a6c0f82SMatthias Ringwald             break;
104892a6c0f82SMatthias Ringwald         case LE_AUDIO_BIG_STATE_W4_SETUP_ISO_PATH:
104902a6c0f82SMatthias Ringwald             big->state = LE_AUDIO_BIG_STATE_W4_SETUP_ISO_PATH_THEN_TERMINATE;
104917aa35f6aSMatthias Ringwald             break;
104927aa35f6aSMatthias Ringwald         case LE_AUDIO_BIG_STATE_W4_ESTABLISHED:
104937aa35f6aSMatthias Ringwald         case LE_AUDIO_BIG_STATE_SETUP_ISO_PATH:
104947aa35f6aSMatthias Ringwald         case LE_AUDIO_BIG_STATE_ACTIVE:
104957aa35f6aSMatthias Ringwald             big->state = LE_AUDIO_BIG_STATE_TERMINATE;
104967aa35f6aSMatthias Ringwald             hci_run();
104977aa35f6aSMatthias Ringwald             break;
104982a6c0f82SMatthias Ringwald         default:
104992a6c0f82SMatthias Ringwald             return ERROR_CODE_COMMAND_DISALLOWED;
105002a6c0f82SMatthias Ringwald     }
105012a6c0f82SMatthias Ringwald     return ERROR_CODE_SUCCESS;
105022a6c0f82SMatthias Ringwald }
105032a6c0f82SMatthias Ringwald 
105042a6c0f82SMatthias Ringwald uint8_t gap_big_sync_terminate(uint8_t big_handle){
105052a6c0f82SMatthias Ringwald     le_audio_big_sync_t * big_sync = hci_big_sync_for_handle(big_handle);
105062a6c0f82SMatthias Ringwald     if (big_sync == NULL){
105072a6c0f82SMatthias Ringwald         return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
105082a6c0f82SMatthias Ringwald     }
105092a6c0f82SMatthias Ringwald     switch (big_sync->state){
105102a6c0f82SMatthias Ringwald         case LE_AUDIO_BIG_STATE_CREATE:
105112a6c0f82SMatthias Ringwald             btstack_linked_list_remove(&hci_stack->le_audio_big_syncs, (btstack_linked_item_t *) big_sync);
10512d04a9afcSMatthias Ringwald             hci_emit_big_sync_stopped(big_handle);
105132a6c0f82SMatthias Ringwald             break;
105147aa35f6aSMatthias Ringwald         case LE_AUDIO_BIG_STATE_W4_SETUP_ISO_PATH:
105152a6c0f82SMatthias Ringwald             big_sync->state = LE_AUDIO_BIG_STATE_W4_SETUP_ISO_PATH_THEN_TERMINATE;
105162a6c0f82SMatthias Ringwald             break;
105172a6c0f82SMatthias Ringwald         case LE_AUDIO_BIG_STATE_W4_ESTABLISHED:
105182a6c0f82SMatthias Ringwald         case LE_AUDIO_BIG_STATE_SETUP_ISO_PATH:
105192a6c0f82SMatthias Ringwald         case LE_AUDIO_BIG_STATE_ACTIVE:
105202a6c0f82SMatthias Ringwald             big_sync->state = LE_AUDIO_BIG_STATE_TERMINATE;
105212a6c0f82SMatthias Ringwald             hci_run();
105227aa35f6aSMatthias Ringwald             break;
105237aa35f6aSMatthias Ringwald         default:
105247aa35f6aSMatthias Ringwald             return ERROR_CODE_COMMAND_DISALLOWED;
105257aa35f6aSMatthias Ringwald     }
105267aa35f6aSMatthias Ringwald     return ERROR_CODE_SUCCESS;
105277aa35f6aSMatthias Ringwald }
10528d39e4f95SMatthias Ringwald 
105295ade6657SMatthias Ringwald uint8_t hci_request_bis_can_send_now_events(uint8_t big_handle){
105305ade6657SMatthias Ringwald     le_audio_big_t * big = hci_big_for_handle(big_handle);
105315ade6657SMatthias Ringwald     if (big == NULL){
105325ade6657SMatthias Ringwald         return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
105335ade6657SMatthias Ringwald     }
105345ade6657SMatthias Ringwald     if (big->state != LE_AUDIO_BIG_STATE_ACTIVE){
105355ade6657SMatthias Ringwald         return ERROR_CODE_COMMAND_DISALLOWED;
105365ade6657SMatthias Ringwald     }
105375ade6657SMatthias Ringwald     big->can_send_now_requested = true;
105385ade6657SMatthias Ringwald     hci_iso_notify_can_send_now();
105395ade6657SMatthias Ringwald     return ERROR_CODE_SUCCESS;
105405ade6657SMatthias Ringwald }
10541d3a89d91SMatthias Ringwald 
105422c077771SMatthias Ringwald uint8_t hci_request_cis_can_send_now_events(hci_con_handle_t cis_con_handle){
105432c077771SMatthias Ringwald     hci_iso_stream_t * iso_stream = hci_iso_stream_for_con_handle(cis_con_handle);
105442c077771SMatthias Ringwald     if (iso_stream == NULL){
105452c077771SMatthias Ringwald         return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
105462c077771SMatthias Ringwald     }
105472c077771SMatthias Ringwald     if ((iso_stream->iso_type != HCI_ISO_TYPE_CIS) && (iso_stream->state != HCI_ISO_STREAM_STATE_ESTABLISHED)) {
105482c077771SMatthias Ringwald         return ERROR_CODE_COMMAND_DISALLOWED;
105492c077771SMatthias Ringwald     }
105502c077771SMatthias Ringwald     iso_stream->can_send_now_requested = true;
105512c077771SMatthias Ringwald     hci_iso_notify_can_send_now();
105522c077771SMatthias Ringwald     return ERROR_CODE_SUCCESS;
105532c077771SMatthias Ringwald }
105542c077771SMatthias Ringwald 
10555d3a89d91SMatthias Ringwald uint8_t gap_cig_create(le_audio_cig_t * storage, le_audio_cig_params_t * cig_params){
10556d3a89d91SMatthias Ringwald     if (hci_cig_for_id(cig_params->cig_id) != NULL){
10557d3a89d91SMatthias Ringwald         return ERROR_CODE_ACL_CONNECTION_ALREADY_EXISTS;
10558d3a89d91SMatthias Ringwald     }
10559d3a89d91SMatthias Ringwald     if (cig_params->num_cis == 0){
10560d3a89d91SMatthias Ringwald         return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS;
10561d3a89d91SMatthias Ringwald     }
105623e377057SMatthias Ringwald     if (cig_params->num_cis > MAX_NR_CIS){
10563d3a89d91SMatthias Ringwald         return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS;
10564d3a89d91SMatthias Ringwald     }
10565d3a89d91SMatthias Ringwald 
10566d3a89d91SMatthias Ringwald     // reserve ISO Streams
10567d3a89d91SMatthias Ringwald     uint8_t i;
10568d3a89d91SMatthias Ringwald     uint8_t status = ERROR_CODE_SUCCESS;
10569d3a89d91SMatthias Ringwald     for (i=0;i<cig_params->num_cis;i++){
10570969d876aSMatthias Ringwald         hci_iso_stream_t * iso_stream = hci_iso_stream_create(HCI_ISO_TYPE_CIS,HCI_ISO_STREAM_STATE_REQUESTED, cig_params->cig_id, i);
1057136468e6fSMatthias Ringwald         if (iso_stream == NULL) {
10572969d876aSMatthias Ringwald             status = ERROR_CODE_MEMORY_CAPACITY_EXCEEDED;
10573d3a89d91SMatthias Ringwald             break;
10574d3a89d91SMatthias Ringwald         }
10575d3a89d91SMatthias Ringwald     }
10576d3a89d91SMatthias Ringwald 
10577d3a89d91SMatthias Ringwald     // free structs on error
10578d3a89d91SMatthias Ringwald     if (status != ERROR_CODE_SUCCESS){
10579d3a89d91SMatthias Ringwald         hci_iso_stream_finalize_by_type_and_group_id(HCI_ISO_TYPE_CIS, cig_params->cig_id);
10580d3a89d91SMatthias Ringwald         return status;
10581d3a89d91SMatthias Ringwald     }
10582d3a89d91SMatthias Ringwald 
10583d3a89d91SMatthias Ringwald     le_audio_cig_t * cig = storage;
10584d3a89d91SMatthias Ringwald     cig->cig_id = cig_params->cig_id;
10585d3a89d91SMatthias Ringwald     cig->num_cis = cig_params->num_cis;
10586d3a89d91SMatthias Ringwald     cig->params = cig_params;
10587d3a89d91SMatthias Ringwald     cig->state = LE_AUDIO_CIG_STATE_CREATE;
10588444e371eSMatthias Ringwald     for (i=0;i<cig->num_cis;i++){
10589444e371eSMatthias Ringwald         cig->cis_con_handles[i] = HCI_CON_HANDLE_INVALID;
10590444e371eSMatthias Ringwald         cig->acl_con_handles[i] = HCI_CON_HANDLE_INVALID;
105910f0ba168SMatthias Ringwald         cig->cis_setup_active[i] = false;
105920f0ba168SMatthias Ringwald         cig->cis_established[i] = false;
10593444e371eSMatthias Ringwald     }
10594d3a89d91SMatthias Ringwald     btstack_linked_list_add(&hci_stack->le_audio_cigs, (btstack_linked_item_t *) cig);
10595d3a89d91SMatthias Ringwald 
10596d3a89d91SMatthias Ringwald     hci_run();
10597d3a89d91SMatthias Ringwald 
10598d3a89d91SMatthias Ringwald     return ERROR_CODE_SUCCESS;
10599d3a89d91SMatthias Ringwald }
10600d3a89d91SMatthias Ringwald 
10601d90722d4SMatthias Ringwald uint8_t gap_cig_remove(uint8_t cig_id){
10602d90722d4SMatthias Ringwald     le_audio_cig_t * cig = hci_cig_for_id(cig_id);
10603d90722d4SMatthias Ringwald     if (cig == NULL){
10604d90722d4SMatthias Ringwald         return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
10605d90722d4SMatthias Ringwald     }
10606d90722d4SMatthias Ringwald 
10607d90722d4SMatthias Ringwald     // close active CIS
10608d90722d4SMatthias Ringwald     uint8_t i;
10609d90722d4SMatthias Ringwald     for (i=0;i<cig->num_cis;i++){
10610d90722d4SMatthias Ringwald         hci_iso_stream_t * stream = hci_iso_stream_for_con_handle(cig->cis_con_handles[i]);
10611d90722d4SMatthias Ringwald         if (stream != NULL){
10612d90722d4SMatthias Ringwald             stream->state = HCI_ISO_STREAM_STATE_W2_CLOSE;
10613d90722d4SMatthias Ringwald         }
10614d90722d4SMatthias Ringwald     }
10615d90722d4SMatthias Ringwald     cig->state = LE_AUDIO_CIG_STATE_REMOVE;
10616d90722d4SMatthias Ringwald 
10617d90722d4SMatthias Ringwald     hci_run();
10618d90722d4SMatthias Ringwald 
10619d90722d4SMatthias Ringwald     return ERROR_CODE_SUCCESS;
10620d90722d4SMatthias Ringwald }
10621d90722d4SMatthias Ringwald 
10622f2e409f3SMatthias Ringwald uint8_t gap_cis_create(uint8_t cig_id, hci_con_handle_t cis_con_handles [], hci_con_handle_t acl_con_handles []){
10623f2e409f3SMatthias Ringwald     le_audio_cig_t * cig = hci_cig_for_id(cig_id);
10624444e371eSMatthias Ringwald     if (cig == NULL){
10625444e371eSMatthias Ringwald         return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
10626444e371eSMatthias Ringwald     }
10627444e371eSMatthias Ringwald 
10628444e371eSMatthias Ringwald     if (cig->state != LE_AUDIO_CIG_STATE_W4_CIS_REQUEST){
10629444e371eSMatthias Ringwald         return ERROR_CODE_COMMAND_DISALLOWED;
10630444e371eSMatthias Ringwald     }
10631444e371eSMatthias Ringwald 
10632444e371eSMatthias Ringwald     // store ACL Connection Handles
10633444e371eSMatthias Ringwald     uint8_t i;
10634444e371eSMatthias Ringwald     for (i=0;i<cig->num_cis;i++){
1063556bd2ec0SMatthias Ringwald         // check that all con handles exist and store
10636444e371eSMatthias Ringwald         hci_con_handle_t cis_handle = cis_con_handles[i];
1063736468e6fSMatthias Ringwald         if (cis_handle == HCI_CON_HANDLE_INVALID){
1063836468e6fSMatthias Ringwald             return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
1063936468e6fSMatthias Ringwald         }
10640444e371eSMatthias Ringwald         uint8_t j;
10641444e371eSMatthias Ringwald         bool found = false;
10642444e371eSMatthias Ringwald         for (j=0;j<cig->num_cis;j++){
10643444e371eSMatthias Ringwald             if (cig->cis_con_handles[j] == cis_handle){
10644444e371eSMatthias Ringwald                 cig->acl_con_handles[j] = acl_con_handles[j];
1064556bd2ec0SMatthias Ringwald                 hci_iso_stream_t * iso_stream = hci_iso_stream_for_con_handle(cis_handle);
1064656bd2ec0SMatthias Ringwald                 btstack_assert(iso_stream != NULL);
1064756bd2ec0SMatthias Ringwald                 iso_stream->acl_handle = acl_con_handles[j];
1064836468e6fSMatthias Ringwald                 found = true;
10649444e371eSMatthias Ringwald                 break;
10650444e371eSMatthias Ringwald             }
10651444e371eSMatthias Ringwald         }
10652444e371eSMatthias Ringwald         if (!found){
10653444e371eSMatthias Ringwald             return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
10654444e371eSMatthias Ringwald         }
10655444e371eSMatthias Ringwald     }
10656444e371eSMatthias Ringwald 
10657444e371eSMatthias Ringwald     cig->state = LE_AUDIO_CIG_STATE_CREATE_CIS;
10658444e371eSMatthias Ringwald     hci_run();
10659444e371eSMatthias Ringwald 
10660444e371eSMatthias Ringwald     return ERROR_CODE_SUCCESS;
10661444e371eSMatthias Ringwald }
10662444e371eSMatthias Ringwald 
10663969d876aSMatthias Ringwald static uint8_t hci_cis_accept_or_reject(hci_con_handle_t cis_handle, hci_iso_stream_state_t state){
10664969d876aSMatthias Ringwald     hci_iso_stream_t * iso_stream = hci_iso_stream_for_con_handle(cis_handle);
106656fd1d2c8SMatthias Ringwald     if (iso_stream == NULL){
106666fd1d2c8SMatthias Ringwald         // if we got a CIS Request but fail to allocate a hci_iso_stream_t object, we won't find it here
10667969d876aSMatthias Ringwald         return ERROR_CODE_MEMORY_CAPACITY_EXCEEDED;
1066826b93350SMatthias Ringwald     }
1066926b93350SMatthias Ringwald 
106706fd1d2c8SMatthias Ringwald     // set next state and continue
106716fd1d2c8SMatthias Ringwald     iso_stream->state = state;
1067226b93350SMatthias Ringwald     hci_run();
1067326b93350SMatthias Ringwald     return ERROR_CODE_SUCCESS;
1067426b93350SMatthias Ringwald }
1067526b93350SMatthias Ringwald 
1067626b93350SMatthias Ringwald uint8_t gap_cis_accept(hci_con_handle_t cis_con_handle){
1067726b93350SMatthias Ringwald     return hci_cis_accept_or_reject(cis_con_handle, HCI_ISO_STREAM_W2_ACCEPT);
1067826b93350SMatthias Ringwald }
1067926b93350SMatthias Ringwald 
1068026b93350SMatthias Ringwald uint8_t gap_cis_reject(hci_con_handle_t cis_con_handle){
1068126b93350SMatthias Ringwald     return hci_cis_accept_or_reject(cis_con_handle, HCI_ISO_STREAM_W2_REJECT);
1068226b93350SMatthias Ringwald }
1068326b93350SMatthias Ringwald 
10684137a570aSMatthias Ringwald #endif /* ENABLE_LE_ISOCHRONOUS_STREAMS */
1068526b93350SMatthias Ringwald 
10686137a570aSMatthias Ringwald // GAP Privacy - notify clients before random address update
10687137a570aSMatthias Ringwald 
10688137a570aSMatthias Ringwald static bool gap_privacy_client_all_ready(void){
10689137a570aSMatthias Ringwald     // check if all ready
10690137a570aSMatthias Ringwald     btstack_linked_list_iterator_t it;
10691137a570aSMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->gap_privacy_clients);
10692137a570aSMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)) {
10693137a570aSMatthias Ringwald         gap_privacy_client_t *client = (gap_privacy_client_t *) btstack_linked_list_iterator_next(&it);
10694137a570aSMatthias Ringwald         if (client->state != GAP_PRIVACY_CLIENT_STATE_READY){
10695137a570aSMatthias Ringwald             return false;
10696137a570aSMatthias Ringwald         }
10697137a570aSMatthias Ringwald     }
10698137a570aSMatthias Ringwald     return true;
10699137a570aSMatthias Ringwald }
10700137a570aSMatthias Ringwald 
10701137a570aSMatthias Ringwald static void gap_privacy_clients_handle_ready(void){
10702137a570aSMatthias Ringwald     // clear 'ready'
10703137a570aSMatthias Ringwald     btstack_linked_list_iterator_t it;
10704137a570aSMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->gap_privacy_clients);
10705137a570aSMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)) {
10706137a570aSMatthias Ringwald         gap_privacy_client_t *client = (gap_privacy_client_t *) btstack_linked_list_iterator_next(&it);
10707137a570aSMatthias Ringwald         client->state = GAP_PRIVACY_CLIENT_STATE_IDLE;
10708137a570aSMatthias Ringwald     }
10709137a570aSMatthias Ringwald     hci_stack->le_advertisements_state &= ~LE_ADVERTISEMENT_STATE_PRIVACY_PENDING;
10710137a570aSMatthias Ringwald     hci_run();
10711137a570aSMatthias Ringwald }
10712137a570aSMatthias Ringwald 
10713137a570aSMatthias Ringwald static void gap_privacy_clients_notify(bd_addr_t new_random_address){
10714137a570aSMatthias Ringwald     btstack_linked_list_iterator_t it;
10715137a570aSMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->gap_privacy_clients);
10716137a570aSMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)) {
10717137a570aSMatthias Ringwald         gap_privacy_client_t *client = (gap_privacy_client_t *) btstack_linked_list_iterator_next(&it);
10718137a570aSMatthias Ringwald         if (client->state == GAP_PRIVACY_CLIENT_STATE_IDLE){
10719137a570aSMatthias Ringwald             client->state = GAP_PRIVACY_CLIENT_STATE_PENDING;
10720137a570aSMatthias Ringwald             (*client->callback)(client, new_random_address);
10721137a570aSMatthias Ringwald         }
10722137a570aSMatthias Ringwald     }
10723137a570aSMatthias Ringwald     if (gap_privacy_client_all_ready()){
10724137a570aSMatthias Ringwald         gap_privacy_clients_handle_ready();
10725137a570aSMatthias Ringwald     }
10726137a570aSMatthias Ringwald }
10727137a570aSMatthias Ringwald 
10728137a570aSMatthias Ringwald void gap_privacy_client_register(gap_privacy_client_t * client){
10729137a570aSMatthias Ringwald     client->state = GAP_PRIVACY_CLIENT_STATE_IDLE;
10730137a570aSMatthias Ringwald     btstack_linked_list_add(&hci_stack->gap_privacy_clients, (btstack_linked_item_t *) client);
10731137a570aSMatthias Ringwald }
10732137a570aSMatthias Ringwald 
10733137a570aSMatthias Ringwald void gap_privacy_client_ready(gap_privacy_client_t * client){
10734137a570aSMatthias Ringwald     client->state = GAP_PRIVACY_CLIENT_STATE_READY;
10735137a570aSMatthias Ringwald     if (gap_privacy_client_all_ready()){
10736137a570aSMatthias Ringwald         gap_privacy_clients_handle_ready();
10737137a570aSMatthias Ringwald     }
10738137a570aSMatthias Ringwald }
10739137a570aSMatthias Ringwald 
10740137a570aSMatthias Ringwald void gap_privacy_client_unregister(gap_privacy_client_t * client){
10741137a570aSMatthias Ringwald     btstack_linked_list_remove(&hci_stack->gap_privacy_clients, (btstack_linked_item_t *) client);
10742137a570aSMatthias Ringwald }
10743137a570aSMatthias Ringwald 
107444ae8623eSMatthias Ringwald #endif /* ENABLE_BLE */
10745f40c73b4SMatthias Ringwald 
10746eddac615SMatthias Ringwald #ifdef FUZZING_BUILD_MODE_UNSAFE_FOR_PRODUCTION
1074718976c74SMatthias Ringwald void hci_setup_test_connections_fuzz(void){
1074818976c74SMatthias Ringwald     hci_connection_t * conn;
1074918976c74SMatthias Ringwald 
1075018976c74SMatthias Ringwald     // default address: 66:55:44:33:00:01
1075118976c74SMatthias Ringwald     bd_addr_t addr = { 0x66, 0x55, 0x44, 0x33, 0x00, 0x00};
1075218976c74SMatthias Ringwald 
107537d33cb26SMilanka Ringwald     // setup Controller info
107547d33cb26SMilanka Ringwald     hci_stack->num_cmd_packets = 255;
107557d33cb26SMilanka Ringwald     hci_stack->acl_packets_total_num = 255;
107567d33cb26SMilanka Ringwald 
1075718976c74SMatthias Ringwald     // setup incoming Classic ACL connection with con handle 0x0001, 66:55:44:33:22:01
1075818976c74SMatthias Ringwald     addr[5] = 0x01;
1075917ab8643SMatthias Ringwald     conn = create_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL, HCI_ROLE_SLAVE);
1076018976c74SMatthias Ringwald     conn->con_handle = addr[5];
1076118976c74SMatthias Ringwald     conn->state = RECEIVED_CONNECTION_REQUEST;
107627d33cb26SMilanka Ringwald     conn->sm_connection.sm_role = HCI_ROLE_SLAVE;
1076318976c74SMatthias Ringwald 
1076418976c74SMatthias Ringwald     // setup incoming Classic SCO connection with con handle 0x0002
1076518976c74SMatthias Ringwald     addr[5] = 0x02;
1076617ab8643SMatthias Ringwald     conn = create_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_SCO, HCI_ROLE_SLAVE);
1076718976c74SMatthias Ringwald     conn->con_handle = addr[5];
1076818976c74SMatthias Ringwald     conn->state = RECEIVED_CONNECTION_REQUEST;
107697d33cb26SMilanka Ringwald     conn->sm_connection.sm_role = HCI_ROLE_SLAVE;
1077018976c74SMatthias Ringwald 
1077118976c74SMatthias Ringwald     // setup ready Classic ACL connection with con handle 0x0003
1077218976c74SMatthias Ringwald     addr[5] = 0x03;
1077317ab8643SMatthias Ringwald     conn = create_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL, HCI_ROLE_SLAVE);
1077418976c74SMatthias Ringwald     conn->con_handle = addr[5];
1077518976c74SMatthias Ringwald     conn->state = OPEN;
107767d33cb26SMilanka Ringwald     conn->sm_connection.sm_role = HCI_ROLE_SLAVE;
1077718976c74SMatthias Ringwald 
1077818976c74SMatthias Ringwald     // setup ready Classic SCO connection with con handle 0x0004
1077918976c74SMatthias Ringwald     addr[5] = 0x04;
1078017ab8643SMatthias Ringwald     conn = create_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_SCO, HCI_ROLE_SLAVE);
1078118976c74SMatthias Ringwald     conn->con_handle = addr[5];
1078218976c74SMatthias Ringwald     conn->state = OPEN;
107837d33cb26SMilanka Ringwald     conn->sm_connection.sm_role = HCI_ROLE_SLAVE;
1078418976c74SMatthias Ringwald 
1078518976c74SMatthias Ringwald     // setup ready LE ACL connection with con handle 0x005 and public address
1078618976c74SMatthias Ringwald     addr[5] = 0x05;
1078717ab8643SMatthias Ringwald     conn = create_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_LE_PUBLIC, HCI_ROLE_SLAVE);
1078818976c74SMatthias Ringwald     conn->con_handle = addr[5];
1078918976c74SMatthias Ringwald     conn->state = OPEN;
107907d33cb26SMilanka Ringwald     conn->sm_connection.sm_role = HCI_ROLE_SLAVE;
107918046a24aSMatthias Ringwald     conn->sm_connection.sm_connection_encrypted = 1;
1079218976c74SMatthias Ringwald }
1079318976c74SMatthias Ringwald 
10794eddac615SMatthias Ringwald void hci_free_connections_fuzz(void){
10795eddac615SMatthias Ringwald     btstack_linked_list_iterator_t it;
10796eddac615SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->connections);
10797eddac615SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
10798eddac615SMatthias Ringwald         hci_connection_t * con = (hci_connection_t*) btstack_linked_list_iterator_next(&it);
10799eddac615SMatthias Ringwald         btstack_linked_list_iterator_remove(&it);
10800eddac615SMatthias Ringwald         btstack_memory_hci_connection_free(con);
10801eddac615SMatthias Ringwald     }
10802eddac615SMatthias Ringwald }
108031470db0cSMatthias Ringwald void hci_simulate_working_fuzz(void){
10804b6ffb67fSMatthias Ringwald     hci_stack->le_scanning_param_update = false;
108051470db0cSMatthias Ringwald     hci_init_done();
108061470db0cSMatthias Ringwald     hci_stack->num_cmd_packets = 255;
108071470db0cSMatthias Ringwald }
10808eddac615SMatthias Ringwald #endif
10809