xref: /btstack/src/hci.c (revision 9244e83c85f7aaeb96ba261f59e83553bab9e73b)
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 \
163a858a414SMatthias Ringwald     X( SUPPORTED_HCI_COMMAND_READ_REMOTE_EXTENDED_FEATURES         ,  2, 6) \
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) \
178d0753e0fSMatthias Ringwald     X( SUPPORTED_HCI_COMMAND_LE_SET_EXTENDED_ADVERTISING_ENABLE    , 36, 5) \
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);
2179da9850bSMatthias Ringwald static void hci_emit_btstack_event(uint8_t * event, uint16_t size, int dump);
218b83d5eabSMatthias Ringwald static void hci_emit_acl_packet(uint8_t * packet, uint16_t size);
21995d71764SMatthias Ringwald static void hci_run(void);
220617c03d6SMatthias Ringwald static bool hci_is_le_connection(hci_connection_t * connection);
221ed208344SMatthias Ringwald static uint8_t hci_send_prepared_cmd_packet(void);
2226a5ffed8SMatthias Ringwald 
2236a5ffed8SMatthias Ringwald #ifdef ENABLE_CLASSIC
224f234b250SMatthias Ringwald static int hci_have_usb_transport(void);
225dbe0d85cSMatthias Ringwald static void hci_trigger_remote_features_for_connection(hci_connection_t * connection);
2266a5ffed8SMatthias Ringwald #endif
2275d509858SMatthias Ringwald 
228a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE
229137a570aSMatthias Ringwald static bool hci_run_general_gap_le(void);
230137a570aSMatthias Ringwald static void gap_privacy_clients_handle_ready(void);
231137a570aSMatthias Ringwald static void gap_privacy_clients_notify(bd_addr_t new_random_address);
232e8c8828eSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
23339677e66SMatthias Ringwald // called from test/ble_client/advertising_data_parser.c
234384b59deSMatthias Ringwald void le_handle_advertisement_report(uint8_t *packet, uint16_t size);
235667ba9d1SMatthias Ringwald static uint8_t hci_whitelist_remove(bd_addr_type_t address_type, const bd_addr_t address);
236ca0d6e5aSMatthias Ringwald static hci_connection_t * gap_get_outgoing_le_connection(void);
237c42da3bcSMatthias Ringwald static void hci_le_scan_stop(void);
2385d509858SMatthias Ringwald #endif
23925df6c61SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
240ee54aff5SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
24125df6c61SMatthias Ringwald static le_advertising_set_t * hci_advertising_set_for_handle(uint8_t advertising_handle);
242033393eeSBob Abeles static uint8_t hci_le_extended_advertising_operation_for_chunk(uint16_t pos, uint16_t len);
243033393eeSBob Abeles static void le_handle_extended_advertisement_report(uint8_t *packet, uint16_t size);
244ee54aff5SMatthias Ringwald #endif /* ENABLE_LE_EXTENDED_ADVERTISING */
245ee54aff5SMatthias Ringwald #endif /* ENABLE_LE_PERIPHERAL */
2464ae8623eSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
247969d876aSMatthias 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);
2484ae8623eSMatthias Ringwald static void hci_iso_stream_finalize(hci_iso_stream_t * iso_stream);
249778463d0SMatthias Ringwald static void hci_iso_stream_finalize_by_type_and_group_id(hci_iso_type_t iso_type, uint8_t group_id);
25015a15be3SMatthias Ringwald static hci_iso_stream_t * hci_iso_stream_for_con_handle(hci_con_handle_t con_handle);
25115a15be3SMatthias Ringwald static void hci_iso_stream_requested_finalize(uint8_t big_handle);
25215a15be3SMatthias Ringwald static void hci_iso_stream_requested_confirm(uint8_t big_handle);
253750818acSMatthias Ringwald static void hci_iso_packet_handler(hci_iso_stream_t *iso_stream, uint8_t *packet, uint16_t size);
2547aa35f6aSMatthias Ringwald static le_audio_big_t * hci_big_for_handle(uint8_t big_handle);
255d3a89d91SMatthias Ringwald static le_audio_cig_t * hci_cig_for_id(uint8_t cig_id);
2565ade6657SMatthias Ringwald static void hci_iso_notify_can_send_now(void);
2577aa35f6aSMatthias Ringwald static void hci_emit_big_created(const le_audio_big_t * big, uint8_t status);
2587aa35f6aSMatthias Ringwald static void hci_emit_big_terminated(const le_audio_big_t * big);
2592a6c0f82SMatthias Ringwald static void hci_emit_big_sync_created(const le_audio_big_sync_t * big_sync, uint8_t status);
260d04a9afcSMatthias Ringwald static void hci_emit_big_sync_stopped(uint8_t big_handle);
261d3a89d91SMatthias Ringwald static void hci_emit_cig_created(const le_audio_cig_t * cig, uint8_t status);
26214045fdbSMatthias Ringwald static void hci_cis_handle_created(hci_iso_stream_t * iso_stream, uint8_t status);
2632a6c0f82SMatthias Ringwald static le_audio_big_sync_t * hci_big_sync_for_handle(uint8_t big_handle);
2644ae8623eSMatthias Ringwald #endif /* ENABLE_LE_ISOCHRONOUS_STREAMS */
265ee54aff5SMatthias Ringwald #endif /* ENABLE_BLE */
266758b46ceSmatthias.ringwald 
26706b35ec0Smatthias.ringwald // the STACK is here
2683a9fb326S[email protected] #ifndef HAVE_MALLOC
2693a9fb326S[email protected] static hci_stack_t   hci_stack_static;
2703a9fb326S[email protected] #endif
2713a9fb326S[email protected] static hci_stack_t * hci_stack = NULL;
27216833f0aSmatthias.ringwald 
2731c9e5e9dSMatthias Ringwald #ifdef ENABLE_CLASSIC
27463168530SMatthias Ringwald // default name
27563168530SMatthias Ringwald static const char * default_classic_name = "BTstack 00:00:00:00:00:00";
27663168530SMatthias Ringwald 
27766fb9560S[email protected] // test helper
27866fb9560S[email protected] static uint8_t disable_l2cap_timeouts = 0;
2791c9e5e9dSMatthias Ringwald #endif
28066fb9560S[email protected] 
281aee5d5c1SMatthias Ringwald // reset connection state on create and on reconnect
282aee5d5c1SMatthias Ringwald // don't overwrite addr, con handle, role
283aee5d5c1SMatthias Ringwald static void hci_connection_init(hci_connection_t * conn){
2848daf94bcSMatthias Ringwald     conn->authentication_flags = AUTH_FLAG_NONE;
28596a45072S[email protected]     conn->bonding_flags = 0;
28696a45072S[email protected]     conn->requested_security_level = LEVEL_0;
2878ce18681SMatthias Ringwald     conn->link_key_type = INVALID_LINK_KEY;
28852db98b2SMatthias Ringwald #ifdef ENABLE_CLASSIC
28988a03c8dSMatthias Ringwald     conn->request_role = HCI_ROLE_INVALID;
290140c0557SMatthias Ringwald     conn->sniff_subrating_max_latency = 0xffff;
291965a4ccfSMatthias Ringwald     conn->qos_service_type = HCI_SERVICE_TYPE_INVALID;
29291a977e8SMatthias Ringwald     btstack_run_loop_set_timer_handler(&conn->timeout, hci_connection_timeout_handler);
29391a977e8SMatthias Ringwald     btstack_run_loop_set_timer_context(&conn->timeout, conn);
29496a45072S[email protected]     hci_connection_timestamp(conn);
29552db98b2SMatthias Ringwald #endif
29696a45072S[email protected]     conn->acl_recombination_length = 0;
29796a45072S[email protected]     conn->acl_recombination_pos = 0;
298ce41473eSMatthias Ringwald     conn->num_packets_sent = 0;
299760b20efSMatthias Ringwald 
300da886c03S[email protected]     conn->le_con_parameter_update_state = CON_PARAMETER_UPDATE_NONE;
301b90f6e0aSMatthias Ringwald #ifdef ENABLE_BLE
302b90f6e0aSMatthias Ringwald     conn->le_phy_update_all_phys = 0xff;
303b90f6e0aSMatthias Ringwald #endif
3040f3b27c5SMatthias Ringwald #ifdef ENABLE_LE_LIMIT_ACL_FRAGMENT_BY_MAX_OCTETS
3050f3b27c5SMatthias Ringwald     conn->le_max_tx_octets = 27;
3060f3b27c5SMatthias Ringwald #endif
307cb439cf1SMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB
308cb439cf1SMatthias Ringwald     conn->classic_oob_c_192 = NULL;
309cb439cf1SMatthias Ringwald     conn->classic_oob_r_192 = NULL;
310cb439cf1SMatthias Ringwald     conn->classic_oob_c_256 = NULL;
311cb439cf1SMatthias Ringwald     conn->classic_oob_r_256 = NULL;
312cb439cf1SMatthias Ringwald #endif
3134dcab8b6SMatthias Ringwald #ifdef ENABLE_LE_PERIODIC_ADVERTISING
3144dcab8b6SMatthias Ringwald     conn->le_past_sync_handle = HCI_CON_HANDLE_INVALID;
3154dcab8b6SMatthias Ringwald     conn->le_past_advertising_handle = 0xff;
3164dcab8b6SMatthias Ringwald #endif
317aee5d5c1SMatthias Ringwald }
318aee5d5c1SMatthias Ringwald 
319aee5d5c1SMatthias Ringwald /**
320aee5d5c1SMatthias Ringwald  * create connection for given address
321aee5d5c1SMatthias Ringwald  *
322aee5d5c1SMatthias Ringwald  * @return connection OR NULL, if no memory left
323aee5d5c1SMatthias Ringwald  */
32488f925b1SMatthias Ringwald static hci_connection_t *
32588f925b1SMatthias Ringwald create_connection_for_bd_addr_and_type(const bd_addr_t addr, bd_addr_type_t addr_type, hci_role_t role) {
326aee5d5c1SMatthias Ringwald     log_info("create_connection_for_addr %s, type %x", bd_addr_to_str(addr), addr_type);
327aee5d5c1SMatthias Ringwald 
328aee5d5c1SMatthias Ringwald     hci_connection_t * conn = btstack_memory_hci_connection_get();
329aee5d5c1SMatthias Ringwald     if (!conn) return NULL;
330aee5d5c1SMatthias Ringwald     hci_connection_init(conn);
331aee5d5c1SMatthias Ringwald 
332aee5d5c1SMatthias Ringwald     bd_addr_copy(conn->address, addr);
333aee5d5c1SMatthias Ringwald     conn->address_type = addr_type;
334aee5d5c1SMatthias Ringwald     conn->con_handle = HCI_CON_HANDLE_INVALID;
33588f925b1SMatthias Ringwald     conn->role = role;
336665d90f2SMatthias Ringwald     btstack_linked_list_add(&hci_stack->connections, (btstack_linked_item_t *) conn);
337aee5d5c1SMatthias Ringwald 
33896a45072S[email protected]     return conn;
33996a45072S[email protected] }
34066fb9560S[email protected] 
341da886c03S[email protected] 
342da886c03S[email protected] /**
343da886c03S[email protected]  * get le connection parameter range
344da886c03S[email protected] *
345da886c03S[email protected]  * @return le connection parameter range struct
346da886c03S[email protected]  */
3474ced4e8cSMatthias Ringwald void gap_get_connection_parameter_range(le_connection_parameter_range_t * range){
3484ced4e8cSMatthias Ringwald     *range = hci_stack->le_connection_parameter_range;
349da886c03S[email protected] }
350da886c03S[email protected] 
351da886c03S[email protected] /**
352da886c03S[email protected]  * set le connection parameter range
353da886c03S[email protected]  *
354da886c03S[email protected]  */
355da886c03S[email protected] 
3564ced4e8cSMatthias Ringwald void gap_set_connection_parameter_range(le_connection_parameter_range_t *range){
3574ced4e8cSMatthias Ringwald     hci_stack->le_connection_parameter_range = *range;
358da886c03S[email protected] }
359da886c03S[email protected] 
360da886c03S[email protected] /**
36173cd8a2aSMatthias Ringwald  * @brief Test if connection parameters are inside in existing rage
36273cd8a2aSMatthias Ringwald  * @param conn_interval_min (unit: 1.25ms)
36373cd8a2aSMatthias Ringwald  * @param conn_interval_max (unit: 1.25ms)
36473cd8a2aSMatthias Ringwald  * @param conn_latency
36573cd8a2aSMatthias Ringwald  * @param supervision_timeout (unit: 10ms)
3666b65794dSMilanka Ringwald  * @return 1 if included
36773cd8a2aSMatthias Ringwald  */
36873cd8a2aSMatthias 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){
36973cd8a2aSMatthias Ringwald     if (le_conn_interval_min < existing_range->le_conn_interval_min) return 0;
37073cd8a2aSMatthias Ringwald     if (le_conn_interval_max > existing_range->le_conn_interval_max) return 0;
37173cd8a2aSMatthias Ringwald 
37273cd8a2aSMatthias Ringwald     if (le_conn_latency < existing_range->le_conn_latency_min) return 0;
37373cd8a2aSMatthias Ringwald     if (le_conn_latency > existing_range->le_conn_latency_max) return 0;
37473cd8a2aSMatthias Ringwald 
37573cd8a2aSMatthias Ringwald     if (le_supervision_timeout < existing_range->le_supervision_timeout_min) return 0;
37673cd8a2aSMatthias Ringwald     if (le_supervision_timeout > existing_range->le_supervision_timeout_max) return 0;
37773cd8a2aSMatthias Ringwald 
37873cd8a2aSMatthias Ringwald     return 1;
37973cd8a2aSMatthias Ringwald }
38073cd8a2aSMatthias Ringwald 
38173cd8a2aSMatthias Ringwald /**
3822b6ab3e6SMatthias Ringwald  * @brief Set max number of connections in LE Peripheral role (if Bluetooth Controller supports it)
3832b6ab3e6SMatthias Ringwald  * @note: default: 1
3842b6ab3e6SMatthias Ringwald  * @param max_peripheral_connections
3852b6ab3e6SMatthias Ringwald  */
386d4e4907bSMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
3872b6ab3e6SMatthias Ringwald void gap_set_max_number_peripheral_connections(int max_peripheral_connections){
3882b6ab3e6SMatthias Ringwald     hci_stack->le_max_number_peripheral_connections = max_peripheral_connections;
3892b6ab3e6SMatthias Ringwald }
390d4e4907bSMatthias Ringwald #endif
3912b6ab3e6SMatthias Ringwald 
3922b6ab3e6SMatthias Ringwald /**
393da886c03S[email protected]  * get hci connections iterator
394da886c03S[email protected]  *
395da886c03S[email protected]  * @return hci connections iterator
396da886c03S[email protected]  */
397da886c03S[email protected] 
398665d90f2SMatthias Ringwald void hci_connections_get_iterator(btstack_linked_list_iterator_t *it){
399665d90f2SMatthias Ringwald     btstack_linked_list_iterator_init(it, &hci_stack->connections);
400da886c03S[email protected] }
401da886c03S[email protected] 
40297addcc5Smatthias.ringwald /**
403ee091cf1Smatthias.ringwald  * get connection for a given handle
404ee091cf1Smatthias.ringwald  *
405ee091cf1Smatthias.ringwald  * @return connection OR NULL, if not found
406ee091cf1Smatthias.ringwald  */
4075061f3afS[email protected] hci_connection_t * hci_connection_for_handle(hci_con_handle_t con_handle){
408665d90f2SMatthias Ringwald     btstack_linked_list_iterator_t it;
409665d90f2SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->connections);
410665d90f2SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
411665d90f2SMatthias Ringwald         hci_connection_t * item = (hci_connection_t *) btstack_linked_list_iterator_next(&it);
4123ac2fe56S[email protected]         if ( item->con_handle == con_handle ) {
413da886c03S[email protected]             return item;
414ee091cf1Smatthias.ringwald         }
415ee091cf1Smatthias.ringwald     }
416ee091cf1Smatthias.ringwald     return NULL;
417ee091cf1Smatthias.ringwald }
418ee091cf1Smatthias.ringwald 
41996a45072S[email protected] /**
42096a45072S[email protected]  * get connection for given address
42196a45072S[email protected]  *
42296a45072S[email protected]  * @return connection OR NULL, if not found
42396a45072S[email protected]  */
424667ba9d1SMatthias Ringwald hci_connection_t * hci_connection_for_bd_addr_and_type(const bd_addr_t  addr, bd_addr_type_t addr_type){
425665d90f2SMatthias Ringwald     btstack_linked_list_iterator_t it;
426665d90f2SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->connections);
427665d90f2SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
428665d90f2SMatthias Ringwald         hci_connection_t * connection = (hci_connection_t *) btstack_linked_list_iterator_next(&it);
42996a45072S[email protected]         if (connection->address_type != addr_type)  continue;
43096a45072S[email protected]         if (memcmp(addr, connection->address, 6) != 0) continue;
43162bda3fbS[email protected]         return connection;
43262bda3fbS[email protected]     }
43362bda3fbS[email protected]     return NULL;
43462bda3fbS[email protected] }
43562bda3fbS[email protected] 
436d5f71a7eSMatthias Ringwald #ifdef ENABLE_CLASSIC
437d5f71a7eSMatthias Ringwald 
4383e5e0926SMatthias Ringwald inline static void connectionClearAuthenticationFlags(hci_connection_t * conn, hci_authentication_flags_t flags){
4393e5e0926SMatthias Ringwald     conn->authentication_flags = (hci_authentication_flags_t)(conn->authentication_flags & ~flags);
4403e5e0926SMatthias Ringwald }
44152db98b2SMatthias Ringwald 
442228e430cSMatthias Ringwald inline static void connectionSetAuthenticationFlags(hci_connection_t * conn, hci_authentication_flags_t flags){
443228e430cSMatthias Ringwald     conn->authentication_flags = (hci_authentication_flags_t)(conn->authentication_flags | flags);
444228e430cSMatthias Ringwald }
445228e430cSMatthias Ringwald 
446ee752bb8SMatthias Ringwald #ifdef ENABLE_SCO_OVER_HCI
447ee752bb8SMatthias Ringwald static int hci_number_sco_connections(void){
448ee752bb8SMatthias Ringwald     int connections = 0;
449ee752bb8SMatthias Ringwald     btstack_linked_list_iterator_t it;
450ee752bb8SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->connections);
451ee752bb8SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
452ee752bb8SMatthias Ringwald         hci_connection_t * connection = (hci_connection_t *) btstack_linked_list_iterator_next(&it);
453ee752bb8SMatthias Ringwald         if (connection->address_type != BD_ADDR_TYPE_SCO) continue;
454ee752bb8SMatthias Ringwald         connections++;
455ee752bb8SMatthias Ringwald     }
456ee752bb8SMatthias Ringwald     return connections;
457ee752bb8SMatthias Ringwald }
458ee752bb8SMatthias Ringwald #endif
459ee752bb8SMatthias Ringwald 
460ec820d77SMatthias Ringwald static void hci_connection_timeout_handler(btstack_timer_source_t *timer){
46191a977e8SMatthias Ringwald     hci_connection_t * connection = (hci_connection_t *) btstack_run_loop_get_timer_context(timer);
462aec7654dSMatthias Ringwald #ifdef HAVE_EMBEDDED_TICK
463528a4a3bSMatthias Ringwald     if (btstack_run_loop_embedded_get_ticks() > connection->timestamp + btstack_run_loop_embedded_ticks_for_ms(HCI_CONNECTION_TIMEOUT_MS)){
464c785ef68Smatthias.ringwald         // connections might be timed out
465c785ef68Smatthias.ringwald         hci_emit_l2cap_check_timeout(connection);
466c785ef68Smatthias.ringwald     }
467f316a845SMatthias Ringwald #else
468c1ab6cc1SMatthias Ringwald     if (btstack_run_loop_get_time_ms() > (connection->timestamp + HCI_CONNECTION_TIMEOUT_MS)){
4695f26aadcSMatthias Ringwald         // connections might be timed out
4705f26aadcSMatthias Ringwald         hci_emit_l2cap_check_timeout(connection);
4715f26aadcSMatthias Ringwald     }
4725f26aadcSMatthias Ringwald #endif
473c785ef68Smatthias.ringwald }
474ee091cf1Smatthias.ringwald 
475ee091cf1Smatthias.ringwald static void hci_connection_timestamp(hci_connection_t *connection){
476aec7654dSMatthias Ringwald #ifdef HAVE_EMBEDDED_TICK
477528a4a3bSMatthias Ringwald     connection->timestamp = btstack_run_loop_embedded_get_ticks();
478f316a845SMatthias Ringwald #else
479528a4a3bSMatthias Ringwald     connection->timestamp = btstack_run_loop_get_time_ms();
4805f26aadcSMatthias Ringwald #endif
481ee091cf1Smatthias.ringwald }
482ee091cf1Smatthias.ringwald 
48343bfb1bdSmatthias.ringwald /**
48480ca58a0Smatthias.ringwald  * add authentication flags and reset timer
48596a45072S[email protected]  * @note: assumes classic connection
486a086dc35SMatthias Ringwald  * @note: bd_addr is passed in as little endian uint8_t * as it is called from parsing packets
4877fde4af9Smatthias.ringwald  */
4887fde4af9Smatthias.ringwald static void hci_add_connection_flags_for_flipped_bd_addr(uint8_t *bd_addr, hci_authentication_flags_t flags){
4897fde4af9Smatthias.ringwald     bd_addr_t addr;
490724d70a2SMatthias Ringwald     reverse_bd_addr(bd_addr, addr);
491f16129ceSMatthias Ringwald     hci_connection_t * conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL);
4927fde4af9Smatthias.ringwald     if (conn) {
49328ca2b46S[email protected]         connectionSetAuthenticationFlags(conn, flags);
49480ca58a0Smatthias.ringwald         hci_connection_timestamp(conn);
4957fde4af9Smatthias.ringwald     }
4967fde4af9Smatthias.ringwald }
4977fde4af9Smatthias.ringwald 
4981714cbbdSMatthias Ringwald static bool hci_pairing_active(hci_connection_t * hci_connection){
4998daf94bcSMatthias Ringwald     return (hci_connection->authentication_flags & AUTH_FLAG_PAIRING_ACTIVE_MASK) != 0;
5001714cbbdSMatthias Ringwald }
5011714cbbdSMatthias Ringwald 
5021714cbbdSMatthias Ringwald static void hci_pairing_started(hci_connection_t * hci_connection, bool ssp){
5031714cbbdSMatthias Ringwald     if (hci_pairing_active(hci_connection)) return;
5041714cbbdSMatthias Ringwald     if (ssp){
5058daf94bcSMatthias Ringwald         hci_connection->authentication_flags |= AUTH_FLAG_SSP_PAIRING_ACTIVE;
5061714cbbdSMatthias Ringwald     } else {
5078daf94bcSMatthias Ringwald         hci_connection->authentication_flags |= AUTH_FLAG_LEGACY_PAIRING_ACTIVE;
5081714cbbdSMatthias Ringwald     }
5091714cbbdSMatthias Ringwald     // if we are initiator, we have sent an HCI Authenticate Request
5101714cbbdSMatthias Ringwald     bool initiator = (hci_connection->bonding_flags & BONDING_SENT_AUTHENTICATE_REQUEST) != 0;
5111714cbbdSMatthias Ringwald 
5125a561920SMatthias Ringwald     // if we are responder, use minimal service security level as required level
5135a561920SMatthias Ringwald     if (!initiator){
514acadfdd0SMatthias 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);
5155a561920SMatthias Ringwald     }
5165a561920SMatthias Ringwald 
5175a561920SMatthias Ringwald     log_info("pairing started, ssp %u, initiator %u, requested level %u", (int) ssp, (int) initiator, hci_connection->requested_security_level);
51877208d90SMatthias Ringwald 
51977208d90SMatthias Ringwald     uint8_t event[12];
52077208d90SMatthias Ringwald     event[0] = GAP_EVENT_PAIRING_STARTED;
52177208d90SMatthias Ringwald     event[1] = 10;
522bfaf6993SMatthias Ringwald     little_endian_store_16(event, 2, (uint16_t) hci_connection->con_handle);
5234159a80bSMatthias Ringwald     reverse_bd_addr(hci_connection->address, &event[4]);
52477208d90SMatthias Ringwald     event[10] = (uint8_t) ssp;
52577208d90SMatthias Ringwald     event[11] = (uint8_t) initiator;
5269da9850bSMatthias Ringwald     hci_emit_btstack_event(event, sizeof(event), 1);
5271714cbbdSMatthias Ringwald }
5281714cbbdSMatthias Ringwald 
5291714cbbdSMatthias Ringwald static void hci_pairing_complete(hci_connection_t * hci_connection, uint8_t status){
5303c439ac4SMatthias Ringwald     hci_connection->requested_security_level = LEVEL_0;
5311714cbbdSMatthias Ringwald     if (!hci_pairing_active(hci_connection)) return;
5328daf94bcSMatthias Ringwald     hci_connection->authentication_flags &= ~AUTH_FLAG_PAIRING_ACTIVE_MASK;
5331e7371deSMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB
534cb439cf1SMatthias Ringwald     hci_connection->classic_oob_c_192 = NULL;
535cb439cf1SMatthias Ringwald     hci_connection->classic_oob_r_192 = NULL;
536cb439cf1SMatthias Ringwald     hci_connection->classic_oob_c_256 = NULL;
537cb439cf1SMatthias Ringwald     hci_connection->classic_oob_r_256 = NULL;
5381e7371deSMatthias Ringwald #endif
5391714cbbdSMatthias Ringwald     log_info("pairing complete, status %02x", status);
54077208d90SMatthias Ringwald 
5413176c896SMatthias Ringwald     uint8_t event[11];
54277208d90SMatthias Ringwald     event[0] = GAP_EVENT_PAIRING_COMPLETE;
54377208d90SMatthias Ringwald     event[1] = 9;
544bfaf6993SMatthias Ringwald     little_endian_store_16(event, 2, (uint16_t) hci_connection->con_handle);
5454159a80bSMatthias Ringwald     reverse_bd_addr(hci_connection->address, &event[4]);
54677208d90SMatthias Ringwald     event[10] = status;
5479da9850bSMatthias Ringwald     hci_emit_btstack_event(event, sizeof(event), 1);
5485999ee11SMatthias Ringwald 
5495999ee11SMatthias Ringwald     // emit dedicated bonding done on failure, otherwise verify that connection can be encrypted
5505999ee11SMatthias Ringwald     if ((status != ERROR_CODE_SUCCESS) && ((hci_connection->bonding_flags & BONDING_DEDICATED) != 0)){
5515999ee11SMatthias Ringwald         hci_connection->bonding_flags &= ~BONDING_DEDICATED;
5525999ee11SMatthias Ringwald         hci_connection->bonding_flags |= BONDING_DISCONNECT_DEDICATED_DONE;
5535999ee11SMatthias Ringwald         hci_connection->bonding_status = status;
5545999ee11SMatthias Ringwald     }
5551714cbbdSMatthias Ringwald }
5561714cbbdSMatthias Ringwald 
55720dcdd22SMatthias Ringwald bool hci_authentication_active_for_handle(hci_con_handle_t handle){
5585061f3afS[email protected]     hci_connection_t * conn = hci_connection_for_handle(handle);
55920dcdd22SMatthias Ringwald     if (!conn) return false;
56020dcdd22SMatthias Ringwald     return hci_pairing_active(conn);
56180ca58a0Smatthias.ringwald }
56280ca58a0Smatthias.ringwald 
56315a95bd5SMatthias Ringwald void gap_drop_link_key_for_bd_addr(bd_addr_t addr){
56455597469SMatthias Ringwald     if (!hci_stack->link_key_db) return;
5652bacf595SMatthias Ringwald     log_info("gap_drop_link_key_for_bd_addr: %s", bd_addr_to_str(addr));
566a98592bcSMatthias Ringwald     hci_stack->link_key_db->delete_link_key(addr);
567c12e46e7Smatthias.ringwald }
56855597469SMatthias Ringwald 
56955597469SMatthias Ringwald void gap_store_link_key_for_bd_addr(bd_addr_t addr, link_key_t link_key, link_key_type_t type){
57055597469SMatthias Ringwald     if (!hci_stack->link_key_db) return;
5712bacf595SMatthias Ringwald     log_info("gap_store_link_key_for_bd_addr: %s, type %u", bd_addr_to_str(addr), type);
57255597469SMatthias Ringwald     hci_stack->link_key_db->put_link_key(addr, link_key, type);
573c12e46e7Smatthias.ringwald }
5741b6fb31bSMatthias Ringwald 
575e8ad470fSMatthias Ringwald bool gap_get_link_key_for_bd_addr(bd_addr_t addr, link_key_t link_key, link_key_type_t * type){
576e8ad470fSMatthias Ringwald 	if (!hci_stack->link_key_db) return false;
57776b0318eSMatthias Ringwald 	int result = hci_stack->link_key_db->get_link_key(addr, link_key, type) != 0;
57876b0318eSMatthias Ringwald 	log_info("link key for %s available %u, type %u", bd_addr_to_str(addr), result, (int) *type);
57976b0318eSMatthias Ringwald 	return result;
580e8ad470fSMatthias Ringwald }
581e8ad470fSMatthias Ringwald 
582ceecb9d9SMatthias Ringwald void gap_delete_all_link_keys(void){
583ceecb9d9SMatthias Ringwald     bd_addr_t  addr;
584ceecb9d9SMatthias Ringwald     link_key_t link_key;
585ceecb9d9SMatthias Ringwald     link_key_type_t type;
586ceecb9d9SMatthias Ringwald     btstack_link_key_iterator_t it;
587ceecb9d9SMatthias Ringwald     int ok = gap_link_key_iterator_init(&it);
588ceecb9d9SMatthias Ringwald     if (!ok) {
589ceecb9d9SMatthias Ringwald         log_error("could not initialize iterator");
590ceecb9d9SMatthias Ringwald         return;
591ceecb9d9SMatthias Ringwald     }
592ceecb9d9SMatthias Ringwald     while (gap_link_key_iterator_get_next(&it, addr, link_key, &type)){
593ceecb9d9SMatthias Ringwald         gap_drop_link_key_for_bd_addr(addr);
594ceecb9d9SMatthias Ringwald     }
595ceecb9d9SMatthias Ringwald     gap_link_key_iterator_done(&it);
596ceecb9d9SMatthias Ringwald }
597ceecb9d9SMatthias Ringwald 
5981b6fb31bSMatthias Ringwald int gap_link_key_iterator_init(btstack_link_key_iterator_t * it){
5991b6fb31bSMatthias Ringwald     if (!hci_stack->link_key_db) return 0;
6001b6fb31bSMatthias Ringwald     if (!hci_stack->link_key_db->iterator_init) return 0;
6011b6fb31bSMatthias Ringwald     return hci_stack->link_key_db->iterator_init(it);
6021b6fb31bSMatthias Ringwald }
6031b6fb31bSMatthias 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){
6041b6fb31bSMatthias Ringwald     if (!hci_stack->link_key_db) return 0;
6051b6fb31bSMatthias Ringwald     return hci_stack->link_key_db->iterator_get_next(it, bd_addr, link_key, type);
6061b6fb31bSMatthias Ringwald }
6071b6fb31bSMatthias Ringwald void gap_link_key_iterator_done(btstack_link_key_iterator_t * it){
6081b6fb31bSMatthias Ringwald     if (!hci_stack->link_key_db) return;
6091b6fb31bSMatthias Ringwald     hci_stack->link_key_db->iterator_done(it);
6101b6fb31bSMatthias Ringwald }
61135454696SMatthias Ringwald #endif
612c12e46e7Smatthias.ringwald 
6138e97a820SMatthias Ringwald bool hci_is_le_connection_type(bd_addr_type_t address_type){
614eb8076ddSMatthias Ringwald     switch (address_type){
615ce41473eSMatthias Ringwald         case BD_ADDR_TYPE_LE_PUBLIC:
616ce41473eSMatthias Ringwald         case BD_ADDR_TYPE_LE_RANDOM:
6173739bc96SMatthias Ringwald         case BD_ADDR_TYPE_LE_PUBLIC_IDENTITY:
6183739bc96SMatthias Ringwald         case BD_ADDR_TYPE_LE_RANDOM_IDENTITY:
619eb8076ddSMatthias Ringwald             return true;
620ce41473eSMatthias Ringwald         default:
621eb8076ddSMatthias Ringwald             return false;
622ce41473eSMatthias Ringwald     }
6230bf6344aS[email protected] }
6240bf6344aS[email protected] 
6250890cf2bSMatthias Ringwald bool hci_is_le_identity_address_type(bd_addr_type_t address_type){
6260890cf2bSMatthias Ringwald     switch (address_type){
6270890cf2bSMatthias Ringwald         case BD_ADDR_TYPE_LE_PUBLIC_IDENTITY:
6280890cf2bSMatthias Ringwald         case BD_ADDR_TYPE_LE_RANDOM_IDENTITY:
6290890cf2bSMatthias Ringwald             return true;
6300890cf2bSMatthias Ringwald         default:
6310890cf2bSMatthias Ringwald             return false;
6320890cf2bSMatthias Ringwald     }
6330890cf2bSMatthias Ringwald }
6340890cf2bSMatthias Ringwald 
635617c03d6SMatthias Ringwald static bool hci_is_le_connection(hci_connection_t * connection){
636eb8076ddSMatthias Ringwald     return hci_is_le_connection_type(connection->address_type);
637eb8076ddSMatthias Ringwald }
638eb8076ddSMatthias Ringwald 
6397fde4af9Smatthias.ringwald /**
64043bfb1bdSmatthias.ringwald  * count connections
64143bfb1bdSmatthias.ringwald  */
64240d1c7a4Smatthias.ringwald static int nr_hci_connections(void){
64356c253c9Smatthias.ringwald     int count = 0;
644665d90f2SMatthias Ringwald     btstack_linked_item_t *it;
645a0da043fSMatthias Ringwald     for (it = (btstack_linked_item_t *) hci_stack->connections; it != NULL ; it = it->next){
64615a27967SMatthias Ringwald         count++;
64715a27967SMatthias Ringwald     }
64843bfb1bdSmatthias.ringwald     return count;
64943bfb1bdSmatthias.ringwald }
650c8e4258aSmatthias.ringwald 
6518f733c6fSMatthias Ringwald uint16_t hci_number_free_acl_slots_for_connection_type(bd_addr_type_t address_type){
652ee303eddS[email protected] 
653f04a0c31SMatthias Ringwald     unsigned int num_packets_sent_classic = 0;
654f04a0c31SMatthias Ringwald     unsigned int num_packets_sent_le = 0;
655ee303eddS[email protected] 
656665d90f2SMatthias Ringwald     btstack_linked_item_t *it;
657a0da043fSMatthias Ringwald     for (it = (btstack_linked_item_t *) hci_stack->connections; it != NULL; it = it->next){
658998906cdSmatthias.ringwald         hci_connection_t * connection = (hci_connection_t *) it;
659ce41473eSMatthias Ringwald         if (hci_is_le_connection(connection)){
660ce41473eSMatthias Ringwald             num_packets_sent_le += connection->num_packets_sent;
661ce41473eSMatthias Ringwald         }
662f16129ceSMatthias Ringwald         if (connection->address_type == BD_ADDR_TYPE_ACL){
663ce41473eSMatthias Ringwald             num_packets_sent_classic += connection->num_packets_sent;
664ee303eddS[email protected]         }
665ee303eddS[email protected]     }
666d999b54eSMatthias Ringwald     log_debug("ACL classic buffers: %u used of %u", num_packets_sent_classic, hci_stack->acl_packets_total_num);
667ee303eddS[email protected]     int free_slots_classic = hci_stack->acl_packets_total_num - num_packets_sent_classic;
668ee303eddS[email protected]     int free_slots_le = 0;
669ee303eddS[email protected] 
670ee303eddS[email protected]     if (free_slots_classic < 0){
6719da54300S[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);
672998906cdSmatthias.ringwald         return 0;
673998906cdSmatthias.ringwald     }
674ee303eddS[email protected] 
675ee303eddS[email protected]     if (hci_stack->le_acl_packets_total_num){
676ee303eddS[email protected]         // if we have LE slots, they are used
677ee303eddS[email protected]         free_slots_le = hci_stack->le_acl_packets_total_num - num_packets_sent_le;
678ee303eddS[email protected]         if (free_slots_le < 0){
6799da54300S[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);
680ee303eddS[email protected]             return 0;
681998906cdSmatthias.ringwald         }
682ee303eddS[email protected]     } else {
683ee303eddS[email protected]         // otherwise, classic slots are used for LE, too
684ee303eddS[email protected]         free_slots_classic -= num_packets_sent_le;
685ee303eddS[email protected]         if (free_slots_classic < 0){
6869da54300S[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);
687ee303eddS[email protected]             return 0;
688ee303eddS[email protected]         }
689ee303eddS[email protected]     }
690ee303eddS[email protected] 
691ee303eddS[email protected]     switch (address_type){
692ee303eddS[email protected]         case BD_ADDR_TYPE_UNKNOWN:
6932125de09SMatthias Ringwald             log_error("hci_number_free_acl_slots: unknown address type");
694ee303eddS[email protected]             return 0;
695ee303eddS[email protected] 
696f16129ceSMatthias Ringwald         case BD_ADDR_TYPE_ACL:
6978f733c6fSMatthias Ringwald             return (uint16_t) free_slots_classic;
698ee303eddS[email protected] 
699ee303eddS[email protected]         default:
7008f733c6fSMatthias Ringwald            if (hci_stack->le_acl_packets_total_num > 0){
7018f733c6fSMatthias Ringwald                return (uint16_t) free_slots_le;
702ee303eddS[email protected]            }
7038f733c6fSMatthias Ringwald            return (uint16_t) free_slots_classic;
704cb00d3aaS[email protected]     }
705998906cdSmatthias.ringwald }
706998906cdSmatthias.ringwald 
7072125de09SMatthias Ringwald int hci_number_free_acl_slots_for_handle(hci_con_handle_t con_handle){
7082125de09SMatthias Ringwald     // get connection type
7092125de09SMatthias Ringwald     hci_connection_t * connection = hci_connection_for_handle(con_handle);
7102125de09SMatthias Ringwald     if (!connection){
7112125de09SMatthias Ringwald         log_error("hci_number_free_acl_slots: handle 0x%04x not in connection list", con_handle);
7122125de09SMatthias Ringwald         return 0;
7132125de09SMatthias Ringwald     }
7142125de09SMatthias Ringwald     return hci_number_free_acl_slots_for_connection_type(connection->address_type);
7152125de09SMatthias Ringwald }
7162125de09SMatthias Ringwald 
71735454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
718701e3307SMatthias Ringwald static int hci_number_free_sco_slots(void){
719f04a0c31SMatthias Ringwald     unsigned int num_sco_packets_sent  = 0;
720665d90f2SMatthias Ringwald     btstack_linked_item_t *it;
721760b20efSMatthias Ringwald     if (hci_stack->synchronous_flow_control_enabled){
722760b20efSMatthias Ringwald         // explicit flow control
723665d90f2SMatthias Ringwald         for (it = (btstack_linked_item_t *) hci_stack->connections; it ; it = it->next){
724e35edcc1S[email protected]             hci_connection_t * connection = (hci_connection_t *) it;
725ce41473eSMatthias Ringwald             if (connection->address_type != BD_ADDR_TYPE_SCO) continue;
726ce41473eSMatthias Ringwald             num_sco_packets_sent += connection->num_packets_sent;
727e35edcc1S[email protected]         }
728e35edcc1S[email protected]         if (num_sco_packets_sent > hci_stack->sco_packets_total_num){
729701e3307SMatthias Ringwald             log_info("hci_number_free_sco_slots:packets (%u) > total packets (%u)", num_sco_packets_sent, hci_stack->sco_packets_total_num);
73044d0e3d5S[email protected]             return 0;
73144d0e3d5S[email protected]         }
732e35edcc1S[email protected]         return hci_stack->sco_packets_total_num - num_sco_packets_sent;
73349205f5dSMatthias Ringwald     } else {
734fa7f2dfdSMatthias Ringwald         // implicit flow control
7356f28d2eeSMatthias Ringwald         int num_ready = 0;
7366f28d2eeSMatthias Ringwald         for (it = (btstack_linked_item_t *) hci_stack->connections; it ; it = it->next){
7376f28d2eeSMatthias Ringwald             hci_connection_t * connection = (hci_connection_t *) it;
7386f28d2eeSMatthias Ringwald             if (connection->address_type != BD_ADDR_TYPE_SCO) continue;
7396f28d2eeSMatthias Ringwald             if (connection->sco_tx_ready == 0) continue;
7406f28d2eeSMatthias Ringwald             num_ready++;
74149205f5dSMatthias Ringwald         }
7426f28d2eeSMatthias Ringwald         return num_ready;
7436f28d2eeSMatthias Ringwald     }
744e35edcc1S[email protected] }
74535454696SMatthias Ringwald #endif
74644d0e3d5S[email protected] 
7472b838201SMatthias Ringwald // only used to send HCI Host Number Completed Packets
748a086dc35SMatthias Ringwald static int hci_can_send_command_packet_transport(void){
749ac928cc2S[email protected]     if (hci_stack->hci_packet_buffer_reserved) return 0;
750ac928cc2S[email protected] 
751ac928cc2S[email protected]     // check for async hci transport implementations
752ac928cc2S[email protected]     if (hci_stack->hci_transport->can_send_packet_now){
753ac928cc2S[email protected]         if (!hci_stack->hci_transport->can_send_packet_now(HCI_COMMAND_DATA_PACKET)){
754ac928cc2S[email protected]             return 0;
755ac928cc2S[email protected]         }
756ac928cc2S[email protected]     }
7572b838201SMatthias Ringwald     return 1;
7582b838201SMatthias Ringwald }
759ac928cc2S[email protected] 
7602b838201SMatthias Ringwald // new functions replacing hci_can_send_packet_now[_using_packet_buffer]
7611972f31fSMatthias Ringwald bool hci_can_send_command_packet_now(void){
762a086dc35SMatthias Ringwald     if (hci_can_send_command_packet_transport() == 0) return false;
7634ea43905SMatthias Ringwald     return hci_stack->num_cmd_packets > 0u;
764ac928cc2S[email protected] }
765ac928cc2S[email protected] 
7669d04d3a7SMatthias Ringwald static int hci_transport_can_send_prepared_packet_now(uint8_t packet_type){
767ac928cc2S[email protected]     // check for async hci transport implementations
7681972f31fSMatthias Ringwald     if (!hci_stack->hci_transport->can_send_packet_now) return true;
7699d04d3a7SMatthias Ringwald     return hci_stack->hci_transport->can_send_packet_now(packet_type);
770ac928cc2S[email protected] }
7719d04d3a7SMatthias Ringwald 
7721972f31fSMatthias Ringwald static bool hci_can_send_prepared_acl_packet_for_address_type(bd_addr_type_t address_type){
7731972f31fSMatthias Ringwald     if (!hci_transport_can_send_prepared_packet_now(HCI_ACL_DATA_PACKET)) return false;
7749d04d3a7SMatthias Ringwald     return hci_number_free_acl_slots_for_connection_type(address_type) > 0;
775ac928cc2S[email protected] }
7769d04d3a7SMatthias Ringwald 
7771972f31fSMatthias Ringwald bool hci_can_send_acl_le_packet_now(void){
7781972f31fSMatthias Ringwald     if (hci_stack->hci_packet_buffer_reserved) return false;
7799d04d3a7SMatthias Ringwald     return hci_can_send_prepared_acl_packet_for_address_type(BD_ADDR_TYPE_LE_PUBLIC);
7809d04d3a7SMatthias Ringwald }
7819d04d3a7SMatthias Ringwald 
7821972f31fSMatthias Ringwald bool hci_can_send_prepared_acl_packet_now(hci_con_handle_t con_handle) {
7831972f31fSMatthias Ringwald     if (!hci_transport_can_send_prepared_packet_now(HCI_ACL_DATA_PACKET)) return false;
784e79abdd6S[email protected]     return hci_number_free_acl_slots_for_handle(con_handle) > 0;
785ac928cc2S[email protected] }
786ac928cc2S[email protected] 
7871972f31fSMatthias Ringwald bool hci_can_send_acl_packet_now(hci_con_handle_t con_handle){
7881972f31fSMatthias Ringwald     if (hci_stack->hci_packet_buffer_reserved) return false;
789ac928cc2S[email protected]     return hci_can_send_prepared_acl_packet_now(con_handle);
7906b4af23dS[email protected] }
7916b4af23dS[email protected] 
79235454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
7931972f31fSMatthias Ringwald bool hci_can_send_acl_classic_packet_now(void){
7941972f31fSMatthias Ringwald     if (hci_stack->hci_packet_buffer_reserved) return false;
795f16129ceSMatthias Ringwald     return hci_can_send_prepared_acl_packet_for_address_type(BD_ADDR_TYPE_ACL);
79635454696SMatthias Ringwald }
79735454696SMatthias Ringwald 
7981972f31fSMatthias Ringwald bool hci_can_send_prepared_sco_packet_now(void){
7991972f31fSMatthias Ringwald     if (!hci_transport_can_send_prepared_packet_now(HCI_SCO_DATA_PACKET)) return false;
800f234b250SMatthias Ringwald     if (hci_have_usb_transport()){
801f234b250SMatthias Ringwald         return hci_stack->sco_can_send_now;
802f234b250SMatthias Ringwald     } else {
803701e3307SMatthias Ringwald         return hci_number_free_sco_slots() > 0;
80444d0e3d5S[email protected]     }
805f234b250SMatthias Ringwald }
80644d0e3d5S[email protected] 
8071972f31fSMatthias Ringwald bool hci_can_send_sco_packet_now(void){
8081972f31fSMatthias Ringwald     if (hci_stack->hci_packet_buffer_reserved) return false;
809701e3307SMatthias Ringwald     return hci_can_send_prepared_sco_packet_now();
81044d0e3d5S[email protected] }
81144d0e3d5S[email protected] 
812d057580eSMatthias Ringwald void hci_request_sco_can_send_now_event(void){
813d057580eSMatthias Ringwald     hci_stack->sco_waiting_for_can_send_now = 1;
814d057580eSMatthias Ringwald     hci_notify_if_sco_can_send_now();
815d057580eSMatthias Ringwald }
81635454696SMatthias Ringwald #endif
817d057580eSMatthias Ringwald 
81895d71764SMatthias Ringwald // used for internal checks in l2cap.c
81902c7fc01SMatthias Ringwald bool hci_is_packet_buffer_reserved(void){
820c8b9416aS[email protected]     return hci_stack->hci_packet_buffer_reserved;
821c8b9416aS[email protected] }
822c8b9416aS[email protected] 
8238f4649e3SMatthias Ringwald void hci_reserve_packet_buffer(void){
8245d350981SMatthias Ringwald     btstack_assert(hci_stack->hci_packet_buffer_reserved == false);
82502c7fc01SMatthias Ringwald     hci_stack->hci_packet_buffer_reserved = true;
8266b4af23dS[email protected] }
8276b4af23dS[email protected] 
82868a0fcf7S[email protected] void hci_release_packet_buffer(void){
8295d350981SMatthias Ringwald     btstack_assert(hci_stack->hci_packet_buffer_reserved);
83002c7fc01SMatthias Ringwald     hci_stack->hci_packet_buffer_reserved = false;
8315daaa52eSMatthias Ringwald     hci_emit_transport_packet_sent();
83268a0fcf7S[email protected] }
83368a0fcf7S[email protected] 
8346b4af23dS[email protected] // assumption: synchronous implementations don't provide can_send_packet_now as they don't keep the buffer after the call
8357f02f414SMatthias Ringwald static int hci_transport_synchronous(void){
8366b4af23dS[email protected]     return hci_stack->hci_transport->can_send_packet_now == NULL;
8376b4af23dS[email protected] }
8386b4af23dS[email protected] 
8398ad9cf99SMatthias Ringwald // used for debugging
8408ad9cf99SMatthias Ringwald #ifdef ENABLE_CONTROLLER_DUMP_PACKETS
8418ad9cf99SMatthias Ringwald static void hci_controller_dump_packets(void){
8428ad9cf99SMatthias Ringwald     // format: "{handle:04x}:{count:02d} "
8438ad9cf99SMatthias Ringwald     char summaries[3][7 * 8 + 1];
8448ad9cf99SMatthias Ringwald     uint16_t totals[3];
8458ad9cf99SMatthias Ringwald     uint8_t index;
8468ad9cf99SMatthias Ringwald     for (index = 0 ; index < 3 ; index++){
8478ad9cf99SMatthias Ringwald         summaries[index][0] = 0;
8488ad9cf99SMatthias Ringwald         totals[index] = 0;
8498ad9cf99SMatthias Ringwald     }
8508ad9cf99SMatthias Ringwald     btstack_linked_item_t *it;
8518ad9cf99SMatthias Ringwald     for (it = (btstack_linked_item_t *) hci_stack->connections; it != NULL; it = it->next){
8528ad9cf99SMatthias Ringwald         hci_connection_t * connection = (hci_connection_t *) it;
8538ad9cf99SMatthias Ringwald         switch (connection->address_type){
8548ad9cf99SMatthias Ringwald             case BD_ADDR_TYPE_ACL:
8558ad9cf99SMatthias Ringwald                 index = 0;
8568ad9cf99SMatthias Ringwald                 break;
8578ad9cf99SMatthias Ringwald             case BD_ADDR_TYPE_SCO:
8588ad9cf99SMatthias Ringwald                 index = 2;
8598ad9cf99SMatthias Ringwald                 break;
8608ad9cf99SMatthias Ringwald             default:
8618ad9cf99SMatthias Ringwald                 index = 1;
862ce7ca7c8SMatthias Ringwald                 break;
8638ad9cf99SMatthias Ringwald         }
8648ad9cf99SMatthias Ringwald         totals[index] += connection->num_packets_sent;
8658ad9cf99SMatthias Ringwald         char item_text[10];
8668ad9cf99SMatthias Ringwald         sprintf(item_text, "%04x:%02d ", connection->con_handle,connection->num_packets_sent);
8678ad9cf99SMatthias Ringwald         btstack_strcat(summaries[index], sizeof(summaries[0]), item_text);
8688ad9cf99SMatthias Ringwald     }
8698ad9cf99SMatthias Ringwald     for (index = 0 ; index < 3 ; index++){
8708ad9cf99SMatthias Ringwald         if (summaries[index][0] == 0){
8718ad9cf99SMatthias Ringwald             summaries[index][0] = '-';
8728ad9cf99SMatthias Ringwald             summaries[index][1] = 0;
8738ad9cf99SMatthias Ringwald         }
8748ad9cf99SMatthias Ringwald     }
8758ad9cf99SMatthias 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]);
8768ad9cf99SMatthias Ringwald }
8778ad9cf99SMatthias Ringwald #endif
8788ad9cf99SMatthias Ringwald 
8793e2050f7SMatthias Ringwald static uint8_t hci_send_acl_packet_fragments(hci_connection_t *connection){
880452cf3bbS[email protected] 
881452cf3bbS[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);
882452cf3bbS[email protected] 
883452cf3bbS[email protected]     // max ACL data packet length depends on connection type (LE vs. Classic) and available buffers
884452cf3bbS[email protected]     uint16_t max_acl_data_packet_length = hci_stack->acl_data_packet_length;
8854ea43905SMatthias Ringwald     if (hci_is_le_connection(connection) && (hci_stack->le_data_packets_length > 0u)){
886452cf3bbS[email protected]         max_acl_data_packet_length = hci_stack->le_data_packets_length;
887452cf3bbS[email protected]     }
888452cf3bbS[email protected] 
8890f3b27c5SMatthias Ringwald #ifdef ENABLE_LE_LIMIT_ACL_FRAGMENT_BY_MAX_OCTETS
890fcf88f47SMatthias Ringwald     if (hci_is_le_connection(connection) && (connection->le_max_tx_octets < max_acl_data_packet_length)){
8910f3b27c5SMatthias Ringwald         max_acl_data_packet_length = connection->le_max_tx_octets;
8920f3b27c5SMatthias Ringwald     }
8930f3b27c5SMatthias Ringwald #endif
894452cf3bbS[email protected] 
895d999b54eSMatthias Ringwald     log_debug("hci_send_acl_packet_fragments entered");
896d999b54eSMatthias Ringwald 
8973e2050f7SMatthias Ringwald     uint8_t status = ERROR_CODE_SUCCESS;
898a086dc35SMatthias Ringwald     // multiple packets could be sent on a synchronous HCI transport
899ff3cc4a5SMatthias Ringwald     while (true){
900452cf3bbS[email protected] 
901d999b54eSMatthias Ringwald         log_debug("hci_send_acl_packet_fragments loop entered");
902d999b54eSMatthias Ringwald 
903452cf3bbS[email protected]         // get current data
9044ea43905SMatthias Ringwald         const uint16_t acl_header_pos = hci_stack->acl_fragmentation_pos - 4u;
905452cf3bbS[email protected]         int current_acl_data_packet_length = hci_stack->acl_fragmentation_total_size - hci_stack->acl_fragmentation_pos;
9061979f09cSMatthias Ringwald         bool more_fragments = false;
907452cf3bbS[email protected] 
908452cf3bbS[email protected]         // if ACL packet is larger than Bluetooth packet buffer, only send max_acl_data_packet_length
909452cf3bbS[email protected]         if (current_acl_data_packet_length > max_acl_data_packet_length){
9101979f09cSMatthias Ringwald             more_fragments = true;
9116bcf18c2SMatthias Ringwald             current_acl_data_packet_length = max_acl_data_packet_length & (~(HCI_ACL_CHUNK_SIZE_ALIGNMENT-1));
912452cf3bbS[email protected]         }
913452cf3bbS[email protected] 
914a086dc35SMatthias Ringwald         // copy handle_and_flags if not first fragment and update packet boundary flags to be 01 (continuing fragment)
9154ea43905SMatthias Ringwald         if (acl_header_pos > 0u){
916f8fbdce0SMatthias Ringwald             uint16_t handle_and_flags = little_endian_read_16(hci_stack->hci_packet_buffer, 0);
9174ea43905SMatthias Ringwald             handle_and_flags = (handle_and_flags & 0xcfffu) | (1u << 12u);
918f8fbdce0SMatthias Ringwald             little_endian_store_16(hci_stack->hci_packet_buffer, acl_header_pos, handle_and_flags);
919452cf3bbS[email protected]         }
920452cf3bbS[email protected] 
921452cf3bbS[email protected]         // update header len
9224ea43905SMatthias Ringwald         little_endian_store_16(hci_stack->hci_packet_buffer, acl_header_pos + 2u, current_acl_data_packet_length);
923452cf3bbS[email protected] 
924452cf3bbS[email protected]         // count packet
925ce41473eSMatthias Ringwald         connection->num_packets_sent++;
9261979f09cSMatthias Ringwald         log_debug("hci_send_acl_packet_fragments loop before send (more fragments %d)", (int) more_fragments);
927d999b54eSMatthias Ringwald 
928d999b54eSMatthias Ringwald         // update state for next fragment (if any) as "transport done" might be sent during send_packet already
929d999b54eSMatthias Ringwald         if (more_fragments){
930d999b54eSMatthias Ringwald             // update start of next fragment to send
931d999b54eSMatthias Ringwald             hci_stack->acl_fragmentation_pos += current_acl_data_packet_length;
932d999b54eSMatthias Ringwald         } else {
933d999b54eSMatthias Ringwald             // done
934d999b54eSMatthias Ringwald             hci_stack->acl_fragmentation_pos = 0;
935d999b54eSMatthias Ringwald             hci_stack->acl_fragmentation_total_size = 0;
936d999b54eSMatthias Ringwald         }
937452cf3bbS[email protected] 
938452cf3bbS[email protected]         // send packet
939452cf3bbS[email protected]         uint8_t * packet = &hci_stack->hci_packet_buffer[acl_header_pos];
940452cf3bbS[email protected]         const int size = current_acl_data_packet_length + 4;
9415bb5bc3eS[email protected]         hci_dump_packet(HCI_ACL_DATA_PACKET, 0, packet, size);
94281d2bdb2SMatthias Ringwald         hci_stack->acl_fragmentation_tx_active = 1;
9433e2050f7SMatthias Ringwald         int err = hci_stack->hci_transport->send_packet(HCI_ACL_DATA_PACKET, packet, size);
9443e2050f7SMatthias Ringwald         if (err != 0){
9453e2050f7SMatthias Ringwald             // no error from HCI Transport expected
9463e2050f7SMatthias Ringwald             status = ERROR_CODE_HARDWARE_FAILURE;
947a84946b2SMatthias Ringwald             break;
9483e2050f7SMatthias Ringwald         }
949452cf3bbS[email protected] 
9508ad9cf99SMatthias Ringwald #ifdef ENABLE_CONTROLLER_DUMP_PACKETS
9518ad9cf99SMatthias Ringwald         hci_controller_dump_packets();
9528ad9cf99SMatthias Ringwald #endif
9538ad9cf99SMatthias Ringwald 
9541979f09cSMatthias Ringwald         log_debug("hci_send_acl_packet_fragments loop after send (more fragments %d)", (int) more_fragments);
955d999b54eSMatthias Ringwald 
956452cf3bbS[email protected]         // done yet?
957452cf3bbS[email protected]         if (!more_fragments) break;
958452cf3bbS[email protected] 
959452cf3bbS[email protected]         // can send more?
9603e2050f7SMatthias Ringwald         if (!hci_can_send_prepared_acl_packet_now(connection->con_handle)) return status;
961452cf3bbS[email protected]     }
962452cf3bbS[email protected] 
963d999b54eSMatthias Ringwald     log_debug("hci_send_acl_packet_fragments loop over");
964452cf3bbS[email protected] 
965d051460cS[email protected]     // release buffer now for synchronous transport
966203bace6S[email protected]     if (hci_transport_synchronous()){
96781d2bdb2SMatthias Ringwald         hci_stack->acl_fragmentation_tx_active = 0;
968452cf3bbS[email protected]         hci_release_packet_buffer();
969452cf3bbS[email protected]     }
970452cf3bbS[email protected] 
9713e2050f7SMatthias Ringwald     return status;
972452cf3bbS[email protected] }
973452cf3bbS[email protected] 
974826f7347S[email protected] // pre: caller has reserved the packet buffer
9753e2050f7SMatthias Ringwald uint8_t hci_send_acl_packet_buffer(int size){
9763e2050f7SMatthias Ringwald     btstack_assert(hci_stack->hci_packet_buffer_reserved);
977826f7347S[email protected] 
978d713a683S[email protected]     uint8_t * packet = hci_stack->hci_packet_buffer;
979d713a683S[email protected]     hci_con_handle_t con_handle = READ_ACL_CONNECTION_HANDLE(packet);
980d713a683S[email protected] 
9815061f3afS[email protected]     hci_connection_t *connection = hci_connection_for_handle( con_handle);
98297b61c7bS[email protected]     if (!connection) {
9835fa0b7cfS[email protected]         log_error("hci_send_acl_packet_buffer called but no connection for handle 0x%04x", con_handle);
98497b61c7bS[email protected]         hci_release_packet_buffer();
9853e2050f7SMatthias Ringwald         return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
98697b61c7bS[email protected]     }
98752db98b2SMatthias Ringwald 
98879a2851bSMilanka Ringwald     // check for free places on Bluetooth module
98979a2851bSMilanka Ringwald     if (!hci_can_send_prepared_acl_packet_now(con_handle)) {
99079a2851bSMilanka Ringwald         log_error("hci_send_acl_packet_buffer called but no free ACL buffers on controller");
99179a2851bSMilanka Ringwald         hci_release_packet_buffer();
99279a2851bSMilanka Ringwald         return BTSTACK_ACL_BUFFERS_FULL;
99379a2851bSMilanka Ringwald     }
99479a2851bSMilanka Ringwald 
99552db98b2SMatthias Ringwald #ifdef ENABLE_CLASSIC
99656cf178bSmatthias.ringwald     hci_connection_timestamp(connection);
99752db98b2SMatthias Ringwald #endif
99856cf178bSmatthias.ringwald 
999452cf3bbS[email protected]     // hci_dump_packet( HCI_ACL_DATA_PACKET, 0, packet, size);
10007856c818Smatthias.ringwald 
1001452cf3bbS[email protected]     // setup data
1002452cf3bbS[email protected]     hci_stack->acl_fragmentation_total_size = size;
1003452cf3bbS[email protected]     hci_stack->acl_fragmentation_pos = 4;   // start of L2CAP packet
10046218e6f1Smatthias.ringwald 
1005452cf3bbS[email protected]     return hci_send_acl_packet_fragments(connection);
1006ee091cf1Smatthias.ringwald }
1007ee091cf1Smatthias.ringwald 
100835454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
100944d0e3d5S[email protected] // pre: caller has reserved the packet buffer
10103e2050f7SMatthias Ringwald uint8_t hci_send_sco_packet_buffer(int size){
10113e2050f7SMatthias Ringwald     btstack_assert(hci_stack->hci_packet_buffer_reserved);
101244d0e3d5S[email protected] 
101344d0e3d5S[email protected]     uint8_t * packet = hci_stack->hci_packet_buffer;
10144b3e1e19SMatthias Ringwald 
10154b3e1e19SMatthias Ringwald     // skip checks in loopback mode
10164b3e1e19SMatthias Ringwald     if (!hci_stack->loopback_mode){
101744d0e3d5S[email protected]         hci_con_handle_t con_handle = READ_ACL_CONNECTION_HANDLE(packet);   // same for ACL and SCO
101844d0e3d5S[email protected] 
101944d0e3d5S[email protected]         // check for free places on Bluetooth module
1020701e3307SMatthias Ringwald         if (!hci_can_send_prepared_sco_packet_now()) {
1021cbf638a9SMatthias Ringwald             log_error("hci_send_sco_packet_buffer called but no free SCO buffers on controller");
102244d0e3d5S[email protected]             hci_release_packet_buffer();
102344d0e3d5S[email protected]             return BTSTACK_ACL_BUFFERS_FULL;
102444d0e3d5S[email protected]         }
102544d0e3d5S[email protected] 
1026e35edcc1S[email protected]         // track send packet in connection struct
1027e35edcc1S[email protected]         hci_connection_t *connection = hci_connection_for_handle( con_handle);
1028e35edcc1S[email protected]         if (!connection) {
1029e35edcc1S[email protected]             log_error("hci_send_sco_packet_buffer called but no connection for handle 0x%04x", con_handle);
1030e35edcc1S[email protected]             hci_release_packet_buffer();
10313e2050f7SMatthias Ringwald             return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
1032e35edcc1S[email protected]         }
1033f234b250SMatthias Ringwald 
1034f234b250SMatthias Ringwald         if (hci_have_usb_transport()){
1035f234b250SMatthias Ringwald             // token used
10361972f31fSMatthias Ringwald             hci_stack->sco_can_send_now = false;
1037f234b250SMatthias Ringwald         } else {
1038760b20efSMatthias Ringwald             if (hci_stack->synchronous_flow_control_enabled){
1039ce41473eSMatthias Ringwald                 connection->num_packets_sent++;
10406f28d2eeSMatthias Ringwald             } else {
1041e4157653SMatthias Ringwald                 connection->sco_tx_ready--;
1042760b20efSMatthias Ringwald             }
10434b3e1e19SMatthias Ringwald         }
1044f234b250SMatthias Ringwald     }
104544d0e3d5S[email protected] 
104644d0e3d5S[email protected]     hci_dump_packet( HCI_SCO_DATA_PACKET, 0, packet, size);
1047543e835cSMatthias Ringwald 
104843149fc9SMatthias Ringwald #ifdef HAVE_SCO_TRANSPORT
104943149fc9SMatthias Ringwald     hci_stack->sco_transport->send_packet(packet, size);
105043149fc9SMatthias Ringwald     hci_release_packet_buffer();
105143149fc9SMatthias Ringwald     hci_emit_transport_packet_sent();
105243149fc9SMatthias Ringwald 
105343149fc9SMatthias Ringwald     return 0;
105443149fc9SMatthias Ringwald #else
105543149fc9SMatthias Ringwald     int err = hci_stack->hci_transport->send_packet(HCI_SCO_DATA_PACKET, packet, size);
1056a84946b2SMatthias Ringwald     uint8_t status;
1057a84946b2SMatthias Ringwald     if (err == 0){
1058a84946b2SMatthias Ringwald         status = ERROR_CODE_SUCCESS;
1059a84946b2SMatthias Ringwald     } else {
1060a84946b2SMatthias Ringwald         status = ERROR_CODE_HARDWARE_FAILURE;
1061a84946b2SMatthias Ringwald     }
1062a84946b2SMatthias Ringwald     if ((status != ERROR_CODE_SUCCESS) || hci_transport_synchronous()){
1063543e835cSMatthias Ringwald         hci_release_packet_buffer();
1064543e835cSMatthias Ringwald     }
1065a84946b2SMatthias Ringwald     return status;
106643149fc9SMatthias Ringwald #endif
106744d0e3d5S[email protected] }
106835454696SMatthias Ringwald #endif
106944d0e3d5S[email protected] 
10700a8cccd5SMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
107168ab6207SMatthias Ringwald static uint8_t hci_send_iso_packet_fragments(void){
107268ab6207SMatthias Ringwald 
107368ab6207SMatthias Ringwald     uint16_t max_iso_data_packet_length = hci_stack->le_iso_packets_length;
107468ab6207SMatthias Ringwald     uint8_t status = ERROR_CODE_SUCCESS;
107568ab6207SMatthias Ringwald     // multiple packets could be send on a synchronous HCI transport
107668ab6207SMatthias Ringwald     while (true){
107768ab6207SMatthias Ringwald 
107868ab6207SMatthias Ringwald         // get current data
107968ab6207SMatthias Ringwald         const uint16_t iso_header_pos = hci_stack->iso_fragmentation_pos - 4u;
108068ab6207SMatthias Ringwald         int current_iso_data_packet_length = hci_stack->iso_fragmentation_total_size - hci_stack->iso_fragmentation_pos;
108168ab6207SMatthias Ringwald         bool more_fragments = false;
108268ab6207SMatthias Ringwald 
108368ab6207SMatthias Ringwald         // if ISO packet is larger than Bluetooth packet buffer, only send max_acl_data_packet_length
108468ab6207SMatthias Ringwald         if (current_iso_data_packet_length > max_iso_data_packet_length){
108568ab6207SMatthias Ringwald             more_fragments = true;
108668ab6207SMatthias Ringwald             current_iso_data_packet_length = max_iso_data_packet_length;
108768ab6207SMatthias Ringwald         }
108868ab6207SMatthias Ringwald 
108968ab6207SMatthias Ringwald         // copy handle_and_flags if not first fragment and update packet boundary flags to be 01 (continuing fragmnent)
109068ab6207SMatthias Ringwald         uint16_t handle_and_flags = little_endian_read_16(hci_stack->hci_packet_buffer, 0);
109168ab6207SMatthias Ringwald         uint8_t pb_flags;
109268ab6207SMatthias Ringwald         if (iso_header_pos == 0u){
109368ab6207SMatthias Ringwald             // first fragment, keep TS field
109468ab6207SMatthias Ringwald             pb_flags = more_fragments ? 0x00 : 0x02;
109568ab6207SMatthias Ringwald             handle_and_flags = (handle_and_flags & 0x4fffu) | (pb_flags << 12u);
109668ab6207SMatthias Ringwald         } else {
109768ab6207SMatthias Ringwald             // later fragment, drop TS field
109868ab6207SMatthias Ringwald             pb_flags = more_fragments ? 0x01 : 0x03;
109968ab6207SMatthias Ringwald             handle_and_flags = (handle_and_flags & 0x0fffu) | (pb_flags << 12u);
110068ab6207SMatthias Ringwald         }
110168ab6207SMatthias Ringwald         little_endian_store_16(hci_stack->hci_packet_buffer, iso_header_pos, handle_and_flags);
110268ab6207SMatthias Ringwald 
110368ab6207SMatthias Ringwald         // update header len
110468ab6207SMatthias Ringwald         little_endian_store_16(hci_stack->hci_packet_buffer, iso_header_pos + 2u, current_iso_data_packet_length);
110568ab6207SMatthias Ringwald 
110668ab6207SMatthias Ringwald         // update state for next fragment (if any) as "transport done" might be sent during send_packet already
110768ab6207SMatthias Ringwald         if (more_fragments){
110868ab6207SMatthias Ringwald             // update start of next fragment to send
110968ab6207SMatthias Ringwald             hci_stack->iso_fragmentation_pos += current_iso_data_packet_length;
111068ab6207SMatthias Ringwald         } else {
111168ab6207SMatthias Ringwald             // done
111268ab6207SMatthias Ringwald             hci_stack->iso_fragmentation_pos = 0;
111368ab6207SMatthias Ringwald             hci_stack->iso_fragmentation_total_size = 0;
111468ab6207SMatthias Ringwald         }
111568ab6207SMatthias Ringwald 
111668ab6207SMatthias Ringwald         // send packet
111768ab6207SMatthias Ringwald         uint8_t * packet = &hci_stack->hci_packet_buffer[iso_header_pos];
111868ab6207SMatthias Ringwald         const int size = current_iso_data_packet_length + 4;
111968ab6207SMatthias Ringwald         hci_dump_packet(HCI_ISO_DATA_PACKET, 0, packet, size);
112068ab6207SMatthias Ringwald         hci_stack->iso_fragmentation_tx_active = true;
112168ab6207SMatthias Ringwald         int err = hci_stack->hci_transport->send_packet(HCI_ISO_DATA_PACKET, packet, size);
112268ab6207SMatthias Ringwald         if (err != 0){
112368ab6207SMatthias Ringwald             // no error from HCI Transport expected
112468ab6207SMatthias Ringwald             status = ERROR_CODE_HARDWARE_FAILURE;
112568ab6207SMatthias Ringwald         }
112668ab6207SMatthias Ringwald 
112768ab6207SMatthias Ringwald         // done yet?
112868ab6207SMatthias Ringwald         if (!more_fragments) break;
112968ab6207SMatthias Ringwald 
113068ab6207SMatthias Ringwald         // can send more?
113168ab6207SMatthias Ringwald         if (!hci_transport_can_send_prepared_packet_now(HCI_ISO_DATA_PACKET)) return false;
113268ab6207SMatthias Ringwald     }
113368ab6207SMatthias Ringwald 
113468ab6207SMatthias Ringwald     // release buffer now for synchronous transport
113568ab6207SMatthias Ringwald     if (hci_transport_synchronous()){
113668ab6207SMatthias Ringwald         hci_stack->iso_fragmentation_tx_active = false;
113768ab6207SMatthias Ringwald         hci_release_packet_buffer();
113868ab6207SMatthias Ringwald         hci_emit_transport_packet_sent();
113968ab6207SMatthias Ringwald     }
114068ab6207SMatthias Ringwald 
114168ab6207SMatthias Ringwald     return status;
114268ab6207SMatthias Ringwald }
114368ab6207SMatthias Ringwald 
1144ace08712SMatthias Ringwald uint8_t hci_send_iso_packet_buffer(uint16_t size){
1145ace08712SMatthias Ringwald     btstack_assert(hci_stack->hci_packet_buffer_reserved);
1146ace08712SMatthias Ringwald 
1147e5413aa0SMatthias Ringwald     hci_con_handle_t con_handle = (hci_con_handle_t) little_endian_read_16(hci_stack->hci_packet_buffer, 0) & 0xfff;
1148e5413aa0SMatthias Ringwald     hci_iso_stream_t * iso_stream = hci_iso_stream_for_con_handle(con_handle);
1149e5413aa0SMatthias Ringwald     if (iso_stream == NULL){
1150977f918dSMatthias Ringwald         hci_release_packet_buffer();
1151977f918dSMatthias Ringwald         hci_iso_notify_can_send_now();
1152e5413aa0SMatthias Ringwald         return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
1153e5413aa0SMatthias Ringwald     }
1154e5413aa0SMatthias Ringwald 
1155e5413aa0SMatthias Ringwald     // TODO: check for space on controller
1156e5413aa0SMatthias Ringwald 
1157977f918dSMatthias Ringwald     // skip iso packets if needed
1158977f918dSMatthias Ringwald     if (iso_stream->num_packets_to_skip > 0){
1159977f918dSMatthias Ringwald         iso_stream->num_packets_to_skip--;
1160977f918dSMatthias Ringwald         // pretend it was processed and trigger next one
1161977f918dSMatthias Ringwald         hci_release_packet_buffer();
1162977f918dSMatthias Ringwald         hci_iso_notify_can_send_now();
1163977f918dSMatthias Ringwald         return ERROR_CODE_SUCCESS;
1164977f918dSMatthias Ringwald     }
1165977f918dSMatthias Ringwald 
1166e5413aa0SMatthias Ringwald     // track outgoing packet sent
1167e5413aa0SMatthias Ringwald     log_info("Outgoing ISO packet for con handle 0x%04x", con_handle);
1168e5413aa0SMatthias Ringwald     iso_stream->num_packets_sent++;
1169e5413aa0SMatthias Ringwald 
117068ab6207SMatthias Ringwald     // setup data
117168ab6207SMatthias Ringwald     hci_stack->iso_fragmentation_total_size = size;
117268ab6207SMatthias Ringwald     hci_stack->iso_fragmentation_pos = 4;   // start of L2CAP packet
117368ab6207SMatthias Ringwald 
117468ab6207SMatthias Ringwald     return hci_send_iso_packet_fragments();
1175ace08712SMatthias Ringwald }
1176ace08712SMatthias Ringwald #endif
1177ace08712SMatthias Ringwald 
1178c3b46f5aSMatthias Ringwald static void acl_handler(uint8_t *packet, uint16_t size){
1179e76a89eeS[email protected] 
11807856c818Smatthias.ringwald     // get info
11817856c818Smatthias.ringwald     hci_con_handle_t con_handle = READ_ACL_CONNECTION_HANDLE(packet);
11825061f3afS[email protected]     hci_connection_t *conn      = hci_connection_for_handle(con_handle);
11837856c818Smatthias.ringwald     uint8_t  acl_flags          = READ_ACL_FLAGS(packet);
11847856c818Smatthias.ringwald     uint16_t acl_length         = READ_ACL_LENGTH(packet);
11857856c818Smatthias.ringwald 
11867856c818Smatthias.ringwald     // ignore non-registered handle
11877856c818Smatthias.ringwald     if (!conn){
1188c3b46f5aSMatthias Ringwald         log_error("acl_handler called with non-registered handle %u!" , con_handle);
11897856c818Smatthias.ringwald         return;
11907856c818Smatthias.ringwald     }
11917856c818Smatthias.ringwald 
1192e76a89eeS[email protected]     // assert packet is complete
11934ea43905SMatthias Ringwald     if ((acl_length + 4u) != size){
1194c3b46f5aSMatthias Ringwald         log_error("acl_handler called with ACL packet of wrong size %d, expected %u => dropping packet", size, acl_length + 4);
1195e76a89eeS[email protected]         return;
1196e76a89eeS[email protected]     }
1197e76a89eeS[email protected] 
119852db98b2SMatthias Ringwald #ifdef ENABLE_CLASSIC
11997856c818Smatthias.ringwald     // update idle timestamp
12007856c818Smatthias.ringwald     hci_connection_timestamp(conn);
120152db98b2SMatthias Ringwald #endif
12027856c818Smatthias.ringwald 
12032b838201SMatthias Ringwald #ifdef ENABLE_HCI_CONTROLLER_TO_HOST_FLOW_CONTROL
12042b838201SMatthias Ringwald     hci_stack->host_completed_packets = 1;
12052b838201SMatthias Ringwald     conn->num_packets_completed++;
12062b838201SMatthias Ringwald #endif
12072b838201SMatthias Ringwald 
12087856c818Smatthias.ringwald     // handle different packet types
12094ea43905SMatthias Ringwald     switch (acl_flags & 0x03u) {
12107856c818Smatthias.ringwald 
12117856c818Smatthias.ringwald         case 0x01: // continuation fragment
12127856c818Smatthias.ringwald 
12130ca847afS[email protected]             // sanity checks
12144ea43905SMatthias Ringwald             if (conn->acl_recombination_pos == 0u) {
12159da54300S[email protected]                 log_error( "ACL Cont Fragment but no first fragment for handle 0x%02x", con_handle);
12167856c818Smatthias.ringwald                 return;
12177856c818Smatthias.ringwald             }
12184ea43905SMatthias Ringwald             if ((conn->acl_recombination_pos + acl_length) > (4u + HCI_ACL_BUFFER_SIZE)){
12190ca847afS[email protected]                 log_error( "ACL Cont Fragment to large: combined packet %u > buffer size %u for handle 0x%02x",
12200ca847afS[email protected]                     conn->acl_recombination_pos + acl_length, 4 + HCI_ACL_BUFFER_SIZE, con_handle);
12210ca847afS[email protected]                 conn->acl_recombination_pos = 0;
12220ca847afS[email protected]                 return;
12230ca847afS[email protected]             }
12247856c818Smatthias.ringwald 
12257856c818Smatthias.ringwald             // append fragment payload (header already stored)
12266535961aSMatthias Ringwald             (void)memcpy(&conn->acl_recombination_buffer[HCI_INCOMING_PRE_BUFFER_SIZE + conn->acl_recombination_pos],
12276535961aSMatthias Ringwald                          &packet[4], acl_length);
12287856c818Smatthias.ringwald             conn->acl_recombination_pos += acl_length;
12297856c818Smatthias.ringwald 
12307856c818Smatthias.ringwald             // forward complete L2CAP packet if complete.
12314ea43905SMatthias Ringwald             if (conn->acl_recombination_pos >= (conn->acl_recombination_length + 4u + 4u)){ // pos already incl. ACL header
1232d6b06661SMatthias Ringwald                 hci_emit_acl_packet(&conn->acl_recombination_buffer[HCI_INCOMING_PRE_BUFFER_SIZE], conn->acl_recombination_pos);
12337856c818Smatthias.ringwald                 // reset recombination buffer
12347856c818Smatthias.ringwald                 conn->acl_recombination_length = 0;
12357856c818Smatthias.ringwald                 conn->acl_recombination_pos = 0;
12367856c818Smatthias.ringwald             }
12377856c818Smatthias.ringwald             break;
12387856c818Smatthias.ringwald 
12397856c818Smatthias.ringwald         case 0x02: { // first fragment
12407856c818Smatthias.ringwald 
124123a77e1aS[email protected]             // sanity check
124223a77e1aS[email protected]             if (conn->acl_recombination_pos) {
124360737d2bSMatthias Ringwald                 // we just received the first fragment, but still have data. Only warn if the packet wasn't a flushable packet
124460737d2bSMatthias Ringwald                 if ((conn->acl_recombination_buffer[HCI_INCOMING_PRE_BUFFER_SIZE+1] >> 4) != 0x02){
124560737d2bSMatthias Ringwald                     log_error( "ACL First Fragment but %u bytes in buffer for handle 0x%02x, dropping stale fragments", conn->acl_recombination_pos, con_handle);
124660737d2bSMatthias Ringwald                 }
124723a77e1aS[email protected]                 conn->acl_recombination_pos = 0;
124823a77e1aS[email protected]             }
124923a77e1aS[email protected] 
12507856c818Smatthias.ringwald             // peek into L2CAP packet!
12517856c818Smatthias.ringwald             uint16_t l2cap_length = READ_L2CAP_LENGTH( packet );
12527856c818Smatthias.ringwald 
12537856c818Smatthias.ringwald             // compare fragment size to L2CAP packet size
12544ea43905SMatthias Ringwald             if (acl_length >= (l2cap_length + 4u)){
12557856c818Smatthias.ringwald                 // forward fragment as L2CAP packet
1256*9244e83cSMatthias Ringwald                 hci_emit_acl_packet(packet, l2cap_length + 8u);
12577856c818Smatthias.ringwald             } else {
12580ca847afS[email protected] 
12590ca847afS[email protected]                 if (acl_length > HCI_ACL_BUFFER_SIZE){
12600ca847afS[email protected]                     log_error( "ACL First Fragment to large: fragment %u > buffer size %u for handle 0x%02x",
12610ca847afS[email protected]                         4 + acl_length, 4 + HCI_ACL_BUFFER_SIZE, con_handle);
12620ca847afS[email protected]                     return;
12630ca847afS[email protected]                 }
12640ca847afS[email protected] 
12657856c818Smatthias.ringwald                 // store first fragment and tweak acl length for complete package
12666535961aSMatthias Ringwald                 (void)memcpy(&conn->acl_recombination_buffer[HCI_INCOMING_PRE_BUFFER_SIZE],
12674ea43905SMatthias Ringwald                              packet, acl_length + 4u);
12684ea43905SMatthias Ringwald                 conn->acl_recombination_pos    = acl_length + 4u;
12697856c818Smatthias.ringwald                 conn->acl_recombination_length = l2cap_length;
12704ea43905SMatthias Ringwald                 little_endian_store_16(conn->acl_recombination_buffer, HCI_INCOMING_PRE_BUFFER_SIZE + 2u, l2cap_length +4u);
12717856c818Smatthias.ringwald             }
12727856c818Smatthias.ringwald             break;
12737856c818Smatthias.ringwald 
12747856c818Smatthias.ringwald         }
12757856c818Smatthias.ringwald         default:
1276c3b46f5aSMatthias Ringwald             log_error( "acl_handler called with invalid packet boundary flags %u", acl_flags & 0x03);
12777856c818Smatthias.ringwald             return;
12787856c818Smatthias.ringwald     }
127994ab26f8Smatthias.ringwald 
128094ab26f8Smatthias.ringwald     // execute main loop
128194ab26f8Smatthias.ringwald     hci_run();
128216833f0aSmatthias.ringwald }
128322909952Smatthias.ringwald 
12841ab2dc58SMatthias Ringwald static void hci_connection_stop_timer(hci_connection_t * conn){
12851ab2dc58SMatthias Ringwald     btstack_run_loop_remove_timer(&conn->timeout);
12861ab2dc58SMatthias Ringwald #ifdef ENABLE_CLASSIC
12871ab2dc58SMatthias Ringwald     btstack_run_loop_remove_timer(&conn->timeout_sco);
12881ab2dc58SMatthias Ringwald #endif
12891ab2dc58SMatthias Ringwald }
12901ab2dc58SMatthias Ringwald 
129167a3e8ecSmatthias.ringwald static void hci_shutdown_connection(hci_connection_t *conn){
12929da54300S[email protected]     log_info("Connection closed: handle 0x%x, %s", conn->con_handle, bd_addr_to_str(conn->address));
12933c4d4b90Smatthias.ringwald 
1294b3264428SMatthias Ringwald #ifdef ENABLE_CLASSIC
1295cb70c5abSMatthias Ringwald #if defined(ENABLE_SCO_OVER_HCI) || defined(HAVE_SCO_TRANSPORT)
1296cb70c5abSMatthias Ringwald     bd_addr_type_t addr_type = conn->address_type;
1297cb70c5abSMatthias Ringwald #endif
1298cb70c5abSMatthias Ringwald #ifdef HAVE_SCO_TRANSPORT
1299cb70c5abSMatthias Ringwald     hci_con_handle_t con_handle = conn->con_handle;
1300ee752bb8SMatthias Ringwald #endif
1301b3264428SMatthias Ringwald #endif
1302ee752bb8SMatthias Ringwald 
13031ab2dc58SMatthias Ringwald     hci_connection_stop_timer(conn);
1304c785ef68Smatthias.ringwald 
1305665d90f2SMatthias Ringwald     btstack_linked_list_remove(&hci_stack->connections, (btstack_linked_item_t *) conn);
1306a3b02b71Smatthias.ringwald     btstack_memory_hci_connection_free( conn );
13073c4d4b90Smatthias.ringwald 
13083c4d4b90Smatthias.ringwald     // now it's gone
1309c7e0c5f6Smatthias.ringwald     hci_emit_nr_connections_changed();
1310ee752bb8SMatthias Ringwald 
1311b3264428SMatthias Ringwald #ifdef ENABLE_CLASSIC
1312034e9b53SMatthias Ringwald #ifdef ENABLE_SCO_OVER_HCI
1313ee752bb8SMatthias Ringwald     // update SCO
1314cb70c5abSMatthias Ringwald     if ((addr_type == BD_ADDR_TYPE_SCO) && (hci_stack->hci_transport != NULL) && (hci_stack->hci_transport->set_sco_config != NULL)){
1315ee752bb8SMatthias Ringwald         hci_stack->hci_transport->set_sco_config(hci_stack->sco_voice_setting_active, hci_number_sco_connections());
1316ee752bb8SMatthias Ringwald     }
1317034e9b53SMatthias Ringwald #endif
1318cb70c5abSMatthias Ringwald #ifdef HAVE_SCO_TRANSPORT
1319cb70c5abSMatthias Ringwald     if ((addr_type == BD_ADDR_TYPE_SCO) && (hci_stack->sco_transport != NULL)){
1320cb70c5abSMatthias Ringwald         hci_stack->sco_transport->close(con_handle);
1321cb70c5abSMatthias Ringwald     }
1322cb70c5abSMatthias Ringwald #endif
1323b3264428SMatthias Ringwald #endif
1324c7e0c5f6Smatthias.ringwald }
1325c7e0c5f6Smatthias.ringwald 
132635454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
132735454696SMatthias Ringwald 
132829e39de4SMatthias Ringwald static const uint16_t hci_acl_packet_type_sizes[] = {
13298f8108aaSmatthias.ringwald     0, HCI_ACL_2DH1_SIZE, HCI_ACL_3DH1_SIZE, HCI_ACL_DM1_SIZE,
13308f8108aaSmatthias.ringwald     HCI_ACL_DH1_SIZE, 0, 0, 0,
13318f8108aaSmatthias.ringwald     HCI_ACL_2DH3_SIZE, HCI_ACL_3DH3_SIZE, HCI_ACL_DM3_SIZE, HCI_ACL_DH3_SIZE,
13328f8108aaSmatthias.ringwald     HCI_ACL_2DH5_SIZE, HCI_ACL_3DH5_SIZE, HCI_ACL_DM5_SIZE, HCI_ACL_DH5_SIZE
13338f8108aaSmatthias.ringwald };
133429e39de4SMatthias Ringwald static const uint8_t hci_acl_packet_type_feature_requirement_bit[] = {
133565389bfcS[email protected]      0, // 3 slot packets
133665389bfcS[email protected]      1, // 5 slot packets
133765389bfcS[email protected]     25, // EDR 2 mpbs
133865389bfcS[email protected]     26, // EDR 3 mbps
1339a086dc35SMatthias Ringwald     39, // 3 slot EDR packtes
134065389bfcS[email protected]     40, // 5 slot EDR packet
134165389bfcS[email protected] };
134229e39de4SMatthias Ringwald static const uint16_t hci_acl_packet_type_feature_packet_mask[] = {
134365389bfcS[email protected]     0x0f00, // 3 slot packets
134465389bfcS[email protected]     0xf000, // 5 slot packets
134565389bfcS[email protected]     0x1102, // EDR 2 mpbs
134665389bfcS[email protected]     0x2204, // EDR 3 mbps
1347a086dc35SMatthias Ringwald     0x0300, // 3 slot EDR packtes
134865389bfcS[email protected]     0x3000, // 5 slot EDR packet
134965389bfcS[email protected] };
13508f8108aaSmatthias.ringwald 
135165389bfcS[email protected] static uint16_t hci_acl_packet_types_for_buffer_size_and_local_features(uint16_t buffer_size, uint8_t * local_supported_features){
135265389bfcS[email protected]     // enable packet types based on size
13538f8108aaSmatthias.ringwald     uint16_t packet_types = 0;
1354f16a69bbS[email protected]     unsigned int i;
13558f8108aaSmatthias.ringwald     for (i=0;i<16;i++){
135629e39de4SMatthias Ringwald         if (hci_acl_packet_type_sizes[i] == 0) continue;
135729e39de4SMatthias Ringwald         if (hci_acl_packet_type_sizes[i] <= buffer_size){
13588f8108aaSmatthias.ringwald             packet_types |= 1 << i;
13598f8108aaSmatthias.ringwald         }
13608f8108aaSmatthias.ringwald     }
136165389bfcS[email protected]     // disable packet types due to missing local supported features
136229e39de4SMatthias Ringwald     for (i=0;i<sizeof(hci_acl_packet_type_feature_requirement_bit); i++){
136329e39de4SMatthias Ringwald         unsigned int bit_idx = hci_acl_packet_type_feature_requirement_bit[i];
136465389bfcS[email protected]         int feature_set = (local_supported_features[bit_idx >> 3] & (1<<(bit_idx & 7))) != 0;
136565389bfcS[email protected]         if (feature_set) continue;
136629e39de4SMatthias Ringwald         log_info("Features bit %02u is not set, removing packet types 0x%04x", bit_idx, hci_acl_packet_type_feature_packet_mask[i]);
136729e39de4SMatthias Ringwald         packet_types &= ~hci_acl_packet_type_feature_packet_mask[i];
136865389bfcS[email protected]     }
13698f8108aaSmatthias.ringwald     return packet_types;
13708f8108aaSmatthias.ringwald }
13718f8108aaSmatthias.ringwald 
13728f8108aaSmatthias.ringwald uint16_t hci_usable_acl_packet_types(void){
1373028ead5eSMatthias Ringwald     uint16_t active_packet_types = (hci_stack->usable_packet_types_acl &  hci_stack->enabled_packet_types_acl);
137429e39de4SMatthias Ringwald     // flip bits for "may not be used"
1375028ead5eSMatthias Ringwald     return  active_packet_types ^ 0x3306;
1376028ead5eSMatthias Ringwald }
1377028ead5eSMatthias Ringwald 
1378028ead5eSMatthias Ringwald void hci_enable_acl_packet_types(uint16_t packet_types){
1379028ead5eSMatthias Ringwald     hci_stack->enabled_packet_types_acl = packet_types;
13808f8108aaSmatthias.ringwald }
138129e39de4SMatthias Ringwald 
1382c92ca2c8SMatthias Ringwald static const struct {
1383c92ca2c8SMatthias Ringwald     uint8_t feature_index;
1384c92ca2c8SMatthias Ringwald     uint16_t feature_packet_mask;
1385c92ca2c8SMatthias Ringwald } hci_sco_packet_type_feature_requirements[] = {
1386c92ca2c8SMatthias Ringwald         { 12, SCO_PACKET_TYPES_HV2 },                           // HV2 packets
1387c92ca2c8SMatthias Ringwald         { 13, SCO_PACKET_TYPES_HV3 },                           // HV3 packets
1388c92ca2c8SMatthias Ringwald         { 31, SCO_PACKET_TYPES_ESCO },                          // eSCO links (EV3 packets)
1389c92ca2c8SMatthias Ringwald         { 32, SCO_PACKET_TYPES_EV4 },                           // EV4 packets
1390c92ca2c8SMatthias Ringwald         { 45, SCO_PACKET_TYPES_2EV3 | SCO_PACKET_TYPES_2EV5 },  // EDR eSCO 2 Mb/s
1391c92ca2c8SMatthias Ringwald         { 46, SCO_PACKET_TYPES_3EV3 | SCO_PACKET_TYPES_3EV5 },  // EDR eSCO 3 Mb/s
13926afff830SMatthias Ringwald         { 47, SCO_PACKET_TYPES_2EV5 | SCO_PACKET_TYPES_3EV5 },  // 3-slot EDR eSCO packets, 2-EV3/3-EV3 use single slot
1393c92ca2c8SMatthias Ringwald };
1394c92ca2c8SMatthias Ringwald 
1395d7891039SMatthias Ringwald // map packet types to payload length, prefer eSCO over SCO and large over small packets
1396d7891039SMatthias Ringwald static const struct {
1397d7891039SMatthias Ringwald     uint16_t type;
1398d7891039SMatthias Ringwald     uint16_t payload_length;
1399d7891039SMatthias Ringwald } hci_sco_packet_type_to_payload_length[] = {
1400d7891039SMatthias Ringwald         {SCO_PACKET_TYPES_3EV5, HCI_SCO_3EV5_SIZE}, // 540
1401d7891039SMatthias Ringwald         {SCO_PACKET_TYPES_2EV5, HCI_SCO_2EV5_SIZE}, // 360
1402d7891039SMatthias Ringwald         {SCO_PACKET_TYPES_EV5,  HCI_SCO_EV5_SIZE},  // 180
1403d7891039SMatthias Ringwald         {SCO_PACKET_TYPES_EV4,  HCI_SCO_EV4_SIZE},  // 120
1404d7891039SMatthias Ringwald         {SCO_PACKET_TYPES_3EV3, HCI_SCO_3EV3_SIZE}, //  90
1405d7891039SMatthias Ringwald         {SCO_PACKET_TYPES_2EV3, HCI_SCO_2EV3_SIZE}, //  60
1406d7891039SMatthias Ringwald         {SCO_PACKET_TYPES_EV3,  HCI_SCO_EV3_SIZE},  //  30
1407d7891039SMatthias Ringwald         {SCO_PACKET_TYPES_HV3,  HCI_SCO_HV3_SIZE},  //  30
1408d7891039SMatthias Ringwald         {SCO_PACKET_TYPES_HV2,  HCI_SCO_HV2_SIZE},  //  20
1409d7891039SMatthias Ringwald         {SCO_PACKET_TYPES_HV1,  HCI_SCO_HV1_SIZE}   //  10
1410d7891039SMatthias Ringwald };
1411d7891039SMatthias Ringwald 
1412c92ca2c8SMatthias Ringwald static uint16_t hci_sco_packet_types_for_features(const uint8_t * local_supported_features){
1413c92ca2c8SMatthias Ringwald     uint16_t packet_types = SCO_PACKET_TYPES_ALL;
1414c92ca2c8SMatthias Ringwald     unsigned int i;
1415c92ca2c8SMatthias Ringwald     // disable packet types due to missing local supported features
1416c92ca2c8SMatthias Ringwald     for (i=0;i<(sizeof(hci_sco_packet_type_feature_requirements)/sizeof(hci_sco_packet_type_feature_requirements[0])); i++){
1417c92ca2c8SMatthias Ringwald         unsigned int bit_idx = hci_sco_packet_type_feature_requirements[i].feature_index;
1418c92ca2c8SMatthias Ringwald         bool feature_set = (local_supported_features[bit_idx >> 3] & (1<<(bit_idx & 7))) != 0;
1419c92ca2c8SMatthias Ringwald         if (feature_set) continue;
1420c92ca2c8SMatthias 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);
1421c92ca2c8SMatthias Ringwald         packet_types &= ~hci_sco_packet_type_feature_requirements[i].feature_packet_mask;
1422c92ca2c8SMatthias Ringwald     }
1423c92ca2c8SMatthias Ringwald     return packet_types;
1424c92ca2c8SMatthias Ringwald }
1425c92ca2c8SMatthias Ringwald 
1426c92ca2c8SMatthias Ringwald uint16_t hci_usable_sco_packet_types(void){
1427c92ca2c8SMatthias Ringwald     return hci_stack->usable_packet_types_sco;
1428c92ca2c8SMatthias Ringwald }
1429c92ca2c8SMatthias Ringwald 
1430d7891039SMatthias Ringwald static uint16_t hci_sco_payload_length_for_packet_types(uint16_t packet_types){
1431d7891039SMatthias Ringwald     uint8_t i;
1432d7891039SMatthias Ringwald     for (i=0;i<sizeof(hci_sco_packet_type_to_payload_length)/sizeof(hci_sco_packet_type_to_payload_length[0]);i++){
1433d7891039SMatthias Ringwald         if ((hci_sco_packet_type_to_payload_length[i].type & packet_types) != 0){
1434d7891039SMatthias Ringwald             return hci_sco_packet_type_to_payload_length[i].payload_length;
1435d7891039SMatthias Ringwald         }
1436d7891039SMatthias Ringwald     }
1437d7891039SMatthias Ringwald     return 0;
1438d7891039SMatthias Ringwald }
1439d7891039SMatthias Ringwald 
144035454696SMatthias Ringwald #endif
14418f8108aaSmatthias.ringwald 
1442facf93fdS[email protected] uint8_t* hci_get_outgoing_packet_buffer(void){
14437dc17943Smatthias.ringwald     // hci packet buffer is >= acl data packet length
14443a9fb326S[email protected]     return hci_stack->hci_packet_buffer;
14457dc17943Smatthias.ringwald }
14467dc17943Smatthias.ringwald 
1447f5d8d141S[email protected] uint16_t hci_max_acl_data_packet_length(void){
14483a9fb326S[email protected]     return hci_stack->acl_data_packet_length;
14497dc17943Smatthias.ringwald }
14507dc17943Smatthias.ringwald 
145106b9e820SMatthias Ringwald #ifdef ENABLE_CLASSIC
145220dcdd22SMatthias Ringwald bool hci_extended_sco_link_supported(void){
14533e68d23dSMatthias Ringwald     // No. 31, byte 3, bit 7
14543e68d23dSMatthias Ringwald     return (hci_stack->local_supported_features[3] & (1 << 7)) != 0;
14553e68d23dSMatthias Ringwald }
145606b9e820SMatthias Ringwald #endif
14573e68d23dSMatthias Ringwald 
145820dcdd22SMatthias Ringwald bool hci_non_flushable_packet_boundary_flag_supported(void){
14596ac9a97eS[email protected]     // No. 54, byte 6, bit 6
14604ea43905SMatthias Ringwald     return (hci_stack->local_supported_features[6u] & (1u << 6u)) != 0u;
14616ac9a97eS[email protected] }
14626ac9a97eS[email protected] 
14639885fb2dSMatthias Ringwald #ifdef ENABLE_CLASSIC
146457514786SMatthias Ringwald static bool gap_ssp_supported(void){
14656ac9a97eS[email protected]     // No. 51, byte 6, bit 3
14664ea43905SMatthias Ringwald     return (hci_stack->local_supported_features[6u] & (1u << 3u)) != 0u;
1467f5d8d141S[email protected] }
14689885fb2dSMatthias Ringwald #endif
1469f5d8d141S[email protected] 
1470ad58a385SMatthias Ringwald bool hci_classic_supported(void){
147135454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
14726ac9a97eS[email protected]     // No. 37, byte 4, bit 5, = No BR/EDR Support
14733a9fb326S[email protected]     return (hci_stack->local_supported_features[4] & (1 << 5)) == 0;
147435454696SMatthias Ringwald #else
147557514786SMatthias Ringwald     return false;
147635454696SMatthias Ringwald #endif
1477f5d8d141S[email protected] }
1478f5d8d141S[email protected] 
1479ad58a385SMatthias Ringwald bool hci_le_supported(void){
1480a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE
14816ac9a97eS[email protected]     // No. 37, byte 4, bit 6 = LE Supported (Controller)
14824ea43905SMatthias Ringwald     return (hci_stack->local_supported_features[4u] & (1u << 6u)) != 0u;
1483f5d8d141S[email protected] #else
148457514786SMatthias Ringwald     return false;
1485f5d8d141S[email protected] #endif
1486f5d8d141S[email protected] }
1487f5d8d141S[email protected] 
14881ffa425cSMatthias Ringwald static bool hci_command_supported(uint8_t command_index){
14891ffa425cSMatthias Ringwald     return (hci_stack->local_supported_commands & (1LU << command_index)) != 0;
14901ffa425cSMatthias Ringwald }
14911ffa425cSMatthias Ringwald 
1492b95a5a35SMatthias Ringwald #ifdef ENABLE_BLE
1493b95a5a35SMatthias Ringwald 
149463671e69SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
149522f987e4SMatthias Ringwald bool hci_le_extended_advertising_supported(void){
149663671e69SMatthias Ringwald     return hci_command_supported(SUPPORTED_HCI_COMMAND_LE_SET_EXTENDED_ADVERTISING_ENABLE);
149763671e69SMatthias Ringwald }
149863671e69SMatthias Ringwald #endif
149963671e69SMatthias Ringwald 
1500f5873674SMatthias Ringwald static void hci_get_own_address_for_addr_type(uint8_t own_addr_type, bd_addr_t own_addr){
15016bcfa632SMatthias Ringwald     if (own_addr_type == BD_ADDR_TYPE_LE_PUBLIC){
15026bcfa632SMatthias Ringwald         (void)memcpy(own_addr, hci_stack->local_bd_addr, 6);
150369a97523S[email protected]     } else {
15046bcfa632SMatthias Ringwald         (void)memcpy(own_addr, hci_stack->le_random_address, 6);
150569a97523S[email protected]     }
150669a97523S[email protected] }
150769a97523S[email protected] 
15086bcfa632SMatthias Ringwald void gap_le_get_own_address(uint8_t * addr_type, bd_addr_t addr){
15096bcfa632SMatthias Ringwald     *addr_type = hci_stack->le_own_addr_type;
15106bcfa632SMatthias Ringwald     hci_get_own_address_for_addr_type(hci_stack->le_own_addr_type, addr);
15116bcfa632SMatthias Ringwald }
15126bcfa632SMatthias Ringwald 
15136bcfa632SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
15146bcfa632SMatthias Ringwald void gap_le_get_own_advertisements_address(uint8_t * addr_type, bd_addr_t addr){
15156bcfa632SMatthias Ringwald     *addr_type = hci_stack->le_advertisements_own_addr_type;
15166bcfa632SMatthias Ringwald     hci_get_own_address_for_addr_type(hci_stack->le_advertisements_own_addr_type, addr);
151736916f81SDirk Helbig }
1518efc77985SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
1519efc77985SMatthias Ringwald void gap_le_get_own_advertising_set_address(uint8_t * addr_type, bd_addr_t addr, uint8_t advertising_handle){
1520efc77985SMatthias Ringwald     if (advertising_handle == 0){
1521efc77985SMatthias Ringwald         gap_le_get_own_advertisements_address(addr_type, addr);
1522efc77985SMatthias Ringwald     } else {
1523efc77985SMatthias Ringwald         le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(advertising_handle);
1524efc77985SMatthias Ringwald         if (advertising_set != NULL){
1525efc77985SMatthias Ringwald             switch (advertising_set->extended_params.own_address_type){
1526efc77985SMatthias Ringwald                 case BD_ADDR_TYPE_LE_PUBLIC:
1527efc77985SMatthias Ringwald                     *addr_type = BD_ADDR_TYPE_LE_PUBLIC;
1528efc77985SMatthias Ringwald                     memcpy(addr, hci_stack->local_bd_addr, 6);
1529efc77985SMatthias Ringwald                     break;
1530efc77985SMatthias Ringwald                 case BD_ADDR_TYPE_LE_RANDOM:
1531efc77985SMatthias Ringwald                     *addr_type = BD_ADDR_TYPE_LE_RANDOM;
1532efc77985SMatthias Ringwald                     memcpy(addr, advertising_set->random_address, 6);
1533efc77985SMatthias Ringwald                     break;
1534efc77985SMatthias Ringwald                 case BD_ADDR_TYPE_LE_PUBLIC_IDENTITY:
1535efc77985SMatthias Ringwald                 case BD_ADDR_TYPE_LE_RANDOM_IDENTITY:
1536efc77985SMatthias Ringwald                     // do nothing as random address was already set from enhanced connection complete
1537efc77985SMatthias Ringwald                     break;
1538efc77985SMatthias Ringwald                 default:
1539efc77985SMatthias Ringwald                     break;
1540efc77985SMatthias Ringwald             }
1541efc77985SMatthias Ringwald         }
1542efc77985SMatthias Ringwald     }
154336916f81SDirk Helbig }
1544efc77985SMatthias Ringwald #endif
15456bcfa632SMatthias Ringwald #endif
15466bcfa632SMatthias Ringwald 
1547e8c8828eSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
15486bcfa632SMatthias Ringwald 
15496bcfa632SMatthias Ringwald /**
15506bcfa632SMatthias Ringwald  * @brief Get own addr type and address used for LE connections (Central)
15516bcfa632SMatthias Ringwald  */
15526bcfa632SMatthias Ringwald void gap_le_get_own_connection_address(uint8_t * addr_type, bd_addr_t addr){
15536bcfa632SMatthias Ringwald     *addr_type = hci_stack->le_connection_own_addr_type;
15546bcfa632SMatthias Ringwald     hci_get_own_address_for_addr_type(hci_stack->le_connection_own_addr_type, addr);
15556bcfa632SMatthias Ringwald }
15566bcfa632SMatthias Ringwald 
1557384b59deSMatthias Ringwald void le_handle_advertisement_report(uint8_t *packet, uint16_t size){
15589ec2630cSMatthias Ringwald 
1559a0698cb4SMatthias Ringwald     uint16_t offset = 3;
1560a0698cb4SMatthias Ringwald     uint8_t num_reports = packet[offset];
1561d1dc057bS[email protected]     offset += 1;
1562d1dc057bS[email protected] 
1563a0698cb4SMatthias Ringwald     uint16_t i;
156403fbe9c6S[email protected]     uint8_t event[12 + LE_ADVERTISING_DATA_SIZE]; // use upper bound to avoid var size automatic var
1565a1df452eSMatthias Ringwald     for (i=0; (i<num_reports) && (offset < size);i++){
156633e6948bSMatthias Ringwald         // sanity checks on data_length:
156733e6948bSMatthias Ringwald         uint8_t data_length = packet[offset + 8];
156833e6948bSMatthias Ringwald         if (data_length > LE_ADVERTISING_DATA_SIZE) return;
15694ea43905SMatthias Ringwald         if ((offset + 9u + data_length + 1u) > size)    return;
157033e6948bSMatthias Ringwald         // setup event
15714ea43905SMatthias Ringwald         uint8_t event_size = 10u + data_length;
1572a0698cb4SMatthias Ringwald         uint16_t pos = 0;
1573045013feSMatthias Ringwald         event[pos++] = GAP_EVENT_ADVERTISING_REPORT;
157457c9da5bS[email protected]         event[pos++] = event_size;
15756535961aSMatthias Ringwald         (void)memcpy(&event[pos], &packet[offset], 1 + 1 + 6); // event type + address type + address
1576d1dc057bS[email protected]         offset += 8;
1577d1dc057bS[email protected]         pos += 8;
1578d1dc057bS[email protected]         event[pos++] = packet[offset + 1 + data_length]; // rssi
157933e6948bSMatthias Ringwald         event[pos++] = data_length;
158033e6948bSMatthias Ringwald         offset++;
15816535961aSMatthias Ringwald         (void)memcpy(&event[pos], &packet[offset], data_length);
158257c9da5bS[email protected]         pos +=    data_length;
15834ea43905SMatthias Ringwald         offset += data_length + 1u; // rssi
15849da9850bSMatthias Ringwald         hci_emit_btstack_event(event, pos, 1);
158557c9da5bS[email protected]     }
158657c9da5bS[email protected] }
1587a0698cb4SMatthias Ringwald 
1588a0698cb4SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
1589033393eeSBob Abeles static void le_handle_extended_advertisement_report(uint8_t *packet, uint16_t size) {
1590a0698cb4SMatthias Ringwald     uint16_t offset = 3;
1591a0698cb4SMatthias Ringwald     uint8_t num_reports = packet[offset++];
1592c95a0fc7SMatthias Ringwald     uint8_t event[2 + 255]; // use upper bound to avoid var size automatic var
1593a0698cb4SMatthias Ringwald     uint8_t i;
1594a0698cb4SMatthias Ringwald     for (i=0; (i<num_reports) && (offset < size);i++){
1595a0698cb4SMatthias Ringwald         // sanity checks on data_length:
1596a0698cb4SMatthias Ringwald         uint16_t data_length = packet[offset + 23];
159743ce0351SMatthias Ringwald         if (data_length > LE_EXTENDED_ADVERTISING_DATA_SIZE) return;
1598a0698cb4SMatthias Ringwald         if ((offset + 24u + data_length) > size)    return;
1599a0698cb4SMatthias Ringwald         uint16_t event_type = little_endian_read_16(packet, offset);
1600a0698cb4SMatthias Ringwald         offset += 2;
1601a0698cb4SMatthias Ringwald         if ((event_type & 0x10) != 0) {
1602a0698cb4SMatthias Ringwald            // setup legacy event
1603a0698cb4SMatthias Ringwald             uint8_t legacy_event_type;
1604a0698cb4SMatthias Ringwald             switch (event_type){
160536916f81SDirk Helbig                 case 0x13: // 0b0010011
1606a0698cb4SMatthias Ringwald                     // ADV_IND
1607a0698cb4SMatthias Ringwald                     legacy_event_type = 0;
1608a0698cb4SMatthias Ringwald                     break;
160936916f81SDirk Helbig                 case 0x15: // 0b0010101
1610a0698cb4SMatthias Ringwald                     // ADV_DIRECT_IND
1611a0698cb4SMatthias Ringwald                     legacy_event_type = 1;
1612a0698cb4SMatthias Ringwald                     break;
161336916f81SDirk Helbig                 case 0x12: // 0b0010010
1614a0698cb4SMatthias Ringwald                     // ADV_SCAN_IND
1615a0698cb4SMatthias Ringwald                     legacy_event_type = 2;
1616a0698cb4SMatthias Ringwald                     break;
161736916f81SDirk Helbig                 case 0x10: // 0b0010000:
1618a0698cb4SMatthias Ringwald                     // ADV_NONCONN_IND
1619a0698cb4SMatthias Ringwald                     legacy_event_type = 3;
1620a0698cb4SMatthias Ringwald                     break;
162136916f81SDirk Helbig                 case 0x1B: // 0b0011011
162236916f81SDirk Helbig                 case 0x1A: // 0b0011010
1623a0698cb4SMatthias Ringwald                     // SCAN_RSP
1624a0698cb4SMatthias Ringwald                     legacy_event_type = 4;
1625a0698cb4SMatthias Ringwald                     break;
1626a0698cb4SMatthias Ringwald                 default:
1627a0698cb4SMatthias Ringwald                     legacy_event_type = 0;
1628a0698cb4SMatthias Ringwald                     break;
1629a0698cb4SMatthias Ringwald             }
1630a0698cb4SMatthias Ringwald             uint16_t pos = 0;
1631a0698cb4SMatthias Ringwald             event[pos++] = GAP_EVENT_ADVERTISING_REPORT;
1632a0698cb4SMatthias Ringwald             event[pos++] = 10u + data_length;
1633a0698cb4SMatthias Ringwald             event[pos++] = legacy_event_type;
1634a0698cb4SMatthias Ringwald             // copy address type + address
1635a0698cb4SMatthias Ringwald             (void) memcpy(&event[pos], &packet[offset], 1 + 6);
1636a0698cb4SMatthias Ringwald             offset += 7;
1637a0698cb4SMatthias Ringwald             pos += 7;
1638a0698cb4SMatthias Ringwald             // skip primary_phy, secondary_phy, advertising_sid, tx_power
1639a0698cb4SMatthias Ringwald             offset += 4;
1640a0698cb4SMatthias Ringwald             // copy rssi
1641a0698cb4SMatthias Ringwald             event[pos++] = packet[offset++];
1642a0698cb4SMatthias Ringwald             // skip periodic advertising interval and direct address
1643a0698cb4SMatthias Ringwald             offset += 9;
1644a0698cb4SMatthias Ringwald             // copy data len + data;
1645a0698cb4SMatthias Ringwald             (void) memcpy(&event[pos], &packet[offset], 1 + data_length);
1646a0698cb4SMatthias Ringwald             pos    += 1 +data_length;
1647a0698cb4SMatthias Ringwald             offset += 1+ data_length;
16489da9850bSMatthias Ringwald             hci_emit_btstack_event(event, pos, 1);
1649a0698cb4SMatthias Ringwald         } else {
1650c95a0fc7SMatthias Ringwald             event[0] = GAP_EVENT_EXTENDED_ADVERTISING_REPORT;
1651c95a0fc7SMatthias Ringwald             uint8_t report_len = 24 + data_length;
1652c95a0fc7SMatthias Ringwald             event[1] = report_len;
16530f7610adSMatthias Ringwald             little_endian_store_16(event, 2, event_type);
16540f7610adSMatthias Ringwald             memcpy(&event[4], &packet[offset], report_len);
1655c95a0fc7SMatthias Ringwald             offset += report_len;
16569da9850bSMatthias Ringwald             hci_emit_btstack_event(event, 2 + report_len, 1);
1657a0698cb4SMatthias Ringwald         }
1658a0698cb4SMatthias Ringwald     }
1659a0698cb4SMatthias Ringwald }
1660a0698cb4SMatthias Ringwald #endif
1661a0698cb4SMatthias Ringwald 
1662b2f949feS[email protected] #endif
1663e8c8828eSMatthias Ringwald #endif
166457c9da5bS[email protected] 
16652b6ab3e6SMatthias Ringwald #ifdef ENABLE_BLE
16662b6ab3e6SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
1667bbc366e6SMatthias Ringwald static void hci_update_advertisements_enabled_for_current_roles(void){
1668a408e724SMatthias Ringwald     if ((hci_stack->le_advertisements_state & LE_ADVERTISEMENT_STATE_ENABLED) != 0){
16692b6ab3e6SMatthias Ringwald         // get number of active le slave connections
16702b6ab3e6SMatthias Ringwald         int num_slave_connections = 0;
16712b6ab3e6SMatthias Ringwald         btstack_linked_list_iterator_t it;
16722b6ab3e6SMatthias Ringwald         btstack_linked_list_iterator_init(&it, &hci_stack->connections);
16732b6ab3e6SMatthias Ringwald         while (btstack_linked_list_iterator_has_next(&it)){
16742b6ab3e6SMatthias Ringwald             hci_connection_t * con = (hci_connection_t*) btstack_linked_list_iterator_next(&it);
16752b6ab3e6SMatthias Ringwald             log_info("state %u, role %u, le_con %u", con->state, con->role, hci_is_le_connection(con));
16762b6ab3e6SMatthias Ringwald             if (con->state != OPEN) continue;
16772b6ab3e6SMatthias Ringwald             if (con->role  != HCI_ROLE_SLAVE) continue;
16782b6ab3e6SMatthias Ringwald             if (!hci_is_le_connection(con)) continue;
16792b6ab3e6SMatthias Ringwald             num_slave_connections++;
16802b6ab3e6SMatthias Ringwald         }
16812b6ab3e6SMatthias Ringwald         log_info("Num LE Peripheral roles: %u of %u", num_slave_connections, hci_stack->le_max_number_peripheral_connections);
1682bbc366e6SMatthias Ringwald         hci_stack->le_advertisements_enabled_for_current_roles = num_slave_connections < hci_stack->le_max_number_peripheral_connections;
1683bbc366e6SMatthias Ringwald     } else {
1684bbc366e6SMatthias Ringwald         hci_stack->le_advertisements_enabled_for_current_roles = false;
16852b6ab3e6SMatthias Ringwald     }
16862b6ab3e6SMatthias Ringwald }
16872b6ab3e6SMatthias Ringwald #endif
16882b6ab3e6SMatthias Ringwald #endif
16892b6ab3e6SMatthias Ringwald 
169059d59ecfSMatthias Ringwald #ifdef ENABLE_CLASSIC
169159d59ecfSMatthias Ringwald static void gap_run_set_local_name(void){
169259d59ecfSMatthias Ringwald     hci_reserve_packet_buffer();
169359d59ecfSMatthias Ringwald     uint8_t * packet = hci_stack->hci_packet_buffer;
169459d59ecfSMatthias Ringwald     // construct HCI Command and send
169559d59ecfSMatthias Ringwald     uint16_t opcode = hci_write_local_name.opcode;
169659d59ecfSMatthias Ringwald     packet[0] = opcode & 0xff;
169759d59ecfSMatthias Ringwald     packet[1] = opcode >> 8;
169859d59ecfSMatthias Ringwald     packet[2] = DEVICE_NAME_LEN;
169959d59ecfSMatthias Ringwald     memset(&packet[3], 0, DEVICE_NAME_LEN);
170059d59ecfSMatthias Ringwald     uint16_t name_len = (uint16_t) strlen(hci_stack->local_name);
170159d59ecfSMatthias Ringwald     uint16_t bytes_to_copy = btstack_min(name_len, DEVICE_NAME_LEN);
170259d59ecfSMatthias Ringwald     // if shorter than DEVICE_NAME_LEN, it's implicitly NULL-terminated by memset call
170359d59ecfSMatthias Ringwald     (void)memcpy(&packet[3], hci_stack->local_name, bytes_to_copy);
170459d59ecfSMatthias Ringwald     // expand '00:00:00:00:00:00' in name with bd_addr
170559d59ecfSMatthias Ringwald     btstack_replace_bd_addr_placeholder(&packet[3], bytes_to_copy, hci_stack->local_bd_addr);
1706ca6804fdSMatthias Ringwald     hci_send_prepared_cmd_packet();
170759d59ecfSMatthias Ringwald }
170859d59ecfSMatthias Ringwald 
170959d59ecfSMatthias Ringwald static void gap_run_set_eir_data(void){
171059d59ecfSMatthias Ringwald     hci_reserve_packet_buffer();
171159d59ecfSMatthias Ringwald     uint8_t * packet = hci_stack->hci_packet_buffer;
171259d59ecfSMatthias Ringwald     // construct HCI Command in-place and send
171359d59ecfSMatthias Ringwald     uint16_t opcode = hci_write_extended_inquiry_response.opcode;
171459d59ecfSMatthias Ringwald     uint16_t offset = 0;
171559d59ecfSMatthias Ringwald     packet[offset++] = opcode & 0xff;
171659d59ecfSMatthias Ringwald     packet[offset++] = opcode >> 8;
171759d59ecfSMatthias Ringwald     packet[offset++] = 1 + EXTENDED_INQUIRY_RESPONSE_DATA_LEN;
171859d59ecfSMatthias Ringwald     packet[offset++] = 0;  // FEC not required
171959d59ecfSMatthias Ringwald     memset(&packet[offset], 0, EXTENDED_INQUIRY_RESPONSE_DATA_LEN);
172059d59ecfSMatthias Ringwald     if (hci_stack->eir_data){
172159d59ecfSMatthias Ringwald         // copy items and expand '00:00:00:00:00:00' in name with bd_addr
172259d59ecfSMatthias Ringwald         ad_context_t context;
172359d59ecfSMatthias Ringwald         for (ad_iterator_init(&context, EXTENDED_INQUIRY_RESPONSE_DATA_LEN, hci_stack->eir_data) ; ad_iterator_has_more(&context) ; ad_iterator_next(&context)) {
172459d59ecfSMatthias Ringwald             uint8_t data_type   = ad_iterator_get_data_type(&context);
172559d59ecfSMatthias Ringwald             uint8_t size        = ad_iterator_get_data_len(&context);
172659d59ecfSMatthias Ringwald             const uint8_t *data = ad_iterator_get_data(&context);
172759d59ecfSMatthias Ringwald             // copy item
172859d59ecfSMatthias Ringwald             packet[offset++] = size + 1;
172959d59ecfSMatthias Ringwald             packet[offset++] = data_type;
173059d59ecfSMatthias Ringwald             memcpy(&packet[offset], data, size);
173159d59ecfSMatthias Ringwald             // update name item
173259d59ecfSMatthias Ringwald             if ((data_type == BLUETOOTH_DATA_TYPE_SHORTENED_LOCAL_NAME) || (data_type == BLUETOOTH_DATA_TYPE_COMPLETE_LOCAL_NAME)){
173359d59ecfSMatthias Ringwald                 btstack_replace_bd_addr_placeholder(&packet[offset], size, hci_stack->local_bd_addr);
173459d59ecfSMatthias Ringwald             }
173559d59ecfSMatthias Ringwald             offset += size;
173659d59ecfSMatthias Ringwald         }
173759d59ecfSMatthias Ringwald     } else {
173859d59ecfSMatthias Ringwald         uint16_t name_len = (uint16_t) strlen(hci_stack->local_name);
173959d59ecfSMatthias Ringwald         uint16_t bytes_to_copy = btstack_min(name_len, EXTENDED_INQUIRY_RESPONSE_DATA_LEN - 2);
174059d59ecfSMatthias Ringwald         packet[offset++] = bytes_to_copy + 1;
174159d59ecfSMatthias Ringwald         packet[offset++] = BLUETOOTH_DATA_TYPE_COMPLETE_LOCAL_NAME;
174259d59ecfSMatthias Ringwald         (void)memcpy(&packet[6], hci_stack->local_name, bytes_to_copy);
174359d59ecfSMatthias Ringwald         // expand '00:00:00:00:00:00' in name with bd_addr
174459d59ecfSMatthias Ringwald         btstack_replace_bd_addr_placeholder(&packet[offset], bytes_to_copy, hci_stack->local_bd_addr);
174559d59ecfSMatthias Ringwald     }
1746ca6804fdSMatthias Ringwald     hci_send_prepared_cmd_packet();
174759d59ecfSMatthias Ringwald }
1748ab4831a3SMatthias Ringwald 
1749ab4831a3SMatthias Ringwald static void hci_run_gap_tasks_classic(void){
1750baa4881eSMatthias Ringwald     if ((hci_stack->gap_tasks_classic & GAP_TASK_SET_CLASS_OF_DEVICE) != 0) {
1751baa4881eSMatthias Ringwald         hci_stack->gap_tasks_classic &= ~GAP_TASK_SET_CLASS_OF_DEVICE;
1752ab4831a3SMatthias Ringwald         hci_send_cmd(&hci_write_class_of_device, hci_stack->class_of_device);
1753ab4831a3SMatthias Ringwald         return;
1754ab4831a3SMatthias Ringwald     }
1755baa4881eSMatthias Ringwald     if ((hci_stack->gap_tasks_classic & GAP_TASK_SET_LOCAL_NAME) != 0) {
1756baa4881eSMatthias Ringwald         hci_stack->gap_tasks_classic &= ~GAP_TASK_SET_LOCAL_NAME;
1757ab4831a3SMatthias Ringwald         gap_run_set_local_name();
1758ab4831a3SMatthias Ringwald         return;
1759ab4831a3SMatthias Ringwald     }
1760baa4881eSMatthias Ringwald     if ((hci_stack->gap_tasks_classic & GAP_TASK_SET_EIR_DATA) != 0) {
1761baa4881eSMatthias Ringwald         hci_stack->gap_tasks_classic &= ~GAP_TASK_SET_EIR_DATA;
1762ab4831a3SMatthias Ringwald         gap_run_set_eir_data();
1763ab4831a3SMatthias Ringwald         return;
1764ab4831a3SMatthias Ringwald     }
1765baa4881eSMatthias Ringwald     if ((hci_stack->gap_tasks_classic & GAP_TASK_SET_DEFAULT_LINK_POLICY) != 0) {
1766baa4881eSMatthias Ringwald         hci_stack->gap_tasks_classic &= ~GAP_TASK_SET_DEFAULT_LINK_POLICY;
1767ab4831a3SMatthias Ringwald         hci_send_cmd(&hci_write_default_link_policy_setting, hci_stack->default_link_policy_settings);
1768ab4831a3SMatthias Ringwald         return;
1769ab4831a3SMatthias Ringwald     }
1770ab4831a3SMatthias Ringwald     // write page scan activity
1771baa4881eSMatthias Ringwald     if ((hci_stack->gap_tasks_classic & GAP_TASK_WRITE_PAGE_SCAN_ACTIVITY) != 0) {
1772baa4881eSMatthias Ringwald         hci_stack->gap_tasks_classic &= ~GAP_TASK_WRITE_PAGE_SCAN_ACTIVITY;
1773ab4831a3SMatthias Ringwald         hci_send_cmd(&hci_write_page_scan_activity, hci_stack->new_page_scan_interval, hci_stack->new_page_scan_window);
1774ab4831a3SMatthias Ringwald         return;
1775ab4831a3SMatthias Ringwald     }
1776ab4831a3SMatthias Ringwald     // write page scan type
1777baa4881eSMatthias Ringwald     if ((hci_stack->gap_tasks_classic & GAP_TASK_WRITE_PAGE_SCAN_TYPE) != 0) {
1778baa4881eSMatthias Ringwald         hci_stack->gap_tasks_classic &= ~GAP_TASK_WRITE_PAGE_SCAN_TYPE;
1779ab4831a3SMatthias Ringwald         hci_send_cmd(&hci_write_page_scan_type, hci_stack->new_page_scan_type);
1780ab4831a3SMatthias Ringwald         return;
1781ab4831a3SMatthias Ringwald     }
178232a12730SMatthias Ringwald     // write page timeout
1783baa4881eSMatthias Ringwald     if ((hci_stack->gap_tasks_classic & GAP_TASK_WRITE_PAGE_TIMEOUT) != 0) {
1784baa4881eSMatthias Ringwald         hci_stack->gap_tasks_classic &= ~GAP_TASK_WRITE_PAGE_TIMEOUT;
178532a12730SMatthias Ringwald         hci_send_cmd(&hci_write_page_timeout, hci_stack->page_timeout);
178632a12730SMatthias Ringwald         return;
178732a12730SMatthias Ringwald     }
1788ab4831a3SMatthias Ringwald     // send scan enable
1789baa4881eSMatthias Ringwald     if ((hci_stack->gap_tasks_classic & GAP_TASK_WRITE_SCAN_ENABLE) != 0) {
1790baa4881eSMatthias Ringwald         hci_stack->gap_tasks_classic &= ~GAP_TASK_WRITE_SCAN_ENABLE;
1791ab4831a3SMatthias Ringwald         hci_send_cmd(&hci_write_scan_enable, hci_stack->new_scan_enable_value);
1792ab4831a3SMatthias Ringwald         return;
1793ab4831a3SMatthias Ringwald     }
1794c0c8a829SMatthias Ringwald     // send write scan activity
1795baa4881eSMatthias Ringwald     if ((hci_stack->gap_tasks_classic & GAP_TASK_WRITE_INQUIRY_SCAN_ACTIVITY) != 0) {
1796baa4881eSMatthias Ringwald         hci_stack->gap_tasks_classic &= ~GAP_TASK_WRITE_INQUIRY_SCAN_ACTIVITY;
1797c0c8a829SMatthias Ringwald         hci_send_cmd(&hci_write_inquiry_scan_activity, hci_stack->inquiry_scan_interval, hci_stack->inquiry_scan_window);
1798c0c8a829SMatthias Ringwald         return;
1799c0c8a829SMatthias Ringwald     }
1800f50ed5acSAndrey Fominykh     // send write inquiry transmit power level
1801f50ed5acSAndrey Fominykh     if ((hci_stack->gap_tasks_classic & GAP_TASK_WRITE_INQUIRY_TX_POWER_LEVEL) != 0) {
1802f50ed5acSAndrey Fominykh         hci_stack->gap_tasks_classic &= ~GAP_TASK_WRITE_INQUIRY_TX_POWER_LEVEL;
1803f50ed5acSAndrey Fominykh         hci_send_cmd(&hci_write_inquiry_transmit_power_level, hci_stack->inquiry_tx_power_level);
1804f50ed5acSAndrey Fominykh         return;
1805f50ed5acSAndrey Fominykh     }
1806ab4831a3SMatthias Ringwald }
180759d59ecfSMatthias Ringwald #endif
180859d59ecfSMatthias Ringwald 
18096fad2c37SMatthias Ringwald #ifndef HAVE_HOST_CONTROLLER_API
181006b9e820SMatthias Ringwald 
181196b53536SMatthias Ringwald static uint32_t hci_transport_uart_get_main_baud_rate(void){
181296b53536SMatthias Ringwald     if (!hci_stack->config) return 0;
18139796ebeaSMatthias Ringwald     uint32_t baud_rate = ((hci_transport_config_uart_t *)hci_stack->config)->baudrate_main;
181496b53536SMatthias Ringwald     return baud_rate;
181596b53536SMatthias Ringwald }
181696b53536SMatthias Ringwald 
1817ec820d77SMatthias Ringwald static void hci_initialization_timeout_handler(btstack_timer_source_t * ds){
18189ec2630cSMatthias Ringwald     UNUSED(ds);
18199ec2630cSMatthias Ringwald 
18200305bdeaSMatthias Ringwald     switch (hci_stack->substate){
18210305bdeaSMatthias Ringwald         case HCI_INIT_W4_SEND_RESET:
18227b0d7667SMatthias Ringwald             log_info("Resend HCI Reset");
18230305bdeaSMatthias Ringwald             hci_stack->substate = HCI_INIT_SEND_RESET;
18247b0d7667SMatthias Ringwald             hci_stack->num_cmd_packets = 1;
18250305bdeaSMatthias Ringwald             hci_run();
18260305bdeaSMatthias Ringwald             break;
18279f007422SMatthias Ringwald         case HCI_INIT_W4_CUSTOM_INIT_CSR_WARM_BOOT_LINK_RESET:
18289f007422SMatthias Ringwald             log_info("Resend HCI Reset - CSR Warm Boot with Link Reset");
18299f007422SMatthias Ringwald             if (hci_stack->hci_transport->reset_link){
18309f007422SMatthias Ringwald                 hci_stack->hci_transport->reset_link();
18319f007422SMatthias Ringwald             }
1832cf373d3aSMatthias Ringwald 
1833cf373d3aSMatthias Ringwald             /* fall through */
1834cf373d3aSMatthias Ringwald 
1835e47e68c7SMatthias Ringwald         case HCI_INIT_W4_CUSTOM_INIT_CSR_WARM_BOOT:
1836e47e68c7SMatthias Ringwald             log_info("Resend HCI Reset - CSR Warm Boot");
1837e47e68c7SMatthias Ringwald             hci_stack->substate = HCI_INIT_SEND_RESET_CSR_WARM_BOOT;
1838e47e68c7SMatthias Ringwald             hci_stack->num_cmd_packets = 1;
1839e47e68c7SMatthias Ringwald             hci_run();
1840688c2635SMatthias Ringwald             break;
18417224be7eSMatthias Ringwald         case HCI_INIT_W4_SEND_BAUD_CHANGE:
18427224be7eSMatthias Ringwald             if (hci_stack->hci_transport->set_baudrate){
184396b53536SMatthias Ringwald                 uint32_t baud_rate = hci_transport_uart_get_main_baud_rate();
1844cd724cb7SMatthias Ringwald                 log_info("Local baud rate change to %" PRIu32 "(timeout handler)", baud_rate);
18457dd9d0ecSMatthias Ringwald                 hci_stack->hci_transport->set_baudrate(baud_rate);
18467224be7eSMatthias Ringwald             }
1847834bce8cSMatthias Ringwald             // For CSR, HCI Reset is sent on new baud rate. Don't forget to reset link for H5/BCSP
184861f37892SMatthias Ringwald             if (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_CAMBRIDGE_SILICON_RADIO){
1849834bce8cSMatthias Ringwald                 if (hci_stack->hci_transport->reset_link){
1850834bce8cSMatthias Ringwald                     log_info("Link Reset");
1851834bce8cSMatthias Ringwald                     hci_stack->hci_transport->reset_link();
1852834bce8cSMatthias Ringwald                 }
1853772a36d3SMatthias Ringwald                 hci_stack->substate = HCI_INIT_SEND_RESET_CSR_WARM_BOOT;
1854772a36d3SMatthias Ringwald                 hci_run();
1855772a36d3SMatthias Ringwald             }
18564696bddbSMatthias Ringwald             break;
1857559961d0SMatthias Ringwald         case HCI_INIT_W4_CUSTOM_INIT_BCM_DELAY:
1858559961d0SMatthias Ringwald             // otherwise continue
1859559961d0SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_READ_LOCAL_SUPPORTED_COMMANDS;
1860559961d0SMatthias Ringwald             hci_send_cmd(&hci_read_local_supported_commands);
1861559961d0SMatthias Ringwald             break;
18620305bdeaSMatthias Ringwald         default:
18630305bdeaSMatthias Ringwald             break;
18640305bdeaSMatthias Ringwald     }
18650305bdeaSMatthias Ringwald }
186606b9e820SMatthias Ringwald #endif
18670305bdeaSMatthias Ringwald 
186871de195eSMatthias Ringwald static void hci_initializing_next_state(void){
186974b323a9SMatthias Ringwald     hci_stack->substate = (hci_substate_t )( ((int) hci_stack->substate) + 1);
187074b323a9SMatthias Ringwald }
187174b323a9SMatthias Ringwald 
1872f795c86eSMatthias Ringwald static void hci_init_done(void){
1873f795c86eSMatthias Ringwald     // done. tell the app
1874f795c86eSMatthias Ringwald     log_info("hci_init_done -> HCI_STATE_WORKING");
1875f795c86eSMatthias Ringwald     hci_stack->state = HCI_STATE_WORKING;
1876f795c86eSMatthias Ringwald     hci_emit_state();
1877f795c86eSMatthias Ringwald }
1878f795c86eSMatthias Ringwald 
187974b323a9SMatthias Ringwald // assumption: hci_can_send_command_packet_now() == true
188071de195eSMatthias Ringwald static void hci_initializing_run(void){
1881148ca237SMatthias Ringwald     log_debug("hci_initializing_run: substate %u, can send %u", hci_stack->substate, hci_can_send_command_packet_now());
1882f4c579d4SMatthias Ringwald 
18830d37aff3SMatthias Ringwald     if (!hci_can_send_command_packet_now()) return;
18840d37aff3SMatthias Ringwald 
1885f4c579d4SMatthias Ringwald #ifndef HAVE_HOST_CONTROLLER_API
1886f9fd20c2SMatthias Ringwald     bool need_baud_change = hci_stack->config
1887f4c579d4SMatthias Ringwald             && hci_stack->chipset
1888f4c579d4SMatthias Ringwald             && hci_stack->chipset->set_baudrate_command
1889f4c579d4SMatthias Ringwald             && hci_stack->hci_transport->set_baudrate
1890f4c579d4SMatthias Ringwald             && ((hci_transport_config_uart_t *)hci_stack->config)->baudrate_main;
1891f4c579d4SMatthias Ringwald #endif
1892f4c579d4SMatthias Ringwald 
189374b323a9SMatthias Ringwald     switch (hci_stack->substate){
189474b323a9SMatthias Ringwald         case HCI_INIT_SEND_RESET:
189574b323a9SMatthias Ringwald             hci_state_reset();
1896a0cf2f3fSMatthias Ringwald 
18976fad2c37SMatthias Ringwald #ifndef HAVE_HOST_CONTROLLER_API
18980305bdeaSMatthias Ringwald             // prepare reset if command complete not received in 100ms
1899659d758cSMatthias Ringwald             btstack_run_loop_set_timer(&hci_stack->timeout, HCI_RESET_RESEND_TIMEOUT_MS);
1900528a4a3bSMatthias Ringwald             btstack_run_loop_set_timer_handler(&hci_stack->timeout, hci_initialization_timeout_handler);
1901528a4a3bSMatthias Ringwald             btstack_run_loop_add_timer(&hci_stack->timeout);
1902a0cf2f3fSMatthias Ringwald #endif
19030305bdeaSMatthias Ringwald             // send command
190474b323a9SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_SEND_RESET;
19050305bdeaSMatthias Ringwald             hci_send_cmd(&hci_reset);
190674b323a9SMatthias Ringwald             break;
190776fcb19bSMatthias Ringwald         case HCI_INIT_SEND_READ_LOCAL_VERSION_INFORMATION:
190876fcb19bSMatthias Ringwald             hci_send_cmd(&hci_read_local_version_information);
190976fcb19bSMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_SEND_READ_LOCAL_VERSION_INFORMATION;
191076fcb19bSMatthias Ringwald             break;
1911e28e41c0SMatthias Ringwald 
1912e28e41c0SMatthias Ringwald #ifndef HAVE_HOST_CONTROLLER_API
1913e47e68c7SMatthias Ringwald         case HCI_INIT_SEND_RESET_CSR_WARM_BOOT:
1914e47e68c7SMatthias Ringwald             hci_state_reset();
1915e47e68c7SMatthias Ringwald             // prepare reset if command complete not received in 100ms
1916659d758cSMatthias Ringwald             btstack_run_loop_set_timer(&hci_stack->timeout, HCI_RESET_RESEND_TIMEOUT_MS);
1917528a4a3bSMatthias Ringwald             btstack_run_loop_set_timer_handler(&hci_stack->timeout, hci_initialization_timeout_handler);
1918528a4a3bSMatthias Ringwald             btstack_run_loop_add_timer(&hci_stack->timeout);
1919e47e68c7SMatthias Ringwald             // send command
1920e47e68c7SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_CUSTOM_INIT_CSR_WARM_BOOT;
1921e47e68c7SMatthias Ringwald             hci_send_cmd(&hci_reset);
1922e47e68c7SMatthias Ringwald             break;
19238d29070eSMatthias Ringwald         case HCI_INIT_SEND_RESET_ST_WARM_BOOT:
19248d29070eSMatthias Ringwald             hci_state_reset();
19258d29070eSMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_SEND_RESET_ST_WARM_BOOT;
19268d29070eSMatthias Ringwald             hci_send_cmd(&hci_reset);
19278d29070eSMatthias Ringwald             break;
1928f4c579d4SMatthias Ringwald         case HCI_INIT_SEND_BAUD_CHANGE_BCM: {
1929a784d71bSMatthias Ringwald             hci_reserve_packet_buffer();
1930f4c579d4SMatthias Ringwald             uint32_t baud_rate = hci_transport_uart_get_main_baud_rate();
1931f4c579d4SMatthias Ringwald             hci_stack->chipset->set_baudrate_command(baud_rate, hci_stack->hci_packet_buffer);
1932f4c579d4SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_SEND_BAUD_CHANGE_BCM;
1933ca6804fdSMatthias Ringwald             hci_send_prepared_cmd_packet();
1934f4c579d4SMatthias Ringwald             break;
1935f4c579d4SMatthias Ringwald         }
1936c97af506SMatthias Ringwald         case HCI_INIT_SET_BD_ADDR:
1937a784d71bSMatthias Ringwald             hci_reserve_packet_buffer();
1938c97af506SMatthias Ringwald             log_info("Set Public BD ADDR to %s", bd_addr_to_str(hci_stack->custom_bd_addr));
1939c97af506SMatthias Ringwald             hci_stack->chipset->set_bd_addr_command(hci_stack->custom_bd_addr, hci_stack->hci_packet_buffer);
1940c97af506SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_SET_BD_ADDR;
1941ca6804fdSMatthias Ringwald             hci_send_prepared_cmd_packet();
1942c97af506SMatthias Ringwald             break;
19438250c242SMatthias Ringwald         case HCI_INIT_SEND_READ_LOCAL_NAME:
19448250c242SMatthias Ringwald #ifdef ENABLE_CLASSIC
19458250c242SMatthias Ringwald             hci_send_cmd(&hci_read_local_name);
19468250c242SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_SEND_READ_LOCAL_NAME;
19478250c242SMatthias Ringwald             break;
19488250c242SMatthias Ringwald #endif
19498250c242SMatthias Ringwald             /* fall through */
19508250c242SMatthias Ringwald 
1951f4c579d4SMatthias Ringwald         case HCI_INIT_SEND_BAUD_CHANGE:
1952f4c579d4SMatthias Ringwald             if (need_baud_change) {
1953a784d71bSMatthias Ringwald                 hci_reserve_packet_buffer();
195496b53536SMatthias Ringwald                 uint32_t baud_rate = hci_transport_uart_get_main_baud_rate();
19553fb36a29SMatthias Ringwald                 hci_stack->chipset->set_baudrate_command(baud_rate, hci_stack->hci_packet_buffer);
195674b323a9SMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_SEND_BAUD_CHANGE;
1957ca6804fdSMatthias Ringwald                 hci_send_prepared_cmd_packet();
19584696bddbSMatthias Ringwald                 // STLC25000D: baudrate change happens within 0.5 s after command was send,
19594696bddbSMatthias Ringwald                 // use timer to update baud rate after 100 ms (knowing exactly, when command was sent is non-trivial)
196061f37892SMatthias Ringwald                 if (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_ST_MICROELECTRONICS){
1961659d758cSMatthias Ringwald                     btstack_run_loop_set_timer(&hci_stack->timeout, HCI_RESET_RESEND_TIMEOUT_MS);
1962528a4a3bSMatthias Ringwald                     btstack_run_loop_add_timer(&hci_stack->timeout);
19634696bddbSMatthias Ringwald                }
196474b323a9SMatthias Ringwald                break;
1965fab26ab3SMatthias Ringwald             }
19666fe16221SMatthias Ringwald             hci_stack->substate = HCI_INIT_CUSTOM_INIT;
1967f4c579d4SMatthias Ringwald 
1968f4c579d4SMatthias Ringwald             /* fall through */
1969f4c579d4SMatthias Ringwald 
197074b323a9SMatthias Ringwald         case HCI_INIT_CUSTOM_INIT:
19716fe16221SMatthias Ringwald         case HCI_INIT_CUSTOM_PRE_INIT:
197274b323a9SMatthias Ringwald             // Custom initialization
19733fb36a29SMatthias Ringwald             if (hci_stack->chipset && hci_stack->chipset->next_command){
1974ee418d0fSMatthias Ringwald                 hci_reserve_packet_buffer();
1975ae334e9eSMatthias Ringwald                 hci_stack->chipset_result = (*hci_stack->chipset->next_command)(hci_stack->hci_packet_buffer);
19761979f09cSMatthias Ringwald                 bool send_cmd = false;
1977ae334e9eSMatthias Ringwald                 switch (hci_stack->chipset_result){
1978f41911edSMatthias Ringwald                     case BTSTACK_CHIPSET_VALID_COMMAND:
19791979f09cSMatthias Ringwald                         send_cmd = true;
19806fe16221SMatthias Ringwald                         switch (hci_stack->substate){
19816fe16221SMatthias Ringwald                             case HCI_INIT_CUSTOM_INIT:
1982e47e68c7SMatthias Ringwald                                 hci_stack->substate = HCI_INIT_W4_CUSTOM_INIT;
1983e47e68c7SMatthias Ringwald                                 break;
19846fe16221SMatthias Ringwald                             case HCI_INIT_CUSTOM_PRE_INIT:
19856fe16221SMatthias Ringwald                                 hci_stack->substate = HCI_INIT_W4_CUSTOM_PRE_INIT;
19866fe16221SMatthias Ringwald                                 break;
19876fe16221SMatthias Ringwald                             default:
19886fe16221SMatthias Ringwald                                 btstack_assert(false);
19896fe16221SMatthias Ringwald                                 break;
19906fe16221SMatthias Ringwald                         }
19916fe16221SMatthias Ringwald                         break;
1992f41911edSMatthias Ringwald                     case BTSTACK_CHIPSET_WARMSTART_REQUIRED:
19931979f09cSMatthias Ringwald                         send_cmd = true;
1994f41911edSMatthias Ringwald                         // CSR Warm Boot: Wait a bit, then send HCI Reset until HCI Command Complete
1995e47e68c7SMatthias Ringwald                         log_info("CSR Warm Boot");
1996659d758cSMatthias Ringwald                         btstack_run_loop_set_timer(&hci_stack->timeout, HCI_RESET_RESEND_TIMEOUT_MS);
1997528a4a3bSMatthias Ringwald                         btstack_run_loop_set_timer_handler(&hci_stack->timeout, hci_initialization_timeout_handler);
1998528a4a3bSMatthias Ringwald                         btstack_run_loop_add_timer(&hci_stack->timeout);
1999a1df452eSMatthias Ringwald                         if ((hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_CAMBRIDGE_SILICON_RADIO)
2000772a36d3SMatthias Ringwald                             && hci_stack->config
20013fb36a29SMatthias Ringwald                             && hci_stack->chipset
20023fb36a29SMatthias Ringwald                             // && hci_stack->chipset->set_baudrate_command -- there's no such command
2003772a36d3SMatthias Ringwald                             && hci_stack->hci_transport->set_baudrate
20042caefae9SMatthias Ringwald                             && hci_transport_uart_get_main_baud_rate()){
2005772a36d3SMatthias Ringwald                             hci_stack->substate = HCI_INIT_W4_SEND_BAUD_CHANGE;
2006772a36d3SMatthias Ringwald                         } else {
20079f007422SMatthias Ringwald                            hci_stack->substate = HCI_INIT_W4_CUSTOM_INIT_CSR_WARM_BOOT_LINK_RESET;
2008772a36d3SMatthias Ringwald                         }
2009e47e68c7SMatthias Ringwald                         break;
2010f41911edSMatthias Ringwald                     default:
2011f41911edSMatthias Ringwald                         break;
2012e47e68c7SMatthias Ringwald                 }
2013ee720f3aSMatthias Ringwald 
2014ee720f3aSMatthias Ringwald                 if (send_cmd){
2015ca6804fdSMatthias Ringwald                     hci_send_prepared_cmd_packet();
201674b323a9SMatthias Ringwald                     break;
2017ee418d0fSMatthias Ringwald                 } else {
2018ee418d0fSMatthias Ringwald                     hci_release_packet_buffer();
201974b323a9SMatthias Ringwald                 }
2020148ca237SMatthias Ringwald                 log_info("Init script done");
202192a0d36dSMatthias Ringwald 
20226fe16221SMatthias Ringwald                 // Custom Pre-Init complete, start regular init with HCI Reset
20236fe16221SMatthias Ringwald                 if (hci_stack->substate == HCI_INIT_CUSTOM_PRE_INIT){
20246fe16221SMatthias Ringwald                     hci_stack->substate = HCI_INIT_W4_SEND_RESET;
20256fe16221SMatthias Ringwald                     hci_send_cmd(&hci_reset);
20266fe16221SMatthias Ringwald                     break;
20276fe16221SMatthias Ringwald                 }
20286fe16221SMatthias Ringwald 
2029559961d0SMatthias Ringwald                 // Init script download on Broadcom chipsets causes:
2030ae334e9eSMatthias Ringwald                 if ( (hci_stack->chipset_result != BTSTACK_CHIPSET_NO_INIT_SCRIPT) &&
2031a1df452eSMatthias Ringwald                    (  (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_BROADCOM_CORPORATION)
2032a1df452eSMatthias Ringwald                 ||    (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_EM_MICROELECTRONIC_MARIN_SA)) ){
2033e021ff1eSMatthias Ringwald 
2034559961d0SMatthias Ringwald                     // - baud rate to reset, restore UART baud rate if needed
203592a0d36dSMatthias Ringwald                     if (need_baud_change) {
20369796ebeaSMatthias Ringwald                         uint32_t baud_rate = ((hci_transport_config_uart_t *)hci_stack->config)->baudrate_init;
2037cd724cb7SMatthias Ringwald                         log_info("Local baud rate change to %" PRIu32 " after init script (bcm)", baud_rate);
203892a0d36dSMatthias Ringwald                         hci_stack->hci_transport->set_baudrate(baud_rate);
203992a0d36dSMatthias Ringwald                     }
2040559961d0SMatthias Ringwald 
2041f19b3c9eSMatthias Ringwald                     uint16_t bcm_delay_ms = 300;
2042f19b3c9eSMatthias Ringwald                     // - UART may or may not be disabled during update and Controller RTS may or may not be high during this time
2043f19b3c9eSMatthias Ringwald                     //   -> Work around: wait here.
2044f19b3c9eSMatthias Ringwald                     log_info("BCM delay (%u ms) after init script", bcm_delay_ms);
2045559961d0SMatthias Ringwald                     hci_stack->substate = HCI_INIT_W4_CUSTOM_INIT_BCM_DELAY;
2046f19b3c9eSMatthias Ringwald                     btstack_run_loop_set_timer(&hci_stack->timeout, bcm_delay_ms);
2047559961d0SMatthias Ringwald                     btstack_run_loop_set_timer_handler(&hci_stack->timeout, hci_initialization_timeout_handler);
2048559961d0SMatthias Ringwald                     btstack_run_loop_add_timer(&hci_stack->timeout);
2049559961d0SMatthias Ringwald                     break;
205092a0d36dSMatthias Ringwald                 }
205174b323a9SMatthias Ringwald             }
205206b9e820SMatthias Ringwald #endif
2053521bd5ffSMatthias Ringwald             /* fall through */
205406b9e820SMatthias Ringwald 
205506b9e820SMatthias Ringwald         case HCI_INIT_READ_LOCAL_SUPPORTED_COMMANDS:
205606b9e820SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_READ_LOCAL_SUPPORTED_COMMANDS;
205706b9e820SMatthias Ringwald             hci_send_cmd(&hci_read_local_supported_commands);
205806b9e820SMatthias Ringwald             break;
205953860077SMatthias Ringwald         case HCI_INIT_READ_BD_ADDR:
206053860077SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_READ_BD_ADDR;
206153860077SMatthias Ringwald             hci_send_cmd(&hci_read_bd_addr);
206253860077SMatthias Ringwald             break;
206374b323a9SMatthias Ringwald         case HCI_INIT_READ_BUFFER_SIZE:
20645ffe9d0bSMatthias Ringwald             // only read buffer size if supported
20651ffa425cSMatthias Ringwald             if (hci_command_supported(SUPPORTED_HCI_COMMAND_READ_BUFFER_SIZE)){
206674b323a9SMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_READ_BUFFER_SIZE;
20670305bdeaSMatthias Ringwald                 hci_send_cmd(&hci_read_buffer_size);
206874b323a9SMatthias Ringwald                 break;
20695ffe9d0bSMatthias Ringwald             }
2070521bd5ffSMatthias Ringwald 
20715ffe9d0bSMatthias Ringwald             /* fall through */
20725ffe9d0bSMatthias Ringwald 
207353860077SMatthias Ringwald         case HCI_INIT_READ_LOCAL_SUPPORTED_FEATURES:
207453860077SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_READ_LOCAL_SUPPORTED_FEATURES;
20750305bdeaSMatthias Ringwald             hci_send_cmd(&hci_read_local_supported_features);
207674b323a9SMatthias Ringwald             break;
20772b838201SMatthias Ringwald 
20782b838201SMatthias Ringwald #ifdef ENABLE_HCI_CONTROLLER_TO_HOST_FLOW_CONTROL
20792b838201SMatthias Ringwald         case HCI_INIT_SET_CONTROLLER_TO_HOST_FLOW_CONTROL:
20802b838201SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_SET_CONTROLLER_TO_HOST_FLOW_CONTROL;
20812b838201SMatthias Ringwald             hci_send_cmd(&hci_set_controller_to_host_flow_control, 3);  // ACL + SCO Flow Control
20822b838201SMatthias Ringwald             break;
20832b838201SMatthias Ringwald         case HCI_INIT_HOST_BUFFER_SIZE:
20842b838201SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_HOST_BUFFER_SIZE;
20852b838201SMatthias Ringwald             hci_send_cmd(&hci_host_buffer_size, HCI_HOST_ACL_PACKET_LEN, HCI_HOST_SCO_PACKET_LEN,
20862b838201SMatthias Ringwald                                                 HCI_HOST_ACL_PACKET_NUM, HCI_HOST_SCO_PACKET_NUM);
20872b838201SMatthias Ringwald             break;
20882b838201SMatthias Ringwald #endif
20892b838201SMatthias Ringwald 
209074b323a9SMatthias Ringwald         case HCI_INIT_SET_EVENT_MASK:
20910305bdeaSMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_SET_EVENT_MASK;
209274b323a9SMatthias Ringwald             if (hci_le_supported()){
20935ce1359eSMatthias Ringwald                 hci_send_cmd(&hci_set_event_mask,0xFFFFFFFFU, 0x3FFFFFFFU);
209474b323a9SMatthias Ringwald             } else {
209574b323a9SMatthias Ringwald                 // Kensington Bluetooth 2.1 USB Dongle (CSR Chipset) returns an error for 0xffff...
20965ce1359eSMatthias Ringwald                 hci_send_cmd(&hci_set_event_mask,0xFFFFFFFFU, 0x1FFFFFFFU);
209774b323a9SMatthias Ringwald             }
209874b323a9SMatthias Ringwald             break;
20992b838201SMatthias Ringwald 
2100ff7d1758SMatthias Ringwald         case HCI_INIT_SET_EVENT_MASK_2:
2101a086dc35SMatthias Ringwald             // On Bluetooth PTS dongle (BL 654) with PacketCraft HCI Firmware (LMP subversion) 0x5244,
21028254e329SMatthias Ringwald             // setting Event Mask 2 causes Controller to drop Encryption Change events.
21038254e329SMatthias Ringwald             if (hci_command_supported(SUPPORTED_HCI_COMMAND_SET_EVENT_MASK_PAGE_2)
21048254e329SMatthias Ringwald             && (hci_stack->manufacturer != BLUETOOTH_COMPANY_ID_PACKETCRAFT_INC)){
2105ff7d1758SMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_SET_EVENT_MASK_2;
2106ff7d1758SMatthias Ringwald                 // Encryption Change Event v2 - bit 25
2107ff7d1758SMatthias Ringwald                 hci_send_cmd(&hci_set_event_mask_2,0x02000000U, 0x0);
2108ff7d1758SMatthias Ringwald                 break;
2109ff7d1758SMatthias Ringwald             }
2110ff7d1758SMatthias Ringwald 
211135454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
2112ff7d1758SMatthias Ringwald             /* fall through */
2113ff7d1758SMatthias Ringwald 
211474b323a9SMatthias Ringwald         case HCI_INIT_WRITE_SIMPLE_PAIRING_MODE:
2115f795c86eSMatthias Ringwald             if (hci_classic_supported() && gap_ssp_supported()){
211674b323a9SMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_WRITE_SIMPLE_PAIRING_MODE;
21170305bdeaSMatthias Ringwald                 hci_send_cmd(&hci_write_simple_pairing_mode, hci_stack->ssp_enable);
211874b323a9SMatthias Ringwald                 break;
2119e7c662faSMatthias Ringwald             }
2120521bd5ffSMatthias Ringwald 
2121e7c662faSMatthias Ringwald             /* fall through */
2122e7c662faSMatthias Ringwald 
2123f6858d14SMatthias Ringwald         case HCI_INIT_WRITE_INQUIRY_MODE:
2124f795c86eSMatthias Ringwald             if (hci_classic_supported()){
2125f6858d14SMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_WRITE_INQUIRY_MODE;
21268a114470SMatthias Ringwald                 hci_send_cmd(&hci_write_inquiry_mode, (int) hci_stack->inquiry_mode);
2127f6858d14SMatthias Ringwald                 break;
2128f795c86eSMatthias Ringwald             }
2129521bd5ffSMatthias Ringwald 
2130f795c86eSMatthias Ringwald             /* fall through */
2131f795c86eSMatthias Ringwald 
21325d23aae8SMatthias Ringwald         case HCI_INIT_WRITE_SECURE_CONNECTIONS_HOST_ENABLE:
2133f3052906SMatthias Ringwald             // skip write secure connections host support if not supported or disabled
21341ffa425cSMatthias Ringwald             if (hci_classic_supported() && hci_stack->secure_connections_enable
21351ffa425cSMatthias Ringwald             && hci_command_supported(SUPPORTED_HCI_COMMAND_WRITE_SECURE_CONNECTIONS_HOST)) {
2136c214d65bSMatthias Ringwald                 hci_stack->secure_connections_active = true;
21375d23aae8SMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_WRITE_SECURE_CONNECTIONS_HOST_ENABLE;
21381ffa425cSMatthias Ringwald                 hci_send_cmd(&hci_write_secure_connections_host_support, 1);
21395d23aae8SMatthias Ringwald                 break;
2140f3052906SMatthias Ringwald             }
2141521bd5ffSMatthias Ringwald 
2142a391128dSMatthias Ringwald             /* fall through */
2143a391128dSMatthias Ringwald 
2144a391128dSMatthias Ringwald         case HCI_INIT_SET_MIN_ENCRYPTION_KEY_SIZE:
2145a391128dSMatthias Ringwald             // skip set min encryption key size
2146a391128dSMatthias Ringwald             if (hci_classic_supported() && hci_command_supported(SUPPORTED_HCI_COMMAND_SET_MIN_ENCRYPTION_KEY_SIZE)) {
2147a391128dSMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_SET_MIN_ENCRYPTION_KEY_SIZE;
2148a391128dSMatthias Ringwald                 hci_send_cmd(&hci_set_min_encryption_key_size, hci_stack->gap_required_encyrption_key_size);
2149a391128dSMatthias Ringwald                 break;
2150a391128dSMatthias Ringwald             }
2151a391128dSMatthias Ringwald 
2152e4c6114dSMatthias Ringwald #ifdef ENABLE_SCO_OVER_HCI
2153521bd5ffSMatthias Ringwald             /* fall through */
2154521bd5ffSMatthias Ringwald 
2155483c5078SMatthias Ringwald         // only sent if ENABLE_SCO_OVER_HCI is defined
2156729ed62eSMatthias Ringwald         case HCI_INIT_WRITE_SYNCHRONOUS_FLOW_CONTROL_ENABLE:
2157e4c6114dSMatthias Ringwald             // skip write synchronous flow control if not supported
21581ffa425cSMatthias Ringwald             if (hci_classic_supported()
21591ffa425cSMatthias Ringwald             && hci_command_supported(SUPPORTED_HCI_COMMAND_WRITE_SYNCHRONOUS_FLOW_CONTROL_ENABLE)) {
2160729ed62eSMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_WRITE_SYNCHRONOUS_FLOW_CONTROL_ENABLE;
2161729ed62eSMatthias Ringwald                 hci_send_cmd(&hci_write_synchronous_flow_control_enable, 1); // SCO tracking enabled
2162729ed62eSMatthias Ringwald                 break;
2163f795c86eSMatthias Ringwald             }
2164f795c86eSMatthias Ringwald             /* fall through */
2165f795c86eSMatthias Ringwald 
2166483c5078SMatthias Ringwald         case HCI_INIT_WRITE_DEFAULT_ERRONEOUS_DATA_REPORTING:
2167e4c6114dSMatthias Ringwald             // skip write default erroneous data reporting if not supported
21681ffa425cSMatthias Ringwald             if (hci_classic_supported()
21691ffa425cSMatthias Ringwald             && hci_command_supported(SUPPORTED_HCI_COMMAND_WRITE_DEFAULT_ERRONEOUS_DATA_REPORTING)) {
2170483c5078SMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_WRITE_DEFAULT_ERRONEOUS_DATA_REPORTING;
2171483c5078SMatthias Ringwald                 hci_send_cmd(&hci_write_default_erroneous_data_reporting, 1);
2172483c5078SMatthias Ringwald                 break;
2173f795c86eSMatthias Ringwald             }
2174e4c6114dSMatthias Ringwald #endif
2175f795c86eSMatthias Ringwald 
2176f795c86eSMatthias Ringwald #if defined(ENABLE_SCO_OVER_HCI) || defined(ENABLE_SCO_OVER_PCM)
2177521bd5ffSMatthias Ringwald             /* fall through */
2178521bd5ffSMatthias Ringwald 
21798051253fSMatthias Ringwald         // only sent if manufacturer is Broadcom and ENABLE_SCO_OVER_HCI or ENABLE_SCO_OVER_PCM is defined
2180a42798c3SMatthias Ringwald         case HCI_INIT_BCM_WRITE_SCO_PCM_INT:
2181e4c6114dSMatthias Ringwald             if (hci_classic_supported() && (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_BROADCOM_CORPORATION)){
2182a42798c3SMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_BCM_WRITE_SCO_PCM_INT;
21838051253fSMatthias Ringwald #ifdef ENABLE_SCO_OVER_HCI
2184a42798c3SMatthias Ringwald                 log_info("BCM: Route SCO data via HCI transport");
2185a42798c3SMatthias Ringwald                 hci_send_cmd(&hci_bcm_write_sco_pcm_int, 1, 0, 0, 0, 0);
21868051253fSMatthias Ringwald #endif
21878051253fSMatthias Ringwald #ifdef ENABLE_SCO_OVER_PCM
21888051253fSMatthias Ringwald                 log_info("BCM: Route SCO data via PCM interface");
21891d2bbd54SMatthias Ringwald #ifdef ENABLE_BCM_PCM_WBS
2190f795c86eSMatthias Ringwald                 // 512 kHz bit clock for 2 channels x 16 bit x 16 kHz
21911d2bbd54SMatthias Ringwald                 hci_send_cmd(&hci_bcm_write_sco_pcm_int, 0, 2, 0, 1, 1);
21921d2bbd54SMatthias Ringwald #else
21931d2bbd54SMatthias Ringwald                 // 256 kHz bit clock for 2 channels x 16 bit x 8 kHz
21941d2bbd54SMatthias Ringwald                 hci_send_cmd(&hci_bcm_write_sco_pcm_int, 0, 1, 0, 1, 1);
21951d2bbd54SMatthias Ringwald #endif
21968051253fSMatthias Ringwald #endif
2197a42798c3SMatthias Ringwald                 break;
2198f795c86eSMatthias Ringwald             }
2199f795c86eSMatthias Ringwald #endif
2200f795c86eSMatthias Ringwald 
22014e821764SMatthias Ringwald #ifdef ENABLE_SCO_OVER_PCM
2202521bd5ffSMatthias Ringwald             /* fall through */
2203521bd5ffSMatthias Ringwald 
22044e821764SMatthias Ringwald         case HCI_INIT_BCM_WRITE_I2SPCM_INTERFACE_PARAM:
2205e4c6114dSMatthias Ringwald             if (hci_classic_supported() && (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_BROADCOM_CORPORATION)){
22064e821764SMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_BCM_WRITE_I2SPCM_INTERFACE_PARAM;
22074e821764SMatthias Ringwald                 log_info("BCM: Config PCM interface for I2S");
22081d2bbd54SMatthias Ringwald #ifdef ENABLE_BCM_PCM_WBS
22091d2bbd54SMatthias Ringwald                 // 512 kHz bit clock for 2 channels x 16 bit x 8 kHz
22101d2bbd54SMatthias Ringwald                 hci_send_cmd(&hci_bcm_write_i2spcm_interface_param, 1, 1, 0, 2);
22111d2bbd54SMatthias Ringwald #else
22121d2bbd54SMatthias Ringwald                 // 256 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, 1);
22141d2bbd54SMatthias Ringwald #endif
22154e821764SMatthias Ringwald                 break;
2216f795c86eSMatthias Ringwald             }
22171be678e9SMatthias Ringwald         case HCI_INIT_BCM_WRITE_PCM_DATA_FORMAT_PARAM:
22181be678e9SMatthias Ringwald             if (hci_classic_supported() && (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_BROADCOM_CORPORATION)){
22191be678e9SMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_BCM_WRITE_PCM_DATA_FORMAT_PARAM;
22201be678e9SMatthias Ringwald                 log_info("BCM: Config PCM Data format");
22211be678e9SMatthias Ringwald                 // msb first, fill bits 0, left justified
22221be678e9SMatthias Ringwald                 hci_send_cmd(&hci_bcm_write_pcm_data_format_param, 0, 0, 3, 3, 0);
22231be678e9SMatthias Ringwald                 break;
22241be678e9SMatthias Ringwald             }
2225dd1f98b4SMatthias Ringwald #ifdef HAVE_BCM_PCM2
2226dd1f98b4SMatthias Ringwald         case HCI_INIT_BCM_PCM2_SETUP:
2227dd1f98b4SMatthias Ringwald             if (hci_classic_supported() && (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_BROADCOM_CORPORATION)) {
2228dd1f98b4SMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_BCM_PCM2_SETUP;
2229dd1f98b4SMatthias Ringwald                 uint8_t  op_mode = 0;  // Op_Mode = 0 = PCM, 1 = I2S
2230dd1f98b4SMatthias Ringwald                 uint32_t pcm_clock_freq;
2231dd1f98b4SMatthias Ringwald                 uint8_t  ch_0_period;
2232dd1f98b4SMatthias Ringwald #ifdef ENABLE_BCM_PCM_WBS
2233dd1f98b4SMatthias Ringwald                 // 512 kHz, resample 8 kHz to 16 khz
2234dd1f98b4SMatthias Ringwald                 pcm_clock_freq = 512000;
2235dd1f98b4SMatthias Ringwald                 ch_0_period = 1;
2236dd1f98b4SMatthias Ringwald #else
2237dd1f98b4SMatthias Ringwald                 // 256 khz, 8 khz output
2238dd1f98b4SMatthias Ringwald                 pcm_clock_freq = 256000;
2239dd1f98b4SMatthias Ringwald                 ch_0_period = 0;
224035454696SMatthias Ringwald #endif
2241dd1f98b4SMatthias Ringwald                 log_info("BCM: Config PCM2 - op mode %u, pcm clock %" PRIu32 ", ch0_period %u", op_mode, pcm_clock_freq, ch_0_period);
2242dd1f98b4SMatthias Ringwald                 hci_send_cmd(&hci_bcm_pcm2_setup,
2243dd1f98b4SMatthias Ringwald                              0x00, // Action = Write
2244dd1f98b4SMatthias Ringwald                              0x00, // Test_Options = None
2245dd1f98b4SMatthias Ringwald                              op_mode, // Op_Mode
2246dd1f98b4SMatthias Ringwald                              0x1D, // Sync_and_Clock_Options Sync = Signal | Sync Output Enable | Generate PCM_CLK | Tristate When Idle
2247dd1f98b4SMatthias Ringwald                              pcm_clock_freq, // PCM_Clock_Freq
2248dd1f98b4SMatthias Ringwald                              0x01, // Sync_Signal_Width
2249dd1f98b4SMatthias Ringwald                              0x0F, // Slot_Width
2250dd1f98b4SMatthias Ringwald                              0x01, // NumberOfSlots
2251dd1f98b4SMatthias Ringwald                              0x00, // Bank_0_Fill_Mode = 0s
2252dd1f98b4SMatthias Ringwald                              0x00, // Bank_0_Number_of_Fill_Bits
2253dd1f98b4SMatthias Ringwald                              0x00, // Bank_0_Programmable_Fill_Data
2254dd1f98b4SMatthias Ringwald                              0x00, // Bank_1_Fill_Mode = 0s
2255dd1f98b4SMatthias Ringwald                              0x00, // Bank_1_Number_of_Fill_Bits
2256dd1f98b4SMatthias Ringwald                              0x00, // Bank_1_Programmable_Fill_Data
2257dd1f98b4SMatthias Ringwald                              0x00, // Data_Justify_And_Bit_Order_Options = Left Justify
2258dd1f98b4SMatthias Ringwald                              0x00, // Ch_0_Slot_Number
2259dd1f98b4SMatthias Ringwald                              0x01, // Ch_1_Slot_Number
2260dd1f98b4SMatthias Ringwald                              0x02, // Ch_2_Slot_Number
2261dd1f98b4SMatthias Ringwald                              0x03, // Ch_3_Slot_Number
2262dd1f98b4SMatthias Ringwald                              0x04, // Ch_4_Slot_Number
2263dd1f98b4SMatthias Ringwald                              ch_0_period, // Ch_0_Period
2264dd1f98b4SMatthias Ringwald                              0x00, // Ch_1_Period
2265dd1f98b4SMatthias Ringwald                              0x00  // Ch_2_Period
2266dd1f98b4SMatthias Ringwald                 );
2267dd1f98b4SMatthias Ringwald                 break;
2268dd1f98b4SMatthias Ringwald             }
22694e821764SMatthias Ringwald #endif
2270dd1f98b4SMatthias Ringwald #endif /* ENABLE_SCO_OVER_PCM */
2271dd1f98b4SMatthias Ringwald #endif /* ENABLE_CLASSIC */
22724e821764SMatthias Ringwald 
2273a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE
2274521bd5ffSMatthias Ringwald             /* fall through */
2275521bd5ffSMatthias Ringwald 
227674b323a9SMatthias Ringwald         // LE INIT
227774b323a9SMatthias Ringwald         case HCI_INIT_LE_READ_BUFFER_SIZE:
2278f795c86eSMatthias Ringwald             if (hci_le_supported()){
227974b323a9SMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_LE_READ_BUFFER_SIZE;
228079b7ea2dSMatthias Ringwald                 if (hci_command_supported(SUPPORTED_HCI_COMMAND_LE_READ_BUFFER_SIZE_V2)){
228179b7ea2dSMatthias Ringwald                     hci_send_cmd(&hci_le_read_buffer_size_v2);
228279b7ea2dSMatthias Ringwald                 } else {
22830305bdeaSMatthias Ringwald                     hci_send_cmd(&hci_le_read_buffer_size);
228479b7ea2dSMatthias Ringwald                 }
228574b323a9SMatthias Ringwald                 break;
2286f795c86eSMatthias Ringwald             }
2287521bd5ffSMatthias Ringwald 
2288f795c86eSMatthias Ringwald             /* fall through */
2289f795c86eSMatthias Ringwald 
2290699a5fcaSMatthias Ringwald         case HCI_INIT_WRITE_LE_HOST_SUPPORTED:
2291699a5fcaSMatthias Ringwald             // skip write le host if not supported (e.g. on LE only EM9301)
22921ffa425cSMatthias Ringwald             if (hci_le_supported()
22931ffa425cSMatthias Ringwald             && hci_command_supported(SUPPORTED_HCI_COMMAND_WRITE_LE_HOST_SUPPORTED)) {
2294699a5fcaSMatthias Ringwald                 // LE Supported Host = 1, Simultaneous Host = 0
2295699a5fcaSMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_WRITE_LE_HOST_SUPPORTED;
2296699a5fcaSMatthias Ringwald                 hci_send_cmd(&hci_write_le_host_supported, 1, 0);
2297daabb8b8SMatthias Ringwald                 break;
2298f795c86eSMatthias Ringwald             }
2299521bd5ffSMatthias Ringwald 
2300f795c86eSMatthias Ringwald             /* fall through */
2301f795c86eSMatthias Ringwald 
2302699a5fcaSMatthias Ringwald         case HCI_INIT_LE_SET_EVENT_MASK:
2303f795c86eSMatthias Ringwald             if (hci_le_supported()){
2304699a5fcaSMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_LE_SET_EVENT_MASK;
23055d6688b0SMatthias Ringwald #ifdef ENABLE_LE_ENHANCED_CONNECTION_COMPLETE_EVENT
2306920a6ac5SMatthias Ringwald                 hci_send_cmd(&hci_le_set_event_mask, 0xffffffff, 0x0107); // all events from core v5.3
23075d6688b0SMatthias Ringwald #else
2308920a6ac5SMatthias Ringwald                 hci_send_cmd(&hci_le_set_event_mask, 0xfffffdff, 0x0007); // all events from core v5.3 without LE Enhanced Connection Complete
23095d6688b0SMatthias Ringwald #endif
231074b323a9SMatthias Ringwald                 break;
2311f795c86eSMatthias Ringwald             }
2312b435e062SMatthias Ringwald #endif
2313b435e062SMatthias Ringwald 
2314b435e062SMatthias Ringwald #ifdef ENABLE_LE_DATA_LENGTH_EXTENSION
2315521bd5ffSMatthias Ringwald             /* fall through */
2316521bd5ffSMatthias Ringwald 
2317dcd678baSMatthias Ringwald         case HCI_INIT_LE_READ_MAX_DATA_LENGTH:
23181ffa425cSMatthias Ringwald             if (hci_le_supported()
23191ffa425cSMatthias Ringwald             && hci_command_supported(SUPPORTED_HCI_COMMAND_LE_READ_MAXIMUM_DATA_LENGTH)) {
2320dcd678baSMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_LE_READ_MAX_DATA_LENGTH;
2321dcd678baSMatthias Ringwald                 hci_send_cmd(&hci_le_read_maximum_data_length);
2322dcd678baSMatthias Ringwald                 break;
2323f795c86eSMatthias Ringwald             }
2324521bd5ffSMatthias Ringwald 
2325f795c86eSMatthias Ringwald             /* fall through */
2326f795c86eSMatthias Ringwald 
2327dcd678baSMatthias Ringwald         case HCI_INIT_LE_WRITE_SUGGESTED_DATA_LENGTH:
23281ffa425cSMatthias Ringwald             if (hci_le_supported()
23291ffa425cSMatthias Ringwald             && hci_command_supported(SUPPORTED_HCI_COMMAND_LE_WRITE_SUGGESTED_DEFAULT_DATA_LENGTH)) {
2330dcd678baSMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_LE_WRITE_SUGGESTED_DATA_LENGTH;
2331b435e062SMatthias 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);
2332dcd678baSMatthias Ringwald                 break;
2333f795c86eSMatthias Ringwald             }
2334b435e062SMatthias Ringwald #endif
2335b435e062SMatthias Ringwald 
2336b95a5a35SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
2337521bd5ffSMatthias Ringwald             /* fall through */
2338521bd5ffSMatthias Ringwald 
23393b6d4121SMatthias Ringwald         case HCI_INIT_READ_WHITE_LIST_SIZE:
2340f795c86eSMatthias Ringwald             if (hci_le_supported()){
23413b6d4121SMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_READ_WHITE_LIST_SIZE;
23423b6d4121SMatthias Ringwald                 hci_send_cmd(&hci_le_read_white_list_size);
23433b6d4121SMatthias Ringwald                 break;
2344f795c86eSMatthias Ringwald             }
2345521bd5ffSMatthias Ringwald 
234674b323a9SMatthias Ringwald #endif
23474f982f31SMatthias Ringwald 
23483a74541eSMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
23493a74541eSMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
23503a74541eSMatthias Ringwald             /* fall through */
23513a74541eSMatthias Ringwald 
23523a74541eSMatthias Ringwald         case HCI_INIT_LE_READ_MAX_ADV_DATA_LEN:
235322f987e4SMatthias Ringwald             if (hci_le_extended_advertising_supported()){
23543a74541eSMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_LE_READ_MAX_ADV_DATA_LEN;
23553a74541eSMatthias Ringwald                 hci_send_cmd(&hci_le_read_maximum_advertising_data_length);
23563a74541eSMatthias Ringwald                 break;
23573a74541eSMatthias Ringwald             }
23583a74541eSMatthias Ringwald #endif
23593a74541eSMatthias Ringwald #endif
2360521bd5ffSMatthias Ringwald 
2361c63ee49aSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
236236916f81SDirk Helbig             /* fall through */
236336916f81SDirk Helbig 
2364c63ee49aSMatthias Ringwald         case HCI_INIT_LE_SET_HOST_FEATURE_CONNECTED_ISO_STREAMS:
2365c63ee49aSMatthias Ringwald             if (hci_le_supported()) {
2366c63ee49aSMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_LE_SET_HOST_FEATURE_CONNECTED_ISO_STREAMS;
2367c63ee49aSMatthias Ringwald                 hci_send_cmd(&hci_le_set_host_feature, 32, 1);
2368c63ee49aSMatthias Ringwald                 break;
2369c63ee49aSMatthias Ringwald             }
2370c63ee49aSMatthias Ringwald #endif
2371c63ee49aSMatthias Ringwald 
2372f266fcb1SMatthias Ringwald #ifdef ENABLE_BLE
2373f266fcb1SMatthias Ringwald             /* fall through */
2374f266fcb1SMatthias Ringwald         case HCI_INIT_LE_SET_HOST_FEATURE_CONNECTION_SUBRATING:
2375f266fcb1SMatthias Ringwald             if (hci_le_supported()) {
2376f266fcb1SMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_LE_SET_HOST_FEATURE_CONNECTION_SUBRATING;
2377f266fcb1SMatthias Ringwald                 hci_send_cmd(&hci_le_set_host_feature, 38, 1);
2378f266fcb1SMatthias Ringwald                 break;
2379f266fcb1SMatthias Ringwald             }
2380f266fcb1SMatthias Ringwald #endif
2381c63ee49aSMatthias Ringwald             /* fall through */
2382c63ee49aSMatthias Ringwald 
2383f795c86eSMatthias Ringwald         case HCI_INIT_DONE:
23844f982f31SMatthias Ringwald             hci_stack->substate = HCI_INIT_DONE;
238573799937SMatthias Ringwald             // main init sequence complete
23864f982f31SMatthias Ringwald #ifdef ENABLE_CLASSIC
238773799937SMatthias Ringwald             // check if initial Classic GAP Tasks are completed
2388baa4881eSMatthias Ringwald             if (hci_classic_supported() && (hci_stack->gap_tasks_classic != 0)) {
23894f982f31SMatthias Ringwald                 hci_run_gap_tasks_classic();
23904f982f31SMatthias Ringwald                 break;
23914f982f31SMatthias Ringwald             }
23924f982f31SMatthias Ringwald #endif
239373799937SMatthias Ringwald #ifdef ENABLE_BLE
239473799937SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
239573799937SMatthias Ringwald             // check if initial LE GAP Tasks are completed
239673799937SMatthias Ringwald             if (hci_le_supported() && hci_stack->le_scanning_param_update) {
239773799937SMatthias Ringwald                 hci_run_general_gap_le();
239873799937SMatthias Ringwald                 break;
239973799937SMatthias Ringwald             }
240073799937SMatthias Ringwald #endif
240173799937SMatthias Ringwald #endif
2402f795c86eSMatthias Ringwald             hci_init_done();
2403f795c86eSMatthias Ringwald             break;
2404f795c86eSMatthias Ringwald 
240574b323a9SMatthias Ringwald         default:
240674b323a9SMatthias Ringwald             return;
240774b323a9SMatthias Ringwald     }
240855975f88SMatthias Ringwald }
240955975f88SMatthias Ringwald 
241007fd2f31SMatthias Ringwald static bool hci_initializing_event_handler_command_completed(const uint8_t * packet){
241107fd2f31SMatthias Ringwald     bool command_completed = false;
24120e2df43fSMatthias Ringwald     if (hci_event_packet_get_type(packet) == HCI_EVENT_COMMAND_COMPLETE){
2413f8fbdce0SMatthias Ringwald         uint16_t opcode = little_endian_read_16(packet,3);
24146155b3d3S[email protected]         if (opcode == hci_stack->last_cmd_opcode){
241507fd2f31SMatthias Ringwald             command_completed = true;
2416148ca237SMatthias Ringwald             log_debug("Command complete for expected opcode %04x at substate %u", opcode, hci_stack->substate);
24176155b3d3S[email protected]         } else {
2418d58dd308SMatthias Ringwald             log_info("Command complete for different opcode %04x, expected %04x, at substate %u", opcode, hci_stack->last_cmd_opcode, hci_stack->substate);
24196155b3d3S[email protected]         }
24206155b3d3S[email protected]     }
24210f97eae7SMatthias Ringwald 
24220e2df43fSMatthias Ringwald     if (hci_event_packet_get_type(packet) == HCI_EVENT_COMMAND_STATUS){
24236155b3d3S[email protected]         uint8_t  status = packet[2];
2424f8fbdce0SMatthias Ringwald         uint16_t opcode = little_endian_read_16(packet,4);
24256155b3d3S[email protected]         if (opcode == hci_stack->last_cmd_opcode){
24266155b3d3S[email protected]             if (status){
242707fd2f31SMatthias Ringwald                 command_completed = true;
2428148ca237SMatthias Ringwald                 log_debug("Command status error 0x%02x for expected opcode %04x at substate %u", status, opcode, hci_stack->substate);
24296155b3d3S[email protected]             } else {
24306155b3d3S[email protected]                 log_info("Command status OK for expected opcode %04x, waiting for command complete", opcode);
24316155b3d3S[email protected]             }
24326155b3d3S[email protected]         } else {
2433148ca237SMatthias Ringwald             log_debug("Command status for opcode %04x, expected %04x", opcode, hci_stack->last_cmd_opcode);
24346155b3d3S[email protected]         }
24356155b3d3S[email protected]     }
24366fad2c37SMatthias Ringwald #ifndef HAVE_HOST_CONTROLLER_API
2437e47e68c7SMatthias Ringwald     // Vendor == CSR
24380e588213SMatthias Ringwald     if ((hci_stack->substate == HCI_INIT_W4_CUSTOM_INIT) && (hci_event_packet_get_type(packet) == HCI_EVENT_VENDOR_SPECIFIC)){
2439e47e68c7SMatthias Ringwald         // TODO: track actual command
244007fd2f31SMatthias Ringwald         command_completed = true;
2441e47e68c7SMatthias Ringwald     }
2442a2481739S[email protected] 
24434e9daa6fSMatthias Ringwald     // Vendor == Toshiba
24440e588213SMatthias Ringwald     if ((hci_stack->substate == HCI_INIT_W4_SEND_BAUD_CHANGE) && (hci_event_packet_get_type(packet) == HCI_EVENT_VENDOR_SPECIFIC)){
24454e9daa6fSMatthias Ringwald         // TODO: track actual command
244607fd2f31SMatthias Ringwald         command_completed = true;
2447004902f1SMatthias Ringwald         // Fix: no HCI Command Complete received, so num_cmd_packets not reset
2448004902f1SMatthias Ringwald         hci_stack->num_cmd_packets = 1;
24494e9daa6fSMatthias Ringwald     }
245007fd2f31SMatthias Ringwald #endif
245107fd2f31SMatthias Ringwald 
245207fd2f31SMatthias Ringwald     return command_completed;
245307fd2f31SMatthias Ringwald }
245407fd2f31SMatthias Ringwald 
245507fd2f31SMatthias Ringwald static void hci_initializing_event_handler(const uint8_t * packet, uint16_t size){
245607fd2f31SMatthias Ringwald 
245707fd2f31SMatthias Ringwald     UNUSED(size);   // ok: less than 6 bytes are read from our buffer
245807fd2f31SMatthias Ringwald 
245907fd2f31SMatthias Ringwald     bool command_completed =  hci_initializing_event_handler_command_completed(packet);
246007fd2f31SMatthias Ringwald 
24616fad2c37SMatthias Ringwald #ifndef HAVE_HOST_CONTROLLER_API
24624e9daa6fSMatthias Ringwald 
24630f97eae7SMatthias Ringwald     // Late response (> 100 ms) for HCI Reset e.g. on Toshiba TC35661:
24640f97eae7SMatthias Ringwald     // Command complete for HCI Reset arrives after we've resent the HCI Reset command
24650f97eae7SMatthias Ringwald     //
24660f97eae7SMatthias Ringwald     // HCI Reset
24670f97eae7SMatthias Ringwald     // Timeout 100 ms
24680f97eae7SMatthias Ringwald     // HCI Reset
24690f97eae7SMatthias Ringwald     // Command Complete Reset
24700f97eae7SMatthias Ringwald     // HCI Read Local Version Information
24710f97eae7SMatthias Ringwald     // Command Complete Reset - but we expected Command Complete Read Local Version Information
24720f97eae7SMatthias Ringwald     // hang...
24730f97eae7SMatthias Ringwald     //
24740f97eae7SMatthias Ringwald     // Fix: Command Complete for HCI Reset in HCI_INIT_W4_SEND_READ_LOCAL_VERSION_INFORMATION trigger resend
24750f97eae7SMatthias Ringwald     if (!command_completed
2476a1df452eSMatthias Ringwald             && (hci_event_packet_get_type(packet) == HCI_EVENT_COMMAND_COMPLETE)
24770e588213SMatthias Ringwald             && (hci_stack->substate == HCI_INIT_W4_SEND_READ_LOCAL_VERSION_INFORMATION)){
24780f97eae7SMatthias Ringwald 
2479f8fbdce0SMatthias Ringwald         uint16_t opcode = little_endian_read_16(packet,3);
24800f97eae7SMatthias Ringwald         if (opcode == hci_reset.opcode){
24810f97eae7SMatthias Ringwald             hci_stack->substate = HCI_INIT_SEND_READ_LOCAL_VERSION_INFORMATION;
24820f97eae7SMatthias Ringwald             return;
24830f97eae7SMatthias Ringwald         }
24840f97eae7SMatthias Ringwald     }
24850f97eae7SMatthias Ringwald 
24869f007422SMatthias Ringwald     // CSR & H5
24879f007422SMatthias Ringwald     // Fix: Command Complete for HCI Reset in HCI_INIT_W4_SEND_READ_LOCAL_VERSION_INFORMATION trigger resend
24889f007422SMatthias Ringwald     if (!command_completed
2489a1df452eSMatthias Ringwald             && (hci_event_packet_get_type(packet) == HCI_EVENT_COMMAND_COMPLETE)
24900e588213SMatthias Ringwald             && (hci_stack->substate == HCI_INIT_W4_READ_LOCAL_SUPPORTED_COMMANDS)){
24919f007422SMatthias Ringwald 
24929f007422SMatthias Ringwald         uint16_t opcode = little_endian_read_16(packet,3);
24939f007422SMatthias Ringwald         if (opcode == hci_reset.opcode){
24949f007422SMatthias Ringwald             hci_stack->substate = HCI_INIT_READ_LOCAL_SUPPORTED_COMMANDS;
24959f007422SMatthias Ringwald             return;
24969f007422SMatthias Ringwald         }
24979f007422SMatthias Ringwald     }
24989f007422SMatthias Ringwald 
24999f007422SMatthias 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
25009f007422SMatthias Ringwald     // fix: Correct substate and behave as command below
25019f007422SMatthias Ringwald     if (command_completed){
25029f007422SMatthias Ringwald         switch (hci_stack->substate){
25039f007422SMatthias Ringwald             case HCI_INIT_SEND_RESET:
25049f007422SMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_SEND_RESET;
25059f007422SMatthias Ringwald                 break;
25069f007422SMatthias Ringwald             case HCI_INIT_SEND_RESET_CSR_WARM_BOOT:
25079f007422SMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_CUSTOM_INIT_CSR_WARM_BOOT;
25089f007422SMatthias Ringwald                 break;
25099f007422SMatthias Ringwald             default:
25109f007422SMatthias Ringwald                 break;
25119f007422SMatthias Ringwald         }
25129f007422SMatthias Ringwald     }
25130f97eae7SMatthias Ringwald 
251406b9e820SMatthias Ringwald #endif
25150f97eae7SMatthias Ringwald 
2516a2481739S[email protected]     if (!command_completed) return;
2517a2481739S[email protected] 
251807fd2f31SMatthias Ringwald     bool need_baud_change = false;
251907fd2f31SMatthias Ringwald     bool need_addr_change = false;
252006b9e820SMatthias Ringwald 
25216fad2c37SMatthias Ringwald #ifndef HAVE_HOST_CONTROLLER_API
252206b9e820SMatthias Ringwald     need_baud_change = hci_stack->config
25233fb36a29SMatthias Ringwald                         && hci_stack->chipset
25243fb36a29SMatthias Ringwald                         && hci_stack->chipset->set_baudrate_command
2525db8bc6ffSMatthias Ringwald                         && hci_stack->hci_transport->set_baudrate
25269796ebeaSMatthias Ringwald                         && ((hci_transport_config_uart_t *)hci_stack->config)->baudrate_main;
2527db8bc6ffSMatthias Ringwald 
252806b9e820SMatthias Ringwald     need_addr_change = hci_stack->custom_bd_addr_set
25293fb36a29SMatthias Ringwald                         && hci_stack->chipset
25303fb36a29SMatthias Ringwald                         && hci_stack->chipset->set_bd_addr_command;
253106b9e820SMatthias Ringwald #endif
2532a80162e9SMatthias Ringwald 
25335c363727SMatthias Ringwald     switch(hci_stack->substate){
253406b9e820SMatthias Ringwald 
25356fad2c37SMatthias Ringwald #ifndef HAVE_HOST_CONTROLLER_API
25369f007422SMatthias Ringwald         case HCI_INIT_SEND_RESET:
2537d58dd308SMatthias Ringwald             // on CSR with BCSP/H5, resend triggers resend of HCI Reset and leads to substate == HCI_INIT_SEND_RESET
25389f007422SMatthias Ringwald             // fix: just correct substate and behave as command below
2539f4c579d4SMatthias Ringwald 
2540f4c579d4SMatthias Ringwald             /* fall through */
2541f4c579d4SMatthias Ringwald #endif
2542f4c579d4SMatthias Ringwald 
254374b323a9SMatthias Ringwald         case HCI_INIT_W4_SEND_RESET:
2544528a4a3bSMatthias Ringwald             btstack_run_loop_remove_timer(&hci_stack->timeout);
2545f4c579d4SMatthias Ringwald             hci_stack->substate = HCI_INIT_SEND_READ_LOCAL_VERSION_INFORMATION;
25462f48d920SMatthias Ringwald             return;
2547f4c579d4SMatthias Ringwald 
2548f4c579d4SMatthias Ringwald #ifndef HAVE_HOST_CONTROLLER_API
2549a80162e9SMatthias Ringwald         case HCI_INIT_W4_SEND_BAUD_CHANGE:
25504696bddbSMatthias Ringwald             // for STLC2500D, baud rate change already happened.
2551fab26ab3SMatthias Ringwald             // for others, baud rate gets changed now
255261f37892SMatthias Ringwald             if ((hci_stack->manufacturer != BLUETOOTH_COMPANY_ID_ST_MICROELECTRONICS) && need_baud_change){
255396b53536SMatthias Ringwald                 uint32_t baud_rate = hci_transport_uart_get_main_baud_rate();
2554cd724cb7SMatthias Ringwald                 log_info("Local baud rate change to %" PRIu32 "(w4_send_baud_change)", baud_rate);
2555fab26ab3SMatthias Ringwald                 hci_stack->hci_transport->set_baudrate(baud_rate);
25564696bddbSMatthias Ringwald             }
255774b323a9SMatthias Ringwald             hci_stack->substate = HCI_INIT_CUSTOM_INIT;
255874b323a9SMatthias Ringwald             return;
2559a80162e9SMatthias Ringwald         case HCI_INIT_W4_CUSTOM_INIT_CSR_WARM_BOOT:
2560528a4a3bSMatthias Ringwald             btstack_run_loop_remove_timer(&hci_stack->timeout);
2561a80162e9SMatthias Ringwald             hci_stack->substate = HCI_INIT_CUSTOM_INIT;
2562a80162e9SMatthias Ringwald             return;
256374b323a9SMatthias Ringwald         case HCI_INIT_W4_CUSTOM_INIT:
256474b323a9SMatthias Ringwald             // repeat custom init
256574b323a9SMatthias Ringwald             hci_stack->substate = HCI_INIT_CUSTOM_INIT;
256674b323a9SMatthias Ringwald             return;
25676fe16221SMatthias Ringwald         case HCI_INIT_W4_CUSTOM_PRE_INIT:
25686fe16221SMatthias Ringwald             // repeat custom init
25696fe16221SMatthias Ringwald             hci_stack->substate = HCI_INIT_CUSTOM_PRE_INIT;
25706fe16221SMatthias Ringwald             return;
257106b9e820SMatthias Ringwald #endif
257206b9e820SMatthias Ringwald 
2573a828a756SMatthias Ringwald         case HCI_INIT_W4_READ_LOCAL_SUPPORTED_COMMANDS:
25740e588213SMatthias Ringwald             if (need_baud_change && (hci_stack->chipset_result != BTSTACK_CHIPSET_NO_INIT_SCRIPT) &&
2575efd3b327SMatthias Ringwald               ((hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_BROADCOM_CORPORATION) ||
2576efd3b327SMatthias Ringwald                (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_EM_MICROELECTRONIC_MARIN_SA))) {
2577eb3a5314SMatthias Ringwald                 hci_stack->substate = HCI_INIT_SEND_BAUD_CHANGE_BCM;
2578eb3a5314SMatthias Ringwald                 return;
2579eb3a5314SMatthias Ringwald             }
258053860077SMatthias Ringwald             if (need_addr_change){
258153860077SMatthias Ringwald                 hci_stack->substate = HCI_INIT_SET_BD_ADDR;
258253860077SMatthias Ringwald                 return;
258353860077SMatthias Ringwald             }
258453860077SMatthias Ringwald             hci_stack->substate = HCI_INIT_READ_BD_ADDR;
258553860077SMatthias Ringwald             return;
25866fad2c37SMatthias Ringwald #ifndef HAVE_HOST_CONTROLLER_API
25877224be7eSMatthias Ringwald         case HCI_INIT_W4_SEND_BAUD_CHANGE_BCM:
25887224be7eSMatthias Ringwald             if (need_baud_change){
258996b53536SMatthias Ringwald                 uint32_t baud_rate = hci_transport_uart_get_main_baud_rate();
2590cd724cb7SMatthias Ringwald                 log_info("Local baud rate change to %" PRIu32 "(w4_send_baud_change_bcm))", baud_rate);
2591fab26ab3SMatthias Ringwald                 hci_stack->hci_transport->set_baudrate(baud_rate);
25927224be7eSMatthias Ringwald             }
2593eb3a5314SMatthias Ringwald             if (need_addr_change){
2594eb3a5314SMatthias Ringwald                 hci_stack->substate = HCI_INIT_SET_BD_ADDR;
2595eb3a5314SMatthias Ringwald                 return;
2596eb3a5314SMatthias Ringwald             }
2597eb3a5314SMatthias Ringwald             hci_stack->substate = HCI_INIT_READ_BD_ADDR;
2598eb3a5314SMatthias Ringwald             return;
259953860077SMatthias Ringwald         case HCI_INIT_W4_SET_BD_ADDR:
26006ca9a99aSMatthias Ringwald             // for STLC2500D + ATWILC3000, bd addr change only gets active after sending reset command
26016ca9a99aSMatthias Ringwald             if ((hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_ST_MICROELECTRONICS)
26026ca9a99aSMatthias Ringwald             ||  (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_ATMEL_CORPORATION)){
260353860077SMatthias Ringwald                 hci_stack->substate = HCI_INIT_SEND_RESET_ST_WARM_BOOT;
260453860077SMatthias Ringwald                 return;
260553860077SMatthias Ringwald             }
260653860077SMatthias Ringwald             // skipping st warm boot
260753860077SMatthias Ringwald             hci_stack->substate = HCI_INIT_READ_BD_ADDR;
260853860077SMatthias Ringwald             return;
260953860077SMatthias Ringwald         case HCI_INIT_W4_SEND_RESET_ST_WARM_BOOT:
261053860077SMatthias Ringwald             hci_stack->substate = HCI_INIT_READ_BD_ADDR;
261153860077SMatthias Ringwald             return;
261206b9e820SMatthias Ringwald #endif
2613e7c662faSMatthias Ringwald 
2614f795c86eSMatthias Ringwald         case HCI_INIT_DONE:
2615eb8d95caSMatthias Ringwald             // set state if we came here by fall through
2616eb8d95caSMatthias Ringwald             hci_stack->substate = HCI_INIT_DONE;
2617f795c86eSMatthias Ringwald             return;
2618a650ba4dSMatthias Ringwald 
26196155b3d3S[email protected]         default:
262074b323a9SMatthias Ringwald             break;
26216155b3d3S[email protected]     }
262255975f88SMatthias Ringwald     hci_initializing_next_state();
26236155b3d3S[email protected] }
26246155b3d3S[email protected] 
26250bbba85bSMatthias Ringwald static void hci_handle_connection_failed(hci_connection_t * conn, uint8_t status){
26263bb5ff27SMatthias Ringwald     // CC2564C might emit Connection Complete for rejected incoming SCO connection
2627a086dc35SMatthias Ringwald     // To prevent accidentally freeing the HCI connection for the ACL connection,
26281a4fdac4SMatthias Ringwald     // check if we have been aware of the HCI connection
26291f34df2cSMatthias Ringwald     switch (conn->state){
26301a4fdac4SMatthias Ringwald         case SENT_CREATE_CONNECTION:
26311f34df2cSMatthias Ringwald         case RECEIVED_CONNECTION_REQUEST:
26329071873aSMatthias Ringwald         case ACCEPTED_CONNECTION_REQUEST:
26331f34df2cSMatthias Ringwald             break;
26341f34df2cSMatthias Ringwald         default:
26351f34df2cSMatthias Ringwald             return;
26361f34df2cSMatthias Ringwald     }
26373bb5ff27SMatthias Ringwald 
2638229331c6SMatthias Ringwald     log_info("Outgoing connection to %s failed", bd_addr_to_str(conn->address));
26390bbba85bSMatthias Ringwald     bd_addr_t bd_address;
26406535961aSMatthias Ringwald     (void)memcpy(&bd_address, conn->address, 6);
26410bbba85bSMatthias Ringwald 
26426bc9fa5eSMatthias Ringwald #ifdef ENABLE_CLASSIC
26436bc9fa5eSMatthias Ringwald     // cache needed data
26446bc9fa5eSMatthias Ringwald     int notify_dedicated_bonding_failed = conn->bonding_flags & BONDING_DEDICATED;
26456bc9fa5eSMatthias Ringwald #endif
26466bc9fa5eSMatthias Ringwald 
26470bbba85bSMatthias Ringwald     // connection failed, remove entry
26480bbba85bSMatthias Ringwald     btstack_linked_list_remove(&hci_stack->connections, (btstack_linked_item_t *) conn);
26490bbba85bSMatthias Ringwald     btstack_memory_hci_connection_free( conn );
26500bbba85bSMatthias Ringwald 
26516bc9fa5eSMatthias Ringwald #ifdef ENABLE_CLASSIC
26520bbba85bSMatthias Ringwald     // notify client if dedicated bonding
26530bbba85bSMatthias Ringwald     if (notify_dedicated_bonding_failed){
26540bbba85bSMatthias Ringwald         log_info("hci notify_dedicated_bonding_failed");
26550bbba85bSMatthias Ringwald         hci_emit_dedicated_bonding_result(bd_address, status);
26560bbba85bSMatthias Ringwald     }
26570bbba85bSMatthias Ringwald 
26580bbba85bSMatthias Ringwald     // if authentication error, also delete link key
26590bbba85bSMatthias Ringwald     if (status == ERROR_CODE_AUTHENTICATION_FAILURE) {
26600bbba85bSMatthias Ringwald         gap_drop_link_key_for_bd_addr(bd_address);
26610bbba85bSMatthias Ringwald     }
26621c79b5e3SMatthias Ringwald #else
26631c79b5e3SMatthias Ringwald     UNUSED(status);
26646bc9fa5eSMatthias Ringwald #endif
26650bbba85bSMatthias Ringwald }
26660bbba85bSMatthias Ringwald 
2667be500194SMatthias Ringwald #ifdef ENABLE_CLASSIC
26682f5c44baSMatthias Ringwald static void hci_handle_remote_features_page_0(hci_connection_t * conn, const uint8_t * features){
26692f5c44baSMatthias Ringwald     // SSP Controller
26702f5c44baSMatthias Ringwald     if (features[6] & (1 << 3)){
26712f5c44baSMatthias Ringwald         conn->bonding_flags |= BONDING_REMOTE_SUPPORTS_SSP_CONTROLLER;
26722f5c44baSMatthias Ringwald     }
26732f5c44baSMatthias Ringwald     // eSCO
26742f5c44baSMatthias Ringwald     if (features[3] & (1<<7)){
26752f5c44baSMatthias Ringwald         conn->remote_supported_features[0] |= 1;
26762f5c44baSMatthias Ringwald     }
26772f5c44baSMatthias Ringwald     // Extended features
26782f5c44baSMatthias Ringwald     if (features[7] & (1<<7)){
26792f5c44baSMatthias Ringwald         conn->remote_supported_features[0] |= 2;
26802f5c44baSMatthias Ringwald     }
26810b78a447SMatthias Ringwald     // SCO packet types
26820b78a447SMatthias Ringwald     conn->remote_supported_sco_packets = hci_sco_packet_types_for_features(features);
26832f5c44baSMatthias Ringwald }
26842f5c44baSMatthias Ringwald 
26852f5c44baSMatthias Ringwald static void hci_handle_remote_features_page_1(hci_connection_t * conn, const uint8_t * features){
26862f5c44baSMatthias Ringwald     // SSP Host
26872f5c44baSMatthias Ringwald     if (features[0] & (1 << 0)){
26882f5c44baSMatthias Ringwald         conn->bonding_flags |= BONDING_REMOTE_SUPPORTS_SSP_HOST;
26892f5c44baSMatthias Ringwald     }
269050c51a77SMatthias Ringwald     // SC Host
269150c51a77SMatthias Ringwald     if (features[0] & (1 << 3)){
269250c51a77SMatthias Ringwald         conn->bonding_flags |= BONDING_REMOTE_SUPPORTS_SC_HOST;
269350c51a77SMatthias Ringwald     }
269450c51a77SMatthias Ringwald }
269550c51a77SMatthias Ringwald 
269650c51a77SMatthias Ringwald static void hci_handle_remote_features_page_2(hci_connection_t * conn, const uint8_t * features){
269750c51a77SMatthias Ringwald     // SC Controller
269850c51a77SMatthias Ringwald     if (features[1] & (1 << 0)){
269950c51a77SMatthias Ringwald         conn->bonding_flags |= BONDING_REMOTE_SUPPORTS_SC_CONTROLLER;
270050c51a77SMatthias Ringwald     }
27012f5c44baSMatthias Ringwald }
27022f5c44baSMatthias Ringwald 
2703de0df013SMatthias Ringwald static void hci_handle_remote_features_received(hci_connection_t * conn){
2704461a2bc4SMatthias Ringwald     conn->bonding_flags &= ~BONDING_REMOTE_FEATURES_QUERY_ACTIVE;
2705de0df013SMatthias Ringwald     conn->bonding_flags |= BONDING_RECEIVED_REMOTE_FEATURES;
2706cb7b3e6fSMatthias Ringwald     log_info("Remote features %02x, bonding flags %" PRIx32, conn->remote_supported_features[0], conn->bonding_flags);
2707de0df013SMatthias Ringwald     if (conn->bonding_flags & BONDING_DEDICATED){
2708de0df013SMatthias Ringwald         conn->bonding_flags |= BONDING_SEND_AUTHENTICATE_REQUEST;
2709de0df013SMatthias Ringwald     }
2710de0df013SMatthias Ringwald }
2711128825c3SMatthias Ringwald static bool hci_remote_sc_enabled(hci_connection_t * connection){
2712128825c3SMatthias Ringwald     const uint16_t sc_enabled_mask = BONDING_REMOTE_SUPPORTS_SC_HOST | BONDING_REMOTE_SUPPORTS_SC_CONTROLLER;
2713128825c3SMatthias Ringwald     return (connection->bonding_flags & sc_enabled_mask) == sc_enabled_mask;
2714128825c3SMatthias Ringwald }
2715128825c3SMatthias Ringwald 
2716be500194SMatthias Ringwald #endif
2717de0df013SMatthias Ringwald 
271867c6c9dcSMatthias Ringwald static void handle_event_for_current_stack_state(const uint8_t * packet, uint16_t size) {
271967c6c9dcSMatthias Ringwald     // handle BT initialization
272067c6c9dcSMatthias Ringwald     if (hci_stack->state == HCI_STATE_INITIALIZING) {
272167c6c9dcSMatthias Ringwald         hci_initializing_event_handler(packet, size);
272267c6c9dcSMatthias Ringwald     }
272367c6c9dcSMatthias Ringwald 
272467c6c9dcSMatthias Ringwald     // help with BT sleep
272567c6c9dcSMatthias Ringwald     if ((hci_stack->state == HCI_STATE_FALLING_ASLEEP)
272667c6c9dcSMatthias Ringwald         && (hci_stack->substate == HCI_FALLING_ASLEEP_W4_WRITE_SCAN_ENABLE)
272772a2585aSMatthias Ringwald         && (hci_event_packet_get_type(packet) == HCI_EVENT_COMMAND_COMPLETE)
272872a2585aSMatthias Ringwald         && (hci_event_command_complete_get_command_opcode(packet) == HCI_OPCODE_HCI_WRITE_SCAN_ENABLE)){
272967c6c9dcSMatthias Ringwald         hci_initializing_next_state();
273067c6c9dcSMatthias Ringwald     }
273167c6c9dcSMatthias Ringwald }
273267c6c9dcSMatthias Ringwald 
27339866fdc7SMatthias Ringwald #ifdef ENABLE_CLASSIC
27344aa2f135SMatthias Ringwald static void hci_handle_mutual_authentication_completed(hci_connection_t * conn){
27354aa2f135SMatthias Ringwald     // bonding complete if connection is authenticated (either initiated or BR/EDR SC)
27364aa2f135SMatthias Ringwald     conn->requested_security_level = LEVEL_0;
27374aa2f135SMatthias Ringwald     gap_security_level_t security_level = gap_security_level_for_connection(conn);
27384aa2f135SMatthias Ringwald     hci_emit_security_level(conn->con_handle, security_level);
27394aa2f135SMatthias Ringwald 
274067718330SMatthias Ringwald     // dedicated bonding
2741de9f0299SMatthias Ringwald     if ((conn->bonding_flags & BONDING_DEDICATED) != 0){
2742de9f0299SMatthias Ringwald         conn->bonding_flags &= ~BONDING_DEDICATED;
2743de9f0299SMatthias Ringwald         conn->bonding_status = security_level == 0 ? ERROR_CODE_INSUFFICIENT_SECURITY : ERROR_CODE_SUCCESS;
2744db3c1f89SMatthias Ringwald #ifdef ENABLE_EXPLICIT_DEDICATED_BONDING_DISCONNECT
2745db3c1f89SMatthias Ringwald         // emit dedicated bonding complete, don't disconnect
2746db3c1f89SMatthias Ringwald         hci_emit_dedicated_bonding_result(conn->address, conn->bonding_status);
2747db3c1f89SMatthias Ringwald #else
2748db3c1f89SMatthias Ringwald         // request disconnect, event is emitted after disconnect
2749db3c1f89SMatthias Ringwald         conn->bonding_flags |= BONDING_DISCONNECT_DEDICATED_DONE;
2750db3c1f89SMatthias Ringwald #endif
2751de9f0299SMatthias Ringwald     }
275267718330SMatthias Ringwald }
2753abdad579SMatthias Ringwald 
275467718330SMatthias Ringwald static void hci_handle_read_encryption_key_size_complete(hci_connection_t * conn, uint8_t encryption_key_size) {
275567718330SMatthias Ringwald     conn->authentication_flags |= AUTH_FLAG_CONNECTION_ENCRYPTED;
275667718330SMatthias Ringwald     conn->encryption_key_size = encryption_key_size;
275767718330SMatthias Ringwald 
275867718330SMatthias Ringwald     // mutual authentication complete if authenticated and we have retrieved the encryption key size
27598daf94bcSMatthias Ringwald     if ((conn->authentication_flags & AUTH_FLAG_CONNECTION_AUTHENTICATED) != 0) {
27604aa2f135SMatthias Ringwald         hci_handle_mutual_authentication_completed(conn);
27614cd03f8aSMatthias Ringwald     } else {
27624cd03f8aSMatthias Ringwald         // otherwise trigger remote feature request and send authentication request
2763dbe0d85cSMatthias Ringwald         hci_trigger_remote_features_for_connection(conn);
27644cd03f8aSMatthias Ringwald         if ((conn->bonding_flags & BONDING_SENT_AUTHENTICATE_REQUEST) == 0) {
2765abdad579SMatthias Ringwald             conn->bonding_flags |= BONDING_SEND_AUTHENTICATE_REQUEST;
27669866fdc7SMatthias Ringwald         }
27674cd03f8aSMatthias Ringwald     }
27684cd03f8aSMatthias Ringwald }
27699866fdc7SMatthias Ringwald #endif
27709866fdc7SMatthias Ringwald 
27713b631737SMatthias Ringwald static void hci_store_local_supported_commands(const uint8_t * packet){
277225e46151SMatthias Ringwald     // create mapping table
277325e46151SMatthias Ringwald #define X(name, offset, bit) { offset, bit },
277425e46151SMatthias Ringwald     static struct {
277525e46151SMatthias Ringwald         uint8_t byte_offset;
277625e46151SMatthias Ringwald         uint8_t bit_position;
277725e46151SMatthias Ringwald     } supported_hci_commands_map [] = {
277825e46151SMatthias Ringwald         SUPPORTED_HCI_COMMANDS
277925e46151SMatthias Ringwald     };
278025e46151SMatthias Ringwald #undef X
278125e46151SMatthias Ringwald 
278225e46151SMatthias Ringwald     // create names for debug purposes
278325e46151SMatthias Ringwald #ifdef ENABLE_LOG_DEBUG
278425e46151SMatthias Ringwald #define X(name, offset, bit) #name,
278525e46151SMatthias Ringwald     static const char * command_names[] = {
278625e46151SMatthias Ringwald         SUPPORTED_HCI_COMMANDS
278725e46151SMatthias Ringwald     };
278825e46151SMatthias Ringwald #undef X
278925e46151SMatthias Ringwald #endif
279025e46151SMatthias Ringwald 
27911ffa425cSMatthias Ringwald     hci_stack->local_supported_commands = 0;
279225e46151SMatthias Ringwald     const uint8_t * commands_map = &packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1];
279325e46151SMatthias Ringwald     uint16_t i;
279425e46151SMatthias Ringwald     for (i = 0 ; i < SUPPORTED_HCI_COMMANDS_COUNT ; i++){
279525e46151SMatthias Ringwald         if ((commands_map[supported_hci_commands_map[i].byte_offset] & (1 << supported_hci_commands_map[i].bit_position)) != 0){
279625e46151SMatthias Ringwald #ifdef ENABLE_LOG_DEBUG
2797345352acSMatthias Ringwald             log_debug("Command %s (%u) supported %u/%u", command_names[i], i, supported_hci_commands_map[i].byte_offset, supported_hci_commands_map[i].bit_position);
279825e46151SMatthias Ringwald #else
27991ffa425cSMatthias Ringwald             log_info("Command 0x%02x supported %u/%u", i, supported_hci_commands_map[i].byte_offset, supported_hci_commands_map[i].bit_position);
280025e46151SMatthias Ringwald #endif
28011ffa425cSMatthias Ringwald             hci_stack->local_supported_commands |= (1LU << i);
280225e46151SMatthias Ringwald         }
280325e46151SMatthias Ringwald     }
2804cb7b3e6fSMatthias Ringwald     log_info("Local supported commands summary %08" PRIx32, hci_stack->local_supported_commands);
28053b631737SMatthias Ringwald }
28063b631737SMatthias Ringwald 
28074f781026SMatthias Ringwald static void handle_command_complete_event(uint8_t * packet, uint16_t size){
2808b08371a9SMilanka Ringwald     UNUSED(size);
2809e76a89eeS[email protected] 
28104781fa78SDirk Helbig     uint8_t status = 0;
28114781fa78SDirk Helbig     if( size > OFFSET_OF_DATA_IN_COMMAND_COMPLETE ) {
28124781fa78SDirk Helbig         status = hci_event_command_complete_get_return_parameters(packet)[0];
28134781fa78SDirk Helbig     }
28149cbd2215SMatthias Ringwald     uint16_t manufacturer;
28159cbd2215SMatthias Ringwald #ifdef ENABLE_CLASSIC
28161f7b95a1Smatthias.ringwald     hci_connection_t * conn;
2817c7a108afSMatthias Ringwald #endif
281836916f81SDirk Helbig #if defined(ENABLE_CLASSIC)
28194781fa78SDirk Helbig     hci_con_handle_t handle;
28209cbd2215SMatthias Ringwald #endif
2821d3a89d91SMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
2822d3a89d91SMatthias Ringwald     le_audio_cig_t * cig;
2823d3a89d91SMatthias Ringwald #endif
282491036612SMatthias Ringwald #if defined(ENABLE_BLE) && defined(ENABLE_HCI_COMMAND_STATUS_DISCARDED_FOR_FAILED_CONNECTIONS_WORKAROUND)
2825f48a5586SMatthias Ringwald     hci_stack->hci_command_con_handle = HCI_CON_HANDLE_INVALID;
2826f48a5586SMatthias Ringwald #endif
2827d3a89d91SMatthias Ringwald 
28286bef4003SMatthias Ringwald     // get num cmd packets - limit to 1 to reduce complexity
28296bef4003SMatthias Ringwald     hci_stack->num_cmd_packets = packet[2] ? 1 : 0;
28307ec5eeaaSmatthias.ringwald 
2831645b7c25SMatthias Ringwald     uint16_t opcode = hci_event_command_complete_get_command_opcode(packet);
2832645b7c25SMatthias Ringwald     switch (opcode){
2833645b7c25SMatthias Ringwald         case HCI_OPCODE_HCI_READ_LOCAL_NAME:
28344781fa78SDirk Helbig             if (status) break;
28359e263bd7SMatthias Ringwald             // terminate, name 248 chars
28369e263bd7SMatthias Ringwald             packet[6+248] = 0;
28379e263bd7SMatthias Ringwald             log_info("local name: %s", &packet[6]);
2838645b7c25SMatthias Ringwald             break;
2839645b7c25SMatthias Ringwald         case HCI_OPCODE_HCI_READ_BUFFER_SIZE:
28401d279b20Smatthias.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"
2841c3b46f5aSMatthias Ringwald             if (hci_stack->state == HCI_STATE_INITIALIZING) {
2842429122ccSMatthias Ringwald                 uint16_t acl_len = little_endian_read_16(packet, 6);
2843429122ccSMatthias Ringwald                 uint16_t sco_len = packet[8];
2844429122ccSMatthias Ringwald 
2845429122ccSMatthias Ringwald                 // determine usable ACL/SCO payload size
2846429122ccSMatthias Ringwald                 hci_stack->acl_data_packet_length = btstack_min(acl_len, HCI_ACL_PAYLOAD_SIZE);
2847429122ccSMatthias Ringwald                 hci_stack->sco_data_packet_length = btstack_min(sco_len, HCI_ACL_PAYLOAD_SIZE);
2848429122ccSMatthias Ringwald 
2849616cfd90SMatthias Ringwald                 hci_stack->acl_packets_total_num = (uint8_t) btstack_min(little_endian_read_16(packet,  9), MAX_NR_CONTROLLER_ACL_BUFFERS);
2850616cfd90SMatthias Ringwald                 hci_stack->sco_packets_total_num = (uint8_t) btstack_min(little_endian_read_16(packet, 11), MAX_NR_CONTROLLER_SCO_PACKETS);
2851a8b12447S[email protected] 
2852429122ccSMatthias Ringwald                 log_info("hci_read_buffer_size: ACL size module %u -> used %u, count %u / SCO size %u, count %u",
2853429122ccSMatthias Ringwald                          acl_len, hci_stack->acl_data_packet_length, hci_stack->acl_packets_total_num,
28541a06f663S[email protected]                          hci_stack->sco_data_packet_length, hci_stack->sco_packets_total_num);
2855c3b46f5aSMatthias Ringwald             }
2856645b7c25SMatthias Ringwald             break;
2857645b7c25SMatthias Ringwald         case HCI_OPCODE_HCI_READ_RSSI:
28584781fa78SDirk Helbig             if (status == ERROR_CODE_SUCCESS){
2859891b9fc2SMatthias Ringwald                 uint8_t event[5];
2860891b9fc2SMatthias Ringwald                 event[0] = GAP_EVENT_RSSI_MEASUREMENT;
2861891b9fc2SMatthias Ringwald                 event[1] = 3;
28626535961aSMatthias Ringwald                 (void)memcpy(&event[2], &packet[6], 3);
28639da9850bSMatthias Ringwald                 hci_emit_btstack_event(event, sizeof(event), 1);
2864891b9fc2SMatthias Ringwald             }
2865645b7c25SMatthias Ringwald             break;
2866a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE
286779b7ea2dSMatthias Ringwald         case HCI_OPCODE_HCI_LE_READ_BUFFER_SIZE_V2:
286879b7ea2dSMatthias Ringwald             hci_stack->le_iso_packets_length = little_endian_read_16(packet, 9);
286979b7ea2dSMatthias Ringwald             hci_stack->le_iso_packets_total_num = packet[11];
287079b7ea2dSMatthias Ringwald             log_info("hci_le_read_buffer_size_v2: iso size %u, iso count %u",
287179b7ea2dSMatthias Ringwald                      hci_stack->le_iso_packets_length, hci_stack->le_iso_packets_total_num);
287279b7ea2dSMatthias Ringwald 
287379b7ea2dSMatthias Ringwald             /* fall through */
287479b7ea2dSMatthias Ringwald 
2875645b7c25SMatthias Ringwald         case HCI_OPCODE_HCI_LE_READ_BUFFER_SIZE:
2876f8fbdce0SMatthias Ringwald             hci_stack->le_data_packets_length = little_endian_read_16(packet, 6);
2877ee303eddS[email protected]             hci_stack->le_acl_packets_total_num = packet[8];
28786c26b087S[email protected]             // determine usable ACL payload size
28796c26b087S[email protected]             if (HCI_ACL_PAYLOAD_SIZE < hci_stack->le_data_packets_length){
28806c26b087S[email protected]                 hci_stack->le_data_packets_length = HCI_ACL_PAYLOAD_SIZE;
28816c26b087S[email protected]             }
288279b7ea2dSMatthias 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);
2883645b7c25SMatthias Ringwald             break;
2884b435e062SMatthias Ringwald #endif
2885b435e062SMatthias Ringwald #ifdef ENABLE_LE_DATA_LENGTH_EXTENSION
2886645b7c25SMatthias Ringwald         case HCI_OPCODE_HCI_LE_READ_MAXIMUM_DATA_LENGTH:
2887dcd678baSMatthias Ringwald             hci_stack->le_supported_max_tx_octets = little_endian_read_16(packet, 6);
2888dcd678baSMatthias Ringwald             hci_stack->le_supported_max_tx_time = little_endian_read_16(packet, 8);
2889dcd678baSMatthias 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);
2890645b7c25SMatthias Ringwald             break;
2891b435e062SMatthias Ringwald #endif
2892d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
2893645b7c25SMatthias Ringwald         case HCI_OPCODE_HCI_LE_READ_WHITE_LIST_SIZE:
2894e691bb38SMatthias Ringwald             hci_stack->le_whitelist_capacity = packet[6];
289515d0a15bSMatthias Ringwald             log_info("hci_le_read_white_list_size: size %u", hci_stack->le_whitelist_capacity);
2896645b7c25SMatthias Ringwald             break;
289765a46ef3S[email protected] #endif
28983a74541eSMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
28993a74541eSMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
29003a74541eSMatthias Ringwald         case HCI_OPCODE_HCI_LE_READ_MAXIMUM_ADVERTISING_DATA_LENGTH:
29013a74541eSMatthias Ringwald             hci_stack->le_maximum_advertising_data_length = little_endian_read_16(packet, 6);
29023a74541eSMatthias Ringwald             break;
290325df6c61SMatthias Ringwald         case HCI_OPCODE_HCI_LE_SET_EXTENDED_ADVERTISING_PARAMETERS:
290425df6c61SMatthias Ringwald             if (hci_stack->le_advertising_set_in_current_command != 0) {
290525df6c61SMatthias Ringwald                 le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(hci_stack->le_advertising_set_in_current_command);
290625df6c61SMatthias Ringwald                 hci_stack->le_advertising_set_in_current_command = 0;
290725df6c61SMatthias Ringwald                 if (advertising_set == NULL) break;
290825df6c61SMatthias Ringwald                 uint8_t adv_status = packet[6];
290925df6c61SMatthias Ringwald                 uint8_t tx_power   = packet[7];
291025df6c61SMatthias 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 };
291125df6c61SMatthias Ringwald                 if (adv_status == 0){
291225df6c61SMatthias Ringwald                     advertising_set->state |= LE_ADVERTISEMENT_STATE_PARAMS_SET;
291325df6c61SMatthias Ringwald                 }
29149da9850bSMatthias Ringwald                 hci_emit_btstack_event(event, sizeof(event), 1);
291525df6c61SMatthias Ringwald             }
291625df6c61SMatthias Ringwald             break;
291725df6c61SMatthias Ringwald         case HCI_OPCODE_HCI_LE_REMOVE_ADVERTISING_SET:
291825df6c61SMatthias Ringwald             if (hci_stack->le_advertising_set_in_current_command != 0) {
291925df6c61SMatthias Ringwald                 le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(hci_stack->le_advertising_set_in_current_command);
292025df6c61SMatthias Ringwald                 hci_stack->le_advertising_set_in_current_command = 0;
292125df6c61SMatthias Ringwald                 if (advertising_set == NULL) break;
29224781fa78SDirk Helbig                 uint8_t event[] = { HCI_EVENT_META_GAP, 3, GAP_SUBEVENT_ADVERTISING_SET_REMOVED, hci_stack->le_advertising_set_in_current_command, status };
29234781fa78SDirk Helbig                 if (status == 0){
292425df6c61SMatthias Ringwald                     btstack_linked_list_remove(&hci_stack->le_advertising_sets, (btstack_linked_item_t *) advertising_set);
292525df6c61SMatthias Ringwald                 }
29269da9850bSMatthias Ringwald                 hci_emit_btstack_event(event, sizeof(event), 1);
292725df6c61SMatthias Ringwald             }
292825df6c61SMatthias Ringwald             break;
29293a74541eSMatthias Ringwald #endif
29303a74541eSMatthias Ringwald #endif
2931645b7c25SMatthias Ringwald         case HCI_OPCODE_HCI_READ_BD_ADDR:
2932645b7c25SMatthias Ringwald             reverse_bd_addr(&packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE + 1], hci_stack->local_bd_addr);
29334781fa78SDirk Helbig             log_info("Local Address, Status: 0x%02x: Addr: %s", status, bd_addr_to_str(hci_stack->local_bd_addr));
293433373e40SMatthias Ringwald #ifdef ENABLE_CLASSIC
29351624665aSMatthias Ringwald             if (hci_stack->link_key_db){
29361624665aSMatthias Ringwald                 hci_stack->link_key_db->set_local_bd_addr(hci_stack->local_bd_addr);
29371624665aSMatthias Ringwald             }
293833373e40SMatthias Ringwald #endif
2939645b7c25SMatthias Ringwald             break;
294035454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
2941645b7c25SMatthias Ringwald         case HCI_OPCODE_HCI_WRITE_SCAN_ENABLE:
294271fd255dSMatthias Ringwald             hci_emit_scan_mode_changed(hci_stack->discoverable, hci_stack->connectable);
2943645b7c25SMatthias Ringwald             break;
29443d1f2d24SMatthias Ringwald         case HCI_OPCODE_HCI_PERIODIC_INQUIRY_MODE:
29453d1f2d24SMatthias Ringwald             if (status == ERROR_CODE_SUCCESS) {
29463d1f2d24SMatthias Ringwald                 hci_stack->inquiry_state = GAP_INQUIRY_STATE_PERIODIC;
29473d1f2d24SMatthias Ringwald             } else {
29483d1f2d24SMatthias Ringwald                 hci_stack->inquiry_state = GAP_INQUIRY_STATE_IDLE;
29493d1f2d24SMatthias Ringwald             }
29503d1f2d24SMatthias Ringwald             break;
2951645b7c25SMatthias Ringwald         case HCI_OPCODE_HCI_INQUIRY_CANCEL:
295230199e24SMatthias Ringwald         case HCI_OPCODE_HCI_EXIT_PERIODIC_INQUIRY_MODE:
2953f5875de5SMatthias Ringwald             if (hci_stack->inquiry_state == GAP_INQUIRY_STATE_W4_CANCELLED){
2954f5875de5SMatthias Ringwald                 hci_stack->inquiry_state = GAP_INQUIRY_STATE_IDLE;
2955f5875de5SMatthias Ringwald                 uint8_t event[] = { GAP_EVENT_INQUIRY_COMPLETE, 1, 0};
29569da9850bSMatthias Ringwald                 hci_emit_btstack_event(event, sizeof(event), 1);
2957f5875de5SMatthias Ringwald             }
2958645b7c25SMatthias Ringwald             break;
295935454696SMatthias Ringwald #endif
2960645b7c25SMatthias Ringwald         case HCI_OPCODE_HCI_READ_LOCAL_SUPPORTED_FEATURES:
29614f781026SMatthias Ringwald             (void)memcpy(hci_stack->local_supported_features, &packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE + 1], 8);
296265389bfcS[email protected] 
296335454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
2964a5a23fc2S[email protected]             // determine usable ACL packet types based on host buffer size and supported features
296529e39de4SMatthias 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]);
2966c92ca2c8SMatthias Ringwald             log_info("ACL Packet types %04x", hci_stack->usable_packet_types_acl);
2967c92ca2c8SMatthias Ringwald             // determine usable SCO packet types based on supported features
2968c92ca2c8SMatthias Ringwald             hci_stack->usable_packet_types_sco = hci_sco_packet_types_for_features(
2969c92ca2c8SMatthias Ringwald                     &hci_stack->local_supported_features[0]);
2970c92ca2c8SMatthias Ringwald             log_info("SCO Packet types %04x - eSCO %u", hci_stack->usable_packet_types_sco, hci_extended_sco_link_supported());
297135454696SMatthias Ringwald #endif
2972f5d8d141S[email protected]             // Classic/LE
2973f5d8d141S[email protected]             log_info("BR/EDR support %u, LE support %u", hci_classic_supported(), hci_le_supported());
2974645b7c25SMatthias Ringwald             break;
2975645b7c25SMatthias Ringwald         case HCI_OPCODE_HCI_READ_LOCAL_VERSION_INFORMATION:
2976645b7c25SMatthias Ringwald             manufacturer = little_endian_read_16(packet, 10);
2977547a29a6SMatthias Ringwald             // map Cypress & Infineon to Broadcom
2978547a29a6SMatthias Ringwald             switch (manufacturer){
2979547a29a6SMatthias Ringwald                 case BLUETOOTH_COMPANY_ID_CYPRESS_SEMICONDUCTOR:
2980547a29a6SMatthias Ringwald                 case BLUETOOTH_COMPANY_ID_INFINEON_TECHNOLOGIES_AG:
2981547a29a6SMatthias Ringwald                     log_info("Treat Cypress/Infineon as Broadcom");
2982c21d89f3SMatthias Ringwald                     manufacturer = BLUETOOTH_COMPANY_ID_BROADCOM_CORPORATION;
2983c21d89f3SMatthias Ringwald                     little_endian_store_16(packet, 10, manufacturer);
2984547a29a6SMatthias Ringwald                     break;
2985547a29a6SMatthias Ringwald                 default:
2986547a29a6SMatthias Ringwald                     break;
2987c21d89f3SMatthias Ringwald             }
2988c21d89f3SMatthias Ringwald             hci_stack->manufacturer = manufacturer;
29894696bddbSMatthias Ringwald             log_info("Manufacturer: 0x%04x", hci_stack->manufacturer);
2990645b7c25SMatthias Ringwald             break;
2991645b7c25SMatthias Ringwald         case HCI_OPCODE_HCI_READ_LOCAL_SUPPORTED_COMMANDS:
29923b631737SMatthias Ringwald             hci_store_local_supported_commands(packet);
2993645b7c25SMatthias Ringwald             break;
2994e8c8828eSMatthias Ringwald #ifdef ENABLE_CLASSIC
2995645b7c25SMatthias Ringwald         case HCI_OPCODE_HCI_WRITE_SYNCHRONOUS_FLOW_CONTROL_ENABLE:
29964781fa78SDirk Helbig             if (status) return;
29975b9b590fSMatthias Ringwald             hci_stack->synchronous_flow_control_enabled = 1;
2998645b7c25SMatthias Ringwald             break;
2999645b7c25SMatthias Ringwald         case HCI_OPCODE_HCI_READ_ENCRYPTION_KEY_SIZE:
3000573897a0SMatthias Ringwald             handle = little_endian_read_16(packet, OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1);
3001573897a0SMatthias Ringwald             conn   = hci_connection_for_handle(handle);
3002c3b46f5aSMatthias Ringwald             if (conn != NULL) {
30039866fdc7SMatthias Ringwald                 uint8_t key_size = 0;
3004573897a0SMatthias Ringwald                 if (status == 0){
30059866fdc7SMatthias Ringwald                     key_size = packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+3];
30064a659b0eSMatthias Ringwald                     log_info("Handle %04x key Size: %u", handle, key_size);
3007170fafaeSMatthias Ringwald                 } else {
3008e9f98c4aSMatthias Ringwald                     key_size = 1;
30099866fdc7SMatthias Ringwald                     log_info("Read Encryption Key Size failed 0x%02x-> assuming insecure connection with key size of 1", status);
3010573897a0SMatthias Ringwald                 }
30119866fdc7SMatthias Ringwald                 hci_handle_read_encryption_key_size_complete(conn, key_size);
3012c3b46f5aSMatthias Ringwald             }
3013645b7c25SMatthias Ringwald             break;
3014cc15bb2cSMatthias Ringwald         // assert pairing complete event is emitted.
3015cc15bb2cSMatthias Ringwald         // note: for SSP, Simple Pairing Complete Event is sufficient, but we want to be more robust
3016cc15bb2cSMatthias Ringwald         case HCI_OPCODE_HCI_PIN_CODE_REQUEST_NEGATIVE_REPLY:
3017cc15bb2cSMatthias Ringwald         case HCI_OPCODE_HCI_USER_PASSKEY_REQUEST_NEGATIVE_REPLY:
3018cc15bb2cSMatthias Ringwald         case HCI_OPCODE_HCI_USER_CONFIRMATION_REQUEST_NEGATIVE_REPLY:
30198cc1507eSMatthias Ringwald             hci_stack->gap_pairing_state = GAP_PAIRING_STATE_IDLE;
3020cc15bb2cSMatthias Ringwald             // lookup connection by gap pairing addr
3021cc15bb2cSMatthias Ringwald             conn = hci_connection_for_bd_addr_and_type(hci_stack->gap_pairing_addr, BD_ADDR_TYPE_ACL);
3022cc15bb2cSMatthias Ringwald             if (conn == NULL) break;
3023cc15bb2cSMatthias Ringwald             hci_pairing_complete(conn, ERROR_CODE_AUTHENTICATION_FAILURE);
3024cc15bb2cSMatthias Ringwald             break;
3025cc15bb2cSMatthias Ringwald 
302675a8e4faSMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB
302775a8e4faSMatthias Ringwald         case HCI_OPCODE_HCI_READ_LOCAL_OOB_DATA:
302875a8e4faSMatthias Ringwald         case HCI_OPCODE_HCI_READ_LOCAL_EXTENDED_OOB_DATA:{
302975a8e4faSMatthias Ringwald             uint8_t event[67];
303075a8e4faSMatthias Ringwald             event[0] = GAP_EVENT_LOCAL_OOB_DATA;
303175a8e4faSMatthias Ringwald             event[1] = 65;
303275a8e4faSMatthias Ringwald             (void)memset(&event[2], 0, 65);
30334781fa78SDirk Helbig             if (status == ERROR_CODE_SUCCESS){
303475a8e4faSMatthias Ringwald                 (void)memcpy(&event[3], &packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1], 32);
303575a8e4faSMatthias Ringwald                 if (opcode == HCI_OPCODE_HCI_READ_LOCAL_EXTENDED_OOB_DATA){
303675a8e4faSMatthias Ringwald                     event[2] = 3;
303775a8e4faSMatthias Ringwald                     (void)memcpy(&event[35], &packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+33], 32);
303875a8e4faSMatthias Ringwald                 } else {
303975a8e4faSMatthias Ringwald                     event[2] = 1;
304075a8e4faSMatthias Ringwald                 }
304175a8e4faSMatthias Ringwald             }
30429da9850bSMatthias Ringwald             hci_emit_btstack_event(event, sizeof(event), 0);
304375a8e4faSMatthias Ringwald             break;
304475a8e4faSMatthias Ringwald         }
30451ae74bf3SMatthias Ringwald 
30461ae74bf3SMatthias Ringwald         // note: only needed if user does not provide OOB data
30471ae74bf3SMatthias Ringwald         case HCI_OPCODE_HCI_REMOTE_OOB_DATA_REQUEST_NEGATIVE_REPLY:
30481ae74bf3SMatthias Ringwald             conn = hci_connection_for_handle(hci_stack->classic_oob_con_handle);
30491ae74bf3SMatthias Ringwald             hci_stack->classic_oob_con_handle = HCI_CON_HANDLE_INVALID;
30501ae74bf3SMatthias Ringwald             if (conn == NULL) break;
30511ae74bf3SMatthias Ringwald             hci_pairing_complete(conn, ERROR_CODE_AUTHENTICATION_FAILURE);
30521ae74bf3SMatthias Ringwald             break;
3053e8c8828eSMatthias Ringwald #endif
305475a8e4faSMatthias Ringwald #endif
30554ae8623eSMatthias Ringwald #ifdef ENABLE_BLE
30564ae8623eSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
3057d3a89d91SMatthias Ringwald         case HCI_OPCODE_HCI_LE_SET_CIG_PARAMETERS:
3058d3a89d91SMatthias Ringwald             // lookup CIG
3059d3a89d91SMatthias Ringwald             cig = hci_cig_for_id(hci_stack->iso_active_operation_group_id);
3060d3a89d91SMatthias Ringwald             if (cig != NULL){
3061d3a89d91SMatthias Ringwald                 uint8_t i = 0;
3062d3a89d91SMatthias Ringwald                 if (status == ERROR_CODE_SUCCESS){
3063d3a89d91SMatthias Ringwald                     // assign CIS handles to pre-allocated CIS
3064d3a89d91SMatthias Ringwald                     btstack_linked_list_iterator_t it;
3065d3a89d91SMatthias Ringwald                     btstack_linked_list_iterator_init(&it, &hci_stack->iso_streams);
3066d3a89d91SMatthias Ringwald                     while (btstack_linked_list_iterator_has_next(&it) && (i < cig->num_cis)) {
3067d3a89d91SMatthias Ringwald                         hci_iso_stream_t *iso_stream = (hci_iso_stream_t *) btstack_linked_list_iterator_next(&it);
3068d3a89d91SMatthias Ringwald                         if ((iso_stream->group_id == hci_stack->iso_active_operation_group_id) &&
3069d3a89d91SMatthias Ringwald                             (iso_stream->iso_type == HCI_ISO_TYPE_CIS)){
3070d3a89d91SMatthias Ringwald                             hci_con_handle_t cis_handle = little_endian_read_16(packet, OFFSET_OF_DATA_IN_COMMAND_COMPLETE+3+(2*i));
3071969d876aSMatthias Ringwald                             iso_stream->cis_handle  = cis_handle;
3072d3a89d91SMatthias Ringwald                             cig->cis_con_handles[i] = cis_handle;
3073d3a89d91SMatthias Ringwald                             i++;
3074d3a89d91SMatthias Ringwald                         }
3075d3a89d91SMatthias Ringwald                     }
3076444e371eSMatthias Ringwald                     cig->state = LE_AUDIO_CIG_STATE_W4_CIS_REQUEST;
3077d3a89d91SMatthias Ringwald                     hci_emit_cig_created(cig, status);
3078d3a89d91SMatthias Ringwald                 } else {
3079d3a89d91SMatthias Ringwald                     hci_emit_cig_created(cig, status);
3080d3a89d91SMatthias Ringwald                     btstack_linked_list_remove(&hci_stack->le_audio_cigs, (btstack_linked_item_t *) cig);
3081d3a89d91SMatthias Ringwald                 }
3082d3a89d91SMatthias Ringwald             }
308326b93350SMatthias Ringwald             hci_stack->iso_active_operation_type = HCI_ISO_TYPE_INVALID;
3084d3a89d91SMatthias Ringwald             break;
30854ae8623eSMatthias Ringwald         case HCI_OPCODE_HCI_LE_CREATE_CIS:
30864ae8623eSMatthias Ringwald             if (status != ERROR_CODE_SUCCESS){
3087d75a6bbfSMatthias Ringwald                 hci_iso_stream_requested_finalize(HCI_ISO_GROUP_ID_INVALID);
30884ae8623eSMatthias Ringwald             }
30894ae8623eSMatthias Ringwald             break;
309042529435SMatthias Ringwald         case HCI_OPCODE_HCI_LE_ACCEPT_CIS_REQUEST:
309142529435SMatthias Ringwald             if (status != ERROR_CODE_SUCCESS){
3092d75a6bbfSMatthias Ringwald                 hci_iso_stream_requested_finalize(HCI_ISO_GROUP_ID_INVALID);
309342529435SMatthias Ringwald             }
309442529435SMatthias Ringwald             break;
30957aa35f6aSMatthias Ringwald         case HCI_OPCODE_HCI_LE_SETUP_ISO_DATA_PATH: {
30967aa35f6aSMatthias Ringwald             // lookup BIG by state
30977aa35f6aSMatthias Ringwald             btstack_linked_list_iterator_t it;
30987aa35f6aSMatthias Ringwald             btstack_linked_list_iterator_init(&it, &hci_stack->le_audio_bigs);
30997aa35f6aSMatthias Ringwald             while (btstack_linked_list_iterator_has_next(&it)) {
31007aa35f6aSMatthias Ringwald                 le_audio_big_t *big = (le_audio_big_t *) btstack_linked_list_iterator_next(&it);
31017aa35f6aSMatthias Ringwald                 if (big->state == LE_AUDIO_BIG_STATE_W4_SETUP_ISO_PATH){
31027aa35f6aSMatthias Ringwald                     if (status == ERROR_CODE_SUCCESS){
31037aa35f6aSMatthias Ringwald                         big->state_vars.next_bis++;
31047aa35f6aSMatthias Ringwald                         if (big->state_vars.next_bis == big->num_bis){
31057aa35f6aSMatthias Ringwald                             big->state = LE_AUDIO_BIG_STATE_ACTIVE;
31067aa35f6aSMatthias Ringwald                             hci_emit_big_created(big, ERROR_CODE_SUCCESS);
31077aa35f6aSMatthias Ringwald                         } else {
31087aa35f6aSMatthias Ringwald                             big->state = LE_AUDIO_BIG_STATE_SETUP_ISO_PATH;
31097aa35f6aSMatthias Ringwald                         }
31107aa35f6aSMatthias Ringwald                     } else {
31117aa35f6aSMatthias Ringwald                         big->state = LE_AUDIO_BIG_STATE_SETUP_ISO_PATHS_FAILED;
31127aa35f6aSMatthias Ringwald                         big->state_vars.status = status;
31132a6c0f82SMatthias Ringwald                     }
31142a6c0f82SMatthias Ringwald                     return;
31152a6c0f82SMatthias Ringwald                 }
31162a6c0f82SMatthias Ringwald             }
31172a6c0f82SMatthias Ringwald             btstack_linked_list_iterator_init(&it, &hci_stack->le_audio_big_syncs);
31182a6c0f82SMatthias Ringwald             while (btstack_linked_list_iterator_has_next(&it)) {
31192a6c0f82SMatthias Ringwald                 le_audio_big_sync_t *big_sync = (le_audio_big_sync_t *) btstack_linked_list_iterator_next(&it);
31202a6c0f82SMatthias Ringwald                 if (big_sync->state == LE_AUDIO_BIG_STATE_W4_SETUP_ISO_PATH){
31212a6c0f82SMatthias Ringwald                     if (status == ERROR_CODE_SUCCESS){
31222a6c0f82SMatthias Ringwald                         big_sync->state_vars.next_bis++;
31232a6c0f82SMatthias Ringwald                         if (big_sync->state_vars.next_bis == big_sync->num_bis){
31242a6c0f82SMatthias Ringwald                             big_sync->state = LE_AUDIO_BIG_STATE_ACTIVE;
31252a6c0f82SMatthias Ringwald                             hci_emit_big_sync_created(big_sync, ERROR_CODE_SUCCESS);
31262a6c0f82SMatthias Ringwald                         } else {
31272a6c0f82SMatthias Ringwald                             big_sync->state = LE_AUDIO_BIG_STATE_SETUP_ISO_PATH;
31282a6c0f82SMatthias Ringwald                         }
31292a6c0f82SMatthias Ringwald                     } else {
31302a6c0f82SMatthias Ringwald                         big_sync->state = LE_AUDIO_BIG_STATE_SETUP_ISO_PATHS_FAILED;
31312a6c0f82SMatthias Ringwald                         big_sync->state_vars.status = status;
31322a6c0f82SMatthias Ringwald                     }
31332a6c0f82SMatthias Ringwald                     return;
31342a6c0f82SMatthias Ringwald                 }
31352a6c0f82SMatthias Ringwald             }
3136f9306a1aSMatthias Ringwald             // Lookup CIS via active group operation
3137f9306a1aSMatthias Ringwald             if (hci_stack->iso_active_operation_type == HCI_ISO_TYPE_CIS){
313826b93350SMatthias Ringwald                 if (hci_stack->iso_active_operation_group_id == HCI_ISO_GROUP_ID_SINGLE_CIS){
313926b93350SMatthias Ringwald                     hci_stack->iso_active_operation_type = HCI_ISO_TYPE_INVALID;
314026b93350SMatthias Ringwald 
314126b93350SMatthias Ringwald                     // lookup CIS by state
314226b93350SMatthias Ringwald                     btstack_linked_list_iterator_init(&it, &hci_stack->iso_streams);
314326b93350SMatthias Ringwald                     while (btstack_linked_list_iterator_has_next(&it)){
314426b93350SMatthias Ringwald                         hci_iso_stream_t * iso_stream = (hci_iso_stream_t *) btstack_linked_list_iterator_next(&it);
3145532211feSMatthias Ringwald                         bool emit_cis_created = false;
314626b93350SMatthias Ringwald                         switch (iso_stream->state){
314726b93350SMatthias Ringwald                             case HCI_ISO_STREAM_STATE_W4_ISO_SETUP_INPUT:
314826b93350SMatthias Ringwald                                 if (status != ERROR_CODE_SUCCESS){
3149532211feSMatthias Ringwald                                     emit_cis_created = true;
315026b93350SMatthias Ringwald                                     break;
315126b93350SMatthias Ringwald                                 }
315226b93350SMatthias Ringwald                                 if (iso_stream->max_sdu_c_to_p > 0){
31531418332dSMatthias Ringwald                                     iso_stream->state = HCI_ISO_STREAM_STATE_W2_SETUP_ISO_OUTPUT;
315426b93350SMatthias Ringwald                                 } else {
3155532211feSMatthias Ringwald                                     emit_cis_created = true;
315626b93350SMatthias Ringwald                                 }
315726b93350SMatthias Ringwald                                 break;
315826b93350SMatthias Ringwald                             case HCI_ISO_STREAM_STATE_W4_ISO_SETUP_OUTPUT:
3159532211feSMatthias Ringwald                                 emit_cis_created = true;
316026b93350SMatthias Ringwald                                 break;
316126b93350SMatthias Ringwald                             default:
316226b93350SMatthias Ringwald                                 break;
316326b93350SMatthias Ringwald                         }
3164532211feSMatthias Ringwald                         if (emit_cis_created){
316514045fdbSMatthias Ringwald                             hci_cis_handle_created(iso_stream, status);
3166532211feSMatthias Ringwald                         }
316726b93350SMatthias Ringwald                     }
316826b93350SMatthias Ringwald                 } else {
3169f9306a1aSMatthias Ringwald                     cig = hci_cig_for_id(hci_stack->iso_active_operation_group_id);
3170532211feSMatthias Ringwald                     hci_stack->iso_active_operation_type = HCI_ISO_TYPE_INVALID;
3171f9306a1aSMatthias Ringwald                     if (cig != NULL) {
3172f9306a1aSMatthias Ringwald                         // emit cis created if all ISO Paths have been created
3173f9306a1aSMatthias Ringwald                         // assume we are central
3174f9306a1aSMatthias Ringwald                         uint8_t cis_index     = cig->state_vars.next_cis >> 1;
3175f9306a1aSMatthias Ringwald                         uint8_t cis_direction = cig->state_vars.next_cis & 1;
3176f9306a1aSMatthias Ringwald                         bool outgoing_needed  = cig->params->cis_params[cis_index].max_sdu_p_to_c > 0;
3177f9306a1aSMatthias Ringwald                         // if outgoing has been setup, or incoming was setup but outgoing not required
3178f9306a1aSMatthias Ringwald                         if ((cis_direction == 1) || (outgoing_needed == false)){
3179532211feSMatthias Ringwald                             // lookup iso stream by cig/cis
3180b5ecaedbSMatthias Ringwald                             btstack_linked_list_iterator_init(&it, &hci_stack->iso_streams);
3181532211feSMatthias Ringwald                             while (btstack_linked_list_iterator_has_next(&it)) {
3182532211feSMatthias Ringwald                                 hci_iso_stream_t *iso_stream = (hci_iso_stream_t *) btstack_linked_list_iterator_next(&it);
3183532211feSMatthias Ringwald                                 if ((iso_stream->group_id == cig->cig_id) && (iso_stream->stream_id == cis_index)){
318414045fdbSMatthias Ringwald                                     hci_cis_handle_created(iso_stream, status);
3185532211feSMatthias Ringwald                                 }
3186532211feSMatthias Ringwald                             }
3187f9306a1aSMatthias Ringwald                         }
3188f9306a1aSMatthias Ringwald                         // next state
3189f9306a1aSMatthias Ringwald                         cig->state_vars.next_cis++;
3190f9306a1aSMatthias Ringwald                         cig->state = LE_AUDIO_CIG_STATE_SETUP_ISO_PATH;
3191f9306a1aSMatthias Ringwald                     }
3192f9306a1aSMatthias Ringwald                 }
319326b93350SMatthias Ringwald             }
31942a6c0f82SMatthias Ringwald             break;
31952a6c0f82SMatthias Ringwald         }
31962a6c0f82SMatthias Ringwald         case HCI_OPCODE_HCI_LE_BIG_TERMINATE_SYNC: {
31972a6c0f82SMatthias Ringwald             // lookup BIG by state
31982a6c0f82SMatthias Ringwald             btstack_linked_list_iterator_t it;
31992a6c0f82SMatthias Ringwald             btstack_linked_list_iterator_init(&it, &hci_stack->le_audio_big_syncs);
32002a6c0f82SMatthias Ringwald             while (btstack_linked_list_iterator_has_next(&it)) {
32012a6c0f82SMatthias Ringwald                 le_audio_big_sync_t *big_sync = (le_audio_big_sync_t *) btstack_linked_list_iterator_next(&it);
3202d04a9afcSMatthias Ringwald                 uint8_t big_handle = big_sync->big_handle;
32032a6c0f82SMatthias Ringwald                 switch (big_sync->state){
32042a6c0f82SMatthias Ringwald                     case LE_AUDIO_BIG_STATE_W4_TERMINATED_AFTER_SETUP_FAILED:
3205d04a9afcSMatthias Ringwald                         btstack_linked_list_iterator_remove(&it);
32062a6c0f82SMatthias Ringwald                         hci_emit_big_sync_created(big_sync, big_sync->state_vars.status);
3207d04a9afcSMatthias Ringwald                         return;
32082a6c0f82SMatthias Ringwald                     default:
3209d04a9afcSMatthias Ringwald                         btstack_linked_list_iterator_remove(&it);
3210d04a9afcSMatthias Ringwald                         hci_emit_big_sync_stopped(big_handle);
32117aa35f6aSMatthias Ringwald                         return;
32127aa35f6aSMatthias Ringwald                 }
32137aa35f6aSMatthias Ringwald             }
32147aa35f6aSMatthias Ringwald             break;
32157aa35f6aSMatthias Ringwald         }
32164ae8623eSMatthias Ringwald #endif
32174ae8623eSMatthias Ringwald #endif
32186f35bb46SMatthias Ringwald         default:
32196f35bb46SMatthias Ringwald             break;
32204f781026SMatthias Ringwald     }
3221645b7c25SMatthias Ringwald }
32224f781026SMatthias Ringwald 
3223d8905293SMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
3224d8905293SMatthias Ringwald static void
3225d8905293SMatthias Ringwald hci_iso_create_big_failed(const le_audio_big_t *big, uint8_t status) {
3226d8905293SMatthias Ringwald     hci_iso_stream_finalize_by_type_and_group_id(HCI_ISO_TYPE_BIS, big->big_handle);
3227d8905293SMatthias Ringwald     btstack_linked_list_remove(&hci_stack->le_audio_bigs, (btstack_linked_item_t *) big);
3228d8905293SMatthias Ringwald     if (big->state == LE_AUDIO_BIG_STATE_W4_ESTABLISHED){
3229d8905293SMatthias Ringwald         hci_emit_big_created(big, status);
3230d8905293SMatthias Ringwald     } else {
3231d8905293SMatthias Ringwald         hci_emit_big_terminated(big);
3232d8905293SMatthias Ringwald     }
3233d8905293SMatthias Ringwald }
3234d8905293SMatthias Ringwald 
3235d8905293SMatthias Ringwald static void hci_iso_big_sync_failed(const le_audio_big_sync_t *big_sync, uint8_t status) {
3236d8905293SMatthias Ringwald     btstack_linked_list_remove(&hci_stack->le_audio_big_syncs, (btstack_linked_item_t *) big_sync);
3237d8905293SMatthias Ringwald     if (big_sync->state == LE_AUDIO_BIG_STATE_W4_ESTABLISHED) {
3238d8905293SMatthias Ringwald         hci_emit_big_sync_created(big_sync, status);
3239d8905293SMatthias Ringwald     } else {
3240d8905293SMatthias Ringwald         hci_emit_big_sync_stopped(big_sync->big_handle);
3241d8905293SMatthias Ringwald     }
3242d8905293SMatthias Ringwald }
3243d8905293SMatthias Ringwald #endif
3244d8905293SMatthias Ringwald 
3245afbf1cd7SMatthias Ringwald static void handle_command_status_event(uint8_t * packet, uint16_t size) {
3246afbf1cd7SMatthias Ringwald     UNUSED(size);
3247afbf1cd7SMatthias Ringwald 
3248afbf1cd7SMatthias Ringwald     // get num cmd packets - limit to 1 to reduce complexity
3249afbf1cd7SMatthias Ringwald     hci_stack->num_cmd_packets = packet[3] ? 1 : 0;
3250afbf1cd7SMatthias Ringwald 
3251c70df5f8SMatthias Ringwald     // get opcode and command status
3252c70df5f8SMatthias Ringwald     uint16_t opcode = hci_event_command_status_get_command_opcode(packet);
3253c70df5f8SMatthias Ringwald 
3254c70df5f8SMatthias Ringwald #if defined(ENABLE_CLASSIC) || defined(ENABLE_LE_CENTRAL) || defined(ENABLE_LE_ISOCHRONOUS_STREAMS)
3255c70df5f8SMatthias Ringwald     uint8_t status = hci_event_command_status_get_status(packet);
3256c70df5f8SMatthias Ringwald #endif
3257c70df5f8SMatthias Ringwald 
3258c70df5f8SMatthias Ringwald #if defined(ENABLE_CLASSIC) || defined(ENABLE_LE_CENTRAL)
3259c70df5f8SMatthias Ringwald     bd_addr_type_t addr_type;
326073bccf35Slouislee91     bd_addr_t addr;
3261c70df5f8SMatthias Ringwald #endif
3262c70df5f8SMatthias Ringwald 
326391036612SMatthias Ringwald #if defined(ENABLE_BLE) && defined (ENABLE_HCI_COMMAND_STATUS_DISCARDED_FOR_FAILED_CONNECTIONS_WORKAROUND)
3264f48a5586SMatthias Ringwald     hci_stack->hci_command_con_handle = HCI_CON_HANDLE_INVALID;
3265f48a5586SMatthias Ringwald #endif
3266f48a5586SMatthias Ringwald 
3267c70df5f8SMatthias Ringwald     switch (opcode){
3268afbf1cd7SMatthias Ringwald #ifdef ENABLE_CLASSIC
3269c70df5f8SMatthias Ringwald         case HCI_OPCODE_HCI_CREATE_CONNECTION:
32709071873aSMatthias Ringwald         case HCI_OPCODE_HCI_SETUP_SYNCHRONOUS_CONNECTION:
3271c70df5f8SMatthias Ringwald         case HCI_OPCODE_HCI_ACCEPT_SYNCHRONOUS_CONNECTION:
3272afbf1cd7SMatthias Ringwald #endif
3273afbf1cd7SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
3274c70df5f8SMatthias Ringwald         case HCI_OPCODE_HCI_LE_CREATE_CONNECTION:
3275afbf1cd7SMatthias Ringwald #endif
3276c70df5f8SMatthias Ringwald #if defined(ENABLE_CLASSIC) || defined(ENABLE_LE_CENTRAL)
3277afbf1cd7SMatthias Ringwald             addr_type = hci_stack->outgoing_addr_type;
327873bccf35Slouislee91             memcpy(addr, hci_stack->outgoing_addr, 6);
3279afbf1cd7SMatthias Ringwald 
3280afbf1cd7SMatthias Ringwald             // reset outgoing address info
3281afbf1cd7SMatthias Ringwald             memset(hci_stack->outgoing_addr, 0, 6);
3282afbf1cd7SMatthias Ringwald             hci_stack->outgoing_addr_type = BD_ADDR_TYPE_UNKNOWN;
3283afbf1cd7SMatthias Ringwald 
3284afbf1cd7SMatthias Ringwald             // on error
3285afbf1cd7SMatthias Ringwald             if (status != ERROR_CODE_SUCCESS){
3286afbf1cd7SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
3287afbf1cd7SMatthias Ringwald                 if (hci_is_le_connection_type(addr_type)){
3288afbf1cd7SMatthias Ringwald                     hci_stack->le_connecting_state = LE_CONNECTING_IDLE;
3289afbf1cd7SMatthias Ringwald                     hci_stack->le_connecting_request = LE_CONNECTING_IDLE;
3290afbf1cd7SMatthias Ringwald                 }
3291afbf1cd7SMatthias Ringwald #endif
3292afbf1cd7SMatthias Ringwald                 // error => outgoing connection failed
329373bccf35Slouislee91                 hci_connection_t * conn = hci_connection_for_bd_addr_and_type(addr, addr_type);
3294afbf1cd7SMatthias Ringwald                 if (conn != NULL){
3295afbf1cd7SMatthias Ringwald                     hci_handle_connection_failed(conn, status);
3296afbf1cd7SMatthias Ringwald                 }
3297afbf1cd7SMatthias Ringwald             }
3298c70df5f8SMatthias Ringwald             break;
3299c70df5f8SMatthias Ringwald #endif
3300afbf1cd7SMatthias Ringwald #ifdef ENABLE_CLASSIC
3301c70df5f8SMatthias Ringwald         case HCI_OPCODE_HCI_INQUIRY:
3302afbf1cd7SMatthias Ringwald             if (status == ERROR_CODE_SUCCESS) {
3303afbf1cd7SMatthias Ringwald                 hci_stack->inquiry_state = GAP_INQUIRY_STATE_ACTIVE;
3304afbf1cd7SMatthias Ringwald             } else {
3305afbf1cd7SMatthias Ringwald                 hci_stack->inquiry_state = GAP_INQUIRY_STATE_IDLE;
3306afbf1cd7SMatthias Ringwald             }
3307c70df5f8SMatthias Ringwald             break;
3308c70df5f8SMatthias Ringwald #endif
3309afbf1cd7SMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
3310c70df5f8SMatthias Ringwald         case HCI_OPCODE_HCI_LE_CREATE_CIS:
3311c70df5f8SMatthias Ringwald         case HCI_OPCODE_HCI_LE_ACCEPT_CIS_REQUEST:
3312afbf1cd7SMatthias Ringwald             if (status == ERROR_CODE_SUCCESS){
3313d75a6bbfSMatthias Ringwald                 hci_iso_stream_requested_confirm(HCI_ISO_GROUP_ID_INVALID);
3314afbf1cd7SMatthias Ringwald             } else {
3315d75a6bbfSMatthias Ringwald                 hci_iso_stream_requested_finalize(HCI_ISO_GROUP_ID_INVALID);
3316afbf1cd7SMatthias Ringwald             }
3317c70df5f8SMatthias Ringwald             break;
331815f9bb6dSMatthias Ringwald         case HCI_OPCODE_HCI_LE_CREATE_BIG:
331915f9bb6dSMatthias Ringwald             if (status != ERROR_CODE_SUCCESS){
332015f9bb6dSMatthias Ringwald                 hci_stack->iso_active_operation_type = HCI_ISO_TYPE_INVALID;
3321d8905293SMatthias Ringwald                 // get current big
3322d8905293SMatthias Ringwald                 le_audio_big_t * big = hci_big_for_handle(hci_stack->iso_active_operation_group_id);
3323d8905293SMatthias Ringwald                 if (big != NULL){
3324d8905293SMatthias Ringwald                     hci_iso_create_big_failed(big, status);
3325d8905293SMatthias Ringwald                 }
332615f9bb6dSMatthias Ringwald             }
332715f9bb6dSMatthias Ringwald             break;
332815f9bb6dSMatthias Ringwald         case HCI_OPCODE_HCI_LE_BIG_CREATE_SYNC:
332915f9bb6dSMatthias Ringwald             if (status != ERROR_CODE_SUCCESS){
333015f9bb6dSMatthias Ringwald                 hci_stack->iso_active_operation_type = HCI_ISO_TYPE_INVALID;
3331d8905293SMatthias Ringwald                 // get current big sync
3332d8905293SMatthias Ringwald                 le_audio_big_sync_t * big_sync = hci_big_sync_for_handle(hci_stack->iso_active_operation_group_id);
3333d8905293SMatthias Ringwald                 if (big_sync != NULL){
3334d8905293SMatthias Ringwald                     hci_iso_big_sync_failed(big_sync, status);
3335d8905293SMatthias Ringwald                 }
333615f9bb6dSMatthias Ringwald             }
333715f9bb6dSMatthias Ringwald             break;
3338afbf1cd7SMatthias Ringwald #endif /* ENABLE_LE_ISOCHRONOUS_STREAMS */
3339c70df5f8SMatthias Ringwald         default:
3340c70df5f8SMatthias Ringwald             break;
3341c70df5f8SMatthias Ringwald     }
3342afbf1cd7SMatthias Ringwald }
3343afbf1cd7SMatthias Ringwald 
33440ce3f217SMatthias Ringwald #ifdef ENABLE_BLE
3345e4def797SMatthias Ringwald static void hci_create_gap_connection_complete_event(const uint8_t * hci_event, uint8_t * gap_event) {
3346e4def797SMatthias Ringwald     gap_event[0] = HCI_EVENT_META_GAP;
3347e4def797SMatthias Ringwald     gap_event[1] = 36 - 2;
3348e4def797SMatthias Ringwald     gap_event[2] = GAP_SUBEVENT_LE_CONNECTION_COMPLETE;
3349bede2a55SMatthias Ringwald     switch (hci_event_le_meta_get_subevent_code(hci_event)){
3350a9212437SMatthias Ringwald         case HCI_SUBEVENT_LE_CONNECTION_COMPLETE:
3351e4def797SMatthias Ringwald             memcpy(&gap_event[3], &hci_event[3], 11);
3352e4def797SMatthias Ringwald             memset(&gap_event[14], 0, 12);
3353e4def797SMatthias Ringwald             memcpy(&gap_event[26], &hci_event[14], 7);
3354e4def797SMatthias Ringwald             memset(&gap_event[33], 0xff, 3);
33557efb077fSMatthias Ringwald             // Some Controllers incorrectly report a resolved identity address in HCI_SUBEVENT_LE_CONNECTION_COMPLETE.
33567efb077fSMatthias Ringwald             // If an address is resolved, we're working with it, but this event does not provide it.
33577efb077fSMatthias Ringwald             // As a workaround, we map identity addresses to regular addresses.
33587efb077fSMatthias Ringwald             gap_event[7] = gap_event[7] & 1;
3359a9212437SMatthias Ringwald             break;
3360a9212437SMatthias Ringwald         case HCI_SUBEVENT_LE_ENHANCED_CONNECTION_COMPLETE_V1:
3361e4def797SMatthias Ringwald             memcpy(&gap_event[3], &hci_event[3], 30);
3362e4def797SMatthias Ringwald             memset(&gap_event[33], 0xff, 3);
3363a9212437SMatthias Ringwald             break;
3364a9212437SMatthias Ringwald         case HCI_SUBEVENT_LE_ENHANCED_CONNECTION_COMPLETE_V2:
3365e4def797SMatthias Ringwald             memcpy(&gap_event[3], &hci_event[3], 33);
3366a9212437SMatthias Ringwald             break;
3367a9212437SMatthias Ringwald         default:
3368a9212437SMatthias Ringwald             btstack_unreachable();
3369a9212437SMatthias Ringwald             break;
3370a9212437SMatthias Ringwald     }
3371a9212437SMatthias Ringwald }
3372a9212437SMatthias Ringwald 
3373688bcdb4SMatthias Ringwald static void hci_handle_le_connection_complete_event(const uint8_t * hci_event){
337498e0165dSMatthias Ringwald     // create GAP_SUBEVENT_LE_CONNECTION_COMPLETE
3375a9212437SMatthias Ringwald     uint8_t gap_event[36];
3376a9212437SMatthias Ringwald     hci_create_gap_connection_complete_event(hci_event, gap_event);
337760fb273dSMatthias Ringwald 
337898e0165dSMatthias Ringwald     // read fields
3379a9212437SMatthias Ringwald     uint8_t status = gap_subevent_le_connection_complete_get_status(gap_event);
3380a9212437SMatthias Ringwald     hci_role_t role = (hci_role_t) gap_subevent_le_connection_complete_get_role(gap_event);
3381a9212437SMatthias Ringwald     uint16_t conn_interval = gap_subevent_le_connection_complete_get_conn_interval(gap_event);
338298e0165dSMatthias Ringwald 
33830ce3f217SMatthias Ringwald 	// Connection management
3384138e942eSMatthias Ringwald     bd_addr_t addr;
3385a9212437SMatthias Ringwald     gap_subevent_le_connection_complete_get_peer_address(gap_event, addr);
3386138e942eSMatthias Ringwald     bd_addr_type_t addr_type = (bd_addr_type_t) gap_subevent_le_connection_complete_get_peer_address_type(gap_event);
3387138e942eSMatthias Ringwald     hci_con_handle_t con_handle = gap_subevent_le_connection_complete_get_connection_handle(gap_event);
338860fb273dSMatthias Ringwald     log_info("LE Connection_complete (status=%u) type %u, %s", status, addr_type, bd_addr_to_str(addr));
3389138e942eSMatthias Ringwald     hci_connection_t * conn = hci_connection_for_bd_addr_and_type(addr, addr_type);
33900ce3f217SMatthias Ringwald 
33910ce3f217SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
33920ce3f217SMatthias Ringwald 	// handle error: error is reported only to the initiator -> outgoing connection
339360fb273dSMatthias Ringwald 	if (status){
33940ce3f217SMatthias Ringwald 
33950ce3f217SMatthias Ringwald 		// handle cancelled outgoing connection
33960ce3f217SMatthias Ringwald 		// "If the cancellation was successful then, after the Command Complete event for the LE_Create_Connection_Cancel command,
33970ce3f217SMatthias Ringwald 		//  either an LE Connection Complete or an LE Enhanced Connection Complete event shall be generated.
33980ce3f217SMatthias Ringwald 		//  In either case, the event shall be sent with the error code Unknown Connection Identifier (0x02)."
3399f24eac89SMatthias Ringwald         bool connection_was_cancelled = false;
340060fb273dSMatthias Ringwald 		if (status == ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER){
3401f24eac89SMatthias Ringwald             connection_was_cancelled = true;
34021f468175SMatthias Ringwald 		    // reset state
34030ce3f217SMatthias Ringwald             hci_stack->le_connecting_state = LE_CONNECTING_IDLE;
34040ce3f217SMatthias Ringwald             // get outgoing connection conn struct for direct connect
3405ca0d6e5aSMatthias Ringwald             conn = gap_get_outgoing_le_connection();
34061f4510f5SMatthias Ringwald             // prepare restart if still active
34071f4510f5SMatthias Ringwald             if (hci_stack->le_connecting_request == LE_CONNECTING_DIRECT){
34089fd274a1SMatthias Ringwald                 conn->state = SEND_CREATE_CONNECTION;
34099fd274a1SMatthias Ringwald             }
34100ce3f217SMatthias Ringwald 		}
34110ce3f217SMatthias Ringwald 
3412c1281a25SMatthias Ringwald 		// free connection if cancelled by user (request == IDLE)
3413f24eac89SMatthias Ringwald         bool cancelled_by_user = hci_stack->le_connecting_request == LE_CONNECTING_IDLE;
3414f24eac89SMatthias Ringwald 		if ((conn != NULL) && cancelled_by_user){
34150ce3f217SMatthias Ringwald 			// remove entry
34160ce3f217SMatthias Ringwald 			btstack_linked_list_remove(&hci_stack->connections, (btstack_linked_item_t *) conn);
34170ce3f217SMatthias Ringwald 			btstack_memory_hci_connection_free( conn );
34180ce3f217SMatthias Ringwald 		}
34194dbe0476SMatthias Ringwald 
3420f24eac89SMatthias Ringwald         // emit GAP_SUBEVENT_LE_CONNECTION_COMPLETE for:
3421f24eac89SMatthias Ringwald         // - outgoing error not caused by connection cancel
3422f24eac89SMatthias Ringwald         // - connection cancelled by user
3423f24eac89SMatthias Ringwald         // by this, no event is emitted for intermediate connection cancel required filterlist modification
3424f24eac89SMatthias Ringwald         if ((connection_was_cancelled == false) || cancelled_by_user){
34251f4510f5SMatthias Ringwald             hci_emit_btstack_event(gap_event, sizeof(gap_event), 1);
3426f24eac89SMatthias Ringwald         }
34270ce3f217SMatthias Ringwald         return;
34280ce3f217SMatthias Ringwald 	}
34290ce3f217SMatthias Ringwald #endif
34300ce3f217SMatthias Ringwald 
34310ce3f217SMatthias Ringwald 	// on success, both hosts receive connection complete event
343260fb273dSMatthias Ringwald     if (role == HCI_ROLE_MASTER){
34330ce3f217SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
34345bb205a5SMatthias Ringwald 		// if we're master, it was an outgoing connection
34350ce3f217SMatthias Ringwald 		// note: no hci_connection_t object exists yet for connect with whitelist
34365bb205a5SMatthias Ringwald 
3437a086dc35SMatthias Ringwald         // if an identity addresses was used without enhanced connection complete event,
343858babb64SMatthias Ringwald         // the connection complete event contains the current random address of the peer device.
343958babb64SMatthias Ringwald         // This random address is needed in the case of a re-pairing
344058babb64SMatthias Ringwald         if (hci_event_le_meta_get_subevent_code(hci_event) == HCI_SUBEVENT_LE_CONNECTION_COMPLETE){
34415bb205a5SMatthias Ringwald             conn = gap_get_outgoing_le_connection();
344258babb64SMatthias Ringwald             // if outgoing connection object is available, check if identity address was used.
344358babb64SMatthias Ringwald             // if yes, track resolved random address and provide rpa
34445bb205a5SMatthias Ringwald             // note: we don't update hci le subevent connection complete
34455bb205a5SMatthias Ringwald             if (conn != NULL){
344658babb64SMatthias Ringwald                 if (hci_is_le_identity_address_type(conn->address_type)){
344758babb64SMatthias Ringwald                     memcpy(&gap_event[20], &gap_event[8], 6);
34485bb205a5SMatthias Ringwald                     gap_event[7] = conn->address_type;
34495bb205a5SMatthias Ringwald                     reverse_bd_addr(conn->address, &gap_event[8]);
34505bb205a5SMatthias Ringwald                 }
345158babb64SMatthias Ringwald             }
345258babb64SMatthias Ringwald         }
34535bb205a5SMatthias Ringwald 
34545bb205a5SMatthias Ringwald         // we're done with it
34550ce3f217SMatthias Ringwald         hci_stack->le_connecting_state   = LE_CONNECTING_IDLE;
34560ce3f217SMatthias Ringwald         hci_stack->le_connecting_request = LE_CONNECTING_IDLE;
34570ce3f217SMatthias Ringwald #endif
34580ce3f217SMatthias Ringwald 	} else {
34590ce3f217SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
34602775f8e2SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
34612775f8e2SMatthias Ringwald         if (hci_le_extended_advertising_supported()) {
3462f7043595SMatthias Ringwald             // advertisement state managed with HCI_SUBEVENT_LE_ADVERTISING_SET_TERMINATED
3463f7043595SMatthias Ringwald 
3464f7043595SMatthias Ringwald             // if advertisement set terminated event arrives before connection complete, connection struct has been prepared
3465f7043595SMatthias Ringwald             // set missing peer address + address type
3466f7043595SMatthias Ringwald             conn = hci_connection_for_handle(con_handle);
3467f7043595SMatthias Ringwald             if (conn != NULL){
3468f7043595SMatthias Ringwald                 memcpy(conn->address, addr, 6);
3469f7043595SMatthias Ringwald                 conn->address_type = addr_type;
3470f7043595SMatthias Ringwald             }
34712775f8e2SMatthias Ringwald         }
34722775f8e2SMatthias Ringwald         else
34732775f8e2SMatthias Ringwald #endif
34742775f8e2SMatthias Ringwald         {
34752775f8e2SMatthias Ringwald             // if we're slave, it was an incoming connection and advertisements have stopped
3476935aa76eSMatthias Ringwald             hci_stack->le_advertisements_state &= ~LE_ADVERTISEMENT_STATE_ACTIVE;
34772775f8e2SMatthias Ringwald         }
34780ce3f217SMatthias Ringwald #endif
34790ce3f217SMatthias Ringwald 	}
34800ce3f217SMatthias Ringwald 
34810ce3f217SMatthias Ringwald 	// LE connections are auto-accepted, so just create a connection if there isn't one already
34820ce3f217SMatthias Ringwald 	if (!conn){
348388f925b1SMatthias Ringwald 		conn = create_connection_for_bd_addr_and_type(addr, addr_type, role);
34840ce3f217SMatthias Ringwald 	}
34850ce3f217SMatthias Ringwald 
34860ce3f217SMatthias Ringwald 	// no memory, sorry.
34870ce3f217SMatthias Ringwald 	if (!conn){
34880ce3f217SMatthias Ringwald 		return;
34890ce3f217SMatthias Ringwald 	}
34900ce3f217SMatthias Ringwald 
34910ce3f217SMatthias Ringwald 	conn->state = OPEN;
3492138e942eSMatthias Ringwald 	conn->con_handle             = con_handle;
349360fb273dSMatthias Ringwald     conn->le_connection_interval = conn_interval;
34940ce3f217SMatthias Ringwald 
34954639b1e4SMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
3496ac0f6b83SMatthias Ringwald     // workaround: PAST doesn't work without LE Read Remote Features on PacketCraft Controller with LMP 568B
34974639b1e4SMatthias Ringwald     if (hci_command_supported(SUPPORTED_HCI_COMMAND_LE_READ_REMOTE_FEATURES)){
3498ac0f6b83SMatthias Ringwald         conn->gap_connection_tasks = GAP_CONNECTION_TASK_LE_READ_REMOTE_FEATURES;
34994639b1e4SMatthias Ringwald     }
35004639b1e4SMatthias Ringwald #endif
3501ac0f6b83SMatthias Ringwald 
35020ce3f217SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
350360fb273dSMatthias Ringwald     if (role == HCI_ROLE_SLAVE){
35040ce3f217SMatthias Ringwald         hci_update_advertisements_enabled_for_current_roles();
35050ce3f217SMatthias Ringwald     }
35060ce3f217SMatthias Ringwald #endif
35070ce3f217SMatthias Ringwald 
3508dde9ff1eSMatthias Ringwald     // init unenhanced att bearer mtu
3509dde9ff1eSMatthias Ringwald     conn->att_connection.mtu = ATT_DEFAULT_MTU;
3510dde9ff1eSMatthias Ringwald     conn->att_connection.mtu_exchanged = false;
3511dde9ff1eSMatthias Ringwald 
35120ce3f217SMatthias Ringwald     // TODO: store - role, peer address type, conn_interval, conn_latency, supervision timeout, master clock
35130ce3f217SMatthias Ringwald 
35140ce3f217SMatthias Ringwald 	// restart timer
35150ce3f217SMatthias Ringwald 	// btstack_run_loop_set_timer(&conn->timeout, HCI_CONNECTION_TIMEOUT_MS);
35160ce3f217SMatthias Ringwald 	// btstack_run_loop_add_timer(&conn->timeout);
35170ce3f217SMatthias Ringwald 
35180ce3f217SMatthias Ringwald 	log_info("New connection: handle %u, %s", conn->con_handle, bd_addr_to_str(conn->address));
35190ce3f217SMatthias Ringwald 
352098e0165dSMatthias Ringwald     // emit GAP_SUBEVENT_LE_CONNECTION_COMPLETE
35219da9850bSMatthias Ringwald     hci_emit_btstack_event(gap_event, sizeof(gap_event), 1);
352298e0165dSMatthias Ringwald 
352398e0165dSMatthias Ringwald     // emit BTSTACK_EVENT_NR_CONNECTIONS_CHANGED;
35240ce3f217SMatthias Ringwald 	hci_emit_nr_connections_changed();
35250ce3f217SMatthias Ringwald }
35260ce3f217SMatthias Ringwald #endif
35270ce3f217SMatthias Ringwald 
352817c6fe5cSMatthias Ringwald #ifdef ENABLE_CLASSIC
352917c6fe5cSMatthias 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){
353017c6fe5cSMatthias Ringwald     if (io_cap_local == SSP_IO_CAPABILITY_UNKNOWN) return false;
353117c6fe5cSMatthias Ringwald     // LEVEL_4 is tested by l2cap
35329a8f78c1SMatthias Ringwald     // LEVEL 3 requires MITM protection -> check io capabilities if Authenticated is possible
35339a8f78c1SMatthias Ringwald     // @see: Core Spec v5.3, Vol 3, Part C, Table 5.7
353417c6fe5cSMatthias Ringwald     if (level >= LEVEL_3){
35359a8f78c1SMatthias Ringwald         // MITM not possible without keyboard or display
353617c6fe5cSMatthias Ringwald         if (io_cap_remote >= SSP_IO_CAPABILITY_NO_INPUT_NO_OUTPUT) return false;
353717c6fe5cSMatthias Ringwald         if (io_cap_local  >= SSP_IO_CAPABILITY_NO_INPUT_NO_OUTPUT) return false;
35389a8f78c1SMatthias Ringwald 
35399a8f78c1SMatthias Ringwald         // MITM possible if one side has keyboard and the other has keyboard or display
35409a8f78c1SMatthias Ringwald         if (io_cap_remote == SSP_IO_CAPABILITY_KEYBOARD_ONLY)      return true;
35419a8f78c1SMatthias Ringwald         if (io_cap_local  == SSP_IO_CAPABILITY_KEYBOARD_ONLY)      return true;
35429a8f78c1SMatthias Ringwald 
35439a8f78c1SMatthias Ringwald         // MITM not possible if one side has only display and other side has no keyboard
35449a8f78c1SMatthias Ringwald         if (io_cap_remote == SSP_IO_CAPABILITY_DISPLAY_ONLY)       return false;
35459a8f78c1SMatthias Ringwald         if (io_cap_local  == SSP_IO_CAPABILITY_DISPLAY_ONLY)       return false;
354617c6fe5cSMatthias Ringwald     }
354717c6fe5cSMatthias Ringwald     // LEVEL 2 requires SSP, which is a given
354817c6fe5cSMatthias Ringwald     return true;
354917c6fe5cSMatthias Ringwald }
35503817f9dfSMatthias Ringwald 
3551b3c4163bSMatthias Ringwald static void hci_ssp_assess_security_on_io_cap_request(hci_connection_t * conn){
35522dd8985bSMatthias Ringwald     // get requested security level
35532dd8985bSMatthias Ringwald     gap_security_level_t requested_security_level = conn->requested_security_level;
35542dd8985bSMatthias Ringwald     if (hci_stack->gap_secure_connections_only_mode){
35552dd8985bSMatthias Ringwald         requested_security_level = LEVEL_4;
35562dd8985bSMatthias Ringwald     }
35572dd8985bSMatthias Ringwald 
3558b3c4163bSMatthias Ringwald     // assess security: LEVEL 4 requires SC
35592dd8985bSMatthias Ringwald     // skip this preliminary test if remote features are not available yet to work around potential issue in ESP32 controller
35602dd8985bSMatthias Ringwald     if ((requested_security_level == LEVEL_4) &&
35612dd8985bSMatthias Ringwald         ((conn->bonding_flags & BONDING_RECEIVED_REMOTE_FEATURES) != 0) &&
35622dd8985bSMatthias Ringwald         !hci_remote_sc_enabled(conn)){
3563b3c4163bSMatthias Ringwald         log_info("Level 4 required, but SC not supported -> abort");
3564b3c4163bSMatthias Ringwald         hci_pairing_complete(conn, ERROR_CODE_INSUFFICIENT_SECURITY);
3565b3c4163bSMatthias Ringwald         connectionSetAuthenticationFlags(conn, AUTH_FLAG_SEND_IO_CAPABILITIES_NEGATIVE_REPLY);
3566b3c4163bSMatthias Ringwald         return;
3567b3c4163bSMatthias Ringwald     }
3568b3c4163bSMatthias Ringwald 
3569c2414c00SMatthias Ringwald     // assess bonding requirements: abort if remote in dedicated bonding mode but we are non-bonding
3570c2414c00SMatthias Ringwald     // - GAP/MOD/NBON/BV-02-C
3571c2414c00SMatthias Ringwald     // - GAP/DM/NBON/BV-01-C
3572c2414c00SMatthias Ringwald     if (conn->authentication_flags & AUTH_FLAG_RECV_IO_CAPABILITIES_RESPONSE){
3573c2414c00SMatthias Ringwald         switch (conn->io_cap_response_auth_req){
3574c2414c00SMatthias Ringwald             case SSP_IO_AUTHREQ_MITM_PROTECTION_NOT_REQUIRED_DEDICATED_BONDING:
3575c2414c00SMatthias Ringwald             case SSP_IO_AUTHREQ_MITM_PROTECTION_REQUIRED_DEDICATED_BONDING:
3576c2414c00SMatthias Ringwald                 if (hci_stack->bondable == false){
3577c2414c00SMatthias Ringwald                     log_info("Dedicated vs. non-bondable -> abort");
3578c2414c00SMatthias Ringwald                     hci_pairing_complete(conn, ERROR_CODE_INSUFFICIENT_SECURITY);
3579c2414c00SMatthias Ringwald                     connectionSetAuthenticationFlags(conn, AUTH_FLAG_SEND_IO_CAPABILITIES_NEGATIVE_REPLY);
3580c2414c00SMatthias Ringwald                     return;
3581c2414c00SMatthias Ringwald                 }
3582c2414c00SMatthias Ringwald             default:
3583c2414c00SMatthias Ringwald                 break;
3584c2414c00SMatthias Ringwald         }
3585c2414c00SMatthias Ringwald     }
3586c2414c00SMatthias Ringwald 
3587b3c4163bSMatthias Ringwald     // assess security based on io capabilities
3588b3c4163bSMatthias Ringwald     if (conn->authentication_flags & AUTH_FLAG_RECV_IO_CAPABILITIES_RESPONSE){
3589b3c4163bSMatthias Ringwald         // responder: fully validate io caps of both sides as well as OOB data
3590b3c4163bSMatthias Ringwald         bool security_possible = false;
3591b3c4163bSMatthias Ringwald         security_possible = hci_ssp_security_level_possible_for_io_cap(requested_security_level, hci_stack->ssp_io_capability, conn->io_cap_response_io);
3592b3c4163bSMatthias Ringwald 
3593b3c4163bSMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB
3594b3c4163bSMatthias Ringwald         // We assume that both Controller can reach LEVEL 4, if one side has received P-192 and the other has received P-256,
3595b3c4163bSMatthias Ringwald         // so we merge the OOB data availability
3596b3c4163bSMatthias Ringwald         uint8_t have_oob_data = conn->io_cap_response_oob_data;
3597b3c4163bSMatthias Ringwald         if (conn->classic_oob_c_192 != NULL){
3598b3c4163bSMatthias Ringwald             have_oob_data |= 1;
3599b3c4163bSMatthias Ringwald         }
3600b3c4163bSMatthias Ringwald         if (conn->classic_oob_c_256 != NULL){
3601b3c4163bSMatthias Ringwald             have_oob_data |= 2;
3602b3c4163bSMatthias Ringwald         }
3603b3c4163bSMatthias Ringwald         // for up to Level 3, either P-192 as well as P-256 will do
3604b3c4163bSMatthias 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
3605b3c4163bSMatthias Ringwald         // if remote does not SC, we should not receive P-256 data either
3606b3c4163bSMatthias Ringwald         if ((requested_security_level <= LEVEL_3) && (have_oob_data != 0)){
3607b3c4163bSMatthias Ringwald             security_possible = true;
3608b3c4163bSMatthias Ringwald         }
3609b3c4163bSMatthias Ringwald         // for Level 4, P-256 is needed
3610b3c4163bSMatthias Ringwald         if ((requested_security_level == LEVEL_4 && ((have_oob_data & 2) != 0))){
3611b3c4163bSMatthias Ringwald             security_possible = true;
3612b3c4163bSMatthias Ringwald         }
3613b3c4163bSMatthias Ringwald #endif
3614b3c4163bSMatthias Ringwald 
3615b3c4163bSMatthias Ringwald         if (security_possible == false){
36162dd8985bSMatthias Ringwald             log_info("IOCap/OOB insufficient for level %u -> abort", requested_security_level);
3617b3c4163bSMatthias Ringwald             hci_pairing_complete(conn, ERROR_CODE_INSUFFICIENT_SECURITY);
3618b3c4163bSMatthias Ringwald             connectionSetAuthenticationFlags(conn, AUTH_FLAG_SEND_IO_CAPABILITIES_NEGATIVE_REPLY);
3619b3c4163bSMatthias Ringwald             return;
3620b3c4163bSMatthias Ringwald         }
3621b3c4163bSMatthias Ringwald     } else {
3622b3c4163bSMatthias Ringwald         // initiator: remote io cap not yet, only check if we have ability for MITM protection if requested and OOB is not supported
36231fe968f5SMatthias Ringwald #ifndef ENABLE_CLASSIC_PAIRING_OOB
36241fe968f5SMatthias Ringwald #ifndef ENABLE_EXPLICIT_IO_CAPABILITIES_REPLY
3625b3c4163bSMatthias Ringwald         if ((conn->requested_security_level >= LEVEL_3) && (hci_stack->ssp_io_capability >= SSP_IO_CAPABILITY_NO_INPUT_NO_OUTPUT)){
3626b3c4163bSMatthias Ringwald             log_info("Level 3+ required, but no input/output -> abort");
3627b3c4163bSMatthias Ringwald             hci_pairing_complete(conn, ERROR_CODE_INSUFFICIENT_SECURITY);
3628b3c4163bSMatthias Ringwald             connectionSetAuthenticationFlags(conn, AUTH_FLAG_SEND_IO_CAPABILITIES_NEGATIVE_REPLY);
3629b3c4163bSMatthias Ringwald             return;
3630b3c4163bSMatthias Ringwald         }
3631b3c4163bSMatthias Ringwald #endif
36321fe968f5SMatthias Ringwald #endif
3633b3c4163bSMatthias Ringwald     }
3634b3c4163bSMatthias Ringwald 
3635b3c4163bSMatthias Ringwald #ifndef ENABLE_EXPLICIT_IO_CAPABILITIES_REPLY
3636b3c4163bSMatthias Ringwald     if (hci_stack->ssp_io_capability != SSP_IO_CAPABILITY_UNKNOWN){
3637b3c4163bSMatthias Ringwald         connectionSetAuthenticationFlags(conn, AUTH_FLAG_SEND_IO_CAPABILITIES_REPLY);
3638b3c4163bSMatthias Ringwald     } else {
3639b3c4163bSMatthias Ringwald         connectionSetAuthenticationFlags(conn, AUTH_FLAG_SEND_IO_CAPABILITIES_NEGATIVE_REPLY);
3640b3c4163bSMatthias Ringwald     }
3641b3c4163bSMatthias Ringwald #endif
3642b3c4163bSMatthias Ringwald }
3643b3c4163bSMatthias Ringwald 
364417c6fe5cSMatthias Ringwald #endif
364517c6fe5cSMatthias Ringwald 
3646c3b46f5aSMatthias Ringwald static void event_handler(uint8_t *packet, uint16_t size){
36474f781026SMatthias Ringwald 
36484f781026SMatthias Ringwald     uint16_t event_length = packet[1];
36494f781026SMatthias Ringwald 
36504f781026SMatthias Ringwald     // assert packet is complete
36514ea43905SMatthias Ringwald     if (size != (event_length + 2u)){
36524f781026SMatthias Ringwald         log_error("event_handler called with packet of wrong size %d, expected %u => dropping packet", size, event_length + 2);
36534f781026SMatthias Ringwald         return;
36544f781026SMatthias Ringwald     }
36554f781026SMatthias Ringwald 
36564f781026SMatthias Ringwald     hci_con_handle_t handle;
36574f781026SMatthias Ringwald     hci_connection_t * conn;
36584f781026SMatthias Ringwald     int i;
36594f781026SMatthias Ringwald 
36604f781026SMatthias Ringwald #ifdef ENABLE_CLASSIC
36615e91d96cSMatthias Ringwald     hci_link_type_t link_type;
366248f33f37SMatthias Ringwald     bd_addr_t addr;
3663cef94710SMatthias Ringwald     bd_addr_type_t addr_type;
36644f781026SMatthias Ringwald #endif
36654ae8623eSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
36664ae8623eSMatthias Ringwald     hci_iso_stream_t * iso_stream;
36677aa35f6aSMatthias Ringwald     le_audio_big_t   * big;
36682a6c0f82SMatthias Ringwald     le_audio_big_sync_t * big_sync;
36694ae8623eSMatthias Ringwald #endif
367089254d99SMatthias Ringwald #if defined(ENABLE_LE_ISOCHRONOUS_STREAMS) || defined(ENABLE_LE_EXTENDED_ADVERTISING)
367189254d99SMatthias Ringwald     btstack_linked_list_iterator_t it;
367289254d99SMatthias Ringwald #endif
3673759e0a0dSMatthias Ringwald #if defined(ENABLE_LE_EXTENDED_ADVERTISING) && defined(ENABLE_LE_CENTRAL)
367489254d99SMatthias Ringwald     uint8_t advertising_handle;
367589254d99SMatthias Ringwald #endif
36764f781026SMatthias Ringwald 
36774f781026SMatthias Ringwald     // log_info("HCI:EVENT:%02x", hci_event_packet_get_type(packet));
36784f781026SMatthias Ringwald 
36794f781026SMatthias Ringwald     switch (hci_event_packet_get_type(packet)) {
36804f781026SMatthias Ringwald 
36814f781026SMatthias Ringwald         case HCI_EVENT_COMMAND_COMPLETE:
36824f781026SMatthias Ringwald             handle_command_complete_event(packet, size);
368356cf178bSmatthias.ringwald             break;
368456cf178bSmatthias.ringwald 
36857ec5eeaaSmatthias.ringwald         case HCI_EVENT_COMMAND_STATUS:
3686afbf1cd7SMatthias Ringwald             handle_command_status_event(packet, size);
36877ec5eeaaSmatthias.ringwald             break;
36887ec5eeaaSmatthias.ringwald 
36892e440c8aS[email protected]         case HCI_EVENT_NUMBER_OF_COMPLETED_PACKETS:{
36909784dac1SMatthias Ringwald             if (size < 3) return;
36919784dac1SMatthias Ringwald             uint16_t num_handles = packet[2];
36924ea43905SMatthias Ringwald             if (size != (3u + num_handles * 4u)) return;
3693d9a1d8edSMatthias Ringwald #ifdef ENABLE_CLASSIC
3694d9a1d8edSMatthias Ringwald             bool notify_sco = false;
3695d9a1d8edSMatthias Ringwald #endif
3696d9a1d8edSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
3697d9a1d8edSMatthias Ringwald             bool notify_iso = false;
3698d9a1d8edSMatthias Ringwald #endif
36999784dac1SMatthias Ringwald             uint16_t offset = 3;
37009784dac1SMatthias Ringwald             for (i=0; i<num_handles;i++){
37014ea43905SMatthias Ringwald                 handle = little_endian_read_16(packet, offset) & 0x0fffu;
37024ea43905SMatthias Ringwald                 offset += 2u;
3703f8fbdce0SMatthias Ringwald                 uint16_t num_packets = little_endian_read_16(packet, offset);
37044ea43905SMatthias Ringwald                 offset += 2u;
37052e440c8aS[email protected] 
37065061f3afS[email protected]                 conn = hci_connection_for_handle(handle);
3707e5413aa0SMatthias Ringwald                 if (conn != NULL) {
370823bed257S[email protected] 
3709ce41473eSMatthias Ringwald                     if (conn->num_packets_sent >= num_packets) {
3710ce41473eSMatthias Ringwald                         conn->num_packets_sent -= num_packets;
3711e35edcc1S[email protected]                     } else {
3712ce41473eSMatthias Ringwald                         log_error("hci_number_completed_packets, more packet slots freed then sent.");
3713ce41473eSMatthias Ringwald                         conn->num_packets_sent = 0;
3714e35edcc1S[email protected]                     }
3715ce41473eSMatthias Ringwald                     // log_info("hci_number_completed_packet %u processed for handle %u, outstanding %u", num_packets, handle, conn->num_packets_sent);
3716d9a1d8edSMatthias Ringwald #ifdef ENABLE_CLASSIC
3717d9a1d8edSMatthias Ringwald                     if (conn->address_type == BD_ADDR_TYPE_SCO){
3718d9a1d8edSMatthias Ringwald                         notify_sco = true;
3719d9a1d8edSMatthias Ringwald                     }
3720d9a1d8edSMatthias Ringwald #endif
3721e5413aa0SMatthias Ringwald                 }
3722e5413aa0SMatthias Ringwald 
37238ad9cf99SMatthias Ringwald #ifdef ENABLE_CONTROLLER_DUMP_PACKETS
37248ad9cf99SMatthias Ringwald                 hci_controller_dump_packets();
37258ad9cf99SMatthias Ringwald #endif
37268ad9cf99SMatthias Ringwald 
3727e5413aa0SMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
3728e5413aa0SMatthias Ringwald                 if (conn == NULL){
3729c30bd0a5SMatthias Ringwald                     iso_stream = hci_iso_stream_for_con_handle(handle);
3730e5413aa0SMatthias Ringwald                     if (iso_stream != NULL){
3731e5413aa0SMatthias Ringwald                         if (iso_stream->num_packets_sent >= num_packets) {
3732e5413aa0SMatthias Ringwald                             iso_stream->num_packets_sent -= num_packets;
3733e5413aa0SMatthias Ringwald                         } else {
3734e5413aa0SMatthias Ringwald                             log_error("hci_number_completed_packets, more packet slots freed then sent.");
3735e5413aa0SMatthias Ringwald                             iso_stream->num_packets_sent = 0;
3736e5413aa0SMatthias Ringwald                         }
37378d72db10SMatthias Ringwald                         if (iso_stream->iso_type == HCI_ISO_TYPE_BIS){
3738c30bd0a5SMatthias Ringwald                             big = hci_big_for_handle(iso_stream->group_id);
3739fe977b37SMatthias Ringwald                             if (big != NULL){
3740fe977b37SMatthias Ringwald                                 big->num_completed_timestamp_current_valid = true;
3741fe977b37SMatthias Ringwald                                 big->num_completed_timestamp_current_ms = btstack_run_loop_get_time_ms();
3742fe977b37SMatthias Ringwald                             }
3743fe977b37SMatthias Ringwald                         }
3744e5413aa0SMatthias Ringwald                         log_info("hci_number_completed_packet %u processed for handle %u, outstanding %u",
3745e5413aa0SMatthias Ringwald                                  num_packets, handle, iso_stream->num_packets_sent);
3746d9a1d8edSMatthias Ringwald                         notify_iso = true;
3747e5413aa0SMatthias Ringwald                     }
3748d9a1d8edSMatthias Ringwald                 }
3749d9a1d8edSMatthias Ringwald #endif
3750d9a1d8edSMatthias Ringwald             }
3751d9a1d8edSMatthias Ringwald 
3752d9a1d8edSMatthias Ringwald #ifdef ENABLE_CLASSIC
3753d9a1d8edSMatthias Ringwald             if (notify_sco){
3754d9a1d8edSMatthias Ringwald                 hci_notify_if_sco_can_send_now();
3755d9a1d8edSMatthias Ringwald             }
3756d9a1d8edSMatthias Ringwald #endif
3757d9a1d8edSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
3758d9a1d8edSMatthias Ringwald             if (notify_iso){
37595ade6657SMatthias Ringwald                 hci_iso_notify_can_send_now();
3760e5413aa0SMatthias Ringwald             }
3761e5413aa0SMatthias Ringwald #endif
37626772a24cSmatthias.ringwald             break;
37632e440c8aS[email protected]         }
376435454696SMatthias Ringwald 
376535454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
37669afaa4d4SMatthias Ringwald         case HCI_EVENT_FLUSH_OCCURRED:
37679afaa4d4SMatthias Ringwald             // flush occurs only if automatic flush has been enabled by gap_enable_link_watchdog()
37689afaa4d4SMatthias Ringwald             handle = hci_event_flush_occurred_get_handle(packet);
37699afaa4d4SMatthias Ringwald             conn = hci_connection_for_handle(handle);
37709afaa4d4SMatthias Ringwald             if (conn) {
37719afaa4d4SMatthias Ringwald                 log_info("Flush occurred, disconnect 0x%04x", handle);
37729afaa4d4SMatthias Ringwald                 conn->state = SEND_DISCONNECT;
37739afaa4d4SMatthias Ringwald             }
37749afaa4d4SMatthias Ringwald             break;
37759afaa4d4SMatthias Ringwald 
3776f5875de5SMatthias Ringwald         case HCI_EVENT_INQUIRY_COMPLETE:
3777f5875de5SMatthias Ringwald             if (hci_stack->inquiry_state == GAP_INQUIRY_STATE_ACTIVE){
3778f5875de5SMatthias Ringwald                 hci_stack->inquiry_state = GAP_INQUIRY_STATE_IDLE;
3779f5875de5SMatthias Ringwald                 uint8_t event[] = { GAP_EVENT_INQUIRY_COMPLETE, 1, 0};
37809da9850bSMatthias Ringwald                 hci_emit_btstack_event(event, sizeof(event), 1);
3781f5875de5SMatthias Ringwald             }
3782f5875de5SMatthias Ringwald             break;
3783b7f1ee76SMatthias Ringwald         case HCI_EVENT_REMOTE_NAME_REQUEST_COMPLETE:
3784b7f1ee76SMatthias Ringwald             if (hci_stack->remote_name_state == GAP_REMOTE_NAME_STATE_W4_COMPLETE){
3785b7f1ee76SMatthias Ringwald                 hci_stack->remote_name_state = GAP_REMOTE_NAME_STATE_IDLE;
3786b7f1ee76SMatthias Ringwald             }
3787b7f1ee76SMatthias Ringwald             break;
37881f7b95a1Smatthias.ringwald         case HCI_EVENT_CONNECTION_REQUEST:
3789724d70a2SMatthias Ringwald             reverse_bd_addr(&packet[2], addr);
37905e91d96cSMatthias Ringwald             link_type = (hci_link_type_t) packet[11];
379172cf8859SMatthias Ringwald 
379272cf8859SMatthias Ringwald             // CVE-2020-26555: reject incoming connection from device with same BD ADDR
379372cf8859SMatthias Ringwald             if (memcmp(hci_stack->local_bd_addr, addr, 6) == 0){
379472cf8859SMatthias Ringwald                 hci_stack->decline_reason = ERROR_CODE_CONNECTION_REJECTED_DUE_TO_UNACCEPTABLE_BD_ADDR;
379572cf8859SMatthias Ringwald                 bd_addr_copy(hci_stack->decline_addr, addr);
379672cf8859SMatthias Ringwald                 break;
379772cf8859SMatthias Ringwald             }
379872cf8859SMatthias Ringwald 
379907e010b6SMilanka Ringwald             if (hci_stack->gap_classic_accept_callback != NULL){
38005e91d96cSMatthias Ringwald                 if ((*hci_stack->gap_classic_accept_callback)(addr, link_type) == 0){
3801d152b6c6SMatthias Ringwald                     hci_stack->decline_reason = ERROR_CODE_CONNECTION_REJECTED_DUE_TO_SECURITY_REASONS;
380207e010b6SMilanka Ringwald                     bd_addr_copy(hci_stack->decline_addr, addr);
380307e010b6SMilanka Ringwald                     break;
380407e010b6SMilanka Ringwald                 }
380507e010b6SMilanka Ringwald             }
380607e010b6SMilanka Ringwald 
380737eaa4cfSmatthias.ringwald             // TODO: eval COD 8-10
38085e91d96cSMatthias Ringwald             log_info("Connection_incoming: %s, type %u", bd_addr_to_str(addr), (unsigned int) link_type);
38095e91d96cSMatthias Ringwald             addr_type = (link_type == HCI_LINK_TYPE_ACL) ? BD_ADDR_TYPE_ACL : BD_ADDR_TYPE_SCO;
38102e77e513S[email protected]             conn = hci_connection_for_bd_addr_and_type(addr, addr_type);
38111f7b95a1Smatthias.ringwald             if (!conn) {
381288f925b1SMatthias Ringwald                 conn = create_connection_for_bd_addr_and_type(addr, addr_type, HCI_ROLE_SLAVE);
38131f7b95a1Smatthias.ringwald             }
3814ce4c8fabSmatthias.ringwald             if (!conn) {
3815ce4c8fabSmatthias.ringwald                 // CONNECTION REJECTED DUE TO LIMITED RESOURCES (0X0D)
38164536712cSMilanka Ringwald                 hci_stack->decline_reason = ERROR_CODE_CONNECTION_REJECTED_DUE_TO_LIMITED_RESOURCES;
3817058e3d6bSMatthias Ringwald                 bd_addr_copy(hci_stack->decline_addr, addr);
3818f23819bcSMatthias Ringwald                 hci_run();
3819f23819bcSMatthias Ringwald                 // avoid event to higher layer
3820f23819bcSMatthias Ringwald                 return;
3821ce4c8fabSmatthias.ringwald             }
382232ab9390Smatthias.ringwald             conn->state = RECEIVED_CONNECTION_REQUEST;
3823f3a16b9aSMatthias Ringwald             // store info about eSCO
38245e91d96cSMatthias Ringwald             if (link_type == HCI_LINK_TYPE_ESCO){
382576ccfb2aSMatthias Ringwald                 conn->remote_supported_features[0] |= 1;
3826f3a16b9aSMatthias Ringwald             }
3827d7891039SMatthias Ringwald             // propagate remote supported sco packet packets from existing ACL to new SCO connection
3828d7891039SMatthias Ringwald             if (addr_type == BD_ADDR_TYPE_SCO){
3829182d886dSMatthias Ringwald                 const hci_connection_t * acl_conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL);
3830182d886dSMatthias Ringwald                 // ACL exists unless fuzzing
3831182d886dSMatthias Ringwald                 if (acl_conn != NULL) {
3832d7891039SMatthias Ringwald                     conn->remote_supported_sco_packets = acl_conn->remote_supported_sco_packets;
3833d7891039SMatthias Ringwald                 }
3834182d886dSMatthias Ringwald             }
383532ab9390Smatthias.ringwald             hci_run();
38361f7b95a1Smatthias.ringwald             break;
38371f7b95a1Smatthias.ringwald 
38386772a24cSmatthias.ringwald         case HCI_EVENT_CONNECTION_COMPLETE:
3839fe1ed1b8Smatthias.ringwald             // Connection management
3840724d70a2SMatthias Ringwald             reverse_bd_addr(&packet[5], addr);
38419da54300S[email protected]             log_info("Connection_complete (status=%u) %s", packet[2], bd_addr_to_str(addr));
3842f16129ceSMatthias Ringwald             addr_type = BD_ADDR_TYPE_ACL;
38432e77e513S[email protected]             conn = hci_connection_for_bd_addr_and_type(addr, addr_type);
3844fe1ed1b8Smatthias.ringwald             if (conn) {
3845893b4ccdSMatthias Ringwald                 switch (conn->state){
3846893b4ccdSMatthias Ringwald                     // expected states
3847893b4ccdSMatthias Ringwald                     case ACCEPTED_CONNECTION_REQUEST:
3848893b4ccdSMatthias Ringwald                     case SENT_CREATE_CONNECTION:
3849893b4ccdSMatthias Ringwald                         break;
3850893b4ccdSMatthias Ringwald                     // unexpected state -> ignore
3851893b4ccdSMatthias Ringwald                     default:
3852893b4ccdSMatthias Ringwald                         // don't forward event to app
3853893b4ccdSMatthias Ringwald                         return;
3854893b4ccdSMatthias Ringwald                 }
3855b448a0e7Smatthias.ringwald                 if (!packet[2]){
3856c8e4258aSmatthias.ringwald                     conn->state = OPEN;
3857f8fbdce0SMatthias Ringwald                     conn->con_handle = little_endian_read_16(packet, 3);
38586909f064SMatthias Ringwald 
385922df2fe2SMatthias Ringwald                     // trigger write supervision timeout if we're master
3860d821984bSMatthias Ringwald                     if ((hci_stack->link_supervision_timeout != HCI_LINK_SUPERVISION_TIMEOUT_DEFAULT) && (conn->role == HCI_ROLE_MASTER)){
386122df2fe2SMatthias Ringwald                         conn->gap_connection_tasks |= GAP_CONNECTION_TASK_WRITE_SUPERVISION_TIMEOUT;
38626909f064SMatthias Ringwald                     }
38636909f064SMatthias Ringwald 
386422df2fe2SMatthias Ringwald                     // trigger write automatic flush timeout
38659afaa4d4SMatthias Ringwald                     if (hci_stack->automatic_flush_timeout != 0){
38669afaa4d4SMatthias Ringwald                         conn->gap_connection_tasks |= GAP_CONNECTION_TASK_WRITE_AUTOMATIC_FLUSH_TIMEOUT;
38679afaa4d4SMatthias Ringwald                     }
38689afaa4d4SMatthias Ringwald 
3869c785ef68Smatthias.ringwald                     // restart timer
3870528a4a3bSMatthias Ringwald                     btstack_run_loop_set_timer(&conn->timeout, HCI_CONNECTION_TIMEOUT_MS);
3871528a4a3bSMatthias Ringwald                     btstack_run_loop_add_timer(&conn->timeout);
3872c785ef68Smatthias.ringwald 
387318c4a0a3SMatthias Ringwald                     // trigger remote features for dedicated bonding
387418c4a0a3SMatthias Ringwald                     if ((conn->bonding_flags & BONDING_DEDICATED) != 0){
387518c4a0a3SMatthias Ringwald                         hci_trigger_remote_features_for_connection(conn);
387618c4a0a3SMatthias Ringwald                     }
387718c4a0a3SMatthias Ringwald 
38789da54300S[email protected]                     log_info("New connection: handle %u, %s", conn->con_handle, bd_addr_to_str(conn->address));
387943bfb1bdSmatthias.ringwald 
388043bfb1bdSmatthias.ringwald                     hci_emit_nr_connections_changed();
3881b448a0e7Smatthias.ringwald                 } else {
38820bbba85bSMatthias Ringwald                     // connection failed
38830bbba85bSMatthias Ringwald                     hci_handle_connection_failed(conn, packet[2]);
3884fe1ed1b8Smatthias.ringwald                 }
3885fe1ed1b8Smatthias.ringwald             }
38866772a24cSmatthias.ringwald             break;
3887fe1ed1b8Smatthias.ringwald 
388844d0e3d5S[email protected]         case HCI_EVENT_SYNCHRONOUS_CONNECTION_COMPLETE:
3889724d70a2SMatthias Ringwald             reverse_bd_addr(&packet[5], addr);
38901f34df2cSMatthias Ringwald             conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_SCO);
38911f34df2cSMatthias Ringwald             log_info("Synchronous Connection Complete for %p (status=%u) %s", conn, packet[2], bd_addr_to_str(addr));
3892182d886dSMatthias Ringwald 
3893182d886dSMatthias Ringwald             // SCO exists unless fuzzer
3894182d886dSMatthias Ringwald             if (conn == NULL) break;
38959071873aSMatthias Ringwald 
38969071873aSMatthias Ringwald             if (packet[2] != ERROR_CODE_SUCCESS){
38979071873aSMatthias Ringwald                 // connection failed, remove entry
38981f34df2cSMatthias Ringwald                 hci_handle_connection_failed(conn, packet[2]);
389944d0e3d5S[email protected]                 break;
390044d0e3d5S[email protected]             }
39019071873aSMatthias Ringwald 
39021a06f663S[email protected]             conn->state = OPEN;
3903f8fbdce0SMatthias Ringwald             conn->con_handle = little_endian_read_16(packet, 3);
3904ee752bb8SMatthias Ringwald 
3905d7891039SMatthias Ringwald             // update sco payload length for eSCO connections
3906d7891039SMatthias Ringwald             if (hci_event_synchronous_connection_complete_get_tx_packet_length(packet) > 0){
3907d7891039SMatthias Ringwald                 conn->sco_payload_length = hci_event_synchronous_connection_complete_get_tx_packet_length(packet);
3908d7891039SMatthias Ringwald                 log_info("eSCO Complete, set payload len %u", conn->sco_payload_length);
3909d7891039SMatthias Ringwald             }
3910d7891039SMatthias Ringwald 
3911ee752bb8SMatthias Ringwald #ifdef ENABLE_SCO_OVER_HCI
3912ee752bb8SMatthias Ringwald             // update SCO
3913ee752bb8SMatthias Ringwald             if (conn->address_type == BD_ADDR_TYPE_SCO && hci_stack->hci_transport && hci_stack->hci_transport->set_sco_config){
3914ee752bb8SMatthias Ringwald                 hci_stack->hci_transport->set_sco_config(hci_stack->sco_voice_setting_active, hci_number_sco_connections());
3915ee752bb8SMatthias Ringwald             }
3916f234b250SMatthias Ringwald             // trigger can send now
3917f234b250SMatthias Ringwald             if (hci_have_usb_transport()){
39181972f31fSMatthias Ringwald                 hci_stack->sco_can_send_now = true;
3919f234b250SMatthias Ringwald             }
3920fa7f2dfdSMatthias Ringwald 
3921a086dc35SMatthias Ringwald             // setup implicit sco flow control
3922fa7f2dfdSMatthias Ringwald             conn->sco_tx_ready = 0;
3923fa7f2dfdSMatthias Ringwald             conn->sco_tx_active  = 0;
3924fa7f2dfdSMatthias Ringwald             conn->sco_established_ms = btstack_run_loop_get_time_ms();
3925fa7f2dfdSMatthias Ringwald 
3926ee752bb8SMatthias Ringwald #endif
3927cb70c5abSMatthias Ringwald #ifdef HAVE_SCO_TRANSPORT
3928cb70c5abSMatthias Ringwald             // configure sco transport
3929cb70c5abSMatthias Ringwald             if (hci_stack->sco_transport != NULL){
3930cb70c5abSMatthias Ringwald                 sco_format_t sco_format = ((hci_stack->sco_voice_setting_active & 0x03) == 0x03) ? SCO_FORMAT_8_BIT : SCO_FORMAT_16_BIT;
3931cb70c5abSMatthias Ringwald                 hci_stack->sco_transport->open(conn->con_handle, sco_format);
3932cb70c5abSMatthias Ringwald             }
3933cb70c5abSMatthias Ringwald #endif
393444d0e3d5S[email protected]             break;
393544d0e3d5S[email protected] 
3936afd4e962S[email protected]         case HCI_EVENT_READ_REMOTE_SUPPORTED_FEATURES_COMPLETE:
3937f8fbdce0SMatthias Ringwald             handle = little_endian_read_16(packet, 3);
3938afd4e962S[email protected]             conn = hci_connection_for_handle(handle);
3939afd4e962S[email protected]             if (!conn) break;
3940afd4e962S[email protected]             if (!packet[2]){
39412f5c44baSMatthias Ringwald                 const uint8_t * features = &packet[5];
39422f5c44baSMatthias Ringwald                 hci_handle_remote_features_page_0(conn, features);
39432f5c44baSMatthias Ringwald 
39445ccef624SMatthias Ringwald                 // read extended features if possible
39451ffa425cSMatthias Ringwald                 if (hci_command_supported(SUPPORTED_HCI_COMMAND_READ_REMOTE_EXTENDED_FEATURES)
39461ffa425cSMatthias Ringwald                 && ((conn->remote_supported_features[0] & 2) != 0)) {
39475ccef624SMatthias Ringwald                     conn->bonding_flags |= BONDING_REQUEST_REMOTE_FEATURES_PAGE_1;
39485ccef624SMatthias Ringwald                     break;
39495ccef624SMatthias Ringwald                 }
39505ccef624SMatthias Ringwald             }
39515ccef624SMatthias Ringwald             hci_handle_remote_features_received(conn);
39525ccef624SMatthias Ringwald             break;
39535ccef624SMatthias Ringwald 
39545ccef624SMatthias Ringwald         case HCI_EVENT_READ_REMOTE_EXTENDED_FEATURES_COMPLETE:
39555ccef624SMatthias Ringwald             handle = little_endian_read_16(packet, 3);
39565ccef624SMatthias Ringwald             conn = hci_connection_for_handle(handle);
39575ccef624SMatthias Ringwald             if (!conn) break;
39585ccef624SMatthias Ringwald             // status = ok, page = 1
395950c51a77SMatthias Ringwald             if (!packet[2]) {
396050c51a77SMatthias Ringwald                 uint8_t page_number = packet[5];
396150c51a77SMatthias Ringwald                 uint8_t maximum_page_number = packet[6];
39625ccef624SMatthias Ringwald                 const uint8_t * features = &packet[7];
396350c51a77SMatthias Ringwald                 bool done = false;
396450c51a77SMatthias Ringwald                 switch (page_number){
396550c51a77SMatthias Ringwald                     case 1:
39662f5c44baSMatthias Ringwald                         hci_handle_remote_features_page_1(conn, features);
396750c51a77SMatthias Ringwald                         if (maximum_page_number >= 2){
396850c51a77SMatthias Ringwald                             // get Secure Connections (Controller) from Page 2 if available
396950c51a77SMatthias Ringwald                             conn->bonding_flags |= BONDING_REQUEST_REMOTE_FEATURES_PAGE_2;
397050c51a77SMatthias Ringwald                         } else {
397150c51a77SMatthias Ringwald                             // otherwise, assume SC (Controller) == SC (Host)
397250c51a77SMatthias Ringwald                             if ((conn->bonding_flags & BONDING_REMOTE_SUPPORTS_SC_HOST) != 0){
397350c51a77SMatthias Ringwald                                 conn->bonding_flags |= BONDING_REMOTE_SUPPORTS_SC_CONTROLLER;
397450c51a77SMatthias Ringwald                             }
397550c51a77SMatthias Ringwald                             done = true;
397650c51a77SMatthias Ringwald                         }
397750c51a77SMatthias Ringwald                         break;
397850c51a77SMatthias Ringwald                     case 2:
397950c51a77SMatthias Ringwald                         hci_handle_remote_features_page_2(conn, features);
398050c51a77SMatthias Ringwald                         done = true;
398150c51a77SMatthias Ringwald                         break;
398250c51a77SMatthias Ringwald                     default:
398350c51a77SMatthias Ringwald                         break;
398450c51a77SMatthias Ringwald                 }
398550c51a77SMatthias Ringwald                 if (!done) break;
3986afd4e962S[email protected]             }
3987de0df013SMatthias Ringwald             hci_handle_remote_features_received(conn);
3988afd4e962S[email protected]             break;
3989afd4e962S[email protected] 
39907fde4af9Smatthias.ringwald         case HCI_EVENT_LINK_KEY_REQUEST:
3991308eeaffSMatthias Ringwald #ifndef ENABLE_EXPLICIT_LINK_KEY_REPLY
399263c0b2fdSMatthias Ringwald             hci_event_link_key_request_get_bd_addr(packet, addr);
399363c0b2fdSMatthias Ringwald             conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL);
399463c0b2fdSMatthias Ringwald             if (!conn) break;
399563c0b2fdSMatthias Ringwald 
399663c0b2fdSMatthias Ringwald             // lookup link key in db if not cached
399763c0b2fdSMatthias Ringwald             if ((conn->link_key_type == INVALID_LINK_KEY) && (hci_stack->link_key_db != NULL)){
399863c0b2fdSMatthias Ringwald                 hci_stack->link_key_db->get_link_key(conn->address, conn->link_key, &conn->link_key_type);
399963c0b2fdSMatthias Ringwald             }
400063c0b2fdSMatthias Ringwald 
400163c0b2fdSMatthias Ringwald             // response sent by hci_run()
400263c0b2fdSMatthias Ringwald             conn->authentication_flags |= AUTH_FLAG_HANDLE_LINK_KEY_REQUEST;
400363c0b2fdSMatthias Ringwald #endif
4004608f51bbSMatthias Ringwald             break;
40057fde4af9Smatthias.ringwald 
40069ab95c90S[email protected]         case HCI_EVENT_LINK_KEY_NOTIFICATION: {
40071714cbbdSMatthias Ringwald             hci_event_link_key_request_get_bd_addr(packet, addr);
4008f16129ceSMatthias Ringwald             conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL);
40099ab95c90S[email protected]             if (!conn) break;
40101714cbbdSMatthias Ringwald 
40111714cbbdSMatthias Ringwald             hci_pairing_complete(conn, ERROR_CODE_SUCCESS);
40121714cbbdSMatthias Ringwald 
40133817f9dfSMatthias Ringwald             // CVE-2020-26555: ignore NULL link key
40143817f9dfSMatthias Ringwald             // default link_key_type = INVALID_LINK_KEY asserts that NULL key won't be used for encryption
40153817f9dfSMatthias Ringwald             if (btstack_is_null(&packet[8], 16)) break;
40163817f9dfSMatthias Ringwald 
40177bdc6798S[email protected]             link_key_type_t link_key_type = (link_key_type_t)packet[24];
40189ab95c90S[email protected]             // Change Connection Encryption keeps link key type
40199ab95c90S[email protected]             if (link_key_type != CHANGED_COMBINATION_KEY){
40209ab95c90S[email protected]                 conn->link_key_type = link_key_type;
40219ab95c90S[email protected]             }
40223817f9dfSMatthias Ringwald 
4023e9f98c4aSMatthias Ringwald             // cache link key. link keys stored in little-endian format for legacy reasons
4024e9f98c4aSMatthias Ringwald             memcpy(&conn->link_key, &packet[8], 16);
4025e9f98c4aSMatthias Ringwald 
4026bec5f683SMatthias Ringwald             // only store link key:
4027bec5f683SMatthias Ringwald             // - if bondable enabled
4028bec5f683SMatthias Ringwald             if (hci_stack->bondable == false) break;
4029af411b3fSMatthias Ringwald             // - if at least one side requests bonding during the IO Capabilities exchange.
4030af411b3fSMatthias Ringwald             // Note: we drop bonding flag in acceptor role if remote doesn't request it
4031af411b3fSMatthias Ringwald             bool bonding_local  = conn->io_cap_request_auth_req  >= SSP_IO_AUTHREQ_MITM_PROTECTION_NOT_REQUIRED_DEDICATED_BONDING;
4032af411b3fSMatthias Ringwald             bool bonding_remote = conn->io_cap_response_auth_req >= SSP_IO_AUTHREQ_MITM_PROTECTION_NOT_REQUIRED_DEDICATED_BONDING;
4033af411b3fSMatthias Ringwald             if ((bonding_local == false) && (bonding_remote == false)) break;
40346edaed7fSMatthias Ringwald             // - if security level sufficient
40356edaed7fSMatthias Ringwald             if (gap_security_level_for_link_key_type(link_key_type) < conn->requested_security_level) break;
403655597469SMatthias Ringwald             gap_store_link_key_for_bd_addr(addr, &packet[8], conn->link_key_type);
40377fde4af9Smatthias.ringwald             break;
40389ab95c90S[email protected]         }
40397fde4af9Smatthias.ringwald 
40407fde4af9Smatthias.ringwald         case HCI_EVENT_PIN_CODE_REQUEST:
40411714cbbdSMatthias Ringwald             hci_event_pin_code_request_get_bd_addr(packet, addr);
40421714cbbdSMatthias Ringwald             conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL);
40431714cbbdSMatthias Ringwald             if (!conn) break;
40441714cbbdSMatthias Ringwald 
40451714cbbdSMatthias Ringwald             hci_pairing_started(conn, false);
4046a800d95eSMatthias Ringwald             // abort pairing if: non-bondable mode (pin code request is not forwarded to app)
40473a9fb326S[email protected]             if (!hci_stack->bondable ){
40488daf94bcSMatthias Ringwald                 conn->authentication_flags |= AUTH_FLAG_DENY_PIN_CODE_REQUEST;
40491714cbbdSMatthias Ringwald                 hci_pairing_complete(conn, ERROR_CODE_PAIRING_NOT_ALLOWED);
4050f8fb5f6eS[email protected]                 hci_run();
4051f8fb5f6eS[email protected]                 return;
40524c57c146S[email protected]             }
4053a800d95eSMatthias Ringwald             // abort pairing if: LEVEL_4 required (pin code request is not forwarded to app)
4054a800d95eSMatthias Ringwald             if ((hci_stack->gap_secure_connections_only_mode) || (conn->requested_security_level == LEVEL_4)){
4055a800d95eSMatthias Ringwald                 log_info("Level 4 required, but SC not supported -> abort");
405650dcc63cSMatthias Ringwald                 conn->authentication_flags |= AUTH_FLAG_DENY_PIN_CODE_REQUEST;
405750dcc63cSMatthias Ringwald                 hci_pairing_complete(conn, ERROR_CODE_INSUFFICIENT_SECURITY);
405850dcc63cSMatthias Ringwald                 hci_run();
405950dcc63cSMatthias Ringwald                 return;
406050dcc63cSMatthias Ringwald             }
40617fde4af9Smatthias.ringwald             break;
40627fde4af9Smatthias.ringwald 
406350d7398cSMatthias Ringwald         case HCI_EVENT_IO_CAPABILITY_RESPONSE:
406450d7398cSMatthias Ringwald             hci_event_io_capability_response_get_bd_addr(packet, addr);
406550d7398cSMatthias Ringwald             conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL);
406650d7398cSMatthias Ringwald             if (!conn) break;
40671714cbbdSMatthias Ringwald 
40688daf94bcSMatthias Ringwald             hci_add_connection_flags_for_flipped_bd_addr(&packet[2], AUTH_FLAG_RECV_IO_CAPABILITIES_RESPONSE);
40691714cbbdSMatthias Ringwald             hci_pairing_started(conn, true);
407050d7398cSMatthias Ringwald             conn->io_cap_response_auth_req = hci_event_io_capability_response_get_authentication_requirements(packet);
4071e276e383SMatthias Ringwald             conn->io_cap_response_io       = hci_event_io_capability_response_get_io_capability(packet);
4072d22b82d6SMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB
4073d22b82d6SMatthias Ringwald             conn->io_cap_response_oob_data = hci_event_io_capability_response_get_oob_data_present(packet);
4074d22b82d6SMatthias Ringwald #endif
407550d7398cSMatthias Ringwald             break;
407650d7398cSMatthias Ringwald 
40771d6b20aeS[email protected]         case HCI_EVENT_IO_CAPABILITY_REQUEST:
40781714cbbdSMatthias Ringwald             hci_event_io_capability_response_get_bd_addr(packet, addr);
40791714cbbdSMatthias Ringwald             conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL);
40801714cbbdSMatthias Ringwald             if (!conn) break;
40811714cbbdSMatthias Ringwald 
4082c950c316SMatthias Ringwald             hci_add_connection_flags_for_flipped_bd_addr(&packet[2], AUTH_FLAG_RECV_IO_CAPABILITIES_REQUEST);
40839671e615SMatthias Ringwald             hci_connection_timestamp(conn);
40841714cbbdSMatthias Ringwald             hci_pairing_started(conn, true);
4085dbe1a790S[email protected]             break;
4086dbe1a790S[email protected] 
40871849becdSMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB
40881849becdSMatthias Ringwald         case HCI_EVENT_REMOTE_OOB_DATA_REQUEST:
40897ca4a7edSMatthias Ringwald             hci_event_remote_oob_data_request_get_bd_addr(packet, addr);
40907ca4a7edSMatthias Ringwald             conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL);
40917ca4a7edSMatthias Ringwald             if (!conn) break;
40927ca4a7edSMatthias Ringwald 
40937ca4a7edSMatthias Ringwald             hci_connection_timestamp(conn);
40947ca4a7edSMatthias Ringwald 
40957ca4a7edSMatthias Ringwald             hci_pairing_started(conn, true);
40967ca4a7edSMatthias Ringwald 
40977ca4a7edSMatthias Ringwald             connectionSetAuthenticationFlags(conn, AUTH_FLAG_SEND_REMOTE_OOB_DATA_REPLY);
40981849becdSMatthias Ringwald             break;
40991849becdSMatthias Ringwald #endif
41001849becdSMatthias Ringwald 
4101dbe1a790S[email protected]         case HCI_EVENT_USER_CONFIRMATION_REQUEST:
410217c6fe5cSMatthias Ringwald             hci_event_user_confirmation_request_get_bd_addr(packet, addr);
4103367aedc0SMatthias Ringwald             conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL);
4104367aedc0SMatthias Ringwald             if (!conn) break;
4105367aedc0SMatthias Ringwald             if (hci_ssp_security_level_possible_for_io_cap(conn->requested_security_level, hci_stack->ssp_io_capability, conn->io_cap_response_io)) {
4106367aedc0SMatthias Ringwald                 if (hci_stack->ssp_auto_accept){
41078daf94bcSMatthias Ringwald                     hci_add_connection_flags_for_flipped_bd_addr(&packet[2], AUTH_FLAG_SEND_USER_CONFIRM_REPLY);
4108367aedc0SMatthias Ringwald                 };
4109367aedc0SMatthias Ringwald             } else {
4110367aedc0SMatthias Ringwald                 hci_pairing_complete(conn, ERROR_CODE_INSUFFICIENT_SECURITY);
4111367aedc0SMatthias Ringwald                 hci_add_connection_flags_for_flipped_bd_addr(&packet[2], AUTH_FLAG_SEND_USER_CONFIRM_NEGATIVE_REPLY);
4112367aedc0SMatthias Ringwald                 // don't forward event to app
4113367aedc0SMatthias Ringwald                 hci_run();
4114367aedc0SMatthias Ringwald                 return;
4115367aedc0SMatthias Ringwald             }
4116dbe1a790S[email protected]             break;
4117dbe1a790S[email protected] 
4118dbe1a790S[email protected]         case HCI_EVENT_USER_PASSKEY_REQUEST:
4119367aedc0SMatthias Ringwald             // Pairing using Passkey results in MITM protection. If Level 4 is required, support for SC is validated on IO Cap Request
4120367aedc0SMatthias Ringwald             if (hci_stack->ssp_auto_accept){
41218daf94bcSMatthias Ringwald                 hci_add_connection_flags_for_flipped_bd_addr(&packet[2], AUTH_FLAG_SEND_USER_PASSKEY_REPLY);
4122367aedc0SMatthias Ringwald             };
41231d6b20aeS[email protected]             break;
41241849becdSMatthias Ringwald 
41253dce6128SMatthias Ringwald         case HCI_EVENT_MODE_CHANGE:
41263dce6128SMatthias Ringwald             handle = hci_event_mode_change_get_handle(packet);
41273dce6128SMatthias Ringwald             conn = hci_connection_for_handle(handle);
41283dce6128SMatthias Ringwald             if (!conn) break;
41293dce6128SMatthias Ringwald             conn->connection_mode = hci_event_mode_change_get_mode(packet);
41303dce6128SMatthias Ringwald             log_info("HCI_EVENT_MODE_CHANGE, handle 0x%04x, mode %u", handle, conn->connection_mode);
41313dce6128SMatthias Ringwald             break;
413235454696SMatthias Ringwald #endif
41331d6b20aeS[email protected] 
4134f0944df2S[email protected]         case HCI_EVENT_ENCRYPTION_CHANGE:
4135a355334eSMatthias Ringwald         case HCI_EVENT_ENCRYPTION_CHANGE_V2:
4136254b78eeSMatthias Ringwald             handle = hci_event_encryption_change_get_connection_handle(packet);
4137f0944df2S[email protected]             conn = hci_connection_for_handle(handle);
4138f0944df2S[email protected]             if (!conn) break;
4139db3c1f89SMatthias Ringwald             if (hci_event_encryption_change_get_status(packet) == ERROR_CODE_SUCCESS) {
4140254b78eeSMatthias Ringwald                 uint8_t encryption_enabled = hci_event_encryption_change_get_encryption_enabled(packet);
4141254b78eeSMatthias Ringwald                 if (encryption_enabled){
4142573897a0SMatthias Ringwald                     if (hci_is_le_connection(conn)){
4143573897a0SMatthias Ringwald                         // For LE, we accept connection as encrypted
41448daf94bcSMatthias Ringwald                         conn->authentication_flags |= AUTH_FLAG_CONNECTION_ENCRYPTED;
4145573897a0SMatthias Ringwald                     }
4146573897a0SMatthias Ringwald #ifdef ENABLE_CLASSIC
4147573897a0SMatthias Ringwald                     else {
4148fcaf38b9SMatthias Ringwald 
4149254b78eeSMatthias Ringwald                         // Detect Secure Connection -> Legacy Connection Downgrade Attack (BIAS)
415036c3546bSMatthias Ringwald                         bool sc_used_during_pairing = gap_secure_connection_for_link_key_type(conn->link_key_type);
4151254b78eeSMatthias Ringwald                         bool connected_uses_aes_ccm = encryption_enabled == 2;
4152edc1ac20SMatthias Ringwald                         if (hci_stack->secure_connections_active && sc_used_during_pairing && !connected_uses_aes_ccm){
4153813a09c6SMatthias Ringwald #ifdef ENABLE_TESTING_SUPPORT
4154813a09c6SMatthias Ringwald                             // The following tests require to reject L2CAP connection as SC has been disabled on the remote
4155813a09c6SMatthias Ringwald                             // - GAP/SEC/SEM/BI-31-C
4156813a09c6SMatthias Ringwald                             // - GAP/SEC/SEM/BI-32-C
4157813a09c6SMatthias Ringwald                             // - GAP/SEC/SEM/BI-33-C
4158813a09c6SMatthias Ringwald 
4159813a09c6SMatthias Ringwald                             // Our release code (aggressively) disconnects the HCI connection, without a chance to respond to PTS
4160813a09c6SMatthias Ringwald                             // To pass the tests, we only downgrade the link key type instead of the more secure disconnect
416129d4766dSMatthias Ringwald                             link_key_type_t new_link_key_type = UNAUTHENTICATED_COMBINATION_KEY_GENERATED_FROM_P192;
416229d4766dSMatthias Ringwald                             if (conn->link_key_type == AUTHENTICATED_COMBINATION_KEY_GENERATED_FROM_P256){
4163813a09c6SMatthias Ringwald                                 new_link_key_type = AUTHENTICATED_COMBINATION_KEY_GENERATED_FROM_P192;
4164813a09c6SMatthias Ringwald                             }
4165813a09c6SMatthias Ringwald                             log_info("SC during pairing, but only E0 now -> downgrade link key type from %u to %u",
4166813a09c6SMatthias Ringwald                                      conn->link_key_type, new_link_key_type);
4167813a09c6SMatthias Ringwald                             conn->link_key_type = new_link_key_type;
4168813a09c6SMatthias Ringwald #else
4169254b78eeSMatthias Ringwald                             log_info("SC during pairing, but only E0 now -> abort");
41709ece71c2SMatthias Ringwald                             conn->bonding_flags |= BONDING_DISCONNECT_SECURITY_BLOCK;
4171254b78eeSMatthias Ringwald                             break;
4172813a09c6SMatthias Ringwald #endif
4173254b78eeSMatthias Ringwald                         }
4174254b78eeSMatthias Ringwald 
417562daa441SMatthias Ringwald #ifdef ENABLE_MUTUAL_AUTHENTICATION_FOR_LEGACY_SECURE_CONNECTIONS
4176aa2fe986SMatthias Ringwald                         // if AES-CCM is used, authentication used SC -> authentication was mutual and we can skip explicit authentication
4177aa2fe986SMatthias Ringwald                         if (connected_uses_aes_ccm){
4178aa2fe986SMatthias Ringwald                             conn->authentication_flags |= AUTH_FLAG_CONNECTION_AUTHENTICATED;
4179aa2fe986SMatthias Ringwald                         }
418062daa441SMatthias Ringwald #else
418162daa441SMatthias Ringwald                         // We consider even Legacy Secure Connections as authenticated as BTstack mandates encryption
4182a086dc35SMatthias Ringwald                         // with encryption key size > hci_stack->gap_required_encryption_key_size
418362daa441SMatthias Ringwald                         // for all operations that require any security. See BIAS attacks.
4184aa2fe986SMatthias Ringwald                         conn->authentication_flags |= AUTH_FLAG_CONNECTION_AUTHENTICATED;
4185aa2fe986SMatthias Ringwald #endif
4186a355334eSMatthias Ringwald                         // validate encryption key size
4187a355334eSMatthias Ringwald                         if (hci_event_packet_get_type(packet) == HCI_EVENT_ENCRYPTION_CHANGE_V2) {
4188a355334eSMatthias Ringwald                             uint8_t encryption_key_size = hci_event_encryption_change_v2_get_encryption_key_size(packet);
4189a355334eSMatthias Ringwald                             // already got encryption key size
4190a355334eSMatthias Ringwald                             hci_handle_read_encryption_key_size_complete(conn, encryption_key_size);
4191a355334eSMatthias Ringwald                         } else {
41921ffa425cSMatthias Ringwald                             if (hci_command_supported(SUPPORTED_HCI_COMMAND_READ_ENCRYPTION_KEY_SIZE)) {
41936e058d3fSMatthias Ringwald                                 // For Classic, we need to validate encryption key size first, if possible (== supported by Controller)
4194573897a0SMatthias Ringwald                                 conn->bonding_flags |= BONDING_SEND_READ_ENCRYPTION_KEY_SIZE;
41956e058d3fSMatthias Ringwald                             } else {
41966e058d3fSMatthias Ringwald                                 // if not, pretend everything is perfect
41979866fdc7SMatthias Ringwald                                 hci_handle_read_encryption_key_size_complete(conn, 16);
41986e058d3fSMatthias Ringwald                             }
4199573897a0SMatthias Ringwald                         }
4200a355334eSMatthias Ringwald                     }
4201573897a0SMatthias Ringwald #endif
4202f0944df2S[email protected]                 } else {
42038daf94bcSMatthias Ringwald                     conn->authentication_flags &= ~AUTH_FLAG_CONNECTION_ENCRYPTED;
4204f0944df2S[email protected]                 }
42055999ee11SMatthias Ringwald             } else {
42068eae094cSMatthias Ringwald #ifdef ENABLE_CLASSIC
42078eae094cSMatthias Ringwald                 if (!hci_is_le_connection(conn)){
42085999ee11SMatthias Ringwald                     uint8_t status = hci_event_encryption_change_get_status(packet);
42095999ee11SMatthias Ringwald                     if ((conn->bonding_flags & BONDING_DEDICATED) != 0){
42105999ee11SMatthias Ringwald                         conn->bonding_flags &= ~BONDING_DEDICATED;
42115999ee11SMatthias Ringwald                         conn->bonding_flags |= BONDING_DISCONNECT_DEDICATED_DONE;
42125999ee11SMatthias Ringwald                         conn->bonding_status = status;
42135999ee11SMatthias Ringwald                     }
421427b992efSMatthias Ringwald                     // trigger security update -> level 0
421527b992efSMatthias Ringwald                     hci_handle_mutual_authentication_completed(conn);
4216ad83dc6aS[email protected]                 }
42178eae094cSMatthias Ringwald #endif
42188eae094cSMatthias Ringwald             }
4219573897a0SMatthias Ringwald 
4220f0944df2S[email protected]             break;
4221f0944df2S[email protected] 
422235454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
42231eb2563eS[email protected]         case HCI_EVENT_AUTHENTICATION_COMPLETE_EVENT:
4224abdad579SMatthias Ringwald             handle = hci_event_authentication_complete_get_connection_handle(packet);
42251eb2563eS[email protected]             conn = hci_connection_for_handle(handle);
42261eb2563eS[email protected]             if (!conn) break;
4227ad83dc6aS[email protected] 
4228dbd5dcc3SMatthias Ringwald             // clear authentication active flag
4229dbd5dcc3SMatthias Ringwald             conn->bonding_flags &= ~BONDING_SENT_AUTHENTICATE_REQUEST;
42301714cbbdSMatthias Ringwald             hci_pairing_complete(conn, hci_event_authentication_complete_get_status(packet));
4231dbd5dcc3SMatthias Ringwald 
4232abdad579SMatthias Ringwald             // authenticated only if auth status == 0
4233abdad579SMatthias Ringwald             if (hci_event_authentication_complete_get_status(packet) == 0){
4234abdad579SMatthias Ringwald                 // authenticated
42358daf94bcSMatthias Ringwald                 conn->authentication_flags |= AUTH_FLAG_CONNECTION_AUTHENTICATED;
4236abdad579SMatthias Ringwald 
4237131ef17aSMatthias Ringwald                 // If not already encrypted, start encryption
42388daf94bcSMatthias Ringwald                 if ((conn->authentication_flags & AUTH_FLAG_CONNECTION_ENCRYPTED) == 0){
42391eb2563eS[email protected]                     conn->bonding_flags |= BONDING_SEND_ENCRYPTION_REQUEST;
4240ad83dc6aS[email protected]                     break;
4241ad83dc6aS[email protected]                 }
4242abdad579SMatthias Ringwald             }
4243abdad579SMatthias Ringwald 
42444aa2f135SMatthias Ringwald             // emit updated security level (will be 0 if not authenticated)
42454aa2f135SMatthias Ringwald             hci_handle_mutual_authentication_completed(conn);
42461eb2563eS[email protected]             break;
42471714cbbdSMatthias Ringwald 
42481714cbbdSMatthias Ringwald         case HCI_EVENT_SIMPLE_PAIRING_COMPLETE:
42491714cbbdSMatthias Ringwald             hci_event_simple_pairing_complete_get_bd_addr(packet, addr);
42501714cbbdSMatthias Ringwald             conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL);
42511714cbbdSMatthias Ringwald             if (!conn) break;
42521714cbbdSMatthias Ringwald 
4253aa2fe986SMatthias Ringwald             // treat successfully paired connection as authenticated
4254aa2fe986SMatthias Ringwald             if (hci_event_simple_pairing_complete_get_status(packet) == ERROR_CODE_SUCCESS){
4255f3aafff1SMatthias Ringwald                 conn->authentication_flags |= AUTH_FLAG_CONNECTION_AUTHENTICATED;
4256aa2fe986SMatthias Ringwald             }
4257aa2fe986SMatthias Ringwald 
42581714cbbdSMatthias Ringwald             hci_pairing_complete(conn, hci_event_simple_pairing_complete_get_status(packet));
42591714cbbdSMatthias Ringwald             break;
426035454696SMatthias Ringwald #endif
426134d2123cS[email protected] 
426286805605S[email protected]         // HCI_EVENT_DISCONNECTION_COMPLETE
4263ccda6e14S[email protected]         // has been split, to first notify stack before shutting connection down
4264ccda6e14S[email protected]         // see end of function, too.
4265a4f30ec0S[email protected]         case HCI_EVENT_DISCONNECTION_COMPLETE:
4266a4f30ec0S[email protected]             if (packet[2]) break;   // status != 0
4267f8fbdce0SMatthias Ringwald             handle = little_endian_read_16(packet, 3);
426881d2bdb2SMatthias Ringwald             // drop outgoing ACL fragments if it is for closed connection and release buffer if tx not active
42694ea43905SMatthias Ringwald             if (hci_stack->acl_fragmentation_total_size > 0u) {
4270c6a37cfdSMatthias Ringwald                 if (handle == READ_ACL_CONNECTION_HANDLE(hci_stack->hci_packet_buffer)){
42714ea43905SMatthias Ringwald                     int release_buffer = hci_stack->acl_fragmentation_tx_active == 0u;
427281d2bdb2SMatthias Ringwald                     log_info("drop fragmented ACL data for closed connection, release buffer %u", release_buffer);
4273c6a37cfdSMatthias Ringwald                     hci_stack->acl_fragmentation_total_size = 0;
4274c6a37cfdSMatthias Ringwald                     hci_stack->acl_fragmentation_pos = 0;
427581d2bdb2SMatthias Ringwald                     if (release_buffer){
427681d2bdb2SMatthias Ringwald                         hci_release_packet_buffer();
427781d2bdb2SMatthias Ringwald                     }
4278c6a37cfdSMatthias Ringwald                 }
4279c6a37cfdSMatthias Ringwald             }
428035454696SMatthias Ringwald 
42814ae8623eSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
4282098c2716SMatthias Ringwald             // drop outgoing ISO fragments if it is for closed connection and release buffer if tx not active
4283098c2716SMatthias Ringwald             if (hci_stack->iso_fragmentation_total_size > 0u) {
4284098c2716SMatthias Ringwald                 if (handle == READ_ISO_CONNECTION_HANDLE(hci_stack->hci_packet_buffer)){
4285098c2716SMatthias Ringwald                     int release_buffer = hci_stack->iso_fragmentation_tx_active == 0u;
4286098c2716SMatthias Ringwald                     log_info("drop fragmented ISO data for closed connection, release buffer %u", release_buffer);
4287098c2716SMatthias Ringwald                     hci_stack->iso_fragmentation_total_size = 0;
4288098c2716SMatthias Ringwald                     hci_stack->iso_fragmentation_pos = 0;
4289098c2716SMatthias Ringwald                     if (release_buffer){
4290098c2716SMatthias Ringwald                         hci_release_packet_buffer();
4291098c2716SMatthias Ringwald                     }
4292098c2716SMatthias Ringwald                 }
4293098c2716SMatthias Ringwald             }
4294098c2716SMatthias Ringwald 
42956fd1d2c8SMatthias Ringwald             // finalize iso stream for CIS handle
429615a15be3SMatthias Ringwald             iso_stream = hci_iso_stream_for_con_handle(handle);
42974ae8623eSMatthias Ringwald             if (iso_stream != NULL){
42984ae8623eSMatthias Ringwald                 hci_iso_stream_finalize(iso_stream);
42994ae8623eSMatthias Ringwald                 break;
43004ae8623eSMatthias Ringwald             }
43014ae8623eSMatthias Ringwald #endif
43024ae8623eSMatthias Ringwald 
430391036612SMatthias Ringwald #if defined(ENABLE_BLE) && defined (ENABLE_HCI_COMMAND_STATUS_DISCARDED_FOR_FAILED_CONNECTIONS_WORKAROUND)
4304f48a5586SMatthias Ringwald             if ((handle != HCI_CON_HANDLE_INVALID) && (handle == hci_stack->hci_command_con_handle)){
4305f48a5586SMatthias Ringwald                 // we did not receive a HCI Command Complete or HCI Command Status event for the disconnected connection
4306f48a5586SMatthias Ringwald                 // if needed, we could also track the hci command opcode and simulate a hci command complete with status
4307f48a5586SMatthias Ringwald                 // but the connection has failed anyway, so for now, we only set the num hci commands back to 1
430805acf48bSMatthias Ringwald                 log_info("Disconnect for conn handle 0x%04x in pending HCI command, assume command failed", handle);
430905acf48bSMatthias Ringwald                 hci_stack->hci_command_con_handle = HCI_CON_HANDLE_INVALID;
4310f48a5586SMatthias Ringwald                 hci_stack->num_cmd_packets = 1;
4311f48a5586SMatthias Ringwald             }
4312f48a5586SMatthias Ringwald #endif
4313f48a5586SMatthias Ringwald 
4314c6a37cfdSMatthias Ringwald             conn = hci_connection_for_handle(handle);
4315c6a37cfdSMatthias Ringwald             if (!conn) break;
43161714cbbdSMatthias Ringwald #ifdef ENABLE_CLASSIC
43171714cbbdSMatthias Ringwald             // pairing failed if it was ongoing
43181714cbbdSMatthias Ringwald             hci_pairing_complete(conn, ERROR_CODE_REMOTE_USER_TERMINATED_CONNECTION);
43191714cbbdSMatthias Ringwald #endif
4320046ec007SMatthias Ringwald 
4321a086dc35SMatthias Ringwald             // emit dedicated bonding event
4322046ec007SMatthias Ringwald             if (conn->bonding_flags & BONDING_EMIT_COMPLETE_ON_DISCONNECT){
4323046ec007SMatthias Ringwald                 hci_emit_dedicated_bonding_result(conn->address, conn->bonding_status);
4324046ec007SMatthias Ringwald             }
4325046ec007SMatthias Ringwald 
4326459d27b9SMatthias Ringwald             // mark connection for shutdown, stop timers, reset state
4327459d27b9SMatthias Ringwald             conn->state = RECEIVED_DISCONNECTION_COMPLETE;
4328459d27b9SMatthias Ringwald             hci_connection_stop_timer(conn);
4329459d27b9SMatthias Ringwald             hci_connection_init(conn);
4330459d27b9SMatthias Ringwald 
433135454696SMatthias Ringwald #ifdef ENABLE_BLE
4332d70217a2SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
4333046ec007SMatthias Ringwald             // re-enable advertisements for le connections if active
43342b6ab3e6SMatthias Ringwald             if (hci_is_le_connection(conn)){
4335bbc366e6SMatthias Ringwald                 hci_update_advertisements_enabled_for_current_roles();
43369a2e4658SMatthias Ringwald             }
433735454696SMatthias Ringwald #endif
4338d70217a2SMatthias Ringwald #endif
4339ccda6e14S[email protected]             break;
43406772a24cSmatthias.ringwald 
4341c68bdf90Smatthias.ringwald         case HCI_EVENT_HARDWARE_ERROR:
4342313e5f9cSMatthias Ringwald             log_error("Hardware Error: 0x%02x", packet[2]);
4343d23838ecSMatthias Ringwald             if (hci_stack->hardware_error_callback){
4344c2e1fa60SMatthias Ringwald                 (*hci_stack->hardware_error_callback)(packet[2]);
43457586ee35S[email protected]             } else {
43467586ee35S[email protected]                 // if no special requests, just reboot stack
43477586ee35S[email protected]                 hci_power_control_off();
43487586ee35S[email protected]                 hci_power_control_on();
4349c68bdf90Smatthias.ringwald             }
4350c68bdf90Smatthias.ringwald             break;
4351c68bdf90Smatthias.ringwald 
43520e6f3837SMatthias Ringwald #ifdef ENABLE_CLASSIC
43535cf766e8SMatthias Ringwald         case HCI_EVENT_ROLE_CHANGE:
43545cf766e8SMatthias Ringwald             if (packet[2]) break;   // status != 0
4355c4c88f1bSJakob Krantz             reverse_bd_addr(&packet[3], addr);
4356f16129ceSMatthias Ringwald             addr_type = BD_ADDR_TYPE_ACL;
4357c4c88f1bSJakob Krantz             conn = hci_connection_for_bd_addr_and_type(addr, addr_type);
4358c4c88f1bSJakob Krantz             if (!conn) break;
435988f925b1SMatthias Ringwald             conn->role = (hci_role_t) packet[9];
43605cf766e8SMatthias Ringwald             break;
43610e6f3837SMatthias Ringwald #endif
43625cf766e8SMatthias Ringwald 
436363fa3374SMatthias Ringwald         case HCI_EVENT_TRANSPORT_PACKET_SENT:
4364098c2716SMatthias Ringwald             // release packet buffer only for asynchronous transport and if there are not further fragments
43654fa24b5fS[email protected]             if (hci_transport_synchronous()) {
436663fa3374SMatthias Ringwald                 log_error("Synchronous HCI Transport shouldn't send HCI_EVENT_TRANSPORT_PACKET_SENT");
43674fa24b5fS[email protected]                 return; // instead of break: to avoid re-entering hci_run()
43684fa24b5fS[email protected]             }
436981d2bdb2SMatthias Ringwald             hci_stack->acl_fragmentation_tx_active = 0;
4370098c2716SMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
4371098c2716SMatthias Ringwald             hci_stack->iso_fragmentation_tx_active = 0;
4372098c2716SMatthias Ringwald             if (hci_stack->iso_fragmentation_total_size) break;
4373098c2716SMatthias Ringwald #endif
4374d051460cS[email protected]             if (hci_stack->acl_fragmentation_total_size) break;
43755daaa52eSMatthias Ringwald 
43765daaa52eSMatthias Ringwald             // release packet buffer without HCI_EVENT_TRANSPORT_PACKET_SENT (as it will be later)
43775daaa52eSMatthias Ringwald             hci_stack->hci_packet_buffer_reserved = false;
4378701e3307SMatthias Ringwald 
43795ade6657SMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
43805ade6657SMatthias Ringwald             hci_iso_notify_can_send_now();
43815ade6657SMatthias Ringwald #endif
438263fa3374SMatthias Ringwald             // L2CAP receives this event via the hci_emit_event below
438363fa3374SMatthias Ringwald 
438435454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
438563fa3374SMatthias Ringwald             // For SCO, we do the can_send_now_check here
4386701e3307SMatthias Ringwald             hci_notify_if_sco_can_send_now();
438735454696SMatthias Ringwald #endif
43886b4af23dS[email protected]             break;
43896b4af23dS[email protected] 
439035454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
439163fa3374SMatthias Ringwald         case HCI_EVENT_SCO_CAN_SEND_NOW:
439263fa3374SMatthias Ringwald             // For SCO, we do the can_send_now_check here
43931972f31fSMatthias Ringwald             hci_stack->sco_can_send_now = true;
439463fa3374SMatthias Ringwald             hci_notify_if_sco_can_send_now();
439563fa3374SMatthias Ringwald             return;
43961cfb383eSMatthias Ringwald 
4397a086dc35SMatthias Ringwald         // explode inquiry results for easier consumption
43981cfb383eSMatthias Ringwald         case HCI_EVENT_INQUIRY_RESULT:
43991cfb383eSMatthias Ringwald         case HCI_EVENT_INQUIRY_RESULT_WITH_RSSI:
44001cfb383eSMatthias Ringwald         case HCI_EVENT_EXTENDED_INQUIRY_RESPONSE:
44019784dac1SMatthias Ringwald             gap_inquiry_explode(packet, size);
44021cfb383eSMatthias Ringwald             break;
440335454696SMatthias Ringwald #endif
440463fa3374SMatthias Ringwald 
4405a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE
44065909f7f2Smatthias.ringwald         case HCI_EVENT_LE_META:
44075909f7f2Smatthias.ringwald             switch (packet[2]){
4408d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
440957c9da5bS[email protected]                 case HCI_SUBEVENT_LE_ADVERTISING_REPORT:
44106fab74dbSMatthias Ringwald                     if (!hci_stack->le_scanning_enabled) break;
441157c9da5bS[email protected]                     le_handle_advertisement_report(packet, size);
44127bdc6798S[email protected]                     break;
4413a0698cb4SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
4414a0698cb4SMatthias Ringwald                 case HCI_SUBEVENT_LE_EXTENDED_ADVERTISING_REPORT:
4415a0698cb4SMatthias Ringwald                     if (!hci_stack->le_scanning_enabled) break;
4416a0698cb4SMatthias Ringwald                     le_handle_extended_advertisement_report(packet, size);
4417a0698cb4SMatthias Ringwald                     break;
4418ce56b945SMatthias Ringwald                 case HCI_SUBEVENT_LE_PERIODIC_ADVERTISING_SYNC_ESTABLISHMENT:
4419ce56b945SMatthias Ringwald                     hci_stack->le_periodic_sync_request = LE_CONNECTING_IDLE;
4420ce56b945SMatthias Ringwald                     hci_stack->le_periodic_sync_state = LE_CONNECTING_IDLE;
4421ce56b945SMatthias Ringwald                     break;
442289254d99SMatthias Ringwald                 case HCI_SUBEVENT_LE_ADVERTISING_SET_TERMINATED:
442389254d99SMatthias Ringwald                     advertising_handle = hci_subevent_le_advertising_set_terminated_get_advertising_handle(packet);
44242daa339aSMatthias Ringwald                     if (advertising_handle == LE_EXTENDED_ADVERTISING_LEGACY_HANDLE){
44252daa339aSMatthias Ringwald                         // legacy advertisements
44262daa339aSMatthias Ringwald                         hci_stack->le_advertisements_state &= ~LE_ADVERTISEMENT_STATE_ACTIVE;
44272daa339aSMatthias Ringwald                         hci_update_advertisements_enabled_for_current_roles();
44282daa339aSMatthias Ringwald                     } else {
442989254d99SMatthias Ringwald                         btstack_linked_list_iterator_init(&it, &hci_stack->le_advertising_sets);
443089254d99SMatthias Ringwald                         while (btstack_linked_list_iterator_has_next(&it)) {
443189254d99SMatthias Ringwald                             le_advertising_set_t *advertising_set = (le_advertising_set_t *) btstack_linked_list_iterator_next(&it);
443289254d99SMatthias Ringwald                             if (advertising_set->advertising_handle == advertising_handle){
443389254d99SMatthias Ringwald                                 advertising_set->state &= ~(LE_ADVERTISEMENT_STATE_ACTIVE | LE_ADVERTISEMENT_STATE_ENABLED);
443489254d99SMatthias Ringwald                             }
443589254d99SMatthias Ringwald                         }
44362775f8e2SMatthias Ringwald                     }
4437f7043595SMatthias Ringwald                     // event may come before le connection complete and announces new connection
4438f7043595SMatthias Ringwald                     if (hci_subevent_le_advertising_set_terminated_get_status(packet) == ERROR_CODE_SUCCESS){
4439f7043595SMatthias Ringwald                         handle = hci_subevent_le_advertising_set_terminated_get_connection_handle(packet);
4440f7043595SMatthias Ringwald                         conn = hci_connection_for_handle(handle);
4441f7043595SMatthias Ringwald                         if (conn == NULL){
444294791381SMatthias Ringwald                             // use placeholder address for peer, will be overwritten in hci_handle_le_connection_complete_event()
444394791381SMatthias Ringwald                             bd_addr_t addr;
444494791381SMatthias Ringwald                             memset(addr, 0, 6);
444594791381SMatthias Ringwald                             conn = create_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_UNKNOWN, HCI_ROLE_SLAVE);
4446f7043595SMatthias Ringwald                             if (conn != NULL){
4447f7043595SMatthias Ringwald                                 conn->state = ANNOUNCED;
4448f7043595SMatthias Ringwald                                 conn->con_handle = handle;
4449f7043595SMatthias Ringwald                             }
4450f7043595SMatthias Ringwald                         }
4451f7043595SMatthias Ringwald                     }
445289254d99SMatthias Ringwald                     break;
4453a0698cb4SMatthias Ringwald #endif
4454d70217a2SMatthias Ringwald #endif
44555909f7f2Smatthias.ringwald                 case HCI_SUBEVENT_LE_CONNECTION_COMPLETE:
445660fb273dSMatthias Ringwald                 case HCI_SUBEVENT_LE_ENHANCED_CONNECTION_COMPLETE_V1:
445760fb273dSMatthias Ringwald                 case HCI_SUBEVENT_LE_ENHANCED_CONNECTION_COMPLETE_V2:
4458688bcdb4SMatthias Ringwald                     hci_handle_le_connection_complete_event(packet);
44595909f7f2Smatthias.ringwald                     break;
44605909f7f2Smatthias.ringwald 
4461f8fbdce0SMatthias Ringwald                 // log_info("LE buffer size: %u, count %u", little_endian_read_16(packet,6), packet[8]);
4462c9db5c21SMilanka Ringwald                 case HCI_SUBEVENT_LE_CONNECTION_UPDATE_COMPLETE:
4463c9db5c21SMilanka Ringwald                     handle = hci_subevent_le_connection_update_complete_get_connection_handle(packet);
4464c9db5c21SMilanka Ringwald                     conn = hci_connection_for_handle(handle);
4465c9db5c21SMilanka Ringwald                     if (!conn) break;
4466c9db5c21SMilanka Ringwald                     conn->le_connection_interval = hci_subevent_le_connection_update_complete_get_conn_interval(packet);
4467c9db5c21SMilanka Ringwald                     break;
446865a46ef3S[email protected] 
446973cd8a2aSMatthias Ringwald                 case HCI_SUBEVENT_LE_REMOTE_CONNECTION_PARAMETER_REQUEST:
447073cd8a2aSMatthias Ringwald                     // connection
447173cd8a2aSMatthias Ringwald                     handle = hci_subevent_le_remote_connection_parameter_request_get_connection_handle(packet);
447273cd8a2aSMatthias Ringwald                     conn = hci_connection_for_handle(handle);
447373cd8a2aSMatthias Ringwald                     if (conn) {
447473cd8a2aSMatthias Ringwald                         // read arguments
447573cd8a2aSMatthias Ringwald                         uint16_t le_conn_interval_min   = hci_subevent_le_remote_connection_parameter_request_get_interval_min(packet);
447673cd8a2aSMatthias Ringwald                         uint16_t le_conn_interval_max   = hci_subevent_le_remote_connection_parameter_request_get_interval_max(packet);
447773cd8a2aSMatthias Ringwald                         uint16_t le_conn_latency        = hci_subevent_le_remote_connection_parameter_request_get_latency(packet);
447873cd8a2aSMatthias Ringwald                         uint16_t le_supervision_timeout = hci_subevent_le_remote_connection_parameter_request_get_timeout(packet);
447973cd8a2aSMatthias Ringwald 
448073cd8a2aSMatthias Ringwald                         // validate against current connection parameter range
448173cd8a2aSMatthias Ringwald                         le_connection_parameter_range_t existing_range;
448273cd8a2aSMatthias Ringwald                         gap_get_connection_parameter_range(&existing_range);
448373cd8a2aSMatthias 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);
448473cd8a2aSMatthias Ringwald                         if (update_parameter){
448573cd8a2aSMatthias Ringwald                             conn->le_con_parameter_update_state = CON_PARAMETER_UPDATE_REPLY;
448673cd8a2aSMatthias Ringwald                             conn->le_conn_interval_min = le_conn_interval_min;
448773cd8a2aSMatthias Ringwald                             conn->le_conn_interval_max = le_conn_interval_max;
448873cd8a2aSMatthias Ringwald                             conn->le_conn_latency = le_conn_latency;
448973cd8a2aSMatthias Ringwald                             conn->le_supervision_timeout = le_supervision_timeout;
449073cd8a2aSMatthias Ringwald                         } else {
4491c3898ca4SMatthias Ringwald                             conn->le_con_parameter_update_state = CON_PARAMETER_UPDATE_NEGATIVE_REPLY;
449273cd8a2aSMatthias Ringwald                         }
449373cd8a2aSMatthias Ringwald                     }
449473cd8a2aSMatthias Ringwald                     break;
44950f3b27c5SMatthias Ringwald #ifdef ENABLE_LE_LIMIT_ACL_FRAGMENT_BY_MAX_OCTETS
44960f3b27c5SMatthias Ringwald                 case HCI_SUBEVENT_LE_DATA_LENGTH_CHANGE:
44970f3b27c5SMatthias Ringwald                     handle = hci_subevent_le_data_length_change_get_connection_handle(packet);
44980f3b27c5SMatthias Ringwald                     conn = hci_connection_for_handle(handle);
44990f3b27c5SMatthias Ringwald                     if (conn) {
45000f3b27c5SMatthias Ringwald                         conn->le_max_tx_octets = hci_subevent_le_data_length_change_get_max_tx_octets(packet);
45010f3b27c5SMatthias Ringwald                     }
45020f3b27c5SMatthias Ringwald                     break;
45030f3b27c5SMatthias Ringwald #endif
45044ae8623eSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
45056fd1d2c8SMatthias Ringwald                 case HCI_SUBEVENT_LE_CIS_REQUEST:
45066fd1d2c8SMatthias Ringwald                     // incoming CIS request, allocate iso stream object and cache metadata
45076fd1d2c8SMatthias Ringwald                     iso_stream = hci_iso_stream_create(HCI_ISO_TYPE_CIS, HCI_ISO_STREAM_W4_USER,
45086fd1d2c8SMatthias Ringwald                                                        hci_subevent_le_cis_request_get_cig_id(packet),
45096fd1d2c8SMatthias Ringwald                                                        hci_subevent_le_cis_request_get_cis_id(packet));
45106fd1d2c8SMatthias Ringwald                     // if there's no memory, gap_cis_accept/gap_cis_reject will fail
45116fd1d2c8SMatthias Ringwald                     if (iso_stream != NULL){
45126fd1d2c8SMatthias Ringwald                         iso_stream->cis_handle = hci_subevent_le_cis_request_get_cis_connection_handle(packet);
45136fd1d2c8SMatthias Ringwald                         iso_stream->acl_handle = hci_subevent_le_cis_request_get_acl_connection_handle(packet);
45146fd1d2c8SMatthias Ringwald                     }
45156fd1d2c8SMatthias Ringwald                     break;
45164ae8623eSMatthias Ringwald                 case HCI_SUBEVENT_LE_CIS_ESTABLISHED:
45178e58e4f7SMatthias Ringwald                     if (hci_stack->iso_active_operation_type == HCI_ISO_TYPE_CIS){
45184ae8623eSMatthias Ringwald                         handle = hci_subevent_le_cis_established_get_connection_handle(packet);
45194ae8623eSMatthias Ringwald                         uint8_t status = hci_subevent_le_cis_established_get_status(packet);
45208e58e4f7SMatthias Ringwald                         iso_stream = hci_iso_stream_for_con_handle(handle);
45218e58e4f7SMatthias Ringwald                         btstack_assert(iso_stream != NULL);
45227dd97f73SMatthias Ringwald                         // track connection info
45237dd97f73SMatthias Ringwald                         iso_stream->number_of_subevents  = hci_subevent_le_cis_established_get_nse(packet);
45247dd97f73SMatthias Ringwald                         iso_stream->burst_number_c_to_p  = hci_subevent_le_cis_established_get_bn_c_to_p(packet);
45257dd97f73SMatthias Ringwald                         iso_stream->burst_number_p_to_c  = hci_subevent_le_cis_established_get_bn_p_to_c(packet);
45267dd97f73SMatthias Ringwald                         iso_stream->flush_timeout_c_to_p = hci_subevent_le_cis_established_get_ft_c_to_p(packet);
45277dd97f73SMatthias Ringwald                         iso_stream->flush_timeout_p_to_c = hci_subevent_le_cis_established_get_ft_p_to_c(packet);
452826b93350SMatthias Ringwald                         iso_stream->max_sdu_c_to_p       = hci_subevent_le_cis_established_get_max_pdu_c_to_p(packet);
452926b93350SMatthias Ringwald                         iso_stream->max_sdu_p_to_c       = hci_subevent_le_cis_established_get_max_pdu_p_to_c(packet);
45307dd97f73SMatthias Ringwald                         iso_stream->iso_interval_1250us  = hci_subevent_le_cis_established_get_iso_interval(packet);
453126b93350SMatthias Ringwald                         if (hci_stack->iso_active_operation_group_id == HCI_ISO_GROUP_ID_SINGLE_CIS){
453226b93350SMatthias Ringwald                             // CIS Accept by Peripheral
453326b93350SMatthias Ringwald                             if (status == ERROR_CODE_SUCCESS){
453426b93350SMatthias Ringwald                                 if (iso_stream->max_sdu_p_to_c > 0){
453526b93350SMatthias Ringwald                                     // we're peripheral and we will send data
453626b93350SMatthias Ringwald                                     iso_stream->state = HCI_ISO_STREAM_STATE_W2_SETUP_ISO_INPUT;
453726b93350SMatthias Ringwald                                 } else {
453826b93350SMatthias Ringwald                                     // we're peripheral and we will only receive data
453926b93350SMatthias Ringwald                                     iso_stream->state = HCI_ISO_STREAM_STATE_W2_SETUP_ISO_OUTPUT;
454026b93350SMatthias Ringwald                                 }
454126b93350SMatthias Ringwald                             } else {
454214045fdbSMatthias Ringwald                                 hci_cis_handle_created(iso_stream, status);
454326b93350SMatthias Ringwald                             }
454426b93350SMatthias Ringwald                             hci_stack->iso_active_operation_type = HCI_ISO_TYPE_INVALID;
454526b93350SMatthias Ringwald                         } else {
454626b93350SMatthias Ringwald                             // CIG Setup by Central
454726b93350SMatthias Ringwald                             le_audio_cig_t * cig = hci_cig_for_id(hci_stack->iso_active_operation_group_id);
454826b93350SMatthias Ringwald                             btstack_assert(cig != NULL);
454926b93350SMatthias Ringwald                             // update iso stream state
45504ae8623eSMatthias Ringwald                             if (status == ERROR_CODE_SUCCESS){
45514ae8623eSMatthias Ringwald                                 iso_stream->state = HCI_ISO_STREAM_STATE_ESTABLISHED;
45524ae8623eSMatthias Ringwald                             } else {
45538e58e4f7SMatthias Ringwald                                 iso_stream->state = HCI_ISO_STREAM_STATE_IDLE;
45544ae8623eSMatthias Ringwald                             }
45558e58e4f7SMatthias Ringwald                             // update cig state
4556f06bb90fSMatthias Ringwald                             for (i=0;i<cig->num_cis;i++){
4557f06bb90fSMatthias Ringwald                                 if (cig->cis_con_handles[i] == handle){
45583abcd16cSMatthias Ringwald                                     cig->cis_setup_active[i] = false;
4559f9306a1aSMatthias Ringwald                                     if (status == ERROR_CODE_SUCCESS){
4560f9306a1aSMatthias Ringwald                                         cig->cis_established[i] = true;
4561f9306a1aSMatthias Ringwald                                     } else {
456214045fdbSMatthias Ringwald                                         hci_cis_handle_created(iso_stream, status);
4563f06bb90fSMatthias Ringwald                                     }
4564f06bb90fSMatthias Ringwald                                 }
4565f06bb90fSMatthias Ringwald                             }
45668e58e4f7SMatthias Ringwald 
45678e58e4f7SMatthias Ringwald                             // trigger iso path setup if complete
45680f0ba168SMatthias Ringwald                             bool cis_setup_active = false;
4569f9306a1aSMatthias Ringwald                             for (i=0;i<cig->num_cis;i++){
45700f0ba168SMatthias Ringwald                                 cis_setup_active |= cig->cis_setup_active[i];
4571f9306a1aSMatthias Ringwald                             }
45720f0ba168SMatthias Ringwald                             if (cis_setup_active == false){
4573f9306a1aSMatthias Ringwald                                 cig->state_vars.next_cis = 0;
4574f9306a1aSMatthias Ringwald                                 cig->state = LE_AUDIO_CIG_STATE_SETUP_ISO_PATH;
457526b93350SMatthias Ringwald                                 hci_stack->iso_active_operation_type = HCI_ISO_TYPE_INVALID;
457626b93350SMatthias Ringwald                             }
4577f06bb90fSMatthias Ringwald                         }
45784ae8623eSMatthias Ringwald                     }
45797aa35f6aSMatthias Ringwald                     break;
45807aa35f6aSMatthias Ringwald                 case HCI_SUBEVENT_LE_CREATE_BIG_COMPLETE:
458126b93350SMatthias Ringwald                     hci_stack->iso_active_operation_type = HCI_ISO_TYPE_INVALID;
45827aa35f6aSMatthias Ringwald                     big = hci_big_for_handle(packet[4]);
45837aa35f6aSMatthias Ringwald                     if (big != NULL){
45847aa35f6aSMatthias Ringwald                         uint8_t status = packet[3];
45857aa35f6aSMatthias Ringwald                         if (status == ERROR_CODE_SUCCESS){
45867aa35f6aSMatthias Ringwald                             // store bis_con_handles and trigger iso path setup
45875fd415a6SMatthias Ringwald                             uint8_t num_bis = btstack_min(big->num_bis, packet[20]);
4588c30bd0a5SMatthias Ringwald 
45897aa35f6aSMatthias Ringwald                             for (i=0;i<num_bis;i++){
4590fb16346aSMatthias Ringwald                                 hci_con_handle_t bis_handle = (hci_con_handle_t) little_endian_read_16(packet, 21 + (2 * i));
4591fb16346aSMatthias Ringwald                                 big->bis_con_handles[i] = bis_handle;
4592fb16346aSMatthias Ringwald                                 // assign bis handle
4593fb16346aSMatthias Ringwald                                 btstack_linked_list_iterator_init(&it, &hci_stack->iso_streams);
4594fb16346aSMatthias Ringwald                                 while (btstack_linked_list_iterator_has_next(&it)){
4595c30bd0a5SMatthias Ringwald                                     iso_stream = (hci_iso_stream_t *) btstack_linked_list_iterator_next(&it);
4596fb16346aSMatthias Ringwald                                     if ((iso_stream->state == HCI_ISO_STREAM_STATE_REQUESTED ) &&
45978d72db10SMatthias Ringwald                                         (iso_stream->group_id == big->big_handle)){
4598969d876aSMatthias Ringwald                                         iso_stream->cis_handle = bis_handle;
4599fb16346aSMatthias Ringwald                                         iso_stream->state = HCI_ISO_STREAM_STATE_ESTABLISHED;
4600cd1139aaSMatthias Ringwald                                         break;
4601fb16346aSMatthias Ringwald                                     }
4602fb16346aSMatthias Ringwald                                 }
46037aa35f6aSMatthias Ringwald                             }
46042a6c0f82SMatthias Ringwald                             if (big->state == LE_AUDIO_BIG_STATE_W4_ESTABLISHED) {
46057aa35f6aSMatthias Ringwald                                 big->state = LE_AUDIO_BIG_STATE_SETUP_ISO_PATH;
46067aa35f6aSMatthias Ringwald                                 big->state_vars.next_bis = 0;
46072a6c0f82SMatthias Ringwald                             }
46087aa35f6aSMatthias Ringwald                         } else {
46092a6c0f82SMatthias Ringwald                             // create BIG failed or has been stopped by us
4610d8905293SMatthias Ringwald                             hci_iso_create_big_failed(big, status);
46117aa35f6aSMatthias Ringwald                         }
46127aa35f6aSMatthias Ringwald                     }
46137aa35f6aSMatthias Ringwald                     break;
46147aa35f6aSMatthias Ringwald                 case HCI_SUBEVENT_LE_TERMINATE_BIG_COMPLETE:
4615c45ca112SMatthias Ringwald                     hci_stack->iso_active_operation_type = HCI_ISO_TYPE_INVALID;
46167aa35f6aSMatthias Ringwald                     big = hci_big_for_handle(hci_subevent_le_terminate_big_complete_get_big_handle(packet));
46177aa35f6aSMatthias Ringwald                     if (big != NULL){
4618fb16346aSMatthias Ringwald                         // finalize associated ISO streams
4619c30bd0a5SMatthias Ringwald 
4620fb16346aSMatthias Ringwald                         btstack_linked_list_iterator_init(&it, &hci_stack->iso_streams);
4621fb16346aSMatthias Ringwald                         while (btstack_linked_list_iterator_has_next(&it)){
4622c30bd0a5SMatthias Ringwald                             iso_stream = (hci_iso_stream_t *) btstack_linked_list_iterator_next(&it);
46238d72db10SMatthias Ringwald                             if (iso_stream->group_id == big->big_handle){
4624969d876aSMatthias Ringwald                                 log_info("BIG Terminated, big_handle 0x%02x, con handle 0x%04x", iso_stream->group_id, iso_stream->cis_handle);
4625fb16346aSMatthias Ringwald                                 btstack_linked_list_iterator_remove(&it);
4626fb16346aSMatthias Ringwald                                 btstack_memory_hci_iso_stream_free(iso_stream);
4627fb16346aSMatthias Ringwald                             }
4628fb16346aSMatthias Ringwald                         }
46297aa35f6aSMatthias Ringwald                         btstack_linked_list_remove(&hci_stack->le_audio_bigs, (btstack_linked_item_t *) big);
46307aa35f6aSMatthias Ringwald                         switch (big->state){
46317aa35f6aSMatthias Ringwald                             case LE_AUDIO_BIG_STATE_W4_TERMINATED_AFTER_SETUP_FAILED:
46327aa35f6aSMatthias Ringwald                                 hci_emit_big_created(big, big->state_vars.status);
46337aa35f6aSMatthias Ringwald                                 break;
46347aa35f6aSMatthias Ringwald                             default:
46357aa35f6aSMatthias Ringwald                                 hci_emit_big_terminated(big);
46367aa35f6aSMatthias Ringwald                                 break;
46377aa35f6aSMatthias Ringwald                         }
46387aa35f6aSMatthias Ringwald                     }
46397aa35f6aSMatthias Ringwald                     break;
46402a6c0f82SMatthias Ringwald                 case HCI_SUBEVENT_LE_BIG_SYNC_ESTABLISHED:
4641c45ca112SMatthias Ringwald                     hci_stack->iso_active_operation_type = HCI_ISO_TYPE_INVALID;
46422a6c0f82SMatthias Ringwald                     big_sync = hci_big_sync_for_handle(packet[4]);
46432a6c0f82SMatthias Ringwald                     if (big_sync != NULL){
46442a6c0f82SMatthias Ringwald                         uint8_t status = packet[3];
46452a6c0f82SMatthias Ringwald                         if (status == ERROR_CODE_SUCCESS){
46462a6c0f82SMatthias Ringwald                             // store bis_con_handles and trigger iso path setup
46475fd415a6SMatthias Ringwald                             uint8_t num_bis = btstack_min(big_sync->num_bis, packet[16]);
46482a6c0f82SMatthias Ringwald                             for (i=0;i<num_bis;i++){
464902e19895SMatthias Ringwald                                 hci_con_handle_t bis_handle = little_endian_read_16(packet, 17 + (2 * i));
465002e19895SMatthias Ringwald                                 big_sync->bis_con_handles[i] = bis_handle;
465102e19895SMatthias Ringwald                                 // setup iso_stream_t
465202e19895SMatthias Ringwald                                 btstack_linked_list_iterator_init(&it, &hci_stack->iso_streams);
465302e19895SMatthias Ringwald                                 while (btstack_linked_list_iterator_has_next(&it)){
4654c30bd0a5SMatthias Ringwald                                     iso_stream = (hci_iso_stream_t *) btstack_linked_list_iterator_next(&it);
465502e19895SMatthias Ringwald                                     if ((iso_stream->state == HCI_ISO_STREAM_STATE_REQUESTED ) &&
465602e19895SMatthias Ringwald                                         (iso_stream->group_id == big_sync->big_handle)){
465702e19895SMatthias Ringwald                                         iso_stream->cis_handle = bis_handle;
465802e19895SMatthias Ringwald                                         iso_stream->state = HCI_ISO_STREAM_STATE_ESTABLISHED;
465902e19895SMatthias Ringwald                                         break;
466002e19895SMatthias Ringwald                                     }
466102e19895SMatthias Ringwald                                 }
46622a6c0f82SMatthias Ringwald                             }
46632a6c0f82SMatthias Ringwald                             if (big_sync->state == LE_AUDIO_BIG_STATE_W4_ESTABLISHED) {
46642a6c0f82SMatthias Ringwald                                 // trigger iso path setup
46652a6c0f82SMatthias Ringwald                                 big_sync->state = LE_AUDIO_BIG_STATE_SETUP_ISO_PATH;
46662a6c0f82SMatthias Ringwald                                 big_sync->state_vars.next_bis = 0;
46672a6c0f82SMatthias Ringwald                             }
46682a6c0f82SMatthias Ringwald                         } else {
46692a6c0f82SMatthias Ringwald                             // create BIG Sync failed or has been stopped by us
4670d8905293SMatthias Ringwald                             hci_iso_big_sync_failed(big_sync, status);
46712a6c0f82SMatthias Ringwald                         }
46722a6c0f82SMatthias Ringwald                     }
46732a6c0f82SMatthias Ringwald                     break;
46742a6c0f82SMatthias Ringwald                 case HCI_SUBEVENT_LE_BIG_SYNC_LOST:
4675c45ca112SMatthias Ringwald                     hci_stack->iso_active_operation_type = HCI_ISO_TYPE_INVALID;
46762a6c0f82SMatthias Ringwald                     big_sync = hci_big_sync_for_handle(packet[4]);
46772a6c0f82SMatthias Ringwald                     if (big_sync != NULL){
4678d04a9afcSMatthias Ringwald                         uint8_t big_handle = packet[4];
46792a6c0f82SMatthias Ringwald                         btstack_linked_list_remove(&hci_stack->le_audio_big_syncs, (btstack_linked_item_t *) big_sync);
4680d04a9afcSMatthias Ringwald                         hci_emit_big_sync_stopped(big_handle);
46812a6c0f82SMatthias Ringwald                     }
46822a6c0f82SMatthias Ringwald                     break;
46834ae8623eSMatthias Ringwald #endif
46845909f7f2Smatthias.ringwald                 default:
46855909f7f2Smatthias.ringwald                     break;
46865909f7f2Smatthias.ringwald             }
46875909f7f2Smatthias.ringwald             break;
46885909f7f2Smatthias.ringwald #endif
46890b36101dSMatthias Ringwald         case HCI_EVENT_VENDOR_SPECIFIC:
46900b36101dSMatthias Ringwald             // Vendor specific commands often create vendor specific event instead of num completed packets
46910b36101dSMatthias Ringwald             // To avoid getting stuck as num_cmds_packets is zero, reset it to 1 for controllers with this behaviour
46920b36101dSMatthias Ringwald             switch (hci_stack->manufacturer){
46930b36101dSMatthias Ringwald                 case BLUETOOTH_COMPANY_ID_CAMBRIDGE_SILICON_RADIO:
46940b36101dSMatthias Ringwald                     hci_stack->num_cmd_packets = 1;
46950b36101dSMatthias Ringwald                     break;
46960b36101dSMatthias Ringwald                 default:
46970b36101dSMatthias Ringwald                     break;
46980b36101dSMatthias Ringwald             }
46990b36101dSMatthias Ringwald             break;
47006772a24cSmatthias.ringwald         default:
47016772a24cSmatthias.ringwald             break;
4702fe1ed1b8Smatthias.ringwald     }
4703fe1ed1b8Smatthias.ringwald 
470467c6c9dcSMatthias Ringwald     handle_event_for_current_stack_state(packet, size);
470589db417bSmatthias.ringwald 
470686805605S[email protected]     // notify upper stack
4707d6b06661SMatthias Ringwald 	hci_emit_event(packet, size, 0);   // don't dump, already happened in packet handler
470894ab26f8Smatthias.ringwald 
470986805605S[email protected]     // moved here to give upper stack a chance to close down everything with hci_connection_t intact
4710797b2a3fSMatthias Ringwald     if ((hci_event_packet_get_type(packet) == HCI_EVENT_DISCONNECTION_COMPLETE) && (packet[2] == 0)){
4711f8fbdce0SMatthias Ringwald 		handle = little_endian_read_16(packet, 3);
471205ae8de3SMatthias Ringwald 		hci_connection_t * aConn = hci_connection_for_handle(handle);
4713046ec007SMatthias Ringwald 		// discard connection if app did not trigger a reconnect in the event handler
4714797b2a3fSMatthias Ringwald 		if (aConn && aConn->state == RECEIVED_DISCONNECTION_COMPLETE){
471505ae8de3SMatthias Ringwald 			hci_shutdown_connection(aConn);
4716b0136355SMatthias Ringwald 		}
47178ad9cf99SMatthias Ringwald #ifdef ENABLE_CONTROLLER_DUMP_PACKETS
47188ad9cf99SMatthias Ringwald         hci_controller_dump_packets();
47198ad9cf99SMatthias Ringwald #endif
472086805605S[email protected]     }
472186805605S[email protected] 
472294ab26f8Smatthias.ringwald 	// execute main loop
472394ab26f8Smatthias.ringwald 	hci_run();
472416833f0aSmatthias.ringwald }
472516833f0aSmatthias.ringwald 
472635454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
47276f28d2eeSMatthias Ringwald 
4728c91d150bS[email protected] static void sco_handler(uint8_t * packet, uint16_t size){
47290b3f95dfSMatthias Ringwald     // lookup connection struct
47302b838201SMatthias Ringwald     hci_con_handle_t con_handle = READ_SCO_CONNECTION_HANDLE(packet);
47312b838201SMatthias Ringwald     hci_connection_t * conn     = hci_connection_for_handle(con_handle);
47320b3f95dfSMatthias Ringwald     if (!conn) return;
47330b3f95dfSMatthias Ringwald 
47346be3cf7fSMatthias Ringwald #ifdef ENABLE_SCO_OVER_HCI
4735760b20efSMatthias Ringwald     // CSR 8811 prefixes 60 byte SCO packet in transparent mode with 20 zero bytes -> skip first 20 payload bytes
4736760b20efSMatthias Ringwald     if (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_CAMBRIDGE_SILICON_RADIO){
4737a1df452eSMatthias Ringwald         if ((size == 83) && ((hci_stack->sco_voice_setting_active & 0x03) == 0x03)){
4738760b20efSMatthias Ringwald             packet[2] = 0x3c;
4739760b20efSMatthias Ringwald             memmove(&packet[3], &packet[23], 63);
4740760b20efSMatthias Ringwald             size = 63;
47410b3f95dfSMatthias Ringwald         }
47420b3f95dfSMatthias Ringwald     }
4743760b20efSMatthias Ringwald 
4744f234b250SMatthias Ringwald     if (hci_have_usb_transport()){
4745f234b250SMatthias Ringwald         // Nothing to do
4746f234b250SMatthias Ringwald     } else {
474749205f5dSMatthias 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);
4748760b20efSMatthias Ringwald         if (hci_stack->synchronous_flow_control_enabled == 0){
4749fa7f2dfdSMatthias Ringwald             // ignore received SCO packets for the first 10 ms, then allow for max two HCI_SCO_2EV3_SIZE packets
4750b1202089SMatthias 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);
4751fa7f2dfdSMatthias Ringwald             if (conn->sco_tx_active == 0){
4752fa7f2dfdSMatthias Ringwald                 if (btstack_time_delta(btstack_run_loop_get_time_ms(), conn->sco_established_ms) > 10){
4753fa7f2dfdSMatthias Ringwald                     conn->sco_tx_active = 1;
4754fa7f2dfdSMatthias Ringwald                     conn->sco_tx_ready = max_sco_packets;
4755fa7f2dfdSMatthias Ringwald                     log_info("Start SCO sending, %u packets", conn->sco_tx_ready);
4756fa7f2dfdSMatthias Ringwald                     hci_notify_if_sco_can_send_now();
475759c33575SMatthias Ringwald                 }
475859c33575SMatthias Ringwald             } else {
4759fa7f2dfdSMatthias Ringwald                 if (conn->sco_tx_ready < max_sco_packets){
4760fa7f2dfdSMatthias Ringwald                     conn->sco_tx_ready++;
476159c33575SMatthias Ringwald                 }
4762fa7f2dfdSMatthias Ringwald                 hci_notify_if_sco_can_send_now();
47636f28d2eeSMatthias Ringwald             }
4764760b20efSMatthias Ringwald         }
4765f234b250SMatthias Ringwald     }
47666be3cf7fSMatthias Ringwald #endif
47676be3cf7fSMatthias Ringwald 
47680b3f95dfSMatthias Ringwald     // deliver to app
47690b3f95dfSMatthias Ringwald     if (hci_stack->sco_packet_handler) {
47700b3f95dfSMatthias Ringwald         hci_stack->sco_packet_handler(HCI_SCO_DATA_PACKET, 0, packet, size);
47710b3f95dfSMatthias Ringwald     }
47720b3f95dfSMatthias Ringwald 
4773ed325439SMatthias Ringwald #ifdef HAVE_SCO_TRANSPORT
4774ed325439SMatthias Ringwald     // We can send one packet for each received packet
4775ed325439SMatthias Ringwald     conn->sco_tx_ready++;
4776ed325439SMatthias Ringwald     hci_notify_if_sco_can_send_now();
4777ed325439SMatthias Ringwald #endif
4778ed325439SMatthias Ringwald 
47790b3f95dfSMatthias Ringwald #ifdef ENABLE_HCI_CONTROLLER_TO_HOST_FLOW_CONTROL
47802b838201SMatthias Ringwald     conn->num_packets_completed++;
47812b838201SMatthias Ringwald     hci_stack->host_completed_packets = 1;
47822b838201SMatthias Ringwald     hci_run();
47832b838201SMatthias Ringwald #endif
4784c91d150bS[email protected] }
478535454696SMatthias Ringwald #endif
4786c91d150bS[email protected] 
47870a57e69fSmatthias.ringwald static void packet_handler(uint8_t packet_type, uint8_t *packet, uint16_t size){
47884248f37eSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
47894248f37eSMatthias Ringwald     // propagate ISO packets received as ACL
4790062276f9SMatthias Ringwald     hci_iso_stream_t * iso_stream = NULL;
47914248f37eSMatthias Ringwald     if ((packet_type == HCI_ACL_DATA_PACKET) && (size >= HCI_ACL_HEADER_SIZE)){
47924248f37eSMatthias Ringwald         hci_con_handle_t con_handle = READ_ACL_CONNECTION_HANDLE(packet);
47934248f37eSMatthias Ringwald         iso_stream = hci_iso_stream_for_con_handle(con_handle);
47944248f37eSMatthias Ringwald         if (iso_stream != NULL){
47954248f37eSMatthias Ringwald             packet_type = HCI_ISO_DATA_PACKET;
47964248f37eSMatthias Ringwald         }
47974248f37eSMatthias Ringwald     }
47984248f37eSMatthias Ringwald #endif
47994248f37eSMatthias Ringwald 
4800b09f7410SMatthias Ringwald     // don't log internal events unless requested
4801b09f7410SMatthias Ringwald     bool internal_event = (packet_type == HCI_EVENT_PACKET) && (hci_event_packet_get_type(packet) >= BTSTACK_EVENT_FIRST);
4802b09f7410SMatthias Ringwald     bool log_packet = internal_event == false;
4803b09f7410SMatthias Ringwald #ifdef ENABLE_LOG_BTSTACK_EVENTS
4804b09f7410SMatthias Ringwald     log_packet = true;
4805b09f7410SMatthias Ringwald #endif
4806b09f7410SMatthias Ringwald     if (log_packet){
48075bb5bc3eS[email protected]         hci_dump_packet(packet_type, 1, packet, size);
4808b09f7410SMatthias Ringwald     }
4809b09f7410SMatthias Ringwald 
481010e830c9Smatthias.ringwald     switch (packet_type) {
481110e830c9Smatthias.ringwald         case HCI_EVENT_PACKET:
481210e830c9Smatthias.ringwald             event_handler(packet, size);
481310e830c9Smatthias.ringwald             break;
481410e830c9Smatthias.ringwald         case HCI_ACL_DATA_PACKET:
481510e830c9Smatthias.ringwald             acl_handler(packet, size);
481610e830c9Smatthias.ringwald             break;
481735454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
4818c91d150bS[email protected]         case HCI_SCO_DATA_PACKET:
4819c91d150bS[email protected]             sco_handler(packet, size);
4820202c8a4cSMatthias Ringwald             break;
482135454696SMatthias Ringwald #endif
48220a8cccd5SMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
48235027c498SMatthias Ringwald         case HCI_ISO_DATA_PACKET:
4824750818acSMatthias Ringwald             if ((iso_stream == NULL) && (size >= HCI_ISO_HEADER_SIZE)){
4825750818acSMatthias Ringwald                 hci_con_handle_t con_handle = READ_ISO_CONNECTION_HANDLE(packet);
4826750818acSMatthias Ringwald                 iso_stream = hci_iso_stream_for_con_handle(con_handle);
4827750818acSMatthias Ringwald             }
4828750818acSMatthias Ringwald             hci_iso_packet_handler(iso_stream, packet, size);
48295027c498SMatthias Ringwald             break;
48305027c498SMatthias Ringwald #endif
483110e830c9Smatthias.ringwald         default:
483210e830c9Smatthias.ringwald             break;
483310e830c9Smatthias.ringwald     }
483410e830c9Smatthias.ringwald }
483510e830c9Smatthias.ringwald 
4836d6b06661SMatthias Ringwald /**
4837d6b06661SMatthias Ringwald  * @brief Add event packet handler.
4838d6b06661SMatthias Ringwald  */
4839d6b06661SMatthias Ringwald void hci_add_event_handler(btstack_packet_callback_registration_t * callback_handler){
4840d6b06661SMatthias Ringwald     btstack_linked_list_add_tail(&hci_stack->event_handlers, (btstack_linked_item_t*) callback_handler);
4841d6b06661SMatthias Ringwald }
4842d6b06661SMatthias Ringwald 
484367f708e0SMatthias Ringwald /**
484467f708e0SMatthias Ringwald  * @brief Remove event packet handler.
484567f708e0SMatthias Ringwald  */
484667f708e0SMatthias Ringwald void hci_remove_event_handler(btstack_packet_callback_registration_t * callback_handler){
484767f708e0SMatthias Ringwald     btstack_linked_list_remove(&hci_stack->event_handlers, (btstack_linked_item_t*) callback_handler);
484867f708e0SMatthias Ringwald }
4849d6b06661SMatthias Ringwald 
4850fcadd0caSmatthias.ringwald /** Register HCI packet handlers */
48513d50b4baSMatthias Ringwald void hci_register_acl_packet_handler(btstack_packet_handler_t handler){
4852fb37a842SMatthias Ringwald     hci_stack->acl_packet_handler = handler;
485316833f0aSmatthias.ringwald }
485416833f0aSmatthias.ringwald 
485535454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
48568abbe8b5SMatthias Ringwald /**
48578abbe8b5SMatthias Ringwald  * @brief Registers a packet handler for SCO data. Used for HSP and HFP profiles.
48588abbe8b5SMatthias Ringwald  */
48593d50b4baSMatthias Ringwald void hci_register_sco_packet_handler(btstack_packet_handler_t handler){
48608abbe8b5SMatthias Ringwald     hci_stack->sco_packet_handler = handler;
48618abbe8b5SMatthias Ringwald }
486235454696SMatthias Ringwald #endif
48638abbe8b5SMatthias Ringwald 
48640a8cccd5SMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
48655027c498SMatthias Ringwald void hci_register_iso_packet_handler(btstack_packet_handler_t handler){
48665027c498SMatthias Ringwald     hci_stack->iso_packet_handler = handler;
48675027c498SMatthias Ringwald }
48685027c498SMatthias Ringwald #endif
48695027c498SMatthias Ringwald 
487071de195eSMatthias Ringwald static void hci_state_reset(void){
4871595bdbfbS[email protected]     // no connections yet
4872595bdbfbS[email protected]     hci_stack->connections = NULL;
487374308b23Smatthias.ringwald 
487474308b23Smatthias.ringwald     // keep discoverable/connectable as this has been requested by the client(s)
487574308b23Smatthias.ringwald     // hci_stack->discoverable = 0;
487674308b23Smatthias.ringwald     // hci_stack->connectable = 0;
487774308b23Smatthias.ringwald     // hci_stack->bondable = 1;
4878b95a5a35SMatthias Ringwald     // hci_stack->own_addr_type = 0;
4879595bdbfbS[email protected] 
488044935e40S[email protected]     // buffer is free
488102c7fc01SMatthias Ringwald     hci_stack->hci_packet_buffer_reserved = false;
488244935e40S[email protected] 
4883595bdbfbS[email protected]     // no pending cmds
4884595bdbfbS[email protected]     hci_stack->decline_reason = 0;
4885595bdbfbS[email protected] 
4886c214d65bSMatthias Ringwald     hci_stack->secure_connections_active = false;
4887c214d65bSMatthias Ringwald 
4888bea424a5SMatthias Ringwald #ifdef ENABLE_CLASSIC
4889496bb884SMatthias Ringwald     hci_stack->inquiry_lap = GAP_IAC_GENERAL_INQUIRY;
489032a12730SMatthias Ringwald 
4891baa4881eSMatthias Ringwald     hci_stack->gap_tasks_classic =
489259d59ecfSMatthias Ringwald             GAP_TASK_SET_DEFAULT_LINK_POLICY |
489359d59ecfSMatthias Ringwald             GAP_TASK_SET_CLASS_OF_DEVICE |
489459d59ecfSMatthias Ringwald             GAP_TASK_SET_LOCAL_NAME |
4895bc2dcc03SMatthias Ringwald             GAP_TASK_SET_EIR_DATA |
489632a12730SMatthias Ringwald             GAP_TASK_WRITE_SCAN_ENABLE |
489732a12730SMatthias Ringwald             GAP_TASK_WRITE_PAGE_TIMEOUT;
4898bea424a5SMatthias Ringwald #endif
4899bea424a5SMatthias Ringwald 
4900cf01e888SMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB
49018d5f0979SMatthias Ringwald     hci_stack->classic_read_local_oob_data = false;
49021ae74bf3SMatthias Ringwald     hci_stack->classic_oob_con_handle = HCI_CON_HANDLE_INVALID;
4903cf01e888SMatthias Ringwald #endif
4904cf01e888SMatthias Ringwald 
4905595bdbfbS[email protected]     // LE
4906b95a5a35SMatthias Ringwald #ifdef ENABLE_BLE
4907b95a5a35SMatthias Ringwald     memset(hci_stack->le_random_address, 0, 6);
4908b95a5a35SMatthias Ringwald     hci_stack->le_random_address_set = 0;
4909d70217a2SMatthias Ringwald #endif
4910d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
4911a61834b6SMatthias Ringwald     hci_stack->le_scanning_active  = false;
491273799937SMatthias Ringwald     hci_stack->le_scanning_param_update = true;
4913b04dfa37SMatthias Ringwald     hci_stack->le_connecting_state = LE_CONNECTING_IDLE;
4914d5b1a89eSMatthias Ringwald     hci_stack->le_connecting_request = LE_CONNECTING_IDLE;
4915e83201bcSMatthias Ringwald     hci_stack->le_whitelist_capacity = 0;
49164bafedd5SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
49174bafedd5SMatthias Ringwald     hci_stack->le_periodic_terminate_sync_handle = HCI_CON_HANDLE_INVALID;
49184bafedd5SMatthias Ringwald #endif
4919d70217a2SMatthias Ringwald #endif
4920a61834b6SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
4921935aa76eSMatthias Ringwald     hci_stack->le_advertisements_state &= ~LE_ADVERTISEMENT_STATE_ACTIVE;
49226bf435a6SMatthias Ringwald     if ((hci_stack->le_advertisements_state & LE_ADVERTISEMENT_STATE_PARAMS_SET) != 0){
4923a61834b6SMatthias Ringwald         hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_SET_PARAMS;
4924a61834b6SMatthias Ringwald     }
4925a61834b6SMatthias Ringwald     if (hci_stack->le_advertisements_data != NULL){
4926a61834b6SMatthias Ringwald         hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_SET_ADV_DATA;
4927a61834b6SMatthias Ringwald     }
4928a61834b6SMatthias Ringwald #endif
4929d320e123SMatthias Ringwald #ifdef ENABLE_LE_PRIVACY_ADDRESS_RESOLUTION
4930d320e123SMatthias Ringwald     hci_stack->le_resolving_list_state = LE_RESOLVING_LIST_SEND_ENABLE_ADDRESS_RESOLUTION;
4931d320e123SMatthias Ringwald #endif
493240f86dfdSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
493326b93350SMatthias Ringwald     hci_stack->iso_active_operation_type = HCI_ISO_TYPE_INVALID;
4934d75a6bbfSMatthias Ringwald     hci_stack->iso_active_operation_group_id = HCI_ISO_GROUP_ID_INVALID;
493540f86dfdSMatthias Ringwald #endif
493691036612SMatthias Ringwald #ifdef ENABLE_HCI_COMMAND_STATUS_DISCARDED_FOR_FAILED_CONNECTIONS_WORKAROUND
4937f48a5586SMatthias Ringwald     hci_stack->hci_command_con_handle = HCI_CON_HANDLE_INVALID;
4938f48a5586SMatthias Ringwald #endif
4939595bdbfbS[email protected] }
4940595bdbfbS[email protected] 
494135454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
49422d5e09d6SMatthias Ringwald /**
49432d5e09d6SMatthias Ringwald  * @brief Configure Bluetooth hardware control. Has to be called before power on.
49442d5e09d6SMatthias Ringwald  */
49452d5e09d6SMatthias Ringwald void hci_set_link_key_db(btstack_link_key_db_t const * link_key_db){
49462d5e09d6SMatthias Ringwald     // store and open remote device db
49472d5e09d6SMatthias Ringwald     hci_stack->link_key_db = link_key_db;
49482d5e09d6SMatthias Ringwald     if (hci_stack->link_key_db) {
49492d5e09d6SMatthias Ringwald         hci_stack->link_key_db->open();
49502d5e09d6SMatthias Ringwald     }
49512d5e09d6SMatthias Ringwald }
495235454696SMatthias Ringwald #endif
49532d5e09d6SMatthias Ringwald 
49542d5e09d6SMatthias Ringwald void hci_init(const hci_transport_t *transport, const void *config){
4955475c8125Smatthias.ringwald 
49563a9fb326S[email protected] #ifdef HAVE_MALLOC
49573a9fb326S[email protected]     if (!hci_stack) {
49583a9fb326S[email protected]         hci_stack = (hci_stack_t*) malloc(sizeof(hci_stack_t));
49593a9fb326S[email protected]     }
4960b1202089SMatthias Ringwald     btstack_assert(hci_stack != NULL);
49613a9fb326S[email protected] #else
49623a9fb326S[email protected]     hci_stack = &hci_stack_static;
49633a9fb326S[email protected] #endif
496466fb9560S[email protected]     memset(hci_stack, 0, sizeof(hci_stack_t));
49653a9fb326S[email protected] 
4966475c8125Smatthias.ringwald     // reference to use transport layer implementation
49673a9fb326S[email protected]     hci_stack->hci_transport = transport;
4968475c8125Smatthias.ringwald 
496911e23e5fSmatthias.ringwald     // reference to used config
49703a9fb326S[email protected]     hci_stack->config = config;
497111e23e5fSmatthias.ringwald 
497226a9b6daSMatthias Ringwald     // setup pointer for outgoing packet buffer
497326a9b6daSMatthias Ringwald     hci_stack->hci_packet_buffer = &hci_stack->hci_packet_buffer_data[HCI_OUTGOING_PRE_BUFFER_SIZE];
497426a9b6daSMatthias Ringwald 
49758fcba05dSmatthias.ringwald     // max acl payload size defined in config.h
49763a9fb326S[email protected]     hci_stack->acl_data_packet_length = HCI_ACL_PAYLOAD_SIZE;
49778fcba05dSmatthias.ringwald 
497816833f0aSmatthias.ringwald     // register packet handlers with transport
497910e830c9Smatthias.ringwald     transport->register_packet_handler(&packet_handler);
4980f5454fc6Smatthias.ringwald 
49813a9fb326S[email protected]     hci_stack->state = HCI_STATE_OFF;
4982e2386ba1S[email protected] 
4983e2386ba1S[email protected]     // class of device
49843a9fb326S[email protected]     hci_stack->class_of_device = 0x007a020c; // Smartphone
4985a45d6b9fS[email protected] 
4986f20168b8Smatthias.ringwald     // bondable by default
4987f20168b8Smatthias.ringwald     hci_stack->bondable = 1;
4988f20168b8Smatthias.ringwald 
4989e9f343c8SMatthias Ringwald #ifdef ENABLE_CLASSIC
499063168530SMatthias Ringwald     // classic name
499163168530SMatthias Ringwald     hci_stack->local_name = default_classic_name;
4992c4c88f1bSJakob Krantz 
4993c4c88f1bSJakob Krantz     // Master slave policy
4994c4c88f1bSJakob Krantz     hci_stack->master_slave_policy = 1;
4995170fafaeSMatthias Ringwald 
4996b4eb4420SMatthias Ringwald     // Allow Role Switch
4997b4eb4420SMatthias Ringwald     hci_stack->allow_role_switch = 1;
4998b4eb4420SMatthias Ringwald 
499978315a58SMatthias Ringwald     // Default / minimum security level = 2
500078315a58SMatthias Ringwald     hci_stack->gap_security_level = LEVEL_2;
500178315a58SMatthias Ringwald 
50025dbec6b3SMatthias Ringwald     // Default Security Mode 4
50035dbec6b3SMatthias Ringwald     hci_stack->gap_security_mode = GAP_SECURITY_MODE_4;
50045dbec6b3SMatthias Ringwald 
5005cd345294SMatthias Ringwald     // Errata-11838 mandates 7 bytes for GAP Security Level 1-3
5006cd345294SMatthias Ringwald     hci_stack->gap_required_encyrption_key_size = 7;
5007d821984bSMatthias Ringwald 
5008d821984bSMatthias Ringwald     // Link Supervision Timeout
5009d821984bSMatthias Ringwald     hci_stack->link_supervision_timeout = HCI_LINK_SUPERVISION_TIMEOUT_DEFAULT;
5010d821984bSMatthias Ringwald 
5011c874aa46SMatthias Ringwald     // Page Timeout
5012c874aa46SMatthias Ringwald     hci_stack->page_timeout = 0x6000;  // ca. 15 sec
5013c874aa46SMatthias Ringwald 
5014a086dc35SMatthias Ringwald     // All ACL packet types are enabled
5015028ead5eSMatthias Ringwald     hci_stack->enabled_packet_types_acl = ACL_PACKET_TYPES_ALL;
5016e9f343c8SMatthias Ringwald #endif
501763168530SMatthias Ringwald 
501863048403S[email protected]     // Secure Simple Pairing default: enable, no I/O capabilities, general bonding, mitm not required, auto accept
50193a9fb326S[email protected]     hci_stack->ssp_enable = 1;
50203a9fb326S[email protected]     hci_stack->ssp_io_capability = SSP_IO_CAPABILITY_NO_INPUT_NO_OUTPUT;
50213a9fb326S[email protected]     hci_stack->ssp_authentication_requirement = SSP_IO_AUTHREQ_MITM_PROTECTION_NOT_REQUIRED_GENERAL_BONDING;
50223a9fb326S[email protected]     hci_stack->ssp_auto_accept = 1;
502369a97523S[email protected] 
50245d23aae8SMatthias Ringwald     // Secure Connections: enable (requires support from Controller)
50255d23aae8SMatthias Ringwald     hci_stack->secure_connections_enable = true;
50265d23aae8SMatthias Ringwald 
5027fac2e2feSMatthias Ringwald     // voice setting - signed 16 bit pcm data with CVSD over the air
5028fac2e2feSMatthias Ringwald     hci_stack->sco_voice_setting = 0x60;
5029d950d659SMatthias Ringwald 
50300c2c5f79SMatthias Ringwald #ifdef ENABLE_BLE
5031cbe54ab2SJakob Krantz     hci_stack->le_connection_scan_interval = 0x0060;   //    60 ms
5032cbe54ab2SJakob Krantz     hci_stack->le_connection_scan_window   = 0x0030;    //   30 ms
5033831711daSMatthias Ringwald     hci_stack->le_connection_interval_min  = 0x0008;    //   10 ms
5034831711daSMatthias Ringwald     hci_stack->le_connection_interval_max  = 0x0018;    //   30 ms
5035831711daSMatthias Ringwald     hci_stack->le_connection_latency       =      4;    //    4
5036831711daSMatthias Ringwald     hci_stack->le_supervision_timeout      = 0x0048;    //  720 ms
503724d14ae3SMatthias Ringwald     hci_stack->le_minimum_ce_length        =      0;    //    0 ms
503824d14ae3SMatthias Ringwald     hci_stack->le_maximum_ce_length        =      0;    //    0 ms
50390c2c5f79SMatthias Ringwald #endif
50400c2c5f79SMatthias Ringwald 
50410c2c5f79SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
50427eb5b27eSMatthias Ringwald     hci_stack->le_connection_phys          =   0x01;    // LE 1M PHY
50437261e5d8SMatthias Ringwald 
50447261e5d8SMatthias Ringwald     // default LE Scanning
50457eb5b27eSMatthias Ringwald     hci_stack->le_scan_type     =  0x01; // active
50468b69e4c7SMatthias Ringwald     hci_stack->le_scan_interval = 0x1e0; // 300 ms
50478b69e4c7SMatthias Ringwald     hci_stack->le_scan_window   =  0x30; //  30 ms
50487eb5b27eSMatthias Ringwald     hci_stack->le_scan_phys     =  0x01; // LE 1M PHY
5049831711daSMatthias Ringwald #endif
5050831711daSMatthias Ringwald 
50512b6ab3e6SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
50522b6ab3e6SMatthias Ringwald     hci_stack->le_max_number_peripheral_connections = 1; // only single connection as peripheral
5053ee605458SMatthias Ringwald 
5054ee605458SMatthias Ringwald     // default advertising parameters from Core v5.4 -- needed to use random address without prior adv setup
5055ee605458SMatthias Ringwald     hci_stack->le_advertisements_interval_min =                         0x0800;
5056ee605458SMatthias Ringwald     hci_stack->le_advertisements_interval_max =                         0x0800;
5057ee605458SMatthias Ringwald     hci_stack->le_advertisements_type =                                      0;
5058ee605458SMatthias Ringwald     hci_stack->le_own_addr_type =                       BD_ADDR_TYPE_LE_PUBLIC;
5059ee605458SMatthias Ringwald     hci_stack->le_advertisements_direct_address_type =  BD_ADDR_TYPE_LE_PUBLIC;
5060ee605458SMatthias Ringwald     hci_stack->le_advertisements_channel_map =                            0x07;
5061ee605458SMatthias Ringwald     hci_stack->le_advertisements_filter_policy =                             0;
50622b6ab3e6SMatthias Ringwald #endif
50632b6ab3e6SMatthias Ringwald 
5064831711daSMatthias Ringwald     // connection parameter range used to answer connection parameter update requests in l2cap
5065831711daSMatthias Ringwald     hci_stack->le_connection_parameter_range.le_conn_interval_min =          6;
5066831711daSMatthias Ringwald     hci_stack->le_connection_parameter_range.le_conn_interval_max =       3200;
5067831711daSMatthias Ringwald     hci_stack->le_connection_parameter_range.le_conn_latency_min =           0;
5068831711daSMatthias Ringwald     hci_stack->le_connection_parameter_range.le_conn_latency_max =         500;
5069831711daSMatthias Ringwald     hci_stack->le_connection_parameter_range.le_supervision_timeout_min =   10;
5070831711daSMatthias Ringwald     hci_stack->le_connection_parameter_range.le_supervision_timeout_max = 3200;
5071831711daSMatthias Ringwald 
507201d4f05fSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
507301d4f05fSMatthias Ringwald     hci_stack->iso_packets_to_queue = 1;
507401d4f05fSMatthias Ringwald #endif
507501d4f05fSMatthias Ringwald 
5076c3d19a30SMatthias Ringwald #ifdef ENABLE_LE_PRIVACY_ADDRESS_RESOLUTION
5077c3d19a30SMatthias Ringwald     hci_stack->le_privacy_mode = LE_PRIVACY_MODE_DEVICE;
5078c3d19a30SMatthias Ringwald #endif
5079c3d19a30SMatthias Ringwald 
5080595bdbfbS[email protected]     hci_state_reset();
5081475c8125Smatthias.ringwald }
5082475c8125Smatthias.ringwald 
50834688f216SMatthias Ringwald void hci_deinit(void){
5084b02cfc15SMatthias Ringwald     btstack_run_loop_remove_timer(&hci_stack->timeout);
50854688f216SMatthias Ringwald #ifdef HAVE_MALLOC
50864688f216SMatthias Ringwald     if (hci_stack) {
50874688f216SMatthias Ringwald         free(hci_stack);
50884688f216SMatthias Ringwald     }
50894688f216SMatthias Ringwald #endif
50904688f216SMatthias Ringwald     hci_stack = NULL;
5091b5bbcbf4SMatthias Ringwald 
5092b5bbcbf4SMatthias Ringwald #ifdef ENABLE_CLASSIC
50934688f216SMatthias Ringwald     disable_l2cap_timeouts = 0;
5094b5bbcbf4SMatthias Ringwald #endif
50954688f216SMatthias Ringwald }
50964688f216SMatthias Ringwald 
50973fb36a29SMatthias Ringwald /**
50983fb36a29SMatthias Ringwald  * @brief Configure Bluetooth chipset driver. Has to be called before power on, or right after receiving the local version information
50993fb36a29SMatthias Ringwald  */
51003fb36a29SMatthias Ringwald void hci_set_chipset(const btstack_chipset_t *chipset_driver){
51013fb36a29SMatthias Ringwald     hci_stack->chipset = chipset_driver;
51023fb36a29SMatthias Ringwald 
51033fb36a29SMatthias Ringwald     // reset chipset driver - init is also called on power_up
51043fb36a29SMatthias Ringwald     if (hci_stack->chipset && hci_stack->chipset->init){
51053fb36a29SMatthias Ringwald         hci_stack->chipset->init(hci_stack->config);
51063fb36a29SMatthias Ringwald     }
51073fb36a29SMatthias Ringwald }
51083fb36a29SMatthias Ringwald 
51096fe16221SMatthias Ringwald void hci_enable_custom_pre_init(void){
51106fe16221SMatthias Ringwald     hci_stack->chipset_pre_init = true;
51116fe16221SMatthias Ringwald }
51126fe16221SMatthias Ringwald 
5113fb55bd0aSMatthias Ringwald /**
5114d0b87befSMatthias Ringwald  * @brief Configure Bluetooth hardware control. Has to be called after hci_init() but before power on.
5115fb55bd0aSMatthias Ringwald  */
5116fb55bd0aSMatthias Ringwald void hci_set_control(const btstack_control_t *hardware_control){
5117fb55bd0aSMatthias Ringwald     // references to used control implementation
5118fb55bd0aSMatthias Ringwald     hci_stack->control = hardware_control;
5119d0b87befSMatthias Ringwald     // init with transport config
5120d0b87befSMatthias Ringwald     hardware_control->init(hci_stack->config);
5121fb55bd0aSMatthias Ringwald }
5122fb55bd0aSMatthias Ringwald 
51231f9eb2ccSMatthias Ringwald static void hci_discard_connections(void){
5124346f8c2cSMatthias Ringwald     btstack_linked_list_iterator_t it;
5125346f8c2cSMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->connections);
5126346f8c2cSMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
5127a086dc35SMatthias Ringwald         // cancel all l2cap connections by emitting disconnection complete before shutdown (free) connection
5128346f8c2cSMatthias Ringwald         hci_connection_t * connection = (hci_connection_t*) btstack_linked_list_iterator_next(&it);
51291f9eb2ccSMatthias Ringwald         hci_emit_disconnection_complete(connection->con_handle, 0x16); // terminated by local host
51301f9eb2ccSMatthias Ringwald         hci_shutdown_connection(connection);
51311f9eb2ccSMatthias Ringwald     }
5132346f8c2cSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
5133346f8c2cSMatthias Ringwald     while (hci_stack->iso_streams != NULL){
5134346f8c2cSMatthias Ringwald         hci_iso_stream_finalize((hci_iso_stream_t *) hci_stack->iso_streams);
5135346f8c2cSMatthias Ringwald     }
5136346f8c2cSMatthias Ringwald #endif
51371f9eb2ccSMatthias Ringwald }
51381f9eb2ccSMatthias Ringwald 
513971de195eSMatthias Ringwald void hci_close(void){
5140e6d6524dSMatthias Ringwald 
5141e6d6524dSMatthias Ringwald #ifdef ENABLE_CLASSIC
5142404843c1Smatthias.ringwald     // close remote device db
5143a98592bcSMatthias Ringwald     if (hci_stack->link_key_db) {
5144a98592bcSMatthias Ringwald         hci_stack->link_key_db->close();
5145404843c1Smatthias.ringwald     }
5146e6d6524dSMatthias Ringwald #endif
51477224be7eSMatthias Ringwald 
51481f9eb2ccSMatthias Ringwald     hci_discard_connections();
51497224be7eSMatthias Ringwald 
5150f5454fc6Smatthias.ringwald     hci_power_control(HCI_POWER_OFF);
51513a9fb326S[email protected] 
51523a9fb326S[email protected] #ifdef HAVE_MALLOC
51533a9fb326S[email protected]     free(hci_stack);
51543a9fb326S[email protected] #endif
51553a9fb326S[email protected]     hci_stack = NULL;
5156404843c1Smatthias.ringwald }
5157404843c1Smatthias.ringwald 
5158cb70c5abSMatthias Ringwald #ifdef HAVE_SCO_TRANSPORT
5159cb70c5abSMatthias Ringwald void hci_set_sco_transport(const btstack_sco_transport_t *sco_transport){
5160cb70c5abSMatthias Ringwald     hci_stack->sco_transport = sco_transport;
5161cb70c5abSMatthias Ringwald     sco_transport->register_packet_handler(&packet_handler);
5162cb70c5abSMatthias Ringwald }
5163cb70c5abSMatthias Ringwald #endif
5164cb70c5abSMatthias Ringwald 
516535454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
5166170fafaeSMatthias Ringwald void gap_set_required_encryption_key_size(uint8_t encryption_key_size){
5167a086dc35SMatthias Ringwald     // validate range and set
5168170fafaeSMatthias Ringwald     if (encryption_key_size < 7)  return;
5169170fafaeSMatthias Ringwald     if (encryption_key_size > 16) return;
5170170fafaeSMatthias Ringwald     hci_stack->gap_required_encyrption_key_size = encryption_key_size;
5171170fafaeSMatthias Ringwald }
517278315a58SMatthias Ringwald 
5173137715ebSMatthias Ringwald uint8_t gap_set_security_mode(gap_security_mode_t security_mode){
5174137715ebSMatthias Ringwald     if ((security_mode == GAP_SECURITY_MODE_4) || (security_mode == GAP_SECURITY_MODE_2)){
51755dbec6b3SMatthias Ringwald         hci_stack->gap_security_mode = security_mode;
5176137715ebSMatthias Ringwald         return ERROR_CODE_SUCCESS;
5177137715ebSMatthias Ringwald     } else {
5178137715ebSMatthias Ringwald         return ERROR_CODE_UNSUPPORTED_FEATURE_OR_PARAMETER_VALUE;
5179137715ebSMatthias Ringwald     }
51805dbec6b3SMatthias Ringwald }
51815dbec6b3SMatthias Ringwald 
51825dbec6b3SMatthias Ringwald gap_security_mode_t gap_get_security_mode(void){
51835dbec6b3SMatthias Ringwald     return hci_stack->gap_security_mode;
51845dbec6b3SMatthias Ringwald }
51855dbec6b3SMatthias Ringwald 
518678315a58SMatthias Ringwald void gap_set_security_level(gap_security_level_t security_level){
518778315a58SMatthias Ringwald     hci_stack->gap_security_level = security_level;
518878315a58SMatthias Ringwald }
518978315a58SMatthias Ringwald 
519078315a58SMatthias Ringwald gap_security_level_t gap_get_security_level(void){
5191d7387af3SMatthias Ringwald     if (hci_stack->gap_secure_connections_only_mode){
5192d7387af3SMatthias Ringwald         return LEVEL_4;
5193d7387af3SMatthias Ringwald     }
519478315a58SMatthias Ringwald     return hci_stack->gap_security_level;
519578315a58SMatthias Ringwald }
519630cdf3c6SMatthias Ringwald 
51978ad4dfffSMatthias Ringwald void gap_set_minimal_service_security_level(gap_security_level_t security_level){
51988ad4dfffSMatthias Ringwald     hci_stack->gap_minimal_service_security_level = security_level;
51998ad4dfffSMatthias Ringwald }
52008ad4dfffSMatthias Ringwald 
520130cdf3c6SMatthias Ringwald void gap_set_secure_connections_only_mode(bool enable){
520230cdf3c6SMatthias Ringwald     hci_stack->gap_secure_connections_only_mode = enable;
520330cdf3c6SMatthias Ringwald }
520430cdf3c6SMatthias Ringwald 
520530cdf3c6SMatthias Ringwald bool gap_get_secure_connections_only_mode(void){
520630cdf3c6SMatthias Ringwald     return hci_stack->gap_secure_connections_only_mode;
520730cdf3c6SMatthias Ringwald }
5208170fafaeSMatthias Ringwald #endif
5209170fafaeSMatthias Ringwald 
5210170fafaeSMatthias Ringwald #ifdef ENABLE_CLASSIC
521160b9e82fSMatthias Ringwald void gap_set_class_of_device(uint32_t class_of_device){
52129e61646fS[email protected]     hci_stack->class_of_device = class_of_device;
5213baa4881eSMatthias Ringwald     hci_stack->gap_tasks_classic |= GAP_TASK_SET_CLASS_OF_DEVICE;
521459d59ecfSMatthias Ringwald     hci_run();
52159e61646fS[email protected] }
521676f27cffSMatthias Ringwald 
5217c33e56d3SMatthias Ringwald void gap_set_default_link_policy_settings(uint16_t default_link_policy_settings){
5218c33e56d3SMatthias Ringwald     hci_stack->default_link_policy_settings = default_link_policy_settings;
5219baa4881eSMatthias Ringwald     hci_stack->gap_tasks_classic |= GAP_TASK_SET_DEFAULT_LINK_POLICY;
522059d59ecfSMatthias Ringwald     hci_run();
5221c33e56d3SMatthias Ringwald }
5222c33e56d3SMatthias Ringwald 
5223b4eb4420SMatthias Ringwald void gap_set_allow_role_switch(bool allow_role_switch){
5224b4eb4420SMatthias Ringwald     hci_stack->allow_role_switch = allow_role_switch ? 1 : 0;
5225b4eb4420SMatthias Ringwald }
5226b4eb4420SMatthias Ringwald 
5227b4eb4420SMatthias Ringwald uint8_t hci_get_allow_role_switch(void){
5228b4eb4420SMatthias Ringwald     return  hci_stack->allow_role_switch;
5229b4eb4420SMatthias Ringwald }
5230b4eb4420SMatthias Ringwald 
52310c3eb48dSMatthias Ringwald void gap_set_link_supervision_timeout(uint16_t link_supervision_timeout){
52320c3eb48dSMatthias Ringwald     hci_stack->link_supervision_timeout = link_supervision_timeout;
52330c3eb48dSMatthias Ringwald }
52340c3eb48dSMatthias Ringwald 
52359afaa4d4SMatthias Ringwald void gap_enable_link_watchdog(uint16_t timeout_ms){
52369afaa4d4SMatthias Ringwald     hci_stack->automatic_flush_timeout = btstack_min(timeout_ms, 1280) * 8 / 5; // divide by 0.625
52379afaa4d4SMatthias Ringwald }
52389afaa4d4SMatthias Ringwald 
52399afaa4d4SMatthias Ringwald uint16_t hci_automatic_flush_timeout(void){
52409afaa4d4SMatthias Ringwald     return hci_stack->automatic_flush_timeout;
52419afaa4d4SMatthias Ringwald }
52429afaa4d4SMatthias Ringwald 
524376f27cffSMatthias Ringwald void hci_disable_l2cap_timeout_check(void){
524476f27cffSMatthias Ringwald     disable_l2cap_timeouts = 1;
524576f27cffSMatthias Ringwald }
524635454696SMatthias Ringwald #endif
52479e61646fS[email protected] 
52486fad2c37SMatthias Ringwald #ifndef HAVE_HOST_CONTROLLER_API
5249f456b2d0S[email protected] // Set Public BD ADDR - passed on to Bluetooth chipset if supported in bt_control_h
5250f456b2d0S[email protected] void hci_set_bd_addr(bd_addr_t addr){
52516535961aSMatthias Ringwald     (void)memcpy(hci_stack->custom_bd_addr, addr, 6);
5252f456b2d0S[email protected]     hci_stack->custom_bd_addr_set = 1;
5253f456b2d0S[email protected] }
525476f27cffSMatthias Ringwald #endif
5255f456b2d0S[email protected] 
52568d213e1aSmatthias.ringwald // State-Module-Driver overview
52578d213e1aSmatthias.ringwald // state                    module  low-level
52588d213e1aSmatthias.ringwald // HCI_STATE_OFF             off      close
52598d213e1aSmatthias.ringwald // HCI_STATE_INITIALIZING,   on       open
52608d213e1aSmatthias.ringwald // HCI_STATE_WORKING,        on       open
52618d213e1aSmatthias.ringwald // HCI_STATE_HALTING,        on       open
5262d661ed19Smatthias.ringwald // HCI_STATE_SLEEPING,    off/sleep   close
5263d661ed19Smatthias.ringwald // HCI_STATE_FALLING_ASLEEP  on       open
5264c7e0c5f6Smatthias.ringwald 
526540d1c7a4Smatthias.ringwald static int hci_power_control_on(void){
52667301ad89Smatthias.ringwald 
5267038bc64cSmatthias.ringwald     // power on
5268f9a30166Smatthias.ringwald     int err = 0;
52693a9fb326S[email protected]     if (hci_stack->control && hci_stack->control->on){
5270d0b87befSMatthias Ringwald         err = (*hci_stack->control->on)();
5271f9a30166Smatthias.ringwald     }
5272038bc64cSmatthias.ringwald     if (err){
52739da54300S[email protected]         log_error( "POWER_ON failed");
5274038bc64cSmatthias.ringwald         hci_emit_hci_open_failed();
5275038bc64cSmatthias.ringwald         return err;
5276038bc64cSmatthias.ringwald     }
5277038bc64cSmatthias.ringwald 
527824b3c629SMatthias Ringwald     // int chipset driver
52793fb36a29SMatthias Ringwald     if (hci_stack->chipset && hci_stack->chipset->init){
52803fb36a29SMatthias Ringwald         hci_stack->chipset->init(hci_stack->config);
52813fb36a29SMatthias Ringwald     }
52823fb36a29SMatthias Ringwald 
528324b3c629SMatthias Ringwald     // init transport
528424b3c629SMatthias Ringwald     if (hci_stack->hci_transport->init){
528524b3c629SMatthias Ringwald         hci_stack->hci_transport->init(hci_stack->config);
528624b3c629SMatthias Ringwald     }
528724b3c629SMatthias Ringwald 
528824b3c629SMatthias Ringwald     // open transport
528924b3c629SMatthias Ringwald     err = hci_stack->hci_transport->open();
5290038bc64cSmatthias.ringwald     if (err){
52919da54300S[email protected]         log_error( "HCI_INIT failed, turning Bluetooth off again");
52923a9fb326S[email protected]         if (hci_stack->control && hci_stack->control->off){
5293d0b87befSMatthias Ringwald             (*hci_stack->control->off)();
5294f9a30166Smatthias.ringwald         }
5295038bc64cSmatthias.ringwald         hci_emit_hci_open_failed();
5296038bc64cSmatthias.ringwald         return err;
5297038bc64cSmatthias.ringwald     }
52988d213e1aSmatthias.ringwald     return 0;
52998d213e1aSmatthias.ringwald }
5300038bc64cSmatthias.ringwald 
530140d1c7a4Smatthias.ringwald static void hci_power_control_off(void){
53028d213e1aSmatthias.ringwald 
53039da54300S[email protected]     log_info("hci_power_control_off");
53049418f9c9Smatthias.ringwald 
53058d213e1aSmatthias.ringwald     // close low-level device
530624b3c629SMatthias Ringwald     hci_stack->hci_transport->close();
53078d213e1aSmatthias.ringwald 
53089da54300S[email protected]     log_info("hci_power_control_off - hci_transport closed");
53099418f9c9Smatthias.ringwald 
53108d213e1aSmatthias.ringwald     // power off
53113a9fb326S[email protected]     if (hci_stack->control && hci_stack->control->off){
5312d0b87befSMatthias Ringwald         (*hci_stack->control->off)();
53138d213e1aSmatthias.ringwald     }
53149418f9c9Smatthias.ringwald 
53159da54300S[email protected]     log_info("hci_power_control_off - control closed");
53169418f9c9Smatthias.ringwald 
53173a9fb326S[email protected]     hci_stack->state = HCI_STATE_OFF;
531872ea5239Smatthias.ringwald }
531972ea5239Smatthias.ringwald 
532040d1c7a4Smatthias.ringwald static void hci_power_control_sleep(void){
532172ea5239Smatthias.ringwald 
53229da54300S[email protected]     log_info("hci_power_control_sleep");
53233144bce4Smatthias.ringwald 
5324b429b9b7Smatthias.ringwald #if 0
5325b429b9b7Smatthias.ringwald     // don't close serial port during sleep
5326b429b9b7Smatthias.ringwald 
532772ea5239Smatthias.ringwald     // close low-level device
53283a9fb326S[email protected]     hci_stack->hci_transport->close(hci_stack->config);
5329b429b9b7Smatthias.ringwald #endif
533072ea5239Smatthias.ringwald 
533172ea5239Smatthias.ringwald     // sleep mode
53323a9fb326S[email protected]     if (hci_stack->control && hci_stack->control->sleep){
5333d0b87befSMatthias Ringwald         (*hci_stack->control->sleep)();
533472ea5239Smatthias.ringwald     }
5335b429b9b7Smatthias.ringwald 
53363a9fb326S[email protected]     hci_stack->state = HCI_STATE_SLEEPING;
53378d213e1aSmatthias.ringwald }
53388d213e1aSmatthias.ringwald 
533940d1c7a4Smatthias.ringwald static int hci_power_control_wake(void){
5340b429b9b7Smatthias.ringwald 
53419da54300S[email protected]     log_info("hci_power_control_wake");
5342b429b9b7Smatthias.ringwald 
5343b429b9b7Smatthias.ringwald     // wake on
53443a9fb326S[email protected]     if (hci_stack->control && hci_stack->control->wake){
5345d0b87befSMatthias Ringwald         (*hci_stack->control->wake)();
5346b429b9b7Smatthias.ringwald     }
5347b429b9b7Smatthias.ringwald 
5348b429b9b7Smatthias.ringwald #if 0
5349b429b9b7Smatthias.ringwald     // open low-level device
53503a9fb326S[email protected]     int err = hci_stack->hci_transport->open(hci_stack->config);
5351b429b9b7Smatthias.ringwald     if (err){
53529da54300S[email protected]         log_error( "HCI_INIT failed, turning Bluetooth off again");
53533a9fb326S[email protected]         if (hci_stack->control && hci_stack->control->off){
5354d0b87befSMatthias Ringwald             (*hci_stack->control->off)();
5355b429b9b7Smatthias.ringwald         }
5356b429b9b7Smatthias.ringwald         hci_emit_hci_open_failed();
5357b429b9b7Smatthias.ringwald         return err;
5358b429b9b7Smatthias.ringwald     }
5359b429b9b7Smatthias.ringwald #endif
5360b429b9b7Smatthias.ringwald 
5361b429b9b7Smatthias.ringwald     return 0;
5362b429b9b7Smatthias.ringwald }
5363b429b9b7Smatthias.ringwald 
53640c88d5efSMatthias Ringwald static void hci_power_enter_initializing_state(void){
536544935e40S[email protected]     // set up state machine
536644935e40S[email protected]     hci_stack->num_cmd_packets = 1; // assume that one cmd can be sent
536702c7fc01SMatthias Ringwald     hci_stack->hci_packet_buffer_reserved = false;
536844935e40S[email protected]     hci_stack->state = HCI_STATE_INITIALIZING;
53696fe16221SMatthias Ringwald 
53700535e08cSMatthias Ringwald #ifndef HAVE_HOST_CONTROLLER_API
53716fe16221SMatthias Ringwald     if (hci_stack->chipset_pre_init) {
53726fe16221SMatthias Ringwald         hci_stack->substate = HCI_INIT_CUSTOM_PRE_INIT;
53730535e08cSMatthias Ringwald     } else
53740535e08cSMatthias Ringwald #endif
53750535e08cSMatthias Ringwald     {
53765c363727SMatthias Ringwald         hci_stack->substate = HCI_INIT_SEND_RESET;
537744935e40S[email protected]     }
53786fe16221SMatthias Ringwald }
5379b429b9b7Smatthias.ringwald 
53800c88d5efSMatthias Ringwald static void hci_power_enter_halting_state(void){
53810c88d5efSMatthias Ringwald #ifdef ENABLE_BLE
53821e907691SMatthias Ringwald     // drop entries scheduled for removal, mark others for re-adding
53831e907691SMatthias Ringwald     btstack_linked_list_iterator_t it;
53841e907691SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->le_whitelist);
53851e907691SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
53861e907691SMatthias Ringwald         whitelist_entry_t * entry = (whitelist_entry_t*) btstack_linked_list_iterator_next(&it);
53871e907691SMatthias Ringwald         if ((entry->state & (LE_WHITELIST_REMOVE_FROM_CONTROLLER | LE_WHITELIST_ADD_TO_CONTROLLER)) == LE_WHITELIST_REMOVE_FROM_CONTROLLER){
53881e907691SMatthias Ringwald             btstack_linked_list_iterator_remove(&it);
53891e907691SMatthias Ringwald             btstack_memory_whitelist_entry_free(entry);
53901e907691SMatthias Ringwald         } else {
53911e907691SMatthias Ringwald             entry->state = LE_WHITELIST_ADD_TO_CONTROLLER;
53921e907691SMatthias Ringwald         }
53931e907691SMatthias Ringwald     }
53944718c38dSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
5395a2c9d908SMatthias Ringwald #ifdef ENABLE_LE_PERIODIC_ADVERTISING
5396e8d160b3SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->le_periodic_advertiser_list);
5397e8d160b3SMatthias Ringwald     const uint8_t mask = LE_PERIODIC_ADVERTISER_LIST_ENTRY_REMOVE_FROM_CONTROLLER | LE_PERIODIC_ADVERTISER_LIST_ENTRY_REMOVE_FROM_CONTROLLER;
5398e8d160b3SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
5399e8d160b3SMatthias Ringwald         periodic_advertiser_list_entry_t * entry = (periodic_advertiser_list_entry_t*) btstack_linked_list_iterator_next(&it);
5400e8d160b3SMatthias Ringwald         if ((entry->state & mask) == LE_PERIODIC_ADVERTISER_LIST_ENTRY_REMOVE_FROM_CONTROLLER) {
5401e8d160b3SMatthias Ringwald             btstack_linked_list_iterator_remove(&it);
5402e8d160b3SMatthias Ringwald             btstack_memory_periodic_advertiser_list_entry_free(entry);
5403e8d160b3SMatthias Ringwald         } else {
5404e8d160b3SMatthias Ringwald             entry->state |= LE_PERIODIC_ADVERTISER_LIST_ENTRY_ADD_TO_CONTROLLER;
5405e8d160b3SMatthias Ringwald             continue;
5406e8d160b3SMatthias Ringwald         }
5407e8d160b3SMatthias Ringwald     }
5408a2c9d908SMatthias Ringwald #endif
54090c88d5efSMatthias Ringwald #endif
54104718c38dSMatthias Ringwald #endif
5411184dbe2fSMatthias Ringwald     // see hci_run
5412184dbe2fSMatthias Ringwald     hci_stack->state = HCI_STATE_HALTING;
54130c88d5efSMatthias Ringwald     hci_stack->substate = HCI_HALTING_CLASSIC_STOP;
5414184dbe2fSMatthias Ringwald     // setup watchdog timer for disconnect - only triggers if Controller does not respond anymore
5415184dbe2fSMatthias Ringwald     btstack_run_loop_set_timer(&hci_stack->timeout, 1000);
5416184dbe2fSMatthias Ringwald     btstack_run_loop_set_timer_handler(&hci_stack->timeout, hci_halting_timeout_handler);
5417184dbe2fSMatthias Ringwald     btstack_run_loop_add_timer(&hci_stack->timeout);
5418184dbe2fSMatthias Ringwald }
5419184dbe2fSMatthias Ringwald 
542042bd3d77SMatthias Ringwald // returns error
542142bd3d77SMatthias Ringwald static int hci_power_control_state_off(HCI_POWER_MODE power_mode){
542242bd3d77SMatthias Ringwald     int err;
54238d213e1aSmatthias.ringwald     switch (power_mode){
54248d213e1aSmatthias.ringwald         case HCI_POWER_ON:
54258d213e1aSmatthias.ringwald             err = hci_power_control_on();
542642bd3d77SMatthias Ringwald             if (err != 0) {
5427f04a0c31SMatthias Ringwald                 log_error("hci_power_control_on() error %d", err);
542897b61c7bS[email protected]                 return err;
542997b61c7bS[email protected]             }
54300c88d5efSMatthias Ringwald             hci_power_enter_initializing_state();
54318d213e1aSmatthias.ringwald             break;
54328d213e1aSmatthias.ringwald         case HCI_POWER_OFF:
54338d213e1aSmatthias.ringwald             // do nothing
54348d213e1aSmatthias.ringwald             break;
54358d213e1aSmatthias.ringwald         case HCI_POWER_SLEEP:
5436b546ac54Smatthias.ringwald             // do nothing (with SLEEP == OFF)
54378d213e1aSmatthias.ringwald             break;
54387bbeb3adSMilanka Ringwald         default:
54397bbeb3adSMilanka Ringwald             btstack_assert(false);
54407bbeb3adSMilanka Ringwald             break;
54418d213e1aSmatthias.ringwald     }
544242bd3d77SMatthias Ringwald     return ERROR_CODE_SUCCESS;
544342bd3d77SMatthias Ringwald }
54447301ad89Smatthias.ringwald 
544542bd3d77SMatthias Ringwald static int hci_power_control_state_initializing(HCI_POWER_MODE power_mode){
54468d213e1aSmatthias.ringwald     switch (power_mode){
54478d213e1aSmatthias.ringwald         case HCI_POWER_ON:
54488d213e1aSmatthias.ringwald             // do nothing
54498d213e1aSmatthias.ringwald             break;
54508d213e1aSmatthias.ringwald         case HCI_POWER_OFF:
54518d213e1aSmatthias.ringwald             // no connections yet, just turn it off
54528d213e1aSmatthias.ringwald             hci_power_control_off();
54538d213e1aSmatthias.ringwald             break;
54548d213e1aSmatthias.ringwald         case HCI_POWER_SLEEP:
5455b546ac54Smatthias.ringwald             // no connections yet, just turn it off
545672ea5239Smatthias.ringwald             hci_power_control_sleep();
54578d213e1aSmatthias.ringwald             break;
54587bbeb3adSMilanka Ringwald         default:
54597bbeb3adSMilanka Ringwald             btstack_assert(false);
54607bbeb3adSMilanka Ringwald             break;
54618d213e1aSmatthias.ringwald     }
546242bd3d77SMatthias Ringwald     return ERROR_CODE_SUCCESS;
546342bd3d77SMatthias Ringwald }
54647301ad89Smatthias.ringwald 
546542bd3d77SMatthias Ringwald static int hci_power_control_state_working(HCI_POWER_MODE power_mode) {
54668d213e1aSmatthias.ringwald     switch (power_mode){
54678d213e1aSmatthias.ringwald         case HCI_POWER_ON:
54688d213e1aSmatthias.ringwald             // do nothing
54698d213e1aSmatthias.ringwald             break;
54708d213e1aSmatthias.ringwald         case HCI_POWER_OFF:
54710c88d5efSMatthias Ringwald             hci_power_enter_halting_state();
54728d213e1aSmatthias.ringwald             break;
54738d213e1aSmatthias.ringwald         case HCI_POWER_SLEEP:
5474b546ac54Smatthias.ringwald             // see hci_run
54753a9fb326S[email protected]             hci_stack->state = HCI_STATE_FALLING_ASLEEP;
547674b323a9SMatthias Ringwald             hci_stack->substate = HCI_FALLING_ASLEEP_DISCONNECT;
54778d213e1aSmatthias.ringwald             break;
54787bbeb3adSMilanka Ringwald         default:
54797bbeb3adSMilanka Ringwald             btstack_assert(false);
54807bbeb3adSMilanka Ringwald             break;
54818d213e1aSmatthias.ringwald     }
548242bd3d77SMatthias Ringwald     return ERROR_CODE_SUCCESS;
548342bd3d77SMatthias Ringwald }
54847301ad89Smatthias.ringwald 
548542bd3d77SMatthias Ringwald static int hci_power_control_state_halting(HCI_POWER_MODE power_mode) {
54868d213e1aSmatthias.ringwald     switch (power_mode){
54878d213e1aSmatthias.ringwald         case HCI_POWER_ON:
54880c88d5efSMatthias Ringwald             hci_power_enter_initializing_state();
54898d213e1aSmatthias.ringwald             break;
54908d213e1aSmatthias.ringwald         case HCI_POWER_OFF:
54918d213e1aSmatthias.ringwald             // do nothing
54928d213e1aSmatthias.ringwald             break;
54938d213e1aSmatthias.ringwald         case HCI_POWER_SLEEP:
5494b546ac54Smatthias.ringwald             // see hci_run
54953a9fb326S[email protected]             hci_stack->state = HCI_STATE_FALLING_ASLEEP;
549674b323a9SMatthias Ringwald             hci_stack->substate = HCI_FALLING_ASLEEP_DISCONNECT;
54978d213e1aSmatthias.ringwald             break;
54987bbeb3adSMilanka Ringwald         default:
54997bbeb3adSMilanka Ringwald             btstack_assert(false);
55007bbeb3adSMilanka Ringwald             break;
55018d213e1aSmatthias.ringwald     }
550200278272SMatthias Ringwald     return ERROR_CODE_SUCCESS;
550342bd3d77SMatthias Ringwald }
55048d213e1aSmatthias.ringwald 
550542bd3d77SMatthias Ringwald static int hci_power_control_state_falling_asleep(HCI_POWER_MODE power_mode) {
55068d213e1aSmatthias.ringwald     switch (power_mode){
55078d213e1aSmatthias.ringwald         case HCI_POWER_ON:
55080c88d5efSMatthias Ringwald             hci_power_enter_initializing_state();
55098d213e1aSmatthias.ringwald             break;
55108d213e1aSmatthias.ringwald         case HCI_POWER_OFF:
55110c88d5efSMatthias Ringwald             hci_power_enter_halting_state();
55128d213e1aSmatthias.ringwald             break;
55138d213e1aSmatthias.ringwald         case HCI_POWER_SLEEP:
5514b546ac54Smatthias.ringwald             // do nothing
55158d213e1aSmatthias.ringwald             break;
55167bbeb3adSMilanka Ringwald         default:
55177bbeb3adSMilanka Ringwald             btstack_assert(false);
55187bbeb3adSMilanka Ringwald             break;
55198d213e1aSmatthias.ringwald     }
552042bd3d77SMatthias Ringwald     return ERROR_CODE_SUCCESS;
552142bd3d77SMatthias Ringwald }
55228d213e1aSmatthias.ringwald 
552342bd3d77SMatthias Ringwald static int hci_power_control_state_sleeping(HCI_POWER_MODE power_mode) {
552442bd3d77SMatthias Ringwald     int err;
55258d213e1aSmatthias.ringwald     switch (power_mode){
55268d213e1aSmatthias.ringwald         case HCI_POWER_ON:
55273144bce4Smatthias.ringwald             err = hci_power_control_wake();
55283144bce4Smatthias.ringwald             if (err) return err;
55290c88d5efSMatthias Ringwald             hci_power_enter_initializing_state();
55308d213e1aSmatthias.ringwald             break;
55318d213e1aSmatthias.ringwald         case HCI_POWER_OFF:
55320c88d5efSMatthias Ringwald             hci_power_enter_halting_state();
55338d213e1aSmatthias.ringwald             break;
55348d213e1aSmatthias.ringwald         case HCI_POWER_SLEEP:
5535b546ac54Smatthias.ringwald             // do nothing
55368d213e1aSmatthias.ringwald             break;
55377bbeb3adSMilanka Ringwald         default:
55387bbeb3adSMilanka Ringwald             btstack_assert(false);
55397bbeb3adSMilanka Ringwald             break;
55408d213e1aSmatthias.ringwald     }
554142bd3d77SMatthias Ringwald     return ERROR_CODE_SUCCESS;
554242bd3d77SMatthias Ringwald }
55437bbeb3adSMilanka Ringwald 
554442bd3d77SMatthias Ringwald int hci_power_control(HCI_POWER_MODE power_mode){
554542bd3d77SMatthias Ringwald     log_info("hci_power_control: %d, current mode %u", power_mode, hci_stack->state);
5546bef627f1SMatthias Ringwald     btstack_run_loop_remove_timer(&hci_stack->timeout);
554724f87726SMatthias Ringwald     int err = 0;
554842bd3d77SMatthias Ringwald     switch (hci_stack->state){
554942bd3d77SMatthias Ringwald         case HCI_STATE_OFF:
555042bd3d77SMatthias Ringwald             err = hci_power_control_state_off(power_mode);
555142bd3d77SMatthias Ringwald             break;
555242bd3d77SMatthias Ringwald         case HCI_STATE_INITIALIZING:
555342bd3d77SMatthias Ringwald             err = hci_power_control_state_initializing(power_mode);
555442bd3d77SMatthias Ringwald             break;
555542bd3d77SMatthias Ringwald         case HCI_STATE_WORKING:
555642bd3d77SMatthias Ringwald             err = hci_power_control_state_working(power_mode);
555742bd3d77SMatthias Ringwald             break;
555842bd3d77SMatthias Ringwald         case HCI_STATE_HALTING:
555942bd3d77SMatthias Ringwald             err = hci_power_control_state_halting(power_mode);
556042bd3d77SMatthias Ringwald             break;
556142bd3d77SMatthias Ringwald         case HCI_STATE_FALLING_ASLEEP:
556242bd3d77SMatthias Ringwald             err = hci_power_control_state_falling_asleep(power_mode);
556342bd3d77SMatthias Ringwald             break;
556442bd3d77SMatthias Ringwald         case HCI_STATE_SLEEPING:
556542bd3d77SMatthias Ringwald             err = hci_power_control_state_sleeping(power_mode);
556642bd3d77SMatthias Ringwald             break;
55677bbeb3adSMilanka Ringwald         default:
55687bbeb3adSMilanka Ringwald             btstack_assert(false);
55697bbeb3adSMilanka Ringwald             break;
557011e23e5fSmatthias.ringwald     }
557124f87726SMatthias Ringwald     if (err != 0){
557242bd3d77SMatthias Ringwald         return err;
557342bd3d77SMatthias Ringwald     }
557468d92d03Smatthias.ringwald 
5575038bc64cSmatthias.ringwald     // create internal event
5576ee8bf225Smatthias.ringwald 	hci_emit_state();
5577ee8bf225Smatthias.ringwald 
557868d92d03Smatthias.ringwald 	// trigger next/first action
557968d92d03Smatthias.ringwald 	hci_run();
558068d92d03Smatthias.ringwald 
5581475c8125Smatthias.ringwald     return 0;
5582475c8125Smatthias.ringwald }
5583475c8125Smatthias.ringwald 
558435454696SMatthias Ringwald 
5585091e35e3SMatthias Ringwald static void hci_halting_run(void) {
5586091e35e3SMatthias Ringwald 
5587091e35e3SMatthias Ringwald     log_info("HCI_STATE_HALTING, substate %x\n", hci_stack->substate);
5588091e35e3SMatthias Ringwald 
5589091e35e3SMatthias Ringwald     hci_connection_t *connection;
5590d5f71a7eSMatthias Ringwald #ifdef ENABLE_BLE
5591d5f71a7eSMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
5592a086dc35SMatthias Ringwald     bool stop_advertisements;
5593d5f71a7eSMatthias Ringwald #endif
5594d5f71a7eSMatthias Ringwald #endif
5595091e35e3SMatthias Ringwald 
5596091e35e3SMatthias Ringwald     switch (hci_stack->substate) {
55970c88d5efSMatthias Ringwald         case HCI_HALTING_CLASSIC_STOP:
55980c88d5efSMatthias Ringwald #ifdef ENABLE_CLASSIC
5599911801caSMatthias Ringwald             if (!hci_can_send_command_packet_now()) return;
5600911801caSMatthias Ringwald 
56010c88d5efSMatthias Ringwald             if (hci_stack->connectable || hci_stack->discoverable){
56020c88d5efSMatthias Ringwald                 hci_stack->substate = HCI_HALTING_LE_ADV_STOP;
56030c88d5efSMatthias Ringwald                 hci_send_cmd(&hci_write_scan_enable, 0);
56040c88d5efSMatthias Ringwald                 return;
56050c88d5efSMatthias Ringwald             }
56060c88d5efSMatthias Ringwald #endif
56070c88d5efSMatthias Ringwald             /* fall through */
56080c88d5efSMatthias Ringwald 
56090c88d5efSMatthias Ringwald         case HCI_HALTING_LE_ADV_STOP:
56100c88d5efSMatthias Ringwald             hci_stack->substate = HCI_HALTING_LE_ADV_STOP;
56110c88d5efSMatthias Ringwald 
56120c88d5efSMatthias Ringwald #ifdef ENABLE_BLE
56130c88d5efSMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
5614911801caSMatthias Ringwald             if (!hci_can_send_command_packet_now()) return;
5615911801caSMatthias Ringwald 
5616a086dc35SMatthias Ringwald             stop_advertisements = (hci_stack->le_advertisements_state & LE_ADVERTISEMENT_STATE_ACTIVE) != 0;
5617911801caSMatthias Ringwald 
5618911801caSMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
561922f987e4SMatthias Ringwald             if (hci_le_extended_advertising_supported()){
5620c814a904SMatthias Ringwald #ifdef ENABLE_LE_PERIODIC_ADVERTISING
5621911801caSMatthias Ringwald                 btstack_linked_list_iterator_t it;
5622911801caSMatthias Ringwald                 btstack_linked_list_iterator_init(&it, &hci_stack->le_advertising_sets);
5623911801caSMatthias Ringwald                 // stop all periodic advertisements and check if an extended set is active
5624911801caSMatthias Ringwald                 while (btstack_linked_list_iterator_has_next(&it)){
5625911801caSMatthias Ringwald                     le_advertising_set_t * advertising_set = (le_advertising_set_t*) btstack_linked_list_iterator_next(&it);
5626911801caSMatthias Ringwald                     if ((advertising_set->state & LE_ADVERTISEMENT_STATE_PERIODIC_ACTIVE) != 0) {
5627911801caSMatthias Ringwald                         advertising_set->state &= ~LE_ADVERTISEMENT_STATE_PERIODIC_ACTIVE;
5628911801caSMatthias Ringwald                         hci_send_cmd(&hci_le_set_periodic_advertising_enable, 0, advertising_set->advertising_handle);
56290c88d5efSMatthias Ringwald                         return;
56300c88d5efSMatthias Ringwald                     }
5631911801caSMatthias Ringwald                     if ((advertising_set->state & LE_ADVERTISEMENT_STATE_ACTIVE) != 0) {
56320aeb0b24SMatthias Ringwald                         stop_advertisements = true;
5633911801caSMatthias Ringwald                         advertising_set->state &= ~LE_ADVERTISEMENT_STATE_ACTIVE;
5634911801caSMatthias Ringwald                     }
5635911801caSMatthias Ringwald                 }
5636c814a904SMatthias Ringwald #endif /* ENABLE_LE_PERIODIC_ADVERTISING */
56370aeb0b24SMatthias Ringwald                 if (stop_advertisements){
5638911801caSMatthias Ringwald                     hci_stack->le_advertisements_state &= ~LE_ADVERTISEMENT_STATE_ACTIVE;
5639911801caSMatthias Ringwald                     hci_send_cmd(&hci_le_set_extended_advertising_enable, 0, 0, NULL, NULL, NULL);
5640911801caSMatthias Ringwald                     return;
5641911801caSMatthias Ringwald                 }
5642d935373dSMatthias Ringwald             } else
5643a2c9d908SMatthias Ringwald #else /* ENABLE_LE_PERIPHERAL */
5644911801caSMatthias Ringwald             {
5645a086dc35SMatthias Ringwald                 if (stop_advertisements) {
5646911801caSMatthias Ringwald                     hci_stack->le_advertisements_state &= ~LE_ADVERTISEMENT_STATE_ACTIVE;
5647911801caSMatthias Ringwald                     hci_send_cmd(&hci_le_set_advertise_enable, 0);
5648911801caSMatthias Ringwald                     return;
5649911801caSMatthias Ringwald                 }
5650911801caSMatthias Ringwald             }
5651911801caSMatthias Ringwald #endif  /* ENABLE_LE_EXTENDED_ADVERTISING*/
5652911801caSMatthias Ringwald #endif  /* ENABLE_LE_PERIPHERAL */
5653911801caSMatthias Ringwald #endif  /* ENABLE_BLE */
5654911801caSMatthias Ringwald 
56550c88d5efSMatthias Ringwald             /* fall through */
56560c88d5efSMatthias Ringwald 
56570c88d5efSMatthias Ringwald         case HCI_HALTING_LE_SCAN_STOP:
56580c88d5efSMatthias Ringwald             hci_stack->substate = HCI_HALTING_LE_SCAN_STOP;
5659911801caSMatthias Ringwald             if (!hci_can_send_command_packet_now()) return;
5660091e35e3SMatthias Ringwald 
5661091e35e3SMatthias Ringwald #ifdef ENABLE_BLE
5662091e35e3SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
56630c88d5efSMatthias Ringwald             if (hci_stack->le_scanning_active){
5664c42da3bcSMatthias Ringwald                 hci_le_scan_stop();
56650c88d5efSMatthias Ringwald                 hci_stack->substate = HCI_HALTING_DISCONNECT_ALL;
56660c88d5efSMatthias Ringwald                 return;
56670c88d5efSMatthias Ringwald             }
5668091e35e3SMatthias Ringwald #endif
5669091e35e3SMatthias Ringwald #endif
56700c88d5efSMatthias Ringwald 
56710c88d5efSMatthias Ringwald             /* fall through */
56720c88d5efSMatthias Ringwald 
56730c88d5efSMatthias Ringwald         case HCI_HALTING_DISCONNECT_ALL:
56740c88d5efSMatthias Ringwald             hci_stack->substate = HCI_HALTING_DISCONNECT_ALL;
5675911801caSMatthias Ringwald             if (!hci_can_send_command_packet_now()) return;
56760c88d5efSMatthias Ringwald 
5677091e35e3SMatthias Ringwald             // close all open connections
5678091e35e3SMatthias Ringwald             connection = (hci_connection_t *) hci_stack->connections;
5679091e35e3SMatthias Ringwald             if (connection) {
5680091e35e3SMatthias Ringwald                 hci_con_handle_t con_handle = (uint16_t) connection->con_handle;
5681091e35e3SMatthias Ringwald 
568247bf68a7SDirk Helbig                 log_info("HCI_STATE_HALTING, connection %p, handle %u, state %u", (void*)connection, con_handle, connection->state);
5683091e35e3SMatthias Ringwald 
568403270f05SMatthias Ringwald                 // check state
568503270f05SMatthias Ringwald                 switch(connection->state) {
568603270f05SMatthias Ringwald                     case SENT_DISCONNECT:
568703270f05SMatthias Ringwald                     case RECEIVED_DISCONNECTION_COMPLETE:
568803270f05SMatthias Ringwald                         // wait until connection is gone
568903270f05SMatthias Ringwald                         return;
569003270f05SMatthias Ringwald                     default:
569103270f05SMatthias Ringwald                         break;
569203270f05SMatthias Ringwald                 }
5693091e35e3SMatthias Ringwald 
5694091e35e3SMatthias Ringwald                 // finally, send the disconnect command
569503270f05SMatthias Ringwald                 connection->state = SENT_DISCONNECT;
5696091e35e3SMatthias Ringwald                 hci_send_cmd(&hci_disconnect, con_handle, ERROR_CODE_REMOTE_USER_TERMINATED_CONNECTION);
5697091e35e3SMatthias Ringwald                 return;
5698091e35e3SMatthias Ringwald             }
5699091e35e3SMatthias Ringwald 
5700346f8c2cSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
5701346f8c2cSMatthias Ringwald             // stop BIGs and BIG Syncs
5702346f8c2cSMatthias Ringwald             if (hci_stack->le_audio_bigs != NULL){
5703346f8c2cSMatthias Ringwald                 le_audio_big_t * big = (le_audio_big_t*) hci_stack->le_audio_bigs;
5704346f8c2cSMatthias Ringwald                 if (big->state == LE_AUDIO_BIG_STATE_W4_TERMINATED) return;
5705346f8c2cSMatthias Ringwald                 big->state = LE_AUDIO_BIG_STATE_W4_TERMINATED;
5706346f8c2cSMatthias Ringwald                 hci_send_cmd(&hci_le_terminate_big, big->big_handle);
5707346f8c2cSMatthias Ringwald                 return;
5708346f8c2cSMatthias Ringwald             }
5709346f8c2cSMatthias Ringwald             if (hci_stack->le_audio_big_syncs != NULL){
5710346f8c2cSMatthias Ringwald                 le_audio_big_sync_t * big_sync = (le_audio_big_sync_t*) hci_stack->le_audio_big_syncs;
5711346f8c2cSMatthias Ringwald                 if (big_sync->state == LE_AUDIO_BIG_STATE_W4_TERMINATED) return;
5712346f8c2cSMatthias Ringwald                 big_sync->state = LE_AUDIO_BIG_STATE_W4_TERMINATED;
5713346f8c2cSMatthias Ringwald                 hci_send_cmd(&hci_le_big_terminate_sync, big_sync->big_handle);
5714346f8c2cSMatthias Ringwald                 return;
5715346f8c2cSMatthias Ringwald             }
5716346f8c2cSMatthias Ringwald #endif
5717346f8c2cSMatthias Ringwald 
5718091e35e3SMatthias Ringwald             btstack_run_loop_remove_timer(&hci_stack->timeout);
5719091e35e3SMatthias Ringwald 
5720a086dc35SMatthias Ringwald             // no connections left, wait a bit to assert that btstack_crypto isn't waiting for an HCI event
5721091e35e3SMatthias Ringwald             log_info("HCI_STATE_HALTING: wait 50 ms");
57220c88d5efSMatthias Ringwald             hci_stack->substate = HCI_HALTING_W4_CLOSE_TIMER;
5723091e35e3SMatthias Ringwald             btstack_run_loop_set_timer(&hci_stack->timeout, 50);
5724091e35e3SMatthias Ringwald             btstack_run_loop_set_timer_handler(&hci_stack->timeout, hci_halting_timeout_handler);
5725091e35e3SMatthias Ringwald             btstack_run_loop_add_timer(&hci_stack->timeout);
5726091e35e3SMatthias Ringwald             break;
5727091e35e3SMatthias Ringwald 
5728b188b5fcSMatthias Ringwald         case HCI_HALTING_W4_CLOSE_TIMER:
5729b188b5fcSMatthias Ringwald             // keep waiting
5730b188b5fcSMatthias Ringwald             break;
5731b188b5fcSMatthias Ringwald 
5732091e35e3SMatthias Ringwald         case HCI_HALTING_CLOSE:
5733091e35e3SMatthias Ringwald             // close left over connections (that had not been properly closed before)
5734b188b5fcSMatthias Ringwald             hci_stack->substate = HCI_HALTING_CLOSE_DISCARDING_CONNECTIONS;
5735091e35e3SMatthias Ringwald             hci_discard_connections();
5736091e35e3SMatthias Ringwald 
5737091e35e3SMatthias Ringwald             log_info("HCI_STATE_HALTING, calling off");
5738091e35e3SMatthias Ringwald 
5739091e35e3SMatthias Ringwald             // switch mode
5740091e35e3SMatthias Ringwald             hci_power_control_off();
5741091e35e3SMatthias Ringwald 
5742091e35e3SMatthias Ringwald             log_info("HCI_STATE_HALTING, emitting state");
5743091e35e3SMatthias Ringwald             hci_emit_state();
5744091e35e3SMatthias Ringwald             log_info("HCI_STATE_HALTING, done");
5745091e35e3SMatthias Ringwald             break;
5746091e35e3SMatthias Ringwald 
5747091e35e3SMatthias Ringwald         default:
5748091e35e3SMatthias Ringwald             break;
5749091e35e3SMatthias Ringwald     }
575036916f81SDirk Helbig }
5751091e35e3SMatthias Ringwald 
5752091e35e3SMatthias Ringwald static void hci_falling_asleep_run(void){
5753091e35e3SMatthias Ringwald     hci_connection_t * connection;
5754091e35e3SMatthias Ringwald     switch(hci_stack->substate) {
5755091e35e3SMatthias Ringwald         case HCI_FALLING_ASLEEP_DISCONNECT:
5756091e35e3SMatthias Ringwald             log_info("HCI_STATE_FALLING_ASLEEP");
5757091e35e3SMatthias Ringwald             // close all open connections
5758091e35e3SMatthias Ringwald             connection =  (hci_connection_t *) hci_stack->connections;
5759091e35e3SMatthias Ringwald             if (connection){
5760091e35e3SMatthias Ringwald 
5761091e35e3SMatthias Ringwald                 // send disconnect
5762091e35e3SMatthias Ringwald                 if (!hci_can_send_command_packet_now()) return;
5763091e35e3SMatthias Ringwald 
576447bf68a7SDirk Helbig                 log_info("HCI_STATE_FALLING_ASLEEP, connection %p, handle %u", (void*)connection, (uint16_t)connection->con_handle);
5765091e35e3SMatthias Ringwald                 hci_send_cmd(&hci_disconnect, connection->con_handle, ERROR_CODE_REMOTE_USER_TERMINATED_CONNECTION);
5766091e35e3SMatthias Ringwald 
5767091e35e3SMatthias Ringwald                 // send disconnected event right away - causes higher layer connections to get closed, too.
5768091e35e3SMatthias Ringwald                 hci_shutdown_connection(connection);
5769091e35e3SMatthias Ringwald                 return;
5770091e35e3SMatthias Ringwald             }
5771091e35e3SMatthias Ringwald 
5772091e35e3SMatthias Ringwald             if (hci_classic_supported()){
5773091e35e3SMatthias Ringwald                 // disable page and inquiry scan
5774091e35e3SMatthias Ringwald                 if (!hci_can_send_command_packet_now()) return;
5775091e35e3SMatthias Ringwald 
5776091e35e3SMatthias Ringwald                 log_info("HCI_STATE_HALTING, disabling inq scans");
5777091e35e3SMatthias Ringwald                 hci_send_cmd(&hci_write_scan_enable, hci_stack->connectable << 1); // drop inquiry scan but keep page scan
5778091e35e3SMatthias Ringwald 
5779091e35e3SMatthias Ringwald                 // continue in next substate
5780091e35e3SMatthias Ringwald                 hci_stack->substate = HCI_FALLING_ASLEEP_W4_WRITE_SCAN_ENABLE;
5781091e35e3SMatthias Ringwald                 break;
5782091e35e3SMatthias Ringwald             }
5783091e35e3SMatthias Ringwald 
5784091e35e3SMatthias Ringwald             /* fall through */
5785091e35e3SMatthias Ringwald 
5786091e35e3SMatthias Ringwald             case HCI_FALLING_ASLEEP_COMPLETE:
5787091e35e3SMatthias Ringwald                 log_info("HCI_STATE_HALTING, calling sleep");
5788091e35e3SMatthias Ringwald                 // switch mode
5789091e35e3SMatthias Ringwald                 hci_power_control_sleep();  // changes hci_stack->state to SLEEP
5790091e35e3SMatthias Ringwald                 hci_emit_state();
5791091e35e3SMatthias Ringwald                 break;
5792091e35e3SMatthias Ringwald 
5793091e35e3SMatthias Ringwald                 default:
5794091e35e3SMatthias Ringwald                     break;
5795091e35e3SMatthias Ringwald     }
5796091e35e3SMatthias Ringwald }
5797091e35e3SMatthias Ringwald 
579835454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
579935454696SMatthias Ringwald 
5800758b46ceSmatthias.ringwald static void hci_update_scan_enable(void){
5801758b46ceSmatthias.ringwald     // 2 = page scan, 1 = inq scan
5802a1df452eSMatthias Ringwald     hci_stack->new_scan_enable_value  = (hci_stack->connectable << 1) | hci_stack->discoverable;
5803baa4881eSMatthias Ringwald     hci_stack->gap_tasks_classic |= GAP_TASK_WRITE_SCAN_ENABLE;
5804758b46ceSmatthias.ringwald     hci_run();
5805758b46ceSmatthias.ringwald }
5806758b46ceSmatthias.ringwald 
580715a95bd5SMatthias Ringwald void gap_discoverable_control(uint8_t enable){
5808381fbed8Smatthias.ringwald     if (enable) enable = 1; // normalize argument
5809381fbed8Smatthias.ringwald 
58103a9fb326S[email protected]     if (hci_stack->discoverable == enable){
581171fd255dSMatthias Ringwald         hci_emit_scan_mode_changed(hci_stack->discoverable, hci_stack->connectable);
5812381fbed8Smatthias.ringwald         return;
5813381fbed8Smatthias.ringwald     }
5814381fbed8Smatthias.ringwald 
58153a9fb326S[email protected]     hci_stack->discoverable = enable;
5816758b46ceSmatthias.ringwald     hci_update_scan_enable();
5817758b46ceSmatthias.ringwald }
5818b031bebbSmatthias.ringwald 
581915a95bd5SMatthias Ringwald void gap_connectable_control(uint8_t enable){
5820758b46ceSmatthias.ringwald     if (enable) enable = 1; // normalize argument
5821758b46ceSmatthias.ringwald 
5822758b46ceSmatthias.ringwald     // don't emit event
58233a9fb326S[email protected]     if (hci_stack->connectable == enable) return;
5824758b46ceSmatthias.ringwald 
58253a9fb326S[email protected]     hci_stack->connectable = enable;
5826758b46ceSmatthias.ringwald     hci_update_scan_enable();
5827381fbed8Smatthias.ringwald }
582835454696SMatthias Ringwald #endif
5829381fbed8Smatthias.ringwald 
583015a95bd5SMatthias Ringwald void gap_local_bd_addr(bd_addr_t address_buffer){
58316535961aSMatthias Ringwald     (void)memcpy(address_buffer, hci_stack->local_bd_addr, 6);
58325061f3afS[email protected] }
58335061f3afS[email protected] 
58342b838201SMatthias Ringwald #ifdef ENABLE_HCI_CONTROLLER_TO_HOST_FLOW_CONTROL
58352b838201SMatthias Ringwald static void hci_host_num_completed_packets(void){
58362b838201SMatthias Ringwald 
58372b838201SMatthias Ringwald     // create packet manually as arrays are not supported and num_commands should not get reduced
58382b838201SMatthias Ringwald     hci_reserve_packet_buffer();
58392b838201SMatthias Ringwald     uint8_t * packet = hci_get_outgoing_packet_buffer();
58402b838201SMatthias Ringwald 
58412b838201SMatthias Ringwald     uint16_t size = 0;
58422b838201SMatthias Ringwald     uint16_t num_handles = 0;
58432b838201SMatthias Ringwald     packet[size++] = 0x35;
58442b838201SMatthias Ringwald     packet[size++] = 0x0c;
58452b838201SMatthias Ringwald     size++;  // skip param len
58462b838201SMatthias Ringwald     size++;  // skip num handles
58472b838201SMatthias Ringwald 
58482b838201SMatthias Ringwald     // add { handle, packets } entries
58492b838201SMatthias Ringwald     btstack_linked_item_t * it;
58502b838201SMatthias Ringwald     for (it = (btstack_linked_item_t *) hci_stack->connections; it ; it = it->next){
58512b838201SMatthias Ringwald         hci_connection_t * connection = (hci_connection_t *) it;
58522b838201SMatthias Ringwald         if (connection->num_packets_completed){
58532b838201SMatthias Ringwald             little_endian_store_16(packet, size, connection->con_handle);
58542b838201SMatthias Ringwald             size += 2;
58552b838201SMatthias Ringwald             little_endian_store_16(packet, size, connection->num_packets_completed);
58562b838201SMatthias Ringwald             size += 2;
58572b838201SMatthias Ringwald             //
58582b838201SMatthias Ringwald             num_handles++;
58592b838201SMatthias Ringwald             connection->num_packets_completed = 0;
58602b838201SMatthias Ringwald         }
58612b838201SMatthias Ringwald     }
58622b838201SMatthias Ringwald 
58632b838201SMatthias Ringwald     packet[2] = size - 3;
58642b838201SMatthias Ringwald     packet[3] = num_handles;
58652b838201SMatthias Ringwald 
58662b838201SMatthias Ringwald     hci_stack->host_completed_packets = 0;
58672b838201SMatthias Ringwald 
58682b838201SMatthias Ringwald     hci_dump_packet(HCI_COMMAND_DATA_PACKET, 0, packet, size);
58692b838201SMatthias Ringwald     hci_stack->hci_transport->send_packet(HCI_COMMAND_DATA_PACKET, packet, size);
58702b838201SMatthias Ringwald 
58712b838201SMatthias Ringwald     // release packet buffer for synchronous transport implementations
58722b838201SMatthias Ringwald     if (hci_transport_synchronous()){
5873e2d22487SMatthias Ringwald         hci_release_packet_buffer();
5874068b8592SMatthias Ringwald         hci_emit_transport_packet_sent();
58752b838201SMatthias Ringwald     }
58762b838201SMatthias Ringwald }
58772b838201SMatthias Ringwald #endif
58782b838201SMatthias Ringwald 
587926fe9592SMatthias Ringwald static void hci_halting_timeout_handler(btstack_timer_source_t * ds){
588026fe9592SMatthias Ringwald     UNUSED(ds);
588126fe9592SMatthias Ringwald     hci_stack->substate = HCI_HALTING_CLOSE;
5882f021201aSMatthias Ringwald     hci_halting_run();
588326fe9592SMatthias Ringwald }
588426fe9592SMatthias Ringwald 
5885f30077b7SMatthias Ringwald static bool hci_run_acl_fragments(void){
58864ea43905SMatthias Ringwald     if (hci_stack->acl_fragmentation_total_size > 0u) {
5887b5d8b22bS[email protected]         hci_con_handle_t con_handle = READ_ACL_CONNECTION_HANDLE(hci_stack->hci_packet_buffer);
5888b5d8b22bS[email protected]         hci_connection_t *connection = hci_connection_for_handle(con_handle);
5889b5d8b22bS[email protected]         if (connection) {
589028a0332dSMatthias Ringwald             if (hci_can_send_prepared_acl_packet_now(con_handle)){
5891b5d8b22bS[email protected]                 hci_send_acl_packet_fragments(connection);
5892f30077b7SMatthias Ringwald                 return true;
5893b5d8b22bS[email protected]             }
589428a0332dSMatthias Ringwald         } else {
5895b5d8b22bS[email protected]             // connection gone -> discard further fragments
589628a0332dSMatthias Ringwald             log_info("hci_run: fragmented ACL packet no connection -> discard fragment");
5897b5d8b22bS[email protected]             hci_stack->acl_fragmentation_total_size = 0;
5898b5d8b22bS[email protected]             hci_stack->acl_fragmentation_pos = 0;
5899b5d8b22bS[email protected]         }
5900b5d8b22bS[email protected]     }
5901f30077b7SMatthias Ringwald     return false;
59022b838201SMatthias Ringwald }
5903b031bebbSmatthias.ringwald 
590468ab6207SMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
590568ab6207SMatthias Ringwald static bool hci_run_iso_fragments(void){
590668ab6207SMatthias Ringwald     if (hci_stack->iso_fragmentation_total_size > 0u) {
590768ab6207SMatthias Ringwald         // TODO: flow control
590868ab6207SMatthias Ringwald         if (hci_transport_can_send_prepared_packet_now(HCI_ISO_DATA_PACKET)){
590968ab6207SMatthias Ringwald             hci_send_iso_packet_fragments();
591068ab6207SMatthias Ringwald             return true;
591168ab6207SMatthias Ringwald         }
591268ab6207SMatthias Ringwald     }
591368ab6207SMatthias Ringwald     return false;
591468ab6207SMatthias Ringwald }
591568ab6207SMatthias Ringwald #endif
591668ab6207SMatthias Ringwald 
591735454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
59186c0d5426SMatthias Ringwald 
59196c0d5426SMatthias Ringwald #ifdef ENABLE_HCI_SERIALIZED_CONTROLLER_OPERATIONS
59206c0d5426SMatthias Ringwald static bool hci_classic_operation_active(void) {
59216c0d5426SMatthias Ringwald     if (hci_stack->inquiry_state >= GAP_INQUIRY_STATE_W4_ACTIVE){
59226c0d5426SMatthias Ringwald         return true;
59236c0d5426SMatthias Ringwald     }
59246c0d5426SMatthias Ringwald     if (hci_stack->remote_name_state == GAP_REMOTE_NAME_STATE_W4_COMPLETE){
59256c0d5426SMatthias Ringwald         return true;
59266c0d5426SMatthias Ringwald     }
59276c0d5426SMatthias Ringwald     btstack_linked_item_t * it;
59286c0d5426SMatthias Ringwald     for (it = (btstack_linked_item_t *) hci_stack->connections; it != NULL; it = it->next) {
59296c0d5426SMatthias Ringwald         hci_connection_t *connection = (hci_connection_t *) it;
59306c0d5426SMatthias Ringwald         switch (connection->state) {
59316c0d5426SMatthias Ringwald             case SENT_CREATE_CONNECTION:
59326c0d5426SMatthias Ringwald             case SENT_CANCEL_CONNECTION:
59336c0d5426SMatthias Ringwald             case SENT_DISCONNECT:
59346c0d5426SMatthias Ringwald                 return true;
59356c0d5426SMatthias Ringwald             default:
59366c0d5426SMatthias Ringwald                 break;
59376c0d5426SMatthias Ringwald         }
59386c0d5426SMatthias Ringwald     }
59396c0d5426SMatthias Ringwald     return false;
59406c0d5426SMatthias Ringwald }
59416c0d5426SMatthias Ringwald #endif
59426c0d5426SMatthias Ringwald 
5943f30077b7SMatthias Ringwald static bool hci_run_general_gap_classic(void){
5944f30077b7SMatthias Ringwald 
594559d59ecfSMatthias Ringwald     // assert stack is working and classic is active
594659d59ecfSMatthias Ringwald     if (hci_classic_supported() == false)      return false;
594759d59ecfSMatthias Ringwald     if (hci_stack->state != HCI_STATE_WORKING) return false;
594859d59ecfSMatthias Ringwald 
5949b031bebbSmatthias.ringwald     // decline incoming connections
59503a9fb326S[email protected]     if (hci_stack->decline_reason){
59513a9fb326S[email protected]         uint8_t reason = hci_stack->decline_reason;
59523a9fb326S[email protected]         hci_stack->decline_reason = 0;
59533a9fb326S[email protected]         hci_send_cmd(&hci_reject_connection_request, hci_stack->decline_addr, reason);
5954f30077b7SMatthias Ringwald         return true;
5955ce4c8fabSmatthias.ringwald     }
595659d59ecfSMatthias Ringwald 
5957baa4881eSMatthias Ringwald     if (hci_stack->gap_tasks_classic != 0){
5958ab4831a3SMatthias Ringwald         hci_run_gap_tasks_classic();
5959f30077b7SMatthias Ringwald         return true;
5960b031bebbSmatthias.ringwald     }
596127741fe7SMatthias Ringwald 
5962f5875de5SMatthias Ringwald     // start/stop inquiry
5963a1df452eSMatthias Ringwald     if ((hci_stack->inquiry_state >= GAP_INQUIRY_DURATION_MIN) && (hci_stack->inquiry_state <= GAP_INQUIRY_DURATION_MAX)){
59646c0d5426SMatthias Ringwald #ifdef ENABLE_HCI_SERIALIZED_CONTROLLER_OPERATIONS
59656c0d5426SMatthias Ringwald         if (hci_classic_operation_active() == false)
59666c0d5426SMatthias Ringwald #endif
59676c0d5426SMatthias Ringwald         {
5968f5875de5SMatthias Ringwald             uint8_t duration = hci_stack->inquiry_state;
5969beb3c81dSMatthias Ringwald             hci_stack->inquiry_state = GAP_INQUIRY_STATE_W4_ACTIVE;
597030199e24SMatthias Ringwald             if (hci_stack->inquiry_max_period_length != 0){
597130199e24SMatthias 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);
597230199e24SMatthias Ringwald             } else {
5973496bb884SMatthias Ringwald                 hci_send_cmd(&hci_inquiry, hci_stack->inquiry_lap, duration, 0);
597430199e24SMatthias Ringwald             }
5975f30077b7SMatthias Ringwald             return true;
5976f5875de5SMatthias Ringwald         }
59776c0d5426SMatthias Ringwald     }
5978f5875de5SMatthias Ringwald     if (hci_stack->inquiry_state == GAP_INQUIRY_STATE_W2_CANCEL){
5979f5875de5SMatthias Ringwald         hci_stack->inquiry_state = GAP_INQUIRY_STATE_W4_CANCELLED;
5980f5875de5SMatthias Ringwald         hci_send_cmd(&hci_inquiry_cancel);
5981f30077b7SMatthias Ringwald         return true;
5982f5875de5SMatthias Ringwald     }
598330199e24SMatthias Ringwald 
598430199e24SMatthias Ringwald     if (hci_stack->inquiry_state == GAP_INQUIRY_STATE_W2_EXIT_PERIODIC){
5985bc06f564SMatthias Ringwald         hci_stack->inquiry_state = GAP_INQUIRY_STATE_W4_CANCELLED;
598630199e24SMatthias Ringwald         hci_send_cmd(&hci_exit_periodic_inquiry_mode);
598730199e24SMatthias Ringwald         return true;
598830199e24SMatthias Ringwald     }
598930199e24SMatthias Ringwald 
5990b7f1ee76SMatthias Ringwald     // remote name request
5991b7f1ee76SMatthias Ringwald     if (hci_stack->remote_name_state == GAP_REMOTE_NAME_STATE_W2_SEND){
59926c0d5426SMatthias Ringwald #ifdef ENABLE_HCI_SERIALIZED_CONTROLLER_OPERATIONS
59936c0d5426SMatthias Ringwald         if (hci_classic_operation_active() == false)
59946c0d5426SMatthias Ringwald #endif
59956c0d5426SMatthias Ringwald         {
5996b7f1ee76SMatthias Ringwald             hci_stack->remote_name_state = GAP_REMOTE_NAME_STATE_W4_COMPLETE;
5997b7f1ee76SMatthias Ringwald             hci_send_cmd(&hci_remote_name_request, hci_stack->remote_name_addr,
5998ee8a36c8SMatthias Ringwald                          hci_stack->remote_name_page_scan_repetition_mode, 0, hci_stack->remote_name_clock_offset);
5999f30077b7SMatthias Ringwald             return true;
6000b7f1ee76SMatthias Ringwald         }
60016c0d5426SMatthias Ringwald     }
6002cf01e888SMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB
6003cf01e888SMatthias Ringwald     // Local OOB data
600459d59ecfSMatthias Ringwald     if (hci_stack->classic_read_local_oob_data){
6005cf01e888SMatthias Ringwald         hci_stack->classic_read_local_oob_data = false;
60061e83575aSMatthias Ringwald         if (hci_command_supported(SUPPORTED_HCI_COMMAND_READ_LOCAL_OOB_EXTENDED_DATA_COMMAND)){
6007cf01e888SMatthias Ringwald             hci_send_cmd(&hci_read_local_extended_oob_data);
6008cf01e888SMatthias Ringwald         } else {
6009cf01e888SMatthias Ringwald             hci_send_cmd(&hci_read_local_oob_data);
6010cf01e888SMatthias Ringwald         }
6011cf01e888SMatthias Ringwald     }
6012cf01e888SMatthias Ringwald #endif
60130a51f88bSMatthias Ringwald     // pairing
60140a51f88bSMatthias Ringwald     if (hci_stack->gap_pairing_state != GAP_PAIRING_STATE_IDLE){
60150a51f88bSMatthias Ringwald         uint8_t state = hci_stack->gap_pairing_state;
6016c26f2c7bSMatthias Ringwald         uint8_t pin_code[PIN_CODE_LEN];
60170a51f88bSMatthias Ringwald         switch (state){
60180a51f88bSMatthias Ringwald             case GAP_PAIRING_STATE_SEND_PIN:
6019cc15bb2cSMatthias Ringwald                 hci_stack->gap_pairing_state = GAP_PAIRING_STATE_IDLE;
60203f659ee4SMilanka Ringwald                 memset(pin_code, 0, 16);
60213f659ee4SMilanka Ringwald                 memcpy(pin_code, hci_stack->gap_pairing_input.gap_pairing_pin, hci_stack->gap_pairing_pin_len);
60223f659ee4SMilanka Ringwald                 hci_send_cmd(&hci_pin_code_request_reply, hci_stack->gap_pairing_addr, hci_stack->gap_pairing_pin_len, pin_code);
60230a51f88bSMatthias Ringwald                 break;
60240a51f88bSMatthias Ringwald             case GAP_PAIRING_STATE_SEND_PIN_NEGATIVE:
6025cc15bb2cSMatthias Ringwald                 hci_stack->gap_pairing_state = GAP_PAIRING_STATE_WAIT_FOR_COMMAND_COMPLETE;
60260a51f88bSMatthias Ringwald                 hci_send_cmd(&hci_pin_code_request_negative_reply, hci_stack->gap_pairing_addr);
60270a51f88bSMatthias Ringwald                 break;
60280a51f88bSMatthias Ringwald             case GAP_PAIRING_STATE_SEND_PASSKEY:
6029cc15bb2cSMatthias Ringwald                 hci_stack->gap_pairing_state = GAP_PAIRING_STATE_IDLE;
6030d504181aSMatthias Ringwald                 hci_send_cmd(&hci_user_passkey_request_reply, hci_stack->gap_pairing_addr, hci_stack->gap_pairing_input.gap_pairing_passkey);
60310a51f88bSMatthias Ringwald                 break;
60320a51f88bSMatthias Ringwald             case GAP_PAIRING_STATE_SEND_PASSKEY_NEGATIVE:
6033cc15bb2cSMatthias Ringwald                 hci_stack->gap_pairing_state = GAP_PAIRING_STATE_WAIT_FOR_COMMAND_COMPLETE;
60340a51f88bSMatthias Ringwald                 hci_send_cmd(&hci_user_passkey_request_negative_reply, hci_stack->gap_pairing_addr);
60350a51f88bSMatthias Ringwald                 break;
60360a51f88bSMatthias Ringwald             case GAP_PAIRING_STATE_SEND_CONFIRMATION:
6037cc15bb2cSMatthias Ringwald                 hci_stack->gap_pairing_state = GAP_PAIRING_STATE_IDLE;
60380a51f88bSMatthias Ringwald                 hci_send_cmd(&hci_user_confirmation_request_reply, hci_stack->gap_pairing_addr);
60390a51f88bSMatthias Ringwald                 break;
60400a51f88bSMatthias Ringwald             case GAP_PAIRING_STATE_SEND_CONFIRMATION_NEGATIVE:
6041cc15bb2cSMatthias Ringwald                 hci_stack->gap_pairing_state = GAP_PAIRING_STATE_WAIT_FOR_COMMAND_COMPLETE;
60420a51f88bSMatthias Ringwald                 hci_send_cmd(&hci_user_confirmation_request_negative_reply, hci_stack->gap_pairing_addr);
60430a51f88bSMatthias Ringwald                 break;
60440a51f88bSMatthias Ringwald             default:
60450a51f88bSMatthias Ringwald                 break;
60460a51f88bSMatthias Ringwald         }
6047f30077b7SMatthias Ringwald         return true;
6048f30077b7SMatthias Ringwald     }
6049f30077b7SMatthias Ringwald     return false;
60500a51f88bSMatthias Ringwald }
605135454696SMatthias Ringwald #endif
6052b031bebbSmatthias.ringwald 
6053a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE
6054be7ef9d8SMatthias Ringwald 
60557eb5b27eSMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
60567eb5b27eSMatthias Ringwald static uint8_t hci_le_num_phys(uint8_t phys){
60577eb5b27eSMatthias Ringwald     const uint8_t num_bits_set[] = { 0, 1, 1, 2, 1, 2, 2, 3 };
60587eb5b27eSMatthias Ringwald     btstack_assert(phys);
60597eb5b27eSMatthias Ringwald     return num_bits_set[phys];
60607eb5b27eSMatthias Ringwald }
60617eb5b27eSMatthias Ringwald #endif
60627eb5b27eSMatthias Ringwald 
6063c42da3bcSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
6064c42da3bcSMatthias Ringwald static void hci_le_scan_stop(void){
6065c42da3bcSMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
606622f987e4SMatthias Ringwald     if (hci_le_extended_advertising_supported()) {
6067c42da3bcSMatthias Ringwald             hci_send_cmd(&hci_le_set_extended_scan_enable, 0, 0, 0, 0);
6068c42da3bcSMatthias Ringwald     } else
6069c42da3bcSMatthias Ringwald #endif
6070c42da3bcSMatthias Ringwald     {
6071c42da3bcSMatthias Ringwald         hci_send_cmd(&hci_le_set_scan_enable, 0, 0);
6072c42da3bcSMatthias Ringwald     }
6073c42da3bcSMatthias Ringwald }
6074327f7f07SMatthias Ringwald 
6075f346015eSMatthias Ringwald static void
6076f346015eSMatthias Ringwald hci_send_le_create_connection(uint8_t initiator_filter_policy, bd_addr_type_t address_type, uint8_t *address) {
6077327f7f07SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
607822f987e4SMatthias Ringwald     if (hci_le_extended_advertising_supported()) {
60797eb5b27eSMatthias Ringwald         // prepare arrays for all phys (LE Coded, LE 1M, LE 2M PHY)
60807eb5b27eSMatthias Ringwald         uint16_t le_connection_scan_interval[3];
60817eb5b27eSMatthias Ringwald         uint16_t le_connection_scan_window[3];
60827eb5b27eSMatthias Ringwald         uint16_t le_connection_interval_min[3];
60837eb5b27eSMatthias Ringwald         uint16_t le_connection_interval_max[3];
60847eb5b27eSMatthias Ringwald         uint16_t le_connection_latency[3];
60857eb5b27eSMatthias Ringwald         uint16_t le_supervision_timeout[3];
60867eb5b27eSMatthias Ringwald         uint16_t le_minimum_ce_length[3];
60877eb5b27eSMatthias Ringwald         uint16_t le_maximum_ce_length[3];
60887eb5b27eSMatthias Ringwald 
60897eb5b27eSMatthias Ringwald         uint8_t i;
60907eb5b27eSMatthias Ringwald         uint8_t num_phys = hci_le_num_phys(hci_stack->le_connection_phys);
60917eb5b27eSMatthias Ringwald         for (i=0;i<num_phys;i++){
60927eb5b27eSMatthias Ringwald             le_connection_scan_interval[i] = hci_stack->le_connection_scan_interval;
60937eb5b27eSMatthias Ringwald             le_connection_scan_window[i]   = hci_stack->le_connection_scan_window;
60947eb5b27eSMatthias Ringwald             le_connection_interval_min[i]  = hci_stack->le_connection_interval_min;
60957eb5b27eSMatthias Ringwald             le_connection_interval_max[i]  = hci_stack->le_connection_interval_max;
60967eb5b27eSMatthias Ringwald             le_connection_latency[i]       = hci_stack->le_connection_latency;
60977eb5b27eSMatthias Ringwald             le_supervision_timeout[i]      = hci_stack->le_supervision_timeout;
60987eb5b27eSMatthias Ringwald             le_minimum_ce_length[i]        = hci_stack->le_minimum_ce_length;
60997eb5b27eSMatthias Ringwald             le_maximum_ce_length[i]        = hci_stack->le_maximum_ce_length;
61007eb5b27eSMatthias Ringwald         }
6101327f7f07SMatthias Ringwald         hci_send_cmd(&hci_le_extended_create_connection,
6102f346015eSMatthias Ringwald                      initiator_filter_policy,
6103327f7f07SMatthias Ringwald                      hci_stack->le_connection_own_addr_type,   // our addr type:
6104f346015eSMatthias Ringwald                      address_type,                  // peer address type
6105f346015eSMatthias Ringwald                      address,                       // peer bd addr
61067eb5b27eSMatthias Ringwald                      hci_stack->le_connection_phys, // initiating PHY
6107327f7f07SMatthias Ringwald                      le_connection_scan_interval,   // conn scan interval
6108327f7f07SMatthias Ringwald                      le_connection_scan_window,     // conn scan windows
6109327f7f07SMatthias Ringwald                      le_connection_interval_min,    // conn interval min
6110327f7f07SMatthias Ringwald                      le_connection_interval_max,    // conn interval max
6111327f7f07SMatthias Ringwald                      le_connection_latency,         // conn latency
6112327f7f07SMatthias Ringwald                      le_supervision_timeout,        // conn latency
6113327f7f07SMatthias Ringwald                      le_minimum_ce_length,          // min ce length
6114327f7f07SMatthias Ringwald                      le_maximum_ce_length           // max ce length
6115327f7f07SMatthias Ringwald         );
6116d935373dSMatthias Ringwald     } else
6117327f7f07SMatthias Ringwald #endif
6118327f7f07SMatthias Ringwald     {
6119327f7f07SMatthias Ringwald         hci_send_cmd(&hci_le_create_connection,
6120327f7f07SMatthias Ringwald                      hci_stack->le_connection_scan_interval,  // conn scan interval
6121327f7f07SMatthias Ringwald                      hci_stack->le_connection_scan_window,    // conn scan windows
6122f346015eSMatthias Ringwald                      initiator_filter_policy,                 // don't use whitelist
6123f346015eSMatthias Ringwald                      address_type,                            // peer address type
6124f346015eSMatthias Ringwald                      address,                                 // peer bd addr
6125327f7f07SMatthias Ringwald                      hci_stack->le_connection_own_addr_type,  // our addr type:
6126327f7f07SMatthias Ringwald                      hci_stack->le_connection_interval_min,   // conn interval min
6127327f7f07SMatthias Ringwald                      hci_stack->le_connection_interval_max,   // conn interval max
6128327f7f07SMatthias Ringwald                      hci_stack->le_connection_latency,        // conn latency
6129327f7f07SMatthias Ringwald                      hci_stack->le_supervision_timeout,       // conn latency
6130327f7f07SMatthias Ringwald                      hci_stack->le_minimum_ce_length,         // min ce length
6131327f7f07SMatthias Ringwald                      hci_stack->le_maximum_ce_length          // max ce length
6132327f7f07SMatthias Ringwald         );
6133327f7f07SMatthias Ringwald     }
6134327f7f07SMatthias Ringwald }
6135c42da3bcSMatthias Ringwald #endif
6136c42da3bcSMatthias Ringwald 
6137be7ef9d8SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
6138be7ef9d8SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
6139033393eeSBob Abeles static uint8_t hci_le_extended_advertising_operation_for_chunk(uint16_t pos, uint16_t len){
6140be7ef9d8SMatthias Ringwald     uint8_t  operation = 0;
6141be7ef9d8SMatthias Ringwald     if (pos == 0){
6142be7ef9d8SMatthias Ringwald         // first fragment or complete data
6143be7ef9d8SMatthias Ringwald         operation |= 1;
6144be7ef9d8SMatthias Ringwald     }
6145be7ef9d8SMatthias Ringwald     if (pos + LE_EXTENDED_ADVERTISING_MAX_CHUNK_LEN >= len){
6146be7ef9d8SMatthias Ringwald         // last fragment or complete data
6147be7ef9d8SMatthias Ringwald         operation |= 2;
6148be7ef9d8SMatthias Ringwald     }
6149be7ef9d8SMatthias Ringwald     return operation;
6150be7ef9d8SMatthias Ringwald }
6151be7ef9d8SMatthias Ringwald #endif
6152be7ef9d8SMatthias Ringwald #endif
6153be7ef9d8SMatthias Ringwald 
61542c052b15SMatthias Ringwald static bool hci_whitelist_modification_pending(void) {
615581ae6c3bSMatthias Ringwald     btstack_linked_list_iterator_t it;
615681ae6c3bSMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->le_whitelist);
615781ae6c3bSMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
615881ae6c3bSMatthias Ringwald         whitelist_entry_t * entry = (whitelist_entry_t*) btstack_linked_list_iterator_next(&it);
615981ae6c3bSMatthias Ringwald         if (entry->state & (LE_WHITELIST_REMOVE_FROM_CONTROLLER | LE_WHITELIST_ADD_TO_CONTROLLER)){
616081ae6c3bSMatthias Ringwald             return true;
616181ae6c3bSMatthias Ringwald         }
616281ae6c3bSMatthias Ringwald     }
616381ae6c3bSMatthias Ringwald     return false;
616481ae6c3bSMatthias Ringwald }
616581ae6c3bSMatthias Ringwald 
61662c052b15SMatthias Ringwald static bool hci_whitelist_modification_process(void){
61672c052b15SMatthias Ringwald     // add/remove entries
61682c052b15SMatthias Ringwald     btstack_linked_list_iterator_t it;
61692c052b15SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->le_whitelist);
61702c052b15SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
61712c052b15SMatthias Ringwald         whitelist_entry_t * entry = (whitelist_entry_t*) btstack_linked_list_iterator_next(&it);
61722c052b15SMatthias Ringwald         if (entry->state & LE_WHITELIST_REMOVE_FROM_CONTROLLER){
61732c052b15SMatthias Ringwald             entry->state &= ~LE_WHITELIST_REMOVE_FROM_CONTROLLER;
61742c052b15SMatthias Ringwald             entry->state &= ~LE_WHITELIST_ON_CONTROLLER;
61752c052b15SMatthias Ringwald             bd_addr_type_t address_type = entry->address_type;
61762c052b15SMatthias Ringwald             bd_addr_t address;
61772c052b15SMatthias Ringwald             memcpy(address, entry->address, 6);
61782c052b15SMatthias Ringwald             if ((entry->state & LE_WHITELIST_ADD_TO_CONTROLLER) == 0){
61792c052b15SMatthias Ringwald                 // remove from whitelist if not scheduled for re-addition
61802c052b15SMatthias Ringwald                 btstack_linked_list_remove(&hci_stack->le_whitelist, (btstack_linked_item_t *) entry);
61812c052b15SMatthias Ringwald                 btstack_memory_whitelist_entry_free(entry);
61822c052b15SMatthias Ringwald             }
61832c052b15SMatthias Ringwald             hci_send_cmd(&hci_le_remove_device_from_white_list, address_type, address);
61842c052b15SMatthias Ringwald             return true;
61852c052b15SMatthias Ringwald         }
61862c052b15SMatthias Ringwald         if (entry->state & LE_WHITELIST_ADD_TO_CONTROLLER){
61872c052b15SMatthias Ringwald             entry->state &= ~LE_WHITELIST_ADD_TO_CONTROLLER;
61882c052b15SMatthias Ringwald             entry->state |= LE_WHITELIST_ON_CONTROLLER;
61892c052b15SMatthias Ringwald             hci_send_cmd(&hci_le_add_device_to_white_list, entry->address_type, entry->address);
61902c052b15SMatthias Ringwald             return true;
61912c052b15SMatthias Ringwald         }
61922c052b15SMatthias Ringwald     }
61932c052b15SMatthias Ringwald     return false;
61942c052b15SMatthias Ringwald }
61952c052b15SMatthias Ringwald 
6196f30077b7SMatthias Ringwald static bool hci_run_general_gap_le(void){
6197f30077b7SMatthias Ringwald 
6198f40c73b4SMatthias Ringwald     btstack_linked_list_iterator_t lit;
6199f9aa0bbcSMatthias Ringwald     UNUSED(lit);
6200f40c73b4SMatthias Ringwald 
62012052d96cSMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
62022052d96cSMatthias Ringwald     if (hci_stack->le_resolvable_private_address_update_s > 0){
62032052d96cSMatthias Ringwald         uint16_t update_s = hci_stack->le_resolvable_private_address_update_s;
62042052d96cSMatthias Ringwald         hci_stack->le_resolvable_private_address_update_s = 0;
62052052d96cSMatthias Ringwald         hci_send_cmd(&hci_le_set_resolvable_private_address_timeout, update_s);
62062052d96cSMatthias Ringwald         return true;
62072052d96cSMatthias Ringwald     }
62082052d96cSMatthias Ringwald #endif
62092052d96cSMatthias Ringwald 
6210a41310b7SMatthias Ringwald     // Phase 1: collect what to stop
6211a41310b7SMatthias Ringwald 
621249a6c69cSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
6213a41310b7SMatthias Ringwald     bool scanning_stop = false;
6214a41310b7SMatthias Ringwald     bool connecting_stop = false;
6215be7ef9d8SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
6216c814a904SMatthias Ringwald #ifdef ENABLE_LE_PERIODIC_ADVERTISING
62174bafedd5SMatthias Ringwald     bool periodic_sync_stop = false;
62184bafedd5SMatthias Ringwald #endif
6219be7ef9d8SMatthias Ringwald #endif
6220c814a904SMatthias Ringwald #endif
6221be7ef9d8SMatthias Ringwald 
622249a6c69cSMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
622349a6c69cSMatthias Ringwald     bool advertising_stop = false;
622449a6c69cSMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
622549a6c69cSMatthias Ringwald     le_advertising_set_t * advertising_stop_set = NULL;
622649a6c69cSMatthias Ringwald #ifdef ENABLE_LE_PERIODIC_ADVERTISING
622749a6c69cSMatthias Ringwald     bool periodic_advertising_stop = false;
6228a41310b7SMatthias Ringwald #endif
622949a6c69cSMatthias Ringwald #endif
6230a41310b7SMatthias Ringwald #endif
6231a41310b7SMatthias Ringwald 
62329136bde8SMatthias Ringwald     // check if own address changes
62339ce6dfa1SMatthias Ringwald     uint8_t address_change_mask = LE_ADVERTISEMENT_TASKS_SET_ADDRESS | LE_ADVERTISEMENT_TASKS_SET_ADDRESS_SET_0;
62349ce6dfa1SMatthias Ringwald     bool random_address_change = (hci_stack->le_advertisements_todo & address_change_mask) != 0;
62359136bde8SMatthias Ringwald 
623629c24bebSMatthias Ringwald     // check if whitelist needs modification
623781ae6c3bSMatthias Ringwald     bool  whitelist_modification_pending = hci_whitelist_modification_pending();
6238f40c73b4SMatthias Ringwald 
623921debf25SMatthias Ringwald     // check if resolving list needs modification
624021debf25SMatthias Ringwald     bool resolving_list_modification_pending = false;
624121debf25SMatthias Ringwald #ifdef ENABLE_LE_PRIVACY_ADDRESS_RESOLUTION
62421ffa425cSMatthias Ringwald     bool resolving_list_supported = hci_command_supported(SUPPORTED_HCI_COMMAND_LE_SET_ADDRESS_RESOLUTION_ENABLE);
6243ea151974SMatthias Ringwald 	if (resolving_list_supported && hci_stack->le_resolving_list_state != LE_RESOLVING_LIST_DONE){
624421debf25SMatthias Ringwald         resolving_list_modification_pending = true;
624521debf25SMatthias Ringwald     }
624621debf25SMatthias Ringwald #endif
624729c24bebSMatthias Ringwald 
6248f40c73b4SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
624949a6c69cSMatthias Ringwald 
6250f40c73b4SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
625149a6c69cSMatthias Ringwald     // check if periodic advertiser list needs modification
6252f40c73b4SMatthias Ringwald     bool periodic_list_modification_pending = false;
6253f40c73b4SMatthias Ringwald     btstack_linked_list_iterator_init(&lit, &hci_stack->le_periodic_advertiser_list);
6254f40c73b4SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&lit)){
6255f40c73b4SMatthias Ringwald         periodic_advertiser_list_entry_t * entry = (periodic_advertiser_list_entry_t*) btstack_linked_list_iterator_next(&lit);
6256f40c73b4SMatthias Ringwald         if (entry->state & (LE_PERIODIC_ADVERTISER_LIST_ENTRY_ADD_TO_CONTROLLER | LE_PERIODIC_ADVERTISER_LIST_ENTRY_REMOVE_FROM_CONTROLLER)){
6257f40c73b4SMatthias Ringwald             periodic_list_modification_pending = true;
6258f40c73b4SMatthias Ringwald             break;
6259f40c73b4SMatthias Ringwald         }
6260f40c73b4SMatthias Ringwald     }
6261f40c73b4SMatthias Ringwald #endif
6262f40c73b4SMatthias Ringwald 
6263fde725feSMatthias Ringwald     // scanning control
62643251a108SMatthias Ringwald     if (hci_stack->le_scanning_active) {
626529c24bebSMatthias Ringwald         // stop if:
626629c24bebSMatthias Ringwald         // - parameter change required
626729c24bebSMatthias Ringwald         // - it's disabled
626829c24bebSMatthias Ringwald         // - whitelist change required but used for scanning
626921debf25SMatthias Ringwald         // - resolving list modified
627051e51a58SMatthias Ringwald         // - own address changes
627129c24bebSMatthias Ringwald         bool scanning_uses_whitelist = (hci_stack->le_scan_filter_policy & 1) == 1;
627221debf25SMatthias Ringwald         if ((hci_stack->le_scanning_param_update) ||
627321debf25SMatthias Ringwald             !hci_stack->le_scanning_enabled ||
6274d54b2c94SMatthias Ringwald             (scanning_uses_whitelist && whitelist_modification_pending) ||
627551e51a58SMatthias Ringwald             resolving_list_modification_pending ||
627651e51a58SMatthias Ringwald             random_address_change){
627721debf25SMatthias Ringwald 
62782d5c2a27SMatthias Ringwald             scanning_stop = true;
6279fde725feSMatthias Ringwald         }
6280fde725feSMatthias Ringwald     }
6281fde725feSMatthias Ringwald 
628229c24bebSMatthias Ringwald     // connecting control
6283f496d06eSMatthias Ringwald     bool connecting_with_whitelist;
6284f496d06eSMatthias Ringwald     switch (hci_stack->le_connecting_state){
6285f496d06eSMatthias Ringwald         case LE_CONNECTING_DIRECT:
6286f496d06eSMatthias Ringwald         case LE_CONNECTING_WHITELIST:
6287af64f147SMatthias Ringwald             // stop connecting if:
6288af64f147SMatthias Ringwald             // - connecting uses white and whitelist modification pending
6289af64f147SMatthias Ringwald             // - if it got disabled
629021debf25SMatthias Ringwald             // - resolving list modified
629151e51a58SMatthias Ringwald             // - own address changes
6292f496d06eSMatthias Ringwald             connecting_with_whitelist = hci_stack->le_connecting_state == LE_CONNECTING_WHITELIST;
6293f496d06eSMatthias Ringwald             if ((connecting_with_whitelist && whitelist_modification_pending) ||
629421debf25SMatthias Ringwald                 (hci_stack->le_connecting_request == LE_CONNECTING_IDLE) ||
629551e51a58SMatthias Ringwald                 resolving_list_modification_pending ||
629651e51a58SMatthias Ringwald                 random_address_change) {
629721debf25SMatthias Ringwald 
629829c24bebSMatthias Ringwald                 connecting_stop = true;
629929c24bebSMatthias Ringwald             }
6300f496d06eSMatthias Ringwald             break;
6301f496d06eSMatthias Ringwald         default:
6302f496d06eSMatthias Ringwald             break;
630329c24bebSMatthias Ringwald     }
630449a6c69cSMatthias Ringwald 
63054bafedd5SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
630649a6c69cSMatthias Ringwald #ifdef ENABLE_LE_PERIODIC_ADVERTISING
63074bafedd5SMatthias Ringwald     // periodic sync control
63084bafedd5SMatthias Ringwald     bool sync_with_advertiser_list;
63094bafedd5SMatthias Ringwald     switch(hci_stack->le_periodic_sync_state){
63104bafedd5SMatthias Ringwald         case LE_CONNECTING_DIRECT:
63114bafedd5SMatthias Ringwald         case LE_CONNECTING_WHITELIST:
631249a6c69cSMatthias Ringwald             // stop sync if:
63134bafedd5SMatthias Ringwald             // - sync with advertiser list and advertiser list modification pending
631449a6c69cSMatthias Ringwald             // - if it got disabled
63154bafedd5SMatthias Ringwald             sync_with_advertiser_list = hci_stack->le_periodic_sync_state == LE_CONNECTING_WHITELIST;
63164bafedd5SMatthias Ringwald             if ((sync_with_advertiser_list && periodic_list_modification_pending) ||
63174bafedd5SMatthias Ringwald                     (hci_stack->le_periodic_sync_request == LE_CONNECTING_IDLE)){
63184bafedd5SMatthias Ringwald                 periodic_sync_stop = true;
63194bafedd5SMatthias Ringwald             }
63204bafedd5SMatthias Ringwald             break;
63214bafedd5SMatthias Ringwald         default:
63224bafedd5SMatthias Ringwald             break;
63234bafedd5SMatthias Ringwald     }
63244bafedd5SMatthias Ringwald #endif
6325d70217a2SMatthias Ringwald #endif
632629c24bebSMatthias Ringwald 
632749a6c69cSMatthias Ringwald #endif /* ENABLE_LE_CENTRAL */
632849a6c69cSMatthias Ringwald 
6329d70217a2SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
633045c102fdSMatthias Ringwald     // le advertisement control
6331935aa76eSMatthias Ringwald     if ((hci_stack->le_advertisements_state & LE_ADVERTISEMENT_STATE_ACTIVE) != 0){
633229c24bebSMatthias Ringwald         // stop if:
633329c24bebSMatthias Ringwald         // - parameter change required
63349136bde8SMatthias Ringwald         // - random address used in advertising and changes
633529c24bebSMatthias Ringwald         // - it's disabled
6336ba44ad41SMatthias Ringwald         // - whitelist change required but used for advertisement filter policy
633721debf25SMatthias Ringwald         // - resolving list modified
633851e51a58SMatthias Ringwald         // - own address changes
6339a61834b6SMatthias Ringwald         bool advertising_uses_whitelist = hci_stack->le_advertisements_filter_policy != 0;
63409136bde8SMatthias Ringwald         bool advertising_uses_random_address = hci_stack->le_own_addr_type != BD_ADDR_TYPE_LE_PUBLIC;
63414e5d21eaSMatthias Ringwald         bool advertising_change    = (hci_stack->le_advertisements_todo & LE_ADVERTISEMENT_TASKS_SET_PARAMS)  != 0;
6342a61834b6SMatthias Ringwald         if (advertising_change ||
63439136bde8SMatthias Ringwald             (advertising_uses_random_address && random_address_change) ||
6344a61834b6SMatthias Ringwald             (hci_stack->le_advertisements_enabled_for_current_roles == 0) ||
63459136bde8SMatthias Ringwald             (advertising_uses_whitelist && whitelist_modification_pending) ||
634651e51a58SMatthias Ringwald             resolving_list_modification_pending ||
634751e51a58SMatthias Ringwald             random_address_change) {
634821debf25SMatthias Ringwald 
6349fde725feSMatthias Ringwald             advertising_stop = true;
6350fde725feSMatthias Ringwald         }
6351fde725feSMatthias Ringwald     }
6352be7ef9d8SMatthias Ringwald 
6353be7ef9d8SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
635422f987e4SMatthias Ringwald     if (hci_le_extended_advertising_supported() && (advertising_stop == false)){
6355be7ef9d8SMatthias Ringwald         btstack_linked_list_iterator_t it;
6356be7ef9d8SMatthias Ringwald         btstack_linked_list_iterator_init(&it, &hci_stack->le_advertising_sets);
6357be7ef9d8SMatthias Ringwald         while (btstack_linked_list_iterator_has_next(&it)){
6358be7ef9d8SMatthias Ringwald             le_advertising_set_t * advertising_set = (le_advertising_set_t*) btstack_linked_list_iterator_next(&it);
635953f240c0SMatthias Ringwald             if ((advertising_set->state & LE_ADVERTISEMENT_STATE_ACTIVE) != 0) {
6360be7ef9d8SMatthias Ringwald                 // stop if:
6361be7ef9d8SMatthias Ringwald                 // - parameter change required
6362be7ef9d8SMatthias Ringwald                 // - random address used in connectable advertising and changes
6363be7ef9d8SMatthias Ringwald                 // - it's disabled
6364be7ef9d8SMatthias Ringwald                 // - whitelist change required but used for advertisement filter policy
6365be7ef9d8SMatthias Ringwald                 // - resolving list modified
6366be7ef9d8SMatthias Ringwald                 // - own address changes
6367be7ef9d8SMatthias Ringwald                 // - advertisement set will be removed
636857a04237SMatthias Ringwald                 bool advertising_uses_whitelist = advertising_set->extended_params.advertising_filter_policy != 0;
636957a04237SMatthias Ringwald                 bool advertising_connectable = (advertising_set->extended_params.advertising_event_properties & 1) != 0;
637053f240c0SMatthias Ringwald                 bool advertising_uses_random_address =
637153f240c0SMatthias Ringwald                         (advertising_set->extended_params.own_address_type != BD_ADDR_TYPE_LE_PUBLIC) &&
637253f240c0SMatthias Ringwald                         advertising_connectable;
6373be7ef9d8SMatthias Ringwald                 bool advertising_parameter_change = (advertising_set->tasks & LE_ADVERTISEMENT_TASKS_SET_PARAMS) != 0;
6374be7ef9d8SMatthias Ringwald                 bool advertising_enabled = (advertising_set->state & LE_ADVERTISEMENT_STATE_ENABLED) != 0;
637553f240c0SMatthias Ringwald                 bool advertising_set_random_address_change =
637653f240c0SMatthias Ringwald                         (advertising_set->tasks & LE_ADVERTISEMENT_TASKS_SET_ADDRESS) != 0;
637753f240c0SMatthias Ringwald                 bool advertising_set_will_be_removed =
637853f240c0SMatthias Ringwald                         (advertising_set->state & LE_ADVERTISEMENT_TASKS_REMOVE_SET) != 0;
6379be7ef9d8SMatthias Ringwald                 if (advertising_parameter_change ||
6380be7ef9d8SMatthias Ringwald                     (advertising_uses_random_address && advertising_set_random_address_change) ||
6381be7ef9d8SMatthias Ringwald                     (advertising_enabled == false) ||
6382be7ef9d8SMatthias Ringwald                     (advertising_uses_whitelist && whitelist_modification_pending) ||
6383be7ef9d8SMatthias Ringwald                     resolving_list_modification_pending ||
6384be7ef9d8SMatthias Ringwald                     advertising_set_will_be_removed) {
6385be7ef9d8SMatthias Ringwald 
6386be7ef9d8SMatthias Ringwald                     advertising_stop = true;
6387be7ef9d8SMatthias Ringwald                     advertising_stop_set = advertising_set;
6388be7ef9d8SMatthias Ringwald                     break;
6389be7ef9d8SMatthias Ringwald                 }
6390be7ef9d8SMatthias Ringwald             }
6391c814a904SMatthias Ringwald #ifdef ENABLE_LE_PERIODIC_ADVERTISING
639253f240c0SMatthias Ringwald             if ((advertising_set->state & LE_ADVERTISEMENT_STATE_PERIODIC_ACTIVE) != 0) {
639353f240c0SMatthias Ringwald                 // stop if:
639453f240c0SMatthias Ringwald                 // - it's disabled
639553f240c0SMatthias Ringwald                 // - parameter change required
639653f240c0SMatthias Ringwald                 bool periodic_enabled = (advertising_set->state & LE_ADVERTISEMENT_STATE_PERIODIC_ENABLED) != 0;
639753f240c0SMatthias Ringwald                 bool periodic_parameter_change = (advertising_set->tasks & LE_ADVERTISEMENT_TASKS_SET_PERIODIC_PARAMS) != 0;
639853f240c0SMatthias Ringwald                 if ((periodic_enabled == false) || periodic_parameter_change){
639949a6c69cSMatthias Ringwald                     periodic_advertising_stop = true;
640053f240c0SMatthias Ringwald                     advertising_stop_set = advertising_set;
640153f240c0SMatthias Ringwald                 }
640253f240c0SMatthias Ringwald             }
640349a6c69cSMatthias Ringwald #endif /* ENABLE_LE_PERIODIC_ADVERTISING */
640453f240c0SMatthias Ringwald         }
6405be7ef9d8SMatthias Ringwald     }
6406be7ef9d8SMatthias Ringwald #endif
6407be7ef9d8SMatthias Ringwald 
6408a41310b7SMatthias Ringwald #endif
6409fde725feSMatthias Ringwald 
6410a41310b7SMatthias Ringwald 
6411a41310b7SMatthias Ringwald     // Phase 2: stop everything that should be off during modifications
6412a41310b7SMatthias Ringwald 
6413131d4778SMatthias Ringwald 
6414131d4778SMatthias Ringwald     // 2.1 Outgoing connection
6415131d4778SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
6416131d4778SMatthias Ringwald     if (connecting_stop){
6417131d4778SMatthias Ringwald         hci_send_cmd(&hci_le_create_connection_cancel);
6418131d4778SMatthias Ringwald         return true;
6419131d4778SMatthias Ringwald     }
6420131d4778SMatthias Ringwald #endif
6421131d4778SMatthias Ringwald 
6422131d4778SMatthias Ringwald     // 2.2 Scanning
6423a41310b7SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
6424a41310b7SMatthias Ringwald     if (scanning_stop){
64255226d7f2SMatthias Ringwald         hci_stack->le_scanning_active = false;
6426c42da3bcSMatthias Ringwald         hci_le_scan_stop();
6427a41310b7SMatthias Ringwald         return true;
6428a41310b7SMatthias Ringwald     }
6429a41310b7SMatthias Ringwald 
6430131d4778SMatthias Ringwald     // 2.3 Periodic Sync
64314bafedd5SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
643249a6c69cSMatthias Ringwald     if (hci_stack->le_periodic_terminate_sync_handle != HCI_CON_HANDLE_INVALID){
643349a6c69cSMatthias Ringwald         uint16_t sync_handle = hci_stack->le_periodic_terminate_sync_handle;
643449a6c69cSMatthias Ringwald         hci_stack->le_periodic_terminate_sync_handle = HCI_CON_HANDLE_INVALID;
643549a6c69cSMatthias Ringwald         hci_send_cmd(&hci_le_periodic_advertising_terminate_sync, sync_handle);
643649a6c69cSMatthias Ringwald         return true;
643749a6c69cSMatthias Ringwald     }
643849a6c69cSMatthias Ringwald #ifdef ENABLE_LE_PERIODIC_ADVERTISING
64394bafedd5SMatthias Ringwald     if (periodic_sync_stop){
64404bafedd5SMatthias Ringwald         hci_stack->le_periodic_sync_state = LE_CONNECTING_CANCEL;
64414bafedd5SMatthias Ringwald         hci_send_cmd(&hci_le_periodic_advertising_create_sync_cancel);
64424bafedd5SMatthias Ringwald         return true;
64434bafedd5SMatthias Ringwald     }
644449a6c69cSMatthias Ringwald #endif /* ENABLE_LE_PERIODIC_ADVERTISING */
6445a8016f96SMatthias Ringwald #endif /* ENABLE_LE_EXTENDED_ADVERTISING */
6446a8016f96SMatthias Ringwald #endif /* ENABLE_LE_CENTRAL */
6447a41310b7SMatthias Ringwald 
6448131d4778SMatthias Ringwald     // 2.4 Advertising: legacy, extended, periodic
6449a41310b7SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
6450fde725feSMatthias Ringwald     if (advertising_stop){
6451e464cd48SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
645222f987e4SMatthias Ringwald         if (hci_le_extended_advertising_supported()) {
6453be7ef9d8SMatthias Ringwald             uint8_t advertising_stop_handle;
6454be7ef9d8SMatthias Ringwald             if (advertising_stop_set != NULL){
6455be7ef9d8SMatthias Ringwald                 advertising_stop_handle = advertising_stop_set->advertising_handle;
6456be7ef9d8SMatthias Ringwald                 advertising_stop_set->state &= ~LE_ADVERTISEMENT_STATE_ACTIVE;
6457be7ef9d8SMatthias Ringwald             } else {
6458be7ef9d8SMatthias Ringwald                 advertising_stop_handle = 0;
6459be7ef9d8SMatthias Ringwald                 hci_stack->le_advertisements_state &= ~LE_ADVERTISEMENT_STATE_ACTIVE;
6460be7ef9d8SMatthias Ringwald             }
6461be7ef9d8SMatthias Ringwald             const uint8_t advertising_handles[] = { advertising_stop_handle };
6462e464cd48SMatthias Ringwald             const uint16_t durations[] = { 0 };
6463e464cd48SMatthias Ringwald             const uint16_t max_events[] = { 0 };
6464e464cd48SMatthias Ringwald             hci_send_cmd(&hci_le_set_extended_advertising_enable, 0, 1, advertising_handles, durations, max_events);
6465e464cd48SMatthias Ringwald         } else
6466e464cd48SMatthias Ringwald #endif
6467e464cd48SMatthias Ringwald         {
6468be7ef9d8SMatthias Ringwald             hci_stack->le_advertisements_state &= ~LE_ADVERTISEMENT_STATE_ACTIVE;
646945c102fdSMatthias Ringwald             hci_send_cmd(&hci_le_set_advertise_enable, 0);
6470e464cd48SMatthias Ringwald         }
6471f30077b7SMatthias Ringwald         return true;
647245c102fdSMatthias Ringwald     }
647353f240c0SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
6474c814a904SMatthias Ringwald #ifdef ENABLE_LE_PERIODIC_ADVERTISING
647549a6c69cSMatthias Ringwald     if (periodic_advertising_stop){
647653f240c0SMatthias Ringwald         advertising_stop_set->state &= ~LE_ADVERTISEMENT_STATE_PERIODIC_ACTIVE;
647753f240c0SMatthias Ringwald         hci_send_cmd(&hci_le_set_periodic_advertising_enable, 0, advertising_stop_set->advertising_handle);
647853f240c0SMatthias Ringwald         return true;
647953f240c0SMatthias Ringwald     }
6480c814a904SMatthias Ringwald #endif /* ENABLE_LE_PERIODIC_ADVERTISING */
6481c814a904SMatthias Ringwald #endif /* ENABLE_LE_EXTENDED_ADVERTISING */
6482a8016f96SMatthias Ringwald #endif /* ENABLE_LE_PERIPHERAL */
6483fde725feSMatthias Ringwald 
6484131d4778SMatthias Ringwald 
6485a41310b7SMatthias Ringwald     // Phase 3: modify
6486a41310b7SMatthias Ringwald 
6487137a570aSMatthias Ringwald     if (hci_stack->le_advertisements_todo & LE_ADVERTISEMENT_TASKS_PRIVACY_NOTIFY) {
6488137a570aSMatthias Ringwald         hci_stack->le_advertisements_todo &= ~LE_ADVERTISEMENT_TASKS_PRIVACY_NOTIFY;
6489137a570aSMatthias Ringwald         // GAP Privacy, notify clients upon upcoming random address change
6490137a570aSMatthias Ringwald         hci_stack->le_advertisements_state |= LE_ADVERTISEMENT_STATE_PRIVACY_PENDING;
64911fa7a4bbSMatthias Ringwald         // notify might cause hci_run to get executed, check if we still can send
6492137a570aSMatthias Ringwald         gap_privacy_clients_notify(hci_stack->le_random_address);
64931fa7a4bbSMatthias Ringwald         if (!hci_can_send_command_packet_now()) {
64941fa7a4bbSMatthias Ringwald             return true;
64951fa7a4bbSMatthias Ringwald         }
6496137a570aSMatthias Ringwald     }
6497137a570aSMatthias Ringwald 
6498137a570aSMatthias Ringwald     // - wait until privacy update completed
6499137a570aSMatthias Ringwald     if ((hci_stack->le_advertisements_state & LE_ADVERTISEMENT_STATE_PRIVACY_PENDING) != 0){
6500137a570aSMatthias Ringwald         return false;
6501137a570aSMatthias Ringwald     }
6502137a570aSMatthias Ringwald 
650364f9dabaSMatthias Ringwald     if (hci_stack->le_advertisements_todo & LE_ADVERTISEMENT_TASKS_SET_ADDRESS){
65049136bde8SMatthias Ringwald         hci_stack->le_advertisements_todo &= ~LE_ADVERTISEMENT_TASKS_SET_ADDRESS;
65059136bde8SMatthias Ringwald         hci_send_cmd(&hci_le_set_random_address, hci_stack->le_random_address);
6506ae35a99cSMatthias Ringwald #ifdef ENABLE_LE_SET_ADV_PARAMS_ON_RANDOM_ADDRESS_CHANGE
6507ae35a99cSMatthias Ringwald         // workaround: on some Controllers, address in advertisements is updated only after next dv params set
6508ae35a99cSMatthias Ringwald         hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_SET_PARAMS;
6509ae35a99cSMatthias Ringwald #endif
65109136bde8SMatthias Ringwald         return true;
65119136bde8SMatthias Ringwald     }
65129136bde8SMatthias Ringwald 
6513a41310b7SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
6514a41310b7SMatthias Ringwald     if (hci_stack->le_scanning_param_update){
6515a41310b7SMatthias Ringwald         hci_stack->le_scanning_param_update = false;
651663671e69SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
651722f987e4SMatthias Ringwald         if (hci_le_extended_advertising_supported()){
65187eb5b27eSMatthias Ringwald             // prepare arrays for all phys (LE Coded and LE 1M PHY)
65197eb5b27eSMatthias Ringwald             uint8_t  scan_types[2];
65207eb5b27eSMatthias Ringwald             uint16_t scan_intervals[2];
65217eb5b27eSMatthias Ringwald             uint16_t scan_windows[2];
65227eb5b27eSMatthias Ringwald 
65237eb5b27eSMatthias Ringwald             uint8_t i;
65247eb5b27eSMatthias Ringwald             uint8_t num_phys = hci_le_num_phys(hci_stack->le_scan_phys);
65257eb5b27eSMatthias Ringwald             for (i=0;i<num_phys;i++){
65267eb5b27eSMatthias Ringwald                 scan_types[i]     = hci_stack->le_scan_type;
65277eb5b27eSMatthias Ringwald                 scan_intervals[i] = hci_stack->le_scan_interval;
65287eb5b27eSMatthias Ringwald                 scan_windows[i]   = hci_stack->le_scan_window;
65297eb5b27eSMatthias Ringwald             }
653063671e69SMatthias Ringwald             hci_send_cmd(&hci_le_set_extended_scan_parameters, hci_stack->le_own_addr_type,
65317eb5b27eSMatthias Ringwald                          hci_stack->le_scan_filter_policy, hci_stack->le_scan_phys, scan_types, scan_intervals, scan_windows);
653263671e69SMatthias Ringwald         } else
653363671e69SMatthias Ringwald #endif
653463671e69SMatthias Ringwald         {
6535a41310b7SMatthias Ringwald             hci_send_cmd(&hci_le_set_scan_parameters, hci_stack->le_scan_type, hci_stack->le_scan_interval, hci_stack->le_scan_window,
6536a41310b7SMatthias Ringwald                          hci_stack->le_own_addr_type, hci_stack->le_scan_filter_policy);
653763671e69SMatthias Ringwald         }
6538a41310b7SMatthias Ringwald         return true;
6539a41310b7SMatthias Ringwald     }
6540a41310b7SMatthias Ringwald #endif
6541a41310b7SMatthias Ringwald 
6542a41310b7SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
654345c102fdSMatthias Ringwald     if (hci_stack->le_advertisements_todo & LE_ADVERTISEMENT_TASKS_SET_PARAMS){
654445c102fdSMatthias Ringwald         hci_stack->le_advertisements_todo &= ~LE_ADVERTISEMENT_TASKS_SET_PARAMS;
65456bcfa632SMatthias Ringwald         hci_stack->le_advertisements_own_addr_type = hci_stack->le_own_addr_type;
6546e464cd48SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
654722f987e4SMatthias Ringwald         if (hci_le_extended_advertising_supported()){
6548e464cd48SMatthias Ringwald             // map advertisment type to advertising event properties
6549e464cd48SMatthias Ringwald             uint16_t adv_event_properties = 0;
655036916f81SDirk Helbig             //                           0b00010011, 0b00010101, 0b00011101, 0b00010010, 0b00010000
655136916f81SDirk Helbig             const uint16_t mapping[] = {       0x13,       0x15,       0x1D,       0x12,       0x10 };
6552e464cd48SMatthias Ringwald             if (hci_stack->le_advertisements_type < (sizeof(mapping)/sizeof(uint16_t))){
6553e464cd48SMatthias Ringwald                 adv_event_properties = mapping[hci_stack->le_advertisements_type];
6554e464cd48SMatthias Ringwald             }
6555174b4d21SMatthias Ringwald             hci_stack->le_advertising_set_in_current_command = 0;
6556e464cd48SMatthias Ringwald             hci_send_cmd(&hci_le_set_extended_advertising_parameters,
6557e464cd48SMatthias Ringwald                          0,
6558e464cd48SMatthias Ringwald                          adv_event_properties,
6559e464cd48SMatthias Ringwald                          hci_stack->le_advertisements_interval_min,
6560e464cd48SMatthias Ringwald                          hci_stack->le_advertisements_interval_max,
6561e464cd48SMatthias Ringwald                          hci_stack->le_advertisements_channel_map,
6562e464cd48SMatthias Ringwald                          hci_stack->le_advertisements_own_addr_type,
6563e464cd48SMatthias Ringwald                          hci_stack->le_advertisements_direct_address_type,
6564e464cd48SMatthias Ringwald                          hci_stack->le_advertisements_direct_address,
6565e464cd48SMatthias Ringwald                          hci_stack->le_advertisements_filter_policy,
6566e464cd48SMatthias Ringwald                          0x7f,  // tx power: no preference
6567e464cd48SMatthias Ringwald                          0x01,  // primary adv phy: LE 1M
6568e464cd48SMatthias Ringwald                          0,     // secondary adv max skip
65695375ad13SMatthias Ringwald                          0x01,  // secondary adv phy
6570e464cd48SMatthias Ringwald                          0,     // adv sid
6571e464cd48SMatthias Ringwald                          0      // scan request notification
6572e464cd48SMatthias Ringwald                          );
6573d935373dSMatthias Ringwald         } else
6574e464cd48SMatthias Ringwald #endif
6575e464cd48SMatthias Ringwald         {
657645c102fdSMatthias Ringwald             hci_send_cmd(&hci_le_set_advertising_parameters,
657745c102fdSMatthias Ringwald                          hci_stack->le_advertisements_interval_min,
657845c102fdSMatthias Ringwald                          hci_stack->le_advertisements_interval_max,
657945c102fdSMatthias Ringwald                          hci_stack->le_advertisements_type,
65806bcfa632SMatthias Ringwald                          hci_stack->le_advertisements_own_addr_type,
658145c102fdSMatthias Ringwald                          hci_stack->le_advertisements_direct_address_type,
658245c102fdSMatthias Ringwald                          hci_stack->le_advertisements_direct_address,
658345c102fdSMatthias Ringwald                          hci_stack->le_advertisements_channel_map,
658445c102fdSMatthias Ringwald                          hci_stack->le_advertisements_filter_policy);
6585e464cd48SMatthias Ringwald         }
6586f30077b7SMatthias Ringwald         return true;
658745c102fdSMatthias Ringwald     }
6588be7ef9d8SMatthias Ringwald 
65899ce6dfa1SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
65909ce6dfa1SMatthias Ringwald     // assumption: only set if extended advertising is supported
65919ce6dfa1SMatthias Ringwald     if ((hci_stack->le_advertisements_todo & LE_ADVERTISEMENT_TASKS_SET_ADDRESS_SET_0) != 0){
65929ce6dfa1SMatthias Ringwald         hci_stack->le_advertisements_todo &= ~LE_ADVERTISEMENT_TASKS_SET_ADDRESS_SET_0;
65939ce6dfa1SMatthias Ringwald         hci_send_cmd(&hci_le_set_advertising_set_random_address, 0, hci_stack->le_random_address);
65949ce6dfa1SMatthias Ringwald         return true;
65959ce6dfa1SMatthias Ringwald     }
65969ce6dfa1SMatthias Ringwald #endif
65979ce6dfa1SMatthias Ringwald 
6598501f56b3SMatthias Ringwald     if (hci_stack->le_advertisements_todo & LE_ADVERTISEMENT_TASKS_SET_ADV_DATA){
6599501f56b3SMatthias Ringwald         hci_stack->le_advertisements_todo &= ~LE_ADVERTISEMENT_TASKS_SET_ADV_DATA;
66007a85e4f5SMatthias Ringwald         uint8_t adv_data_clean[31];
66017a85e4f5SMatthias Ringwald         memset(adv_data_clean, 0, sizeof(adv_data_clean));
66026535961aSMatthias Ringwald         (void)memcpy(adv_data_clean, hci_stack->le_advertisements_data,
66036535961aSMatthias Ringwald                      hci_stack->le_advertisements_data_len);
66043c9da642SMatthias Ringwald         btstack_replace_bd_addr_placeholder(adv_data_clean, hci_stack->le_advertisements_data_len, hci_stack->local_bd_addr);
6605e464cd48SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
660622f987e4SMatthias Ringwald         if (hci_le_extended_advertising_supported()){
6607174b4d21SMatthias Ringwald             hci_stack->le_advertising_set_in_current_command = 0;
6608e464cd48SMatthias Ringwald             hci_send_cmd(&hci_le_set_extended_advertising_data, 0, 0x03, 0x01, hci_stack->le_advertisements_data_len, adv_data_clean);
6609e464cd48SMatthias Ringwald         } else
6610e464cd48SMatthias Ringwald #endif
6611e464cd48SMatthias Ringwald         {
66127a85e4f5SMatthias Ringwald             hci_send_cmd(&hci_le_set_advertising_data, hci_stack->le_advertisements_data_len, adv_data_clean);
6613e464cd48SMatthias Ringwald         }
6614f30077b7SMatthias Ringwald         return true;
661545c102fdSMatthias Ringwald     }
6616be7ef9d8SMatthias Ringwald 
6617501f56b3SMatthias Ringwald     if (hci_stack->le_advertisements_todo & LE_ADVERTISEMENT_TASKS_SET_SCAN_DATA){
6618501f56b3SMatthias Ringwald         hci_stack->le_advertisements_todo &= ~LE_ADVERTISEMENT_TASKS_SET_SCAN_DATA;
6619f868b059SMatthias Ringwald         uint8_t scan_data_clean[31];
6620f868b059SMatthias Ringwald         memset(scan_data_clean, 0, sizeof(scan_data_clean));
66216535961aSMatthias Ringwald         (void)memcpy(scan_data_clean, hci_stack->le_scan_response_data,
66226535961aSMatthias Ringwald                      hci_stack->le_scan_response_data_len);
66233c9da642SMatthias Ringwald         btstack_replace_bd_addr_placeholder(scan_data_clean, hci_stack->le_scan_response_data_len, hci_stack->local_bd_addr);
6624e464cd48SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
662522f987e4SMatthias Ringwald         if (hci_le_extended_advertising_supported()){
6626174b4d21SMatthias Ringwald             hci_stack->le_advertising_set_in_current_command = 0;
6627e464cd48SMatthias Ringwald             hci_send_cmd(&hci_le_set_extended_scan_response_data, 0, 0x03, 0x01, hci_stack->le_scan_response_data_len, scan_data_clean);
6628e464cd48SMatthias Ringwald         } else
6629e464cd48SMatthias Ringwald #endif
6630e464cd48SMatthias Ringwald         {
6631214bfd60SMatthias Ringwald             hci_send_cmd(&hci_le_set_scan_response_data, hci_stack->le_scan_response_data_len, scan_data_clean);
6632e464cd48SMatthias Ringwald         }
6633f30077b7SMatthias Ringwald         return true;
6634501f56b3SMatthias Ringwald     }
6635be7ef9d8SMatthias Ringwald 
6636be7ef9d8SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
663722f987e4SMatthias Ringwald     if (hci_le_extended_advertising_supported()) {
6638be7ef9d8SMatthias Ringwald         btstack_linked_list_iterator_t it;
6639be7ef9d8SMatthias Ringwald         btstack_linked_list_iterator_init(&it, &hci_stack->le_advertising_sets);
6640be7ef9d8SMatthias Ringwald         while (btstack_linked_list_iterator_has_next(&it)){
6641be7ef9d8SMatthias Ringwald             le_advertising_set_t * advertising_set = (le_advertising_set_t*) btstack_linked_list_iterator_next(&it);
6642be7ef9d8SMatthias Ringwald             if ((advertising_set->tasks & LE_ADVERTISEMENT_TASKS_REMOVE_SET) != 0) {
6643be7ef9d8SMatthias Ringwald                 advertising_set->tasks &= ~LE_ADVERTISEMENT_TASKS_REMOVE_SET;
6644174b4d21SMatthias Ringwald                 hci_stack->le_advertising_set_in_current_command = advertising_set->advertising_handle;
6645be7ef9d8SMatthias Ringwald                 hci_send_cmd(&hci_le_remove_advertising_set, advertising_set->advertising_handle);
6646be7ef9d8SMatthias Ringwald                 return true;
6647be7ef9d8SMatthias Ringwald             }
6648be7ef9d8SMatthias Ringwald             if ((advertising_set->tasks & LE_ADVERTISEMENT_TASKS_SET_PARAMS) != 0){
6649be7ef9d8SMatthias Ringwald                 advertising_set->tasks &= ~LE_ADVERTISEMENT_TASKS_SET_PARAMS;
6650174b4d21SMatthias Ringwald                 hci_stack->le_advertising_set_in_current_command = advertising_set->advertising_handle;
6651be7ef9d8SMatthias Ringwald                 hci_send_cmd(&hci_le_set_extended_advertising_parameters,
6652be7ef9d8SMatthias Ringwald                              advertising_set->advertising_handle,
665357a04237SMatthias Ringwald                              advertising_set->extended_params.advertising_event_properties,
665457a04237SMatthias Ringwald                              advertising_set->extended_params.primary_advertising_interval_min,
665557a04237SMatthias Ringwald                              advertising_set->extended_params.primary_advertising_interval_max,
665657a04237SMatthias Ringwald                              advertising_set->extended_params.primary_advertising_channel_map,
665757a04237SMatthias Ringwald                              advertising_set->extended_params.own_address_type,
665857a04237SMatthias Ringwald                              advertising_set->extended_params.peer_address_type,
665957a04237SMatthias Ringwald                              advertising_set->extended_params.peer_address,
666057a04237SMatthias Ringwald                              advertising_set->extended_params.advertising_filter_policy,
666157a04237SMatthias Ringwald                              advertising_set->extended_params.advertising_tx_power,
666257a04237SMatthias Ringwald                              advertising_set->extended_params.primary_advertising_phy,
666357a04237SMatthias Ringwald                              advertising_set->extended_params.secondary_advertising_max_skip,
666457a04237SMatthias Ringwald                              advertising_set->extended_params.secondary_advertising_phy,
666557a04237SMatthias Ringwald                              advertising_set->extended_params.advertising_sid,
666657a04237SMatthias Ringwald                              advertising_set->extended_params.scan_request_notification_enable
6667be7ef9d8SMatthias Ringwald                 );
6668be7ef9d8SMatthias Ringwald                 return true;
6669be7ef9d8SMatthias Ringwald             }
66700f54aa8dSMatthias Ringwald             if ((advertising_set->tasks & LE_ADVERTISEMENT_TASKS_SET_ADDRESS) != 0){
66710f54aa8dSMatthias Ringwald                 advertising_set->tasks &= ~LE_ADVERTISEMENT_TASKS_SET_ADDRESS;
66720f54aa8dSMatthias Ringwald                 hci_send_cmd(&hci_le_set_advertising_set_random_address, advertising_set->advertising_handle, advertising_set->random_address);
66730f54aa8dSMatthias Ringwald                 return true;
66740f54aa8dSMatthias Ringwald             }
6675be7ef9d8SMatthias Ringwald             if ((advertising_set->tasks & LE_ADVERTISEMENT_TASKS_SET_ADV_DATA) != 0) {
6676be7ef9d8SMatthias Ringwald                 uint16_t pos = advertising_set->adv_data_pos;
6677be7ef9d8SMatthias Ringwald                 uint8_t  operation = hci_le_extended_advertising_operation_for_chunk(pos, advertising_set->adv_data_len);
6678be7ef9d8SMatthias Ringwald                 uint16_t data_to_upload = btstack_min(advertising_set->adv_data_len - pos, LE_EXTENDED_ADVERTISING_MAX_CHUNK_LEN);
6679be7ef9d8SMatthias Ringwald                 if ((operation & 0x02) != 0){
6680be7ef9d8SMatthias Ringwald                     // last fragment or complete data
6681be7ef9d8SMatthias Ringwald                     operation |= 2;
6682be7ef9d8SMatthias Ringwald                     advertising_set->adv_data_pos = 0;
6683be7ef9d8SMatthias Ringwald                     advertising_set->tasks &= ~LE_ADVERTISEMENT_TASKS_SET_ADV_DATA;
6684be7ef9d8SMatthias Ringwald                 } else {
6685be7ef9d8SMatthias Ringwald                     advertising_set->adv_data_pos += data_to_upload;
6686be7ef9d8SMatthias Ringwald                 }
6687174b4d21SMatthias Ringwald                 hci_stack->le_advertising_set_in_current_command = advertising_set->advertising_handle;
66880cbe4690SMatthias Ringwald                 hci_send_cmd(&hci_le_set_extended_advertising_data, advertising_set->advertising_handle, operation, 0x01, data_to_upload, &advertising_set->adv_data[pos]);
6689be7ef9d8SMatthias Ringwald                 return true;
6690be7ef9d8SMatthias Ringwald             }
6691be7ef9d8SMatthias Ringwald             if ((advertising_set->tasks & LE_ADVERTISEMENT_TASKS_SET_SCAN_DATA) != 0) {
6692be7ef9d8SMatthias Ringwald                 uint16_t pos = advertising_set->scan_data_pos;
6693be7ef9d8SMatthias Ringwald                 uint8_t  operation = hci_le_extended_advertising_operation_for_chunk(pos, advertising_set->scan_data_len);
6694be7ef9d8SMatthias Ringwald                 uint16_t data_to_upload = btstack_min(advertising_set->scan_data_len - pos, LE_EXTENDED_ADVERTISING_MAX_CHUNK_LEN);
6695be7ef9d8SMatthias Ringwald                 if ((operation & 0x02) != 0){
6696be7ef9d8SMatthias Ringwald                     advertising_set->scan_data_pos = 0;
6697be7ef9d8SMatthias Ringwald                     advertising_set->tasks &= ~LE_ADVERTISEMENT_TASKS_SET_SCAN_DATA;
6698be7ef9d8SMatthias Ringwald                 } else {
6699be7ef9d8SMatthias Ringwald                     advertising_set->scan_data_pos += data_to_upload;
6700be7ef9d8SMatthias Ringwald                 }
6701174b4d21SMatthias Ringwald                 hci_stack->le_advertising_set_in_current_command = advertising_set->advertising_handle;
67028ef6d15fSMatthias 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]);
6703be7ef9d8SMatthias Ringwald                 return true;
6704be7ef9d8SMatthias Ringwald             }
6705c814a904SMatthias Ringwald #ifdef ENABLE_LE_PERIODIC_ADVERTISING
670653f240c0SMatthias Ringwald             if ((advertising_set->tasks & LE_ADVERTISEMENT_TASKS_SET_PERIODIC_PARAMS) != 0){
670753f240c0SMatthias Ringwald                 advertising_set->tasks &= ~LE_ADVERTISEMENT_TASKS_SET_PERIODIC_PARAMS;
670853f240c0SMatthias Ringwald                 hci_stack->le_advertising_set_in_current_command = advertising_set->advertising_handle;
670953f240c0SMatthias Ringwald                 hci_send_cmd(&hci_le_set_periodic_advertising_parameters,
671053f240c0SMatthias Ringwald                              advertising_set->advertising_handle,
671153f240c0SMatthias Ringwald                              advertising_set->periodic_params.periodic_advertising_interval_min,
671253f240c0SMatthias Ringwald                              advertising_set->periodic_params.periodic_advertising_interval_max,
671353f240c0SMatthias Ringwald                              advertising_set->periodic_params.periodic_advertising_properties);
671453f240c0SMatthias Ringwald                 return true;
671553f240c0SMatthias Ringwald             }
671653f240c0SMatthias Ringwald             if ((advertising_set->tasks & LE_ADVERTISEMENT_TASKS_SET_PERIODIC_DATA) != 0) {
67170cbe4690SMatthias Ringwald                 uint16_t pos = advertising_set->periodic_data_pos;
671853f240c0SMatthias Ringwald                 uint8_t  operation = hci_le_extended_advertising_operation_for_chunk(pos, advertising_set->periodic_data_len);
671953f240c0SMatthias Ringwald                 uint16_t data_to_upload = btstack_min(advertising_set->periodic_data_len - pos, LE_EXTENDED_ADVERTISING_MAX_CHUNK_LEN);
672053f240c0SMatthias Ringwald                 if ((operation & 0x02) != 0){
672153f240c0SMatthias Ringwald                     // last fragment or complete data
672253f240c0SMatthias Ringwald                     operation |= 2;
67230cbe4690SMatthias Ringwald                     advertising_set->periodic_data_pos = 0;
672453f240c0SMatthias Ringwald                     advertising_set->tasks &= ~LE_ADVERTISEMENT_TASKS_SET_PERIODIC_DATA;
672553f240c0SMatthias Ringwald                 } else {
67260cbe4690SMatthias Ringwald                     advertising_set->periodic_data_pos += data_to_upload;
672753f240c0SMatthias Ringwald                 }
672853f240c0SMatthias Ringwald                 hci_stack->le_advertising_set_in_current_command = advertising_set->advertising_handle;
67290cbe4690SMatthias Ringwald                 hci_send_cmd(&hci_le_set_periodic_advertising_data, advertising_set->advertising_handle, operation, data_to_upload, &advertising_set->periodic_data[pos]);
673053f240c0SMatthias Ringwald                 return true;
673153f240c0SMatthias Ringwald             }
6732c814a904SMatthias Ringwald #endif /* ENABLE_LE_PERIODIC_ADVERTISING */
6733be7ef9d8SMatthias Ringwald         }
6734be7ef9d8SMatthias Ringwald     }
6735be7ef9d8SMatthias Ringwald #endif
6736be7ef9d8SMatthias Ringwald 
6737d70217a2SMatthias Ringwald #endif
67389956955bSMatthias Ringwald 
6739057ab60cSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
6740a41310b7SMatthias Ringwald     // if connect with whitelist was active and is not cancelled yet, wait until next time
6741a41310b7SMatthias Ringwald     if (hci_stack->le_connecting_state == LE_CONNECTING_CANCEL) return false;
67424bafedd5SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
67434bafedd5SMatthias Ringwald     // if periodic sync with advertiser list was active and is not cancelled yet, wait until next time
67444bafedd5SMatthias Ringwald     if (hci_stack->le_periodic_sync_state == LE_CONNECTING_CANCEL) return false;
67454bafedd5SMatthias Ringwald #endif
6746057ab60cSMatthias Ringwald #endif
6747057ab60cSMatthias Ringwald 
6748a41310b7SMatthias Ringwald     // LE Whitelist Management
6749a41310b7SMatthias Ringwald     if (whitelist_modification_pending){
67502c052b15SMatthias Ringwald         bool done = hci_whitelist_modification_process();
67512c052b15SMatthias Ringwald         if (done) return true;
675291915b0bSMatthias Ringwald     }
67539956955bSMatthias Ringwald 
675421debf25SMatthias Ringwald #ifdef ENABLE_LE_PRIVACY_ADDRESS_RESOLUTION
675521debf25SMatthias Ringwald     // LE Resolving List Management
67562fbf0ed0SMatthias Ringwald     if (resolving_list_modification_pending) {
675721debf25SMatthias Ringwald 		uint16_t i;
67588dc1b1d0SMatthias Ringwald         uint8_t null_16[16];
67598dc1b1d0SMatthias Ringwald         uint8_t local_irk_flipped[16];
67608dc1b1d0SMatthias Ringwald         const uint8_t *local_irk;
676121debf25SMatthias Ringwald 		switch (hci_stack->le_resolving_list_state) {
676221debf25SMatthias Ringwald 			case LE_RESOLVING_LIST_SEND_ENABLE_ADDRESS_RESOLUTION:
676321debf25SMatthias Ringwald 				hci_stack->le_resolving_list_state = LE_RESOLVING_LIST_READ_SIZE;
676421debf25SMatthias Ringwald 				hci_send_cmd(&hci_le_set_address_resolution_enabled, 1);
676521debf25SMatthias Ringwald 				return true;
676621debf25SMatthias Ringwald 			case LE_RESOLVING_LIST_READ_SIZE:
676721debf25SMatthias Ringwald 				hci_stack->le_resolving_list_state = LE_RESOLVING_LIST_SEND_CLEAR;
676821debf25SMatthias Ringwald 				hci_send_cmd(&hci_le_read_resolving_list_size);
676921debf25SMatthias Ringwald 				return true;
677021debf25SMatthias Ringwald 			case LE_RESOLVING_LIST_SEND_CLEAR:
67718dc1b1d0SMatthias Ringwald 				hci_stack->le_resolving_list_state = LE_RESOLVING_LIST_SET_IRK;
6772ea151974SMatthias Ringwald 				(void) memset(hci_stack->le_resolving_list_add_entries, 0xff,
6773ea151974SMatthias Ringwald 							  sizeof(hci_stack->le_resolving_list_add_entries));
6774e8ca66c6SMatthias Ringwald                 (void) memset(hci_stack->le_resolving_list_set_privacy_mode, 0xff,
6775e8ca66c6SMatthias Ringwald                               sizeof(hci_stack->le_resolving_list_set_privacy_mode));
6776ea151974SMatthias Ringwald 				(void) memset(hci_stack->le_resolving_list_remove_entries, 0,
6777ea151974SMatthias Ringwald 							  sizeof(hci_stack->le_resolving_list_remove_entries));
677821debf25SMatthias Ringwald 				hci_send_cmd(&hci_le_clear_resolving_list);
677921debf25SMatthias Ringwald 				return true;
67808dc1b1d0SMatthias Ringwald             case LE_RESOLVING_LIST_SET_IRK:
67818dc1b1d0SMatthias Ringwald                 // set IRK used by RPA for undirected advertising
67828dc1b1d0SMatthias Ringwald                 hci_stack->le_resolving_list_state = LE_RESOLVING_LIST_UPDATES_ENTRIES;
67838dc1b1d0SMatthias Ringwald                 local_irk = gap_get_persistent_irk();
67848dc1b1d0SMatthias Ringwald                 reverse_128(local_irk, local_irk_flipped);
67858dc1b1d0SMatthias Ringwald                 memset(null_16, 0, sizeof(null_16));
67868dc1b1d0SMatthias Ringwald                 hci_send_cmd(&hci_le_add_device_to_resolving_list, BD_ADDR_TYPE_LE_PUBLIC, null_16,
67878dc1b1d0SMatthias Ringwald                              null_16, local_irk_flipped);
67888dc1b1d0SMatthias Ringwald                 return true;
67895f3ccd83SMatthias Ringwald 			case LE_RESOLVING_LIST_UPDATES_ENTRIES:
67905f3ccd83SMatthias Ringwald                 // first remove old entries
679102b02cffSMatthias Ringwald 				for (i = 0; i < MAX_NUM_RESOLVING_LIST_ENTRIES && i < le_device_db_max_count(); i++) {
679202b02cffSMatthias Ringwald 					uint8_t offset = i >> 3;
679302b02cffSMatthias Ringwald 					uint8_t mask = 1 << (i & 7);
679402b02cffSMatthias Ringwald 					if ((hci_stack->le_resolving_list_remove_entries[offset] & mask) == 0) continue;
679502b02cffSMatthias Ringwald 					hci_stack->le_resolving_list_remove_entries[offset] &= ~mask;
679602b02cffSMatthias Ringwald 					bd_addr_t peer_identity_addreses;
679702b02cffSMatthias Ringwald 					int peer_identity_addr_type = (int) BD_ADDR_TYPE_UNKNOWN;
679802b02cffSMatthias Ringwald 					sm_key_t peer_irk;
679902b02cffSMatthias Ringwald 					le_device_db_info(i, &peer_identity_addr_type, peer_identity_addreses, peer_irk);
680002b02cffSMatthias Ringwald 					if (peer_identity_addr_type == BD_ADDR_TYPE_UNKNOWN) continue;
6801f5228c62SMatthias Ringwald 
6802f5228c62SMatthias Ringwald #ifdef ENABLE_LE_WHITELIST_TOUCH_AFTER_RESOLVING_LIST_UPDATE
6803f5228c62SMatthias Ringwald 					// trigger whitelist entry 'update' (work around for controller bug)
6804f5228c62SMatthias Ringwald 					btstack_linked_list_iterator_init(&lit, &hci_stack->le_whitelist);
6805f5228c62SMatthias Ringwald 					while (btstack_linked_list_iterator_has_next(&lit)) {
6806f5228c62SMatthias Ringwald 						whitelist_entry_t *entry = (whitelist_entry_t *) btstack_linked_list_iterator_next(&lit);
6807f5228c62SMatthias Ringwald 						if (entry->address_type != peer_identity_addr_type) continue;
6808f5228c62SMatthias Ringwald 						if (memcmp(entry->address, peer_identity_addreses, 6) != 0) continue;
6809f5228c62SMatthias Ringwald 						log_info("trigger whitelist update %s", bd_addr_to_str(peer_identity_addreses));
6810f5228c62SMatthias Ringwald 						entry->state |= LE_WHITELIST_REMOVE_FROM_CONTROLLER | LE_WHITELIST_ADD_TO_CONTROLLER;
6811f5228c62SMatthias Ringwald 					}
6812f5228c62SMatthias Ringwald #endif
6813f5228c62SMatthias Ringwald 
6814ea151974SMatthias Ringwald 					hci_send_cmd(&hci_le_remove_device_from_resolving_list, peer_identity_addr_type,
6815ea151974SMatthias Ringwald 								 peer_identity_addreses);
681602b02cffSMatthias Ringwald 					return true;
681702b02cffSMatthias Ringwald 				}
681802b02cffSMatthias Ringwald 
68195f3ccd83SMatthias Ringwald                 // then add new entries
682021debf25SMatthias Ringwald 				for (i = 0; i < MAX_NUM_RESOLVING_LIST_ENTRIES && i < le_device_db_max_count(); i++) {
682121debf25SMatthias Ringwald 					uint8_t offset = i >> 3;
682221debf25SMatthias Ringwald 					uint8_t mask = 1 << (i & 7);
682302b02cffSMatthias Ringwald 					if ((hci_stack->le_resolving_list_add_entries[offset] & mask) == 0) continue;
682402b02cffSMatthias Ringwald 					hci_stack->le_resolving_list_add_entries[offset] &= ~mask;
682521debf25SMatthias Ringwald 					bd_addr_t peer_identity_addreses;
682621debf25SMatthias Ringwald 					int peer_identity_addr_type = (int) BD_ADDR_TYPE_UNKNOWN;
682721debf25SMatthias Ringwald 					sm_key_t peer_irk;
682821debf25SMatthias Ringwald 					le_device_db_info(i, &peer_identity_addr_type, peer_identity_addreses, peer_irk);
682921debf25SMatthias Ringwald 					if (peer_identity_addr_type == BD_ADDR_TYPE_UNKNOWN) continue;
6830e938c062SMatthias Ringwald                     if (btstack_is_null(peer_irk, 16)) continue;
68312b6efc4dSMatthias Ringwald 					local_irk = gap_get_persistent_irk();
683221debf25SMatthias Ringwald 					// command uses format specifier 'P' that stores 16-byte value without flip
683321debf25SMatthias Ringwald 					uint8_t peer_irk_flipped[16];
683421debf25SMatthias Ringwald 					reverse_128(local_irk, local_irk_flipped);
683521debf25SMatthias Ringwald 					reverse_128(peer_irk, peer_irk_flipped);
6836ea151974SMatthias Ringwald 					hci_send_cmd(&hci_le_add_device_to_resolving_list, peer_identity_addr_type, peer_identity_addreses,
6837ea151974SMatthias Ringwald 								 peer_irk_flipped, local_irk_flipped);
683821debf25SMatthias Ringwald 					return true;
683921debf25SMatthias Ringwald 				}
6840e8ca66c6SMatthias Ringwald 
6841e8ca66c6SMatthias Ringwald                 // finally, set privacy mode
6842e8ca66c6SMatthias Ringwald                 for (i = 0; i < MAX_NUM_RESOLVING_LIST_ENTRIES && i < le_device_db_max_count(); i++) {
6843e8ca66c6SMatthias Ringwald                     uint8_t offset = i >> 3;
6844e8ca66c6SMatthias Ringwald                     uint8_t mask = 1 << (i & 7);
6845e8ca66c6SMatthias Ringwald                     if ((hci_stack->le_resolving_list_set_privacy_mode[offset] & mask) == 0) continue;
6846e8ca66c6SMatthias Ringwald                     hci_stack->le_resolving_list_set_privacy_mode[offset] &= ~mask;
6847e8ca66c6SMatthias Ringwald                     if (hci_stack->le_privacy_mode == LE_PRIVACY_MODE_NETWORK) {
6848e8ca66c6SMatthias Ringwald                         // Network Privacy Mode is default
6849e8ca66c6SMatthias Ringwald                         continue;
6850e8ca66c6SMatthias Ringwald                     }
6851e8ca66c6SMatthias Ringwald                     bd_addr_t peer_identity_address;
6852e8ca66c6SMatthias Ringwald                     int peer_identity_addr_type = (int) BD_ADDR_TYPE_UNKNOWN;
6853e8ca66c6SMatthias Ringwald                     sm_key_t peer_irk;
6854e8ca66c6SMatthias Ringwald                     le_device_db_info(i, &peer_identity_addr_type, peer_identity_address, peer_irk);
6855e8ca66c6SMatthias Ringwald                     if (peer_identity_addr_type == BD_ADDR_TYPE_UNKNOWN) continue;
6856e8ca66c6SMatthias Ringwald                     if (btstack_is_null(peer_irk, 16)) continue;
6857e8ca66c6SMatthias Ringwald                     // command uses format specifier 'P' that stores 16-byte value without flip
6858e8ca66c6SMatthias Ringwald                     uint8_t peer_irk_flipped[16];
6859e8ca66c6SMatthias Ringwald                     reverse_128(peer_irk, peer_irk_flipped);
6860e8ca66c6SMatthias Ringwald                     hci_send_cmd(&hci_le_set_privacy_mode, peer_identity_addr_type, peer_identity_address, hci_stack->le_privacy_mode);
6861e8ca66c6SMatthias Ringwald                     return true;
6862e8ca66c6SMatthias Ringwald                 }
686321debf25SMatthias Ringwald 				break;
686402b02cffSMatthias Ringwald 
686521debf25SMatthias Ringwald 			default:
686621debf25SMatthias Ringwald 				break;
686721debf25SMatthias Ringwald 		}
686821debf25SMatthias Ringwald         hci_stack->le_resolving_list_state = LE_RESOLVING_LIST_DONE;
68692fbf0ed0SMatthias Ringwald 	}
687021debf25SMatthias Ringwald #endif
6871a41310b7SMatthias Ringwald 
6872f40c73b4SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
6873f40c73b4SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
6874f40c73b4SMatthias Ringwald     // LE Whitelist Management
6875f40c73b4SMatthias Ringwald     if (periodic_list_modification_pending){
6876f40c73b4SMatthias Ringwald         // add/remove entries
6877f40c73b4SMatthias Ringwald         btstack_linked_list_iterator_init(&lit, &hci_stack->le_periodic_advertiser_list);
6878f40c73b4SMatthias Ringwald         while (btstack_linked_list_iterator_has_next(&lit)){
6879f40c73b4SMatthias Ringwald             periodic_advertiser_list_entry_t * entry = (periodic_advertiser_list_entry_t*) btstack_linked_list_iterator_next(&lit);
6880f40c73b4SMatthias Ringwald             if (entry->state & LE_PERIODIC_ADVERTISER_LIST_ENTRY_REMOVE_FROM_CONTROLLER){
6881f40c73b4SMatthias Ringwald                 entry->state &= ~LE_PERIODIC_ADVERTISER_LIST_ENTRY_REMOVE_FROM_CONTROLLER;
6882d946a741SMatthias Ringwald                 hci_send_cmd(&hci_le_remove_device_from_periodic_advertiser_list, entry->address_type, entry->address, entry->sid);
6883f40c73b4SMatthias Ringwald                 return true;
6884f40c73b4SMatthias Ringwald             }
6885f40c73b4SMatthias Ringwald             if (entry->state & LE_PERIODIC_ADVERTISER_LIST_ENTRY_ADD_TO_CONTROLLER){
6886f40c73b4SMatthias Ringwald                 entry->state &= ~LE_PERIODIC_ADVERTISER_LIST_ENTRY_ADD_TO_CONTROLLER;
6887f40c73b4SMatthias Ringwald                 entry->state |= LE_PERIODIC_ADVERTISER_LIST_ENTRY_ON_CONTROLLER;
68889e88556bSMatthias Ringwald                 hci_send_cmd(&hci_le_add_device_to_periodic_advertiser_list, entry->address_type, entry->address, entry->sid);
6889f40c73b4SMatthias Ringwald                 return true;
6890f40c73b4SMatthias Ringwald             }
6891f40c73b4SMatthias Ringwald             if ((entry->state & LE_PERIODIC_ADVERTISER_LIST_ENTRY_ON_CONTROLLER) == 0){
6892f40c73b4SMatthias Ringwald                 btstack_linked_list_remove(&hci_stack->le_periodic_advertiser_list, (btstack_linked_item_t *) entry);
6893f40c73b4SMatthias Ringwald                 btstack_memory_periodic_advertiser_list_entry_free(entry);
6894f40c73b4SMatthias Ringwald             }
6895f40c73b4SMatthias Ringwald         }
6896f40c73b4SMatthias Ringwald     }
6897f40c73b4SMatthias Ringwald #endif
6898f40c73b4SMatthias Ringwald #endif
6899f40c73b4SMatthias Ringwald 
690098aa715fSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
690198aa715fSMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
690298aa715fSMatthias Ringwald #ifdef ENABLE_LE_PERIODIC_ADVERTISING
690398aa715fSMatthias Ringwald     if (hci_stack->le_past_set_default_params){
690498aa715fSMatthias Ringwald         hci_stack->le_past_set_default_params = false;
690598aa715fSMatthias Ringwald         hci_send_cmd(&hci_le_set_default_periodic_advertising_sync_transfer_parameters,
690698aa715fSMatthias Ringwald                      hci_stack->le_past_mode,
690798aa715fSMatthias Ringwald                      hci_stack->le_past_skip,
690898aa715fSMatthias Ringwald                      hci_stack->le_past_sync_timeout,
690998aa715fSMatthias Ringwald                      hci_stack->le_past_cte_type);
691098aa715fSMatthias Ringwald         return true;
691198aa715fSMatthias Ringwald     }
691298aa715fSMatthias Ringwald #endif
691398aa715fSMatthias Ringwald #endif
691498aa715fSMatthias Ringwald #endif
691598aa715fSMatthias Ringwald 
6916a086dc35SMatthias Ringwald     // postpone all actions until stack is fully working
691773799937SMatthias Ringwald     if (hci_stack->state != HCI_STATE_WORKING) return false;
691873799937SMatthias Ringwald 
691973799937SMatthias Ringwald     // advertisements, active scanning, and creating connections requires random address to be set if using private address
692073799937SMatthias Ringwald     if ( (hci_stack->le_own_addr_type != BD_ADDR_TYPE_LE_PUBLIC) && (hci_stack->le_random_address_set == 0u) ) return false;
692173799937SMatthias Ringwald 
6922a41310b7SMatthias Ringwald     // Phase 4: restore state
692329c24bebSMatthias Ringwald 
692429c24bebSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
6925af64f147SMatthias Ringwald     // re-start scanning
692629c24bebSMatthias Ringwald     if ((hci_stack->le_scanning_enabled && !hci_stack->le_scanning_active)){
692729c24bebSMatthias Ringwald         hci_stack->le_scanning_active = true;
692863671e69SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
692922f987e4SMatthias Ringwald         if (hci_le_extended_advertising_supported()){
69304856283bSMatthias Ringwald             hci_send_cmd(&hci_le_set_extended_scan_enable, 1, hci_stack->le_scan_filter_duplicates, 0, 0);
693163671e69SMatthias Ringwald         } else
693263671e69SMatthias Ringwald #endif
693363671e69SMatthias Ringwald         {
69344856283bSMatthias Ringwald             hci_send_cmd(&hci_le_set_scan_enable, 1, hci_stack->le_scan_filter_duplicates);
693563671e69SMatthias Ringwald         }
693629c24bebSMatthias Ringwald         return true;
693729c24bebSMatthias Ringwald     }
693829c24bebSMatthias Ringwald #endif
693929c24bebSMatthias Ringwald 
694013eb2a2eSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
6941af64f147SMatthias Ringwald     // re-start connecting
6942af64f147SMatthias Ringwald     if ( (hci_stack->le_connecting_state == LE_CONNECTING_IDLE) && (hci_stack->le_connecting_request == LE_CONNECTING_WHITELIST)){
69439956955bSMatthias Ringwald         bd_addr_t null_addr;
69449956955bSMatthias Ringwald         memset(null_addr, 0, 6);
69456bcfa632SMatthias Ringwald         hci_stack->le_connection_own_addr_type =  hci_stack->le_own_addr_type;
69466bcfa632SMatthias Ringwald         hci_get_own_address_for_addr_type(hci_stack->le_connection_own_addr_type, hci_stack->le_connection_own_address);
69476f34e9d6SMatthias Ringwald         hci_send_le_create_connection(1, 0, null_addr);
6948f30077b7SMatthias Ringwald         return true;
69499956955bSMatthias Ringwald     }
69504bafedd5SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
69514bafedd5SMatthias Ringwald     if (hci_stack->le_periodic_sync_state == LE_CONNECTING_IDLE){
69524bafedd5SMatthias Ringwald         switch(hci_stack->le_periodic_sync_request){
69534bafedd5SMatthias Ringwald             case LE_CONNECTING_DIRECT:
69544bafedd5SMatthias Ringwald             case LE_CONNECTING_WHITELIST:
69554bafedd5SMatthias Ringwald                 hci_stack->le_periodic_sync_state = ((hci_stack->le_periodic_sync_options & 1) != 0) ? LE_CONNECTING_WHITELIST : LE_CONNECTING_DIRECT;
69564bafedd5SMatthias Ringwald                 hci_send_cmd(&hci_le_periodic_advertising_create_sync,
69574bafedd5SMatthias Ringwald                              hci_stack->le_periodic_sync_options,
69584bafedd5SMatthias Ringwald                              hci_stack->le_periodic_sync_advertising_sid,
69594bafedd5SMatthias Ringwald                              hci_stack->le_periodic_sync_advertiser_address_type,
69604bafedd5SMatthias Ringwald                              hci_stack->le_periodic_sync_advertiser_address,
69614bafedd5SMatthias Ringwald                              hci_stack->le_periodic_sync_skip,
69624bafedd5SMatthias Ringwald                              hci_stack->le_periodic_sync_timeout,
69634bafedd5SMatthias Ringwald                              hci_stack->le_periodic_sync_cte_type);
69644bafedd5SMatthias Ringwald                 return true;
69654bafedd5SMatthias Ringwald             default:
69664bafedd5SMatthias Ringwald                 break;
69674bafedd5SMatthias Ringwald         }
69684bafedd5SMatthias Ringwald     }
69694bafedd5SMatthias Ringwald #endif
6970d70217a2SMatthias Ringwald #endif
6971a41310b7SMatthias Ringwald 
6972a41310b7SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
6973a41310b7SMatthias Ringwald     // re-start advertising
6974935aa76eSMatthias Ringwald     if (hci_stack->le_advertisements_enabled_for_current_roles && ((hci_stack->le_advertisements_state & LE_ADVERTISEMENT_STATE_ACTIVE) == 0)){
6975a41310b7SMatthias Ringwald         // check if advertisements should be enabled given
6976935aa76eSMatthias Ringwald         hci_stack->le_advertisements_state |= LE_ADVERTISEMENT_STATE_ACTIVE;
6977b892db1cSMatthias Ringwald         hci_get_own_address_for_addr_type(hci_stack->le_advertisements_own_addr_type, hci_stack->le_advertisements_own_address);
6978e464cd48SMatthias Ringwald 
6979e464cd48SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
698022f987e4SMatthias Ringwald         if (hci_le_extended_advertising_supported()){
6981e464cd48SMatthias Ringwald             const uint8_t advertising_handles[] = { 0 };
6982e464cd48SMatthias Ringwald             const uint16_t durations[] = { 0 };
6983e464cd48SMatthias Ringwald             const uint16_t max_events[] = { 0 };
6984e464cd48SMatthias Ringwald             hci_send_cmd(&hci_le_set_extended_advertising_enable, 1, 1, advertising_handles, durations, max_events);
6985e464cd48SMatthias Ringwald         } else
6986e464cd48SMatthias Ringwald #endif
6987e464cd48SMatthias Ringwald         {
6988a41310b7SMatthias Ringwald             hci_send_cmd(&hci_le_set_advertise_enable, 1);
6989e464cd48SMatthias Ringwald         }
6990a41310b7SMatthias Ringwald         return true;
6991a41310b7SMatthias Ringwald     }
6992be7ef9d8SMatthias Ringwald 
6993be7ef9d8SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
699422f987e4SMatthias Ringwald     if (hci_le_extended_advertising_supported()) {
6995be7ef9d8SMatthias Ringwald         btstack_linked_list_iterator_t it;
6996be7ef9d8SMatthias Ringwald         btstack_linked_list_iterator_init(&it, &hci_stack->le_advertising_sets);
6997be7ef9d8SMatthias Ringwald         while (btstack_linked_list_iterator_has_next(&it)) {
6998be7ef9d8SMatthias Ringwald             le_advertising_set_t *advertising_set = (le_advertising_set_t *) btstack_linked_list_iterator_next(&it);
6999be7ef9d8SMatthias Ringwald             if (((advertising_set->state & LE_ADVERTISEMENT_STATE_ENABLED) != 0) && ((advertising_set->state & LE_ADVERTISEMENT_STATE_ACTIVE) == 0)){
70008caa405cSMatthias Ringwald                 advertising_set->state |= LE_ADVERTISEMENT_STATE_ACTIVE;
7001be7ef9d8SMatthias Ringwald                 const uint8_t advertising_handles[] = { advertising_set->advertising_handle };
7002be7ef9d8SMatthias Ringwald                 const uint16_t durations[] = { advertising_set->enable_timeout };
7003be7ef9d8SMatthias Ringwald                 const uint16_t max_events[] = { advertising_set->enable_max_scan_events };
7004be7ef9d8SMatthias Ringwald                 hci_send_cmd(&hci_le_set_extended_advertising_enable, 1, 1, advertising_handles, durations, max_events);
7005be7ef9d8SMatthias Ringwald                 return true;
7006be7ef9d8SMatthias Ringwald             }
7007c814a904SMatthias Ringwald #ifdef ENABLE_LE_PERIODIC_ADVERTISING
700853f240c0SMatthias Ringwald             if (((advertising_set->state & LE_ADVERTISEMENT_STATE_PERIODIC_ENABLED) != 0) && ((advertising_set->state & LE_ADVERTISEMENT_STATE_PERIODIC_ACTIVE) == 0)){
700953f240c0SMatthias Ringwald                 advertising_set->state |= LE_ADVERTISEMENT_STATE_PERIODIC_ACTIVE;
701053f240c0SMatthias Ringwald                 uint8_t enable = 1;
701153f240c0SMatthias Ringwald                 if (advertising_set->periodic_include_adi){
701253f240c0SMatthias Ringwald                     enable |= 2;
701353f240c0SMatthias Ringwald                 }
701453f240c0SMatthias Ringwald                 hci_send_cmd(&hci_le_set_periodic_advertising_enable, enable, advertising_set->advertising_handle);
701553f240c0SMatthias Ringwald                 return true;
701653f240c0SMatthias Ringwald             }
7017c814a904SMatthias Ringwald #endif /* ENABLE_LE_PERIODIC_ADVERTISING */
7018be7ef9d8SMatthias Ringwald         }
7019be7ef9d8SMatthias Ringwald     }
7020be7ef9d8SMatthias Ringwald #endif
7021a41310b7SMatthias Ringwald #endif
7022a41310b7SMatthias Ringwald 
7023f30077b7SMatthias Ringwald     return false;
70247bdc6798S[email protected] }
70257aa35f6aSMatthias Ringwald 
70267aa35f6aSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
70277aa35f6aSMatthias Ringwald static bool hci_run_iso_tasks(void){
70287aa35f6aSMatthias Ringwald     btstack_linked_list_iterator_t it;
70292a6c0f82SMatthias Ringwald 
703026b93350SMatthias Ringwald     if (hci_stack->iso_active_operation_type != HCI_ISO_TYPE_INVALID) {
703140f86dfdSMatthias Ringwald         return false;
703240f86dfdSMatthias Ringwald     }
703340f86dfdSMatthias Ringwald 
70342a6c0f82SMatthias Ringwald     // BIG
70357aa35f6aSMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->le_audio_bigs);
70367aa35f6aSMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
70377aa35f6aSMatthias Ringwald         le_audio_big_t * big = (le_audio_big_t *) btstack_linked_list_iterator_next(&it);
70387aa35f6aSMatthias Ringwald         switch (big->state){
70397aa35f6aSMatthias Ringwald             case LE_AUDIO_BIG_STATE_CREATE:
704040f86dfdSMatthias Ringwald                 hci_stack->iso_active_operation_group_id = big->params->big_handle;
704140f86dfdSMatthias Ringwald                 hci_stack->iso_active_operation_type = HCI_ISO_TYPE_BIS;
70427aa35f6aSMatthias Ringwald                 big->state = LE_AUDIO_BIG_STATE_W4_ESTABLISHED;
70437aa35f6aSMatthias Ringwald                 hci_send_cmd(&hci_le_create_big,
70447aa35f6aSMatthias Ringwald                              big->params->big_handle,
70457aa35f6aSMatthias Ringwald                              big->params->advertising_handle,
70467aa35f6aSMatthias Ringwald                              big->params->num_bis,
70477aa35f6aSMatthias Ringwald                              big->params->sdu_interval_us,
70487aa35f6aSMatthias Ringwald                              big->params->max_sdu,
70497aa35f6aSMatthias Ringwald                              big->params->max_transport_latency_ms,
70507aa35f6aSMatthias Ringwald                              big->params->rtn,
70517aa35f6aSMatthias Ringwald                              big->params->phy,
70527aa35f6aSMatthias Ringwald                              big->params->packing,
70537aa35f6aSMatthias Ringwald                              big->params->framing,
70547aa35f6aSMatthias Ringwald                              big->params->encryption,
70557aa35f6aSMatthias Ringwald                              big->params->broadcast_code);
70567aa35f6aSMatthias Ringwald                 return true;
70577aa35f6aSMatthias Ringwald             case LE_AUDIO_BIG_STATE_SETUP_ISO_PATH:
70587aa35f6aSMatthias Ringwald                 big->state = LE_AUDIO_BIG_STATE_W4_SETUP_ISO_PATH;
705985dc435bSDirk 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);
70607aa35f6aSMatthias Ringwald                 return true;
70617aa35f6aSMatthias Ringwald             case LE_AUDIO_BIG_STATE_SETUP_ISO_PATHS_FAILED:
70627aa35f6aSMatthias Ringwald                 big->state = LE_AUDIO_BIG_STATE_W4_TERMINATED_AFTER_SETUP_FAILED;
70632a6c0f82SMatthias Ringwald                 hci_send_cmd(&hci_le_terminate_big, big->big_handle, big->state_vars.status);
7064c1f83111SMatthias Ringwald                 return true;
70657aa35f6aSMatthias Ringwald             case LE_AUDIO_BIG_STATE_TERMINATE:
70667aa35f6aSMatthias Ringwald                 big->state = LE_AUDIO_BIG_STATE_W4_TERMINATED;
7067d1620e55SMatthias Ringwald                 hci_send_cmd(&hci_le_terminate_big, big->big_handle, ERROR_CODE_REMOTE_USER_TERMINATED_CONNECTION);
70687aa35f6aSMatthias Ringwald                 return true;
70697aa35f6aSMatthias Ringwald             default:
70707aa35f6aSMatthias Ringwald                 break;
70717aa35f6aSMatthias Ringwald         }
70727aa35f6aSMatthias Ringwald     }
70732a6c0f82SMatthias Ringwald 
70742a6c0f82SMatthias Ringwald     // BIG Sync
70752a6c0f82SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->le_audio_big_syncs);
70762a6c0f82SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
70772a6c0f82SMatthias Ringwald         le_audio_big_sync_t * big_sync = (le_audio_big_sync_t *) btstack_linked_list_iterator_next(&it);
70782a6c0f82SMatthias Ringwald         switch (big_sync->state){
70792a6c0f82SMatthias Ringwald             case LE_AUDIO_BIG_STATE_CREATE:
708040f86dfdSMatthias Ringwald                 hci_stack->iso_active_operation_group_id = big_sync->params->big_handle;
708140f86dfdSMatthias Ringwald                 hci_stack->iso_active_operation_type = HCI_ISO_TYPE_BIS;
70822a6c0f82SMatthias Ringwald                 big_sync->state = LE_AUDIO_BIG_STATE_W4_ESTABLISHED;
70832a6c0f82SMatthias Ringwald                 hci_send_cmd(&hci_le_big_create_sync,
70842a6c0f82SMatthias Ringwald                              big_sync->params->big_handle,
70852a6c0f82SMatthias Ringwald                              big_sync->params->sync_handle,
70862a6c0f82SMatthias Ringwald                              big_sync->params->encryption,
70872a6c0f82SMatthias Ringwald                              big_sync->params->broadcast_code,
70882a6c0f82SMatthias Ringwald                              big_sync->params->mse,
70892a6c0f82SMatthias Ringwald                              big_sync->params->big_sync_timeout_10ms,
70902a6c0f82SMatthias Ringwald                              big_sync->params->num_bis,
70912a6c0f82SMatthias Ringwald                              big_sync->params->bis_indices);
70922a6c0f82SMatthias Ringwald                 return true;
70932a6c0f82SMatthias Ringwald             case LE_AUDIO_BIG_STATE_SETUP_ISO_PATH:
70942a6c0f82SMatthias Ringwald                 big_sync->state = LE_AUDIO_BIG_STATE_W4_SETUP_ISO_PATH;
709585dc435bSDirk 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);
70962a6c0f82SMatthias Ringwald                 return true;
70972a6c0f82SMatthias Ringwald             case LE_AUDIO_BIG_STATE_SETUP_ISO_PATHS_FAILED:
70982a6c0f82SMatthias Ringwald                 big_sync->state = LE_AUDIO_BIG_STATE_W4_TERMINATED_AFTER_SETUP_FAILED;
70992a6c0f82SMatthias Ringwald                 hci_send_cmd(&hci_le_big_terminate_sync, big_sync->big_handle);
7100c1f83111SMatthias Ringwald                 return true;
71012a6c0f82SMatthias Ringwald             case LE_AUDIO_BIG_STATE_TERMINATE:
71022a6c0f82SMatthias Ringwald                 big_sync->state = LE_AUDIO_BIG_STATE_W4_TERMINATED;
71032a6c0f82SMatthias Ringwald                 hci_send_cmd(&hci_le_big_terminate_sync, big_sync->big_handle);
71042a6c0f82SMatthias Ringwald                 return true;
71052a6c0f82SMatthias Ringwald             default:
71062a6c0f82SMatthias Ringwald                 break;
71072a6c0f82SMatthias Ringwald         }
71082a6c0f82SMatthias Ringwald     }
71092a6c0f82SMatthias Ringwald 
7110d3a89d91SMatthias Ringwald     // CIG
7111d90722d4SMatthias Ringwald     bool cig_active;
7112d3a89d91SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->le_audio_cigs);
7113d3a89d91SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)) {
7114d3a89d91SMatthias Ringwald         le_audio_cig_t *cig = (le_audio_cig_t *) btstack_linked_list_iterator_next(&it);
7115d3a89d91SMatthias Ringwald         uint8_t i;
7116444e371eSMatthias Ringwald         // Set CIG Parameters
7117d3a89d91SMatthias Ringwald         uint8_t cis_id[MAX_NR_CIS];
7118d3a89d91SMatthias Ringwald         uint16_t max_sdu_c_to_p[MAX_NR_CIS];
7119d3a89d91SMatthias Ringwald         uint16_t max_sdu_p_to_c[MAX_NR_CIS];
7120d3a89d91SMatthias Ringwald         uint8_t phy_c_to_p[MAX_NR_CIS];
7121d3a89d91SMatthias Ringwald         uint8_t phy_p_to_c[MAX_NR_CIS];
7122d3a89d91SMatthias Ringwald         uint8_t rtn_c_to_p[MAX_NR_CIS];
7123d3a89d91SMatthias Ringwald         uint8_t rtn_p_to_c[MAX_NR_CIS];
7124d3a89d91SMatthias Ringwald         switch (cig->state) {
7125d3a89d91SMatthias Ringwald             case LE_AUDIO_CIG_STATE_CREATE:
7126d3a89d91SMatthias Ringwald                 hci_stack->iso_active_operation_group_id = cig->params->cig_id;
7127d3a89d91SMatthias Ringwald                 hci_stack->iso_active_operation_type = HCI_ISO_TYPE_CIS;
7128d3a89d91SMatthias Ringwald                 cig->state = LE_AUDIO_CIG_STATE_W4_ESTABLISHED;
7129d3a89d91SMatthias Ringwald                 le_audio_cig_params_t * params = cig->params;
7130d3a89d91SMatthias Ringwald                 for (i = 0; i < params->num_cis; i++) {
7131d3a89d91SMatthias Ringwald                     le_audio_cis_params_t * cis_params = &cig->params->cis_params[i];
7132d3a89d91SMatthias Ringwald                     cis_id[i]         = cis_params->cis_id;
7133d3a89d91SMatthias Ringwald                     max_sdu_c_to_p[i] = cis_params->max_sdu_c_to_p;
7134d3a89d91SMatthias Ringwald                     max_sdu_p_to_c[i] = cis_params->max_sdu_p_to_c;
7135d3a89d91SMatthias Ringwald                     phy_c_to_p[i]     = cis_params->phy_c_to_p;
7136d3a89d91SMatthias Ringwald                     phy_p_to_c[i]     = cis_params->phy_p_to_c;
7137d3a89d91SMatthias Ringwald                     rtn_c_to_p[i]     = cis_params->rtn_c_to_p;
7138d3a89d91SMatthias Ringwald                     rtn_p_to_c[i]     = cis_params->rtn_p_to_c;
7139d3a89d91SMatthias Ringwald                 }
7140d3a89d91SMatthias Ringwald                 hci_send_cmd(&hci_le_set_cig_parameters,
7141d3a89d91SMatthias Ringwald                              cig->cig_id,
7142d3a89d91SMatthias Ringwald                              params->sdu_interval_c_to_p,
7143d3a89d91SMatthias Ringwald                              params->sdu_interval_p_to_c,
7144d3a89d91SMatthias Ringwald                              params->worst_case_sca,
7145d3a89d91SMatthias Ringwald                              params->packing,
7146d3a89d91SMatthias Ringwald                              params->framing,
7147d3a89d91SMatthias Ringwald                              params->max_transport_latency_c_to_p,
7148d3a89d91SMatthias Ringwald                              params->max_transport_latency_p_to_c,
7149d3a89d91SMatthias Ringwald                              params->num_cis,
7150d3a89d91SMatthias Ringwald                              cis_id,
7151d3a89d91SMatthias Ringwald                              max_sdu_c_to_p,
7152d3a89d91SMatthias Ringwald                              max_sdu_p_to_c,
7153d3a89d91SMatthias Ringwald                              phy_c_to_p,
7154d3a89d91SMatthias Ringwald                              phy_p_to_c,
7155d3a89d91SMatthias Ringwald                              rtn_c_to_p,
7156d3a89d91SMatthias Ringwald                              rtn_p_to_c
7157d3a89d91SMatthias Ringwald                 );
7158bb42b5c0SMatthias Ringwald                 return true;
7159444e371eSMatthias Ringwald             case LE_AUDIO_CIG_STATE_CREATE_CIS:
7160bb42b5c0SMatthias Ringwald                 hci_stack->iso_active_operation_group_id = cig->params->cig_id;
7161bb42b5c0SMatthias Ringwald                 hci_stack->iso_active_operation_type = HCI_ISO_TYPE_CIS;
7162444e371eSMatthias Ringwald                 cig->state = LE_AUDIO_CIG_STATE_W4_CREATE_CIS;
71633abcd16cSMatthias Ringwald                 for (i=0;i<cig->num_cis;i++){
71643abcd16cSMatthias Ringwald                     cig->cis_setup_active[i] = true;
71653abcd16cSMatthias Ringwald                 }
7166444e371eSMatthias Ringwald                 hci_send_cmd(&hci_le_create_cis, cig->num_cis, cig->cis_con_handles, cig->acl_con_handles);
7167bb42b5c0SMatthias Ringwald                 return true;
7168f9306a1aSMatthias Ringwald             case LE_AUDIO_CIG_STATE_SETUP_ISO_PATH:
7169c5f5d706SMatthias Ringwald                 for ( ; cig->state_vars.next_cis < (cig->num_cis * 2) ; cig->state_vars.next_cis++ ){
7170f9306a1aSMatthias Ringwald                     // find next path to setup
7171f9306a1aSMatthias Ringwald                     uint8_t cis_index = cig->state_vars.next_cis >> 1;
7172f9306a1aSMatthias Ringwald                     if (cig->cis_established[cis_index] == false) {
7173f9306a1aSMatthias Ringwald                         continue;
7174f9306a1aSMatthias Ringwald                     }
7175f9306a1aSMatthias Ringwald                     uint8_t cis_direction = cig->state_vars.next_cis & 1;
7176f9306a1aSMatthias Ringwald                     bool setup = true;
71778e58e4f7SMatthias Ringwald                     if (cis_direction == 0){
7178f9306a1aSMatthias Ringwald                         // 0 - input - host to controller
7179f9306a1aSMatthias Ringwald                         // we are central => central to peripheral
7180f9306a1aSMatthias Ringwald                         setup &= cig->params->cis_params[cis_index].max_sdu_c_to_p > 0;
7181f9306a1aSMatthias Ringwald                     } else {
7182f9306a1aSMatthias Ringwald                         // 1 - output - controller to host
7183f9306a1aSMatthias Ringwald                         // we are central => peripheral to central
7184f9306a1aSMatthias Ringwald                         setup &= cig->params->cis_params[cis_index].max_sdu_p_to_c > 0;
7185f9306a1aSMatthias Ringwald                     }
7186f9306a1aSMatthias Ringwald                     if (setup){
7187f9306a1aSMatthias Ringwald                         hci_stack->iso_active_operation_group_id = cig->params->cig_id;
7188f9306a1aSMatthias Ringwald                         hci_stack->iso_active_operation_type = HCI_ISO_TYPE_CIS;
7189f9306a1aSMatthias Ringwald                         cig->state = LE_AUDIO_CIG_STATE_W4_SETUP_ISO_PATH;
719085dc435bSDirk 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);
7191f9306a1aSMatthias Ringwald                         return true;
7192f9306a1aSMatthias Ringwald                     }
7193f9306a1aSMatthias Ringwald                 }
7194f9306a1aSMatthias Ringwald                 cig->state = LE_AUDIO_CIG_STATE_ACTIVE;
7195d90722d4SMatthias Ringwald                 break;
7196d90722d4SMatthias Ringwald             case LE_AUDIO_CIG_STATE_REMOVE:
7197d90722d4SMatthias Ringwald                 // check if CIG Active
7198d90722d4SMatthias Ringwald                 cig_active = false;
7199d90722d4SMatthias Ringwald                 for (i = 0; i < cig->num_cis; i++) {
7200d90722d4SMatthias Ringwald                     if (cig->cis_con_handles[i] != HCI_CON_HANDLE_INVALID){
7201d90722d4SMatthias Ringwald                         hci_iso_stream_t * stream = hci_iso_stream_for_con_handle(cig->cis_con_handles[i]);
7202d90722d4SMatthias Ringwald                         if (stream != NULL){
7203d90722d4SMatthias Ringwald                             cig_active = true;
7204d90722d4SMatthias Ringwald                             break;
7205d90722d4SMatthias Ringwald                         }
7206d90722d4SMatthias Ringwald                     }
7207d90722d4SMatthias Ringwald                 }
7208d90722d4SMatthias Ringwald                 if (cig_active == false){
7209d90722d4SMatthias Ringwald                     btstack_linked_list_iterator_remove(&it);
7210d90722d4SMatthias Ringwald                     hci_send_cmd(&hci_le_remove_cig, cig->cig_id);
7211d90722d4SMatthias Ringwald                     return true;
7212d90722d4SMatthias Ringwald                 }
7213d3a89d91SMatthias Ringwald             default:
7214d3a89d91SMatthias Ringwald                 break;
7215d3a89d91SMatthias Ringwald         }
7216d3a89d91SMatthias Ringwald     }
7217d3a89d91SMatthias Ringwald 
7218d90722d4SMatthias Ringwald     // CIS Accept/Reject/Setup ISO Path/Close
721926b93350SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->iso_streams);
722026b93350SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)) {
722126b93350SMatthias Ringwald         hci_iso_stream_t *iso_stream = (hci_iso_stream_t *) btstack_linked_list_iterator_next(&it);
722226b93350SMatthias Ringwald         hci_con_handle_t con_handle;
722326b93350SMatthias Ringwald         switch (iso_stream->state){
722426b93350SMatthias Ringwald             case HCI_ISO_STREAM_W2_ACCEPT:
722526b93350SMatthias Ringwald                 iso_stream->state = HCI_ISO_STREAM_STATE_W4_ESTABLISHED;
722626b93350SMatthias Ringwald                 hci_stack->iso_active_operation_type = HCI_ISO_TYPE_CIS;
722726b93350SMatthias Ringwald                 hci_stack->iso_active_operation_group_id = HCI_ISO_GROUP_ID_SINGLE_CIS;
7228969d876aSMatthias Ringwald                 hci_send_cmd(&hci_le_accept_cis_request, iso_stream->cis_handle);
722926b93350SMatthias Ringwald                 return true;
723026b93350SMatthias Ringwald             case HCI_ISO_STREAM_W2_REJECT:
7231969d876aSMatthias Ringwald                 con_handle = iso_stream->cis_handle;
723226b93350SMatthias Ringwald                 hci_stack->iso_active_operation_type = HCI_ISO_TYPE_CIS;
723326b93350SMatthias Ringwald                 hci_stack->iso_active_operation_group_id = HCI_ISO_GROUP_ID_SINGLE_CIS;
723426b93350SMatthias Ringwald                 hci_iso_stream_finalize(iso_stream);
723526b93350SMatthias Ringwald                 hci_send_cmd(&hci_le_reject_cis_request, con_handle, ERROR_CODE_REMOTE_DEVICE_TERMINATED_CONNECTION_DUE_TO_LOW_RESOURCES);
723626b93350SMatthias Ringwald                 return true;
723726b93350SMatthias Ringwald             case HCI_ISO_STREAM_STATE_W2_SETUP_ISO_INPUT:
723826b93350SMatthias Ringwald                 hci_stack->iso_active_operation_group_id = HCI_ISO_GROUP_ID_SINGLE_CIS;
723926b93350SMatthias Ringwald                 hci_stack->iso_active_operation_type = HCI_ISO_TYPE_CIS;
724026b93350SMatthias Ringwald                 iso_stream->state = HCI_ISO_STREAM_STATE_W4_ISO_SETUP_INPUT;
724185dc435bSDirk 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);
724207e32b36SMatthias Ringwald                 return true;
724326b93350SMatthias Ringwald             case HCI_ISO_STREAM_STATE_W2_SETUP_ISO_OUTPUT:
724426b93350SMatthias Ringwald                 hci_stack->iso_active_operation_group_id = HCI_ISO_GROUP_ID_SINGLE_CIS;
724526b93350SMatthias Ringwald                 hci_stack->iso_active_operation_type = HCI_ISO_TYPE_CIS;
724626b93350SMatthias Ringwald                 iso_stream->state = HCI_ISO_STREAM_STATE_W4_ISO_SETUP_OUTPUT;
724785dc435bSDirk 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);
724807e32b36SMatthias Ringwald                 return true;
7249d90722d4SMatthias Ringwald             case HCI_ISO_STREAM_STATE_W2_CLOSE:
7250d90722d4SMatthias Ringwald                 iso_stream->state = HCI_ISO_STREAM_STATE_W4_DISCONNECTED;
725107e32b36SMatthias Ringwald                 hci_send_cmd(&hci_disconnect, iso_stream->cis_handle, ERROR_CODE_REMOTE_USER_TERMINATED_CONNECTION);
725207e32b36SMatthias Ringwald                 return true;
725326b93350SMatthias Ringwald             default:
725426b93350SMatthias Ringwald                 break;
725526b93350SMatthias Ringwald         }
725626b93350SMatthias Ringwald     }
725726b93350SMatthias Ringwald 
72587aa35f6aSMatthias Ringwald     return false;
72597aa35f6aSMatthias Ringwald }
72607aa35f6aSMatthias Ringwald #endif /* ENABLE_LE_ISOCHRONOUS_STREAMS */
7261b2f949feS[email protected] #endif
72627bdc6798S[email protected] 
726388a03c8dSMatthias Ringwald static bool hci_run_general_pending_commands(void){
7264f30077b7SMatthias Ringwald     btstack_linked_item_t * it;
7265a0da043fSMatthias Ringwald     for (it = (btstack_linked_item_t *) hci_stack->connections; it != NULL; it = it->next){
726605ae8de3SMatthias Ringwald         hci_connection_t * connection = (hci_connection_t *) it;
726732ab9390Smatthias.ringwald 
72680bf6344aS[email protected]         switch(connection->state){
72690bf6344aS[email protected]             case SEND_CREATE_CONNECTION:
72704f3229d8S[email protected]                 switch(connection->address_type){
727135454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
7272f16129ceSMatthias Ringwald                     case BD_ADDR_TYPE_ACL:
72739da54300S[email protected]                         log_info("sending hci_create_connection");
7274b4eb4420SMatthias Ringwald                         hci_send_cmd(&hci_create_connection, connection->address, hci_usable_acl_packet_types(), 0, 0, 0, hci_stack->allow_role_switch);
72754f3229d8S[email protected]                         break;
727635454696SMatthias Ringwald #endif
72774f3229d8S[email protected]                     default:
7278a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE
7279d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
72809da54300S[email protected]                         log_info("sending hci_le_create_connection");
72816bcfa632SMatthias Ringwald                         hci_stack->le_connection_own_addr_type =  hci_stack->le_own_addr_type;
72826bcfa632SMatthias Ringwald                         hci_get_own_address_for_addr_type(hci_stack->le_connection_own_addr_type, hci_stack->le_connection_own_address);
7283f346015eSMatthias Ringwald                         hci_send_le_create_connection(0, connection->address_type, connection->address);
72844f3229d8S[email protected]                         connection->state = SENT_CREATE_CONNECTION;
7285b2f949feS[email protected] #endif
7286d70217a2SMatthias Ringwald #endif
72874f3229d8S[email protected]                         break;
72884f3229d8S[email protected]                 }
7289f30077b7SMatthias Ringwald                 return true;
7290ad83dc6aS[email protected] 
729135454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
72920bf6344aS[email protected]             case RECEIVED_CONNECTION_REQUEST:
7293f16129ceSMatthias Ringwald                 if (connection->address_type == BD_ADDR_TYPE_ACL){
729476ccfb2aSMatthias Ringwald                     log_info("sending hci_accept_connection_request");
7295895f6685SMilanka Ringwald                     connection->state = ACCEPTED_CONNECTION_REQUEST;
7296c4c88f1bSJakob Krantz                     hci_send_cmd(&hci_accept_connection_request, connection->address, hci_stack->master_slave_policy);
7297f30077b7SMatthias Ringwald                     return true;
7298ee025741SMatthias Ringwald                 }
7299ee025741SMatthias Ringwald                 break;
730035454696SMatthias Ringwald #endif
73010bf6344aS[email protected]             case SEND_DISCONNECT:
73020bf6344aS[email protected]                 connection->state = SENT_DISCONNECT;
73036ef3696aSMatthias Ringwald                 hci_send_cmd(&hci_disconnect, connection->con_handle, ERROR_CODE_REMOTE_USER_TERMINATED_CONNECTION);
7304f30077b7SMatthias Ringwald                 return true;
73050bf6344aS[email protected] 
73060bf6344aS[email protected]             default:
73070bf6344aS[email protected]                 break;
7308c7e0c5f6Smatthias.ringwald         }
7309c7e0c5f6Smatthias.ringwald 
7310cabf004eSMatthias Ringwald         // no further commands if connection is about to get shut down
7311cabf004eSMatthias Ringwald         if (connection->state == SENT_DISCONNECT) continue;
7312cabf004eSMatthias Ringwald 
731394418890SMatthias Ringwald #ifdef ENABLE_CLASSIC
731494418890SMatthias Ringwald 
7315ad20f0c8SMatthias Ringwald         // Handling link key request requires remote supported features
731650f49832SMatthias Ringwald         if (((connection->authentication_flags & AUTH_FLAG_HANDLE_LINK_KEY_REQUEST) != 0)){
7317608f51bbSMatthias Ringwald             log_info("responding to link key request, have link key db: %u", hci_stack->link_key_db != NULL);
73188daf94bcSMatthias Ringwald             connectionClearAuthenticationFlags(connection, AUTH_FLAG_HANDLE_LINK_KEY_REQUEST);
731930e72d78SMatthias Ringwald 
7320e9f98c4aSMatthias Ringwald             bool have_link_key = connection->link_key_type != INVALID_LINK_KEY;
7321e9f98c4aSMatthias Ringwald             bool security_level_sufficient = have_link_key && (gap_security_level_for_link_key_type(connection->link_key_type) >= connection->requested_security_level);
732230e72d78SMatthias Ringwald             if (have_link_key && security_level_sufficient){
7323e9f98c4aSMatthias Ringwald                 hci_send_cmd(&hci_link_key_request_reply, connection->address, &connection->link_key);
732432ab9390Smatthias.ringwald             } else {
732532ab9390Smatthias.ringwald                 hci_send_cmd(&hci_link_key_request_negative_reply, connection->address);
732632ab9390Smatthias.ringwald             }
7327f30077b7SMatthias Ringwald             return true;
732832ab9390Smatthias.ringwald         }
73291d6b20aeS[email protected] 
73308daf94bcSMatthias Ringwald         if (connection->authentication_flags & AUTH_FLAG_DENY_PIN_CODE_REQUEST){
73319da54300S[email protected]             log_info("denying to pin request");
73328daf94bcSMatthias Ringwald             connectionClearAuthenticationFlags(connection, AUTH_FLAG_DENY_PIN_CODE_REQUEST);
733334d2123cS[email protected]             hci_send_cmd(&hci_pin_code_request_negative_reply, connection->address);
7334f30077b7SMatthias Ringwald             return true;
73354c57c146S[email protected]         }
73364c57c146S[email protected] 
7337c950c316SMatthias Ringwald         // security assessment requires remote features
73382dd8985bSMatthias Ringwald         if ((connection->authentication_flags & AUTH_FLAG_RECV_IO_CAPABILITIES_REQUEST) != 0){
7339c950c316SMatthias Ringwald             connectionClearAuthenticationFlags(connection, AUTH_FLAG_RECV_IO_CAPABILITIES_REQUEST);
7340c950c316SMatthias Ringwald             hci_ssp_assess_security_on_io_cap_request(connection);
7341c950c316SMatthias 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
7342c950c316SMatthias Ringwald         }
7343c950c316SMatthias Ringwald 
73448daf94bcSMatthias Ringwald         if (connection->authentication_flags & AUTH_FLAG_SEND_IO_CAPABILITIES_REPLY){
73458daf94bcSMatthias Ringwald             connectionClearAuthenticationFlags(connection, AUTH_FLAG_SEND_IO_CAPABILITIES_REPLY);
7346a8d20135SMatthias Ringwald             // set authentication requirements:
7347a8d20135SMatthias Ringwald             // - MITM = ssp_authentication_requirement (USER) | requested_security_level (dynamic)
7348532454f9SMatthias Ringwald             // - BONDING MODE: dedicated if requested, bondable otherwise. Drop bondable if not set for remote
7349cb912b12SMatthias Ringwald             connection->io_cap_request_auth_req = hci_stack->ssp_authentication_requirement & 1;
73509faad3abS[email protected]             if (gap_mitm_protection_required_for_security_level(connection->requested_security_level)){
7351cb912b12SMatthias Ringwald                 connection->io_cap_request_auth_req |= 1;
7352106d6d11S[email protected]             }
7353532454f9SMatthias Ringwald             bool bonding = hci_stack->bondable;
73548daf94bcSMatthias Ringwald             if (connection->authentication_flags & AUTH_FLAG_RECV_IO_CAPABILITIES_RESPONSE){
7355532454f9SMatthias Ringwald                 // if we have received IO Cap Response, we're in responder role
7356532454f9SMatthias Ringwald                 bool remote_bonding = connection->io_cap_response_auth_req >= SSP_IO_AUTHREQ_MITM_PROTECTION_NOT_REQUIRED_DEDICATED_BONDING;
7357532454f9SMatthias Ringwald                 if (bonding && !remote_bonding){
7358532454f9SMatthias Ringwald                     log_info("Remote not bonding, dropping local flag");
7359532454f9SMatthias Ringwald                     bonding = false;
7360532454f9SMatthias Ringwald                 }
7361532454f9SMatthias Ringwald             }
7362532454f9SMatthias Ringwald             if (bonding){
7363a8d20135SMatthias Ringwald                 if (connection->bonding_flags & BONDING_DEDICATED){
7364cb912b12SMatthias Ringwald                     connection->io_cap_request_auth_req |= SSP_IO_AUTHREQ_MITM_PROTECTION_NOT_REQUIRED_DEDICATED_BONDING;
7365532454f9SMatthias Ringwald                 } else {
7366cb912b12SMatthias Ringwald                     connection->io_cap_request_auth_req |= SSP_IO_AUTHREQ_MITM_PROTECTION_NOT_REQUIRED_GENERAL_BONDING;
7367a8d20135SMatthias Ringwald                 }
7368532454f9SMatthias Ringwald             }
73691849becdSMatthias Ringwald             uint8_t have_oob_data = 0;
73701849becdSMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB
73711849becdSMatthias Ringwald             if (connection->classic_oob_c_192 != NULL){
73721849becdSMatthias Ringwald                     have_oob_data |= 1;
73731849becdSMatthias Ringwald             }
73741849becdSMatthias Ringwald             if (connection->classic_oob_c_256 != NULL){
73751849becdSMatthias Ringwald                 have_oob_data |= 2;
73761849becdSMatthias Ringwald             }
73771849becdSMatthias Ringwald #endif
7378cb912b12SMatthias Ringwald             hci_send_cmd(&hci_io_capability_request_reply, &connection->address, hci_stack->ssp_io_capability, have_oob_data, connection->io_cap_request_auth_req);
737911b03efaSMatthias Ringwald             return true;
7380f8fb5f6eS[email protected]         }
738111b03efaSMatthias Ringwald 
73828daf94bcSMatthias Ringwald         if (connection->authentication_flags & AUTH_FLAG_SEND_IO_CAPABILITIES_NEGATIVE_REPLY) {
73838daf94bcSMatthias Ringwald             connectionClearAuthenticationFlags(connection, AUTH_FLAG_SEND_IO_CAPABILITIES_NEGATIVE_REPLY);
738411b03efaSMatthias Ringwald             hci_send_cmd(&hci_io_capability_request_negative_reply, &connection->address, ERROR_CODE_PAIRING_NOT_ALLOWED);
7385f30077b7SMatthias Ringwald             return true;
738632ab9390Smatthias.ringwald         }
738732ab9390Smatthias.ringwald 
73881849becdSMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB
73897ca4a7edSMatthias Ringwald         if (connection->authentication_flags & AUTH_FLAG_SEND_REMOTE_OOB_DATA_REPLY){
73907ca4a7edSMatthias Ringwald             connectionClearAuthenticationFlags(connection, AUTH_FLAG_SEND_REMOTE_OOB_DATA_REPLY);
73911849becdSMatthias Ringwald             const uint8_t zero[16] = { 0 };
73921849becdSMatthias Ringwald             const uint8_t * r_192 = zero;
73931849becdSMatthias Ringwald             const uint8_t * c_192 = zero;
73941849becdSMatthias Ringwald             const uint8_t * r_256 = zero;
73951849becdSMatthias Ringwald             const uint8_t * c_256 = zero;
73961849becdSMatthias Ringwald             // verify P-256 OOB
73971e83575aSMatthias Ringwald             if ((connection->classic_oob_c_256 != NULL) && hci_command_supported(SUPPORTED_HCI_COMMAND_REMOTE_OOB_EXTENDED_DATA_REQUEST_REPLY)) {
73981849becdSMatthias Ringwald                 c_256 = connection->classic_oob_c_256;
73991849becdSMatthias Ringwald                 if (connection->classic_oob_r_256 != NULL) {
74001849becdSMatthias Ringwald                     r_256 = connection->classic_oob_r_256;
74011849becdSMatthias Ringwald                 }
74021849becdSMatthias Ringwald             }
74031849becdSMatthias Ringwald             // verify P-192 OOB
74041849becdSMatthias Ringwald             if ((connection->classic_oob_c_192 != NULL)) {
74051849becdSMatthias Ringwald                 c_192 = connection->classic_oob_c_192;
74061849becdSMatthias Ringwald                 if (connection->classic_oob_r_192 != NULL) {
74071849becdSMatthias Ringwald                     r_192 = connection->classic_oob_r_192;
74081849becdSMatthias Ringwald                 }
74091849becdSMatthias Ringwald             }
74107ca4a7edSMatthias Ringwald 
74117ca4a7edSMatthias Ringwald             // assess security
74127ca4a7edSMatthias Ringwald             bool need_level_4 = hci_stack->gap_secure_connections_only_mode || (connection->requested_security_level == LEVEL_4);
74137ca4a7edSMatthias Ringwald             bool can_reach_level_4 = hci_remote_sc_enabled(connection) && (c_256 != NULL);
74147ca4a7edSMatthias Ringwald             if (need_level_4 && !can_reach_level_4){
74157ca4a7edSMatthias Ringwald                 log_info("Level 4 required, but not possible -> abort");
74167ca4a7edSMatthias Ringwald                 hci_pairing_complete(connection, ERROR_CODE_INSUFFICIENT_SECURITY);
74177ca4a7edSMatthias Ringwald                 // send oob negative reply
74187ca4a7edSMatthias Ringwald                 c_256 = NULL;
74197ca4a7edSMatthias Ringwald                 c_192 = NULL;
74207ca4a7edSMatthias Ringwald             }
74217ca4a7edSMatthias Ringwald 
74221849becdSMatthias Ringwald             // Reply
74231849becdSMatthias Ringwald             if (c_256 != zero) {
74241849becdSMatthias Ringwald                 hci_send_cmd(&hci_remote_oob_extended_data_request_reply, &connection->address, c_192, r_192, c_256, r_256);
74251849becdSMatthias Ringwald             } else if (c_192 != zero){
74261849becdSMatthias Ringwald                 hci_send_cmd(&hci_remote_oob_data_request_reply, &connection->address, c_192, r_192);
74271849becdSMatthias Ringwald             } else {
74281ae74bf3SMatthias Ringwald                 hci_stack->classic_oob_con_handle = connection->con_handle;
74291849becdSMatthias Ringwald                 hci_send_cmd(&hci_remote_oob_data_request_negative_reply, &connection->address);
74301849becdSMatthias Ringwald             }
74311849becdSMatthias Ringwald             return true;
74321849becdSMatthias Ringwald         }
74331849becdSMatthias Ringwald #endif
74341849becdSMatthias Ringwald 
74358daf94bcSMatthias Ringwald         if (connection->authentication_flags & AUTH_FLAG_SEND_USER_CONFIRM_REPLY){
74368daf94bcSMatthias Ringwald             connectionClearAuthenticationFlags(connection, AUTH_FLAG_SEND_USER_CONFIRM_REPLY);
743734d2123cS[email protected]             hci_send_cmd(&hci_user_confirmation_request_reply, &connection->address);
7438f30077b7SMatthias Ringwald             return true;
7439dbe1a790S[email protected]         }
7440dbe1a790S[email protected] 
7441367aedc0SMatthias Ringwald         if (connection->authentication_flags & AUTH_FLAG_SEND_USER_CONFIRM_NEGATIVE_REPLY){
7442367aedc0SMatthias Ringwald             connectionClearAuthenticationFlags(connection, AUTH_FLAG_SEND_USER_CONFIRM_NEGATIVE_REPLY);
7443367aedc0SMatthias Ringwald             hci_send_cmd(&hci_user_confirmation_request_negative_reply, &connection->address);
7444367aedc0SMatthias Ringwald             return true;
7445367aedc0SMatthias Ringwald         }
7446367aedc0SMatthias Ringwald 
74478daf94bcSMatthias Ringwald         if (connection->authentication_flags & AUTH_FLAG_SEND_USER_PASSKEY_REPLY){
74488daf94bcSMatthias Ringwald             connectionClearAuthenticationFlags(connection, AUTH_FLAG_SEND_USER_PASSKEY_REPLY);
744934d2123cS[email protected]             hci_send_cmd(&hci_user_passkey_request_reply, &connection->address, 000000);
7450f30077b7SMatthias Ringwald             return true;
7451dbe1a790S[email protected]         }
7452afd4e962S[email protected] 
7453ab0c69a9SMatthias Ringwald         if ((connection->bonding_flags & (BONDING_DISCONNECT_DEDICATED_DONE | BONDING_DEDICATED_DEFER_DISCONNECT)) == BONDING_DISCONNECT_DEDICATED_DONE){
7454ad83dc6aS[email protected]             connection->bonding_flags &= ~BONDING_DISCONNECT_DEDICATED_DONE;
74551bd5283dS[email protected]             connection->bonding_flags |= BONDING_EMIT_COMPLETE_ON_DISCONNECT;
74566ef3696aSMatthias Ringwald             connection->state = SENT_DISCONNECT;
74576ef3696aSMatthias Ringwald             hci_send_cmd(&hci_disconnect, connection->con_handle, ERROR_CODE_REMOTE_USER_TERMINATED_CONNECTION);
7458f30077b7SMatthias Ringwald             return true;
7459ad83dc6aS[email protected]         }
746076f27cffSMatthias Ringwald 
74612a75353aSMatthias Ringwald         if ((connection->bonding_flags & BONDING_SEND_AUTHENTICATE_REQUEST) && ((connection->bonding_flags & BONDING_RECEIVED_REMOTE_FEATURES) != 0)){
746234d2123cS[email protected]             connection->bonding_flags &= ~BONDING_SEND_AUTHENTICATE_REQUEST;
7463abdad579SMatthias Ringwald             connection->bonding_flags |= BONDING_SENT_AUTHENTICATE_REQUEST;
746434d2123cS[email protected]             hci_send_cmd(&hci_authentication_requested, connection->con_handle);
7465f30077b7SMatthias Ringwald             return true;
7466afd4e962S[email protected]         }
746776f27cffSMatthias Ringwald 
7468dce78009S[email protected]         if (connection->bonding_flags & BONDING_SEND_ENCRYPTION_REQUEST){
7469dce78009S[email protected]             connection->bonding_flags &= ~BONDING_SEND_ENCRYPTION_REQUEST;
7470dce78009S[email protected]             hci_send_cmd(&hci_set_connection_encryption, connection->con_handle, 1);
7471f30077b7SMatthias Ringwald             return true;
7472dce78009S[email protected]         }
7473447016ffSMatthias Ringwald 
7474573897a0SMatthias Ringwald         if (connection->bonding_flags & BONDING_SEND_READ_ENCRYPTION_KEY_SIZE){
7475573897a0SMatthias Ringwald             connection->bonding_flags &= ~BONDING_SEND_READ_ENCRYPTION_KEY_SIZE;
7476573897a0SMatthias Ringwald             hci_send_cmd(&hci_read_encryption_key_size, connection->con_handle, 1);
7477f30077b7SMatthias Ringwald             return true;
7478573897a0SMatthias Ringwald         }
7479447016ffSMatthias Ringwald 
7480447016ffSMatthias Ringwald         if (connection->bonding_flags & BONDING_REQUEST_REMOTE_FEATURES_PAGE_0){
7481447016ffSMatthias Ringwald             connection->bonding_flags &= ~BONDING_REQUEST_REMOTE_FEATURES_PAGE_0;
7482447016ffSMatthias Ringwald             hci_send_cmd(&hci_read_remote_supported_features_command, connection->con_handle);
7483447016ffSMatthias Ringwald             return true;
7484447016ffSMatthias Ringwald         }
7485447016ffSMatthias Ringwald 
7486447016ffSMatthias Ringwald         if (connection->bonding_flags & BONDING_REQUEST_REMOTE_FEATURES_PAGE_1){
7487447016ffSMatthias Ringwald             connection->bonding_flags &= ~BONDING_REQUEST_REMOTE_FEATURES_PAGE_1;
7488447016ffSMatthias Ringwald             hci_send_cmd(&hci_read_remote_extended_features_command, connection->con_handle, 1);
7489447016ffSMatthias Ringwald             return true;
7490447016ffSMatthias Ringwald         }
7491447016ffSMatthias Ringwald 
7492447016ffSMatthias Ringwald         if (connection->bonding_flags & BONDING_REQUEST_REMOTE_FEATURES_PAGE_2){
7493447016ffSMatthias Ringwald             connection->bonding_flags &= ~BONDING_REQUEST_REMOTE_FEATURES_PAGE_2;
7494447016ffSMatthias Ringwald             hci_send_cmd(&hci_read_remote_extended_features_command, connection->con_handle, 2);
7495447016ffSMatthias Ringwald             return true;
7496447016ffSMatthias Ringwald         }
749776f27cffSMatthias Ringwald #endif
749876f27cffSMatthias Ringwald 
749976f27cffSMatthias Ringwald         if (connection->bonding_flags & BONDING_DISCONNECT_SECURITY_BLOCK){
750076f27cffSMatthias Ringwald             connection->bonding_flags &= ~BONDING_DISCONNECT_SECURITY_BLOCK;
75011714cbbdSMatthias Ringwald #ifdef ENABLE_CLASSIC
75021714cbbdSMatthias Ringwald             hci_pairing_complete(connection, ERROR_CODE_CONNECTION_REJECTED_DUE_TO_SECURITY_REASONS);
75031714cbbdSMatthias Ringwald #endif
75046ef3696aSMatthias Ringwald             if (connection->state != SENT_DISCONNECT){
75056ef3696aSMatthias Ringwald                 connection->state = SENT_DISCONNECT;
75066ef3696aSMatthias Ringwald                 hci_send_cmd(&hci_disconnect, connection->con_handle, ERROR_CODE_AUTHENTICATION_FAILURE);
7507f30077b7SMatthias Ringwald                 return true;
750876f27cffSMatthias Ringwald             }
75096ef3696aSMatthias Ringwald         }
7510da886c03S[email protected] 
75116cdc2862SMatthias Ringwald #ifdef ENABLE_CLASSIC
7512f8ee3071SMatthias Ringwald         uint16_t sniff_min_interval;
7513f8ee3071SMatthias Ringwald         switch (connection->sniff_min_interval){
7514f8ee3071SMatthias Ringwald             case 0:
7515f8ee3071SMatthias Ringwald                 break;
7516f8ee3071SMatthias Ringwald             case 0xffff:
7517f8ee3071SMatthias Ringwald                 connection->sniff_min_interval = 0;
7518f8ee3071SMatthias Ringwald                 hci_send_cmd(&hci_exit_sniff_mode, connection->con_handle);
7519f30077b7SMatthias Ringwald                 return true;
7520f8ee3071SMatthias Ringwald             default:
7521f8ee3071SMatthias Ringwald                 sniff_min_interval = connection->sniff_min_interval;
7522f8ee3071SMatthias Ringwald                 connection->sniff_min_interval = 0;
7523f8ee3071SMatthias Ringwald                 hci_send_cmd(&hci_sniff_mode, connection->con_handle, connection->sniff_max_interval, sniff_min_interval, connection->sniff_attempt, connection->sniff_timeout);
7524f30077b7SMatthias Ringwald                 return true;
7525f8ee3071SMatthias Ringwald         }
752688a03c8dSMatthias Ringwald 
7527140c0557SMatthias Ringwald         if (connection->sniff_subrating_max_latency != 0xffff){
7528140c0557SMatthias Ringwald             uint16_t max_latency = connection->sniff_subrating_max_latency;
7529140c0557SMatthias Ringwald             connection->sniff_subrating_max_latency = 0;
7530140c0557SMatthias Ringwald             hci_send_cmd(&hci_sniff_subrating, connection->con_handle, max_latency, connection->sniff_subrating_min_remote_timeout, connection->sniff_subrating_min_local_timeout);
7531140c0557SMatthias Ringwald             return true;
7532140c0557SMatthias Ringwald         }
7533140c0557SMatthias Ringwald 
7534965a4ccfSMatthias Ringwald         if (connection->qos_service_type != HCI_SERVICE_TYPE_INVALID){
7535278ff8a9SMatthias Ringwald             uint8_t service_type = (uint8_t) connection->qos_service_type;
7536965a4ccfSMatthias Ringwald             connection->qos_service_type = HCI_SERVICE_TYPE_INVALID;
7537278ff8a9SMatthias 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);
7538278ff8a9SMatthias Ringwald             return true;
7539278ff8a9SMatthias Ringwald         }
7540278ff8a9SMatthias Ringwald 
754188a03c8dSMatthias Ringwald         if (connection->request_role != HCI_ROLE_INVALID){
754288a03c8dSMatthias Ringwald             hci_role_t role = connection->request_role;
754388a03c8dSMatthias Ringwald             connection->request_role = HCI_ROLE_INVALID;
754488a03c8dSMatthias Ringwald             hci_send_cmd(&hci_switch_role_command, connection->address, role);
754588a03c8dSMatthias Ringwald             return true;
754688a03c8dSMatthias Ringwald         }
754722df2fe2SMatthias Ringwald #endif
75489afaa4d4SMatthias Ringwald 
75499afaa4d4SMatthias Ringwald         if (connection->gap_connection_tasks != 0){
755022df2fe2SMatthias Ringwald #ifdef ENABLE_CLASSIC
75519afaa4d4SMatthias Ringwald             if ((connection->gap_connection_tasks & GAP_CONNECTION_TASK_WRITE_AUTOMATIC_FLUSH_TIMEOUT) != 0){
75529afaa4d4SMatthias Ringwald                 connection->gap_connection_tasks &= ~GAP_CONNECTION_TASK_WRITE_AUTOMATIC_FLUSH_TIMEOUT;
75539afaa4d4SMatthias Ringwald                 hci_send_cmd(&hci_write_automatic_flush_timeout, connection->con_handle, hci_stack->automatic_flush_timeout);
75549afaa4d4SMatthias Ringwald                 return true;
75559afaa4d4SMatthias Ringwald             }
755622df2fe2SMatthias Ringwald             if (connection->gap_connection_tasks & GAP_CONNECTION_TASK_WRITE_SUPERVISION_TIMEOUT){
755722df2fe2SMatthias Ringwald                 connection->gap_connection_tasks &= ~GAP_CONNECTION_TASK_WRITE_SUPERVISION_TIMEOUT;
755822df2fe2SMatthias Ringwald                 hci_send_cmd(&hci_write_link_supervision_timeout, connection->con_handle, hci_stack->link_supervision_timeout);
755922df2fe2SMatthias Ringwald                 return true;
75609afaa4d4SMatthias Ringwald             }
75616cdc2862SMatthias Ringwald #endif
756222df2fe2SMatthias Ringwald             if (connection->gap_connection_tasks & GAP_CONNECTION_TASK_READ_RSSI){
756322df2fe2SMatthias Ringwald                 connection->gap_connection_tasks &= ~GAP_CONNECTION_TASK_READ_RSSI;
756422df2fe2SMatthias Ringwald                 hci_send_cmd(&hci_read_rssi, connection->con_handle);
756522df2fe2SMatthias Ringwald                 return true;
756622df2fe2SMatthias Ringwald             }
7567ac0f6b83SMatthias Ringwald #ifdef ENABLE_BLE
7568ac0f6b83SMatthias Ringwald             if (connection->gap_connection_tasks & GAP_CONNECTION_TASK_LE_READ_REMOTE_FEATURES){
7569ac0f6b83SMatthias Ringwald                 connection->gap_connection_tasks &= ~GAP_CONNECTION_TASK_LE_READ_REMOTE_FEATURES;
7570ac0f6b83SMatthias Ringwald                 hci_send_cmd(&hci_le_read_remote_used_features, connection->con_handle);
7571ac0f6b83SMatthias Ringwald                 return true;
7572ac0f6b83SMatthias Ringwald             }
7573ac0f6b83SMatthias Ringwald #endif
757422df2fe2SMatthias Ringwald         }
7575f8ee3071SMatthias Ringwald 
7576a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE
757773cd8a2aSMatthias Ringwald         switch (connection->le_con_parameter_update_state){
757873cd8a2aSMatthias Ringwald             // response to L2CAP CON PARAMETER UPDATE REQUEST
757973cd8a2aSMatthias Ringwald             case CON_PARAMETER_UPDATE_CHANGE_HCI_CON_PARAMETERS:
7580da886c03S[email protected]                 connection->le_con_parameter_update_state = CON_PARAMETER_UPDATE_NONE;
758173cd8a2aSMatthias Ringwald                 hci_send_cmd(&hci_le_connection_update, connection->con_handle, connection->le_conn_interval_min,
7582c37a3166S[email protected]                              connection->le_conn_interval_max, connection->le_conn_latency, connection->le_supervision_timeout,
7583d4876126SMatthias Ringwald                              hci_stack->le_minimum_ce_length, hci_stack->le_maximum_ce_length);
7584f30077b7SMatthias Ringwald                 return true;
758573cd8a2aSMatthias Ringwald             case CON_PARAMETER_UPDATE_REPLY:
758673cd8a2aSMatthias Ringwald                 connection->le_con_parameter_update_state = CON_PARAMETER_UPDATE_NONE;
758773cd8a2aSMatthias Ringwald                 hci_send_cmd(&hci_le_remote_connection_parameter_request_reply, connection->con_handle, connection->le_conn_interval_min,
758873cd8a2aSMatthias Ringwald                              connection->le_conn_interval_max, connection->le_conn_latency, connection->le_supervision_timeout,
7589d4876126SMatthias Ringwald                              hci_stack->le_minimum_ce_length, hci_stack->le_maximum_ce_length);
7590f30077b7SMatthias Ringwald                 return true;
759173cd8a2aSMatthias Ringwald             case CON_PARAMETER_UPDATE_NEGATIVE_REPLY:
759273cd8a2aSMatthias Ringwald                 connection->le_con_parameter_update_state = CON_PARAMETER_UPDATE_NONE;
75931e0338ebSMatthias Ringwald                 hci_send_cmd(&hci_le_remote_connection_parameter_request_negative_reply, connection->con_handle,
75941e0338ebSMatthias Ringwald                              ERROR_CODE_UNACCEPTABLE_CONNECTION_PARAMETERS);
7595f30077b7SMatthias Ringwald                 return true;
759673cd8a2aSMatthias Ringwald             default:
759773cd8a2aSMatthias Ringwald                 break;
7598c37a3166S[email protected]         }
75994ea43905SMatthias Ringwald         if (connection->le_phy_update_all_phys != 0xffu){
7600b90f6e0aSMatthias Ringwald             uint8_t all_phys = connection->le_phy_update_all_phys;
7601b90f6e0aSMatthias Ringwald             connection->le_phy_update_all_phys = 0xff;
7602b90f6e0aSMatthias 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);
7603f30077b7SMatthias Ringwald             return true;
7604b90f6e0aSMatthias Ringwald         }
76059007c891SMatthias Ringwald         if (connection->le_subrate_min > 0){
76069007c891SMatthias Ringwald             uint16_t subrate_min = connection->le_subrate_min;
76079007c891SMatthias Ringwald             connection->le_subrate_min = 0;
76089007c891SMatthias Ringwald             hci_send_cmd(&hci_le_subrate_request, connection->con_handle, subrate_min, connection->le_subrate_max, connection->le_subrate_max_latency,
76099007c891SMatthias Ringwald                              connection->le_subrate_continuation_number, connection->le_supervision_timeout);
76109007c891SMatthias Ringwald             return true;
76119007c891SMatthias Ringwald         }
76123bd96807SMatthias Ringwald #ifdef ENABLE_LE_PERIODIC_ADVERTISING
76133bd96807SMatthias Ringwald         if (connection->le_past_sync_handle != HCI_CON_HANDLE_INVALID){
76143bd96807SMatthias Ringwald             hci_con_handle_t sync_handle = connection->le_past_sync_handle;
76153bd96807SMatthias Ringwald             connection->le_past_sync_handle = HCI_CON_HANDLE_INVALID;
76163bd96807SMatthias Ringwald             hci_send_cmd(&hci_le_periodic_advertising_sync_transfer, connection->con_handle, connection->le_past_service_data, sync_handle);
76173bd96807SMatthias Ringwald             return true;
76183bd96807SMatthias Ringwald         }
7619027f4677SMatthias Ringwald         if (connection->le_past_advertising_handle != 0xff){
7620027f4677SMatthias Ringwald             uint8_t advertising_handle = connection->le_past_advertising_handle;
7621027f4677SMatthias Ringwald             connection->le_past_advertising_handle = 0xff;
7622027f4677SMatthias Ringwald             hci_send_cmd(&hci_le_periodic_advertising_set_info_transfer, connection->con_handle, connection->le_past_service_data, advertising_handle);
7623027f4677SMatthias Ringwald             return true;
7624027f4677SMatthias Ringwald         }
76253bd96807SMatthias Ringwald #endif
7626c37a3166S[email protected] #endif
7627dbe1a790S[email protected]     }
7628f30077b7SMatthias Ringwald     return false;
7629f30077b7SMatthias Ringwald }
7630c7e0c5f6Smatthias.ringwald 
7631f30077b7SMatthias Ringwald static void hci_run(void){
7632f30077b7SMatthias Ringwald 
7633df9e2780SMatthias Ringwald     // stack state sub statemachines
7634df9e2780SMatthias Ringwald     switch (hci_stack->state) {
7635df9e2780SMatthias Ringwald         case HCI_STATE_INITIALIZING:
7636df9e2780SMatthias Ringwald             hci_initializing_run();
7637d0dea5fbSMatthias Ringwald             break;
7638df9e2780SMatthias Ringwald         case HCI_STATE_HALTING:
7639df9e2780SMatthias Ringwald             hci_halting_run();
7640d0dea5fbSMatthias Ringwald             break;
7641df9e2780SMatthias Ringwald         case HCI_STATE_FALLING_ASLEEP:
7642df9e2780SMatthias Ringwald             hci_falling_asleep_run();
7643d0dea5fbSMatthias Ringwald             break;
7644df9e2780SMatthias Ringwald         default:
7645df9e2780SMatthias Ringwald             break;
7646df9e2780SMatthias Ringwald     }
7647df9e2780SMatthias Ringwald 
7648d0dea5fbSMatthias Ringwald     // allow to run after initialization to working transition
7649d0dea5fbSMatthias Ringwald     if (hci_stack->state != HCI_STATE_WORKING){
7650d0dea5fbSMatthias Ringwald         return;
7651d0dea5fbSMatthias Ringwald     }
7652d0dea5fbSMatthias Ringwald 
7653f30077b7SMatthias Ringwald     bool done;
7654f30077b7SMatthias Ringwald 
7655f30077b7SMatthias Ringwald     // send continuation fragments first, as they block the prepared packet buffer
7656f30077b7SMatthias Ringwald     done = hci_run_acl_fragments();
7657f30077b7SMatthias Ringwald     if (done) return;
7658f30077b7SMatthias Ringwald 
765968ab6207SMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
766068ab6207SMatthias Ringwald     done = hci_run_iso_fragments();
766168ab6207SMatthias Ringwald     if (done) return;
766268ab6207SMatthias Ringwald #endif
766368ab6207SMatthias Ringwald 
7664f30077b7SMatthias Ringwald #ifdef ENABLE_HCI_CONTROLLER_TO_HOST_FLOW_CONTROL
7665f30077b7SMatthias Ringwald     // send host num completed packets next as they don't require num_cmd_packets > 0
7666c69be560SMatthias Ringwald     if (!hci_can_send_command_packet_transport()) return;
7667f30077b7SMatthias Ringwald     if (hci_stack->host_completed_packets){
7668f30077b7SMatthias Ringwald         hci_host_num_completed_packets();
7669f30077b7SMatthias Ringwald         return;
7670f30077b7SMatthias Ringwald     }
7671f30077b7SMatthias Ringwald #endif
7672f30077b7SMatthias Ringwald 
7673f30077b7SMatthias Ringwald     if (!hci_can_send_command_packet_now()) return;
7674f30077b7SMatthias Ringwald 
7675f30077b7SMatthias Ringwald     // global/non-connection oriented commands
7676f30077b7SMatthias Ringwald 
7677f30077b7SMatthias Ringwald 
7678f30077b7SMatthias Ringwald #ifdef ENABLE_CLASSIC
7679f30077b7SMatthias Ringwald     // general gap classic
7680f30077b7SMatthias Ringwald     done = hci_run_general_gap_classic();
7681f30077b7SMatthias Ringwald     if (done) return;
7682f30077b7SMatthias Ringwald #endif
7683f30077b7SMatthias Ringwald 
7684f30077b7SMatthias Ringwald #ifdef ENABLE_BLE
7685f30077b7SMatthias Ringwald     // general gap le
7686f30077b7SMatthias Ringwald     done = hci_run_general_gap_le();
7687f30077b7SMatthias Ringwald     if (done) return;
76887aa35f6aSMatthias Ringwald 
76897aa35f6aSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
76907aa35f6aSMatthias Ringwald     // ISO related tasks, e.g. BIG create/terminate/sync
76917aa35f6aSMatthias Ringwald     done = hci_run_iso_tasks();
76927aa35f6aSMatthias Ringwald     if (done) return;
76937aa35f6aSMatthias Ringwald #endif
7694f30077b7SMatthias Ringwald #endif
7695f30077b7SMatthias Ringwald 
7696f30077b7SMatthias Ringwald     // send pending HCI commands
7697df9e2780SMatthias Ringwald     hci_run_general_pending_commands();
76983429f56bSmatthias.ringwald }
769916833f0aSmatthias.ringwald 
77000f076adeSMatthias Ringwald #ifdef ENABLE_CLASSIC
7701d7891039SMatthias Ringwald static void hci_set_sco_payload_length_for_flipped_packet_types(hci_connection_t * hci_connection, uint16_t flipped_packet_types){
7702d7891039SMatthias Ringwald     // bits 6-9 are 'don't use'
7703d7891039SMatthias Ringwald     uint16_t packet_types = flipped_packet_types ^ 0x03c0;
7704d7891039SMatthias Ringwald 
7705d7891039SMatthias Ringwald     // restrict packet types to local and remote supported
7706d7891039SMatthias Ringwald     packet_types &= hci_connection->remote_supported_sco_packets & hci_stack->usable_packet_types_sco;
7707d7891039SMatthias Ringwald     hci_connection->sco_payload_length = hci_sco_payload_length_for_packet_types(packet_types);
7708d7891039SMatthias Ringwald     log_info("Possible SCO packet types 0x%04x => payload length %u", packet_types, hci_connection->sco_payload_length);
7709d7891039SMatthias Ringwald }
77100f076adeSMatthias Ringwald #endif
7711d7891039SMatthias Ringwald 
7712ca6804fdSMatthias Ringwald // funnel for sending cmd packet using single outgoing buffer
7713ed208344SMatthias Ringwald static uint8_t hci_send_prepared_cmd_packet(void) {
7714ca6804fdSMatthias Ringwald     btstack_assert(hci_stack->hci_packet_buffer_reserved);
7715f91accd3SMatthias Ringwald     // cache opcode
7716f91accd3SMatthias Ringwald     hci_stack->last_cmd_opcode = little_endian_read_16(hci_stack->hci_packet_buffer, 0);
7717f91accd3SMatthias Ringwald     // get size
7718ca6804fdSMatthias Ringwald     uint16_t size = 3u + hci_stack->hci_packet_buffer[2u];
7719f91accd3SMatthias Ringwald     // send packet
7720ca6804fdSMatthias Ringwald     uint8_t status = hci_send_cmd_packet(hci_stack->hci_packet_buffer, size);
7721ca6804fdSMatthias Ringwald     // release packet buffer on error or for synchronous transport implementations
7722ca6804fdSMatthias Ringwald     if ((status != ERROR_CODE_SUCCESS) || hci_transport_synchronous()){
7723ca6804fdSMatthias Ringwald         hci_release_packet_buffer();
7724ca6804fdSMatthias Ringwald     }
7725ca6804fdSMatthias Ringwald     return status;
7726ca6804fdSMatthias Ringwald }
7727ca6804fdSMatthias Ringwald 
77283e2050f7SMatthias Ringwald uint8_t hci_send_cmd_packet(uint8_t *packet, int size){
772935454696SMatthias Ringwald     // house-keeping
773035454696SMatthias Ringwald 
773135454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
7732c8e4258aSmatthias.ringwald     bd_addr_t addr;
7733c8e4258aSmatthias.ringwald     hci_connection_t * conn;
7734c123d999SMatthias Ringwald #endif
7735c123d999SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
77366f35bb46SMatthias Ringwald     uint8_t initiator_filter_policy;
77379cbd2215SMatthias Ringwald #endif
7738c8e4258aSmatthias.ringwald 
77396f35bb46SMatthias Ringwald     uint16_t opcode = little_endian_read_16(packet, 0);
77406f35bb46SMatthias Ringwald     switch (opcode) {
77419cbd2215SMatthias Ringwald         case HCI_OPCODE_HCI_WRITE_LOOPBACK_MODE:
77429cbd2215SMatthias Ringwald             hci_stack->loopback_mode = packet[3];
77439cbd2215SMatthias Ringwald             break;
77449cbd2215SMatthias Ringwald 
77459cbd2215SMatthias Ringwald #ifdef ENABLE_CLASSIC
77466f35bb46SMatthias Ringwald         case HCI_OPCODE_HCI_CREATE_CONNECTION:
7747724d70a2SMatthias Ringwald             reverse_bd_addr(&packet[3], addr);
77489da54300S[email protected]             log_info("Create_connection to %s", bd_addr_to_str(addr));
7749c8e4258aSmatthias.ringwald 
775072cf8859SMatthias Ringwald             // CVE-2020-26555: reject outgoing connection to device with same BD ADDR
775172cf8859SMatthias Ringwald             if (memcmp(hci_stack->local_bd_addr, addr, 6) == 0) {
775279e0fa07SMatthias Ringwald                 hci_emit_connection_complete(addr, 0, ERROR_CODE_CONNECTION_REJECTED_DUE_TO_UNACCEPTABLE_BD_ADDR);
77533e2050f7SMatthias Ringwald                 return ERROR_CODE_CONNECTION_REJECTED_DUE_TO_UNACCEPTABLE_BD_ADDR;
775472cf8859SMatthias Ringwald             }
775572cf8859SMatthias Ringwald 
7756f16129ceSMatthias Ringwald             conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL);
7757ad83dc6aS[email protected]             if (!conn) {
775888f925b1SMatthias Ringwald                 conn = create_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL, HCI_ROLE_MASTER);
775917f1ba2aSmatthias.ringwald                 if (!conn) {
776017f1ba2aSmatthias.ringwald                     // notify client that alloc failed
77612deddeceSMatthias Ringwald                     hci_emit_connection_complete(addr, 0, BTSTACK_MEMORY_ALLOC_FAILED);
77623e2050f7SMatthias Ringwald                     return BTSTACK_MEMORY_ALLOC_FAILED; // packet not sent to controller
776317f1ba2aSmatthias.ringwald                 }
7764ad83dc6aS[email protected]                 conn->state = SEND_CREATE_CONNECTION;
7765ad83dc6aS[email protected]             }
7766aee5d5c1SMatthias Ringwald 
7767ad83dc6aS[email protected]             log_info("conn state %u", conn->state);
77683e2050f7SMatthias Ringwald             // TODO: L2CAP should not send create connection command, instead a (new) gap function should be used
7769ad83dc6aS[email protected]             switch (conn->state) {
7770ad83dc6aS[email protected]                 // if connection active exists
7771ad83dc6aS[email protected]                 case OPEN:
7772f5e5741dSMatthias Ringwald                     // and OPEN, emit connection complete command
777372cf8859SMatthias Ringwald                     hci_emit_connection_complete(addr, conn->con_handle, ERROR_CODE_SUCCESS);
77743e2050f7SMatthias Ringwald                     // packet not sent to controller
77753e2050f7SMatthias Ringwald                     return ERROR_CODE_ACL_CONNECTION_ALREADY_EXISTS;
7776672e36abSMatthias Ringwald                 case RECEIVED_DISCONNECTION_COMPLETE:
7777672e36abSMatthias Ringwald                     // create connection triggered in disconnect complete event, let's do it now
7778672e36abSMatthias Ringwald                     break;
7779ad83dc6aS[email protected]                 case SEND_CREATE_CONNECTION:
77806c0d5426SMatthias Ringwald #ifdef ENABLE_HCI_SERIALIZED_CONTROLLER_OPERATIONS
77816c0d5426SMatthias Ringwald                     if (hci_classic_operation_active()){
77826c0d5426SMatthias Ringwald                         return ERROR_CODE_SUCCESS;
77836c0d5426SMatthias Ringwald                     }
77846c0d5426SMatthias Ringwald #endif
7785532f91a5SMatthias Ringwald                     // connection created by hci, e.g. dedicated bonding, but not executed yet, let's do it now
7786532f91a5SMatthias Ringwald                     break;
7787ad83dc6aS[email protected]                 default:
7788ad83dc6aS[email protected]                     // otherwise, just ignore as it is already in the open process
77893e2050f7SMatthias Ringwald                     // packet not sent to controller
77903e2050f7SMatthias Ringwald                     return ERROR_CODE_ACL_CONNECTION_ALREADY_EXISTS;
7791ad83dc6aS[email protected]             }
7792c8e4258aSmatthias.ringwald             conn->state = SENT_CREATE_CONNECTION;
7793229331c6SMatthias Ringwald 
7794229331c6SMatthias Ringwald             // track outgoing connection
7795f16129ceSMatthias Ringwald             hci_stack->outgoing_addr_type = BD_ADDR_TYPE_ACL;
77966535961aSMatthias Ringwald             (void) memcpy(hci_stack->outgoing_addr, addr, 6);
77976f35bb46SMatthias Ringwald             break;
7798ee752bb8SMatthias Ringwald 
77996f35bb46SMatthias Ringwald         case HCI_OPCODE_HCI_SETUP_SYNCHRONOUS_CONNECTION:
78009071873aSMatthias Ringwald             conn = hci_connection_for_handle(little_endian_read_16(packet, 3));
78019071873aSMatthias Ringwald             if (conn == NULL) {
78029071873aSMatthias Ringwald                 // neither SCO nor ACL connection for con handle
78039071873aSMatthias Ringwald                 return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
78049071873aSMatthias Ringwald             } else {
7805d7891039SMatthias Ringwald                 uint16_t remote_supported_sco_packets;
78069071873aSMatthias Ringwald                 switch (conn->address_type){
78079071873aSMatthias Ringwald                     case BD_ADDR_TYPE_ACL:
78089071873aSMatthias Ringwald                         // assert SCO connection does not exit
7809d9290e95SMatthias Ringwald                         if (hci_connection_for_bd_addr_and_type(conn->address, BD_ADDR_TYPE_SCO) != NULL){
78109071873aSMatthias Ringwald                             return ERROR_CODE_COMMAND_DISALLOWED;
78119071873aSMatthias Ringwald                         }
7812d7891039SMatthias Ringwald                         // cache remote sco packet types
7813d7891039SMatthias Ringwald                         remote_supported_sco_packets = conn->remote_supported_sco_packets;
7814d7891039SMatthias Ringwald 
78159071873aSMatthias Ringwald                         // allocate connection struct
781688f925b1SMatthias Ringwald                         conn = create_connection_for_bd_addr_and_type(conn->address, BD_ADDR_TYPE_SCO,
781788f925b1SMatthias Ringwald                                                                       HCI_ROLE_MASTER);
78189071873aSMatthias Ringwald                         if (!conn) {
78199071873aSMatthias Ringwald                             return ERROR_CODE_MEMORY_CAPACITY_EXCEEDED;
78209071873aSMatthias Ringwald                         }
7821d7891039SMatthias Ringwald                         conn->remote_supported_sco_packets = remote_supported_sco_packets;
78229071873aSMatthias Ringwald                         break;
78239071873aSMatthias Ringwald                     case BD_ADDR_TYPE_SCO:
78249071873aSMatthias Ringwald                         // update of existing SCO connection
78259071873aSMatthias Ringwald                         break;
78269071873aSMatthias Ringwald                     default:
78279071873aSMatthias Ringwald                         return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS;
78289071873aSMatthias Ringwald                 }
78299071873aSMatthias Ringwald             }
7830d9290e95SMatthias Ringwald 
7831d9290e95SMatthias Ringwald             // conn refers to hci connection of type sco now
7832d9290e95SMatthias Ringwald 
78339071873aSMatthias Ringwald             conn->state = SENT_CREATE_CONNECTION;
78349071873aSMatthias Ringwald 
78359071873aSMatthias Ringwald             // track outgoing connection to handle command status with error
78369071873aSMatthias Ringwald             hci_stack->outgoing_addr_type = BD_ADDR_TYPE_SCO;
7837f728a932SMatthias Ringwald             (void) memcpy(hci_stack->outgoing_addr, conn->address, 6);
78389071873aSMatthias Ringwald 
7839ee752bb8SMatthias Ringwald             // setup_synchronous_connection? Voice setting at offset 22
7840ee752bb8SMatthias Ringwald             // TODO: compare to current setting if sco connection already active
7841ee752bb8SMatthias Ringwald             hci_stack->sco_voice_setting_active = little_endian_read_16(packet, 15);
7842d7891039SMatthias Ringwald 
7843d7891039SMatthias Ringwald             // derive sco payload length from packet types
7844d7891039SMatthias Ringwald             hci_set_sco_payload_length_for_flipped_packet_types(conn, little_endian_read_16(packet, 18));
78456f35bb46SMatthias Ringwald             break;
78469071873aSMatthias Ringwald 
78476f35bb46SMatthias Ringwald         case HCI_OPCODE_HCI_ACCEPT_SYNCHRONOUS_CONNECTION:
78489071873aSMatthias Ringwald             // get SCO connection
78499071873aSMatthias Ringwald             reverse_bd_addr(&packet[3], addr);
78509071873aSMatthias Ringwald             conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_SCO);
78519071873aSMatthias Ringwald             if (conn == NULL){
78529071873aSMatthias Ringwald                 return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
78539071873aSMatthias Ringwald             }
78549071873aSMatthias Ringwald 
78559071873aSMatthias Ringwald             conn->state = ACCEPTED_CONNECTION_REQUEST;
78569071873aSMatthias Ringwald 
78579071873aSMatthias Ringwald             // track outgoing connection to handle command status with error
78589071873aSMatthias Ringwald             hci_stack->outgoing_addr_type = BD_ADDR_TYPE_SCO;
78599071873aSMatthias Ringwald             (void) memcpy(hci_stack->outgoing_addr, addr, 6);
78609071873aSMatthias Ringwald 
7861c91e6e4fSMatthias Ringwald             // accept_synchronous_connection? Voice setting at offset 18
7862ee752bb8SMatthias Ringwald             // TODO: compare to current setting if sco connection already active
7863ee752bb8SMatthias Ringwald             hci_stack->sco_voice_setting_active = little_endian_read_16(packet, 19);
7864d7891039SMatthias Ringwald 
7865d7891039SMatthias Ringwald             // derive sco payload length from packet types
7866d7891039SMatthias Ringwald             hci_set_sco_payload_length_for_flipped_packet_types(conn, little_endian_read_16(packet, 22));
78676f35bb46SMatthias Ringwald             break;
7868ee752bb8SMatthias Ringwald #endif
78694b3e1e19SMatthias Ringwald 
7870a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE
7871d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
78726f35bb46SMatthias Ringwald         case HCI_OPCODE_HCI_LE_CREATE_CONNECTION:
7873b04dfa37SMatthias Ringwald             // white list used?
78746f35bb46SMatthias Ringwald             initiator_filter_policy = packet[7];
7875b04dfa37SMatthias Ringwald             switch (initiator_filter_policy) {
7876b04dfa37SMatthias Ringwald                 case 0:
7877b04dfa37SMatthias Ringwald                     // whitelist not used
7878b04dfa37SMatthias Ringwald                     hci_stack->le_connecting_state = LE_CONNECTING_DIRECT;
7879b04dfa37SMatthias Ringwald                     break;
7880b04dfa37SMatthias Ringwald                 case 1:
7881b04dfa37SMatthias Ringwald                     hci_stack->le_connecting_state = LE_CONNECTING_WHITELIST;
7882b04dfa37SMatthias Ringwald                     break;
7883b04dfa37SMatthias Ringwald                 default:
7884b04dfa37SMatthias Ringwald                     log_error("Invalid initiator_filter_policy in LE Create Connection %u", initiator_filter_policy);
7885b04dfa37SMatthias Ringwald                     break;
7886b04dfa37SMatthias Ringwald             }
7887c163146eSMatthias Ringwald             // track outgoing connection
78888f7da641SMatthias Ringwald             hci_stack->outgoing_addr_type = (bd_addr_type_t) packet[8]; // peer address type
7889c163146eSMatthias Ringwald             reverse_bd_addr( &packet[9], hci_stack->outgoing_addr); // peer address
78906f35bb46SMatthias Ringwald             break;
78918f7da641SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
78928f7da641SMatthias Ringwald         case HCI_OPCODE_HCI_LE_EXTENDED_CREATE_CONNECTION:
78938f7da641SMatthias Ringwald             // white list used?
78948f7da641SMatthias Ringwald             initiator_filter_policy = packet[3];
78958f7da641SMatthias Ringwald             switch (initiator_filter_policy) {
78968f7da641SMatthias Ringwald                 case 0:
78978f7da641SMatthias Ringwald                     // whitelist not used
78988f7da641SMatthias Ringwald                     hci_stack->le_connecting_state = LE_CONNECTING_DIRECT;
78998f7da641SMatthias Ringwald                     break;
79008f7da641SMatthias Ringwald                 case 1:
79018f7da641SMatthias Ringwald                     hci_stack->le_connecting_state = LE_CONNECTING_WHITELIST;
79028f7da641SMatthias Ringwald                     break;
79038f7da641SMatthias Ringwald                 default:
79048f7da641SMatthias Ringwald                     log_error("Invalid initiator_filter_policy in LE Create Connection %u", initiator_filter_policy);
79058f7da641SMatthias Ringwald                     break;
79068f7da641SMatthias Ringwald             }
79078f7da641SMatthias Ringwald             // track outgoing connection
79088f7da641SMatthias Ringwald             hci_stack->outgoing_addr_type = (bd_addr_type_t) packet[5]; // peer address type
79098f7da641SMatthias Ringwald             reverse_bd_addr( &packet[6], hci_stack->outgoing_addr); // peer address
79108f7da641SMatthias Ringwald             break;
79118f7da641SMatthias Ringwald #endif
79126f35bb46SMatthias Ringwald         case HCI_OPCODE_HCI_LE_CREATE_CONNECTION_CANCEL:
79136ea9315cSMatthias Ringwald             hci_stack->le_connecting_state = LE_CONNECTING_CANCEL;
79146f35bb46SMatthias Ringwald             break;
79159cbd2215SMatthias Ringwald #endif
791691036612SMatthias Ringwald #ifdef ENABLE_HCI_COMMAND_STATUS_DISCARDED_FOR_FAILED_CONNECTIONS_WORKAROUND
7917f48a5586SMatthias Ringwald         case HCI_OPCODE_HCI_LE_CONNECTION_UPDATE:
7918f48a5586SMatthias Ringwald         case HCI_OPCODE_HCI_LE_READ_REMOTE_USED_FEATURES:
7919f48a5586SMatthias Ringwald         case HCI_OPCODE_HCI_LE_START_ENCRYPTION:
7920f48a5586SMatthias Ringwald         case HCI_OPCODE_HCI_LE_LONG_TERM_KEY_REQUEST_REPLY:
7921f48a5586SMatthias Ringwald         case HCI_OPCODE_HCI_LE_LONG_TERM_KEY_NEGATIVE_REPLY:
7922f48a5586SMatthias Ringwald         case HCI_OPCODE_HCI_LE_REMOTE_CONNECTION_PARAMETER_REQUEST_REPLY:
7923f48a5586SMatthias Ringwald         case HCI_OPCODE_HCI_LE_REMOTE_CONNECTION_PARAMETER_REQUEST_NEGATIVE_REPLY:
7924f48a5586SMatthias Ringwald         case HCI_OPCODE_HCI_LE_SET_DATA_LENGTH:
7925f48a5586SMatthias Ringwald         case HCI_OPCODE_HCI_LE_READ_PHY:
7926f48a5586SMatthias Ringwald         case HCI_OPCODE_HCI_LE_SET_PHY:
7927f48a5586SMatthias Ringwald             // conection handle is first command parameter
7928f48a5586SMatthias Ringwald             hci_stack->hci_command_con_handle = little_endian_read_16(packet, 3);
7929f48a5586SMatthias Ringwald             break;
7930f48a5586SMatthias Ringwald #endif
79314ae8623eSMatthias Ringwald #endif /* ENABLE_BLE */
79326f35bb46SMatthias Ringwald         default:
79336f35bb46SMatthias Ringwald             break;
7934b04dfa37SMatthias Ringwald     }
793569a97523S[email protected] 
79363a9fb326S[email protected]     hci_stack->num_cmd_packets--;
79375bb5bc3eS[email protected] 
79385bb5bc3eS[email protected]     hci_dump_packet(HCI_COMMAND_DATA_PACKET, 0, packet, size);
79393e2050f7SMatthias Ringwald     int err = hci_stack->hci_transport->send_packet(HCI_COMMAND_DATA_PACKET, packet, size);
7940a84946b2SMatthias Ringwald     uint8_t status;
7941a84946b2SMatthias Ringwald     if (err == 0){
7942a84946b2SMatthias Ringwald         status = ERROR_CODE_SUCCESS;
7943a84946b2SMatthias Ringwald     } else {
7944a84946b2SMatthias Ringwald         status = ERROR_CODE_HARDWARE_FAILURE;
79453e2050f7SMatthias Ringwald     }
7946a84946b2SMatthias Ringwald     return status;
794731452debSmatthias.ringwald }
79488adf0ddaSmatthias.ringwald 
79492bd8b7e7S[email protected] // disconnect because of security block
79502bd8b7e7S[email protected] void hci_disconnect_security_block(hci_con_handle_t con_handle){
79512bd8b7e7S[email protected]     hci_connection_t * connection = hci_connection_for_handle(con_handle);
79522bd8b7e7S[email protected]     if (!connection) return;
79532bd8b7e7S[email protected]     connection->bonding_flags |= BONDING_DISCONNECT_SECURITY_BLOCK;
79542bd8b7e7S[email protected] }
79552bd8b7e7S[email protected] 
79562bd8b7e7S[email protected] 
7957dbe1a790S[email protected] // Configure Secure Simple Pairing
7958dbe1a790S[email protected] 
795935454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
796035454696SMatthias Ringwald 
7961dbe1a790S[email protected] // enable will enable SSP during init
796215a95bd5SMatthias Ringwald void gap_ssp_set_enable(int enable){
79633a9fb326S[email protected]     hci_stack->ssp_enable = enable;
7964dbe1a790S[email protected] }
7965dbe1a790S[email protected] 
796695d71764SMatthias Ringwald static int hci_local_ssp_activated(void){
796715a95bd5SMatthias Ringwald     return gap_ssp_supported() && hci_stack->ssp_enable;
79682bd8b7e7S[email protected] }
79692bd8b7e7S[email protected] 
7970dbe1a790S[email protected] // if set, BTstack will respond to io capability request using authentication requirement
797115a95bd5SMatthias Ringwald void gap_ssp_set_io_capability(int io_capability){
79723a9fb326S[email protected]     hci_stack->ssp_io_capability = io_capability;
7973dbe1a790S[email protected] }
797415a95bd5SMatthias Ringwald void gap_ssp_set_authentication_requirement(int authentication_requirement){
79753a9fb326S[email protected]     hci_stack->ssp_authentication_requirement = authentication_requirement;
7976dbe1a790S[email protected] }
7977dbe1a790S[email protected] 
7978a086dc35SMatthias Ringwald // if set, BTstack will confirm a numeric comparison and enter '000000' if requested
797915a95bd5SMatthias Ringwald void gap_ssp_set_auto_accept(int auto_accept){
79803a9fb326S[email protected]     hci_stack->ssp_auto_accept = auto_accept;
7981dbe1a790S[email protected] }
79825d23aae8SMatthias Ringwald 
79835d23aae8SMatthias Ringwald void gap_secure_connections_enable(bool enable){
79845d23aae8SMatthias Ringwald     hci_stack->secure_connections_enable = enable;
79855d23aae8SMatthias Ringwald }
798622d445d8SMatthias Ringwald bool gap_secure_connections_active(void){
7987eaf85bc8SMatthias Ringwald     return hci_stack->secure_connections_active;
798822d445d8SMatthias Ringwald }
79895d23aae8SMatthias Ringwald 
799035454696SMatthias Ringwald #endif
7991dbe1a790S[email protected] 
799294be1a66SMatthias Ringwald // va_list part of hci_send_cmd
79933e2050f7SMatthias Ringwald uint8_t hci_send_cmd_va_arg(const hci_cmd_t * cmd, va_list argptr){
7994d94d3cafS[email protected]     if (!hci_can_send_command_packet_now()){
79959d14b626S[email protected]         log_error("hci_send_cmd called but cannot send packet now");
79963e2050f7SMatthias Ringwald         return ERROR_CODE_COMMAND_DISALLOWED;
79979d14b626S[email protected]     }
79989d14b626S[email protected] 
79999d14b626S[email protected]     hci_reserve_packet_buffer();
8000f91accd3SMatthias Ringwald     hci_cmd_create_from_template(hci_stack->hci_packet_buffer, cmd, argptr);
8001ca6804fdSMatthias Ringwald     return hci_send_prepared_cmd_packet();
800294be1a66SMatthias Ringwald }
80039d14b626S[email protected] 
800494be1a66SMatthias Ringwald /**
8005a086dc35SMatthias Ringwald  * pre: num_commands >= 0 - it's allowed to send a command to the controller
800694be1a66SMatthias Ringwald  */
80073e2050f7SMatthias Ringwald uint8_t hci_send_cmd(const hci_cmd_t * cmd, ...){
80081cd208adSmatthias.ringwald     va_list argptr;
80091cd208adSmatthias.ringwald     va_start(argptr, cmd);
80103e2050f7SMatthias Ringwald     uint8_t status = hci_send_cmd_va_arg(cmd, argptr);
80111cd208adSmatthias.ringwald     va_end(argptr);
80123e2050f7SMatthias Ringwald     return status;
801393b8dc03Smatthias.ringwald }
8014c8e4258aSmatthias.ringwald 
80159da9850bSMatthias Ringwald // Forward HCI events and create non-HCI events
8016ee091cf1Smatthias.ringwald 
8017d6b06661SMatthias Ringwald static void hci_emit_event(uint8_t * event, uint16_t size, int dump){
8018fb37a842SMatthias Ringwald     // dump packet
8019d6b06661SMatthias Ringwald     if (dump) {
802092da54c4SMatthias Ringwald         hci_dump_packet( HCI_EVENT_PACKET, 1, event, size);
8021d6b06661SMatthias Ringwald     }
80221ef6bb52SMatthias Ringwald 
8023fb37a842SMatthias Ringwald     // dispatch to all event handlers
80241ef6bb52SMatthias Ringwald     btstack_linked_list_iterator_t it;
80251ef6bb52SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->event_handlers);
80261ef6bb52SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
80271ef6bb52SMatthias Ringwald         btstack_packet_callback_registration_t * entry = (btstack_packet_callback_registration_t*) btstack_linked_list_iterator_next(&it);
8028d9a7306aSMatthias Ringwald         entry->callback(HCI_EVENT_PACKET, 0, event, size);
80291ef6bb52SMatthias Ringwald     }
8030d6b06661SMatthias Ringwald }
8031d6b06661SMatthias Ringwald 
80329da9850bSMatthias Ringwald static void hci_emit_btstack_event(uint8_t * event, uint16_t size, int dump){
80339da9850bSMatthias Ringwald #ifndef ENABLE_LOG_BTSTACK_EVENTS
80349da9850bSMatthias Ringwald     dump = 0;
80359da9850bSMatthias Ringwald #endif
80369da9850bSMatthias Ringwald     hci_emit_event(event, size, dump);
80379da9850bSMatthias Ringwald }
80389da9850bSMatthias Ringwald 
8039d6b06661SMatthias Ringwald static void hci_emit_acl_packet(uint8_t * packet, uint16_t size){
8040fb37a842SMatthias Ringwald     if (!hci_stack->acl_packet_handler) return;
80413d50b4baSMatthias Ringwald     hci_stack->acl_packet_handler(HCI_ACL_DATA_PACKET, 0, packet, size);
8042d6b06661SMatthias Ringwald }
8043d6b06661SMatthias Ringwald 
804435454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
8045701e3307SMatthias Ringwald static void hci_notify_if_sco_can_send_now(void){
80463bc639ceSMatthias Ringwald     // notify SCO sender if waiting
8047701e3307SMatthias Ringwald     if (!hci_stack->sco_waiting_for_can_send_now) return;
8048701e3307SMatthias Ringwald     if (hci_can_send_sco_packet_now()){
80493bc639ceSMatthias Ringwald         hci_stack->sco_waiting_for_can_send_now = 0;
8050701e3307SMatthias Ringwald         uint8_t event[2] = { HCI_EVENT_SCO_CAN_SEND_NOW, 0 };
80519da9850bSMatthias Ringwald         hci_dump_btstack_event(event, sizeof(event));
80523d50b4baSMatthias Ringwald         hci_stack->sco_packet_handler(HCI_EVENT_PACKET, 0, event, sizeof(event));
80533bc639ceSMatthias Ringwald     }
80543bc639ceSMatthias Ringwald }
80551cfb383eSMatthias Ringwald 
80561cfb383eSMatthias Ringwald // parsing end emitting has been merged to reduce code size
80579784dac1SMatthias Ringwald static void gap_inquiry_explode(uint8_t *packet, uint16_t size) {
8058ac9136ccSMatthias Ringwald     uint8_t event[28+GAP_INQUIRY_MAX_NAME_LEN];
80591cfb383eSMatthias Ringwald 
80601cfb383eSMatthias Ringwald     uint8_t * eir_data;
80611cfb383eSMatthias Ringwald     ad_context_t context;
80621cfb383eSMatthias Ringwald     const uint8_t * name;
80631cfb383eSMatthias Ringwald     uint8_t         name_len;
80641cfb383eSMatthias Ringwald 
80659784dac1SMatthias Ringwald     if (size < 3) return;
80669784dac1SMatthias Ringwald 
80671cfb383eSMatthias Ringwald     int event_type = hci_event_packet_get_type(packet);
8068a1df452eSMatthias Ringwald     int num_reserved_fields = (event_type == HCI_EVENT_INQUIRY_RESULT) ? 2 : 1;    // 2 for old event, 1 otherwise
80691cfb383eSMatthias Ringwald     int num_responses       = hci_event_inquiry_result_get_num_responses(packet);
80701cfb383eSMatthias Ringwald 
80719784dac1SMatthias Ringwald     switch (event_type){
80729784dac1SMatthias Ringwald         case HCI_EVENT_INQUIRY_RESULT:
80739784dac1SMatthias Ringwald         case HCI_EVENT_INQUIRY_RESULT_WITH_RSSI:
80749784dac1SMatthias Ringwald             if (size != (3 + (num_responses * 14))) return;
80759784dac1SMatthias Ringwald             break;
80769784dac1SMatthias Ringwald         case HCI_EVENT_EXTENDED_INQUIRY_RESPONSE:
80779784dac1SMatthias Ringwald             if (size != 257) return;
80789784dac1SMatthias Ringwald             if (num_responses != 1) return;
80799784dac1SMatthias Ringwald             break;
80809784dac1SMatthias Ringwald         default:
80819784dac1SMatthias Ringwald             return;
80829784dac1SMatthias Ringwald     }
80839784dac1SMatthias Ringwald 
80841cfb383eSMatthias Ringwald     // event[1] is set at the end
80851cfb383eSMatthias Ringwald     int i;
80861cfb383eSMatthias Ringwald     for (i=0; i<num_responses;i++){
80871cfb383eSMatthias Ringwald         memset(event, 0, sizeof(event));
80881cfb383eSMatthias Ringwald         event[0] = GAP_EVENT_INQUIRY_RESULT;
8089ac973fd6SMatthias Ringwald         uint8_t event_size = 27;    // if name is not set by EIR
80901cfb383eSMatthias Ringwald 
80916535961aSMatthias Ringwald         (void)memcpy(&event[2], &packet[3 + (i * 6)], 6); // bd_addr
80920e588213SMatthias Ringwald         event[8] =          packet[3 + (num_responses*(6))                         + (i*1)];     // page_scan_repetition_mode
80936535961aSMatthias Ringwald         (void)memcpy(&event[9],
80946535961aSMatthias Ringwald                      &packet[3 + (num_responses * (6 + 1 + num_reserved_fields)) + (i * 3)],
80956535961aSMatthias Ringwald                      3); // class of device
80966535961aSMatthias Ringwald         (void)memcpy(&event[12],
80976535961aSMatthias Ringwald                      &packet[3 + (num_responses * (6 + 1 + num_reserved_fields + 3)) + (i * 2)],
80986535961aSMatthias Ringwald                      2); // clock offset
80991cfb383eSMatthias Ringwald 
81001cfb383eSMatthias Ringwald         switch (event_type){
81011cfb383eSMatthias Ringwald             case HCI_EVENT_INQUIRY_RESULT:
81021cfb383eSMatthias Ringwald                 // 14,15,16,17 = 0, size 18
81031cfb383eSMatthias Ringwald                 break;
81041cfb383eSMatthias Ringwald             case HCI_EVENT_INQUIRY_RESULT_WITH_RSSI:
81051cfb383eSMatthias Ringwald                 event[14] = 1;
8106a1df452eSMatthias Ringwald                 event[15] = packet [3 + (num_responses*(6+1+num_reserved_fields+3+2)) + (i*1)]; // rssi
81071cfb383eSMatthias Ringwald                 // 16,17 = 0, size 18
81081cfb383eSMatthias Ringwald                 break;
81091cfb383eSMatthias Ringwald             case HCI_EVENT_EXTENDED_INQUIRY_RESPONSE:
81101cfb383eSMatthias Ringwald                 event[14] = 1;
8111a1df452eSMatthias Ringwald                 event[15] = packet [3 + (num_responses*(6+1+num_reserved_fields+3+2)) + (i*1)]; // rssi
811279186815SMatthias Ringwald                 // EIR packets only contain a single inquiry response
81131cfb383eSMatthias Ringwald                 eir_data = &packet[3 + (6+1+num_reserved_fields+3+2+1)];
81141cfb383eSMatthias Ringwald                 name = NULL;
8115a8c4e5adSMatthias Ringwald                 // Iterate over EIR data
8116a8c4e5adSMatthias Ringwald                 for (ad_iterator_init(&context, EXTENDED_INQUIRY_RESPONSE_DATA_LEN, eir_data) ; ad_iterator_has_more(&context) ; ad_iterator_next(&context)){
81171cfb383eSMatthias Ringwald                     uint8_t data_type    = ad_iterator_get_data_type(&context);
81181cfb383eSMatthias Ringwald                     uint8_t data_size    = ad_iterator_get_data_len(&context);
81191cfb383eSMatthias Ringwald                     const uint8_t * data = ad_iterator_get_data(&context);
8120ac9136ccSMatthias Ringwald                     // Prefer Complete Local Name over Shortened Local Name
81211cfb383eSMatthias Ringwald                     switch (data_type){
81221cfb383eSMatthias Ringwald                         case BLUETOOTH_DATA_TYPE_SHORTENED_LOCAL_NAME:
81231cfb383eSMatthias Ringwald                             if (name) continue;
8124cf373d3aSMatthias Ringwald                             /* fall through */
81251cfb383eSMatthias Ringwald                         case BLUETOOTH_DATA_TYPE_COMPLETE_LOCAL_NAME:
81261cfb383eSMatthias Ringwald                             name = data;
81271cfb383eSMatthias Ringwald                             name_len = data_size;
81281cfb383eSMatthias Ringwald                             break;
8129ac9136ccSMatthias Ringwald                         case BLUETOOTH_DATA_TYPE_DEVICE_ID:
8130ac9136ccSMatthias Ringwald                             if (data_size != 8) break;
8131ac9136ccSMatthias Ringwald                             event[16] = 1;
81323c0c7fefSMatthias Ringwald                             memcpy(&event[17], data, 8);
8133ac9136ccSMatthias Ringwald                             break;
81341cfb383eSMatthias Ringwald                         default:
81351cfb383eSMatthias Ringwald                             break;
81361cfb383eSMatthias Ringwald                     }
81371cfb383eSMatthias Ringwald                 }
81381cfb383eSMatthias Ringwald                 if (name){
8139ac9136ccSMatthias Ringwald                     event[25] = 1;
81401cfb383eSMatthias Ringwald                     // truncate name if needed
81411cfb383eSMatthias Ringwald                     int len = btstack_min(name_len, GAP_INQUIRY_MAX_NAME_LEN);
8142ac9136ccSMatthias Ringwald                     event[26] = len;
8143ac9136ccSMatthias Ringwald                     (void)memcpy(&event[27], name, len);
81441cfb383eSMatthias Ringwald                     event_size += len;
81451cfb383eSMatthias Ringwald                 }
81461cfb383eSMatthias Ringwald                 break;
81477bbeb3adSMilanka Ringwald             default:
81487bbeb3adSMilanka Ringwald                 return;
81491cfb383eSMatthias Ringwald         }
81501cfb383eSMatthias Ringwald         event[1] = event_size - 2;
81519da9850bSMatthias Ringwald         hci_emit_btstack_event(event, event_size, 1);
81521cfb383eSMatthias Ringwald     }
81531cfb383eSMatthias Ringwald }
815435454696SMatthias Ringwald #endif
81553bc639ceSMatthias Ringwald 
815671de195eSMatthias Ringwald void hci_emit_state(void){
81573a9fb326S[email protected]     log_info("BTSTACK_EVENT_STATE %u", hci_stack->state);
8158425d1371Smatthias.ringwald     uint8_t event[3];
815980d52d6bSmatthias.ringwald     event[0] = BTSTACK_EVENT_STATE;
81604ea43905SMatthias Ringwald     event[1] = sizeof(event) - 2u;
81613a9fb326S[email protected]     event[2] = hci_stack->state;
81629da9850bSMatthias Ringwald     hci_emit_btstack_event(event, sizeof(event), 1);
8163c8e4258aSmatthias.ringwald }
8164c8e4258aSmatthias.ringwald 
816535454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
81662deddeceSMatthias Ringwald static void hci_emit_connection_complete(bd_addr_t address, hci_con_handle_t con_handle, uint8_t status){
8167425d1371Smatthias.ringwald     uint8_t event[13];
8168c8e4258aSmatthias.ringwald     event[0] = HCI_EVENT_CONNECTION_COMPLETE;
8169425d1371Smatthias.ringwald     event[1] = sizeof(event) - 2;
817017f1ba2aSmatthias.ringwald     event[2] = status;
81712deddeceSMatthias Ringwald     little_endian_store_16(event, 3, con_handle);
81722deddeceSMatthias Ringwald     reverse_bd_addr(address, &event[5]);
8173c8e4258aSmatthias.ringwald     event[11] = 1; // ACL connection
8174c8e4258aSmatthias.ringwald     event[12] = 0; // encryption disabled
81759da9850bSMatthias Ringwald     hci_emit_btstack_event(event, sizeof(event), 1);
8176c8e4258aSmatthias.ringwald }
817752db98b2SMatthias Ringwald static void hci_emit_l2cap_check_timeout(hci_connection_t *conn){
817852db98b2SMatthias Ringwald     if (disable_l2cap_timeouts) return;
817952db98b2SMatthias Ringwald     log_info("L2CAP_EVENT_TIMEOUT_CHECK");
818052db98b2SMatthias Ringwald     uint8_t event[4];
818152db98b2SMatthias Ringwald     event[0] = L2CAP_EVENT_TIMEOUT_CHECK;
818252db98b2SMatthias Ringwald     event[1] = sizeof(event) - 2;
818352db98b2SMatthias Ringwald     little_endian_store_16(event, 2, conn->con_handle);
81849da9850bSMatthias Ringwald     hci_emit_btstack_event(event, sizeof(event), 1);
818552db98b2SMatthias Ringwald }
818635454696SMatthias Ringwald #endif
8187c8e4258aSmatthias.ringwald 
818835454696SMatthias Ringwald #ifdef ENABLE_BLE
8189d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
8190667ba9d1SMatthias 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){
8191ebd1b979SMatthias Ringwald     uint8_t hci_event[21];
8192ebd1b979SMatthias Ringwald     hci_event[0] = HCI_EVENT_LE_META;
8193ebd1b979SMatthias Ringwald     hci_event[1] = sizeof(hci_event) - 2u;
8194ebd1b979SMatthias Ringwald     hci_event[2] = HCI_SUBEVENT_LE_CONNECTION_COMPLETE;
8195ebd1b979SMatthias Ringwald     hci_event[3] = status;
8196ebd1b979SMatthias Ringwald     little_endian_store_16(hci_event, 4, con_handle);
8197ebd1b979SMatthias Ringwald     hci_event[6] = 0; // TODO: role
8198ebd1b979SMatthias Ringwald     hci_event[7] = address_type;
8199ebd1b979SMatthias Ringwald     reverse_bd_addr(address, &hci_event[8]);
8200ebd1b979SMatthias Ringwald     little_endian_store_16(hci_event, 14, 0); // interval
8201ebd1b979SMatthias Ringwald     little_endian_store_16(hci_event, 16, 0); // latency
8202ebd1b979SMatthias Ringwald     little_endian_store_16(hci_event, 18, 0); // supervision timeout
8203ebd1b979SMatthias Ringwald     hci_event[20] = 0; // master clock accuracy
82049da9850bSMatthias Ringwald     hci_emit_btstack_event(hci_event, sizeof(hci_event), 1);
8205ebd1b979SMatthias Ringwald     // emit GAP event, too
8206ebd1b979SMatthias Ringwald     uint8_t gap_event[36];
8207ebd1b979SMatthias Ringwald     hci_create_gap_connection_complete_event(hci_event, gap_event);
82089da9850bSMatthias Ringwald     hci_emit_btstack_event(gap_event, sizeof(gap_event), 1);
82094f3229d8S[email protected] }
821035454696SMatthias Ringwald #endif
8211d70217a2SMatthias Ringwald #endif
82124f3229d8S[email protected] 
8213fd43c0e0SMatthias Ringwald static void hci_emit_transport_packet_sent(void){
8214fd43c0e0SMatthias Ringwald     // notify upper stack that it might be possible to send again
8215fd43c0e0SMatthias Ringwald     uint8_t event[] = { HCI_EVENT_TRANSPORT_PACKET_SENT, 0};
82169da9850bSMatthias Ringwald     hci_emit_btstack_event(&event[0], sizeof(event), 0);  // don't dump
8217fd43c0e0SMatthias Ringwald }
8218fd43c0e0SMatthias Ringwald 
8219fc64f94aSMatthias Ringwald static void hci_emit_disconnection_complete(hci_con_handle_t con_handle, uint8_t reason){
8220425d1371Smatthias.ringwald     uint8_t event[6];
82213c4d4b90Smatthias.ringwald     event[0] = HCI_EVENT_DISCONNECTION_COMPLETE;
82224ea43905SMatthias Ringwald     event[1] = sizeof(event) - 2u;
82233c4d4b90Smatthias.ringwald     event[2] = 0; // status = OK
8224fc64f94aSMatthias Ringwald     little_endian_store_16(event, 3, con_handle);
82253c4d4b90Smatthias.ringwald     event[5] = reason;
82269da9850bSMatthias Ringwald     hci_emit_btstack_event(event, sizeof(event), 1);
82273c4d4b90Smatthias.ringwald }
82283c4d4b90Smatthias.ringwald 
8229b83d5eabSMatthias Ringwald static void hci_emit_nr_connections_changed(void){
8230e0abb8e7S[email protected]     log_info("BTSTACK_EVENT_NR_CONNECTIONS_CHANGED %u", nr_hci_connections());
8231425d1371Smatthias.ringwald     uint8_t event[3];
823280d52d6bSmatthias.ringwald     event[0] = BTSTACK_EVENT_NR_CONNECTIONS_CHANGED;
82334ea43905SMatthias Ringwald     event[1] = sizeof(event) - 2u;
823443bfb1bdSmatthias.ringwald     event[2] = nr_hci_connections();
82359da9850bSMatthias Ringwald     hci_emit_btstack_event(event, sizeof(event), 1);
823643bfb1bdSmatthias.ringwald }
8237038bc64cSmatthias.ringwald 
8238b83d5eabSMatthias Ringwald static void hci_emit_hci_open_failed(void){
8239e0abb8e7S[email protected]     log_info("BTSTACK_EVENT_POWERON_FAILED");
8240425d1371Smatthias.ringwald     uint8_t event[2];
824180d52d6bSmatthias.ringwald     event[0] = BTSTACK_EVENT_POWERON_FAILED;
82424ea43905SMatthias Ringwald     event[1] = sizeof(event) - 2u;
82439da9850bSMatthias Ringwald     hci_emit_btstack_event(event, sizeof(event), 1);
8244038bc64cSmatthias.ringwald }
82451b0e3922Smatthias.ringwald 
824635454696SMatthias Ringwald static void hci_emit_dedicated_bonding_result(bd_addr_t address, uint8_t status){
824735454696SMatthias Ringwald     log_info("hci_emit_dedicated_bonding_result %u ", status);
824835454696SMatthias Ringwald     uint8_t event[9];
824935454696SMatthias Ringwald     int pos = 0;
825035454696SMatthias Ringwald     event[pos++] = GAP_EVENT_DEDICATED_BONDING_COMPLETED;
82514ea43905SMatthias Ringwald     event[pos++] = sizeof(event) - 2u;
825235454696SMatthias Ringwald     event[pos++] = status;
825335454696SMatthias Ringwald     reverse_bd_addr(address, &event[pos]);
82549da9850bSMatthias Ringwald     hci_emit_btstack_event(event, sizeof(event), 1);
8255381fbed8Smatthias.ringwald }
8256458bf4e8S[email protected] 
825735454696SMatthias Ringwald 
825835454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
825935454696SMatthias Ringwald 
8260b83d5eabSMatthias Ringwald static void hci_emit_security_level(hci_con_handle_t con_handle, gap_security_level_t level){
8261df3354fcS[email protected]     log_info("hci_emit_security_level %u for handle %x", level, con_handle);
8262a00031e2S[email protected]     uint8_t event[5];
8263e00caf9cS[email protected]     int pos = 0;
82645611a760SMatthias Ringwald     event[pos++] = GAP_EVENT_SECURITY_LEVEL;
8265e00caf9cS[email protected]     event[pos++] = sizeof(event) - 2;
8266f8fbdce0SMatthias Ringwald     little_endian_store_16(event, 2, con_handle);
8267e00caf9cS[email protected]     pos += 2;
8268e00caf9cS[email protected]     event[pos++] = level;
82699da9850bSMatthias Ringwald     hci_emit_btstack_event(event, sizeof(event), 1);
8270e00caf9cS[email protected] }
8271e00caf9cS[email protected] 
827235454696SMatthias Ringwald static gap_security_level_t gap_security_level_for_connection(hci_connection_t * connection){
827335454696SMatthias Ringwald     if (!connection) return LEVEL_0;
82748daf94bcSMatthias Ringwald     if ((connection->authentication_flags & AUTH_FLAG_CONNECTION_ENCRYPTED) == 0) return LEVEL_0;
8275fcaf38b9SMatthias Ringwald     // BIAS: we only consider Authenticated if the connection is already encrypted, which requires that both sides have link key
82768daf94bcSMatthias Ringwald     if ((connection->authentication_flags & AUTH_FLAG_CONNECTION_AUTHENTICATED) == 0) return LEVEL_0;
8277170fafaeSMatthias Ringwald     if (connection->encryption_key_size < hci_stack->gap_required_encyrption_key_size) return LEVEL_0;
82784051b7ffSMatthias Ringwald     gap_security_level_t security_level = gap_security_level_for_link_key_type(connection->link_key_type);
8279a086dc35SMatthias Ringwald     // LEVEL 4 always requires 128 bit encryption key size
82800e588213SMatthias Ringwald     if ((security_level == LEVEL_4) && (connection->encryption_key_size < 16)){
8281170fafaeSMatthias Ringwald         security_level = LEVEL_3;
8282170fafaeSMatthias Ringwald     }
8283170fafaeSMatthias Ringwald     return security_level;
828435454696SMatthias Ringwald }
828535454696SMatthias Ringwald 
828671fd255dSMatthias Ringwald static void hci_emit_scan_mode_changed(uint8_t discoverable, uint8_t connectable){
828771fd255dSMatthias Ringwald     uint8_t event[4];
828871fd255dSMatthias Ringwald     event[0] = BTSTACK_EVENT_SCAN_MODE_CHANGED;
828935454696SMatthias Ringwald     event[1] = sizeof(event) - 2;
829071fd255dSMatthias Ringwald     event[2] = discoverable;
829171fd255dSMatthias Ringwald     event[3] = connectable;
82929da9850bSMatthias Ringwald     hci_emit_btstack_event(event, sizeof(event), 1);
8293ad83dc6aS[email protected] }
8294ad83dc6aS[email protected] 
829598a2fd1cSMatthias Ringwald // query if remote side supports eSCO
829620dcdd22SMatthias Ringwald bool hci_remote_esco_supported(hci_con_handle_t con_handle){
829798a2fd1cSMatthias Ringwald     hci_connection_t * connection = hci_connection_for_handle(con_handle);
829820dcdd22SMatthias Ringwald     if (!connection) return false;
829976ccfb2aSMatthias Ringwald     return (connection->remote_supported_features[0] & 1) != 0;
830098a2fd1cSMatthias Ringwald }
830198a2fd1cSMatthias Ringwald 
83020b78a447SMatthias Ringwald uint16_t hci_remote_sco_packet_types(hci_con_handle_t con_handle){
83030b78a447SMatthias Ringwald     hci_connection_t * connection = hci_connection_for_handle(con_handle);
83040b78a447SMatthias Ringwald     if (!connection) return 0;
83050b78a447SMatthias Ringwald     return connection->remote_supported_sco_packets;
83060b78a447SMatthias Ringwald }
83070b78a447SMatthias Ringwald 
830867aae551SMatthias Ringwald static bool hci_ssp_supported(hci_connection_t * connection){
830967aae551SMatthias Ringwald     const uint8_t mask = BONDING_REMOTE_SUPPORTS_SSP_CONTROLLER | BONDING_REMOTE_SUPPORTS_SSP_HOST;
831067aae551SMatthias Ringwald     return (connection->bonding_flags & mask) == mask;
831167aae551SMatthias Ringwald }
831267aae551SMatthias Ringwald 
83132bd8b7e7S[email protected] // query if remote side supports SSP
831420dcdd22SMatthias Ringwald bool hci_remote_ssp_supported(hci_con_handle_t con_handle){
83152bd8b7e7S[email protected]     hci_connection_t * connection = hci_connection_for_handle(con_handle);
831620dcdd22SMatthias Ringwald     if (!connection) return false;
831767aae551SMatthias Ringwald     return hci_ssp_supported(connection) ? 1 : 0;
83182bd8b7e7S[email protected] }
83192bd8b7e7S[email protected] 
832020dcdd22SMatthias Ringwald bool gap_ssp_supported_on_both_sides(hci_con_handle_t handle){
8321df3354fcS[email protected]     return hci_local_ssp_activated() && hci_remote_ssp_supported(handle);
8322df3354fcS[email protected] }
8323df3354fcS[email protected] 
83246ffc78ceSMatthias Ringwald /**
83256ffc78ceSMatthias Ringwald  * Check if remote supported features query has completed
83266ffc78ceSMatthias Ringwald  */
83276ffc78ceSMatthias Ringwald bool hci_remote_features_available(hci_con_handle_t handle){
83286ffc78ceSMatthias Ringwald     hci_connection_t * connection = hci_connection_for_handle(handle);
83296ffc78ceSMatthias Ringwald     if (!connection) return false;
83306ffc78ceSMatthias Ringwald     return (connection->bonding_flags & BONDING_RECEIVED_REMOTE_FEATURES) != 0;
83316ffc78ceSMatthias Ringwald }
83326ffc78ceSMatthias Ringwald 
8333d6596031SMatthias Ringwald /**
8334d6596031SMatthias Ringwald  * Trigger remote supported features query
8335d6596031SMatthias Ringwald  */
8336c9742cd1SMatthias Ringwald 
8337c9742cd1SMatthias Ringwald static void hci_trigger_remote_features_for_connection(hci_connection_t * connection){
8338c9742cd1SMatthias Ringwald     if ((connection->bonding_flags & (BONDING_REMOTE_FEATURES_QUERY_ACTIVE | BONDING_RECEIVED_REMOTE_FEATURES)) == 0){
8339c9742cd1SMatthias Ringwald         connection->bonding_flags |= BONDING_REMOTE_FEATURES_QUERY_ACTIVE | BONDING_REQUEST_REMOTE_FEATURES_PAGE_0;
8340c9742cd1SMatthias Ringwald     }
8341c9742cd1SMatthias Ringwald }
8342c9742cd1SMatthias Ringwald 
8343d6596031SMatthias Ringwald void hci_remote_features_query(hci_con_handle_t con_handle){
8344d6596031SMatthias Ringwald     hci_connection_t * connection = hci_connection_for_handle(con_handle);
8345d6596031SMatthias Ringwald     if (!connection) return;
8346c9742cd1SMatthias Ringwald     hci_trigger_remote_features_for_connection(connection);
8347d6596031SMatthias Ringwald     hci_run();
8348d6596031SMatthias Ringwald }
8349d6596031SMatthias Ringwald 
8350458bf4e8S[email protected] // GAP API
8351458bf4e8S[email protected] /**
8352458bf4e8S[email protected]  * @bbrief enable/disable bonding. default is enabled
8353458bf4e8S[email protected]  * @praram enabled
8354458bf4e8S[email protected]  */
83554c57c146S[email protected] void gap_set_bondable_mode(int enable){
83563a9fb326S[email protected]     hci_stack->bondable = enable ? 1 : 0;
8357458bf4e8S[email protected] }
83584ef6443cSMatthias Ringwald /**
83594ef6443cSMatthias Ringwald  * @brief Get bondable mode.
83604ef6443cSMatthias Ringwald  * @return 1 if bondable
83614ef6443cSMatthias Ringwald  */
83624ef6443cSMatthias Ringwald int gap_get_bondable_mode(void){
83634ef6443cSMatthias Ringwald     return hci_stack->bondable;
83644ef6443cSMatthias Ringwald }
8365cb230b9dS[email protected] 
8366cb230b9dS[email protected] /**
836734d2123cS[email protected]  * @brief map link keys to security levels
8368cb230b9dS[email protected]  */
836934d2123cS[email protected] gap_security_level_t gap_security_level_for_link_key_type(link_key_type_t link_key_type){
837034d2123cS[email protected]     switch (link_key_type){
83713c68dfa9S[email protected]         case AUTHENTICATED_COMBINATION_KEY_GENERATED_FROM_P256:
83723c68dfa9S[email protected]             return LEVEL_4;
83733c68dfa9S[email protected]         case COMBINATION_KEY:
83743c68dfa9S[email protected]         case AUTHENTICATED_COMBINATION_KEY_GENERATED_FROM_P192:
83753c68dfa9S[email protected]             return LEVEL_3;
83763c68dfa9S[email protected]         default:
83773c68dfa9S[email protected]             return LEVEL_2;
83783c68dfa9S[email protected]     }
8379cb230b9dS[email protected] }
8380cb230b9dS[email protected] 
83818b35e16aSMatthias Ringwald /**
83828b35e16aSMatthias Ringwald  * @brief map link keys to secure connection yes/no
83838b35e16aSMatthias Ringwald  */
838436c3546bSMatthias Ringwald bool gap_secure_connection_for_link_key_type(link_key_type_t link_key_type){
83858b35e16aSMatthias Ringwald     switch (link_key_type){
83868b35e16aSMatthias Ringwald         case AUTHENTICATED_COMBINATION_KEY_GENERATED_FROM_P256:
83878b35e16aSMatthias Ringwald         case UNAUTHENTICATED_COMBINATION_KEY_GENERATED_FROM_P256:
838836c3546bSMatthias Ringwald             return true;
83898b35e16aSMatthias Ringwald         default:
839036c3546bSMatthias Ringwald             return false;
83918b35e16aSMatthias Ringwald     }
83928b35e16aSMatthias Ringwald }
83938b35e16aSMatthias Ringwald 
83948b35e16aSMatthias Ringwald /**
83958b35e16aSMatthias Ringwald  * @brief map link keys to authenticated
83968b35e16aSMatthias Ringwald  */
83977040ba26SMatthias Ringwald bool gap_authenticated_for_link_key_type(link_key_type_t link_key_type){
83988b35e16aSMatthias Ringwald     switch (link_key_type){
83998b35e16aSMatthias Ringwald         case AUTHENTICATED_COMBINATION_KEY_GENERATED_FROM_P256:
84008b35e16aSMatthias Ringwald         case AUTHENTICATED_COMBINATION_KEY_GENERATED_FROM_P192:
84017040ba26SMatthias Ringwald             return true;
84028b35e16aSMatthias Ringwald         default:
84037040ba26SMatthias Ringwald             return false;
84048b35e16aSMatthias Ringwald     }
84058b35e16aSMatthias Ringwald }
84068b35e16aSMatthias Ringwald 
8407552b9260SMatthias Ringwald bool gap_mitm_protection_required_for_security_level(gap_security_level_t level){
84085127cc62S[email protected]     log_info("gap_mitm_protection_required_for_security_level %u", level);
8409106d6d11S[email protected]     return level > LEVEL_2;
8410106d6d11S[email protected] }
8411106d6d11S[email protected] 
841234d2123cS[email protected] /**
841334d2123cS[email protected]  * @brief get current security level
841434d2123cS[email protected]  */
841534d2123cS[email protected] gap_security_level_t gap_security_level(hci_con_handle_t con_handle){
841634d2123cS[email protected]     hci_connection_t * connection = hci_connection_for_handle(con_handle);
841734d2123cS[email protected]     if (!connection) return LEVEL_0;
841834d2123cS[email protected]     return gap_security_level_for_connection(connection);
841934d2123cS[email protected] }
842034d2123cS[email protected] 
8421cb230b9dS[email protected] /**
8422cb230b9dS[email protected]  * @brief request connection to device to
8423cb230b9dS[email protected]  * @result GAP_AUTHENTICATION_RESULT
8424cb230b9dS[email protected]  */
842534d2123cS[email protected] void gap_request_security_level(hci_con_handle_t con_handle, gap_security_level_t requested_level){
842634d2123cS[email protected]     hci_connection_t * connection = hci_connection_for_handle(con_handle);
842734d2123cS[email protected]     if (!connection){
8428a00031e2S[email protected]         hci_emit_security_level(con_handle, LEVEL_0);
842934d2123cS[email protected]         return;
843034d2123cS[email protected]     }
8431defbf200SMatthias Ringwald 
8432defbf200SMatthias Ringwald     btstack_assert(hci_is_le_connection(connection) == false);
8433defbf200SMatthias Ringwald 
8434bc00e12cSMatthias 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)
8435bc00e12cSMatthias Ringwald     // available on the BR/EDR physical transport require Security Mode 4, Level 4 "
8436bc00e12cSMatthias Ringwald     if (hci_stack->gap_secure_connections_only_mode && (requested_level != LEVEL_0)){
8437bc00e12cSMatthias Ringwald         requested_level = LEVEL_4;
8438bc00e12cSMatthias Ringwald     }
8439bc00e12cSMatthias Ringwald 
844034d2123cS[email protected]     gap_security_level_t current_level = gap_security_level(con_handle);
844183d08d7cSMatthias Ringwald     log_info("gap_request_security_level requested level %u, planned level %u, current level %u",
844283d08d7cSMatthias Ringwald         requested_level, connection->requested_security_level, current_level);
844383d08d7cSMatthias Ringwald 
8444dbd5dcc3SMatthias Ringwald     // authentication active if authentication request was sent or planned level > 0
8445dbd5dcc3SMatthias Ringwald     bool authentication_active = ((connection->bonding_flags & BONDING_SENT_AUTHENTICATE_REQUEST) != 0) || (connection->requested_security_level > LEVEL_0);
8446dbd5dcc3SMatthias Ringwald     if (authentication_active){
84471cf0a6c8SMatthias Ringwald         // authentication already active
844883d08d7cSMatthias Ringwald         if (connection->requested_security_level < requested_level){
844983d08d7cSMatthias Ringwald             // increase requested level as new level is higher
845083d08d7cSMatthias Ringwald             // TODO: handle re-authentication when done
845183d08d7cSMatthias Ringwald             connection->requested_security_level = requested_level;
845283d08d7cSMatthias Ringwald         }
84531cf0a6c8SMatthias Ringwald     } else {
845483d08d7cSMatthias Ringwald         // no request active, notify if security sufficient
845583d08d7cSMatthias Ringwald         if (requested_level <= current_level){
8456a00031e2S[email protected]             hci_emit_security_level(con_handle, current_level);
845734d2123cS[email protected]             return;
845834d2123cS[email protected]         }
8459a00031e2S[email protected] 
8460e060c07dSMatthias Ringwald         // store request
846134d2123cS[email protected]         connection->requested_security_level = requested_level;
8462a00031e2S[email protected] 
84631cf0a6c8SMatthias Ringwald         // start to authenticate connection
84641eb2563eS[email protected]         connection->bonding_flags |= BONDING_SEND_AUTHENTICATE_REQUEST;
84657fdbaf79SMatthias Ringwald 
84667fdbaf79SMatthias Ringwald         // request remote features if not already active, also trigger hci_run
84677fdbaf79SMatthias Ringwald         hci_remote_features_query(con_handle);
8468e00caf9cS[email protected]     }
84691cf0a6c8SMatthias Ringwald }
8470ad83dc6aS[email protected] 
8471ad83dc6aS[email protected] /**
8472ad83dc6aS[email protected]  * @brief start dedicated bonding with device. disconnect after bonding
8473ad83dc6aS[email protected]  * @param device
8474ad83dc6aS[email protected]  * @param request MITM protection
8475ad83dc6aS[email protected]  * @result GAP_DEDICATED_BONDING_COMPLETE
8476ad83dc6aS[email protected]  */
8477ad83dc6aS[email protected] int gap_dedicated_bonding(bd_addr_t device, int mitm_protection_required){
8478ad83dc6aS[email protected] 
8479ad83dc6aS[email protected]     // create connection state machine
848088f925b1SMatthias Ringwald     hci_connection_t * connection = create_connection_for_bd_addr_and_type(device, BD_ADDR_TYPE_ACL, HCI_ROLE_MASTER);
8481ad83dc6aS[email protected] 
8482ad83dc6aS[email protected]     if (!connection){
8483ad83dc6aS[email protected]         return BTSTACK_MEMORY_ALLOC_FAILED;
8484ad83dc6aS[email protected]     }
8485ad83dc6aS[email protected] 
84864cd03f8aSMatthias Ringwald     // delete link key
848715a95bd5SMatthias Ringwald     gap_drop_link_key_for_bd_addr(device);
8488ad83dc6aS[email protected] 
8489ad83dc6aS[email protected]     // configure LEVEL_2/3, dedicated bonding
8490ad83dc6aS[email protected]     connection->state = SEND_CREATE_CONNECTION;
8491ad83dc6aS[email protected]     connection->requested_security_level = mitm_protection_required ? LEVEL_3 : LEVEL_2;
8492f04a0c31SMatthias Ringwald     log_info("gap_dedicated_bonding, mitm %d -> level %u", mitm_protection_required, connection->requested_security_level);
8493ad83dc6aS[email protected]     connection->bonding_flags = BONDING_DEDICATED;
8494ad83dc6aS[email protected] 
8495ad83dc6aS[email protected]     hci_run();
8496ad83dc6aS[email protected] 
8497ad83dc6aS[email protected]     return 0;
8498ad83dc6aS[email protected] }
84998e618f72S[email protected] 
8500f82b8f4bSMatthias Ringwald uint8_t hci_dedicated_bonding_defer_disconnect(hci_con_handle_t con_handle, bool defer){
8501ab0c69a9SMatthias Ringwald     hci_connection_t * connection = hci_connection_for_handle(con_handle);
8502ab0c69a9SMatthias Ringwald     if (connection == NULL){
8503ab0c69a9SMatthias Ringwald         return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
8504ab0c69a9SMatthias Ringwald     }
8505ab0c69a9SMatthias Ringwald     if (defer){
8506ab0c69a9SMatthias Ringwald         connection->bonding_flags |= BONDING_DEDICATED_DEFER_DISCONNECT;
8507ab0c69a9SMatthias Ringwald     } else {
8508ab0c69a9SMatthias Ringwald         connection->bonding_flags &= ~BONDING_DEDICATED_DEFER_DISCONNECT;
8509ab0c69a9SMatthias Ringwald         // trigger disconnect
8510ab0c69a9SMatthias Ringwald         hci_run();
8511ab0c69a9SMatthias Ringwald     }
8512ab0c69a9SMatthias Ringwald     return ERROR_CODE_SUCCESS;
8513ab0c69a9SMatthias Ringwald }
8514ab0c69a9SMatthias Ringwald 
85158e618f72S[email protected] void gap_set_local_name(const char * local_name){
85168e618f72S[email protected]     hci_stack->local_name = local_name;
8517baa4881eSMatthias Ringwald     hci_stack->gap_tasks_classic |= GAP_TASK_SET_LOCAL_NAME;
851859d59ecfSMatthias Ringwald     // also update EIR if not set by user
851959d59ecfSMatthias Ringwald     if (hci_stack->eir_data == NULL){
8520baa4881eSMatthias Ringwald         hci_stack->gap_tasks_classic |= GAP_TASK_SET_EIR_DATA;
852159d59ecfSMatthias Ringwald     }
852259d59ecfSMatthias Ringwald     hci_run();
85238e618f72S[email protected] }
85241aeec2ebSMatthias Ringwald #endif
85258e618f72S[email protected] 
852635454696SMatthias Ringwald 
852735454696SMatthias Ringwald #ifdef ENABLE_BLE
852835454696SMatthias Ringwald 
8529d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
8530d8e8f12aSMatthias Ringwald void gap_start_scan(void){
8531fde725feSMatthias Ringwald     hci_stack->le_scanning_enabled = true;
85327bdc6798S[email protected]     hci_run();
85337bdc6798S[email protected] }
85348e618f72S[email protected] 
8535d8e8f12aSMatthias Ringwald void gap_stop_scan(void){
8536fde725feSMatthias Ringwald     hci_stack->le_scanning_enabled = false;
85377bdc6798S[email protected]     hci_run();
85387bdc6798S[email protected] }
85394f3229d8S[email protected] 
8540a7a719e9SMatthias Ringwald void gap_set_scan_params(uint8_t scan_type, uint16_t scan_interval, uint16_t scan_window, uint8_t scanning_filter_policy){
8541ef11999fSmatthias.ringwald     hci_stack->le_scan_type          = scan_type;
8542a7a719e9SMatthias Ringwald     hci_stack->le_scan_filter_policy = scanning_filter_policy;
8543ef11999fSmatthias.ringwald     hci_stack->le_scan_interval      = scan_interval;
8544ef11999fSmatthias.ringwald     hci_stack->le_scan_window        = scan_window;
85458b69e4c7SMatthias Ringwald     hci_stack->le_scanning_param_update = true;
8546ef11999fSmatthias.ringwald     hci_run();
8547ef11999fSmatthias.ringwald }
85484f3229d8S[email protected] 
8549a7a719e9SMatthias Ringwald void gap_set_scan_parameters(uint8_t scan_type, uint16_t scan_interval, uint16_t scan_window){
8550a7a719e9SMatthias Ringwald     gap_set_scan_params(scan_type, scan_interval, scan_window, 0);
8551a7a719e9SMatthias Ringwald }
8552a7a719e9SMatthias Ringwald 
85534856283bSMatthias Ringwald void gap_set_scan_duplicate_filter(bool enabled){
85544856283bSMatthias Ringwald     hci_stack->le_scan_filter_duplicates = enabled ? 1 : 0;
85554856283bSMatthias Ringwald }
85564856283bSMatthias Ringwald 
85577eb5b27eSMatthias Ringwald void gap_set_scan_phys(uint8_t phys){
85587eb5b27eSMatthias Ringwald     // LE Coded and LE 1M PHY
85597eb5b27eSMatthias Ringwald     hci_stack->le_scan_phys = phys & 0x05;
85607eb5b27eSMatthias Ringwald }
85617eb5b27eSMatthias Ringwald 
8562667ba9d1SMatthias Ringwald uint8_t gap_connect(const bd_addr_t addr, bd_addr_type_t addr_type) {
85639cb52963SMatthias Ringwald     // disallow le connection if outgoing already active
8564d32b3f05SMatthias Ringwald     if (hci_is_le_connection_type(addr_type) && hci_stack->le_connecting_request != LE_CONNECTING_IDLE){
85659cb52963SMatthias Ringwald         log_error("le connect already active");
8566d32b3f05SMatthias Ringwald         return ERROR_CODE_COMMAND_DISALLOWED;
8567d32b3f05SMatthias Ringwald     }
8568d32b3f05SMatthias Ringwald 
85699cb52963SMatthias Ringwald     hci_connection_t * conn = hci_connection_for_bd_addr_and_type(addr, addr_type);
85709cb52963SMatthias Ringwald     if (conn == NULL) {
857188f925b1SMatthias Ringwald         conn = create_connection_for_bd_addr_and_type(addr, addr_type, HCI_ROLE_MASTER);
8572f29c1023SMatthias Ringwald         if (conn == NULL){
85739cb52963SMatthias Ringwald             // alloc failed
8574d8e8f12aSMatthias Ringwald             log_info("gap_connect: failed to alloc hci_connection_t");
85759cb52963SMatthias Ringwald             return BTSTACK_MEMORY_ALLOC_FAILED;
85769cb52963SMatthias Ringwald         }
85779cb52963SMatthias Ringwald     } else {
85789cb52963SMatthias Ringwald         switch (conn->state) {
85799cb52963SMatthias Ringwald             case RECEIVED_DISCONNECTION_COMPLETE:
85809cb52963SMatthias Ringwald                 // connection was just disconnected, reset state and allow re-connect
85819cb52963SMatthias Ringwald                 conn->role = HCI_ROLE_MASTER;
85829cb52963SMatthias Ringwald                 break;
85839cb52963SMatthias Ringwald             default:
85849cb52963SMatthias Ringwald                 return ERROR_CODE_COMMAND_DISALLOWED;
85859cb52963SMatthias Ringwald         }
85864f3229d8S[email protected]     }
8587d5b1a89eSMatthias Ringwald 
8588d5b1a89eSMatthias Ringwald     // set le connecting state
8589d5b1a89eSMatthias Ringwald     if (hci_is_le_connection_type(addr_type)){
8590d5b1a89eSMatthias Ringwald         hci_stack->le_connecting_request = LE_CONNECTING_DIRECT;
8591d5b1a89eSMatthias Ringwald     }
8592d5b1a89eSMatthias Ringwald 
85939cb52963SMatthias Ringwald     // trigger connect
8594d8e8f12aSMatthias Ringwald     log_info("gap_connect: send create connection next");
8595b0136355SMatthias Ringwald     conn->state = SEND_CREATE_CONNECTION;
8596b0136355SMatthias Ringwald     hci_run();
8597b0136355SMatthias Ringwald     return ERROR_CODE_SUCCESS;
8598b0136355SMatthias Ringwald }
8599b0136355SMatthias Ringwald 
86007851196eSmatthias.ringwald // @assumption: only a single outgoing LE Connection exists
8601ca0d6e5aSMatthias Ringwald static hci_connection_t * gap_get_outgoing_le_connection(void){
8602665d90f2SMatthias Ringwald     btstack_linked_item_t *it;
8603a0da043fSMatthias Ringwald     for (it = (btstack_linked_item_t *) hci_stack->connections; it != NULL; it = it->next){
86040bf6344aS[email protected]         hci_connection_t * conn = (hci_connection_t *) it;
8605ca0d6e5aSMatthias Ringwald         if (hci_is_le_connection(conn)){
86060bf6344aS[email protected]             switch (conn->state){
8607a6725849S[email protected]                 case SEND_CREATE_CONNECTION:
86087851196eSmatthias.ringwald                 case SENT_CREATE_CONNECTION:
86097851196eSmatthias.ringwald                     return conn;
86107851196eSmatthias.ringwald                 default:
86117851196eSmatthias.ringwald                     break;
86127851196eSmatthias.ringwald             };
86137851196eSmatthias.ringwald         }
8614ca0d6e5aSMatthias Ringwald     }
86157851196eSmatthias.ringwald     return NULL;
86167851196eSmatthias.ringwald }
86177851196eSmatthias.ringwald 
8618d8e8f12aSMatthias Ringwald uint8_t gap_connect_cancel(void){
861914f2d8f0SMatthias Ringwald     hci_connection_t * conn;
862014f2d8f0SMatthias Ringwald     switch (hci_stack->le_connecting_request){
862114f2d8f0SMatthias Ringwald         case LE_CONNECTING_IDLE:
862214f2d8f0SMatthias Ringwald             break;
862314f2d8f0SMatthias Ringwald         case LE_CONNECTING_WHITELIST:
862414f2d8f0SMatthias Ringwald             hci_stack->le_connecting_request = LE_CONNECTING_IDLE;
862514f2d8f0SMatthias Ringwald             hci_run();
862614f2d8f0SMatthias Ringwald             break;
862714f2d8f0SMatthias Ringwald         case LE_CONNECTING_DIRECT:
862814f2d8f0SMatthias Ringwald             hci_stack->le_connecting_request = LE_CONNECTING_IDLE;
8629ca0d6e5aSMatthias Ringwald             conn = gap_get_outgoing_le_connection();
863014f2d8f0SMatthias Ringwald             if (conn == NULL){
863114f2d8f0SMatthias Ringwald                 hci_run();
863214f2d8f0SMatthias Ringwald             } else {
86337851196eSmatthias.ringwald                 switch (conn->state){
86347851196eSmatthias.ringwald                     case SEND_CREATE_CONNECTION:
86357851196eSmatthias.ringwald                         // skip sending create connection and emit event instead
86362e77e513S[email protected]                         hci_emit_le_connection_complete(conn->address_type, conn->address, 0, ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER);
8637665d90f2SMatthias Ringwald                         btstack_linked_list_remove(&hci_stack->connections, (btstack_linked_item_t *) conn);
86387851196eSmatthias.ringwald                         btstack_memory_hci_connection_free( conn );
86390bf6344aS[email protected]                         break;
8640a6725849S[email protected]                     case SENT_CREATE_CONNECTION:
8641ea04fbd8SMatthias Ringwald                         // let hci_run_general_gap_le cancel outgoing connection
86420bf6344aS[email protected]                         hci_run();
86430bf6344aS[email protected]                         break;
86440bf6344aS[email protected]                     default:
86450bf6344aS[email protected]                         break;
86460bf6344aS[email protected]                 }
864714f2d8f0SMatthias Ringwald             }
864814f2d8f0SMatthias Ringwald             break;
864943dfd98aSMatthias Ringwald         default:
865014f2d8f0SMatthias Ringwald             btstack_unreachable();
865114f2d8f0SMatthias Ringwald             break;
865214f2d8f0SMatthias Ringwald     }
865314f2d8f0SMatthias Ringwald     return ERROR_CODE_SUCCESS;
8654e31f89a7S[email protected] }
86554f3229d8S[email protected] 
8656c37a3166S[email protected] /**
86576012052bSMatthias Ringwald  * @brief Set connection parameters for outgoing connections
8658cbe54ab2SJakob Krantz  * @param conn_scan_interval (unit: 0.625 msec), default: 60 ms
8659cbe54ab2SJakob Krantz  * @param conn_scan_window (unit: 0.625 msec), default: 30 ms
86606012052bSMatthias Ringwald  * @param conn_interval_min (unit: 1.25ms), default: 10 ms
86616012052bSMatthias Ringwald  * @param conn_interval_max (unit: 1.25ms), default: 30 ms
86626012052bSMatthias Ringwald  * @param conn_latency, default: 4
86636012052bSMatthias Ringwald  * @param supervision_timeout (unit: 10ms), default: 720 ms
86646012052bSMatthias Ringwald  * @param min_ce_length (unit: 0.625ms), default: 10 ms
86656012052bSMatthias Ringwald  * @param max_ce_length (unit: 0.625ms), default: 30 ms
86666012052bSMatthias Ringwald  */
86676012052bSMatthias Ringwald 
86680c2c5f79SMatthias Ringwald void gap_set_connection_phys(uint8_t phys){
86690c2c5f79SMatthias Ringwald     // LE Coded, LE 1M, LE 2M PHY
86700c2c5f79SMatthias Ringwald     hci_stack->le_connection_phys = phys & 7;
86710c2c5f79SMatthias Ringwald }
86720c2c5f79SMatthias Ringwald 
86730c2c5f79SMatthias Ringwald #endif
86740c2c5f79SMatthias Ringwald 
8675cbe54ab2SJakob Krantz void gap_set_connection_parameters(uint16_t conn_scan_interval, uint16_t conn_scan_window,
8676cbe54ab2SJakob Krantz                                    uint16_t conn_interval_min, uint16_t conn_interval_max, uint16_t conn_latency,
8677cbe54ab2SJakob Krantz                                    uint16_t supervision_timeout, uint16_t min_ce_length, uint16_t max_ce_length){
8678cbe54ab2SJakob Krantz     hci_stack->le_connection_scan_interval = conn_scan_interval;
8679cbe54ab2SJakob Krantz     hci_stack->le_connection_scan_window = conn_scan_window;
86806012052bSMatthias Ringwald     hci_stack->le_connection_interval_min = conn_interval_min;
86816012052bSMatthias Ringwald     hci_stack->le_connection_interval_max = conn_interval_max;
86826012052bSMatthias Ringwald     hci_stack->le_connection_latency = conn_latency;
86836012052bSMatthias Ringwald     hci_stack->le_supervision_timeout = supervision_timeout;
86846012052bSMatthias Ringwald     hci_stack->le_minimum_ce_length = min_ce_length;
86856012052bSMatthias Ringwald     hci_stack->le_maximum_ce_length = max_ce_length;
86866012052bSMatthias Ringwald }
86877eb5b27eSMatthias Ringwald 
86886012052bSMatthias Ringwald /**
8689c37a3166S[email protected]  * @brief Updates the connection parameters for a given LE connection
8690c37a3166S[email protected]  * @param handle
8691c37a3166S[email protected]  * @param conn_interval_min (unit: 1.25ms)
8692c37a3166S[email protected]  * @param conn_interval_max (unit: 1.25ms)
8693c37a3166S[email protected]  * @param conn_latency
8694c37a3166S[email protected]  * @param supervision_timeout (unit: 10ms)
86956b65794dSMilanka Ringwald  * @return 0 if ok
8696c37a3166S[email protected]  */
8697c37a3166S[email protected] int gap_update_connection_parameters(hci_con_handle_t con_handle, uint16_t conn_interval_min,
8698c37a3166S[email protected]     uint16_t conn_interval_max, uint16_t conn_latency, uint16_t supervision_timeout){
8699c37a3166S[email protected]     hci_connection_t * connection = hci_connection_for_handle(con_handle);
8700c37a3166S[email protected]     if (!connection) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
8701c37a3166S[email protected]     connection->le_conn_interval_min = conn_interval_min;
8702c37a3166S[email protected]     connection->le_conn_interval_max = conn_interval_max;
8703c37a3166S[email protected]     connection->le_conn_latency = conn_latency;
8704c37a3166S[email protected]     connection->le_supervision_timeout = supervision_timeout;
870584cf6d83SMatthias Ringwald     connection->le_con_parameter_update_state = CON_PARAMETER_UPDATE_CHANGE_HCI_CON_PARAMETERS;
8706cfc59f1bSMatthias Ringwald     hci_run();
8707c37a3166S[email protected]     return 0;
8708c37a3166S[email protected] }
8709c37a3166S[email protected] 
871045c102fdSMatthias Ringwald /**
8711b68d7bc3SMatthias Ringwald  * @brief Request an update of the connection parameter for a given LE connection
8712b68d7bc3SMatthias Ringwald  * @param handle
8713b68d7bc3SMatthias Ringwald  * @param conn_interval_min (unit: 1.25ms)
8714b68d7bc3SMatthias Ringwald  * @param conn_interval_max (unit: 1.25ms)
8715b68d7bc3SMatthias Ringwald  * @param conn_latency
8716b68d7bc3SMatthias Ringwald  * @param supervision_timeout (unit: 10ms)
87176b65794dSMilanka Ringwald  * @return 0 if ok
8718b68d7bc3SMatthias Ringwald  */
8719b68d7bc3SMatthias Ringwald int gap_request_connection_parameter_update(hci_con_handle_t con_handle, uint16_t conn_interval_min,
8720b68d7bc3SMatthias Ringwald     uint16_t conn_interval_max, uint16_t conn_latency, uint16_t supervision_timeout){
8721b68d7bc3SMatthias Ringwald     hci_connection_t * connection = hci_connection_for_handle(con_handle);
8722b68d7bc3SMatthias Ringwald     if (!connection) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
8723b68d7bc3SMatthias Ringwald     connection->le_conn_interval_min = conn_interval_min;
8724b68d7bc3SMatthias Ringwald     connection->le_conn_interval_max = conn_interval_max;
8725b68d7bc3SMatthias Ringwald     connection->le_conn_latency = conn_latency;
8726b68d7bc3SMatthias Ringwald     connection->le_supervision_timeout = supervision_timeout;
8727b68d7bc3SMatthias Ringwald     connection->le_con_parameter_update_state = CON_PARAMETER_UPDATE_SEND_REQUEST;
872809c9c963SMatthias Ringwald     uint8_t l2cap_trigger_run_event[2] = { L2CAP_EVENT_TRIGGER_RUN, 0};
87299da9850bSMatthias Ringwald     hci_emit_btstack_event(l2cap_trigger_run_event, sizeof(l2cap_trigger_run_event), 0);
8730b68d7bc3SMatthias Ringwald     return 0;
8731b68d7bc3SMatthias Ringwald }
8732b68d7bc3SMatthias Ringwald 
87339007c891SMatthias Ringwald uint8_t gap_request_connection_subrating(hci_con_handle_t con_handle, uint16_t subrate_min, uint16_t subrate_max,
87349007c891SMatthias Ringwald                                          uint16_t max_latency, uint16_t continuation_number, uint16_t supervision_timeout){
87359007c891SMatthias Ringwald     hci_connection_t * connection = hci_connection_for_handle(con_handle);
87369007c891SMatthias Ringwald     if (!connection) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
87379007c891SMatthias Ringwald 
87389007c891SMatthias Ringwald     connection->le_subrate_min = subrate_min;
87399007c891SMatthias Ringwald     connection->le_subrate_max = subrate_max;
87409007c891SMatthias Ringwald     connection->le_subrate_max_latency = max_latency;
87419007c891SMatthias Ringwald     connection->le_subrate_continuation_number = continuation_number;
87429007c891SMatthias Ringwald     connection->le_supervision_timeout = supervision_timeout;
87439007c891SMatthias Ringwald     hci_run();
87449007c891SMatthias Ringwald     return ERROR_CODE_SUCCESS;
87459007c891SMatthias Ringwald }
87469007c891SMatthias Ringwald 
8747d70217a2SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
8748d70217a2SMatthias Ringwald 
87495e05c0afSMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
87505e05c0afSMatthias Ringwald static void hci_assert_advertisement_set_0_ready(void){
87515e05c0afSMatthias Ringwald     // force advertising set creation for legacy LE Advertising
87525e05c0afSMatthias Ringwald     if ((hci_stack->le_advertisements_state & LE_ADVERTISEMENT_STATE_PARAMS_SET) == 0){
87535e05c0afSMatthias Ringwald         hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_SET_PARAMS;
87545e05c0afSMatthias Ringwald     }
87555e05c0afSMatthias Ringwald }
87565e05c0afSMatthias Ringwald #endif
87575e05c0afSMatthias Ringwald 
8758b68d7bc3SMatthias Ringwald /**
875945c102fdSMatthias Ringwald  * @brief Set Advertisement Data
876045c102fdSMatthias Ringwald  * @param advertising_data_length
876145c102fdSMatthias Ringwald  * @param advertising_data (max 31 octets)
876245c102fdSMatthias Ringwald  * @note data is not copied, pointer has to stay valid
876345c102fdSMatthias Ringwald  */
876445c102fdSMatthias Ringwald void gap_advertisements_set_data(uint8_t advertising_data_length, uint8_t * advertising_data){
876545c102fdSMatthias Ringwald     hci_stack->le_advertisements_data_len = advertising_data_length;
876645c102fdSMatthias Ringwald     hci_stack->le_advertisements_data = advertising_data;
8767501f56b3SMatthias Ringwald     hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_SET_ADV_DATA;
87685e05c0afSMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
87695e05c0afSMatthias Ringwald     hci_assert_advertisement_set_0_ready();
87705e05c0afSMatthias Ringwald #endif
8771bbc366e6SMatthias Ringwald     hci_run();
877245c102fdSMatthias Ringwald }
8773501f56b3SMatthias Ringwald 
8774501f56b3SMatthias Ringwald /**
8775501f56b3SMatthias Ringwald  * @brief Set Scan Response Data
8776501f56b3SMatthias Ringwald  * @param advertising_data_length
8777501f56b3SMatthias Ringwald  * @param advertising_data (max 31 octets)
8778501f56b3SMatthias Ringwald  * @note data is not copied, pointer has to stay valid
8779501f56b3SMatthias Ringwald  */
8780501f56b3SMatthias Ringwald void gap_scan_response_set_data(uint8_t scan_response_data_length, uint8_t * scan_response_data){
8781501f56b3SMatthias Ringwald     hci_stack->le_scan_response_data_len = scan_response_data_length;
8782501f56b3SMatthias Ringwald     hci_stack->le_scan_response_data = scan_response_data;
8783501f56b3SMatthias Ringwald     hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_SET_SCAN_DATA;
87845e05c0afSMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
87855e05c0afSMatthias Ringwald     hci_assert_advertisement_set_0_ready();
87865e05c0afSMatthias Ringwald #endif
8787bbc366e6SMatthias Ringwald     hci_run();
878845c102fdSMatthias Ringwald }
878945c102fdSMatthias Ringwald 
879045c102fdSMatthias Ringwald /**
879145c102fdSMatthias Ringwald  * @brief Set Advertisement Parameters
879245c102fdSMatthias Ringwald  * @param adv_int_min
879345c102fdSMatthias Ringwald  * @param adv_int_max
879445c102fdSMatthias Ringwald  * @param adv_type
879545c102fdSMatthias Ringwald  * @param direct_address_type
879645c102fdSMatthias Ringwald  * @param direct_address
879745c102fdSMatthias Ringwald  * @param channel_map
879845c102fdSMatthias Ringwald  * @param filter_policy
879945c102fdSMatthias Ringwald  *
880045c102fdSMatthias Ringwald  * @note internal use. use gap_advertisements_set_params from gap_le.h instead.
880145c102fdSMatthias Ringwald  */
880245c102fdSMatthias Ringwald  void hci_le_advertisements_set_params(uint16_t adv_int_min, uint16_t adv_int_max, uint8_t adv_type,
8803b95a5a35SMatthias Ringwald     uint8_t direct_address_typ, bd_addr_t direct_address,
880445c102fdSMatthias Ringwald     uint8_t channel_map, uint8_t filter_policy) {
880545c102fdSMatthias Ringwald 
880645c102fdSMatthias Ringwald     hci_stack->le_advertisements_interval_min = adv_int_min;
880745c102fdSMatthias Ringwald     hci_stack->le_advertisements_interval_max = adv_int_max;
880845c102fdSMatthias Ringwald     hci_stack->le_advertisements_type = adv_type;
880945c102fdSMatthias Ringwald     hci_stack->le_advertisements_direct_address_type = direct_address_typ;
881045c102fdSMatthias Ringwald     hci_stack->le_advertisements_channel_map = channel_map;
881145c102fdSMatthias Ringwald     hci_stack->le_advertisements_filter_policy = filter_policy;
88126535961aSMatthias Ringwald     (void)memcpy(hci_stack->le_advertisements_direct_address, direct_address,
88136535961aSMatthias Ringwald                  6);
881445c102fdSMatthias Ringwald 
88156bf435a6SMatthias Ringwald     hci_stack->le_advertisements_todo  |= LE_ADVERTISEMENT_TASKS_SET_PARAMS;
88166bf435a6SMatthias Ringwald     hci_stack->le_advertisements_state |= LE_ADVERTISEMENT_STATE_PARAMS_SET;
8817bbc366e6SMatthias Ringwald     hci_run();
881845c102fdSMatthias Ringwald  }
881945c102fdSMatthias Ringwald 
882045c102fdSMatthias Ringwald /**
882145c102fdSMatthias Ringwald  * @brief Enable/Disable Advertisements
882245c102fdSMatthias Ringwald  * @param enabled
882345c102fdSMatthias Ringwald  */
882445c102fdSMatthias Ringwald void gap_advertisements_enable(int enabled){
8825a408e724SMatthias Ringwald     if (enabled == 0){
8826a408e724SMatthias Ringwald         hci_stack->le_advertisements_state &= ~LE_ADVERTISEMENT_STATE_ENABLED;
8827a408e724SMatthias Ringwald     } else {
8828a408e724SMatthias Ringwald         hci_stack->le_advertisements_state |= LE_ADVERTISEMENT_STATE_ENABLED;
8829a408e724SMatthias Ringwald     }
8830bbc366e6SMatthias Ringwald     hci_update_advertisements_enabled_for_current_roles();
8831cfc59f1bSMatthias Ringwald     hci_run();
883245c102fdSMatthias Ringwald }
883345c102fdSMatthias Ringwald 
8834a5770ecbSMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
8835a5770ecbSMatthias Ringwald static le_advertising_set_t * hci_advertising_set_for_handle(uint8_t advertising_handle){
8836a5770ecbSMatthias Ringwald     btstack_linked_list_iterator_t it;
8837a5770ecbSMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->le_advertising_sets);
8838a5770ecbSMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
8839a5770ecbSMatthias Ringwald         le_advertising_set_t * item = (le_advertising_set_t *) btstack_linked_list_iterator_next(&it);
8840a5770ecbSMatthias Ringwald         if ( item->advertising_handle == advertising_handle ) {
8841a5770ecbSMatthias Ringwald             return item;
8842a5770ecbSMatthias Ringwald         }
8843a5770ecbSMatthias Ringwald     }
8844a5770ecbSMatthias Ringwald     return NULL;
8845a5770ecbSMatthias Ringwald }
8846a5770ecbSMatthias Ringwald 
88472052d96cSMatthias Ringwald uint8_t gap_extended_advertising_set_resolvable_private_address_update(uint16_t update_s){
88482052d96cSMatthias Ringwald     hci_stack->le_resolvable_private_address_update_s = update_s;
88492052d96cSMatthias Ringwald     hci_run();
88502052d96cSMatthias Ringwald     return ERROR_CODE_SUCCESS;
88512052d96cSMatthias Ringwald }
88522052d96cSMatthias Ringwald 
8853a5770ecbSMatthias 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){
88542d0c7965SMatthias Ringwald     // find free advertisement handle. we use LE_EXTENDED_ADVERTISING_LEGACY_HANDLE for non-extended advertising
8855a5770ecbSMatthias Ringwald     uint8_t advertisement_handle;
88562d0c7965SMatthias Ringwald     for (advertisement_handle = LE_EXTENDED_ADVERTISING_LEGACY_HANDLE + 1; advertisement_handle <= LE_EXTENDED_ADVERTISING_MAX_HANDLE; advertisement_handle++){
8857a5770ecbSMatthias Ringwald         if (hci_advertising_set_for_handle(advertisement_handle) == NULL) break;
8858a5770ecbSMatthias Ringwald     }
8859a5770ecbSMatthias Ringwald     if (advertisement_handle > LE_EXTENDED_ADVERTISING_MAX_HANDLE) return ERROR_CODE_MEMORY_CAPACITY_EXCEEDED;
8860a5770ecbSMatthias Ringwald     // clear
8861a5770ecbSMatthias Ringwald     memset(storage, 0, sizeof(le_advertising_set_t));
8862a5770ecbSMatthias Ringwald     // copy params
88630cbe4690SMatthias Ringwald     storage->advertising_handle = advertisement_handle;
886457a04237SMatthias Ringwald     memcpy(&storage->extended_params, advertising_parameters, sizeof(le_extended_advertising_parameters_t));
8865a5770ecbSMatthias Ringwald     // add to list
8866a5770ecbSMatthias Ringwald     bool add_ok = btstack_linked_list_add(&hci_stack->le_advertising_sets, (btstack_linked_item_t *) storage);
8867a5770ecbSMatthias Ringwald     if (!add_ok) return ERROR_CODE_ACL_CONNECTION_ALREADY_EXISTS;
88680cbe4690SMatthias Ringwald     *out_advertising_handle = advertisement_handle;
8869a5770ecbSMatthias Ringwald     // set tasks and start
8870a5770ecbSMatthias Ringwald     storage->tasks = LE_ADVERTISEMENT_TASKS_SET_PARAMS;
8871a5770ecbSMatthias Ringwald     hci_run();
8872a5770ecbSMatthias Ringwald     return ERROR_CODE_SUCCESS;
8873a5770ecbSMatthias Ringwald }
8874a5770ecbSMatthias Ringwald 
8875a5770ecbSMatthias Ringwald uint8_t gap_extended_advertising_set_params(uint8_t advertising_handle, const le_extended_advertising_parameters_t * advertising_parameters){
8876a5770ecbSMatthias Ringwald     le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(advertising_handle);
8877a5770ecbSMatthias Ringwald     if (advertising_set == NULL) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
887857a04237SMatthias Ringwald     memcpy(&advertising_set->extended_params, advertising_parameters, sizeof(le_extended_advertising_parameters_t));
8879a5770ecbSMatthias Ringwald     // set tasks and start
8880a5770ecbSMatthias Ringwald     advertising_set->tasks |= LE_ADVERTISEMENT_TASKS_SET_PARAMS;
8881a5770ecbSMatthias Ringwald     hci_run();
8882a5770ecbSMatthias Ringwald     return ERROR_CODE_SUCCESS;
8883a5770ecbSMatthias Ringwald }
8884a5770ecbSMatthias Ringwald 
8885a5770ecbSMatthias Ringwald uint8_t gap_extended_advertising_get_params(uint8_t advertising_handle, le_extended_advertising_parameters_t * advertising_parameters){
8886a5770ecbSMatthias Ringwald     le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(advertising_handle);
8887a5770ecbSMatthias Ringwald     if (advertising_set == NULL) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
888857a04237SMatthias Ringwald     memcpy(advertising_parameters, &advertising_set->extended_params, sizeof(le_extended_advertising_parameters_t));
8889a5770ecbSMatthias Ringwald     return ERROR_CODE_SUCCESS;
8890a5770ecbSMatthias Ringwald }
8891a5770ecbSMatthias Ringwald 
8892a5770ecbSMatthias Ringwald uint8_t gap_extended_advertising_set_random_address(uint8_t advertising_handle, bd_addr_t random_address){
8893a5770ecbSMatthias Ringwald     le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(advertising_handle);
8894a5770ecbSMatthias Ringwald     if (advertising_set == NULL) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
8895a5770ecbSMatthias Ringwald     memcpy(advertising_set->random_address, random_address, 6);
8896a5770ecbSMatthias Ringwald     // set tasks and start
8897a5770ecbSMatthias Ringwald     advertising_set->tasks |= LE_ADVERTISEMENT_TASKS_SET_ADDRESS;
8898a5770ecbSMatthias Ringwald     hci_run();
8899a5770ecbSMatthias Ringwald     return ERROR_CODE_SUCCESS;
8900a5770ecbSMatthias Ringwald }
8901a5770ecbSMatthias Ringwald 
89022e4aaf70SMatthias Ringwald uint8_t gap_extended_advertising_set_adv_data(uint8_t advertising_handle, uint16_t advertising_data_length, const uint8_t * advertising_data){
8903a5770ecbSMatthias Ringwald     le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(advertising_handle);
8904a5770ecbSMatthias Ringwald     if (advertising_set == NULL) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
8905a5770ecbSMatthias Ringwald     advertising_set->adv_data = advertising_data;
8906a5770ecbSMatthias Ringwald     advertising_set->adv_data_len = advertising_data_length;
8907a5770ecbSMatthias Ringwald     // set tasks and start
8908a5770ecbSMatthias Ringwald     advertising_set->tasks |= LE_ADVERTISEMENT_TASKS_SET_ADV_DATA;
8909a5770ecbSMatthias Ringwald     hci_run();
8910a5770ecbSMatthias Ringwald     return ERROR_CODE_SUCCESS;
8911a5770ecbSMatthias Ringwald }
8912a5770ecbSMatthias Ringwald 
89132e4aaf70SMatthias 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){
8914a5770ecbSMatthias Ringwald     le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(advertising_handle);
8915a5770ecbSMatthias Ringwald     if (advertising_set == NULL) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
8916a5770ecbSMatthias Ringwald     advertising_set->scan_data = scan_response_data;
8917a5770ecbSMatthias Ringwald     advertising_set->scan_data_len = scan_response_data_length;
8918a5770ecbSMatthias Ringwald     // set tasks and start
8919a5770ecbSMatthias Ringwald     advertising_set->tasks |= LE_ADVERTISEMENT_TASKS_SET_SCAN_DATA;
8920a5770ecbSMatthias Ringwald     hci_run();
8921a5770ecbSMatthias Ringwald     return ERROR_CODE_SUCCESS;
8922a5770ecbSMatthias Ringwald }
8923a5770ecbSMatthias Ringwald 
8924a5770ecbSMatthias Ringwald uint8_t gap_extended_advertising_start(uint8_t advertising_handle, uint16_t timeout, uint8_t num_extended_advertising_events){
8925a5770ecbSMatthias Ringwald     le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(advertising_handle);
8926a5770ecbSMatthias Ringwald     if (advertising_set == NULL) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
8927a5770ecbSMatthias Ringwald     advertising_set->enable_timeout = timeout;
8928a5770ecbSMatthias Ringwald     advertising_set->enable_max_scan_events = num_extended_advertising_events;
8929a5770ecbSMatthias Ringwald     // set tasks and start
8930a5770ecbSMatthias Ringwald     advertising_set->state |= LE_ADVERTISEMENT_STATE_ENABLED;
8931a5770ecbSMatthias Ringwald     hci_run();
8932a5770ecbSMatthias Ringwald     return ERROR_CODE_SUCCESS;
8933a5770ecbSMatthias Ringwald }
8934a5770ecbSMatthias Ringwald 
8935a5770ecbSMatthias Ringwald uint8_t gap_extended_advertising_stop(uint8_t advertising_handle){
8936a5770ecbSMatthias Ringwald     le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(advertising_handle);
8937a5770ecbSMatthias Ringwald     if (advertising_set == NULL) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
8938a5770ecbSMatthias Ringwald     // set tasks and start
8939a5770ecbSMatthias Ringwald     advertising_set->state &= ~LE_ADVERTISEMENT_STATE_ENABLED;
8940a5770ecbSMatthias Ringwald     hci_run();
8941a5770ecbSMatthias Ringwald     return ERROR_CODE_SUCCESS;
8942a5770ecbSMatthias Ringwald }
8943a5770ecbSMatthias Ringwald 
8944c814a904SMatthias Ringwald uint8_t gap_extended_advertising_remove(uint8_t advertising_handle){
8945c814a904SMatthias Ringwald     le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(advertising_handle);
8946c814a904SMatthias Ringwald     if (advertising_set == NULL) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
8947c814a904SMatthias Ringwald     // set tasks and start
8948c814a904SMatthias Ringwald     advertising_set->tasks |= LE_ADVERTISEMENT_TASKS_REMOVE_SET;
8949c814a904SMatthias Ringwald     hci_run();
8950c814a904SMatthias Ringwald     return ERROR_CODE_SUCCESS;
8951c814a904SMatthias Ringwald }
8952c814a904SMatthias Ringwald 
8953c814a904SMatthias Ringwald #ifdef ENABLE_LE_PERIODIC_ADVERTISING
8954c814a904SMatthias Ringwald uint8_t gap_periodic_advertising_set_params(uint8_t advertising_handle, const le_periodic_advertising_parameters_t * advertising_parameters){
8955c814a904SMatthias Ringwald     le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(advertising_handle);
8956c814a904SMatthias Ringwald     if (advertising_set == NULL) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
8957c814a904SMatthias Ringwald     // periodic advertising requires neither connectable, scannable, legacy or anonymous
8958c814a904SMatthias Ringwald     if ((advertising_set->extended_params.advertising_event_properties & 0x1f) != 0) return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS;
8959c814a904SMatthias Ringwald     memcpy(&advertising_set->periodic_params, advertising_parameters, sizeof(le_periodic_advertising_parameters_t));
8960c814a904SMatthias Ringwald     // set tasks and start
8961c814a904SMatthias Ringwald     advertising_set->tasks |= LE_ADVERTISEMENT_TASKS_SET_PERIODIC_PARAMS;
8962c814a904SMatthias Ringwald     hci_run();
8963c814a904SMatthias Ringwald     return ERROR_CODE_SUCCESS;
8964c814a904SMatthias Ringwald }
8965c814a904SMatthias Ringwald 
8966c814a904SMatthias Ringwald uint8_t gap_periodic_advertising_get_params(uint8_t advertising_handle, le_periodic_advertising_parameters_t * advertising_parameters){
8967c814a904SMatthias Ringwald     le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(advertising_handle);
8968c814a904SMatthias Ringwald     if (advertising_set == NULL) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
8969c814a904SMatthias Ringwald     memcpy(advertising_parameters, &advertising_set->extended_params, sizeof(le_periodic_advertising_parameters_t));
8970c814a904SMatthias Ringwald     return ERROR_CODE_SUCCESS;
8971c814a904SMatthias Ringwald }
8972c814a904SMatthias Ringwald 
8973c814a904SMatthias Ringwald uint8_t gap_periodic_advertising_set_data(uint8_t advertising_handle, uint16_t periodic_data_length, const uint8_t * periodic_data){
8974c814a904SMatthias Ringwald     le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(advertising_handle);
8975c814a904SMatthias Ringwald     if (advertising_set == NULL) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
8976c814a904SMatthias Ringwald     advertising_set->periodic_data = periodic_data;
8977c814a904SMatthias Ringwald     advertising_set->periodic_data_len = periodic_data_length;
8978c814a904SMatthias Ringwald     // set tasks and start
8979c814a904SMatthias Ringwald     advertising_set->tasks |= LE_ADVERTISEMENT_TASKS_SET_PERIODIC_DATA;
8980c814a904SMatthias Ringwald     hci_run();
8981c814a904SMatthias Ringwald     return ERROR_CODE_SUCCESS;
8982c814a904SMatthias Ringwald }
8983c814a904SMatthias Ringwald 
898453f240c0SMatthias Ringwald uint8_t gap_periodic_advertising_start(uint8_t advertising_handle, bool include_adi){
898553f240c0SMatthias Ringwald     le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(advertising_handle);
898653f240c0SMatthias Ringwald     if (advertising_set == NULL) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
898753f240c0SMatthias Ringwald     // set tasks and start
898853f240c0SMatthias Ringwald     advertising_set->periodic_include_adi = include_adi;
898953f240c0SMatthias Ringwald     advertising_set->state |= LE_ADVERTISEMENT_STATE_PERIODIC_ENABLED;
899053f240c0SMatthias Ringwald     hci_run();
899153f240c0SMatthias Ringwald     return ERROR_CODE_SUCCESS;
899253f240c0SMatthias Ringwald }
899353f240c0SMatthias Ringwald 
899453f240c0SMatthias Ringwald uint8_t gap_periodic_advertising_stop(uint8_t advertising_handle){
899553f240c0SMatthias Ringwald     le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(advertising_handle);
899653f240c0SMatthias Ringwald     if (advertising_set == NULL) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
899753f240c0SMatthias Ringwald     // set tasks and start
899853f240c0SMatthias Ringwald     advertising_set->state &= ~LE_ADVERTISEMENT_STATE_PERIODIC_ENABLED;
899953f240c0SMatthias Ringwald     hci_run();
900053f240c0SMatthias Ringwald     return ERROR_CODE_SUCCESS;
900153f240c0SMatthias Ringwald }
900298aa715fSMatthias Ringwald 
90034718c38dSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
900498aa715fSMatthias 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){
900598aa715fSMatthias Ringwald     hci_stack->le_past_mode = mode;
900698aa715fSMatthias Ringwald     hci_stack->le_past_skip = skip;
900798aa715fSMatthias Ringwald     hci_stack->le_past_sync_timeout = sync_timeout;
900898aa715fSMatthias Ringwald     hci_stack->le_past_cte_type = cte_type;
900998aa715fSMatthias Ringwald     hci_stack->le_past_set_default_params = true;
901098aa715fSMatthias Ringwald     hci_run();
901198aa715fSMatthias Ringwald     return ERROR_CODE_SUCCESS;
901298aa715fSMatthias Ringwald }
901398aa715fSMatthias Ringwald 
90143bd96807SMatthias 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){
90153bd96807SMatthias Ringwald     hci_connection_t * hci_connection = hci_connection_for_handle(con_handle);
90163bd96807SMatthias Ringwald     if (hci_connection == NULL){
90173bd96807SMatthias Ringwald         return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
90183bd96807SMatthias Ringwald     }
90193bd96807SMatthias Ringwald     hci_connection->le_past_sync_handle = sync_handle;
90203bd96807SMatthias Ringwald     hci_connection->le_past_service_data = service_data;
90213bd96807SMatthias Ringwald     hci_run();
90223bd96807SMatthias Ringwald     return ERROR_CODE_SUCCESS;
90233bd96807SMatthias Ringwald }
90244718c38dSMatthias Ringwald #endif
90253bd96807SMatthias Ringwald 
9026027f4677SMatthias Ringwald uint8_t gap_periodic_advertising_set_info_transfer_send(hci_con_handle_t con_handle, uint16_t service_data, uint8_t advertising_handle){
9027027f4677SMatthias Ringwald     hci_connection_t * hci_connection = hci_connection_for_handle(con_handle);
9028027f4677SMatthias Ringwald     if (hci_connection == NULL){
9029027f4677SMatthias Ringwald         return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
9030027f4677SMatthias Ringwald     }
9031027f4677SMatthias Ringwald     hci_connection->le_past_advertising_handle = advertising_handle;
9032027f4677SMatthias Ringwald     hci_connection->le_past_service_data = service_data;
9033027f4677SMatthias Ringwald     hci_run();
9034027f4677SMatthias Ringwald     return ERROR_CODE_SUCCESS;
9035027f4677SMatthias Ringwald }
9036027f4677SMatthias Ringwald 
9037c814a904SMatthias Ringwald #endif /* ENABLE_LE_PERIODIC_ADVERTISING */
903853f240c0SMatthias Ringwald 
9039a5770ecbSMatthias Ringwald #endif
9040a5770ecbSMatthias Ringwald 
904135454696SMatthias Ringwald #endif
904206e5cf96SMatthias Ringwald 
904306e5cf96SMatthias Ringwald void hci_le_set_own_address_type(uint8_t own_address_type){
904406e5cf96SMatthias Ringwald     log_info("hci_le_set_own_address_type: old %u, new %u", hci_stack->le_own_addr_type, own_address_type);
904506e5cf96SMatthias Ringwald     if (own_address_type == hci_stack->le_own_addr_type) return;
904606e5cf96SMatthias Ringwald     hci_stack->le_own_addr_type = own_address_type;
904706e5cf96SMatthias Ringwald 
904864068776SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
904906e5cf96SMatthias Ringwald     // update advertisement parameters, too
905006e5cf96SMatthias Ringwald     hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_SET_PARAMS;
9051bbc366e6SMatthias Ringwald     hci_run();
905264068776SMatthias Ringwald #endif
905364068776SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
905406e5cf96SMatthias Ringwald     // note: we don't update scan parameters or modify ongoing connection attempts
905564068776SMatthias Ringwald #endif
905606e5cf96SMatthias Ringwald }
905706e5cf96SMatthias Ringwald 
90589136bde8SMatthias Ringwald void hci_le_random_address_set(const bd_addr_t random_address){
9059137a570aSMatthias Ringwald     log_info("gap_privacy: hci_le_random_address_set %s", bd_addr_to_str(random_address));
90609136bde8SMatthias Ringwald     memcpy(hci_stack->le_random_address, random_address, 6);
90619136bde8SMatthias Ringwald     hci_stack->le_random_address_set = true;
9062137a570aSMatthias Ringwald     hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_SET_ADDRESS | LE_ADVERTISEMENT_TASKS_PRIVACY_NOTIFY;
90639ce6dfa1SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
906422f987e4SMatthias Ringwald     if (hci_le_extended_advertising_supported()){
90655e05c0afSMatthias Ringwald         hci_assert_advertisement_set_0_ready();
90669ce6dfa1SMatthias Ringwald         hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_SET_ADDRESS_SET_0;
90679ce6dfa1SMatthias Ringwald     }
90689ce6dfa1SMatthias Ringwald #endif
90699136bde8SMatthias Ringwald     hci_run();
90709136bde8SMatthias Ringwald }
90719136bde8SMatthias Ringwald 
9072d70217a2SMatthias Ringwald #endif
907345c102fdSMatthias Ringwald 
9074616edd56SMatthias Ringwald uint8_t gap_disconnect(hci_con_handle_t handle){
90755917a5c5S[email protected]     hci_connection_t * conn = hci_connection_for_handle(handle);
90765917a5c5S[email protected]     if (!conn){
90777851196eSmatthias.ringwald         hci_emit_disconnection_complete(handle, 0);
9078616edd56SMatthias Ringwald         return 0;
90795917a5c5S[email protected]     }
908061972f0aSMatthias Ringwald     uint8_t status = ERROR_CODE_SUCCESS;
908161972f0aSMatthias Ringwald     switch (conn->state){
908261972f0aSMatthias Ringwald         case RECEIVED_DISCONNECTION_COMPLETE:
908361972f0aSMatthias Ringwald             // ignore if remote just disconnected
908461972f0aSMatthias Ringwald             break;
908561972f0aSMatthias Ringwald         case SEND_DISCONNECT:
908661972f0aSMatthias Ringwald         case SENT_DISCONNECT:
908761972f0aSMatthias Ringwald             // disconnect already requested or sent
908861972f0aSMatthias Ringwald             status = ERROR_CODE_COMMAND_DISALLOWED;
908961972f0aSMatthias Ringwald             break;
909061972f0aSMatthias Ringwald         default:
909161972f0aSMatthias Ringwald             // trigger hci_disconnect
90925917a5c5S[email protected]             conn->state = SEND_DISCONNECT;
90935917a5c5S[email protected]             hci_run();
909461972f0aSMatthias Ringwald             break;
909561972f0aSMatthias Ringwald     }
909661972f0aSMatthias Ringwald     return status;
90974f3229d8S[email protected] }
909804a6ef8cSmatthias.ringwald 
9099228e430cSMatthias Ringwald int gap_read_rssi(hci_con_handle_t con_handle){
9100228e430cSMatthias Ringwald     hci_connection_t * hci_connection = hci_connection_for_handle(con_handle);
9101228e430cSMatthias Ringwald     if (hci_connection == NULL) return 0;
910222df2fe2SMatthias Ringwald     hci_connection->gap_connection_tasks |= GAP_CONNECTION_TASK_READ_RSSI;
9103228e430cSMatthias Ringwald     hci_run();
9104228e430cSMatthias Ringwald     return 1;
9105228e430cSMatthias Ringwald }
9106228e430cSMatthias Ringwald 
9107a1bf5ae7SMatthias Ringwald /**
9108a1bf5ae7SMatthias Ringwald  * @brief Get connection type
9109a1bf5ae7SMatthias Ringwald  * @param con_handle
9110a1bf5ae7SMatthias Ringwald  * @result connection_type
9111a1bf5ae7SMatthias Ringwald  */
9112a1bf5ae7SMatthias Ringwald gap_connection_type_t gap_get_connection_type(hci_con_handle_t connection_handle){
9113a1bf5ae7SMatthias Ringwald     hci_connection_t * conn = hci_connection_for_handle(connection_handle);
9114a1bf5ae7SMatthias Ringwald     if (!conn) return GAP_CONNECTION_INVALID;
9115a1bf5ae7SMatthias Ringwald     switch (conn->address_type){
9116a1bf5ae7SMatthias Ringwald         case BD_ADDR_TYPE_LE_PUBLIC:
9117a1bf5ae7SMatthias Ringwald         case BD_ADDR_TYPE_LE_RANDOM:
9118ad9f3530SMatthias Ringwald         case BD_ADDR_TYPE_LE_PUBLIC_IDENTITY:
9119ad9f3530SMatthias Ringwald         case BD_ADDR_TYPE_LE_RANDOM_IDENTITY:
9120a1bf5ae7SMatthias Ringwald             return GAP_CONNECTION_LE;
9121a1bf5ae7SMatthias Ringwald         case BD_ADDR_TYPE_SCO:
9122a1bf5ae7SMatthias Ringwald             return GAP_CONNECTION_SCO;
9123f16129ceSMatthias Ringwald         case BD_ADDR_TYPE_ACL:
9124a1bf5ae7SMatthias Ringwald             return GAP_CONNECTION_ACL;
9125a1bf5ae7SMatthias Ringwald         default:
9126a1bf5ae7SMatthias Ringwald             return GAP_CONNECTION_INVALID;
9127a1bf5ae7SMatthias Ringwald     }
9128a1bf5ae7SMatthias Ringwald }
9129a1bf5ae7SMatthias Ringwald 
91302dceb1d6SMatthias Ringwald hci_role_t gap_get_role(hci_con_handle_t connection_handle){
91312dceb1d6SMatthias Ringwald     hci_connection_t * conn = hci_connection_for_handle(connection_handle);
91322dceb1d6SMatthias Ringwald     if (!conn) return HCI_ROLE_INVALID;
91332dceb1d6SMatthias Ringwald     return (hci_role_t) conn->role;
91342dceb1d6SMatthias Ringwald }
91352dceb1d6SMatthias Ringwald 
91362dceb1d6SMatthias Ringwald 
913744f858f3SMatthias Ringwald #ifdef ENABLE_CLASSIC
9138667ba9d1SMatthias Ringwald uint8_t gap_request_role(const bd_addr_t addr, hci_role_t role){
913988a03c8dSMatthias Ringwald     hci_connection_t * conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL);
914088a03c8dSMatthias Ringwald     if (!conn) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
914188a03c8dSMatthias Ringwald     conn->request_role = role;
914288a03c8dSMatthias Ringwald     hci_run();
9143d04a455eSMatthias Ringwald     return ERROR_CODE_SUCCESS;
914488a03c8dSMatthias Ringwald }
914544f858f3SMatthias Ringwald #endif
914688a03c8dSMatthias Ringwald 
9147a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE
91484f551432SMatthias Ringwald 
91499d8be771SMatthias 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){
9150b45b7749SMilanka Ringwald     hci_connection_t * conn = hci_connection_for_handle(con_handle);
9151b90f6e0aSMatthias Ringwald     if (!conn) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
9152b90f6e0aSMatthias Ringwald 
9153b90f6e0aSMatthias Ringwald     conn->le_phy_update_all_phys    = all_phys;
9154b90f6e0aSMatthias Ringwald     conn->le_phy_update_tx_phys     = tx_phys;
9155b90f6e0aSMatthias Ringwald     conn->le_phy_update_rx_phys     = rx_phys;
91569d8be771SMatthias Ringwald     conn->le_phy_update_phy_options = (uint8_t) phy_options;
9157b90f6e0aSMatthias Ringwald 
9158b90f6e0aSMatthias Ringwald     hci_run();
9159b90f6e0aSMatthias Ringwald 
9160b90f6e0aSMatthias Ringwald     return 0;
9161b90f6e0aSMatthias Ringwald }
9162b90f6e0aSMatthias Ringwald 
9163667ba9d1SMatthias Ringwald static uint8_t hci_whitelist_add(bd_addr_type_t address_type, const bd_addr_t address){
9164100da355SMatthias Ringwald 
9165100da355SMatthias Ringwald #if !defined(HAVE_MALLOC) && (!defined(MAX_NR_WHITELIST_ENTRIES) || (MAX_NR_WHITELIST_ENTRIES == 0))
9166100da355SMatthias Ringwald     // incorrect configuration:
9167100da355SMatthias Ringwald     // - as MAX_NR_WHITELIST_ENTRIES is not defined or zero this function always fails
9168100da355SMatthias Ringwald     // - please set MAX_NR_WHITELIST_ENTRIES in btstack_config.h
9169100da355SMatthias Ringwald     btstack_assert(false);
9170100da355SMatthias Ringwald #endif
9171100da355SMatthias Ringwald 
91727a92a9dbSMatthias Ringwald     // check if already in list
91737a92a9dbSMatthias Ringwald     btstack_linked_list_iterator_t it;
91747a92a9dbSMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->le_whitelist);
91757a92a9dbSMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)) {
91767a92a9dbSMatthias Ringwald         whitelist_entry_t *entry = (whitelist_entry_t *) btstack_linked_list_iterator_next(&it);
91777a92a9dbSMatthias Ringwald         if (entry->address_type != address_type) {
91787a92a9dbSMatthias Ringwald             continue;
91797a92a9dbSMatthias Ringwald         }
91807a92a9dbSMatthias Ringwald         if (memcmp(entry->address, address, 6) != 0) {
91817a92a9dbSMatthias Ringwald             continue;
91827a92a9dbSMatthias Ringwald         }
9183caaf5151SMilanka Ringwald 
9184caaf5151SMilanka Ringwald         // if already on controller:
9185caaf5151SMilanka Ringwald         if ((entry->state & LE_WHITELIST_ON_CONTROLLER) != 0){
9186caaf5151SMilanka Ringwald             if ((entry->state & LE_WHITELIST_REMOVE_FROM_CONTROLLER) != 0){
9187caaf5151SMilanka Ringwald                 // drop remove request
9188caaf5151SMilanka Ringwald                 entry->state = LE_WHITELIST_ON_CONTROLLER;
9189caaf5151SMilanka Ringwald                 return ERROR_CODE_SUCCESS;
9190caaf5151SMilanka Ringwald             } else {
9191caaf5151SMilanka Ringwald                 // disallow as already on controller
91927a92a9dbSMatthias Ringwald                 return ERROR_CODE_COMMAND_DISALLOWED;
91937a92a9dbSMatthias Ringwald             }
9194287379ccSMatthias Ringwald         }
9195caaf5151SMilanka Ringwald 
9196caaf5151SMilanka Ringwald         // assume scheduled to add
9197caaf5151SMilanka Ringwald 		return ERROR_CODE_COMMAND_DISALLOWED;
9198caaf5151SMilanka Ringwald     }
9199caaf5151SMilanka Ringwald 
92007a92a9dbSMatthias Ringwald     // alloc and add to list
9201e83201bcSMatthias Ringwald     whitelist_entry_t * entry = btstack_memory_whitelist_entry_get();
9202e83201bcSMatthias Ringwald     if (!entry) return BTSTACK_MEMORY_ALLOC_FAILED;
9203e83201bcSMatthias Ringwald     entry->address_type = address_type;
92046535961aSMatthias Ringwald     (void)memcpy(entry->address, address, 6);
9205e83201bcSMatthias Ringwald     entry->state = LE_WHITELIST_ADD_TO_CONTROLLER;
9206665d90f2SMatthias Ringwald     btstack_linked_list_add(&hci_stack->le_whitelist, (btstack_linked_item_t*) entry);
9207226db5efSMatthias Ringwald     return ERROR_CODE_SUCCESS;
9208ac9c45e0SMatthias Ringwald }
9209ac9c45e0SMatthias Ringwald 
9210667ba9d1SMatthias Ringwald static uint8_t hci_whitelist_remove(bd_addr_type_t address_type, const bd_addr_t address){
9211665d90f2SMatthias Ringwald     btstack_linked_list_iterator_t it;
9212665d90f2SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->le_whitelist);
9213665d90f2SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
9214665d90f2SMatthias Ringwald         whitelist_entry_t * entry = (whitelist_entry_t*) btstack_linked_list_iterator_next(&it);
92157a92a9dbSMatthias Ringwald         if (entry->address_type != address_type) {
92167a92a9dbSMatthias Ringwald             continue;
92177a92a9dbSMatthias Ringwald         }
92187a92a9dbSMatthias Ringwald         if (memcmp(entry->address, address, 6) != 0) {
92197a92a9dbSMatthias Ringwald             continue;
92207a92a9dbSMatthias Ringwald         }
9221e83201bcSMatthias Ringwald         if (entry->state & LE_WHITELIST_ON_CONTROLLER){
9222e83201bcSMatthias Ringwald             // remove from controller if already present
9223e83201bcSMatthias Ringwald             entry->state |= LE_WHITELIST_REMOVE_FROM_CONTROLLER;
9224a3b69fdeSMatthias Ringwald         }  else {
9225226db5efSMatthias Ringwald             // directly remove entry from whitelist
9226665d90f2SMatthias Ringwald             btstack_linked_list_iterator_remove(&it);
9227e83201bcSMatthias Ringwald             btstack_memory_whitelist_entry_free(entry);
9228e83201bcSMatthias Ringwald         }
9229a3b69fdeSMatthias Ringwald         return ERROR_CODE_SUCCESS;
9230a3b69fdeSMatthias Ringwald     }
9231a3b69fdeSMatthias Ringwald     return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
923242ff5ba1SMatthias Ringwald }
923342ff5ba1SMatthias Ringwald 
9234226db5efSMatthias Ringwald static void hci_whitelist_clear(void){
9235665d90f2SMatthias Ringwald     btstack_linked_list_iterator_t it;
9236665d90f2SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->le_whitelist);
9237665d90f2SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
9238665d90f2SMatthias Ringwald         whitelist_entry_t * entry = (whitelist_entry_t*) btstack_linked_list_iterator_next(&it);
9239e83201bcSMatthias Ringwald         if (entry->state & LE_WHITELIST_ON_CONTROLLER){
9240e83201bcSMatthias Ringwald             // remove from controller if already present
9241e83201bcSMatthias Ringwald             entry->state |= LE_WHITELIST_REMOVE_FROM_CONTROLLER;
9242e83201bcSMatthias Ringwald             continue;
9243e83201bcSMatthias Ringwald         }
924491915b0bSMatthias Ringwald         // directly remove entry from whitelist
9245665d90f2SMatthias Ringwald         btstack_linked_list_iterator_remove(&it);
9246e83201bcSMatthias Ringwald         btstack_memory_whitelist_entry_free(entry);
9247e83201bcSMatthias Ringwald     }
9248226db5efSMatthias Ringwald }
9249226db5efSMatthias Ringwald 
9250a3b69fdeSMatthias Ringwald /**
9251a3b69fdeSMatthias Ringwald  * @brief Clear Whitelist
92526b65794dSMilanka Ringwald  * @return 0 if ok
9253a3b69fdeSMatthias Ringwald  */
9254a3b69fdeSMatthias Ringwald uint8_t gap_whitelist_clear(void){
9255a3b69fdeSMatthias Ringwald     hci_whitelist_clear();
9256a3b69fdeSMatthias Ringwald     hci_run();
9257a3b69fdeSMatthias Ringwald     return ERROR_CODE_SUCCESS;
9258a3b69fdeSMatthias Ringwald }
9259a3b69fdeSMatthias Ringwald 
9260a3b69fdeSMatthias Ringwald /**
9261a3b69fdeSMatthias Ringwald  * @brief Add Device to Whitelist
9262a3b69fdeSMatthias Ringwald  * @param address_typ
9263a3b69fdeSMatthias Ringwald  * @param address
92646b65794dSMilanka Ringwald  * @return 0 if ok
9265a3b69fdeSMatthias Ringwald  */
9266667ba9d1SMatthias Ringwald uint8_t gap_whitelist_add(bd_addr_type_t address_type, const bd_addr_t address){
9267a3b69fdeSMatthias Ringwald     uint8_t status = hci_whitelist_add(address_type, address);
9268a3b69fdeSMatthias Ringwald     if (status){
9269a3b69fdeSMatthias Ringwald         return status;
9270a3b69fdeSMatthias Ringwald     }
9271a3b69fdeSMatthias Ringwald     hci_run();
9272a3b69fdeSMatthias Ringwald     return ERROR_CODE_SUCCESS;
9273a3b69fdeSMatthias Ringwald }
9274a3b69fdeSMatthias Ringwald 
9275a3b69fdeSMatthias Ringwald /**
9276a3b69fdeSMatthias Ringwald  * @brief Remove Device from Whitelist
9277a3b69fdeSMatthias Ringwald  * @param address_typ
9278a3b69fdeSMatthias Ringwald  * @param address
92796b65794dSMilanka Ringwald  * @return 0 if ok
9280a3b69fdeSMatthias Ringwald  */
9281667ba9d1SMatthias Ringwald uint8_t gap_whitelist_remove(bd_addr_type_t address_type, const bd_addr_t address){
9282a3b69fdeSMatthias Ringwald     uint8_t status = hci_whitelist_remove(address_type, address);
9283a3b69fdeSMatthias Ringwald     if (status){
9284a3b69fdeSMatthias Ringwald         return status;
9285a3b69fdeSMatthias Ringwald     }
9286a3b69fdeSMatthias Ringwald     hci_run();
9287a3b69fdeSMatthias Ringwald     return ERROR_CODE_SUCCESS;
9288a3b69fdeSMatthias Ringwald }
9289a3b69fdeSMatthias Ringwald 
9290226db5efSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
9291226db5efSMatthias Ringwald /**
929295e257d9SMatthias Ringwald  * @brief Connect with Whitelist
929395e257d9SMatthias Ringwald  * @note Explicit whitelist management and this connect with whitelist replace deprecated gap_auto_connection_* functions
92946b65794dSMilanka Ringwald  * @return - if ok
929595e257d9SMatthias Ringwald  */
929695e257d9SMatthias Ringwald uint8_t gap_connect_with_whitelist(void){
929795e257d9SMatthias Ringwald     if (hci_stack->le_connecting_request != LE_CONNECTING_IDLE){
929895e257d9SMatthias Ringwald         return ERROR_CODE_COMMAND_DISALLOWED;
929995e257d9SMatthias Ringwald     }
930095e257d9SMatthias Ringwald     hci_stack->le_connecting_request = LE_CONNECTING_WHITELIST;
930195e257d9SMatthias Ringwald     hci_run();
930295e257d9SMatthias Ringwald     return ERROR_CODE_SUCCESS;
930395e257d9SMatthias Ringwald }
930495e257d9SMatthias Ringwald 
930595e257d9SMatthias Ringwald /**
9306226db5efSMatthias Ringwald  * @brief Auto Connection Establishment - Start Connecting to device
9307226db5efSMatthias Ringwald  * @param address_typ
9308226db5efSMatthias Ringwald  * @param address
93096b65794dSMilanka Ringwald  * @return 0 if ok
9310226db5efSMatthias Ringwald  */
9311667ba9d1SMatthias Ringwald uint8_t gap_auto_connection_start(bd_addr_type_t address_type, const bd_addr_t address){
931295e257d9SMatthias Ringwald     if (hci_stack->le_connecting_request == LE_CONNECTING_DIRECT){
9313226db5efSMatthias Ringwald         return ERROR_CODE_COMMAND_DISALLOWED;
9314226db5efSMatthias Ringwald     }
9315226db5efSMatthias Ringwald 
9316226db5efSMatthias Ringwald     uint8_t status = hci_whitelist_add(address_type, address);
931763f2efc9SMatthias Ringwald     if (status == BTSTACK_MEMORY_ALLOC_FAILED) {
9318226db5efSMatthias Ringwald         return status;
9319226db5efSMatthias Ringwald     }
9320226db5efSMatthias Ringwald 
9321226db5efSMatthias Ringwald     hci_stack->le_connecting_request = LE_CONNECTING_WHITELIST;
9322226db5efSMatthias Ringwald 
9323226db5efSMatthias Ringwald     hci_run();
932495e257d9SMatthias Ringwald     return ERROR_CODE_SUCCESS;
9325226db5efSMatthias Ringwald }
9326226db5efSMatthias Ringwald 
9327226db5efSMatthias Ringwald /**
9328226db5efSMatthias Ringwald  * @brief Auto Connection Establishment - Stop Connecting to device
9329226db5efSMatthias Ringwald  * @param address_typ
9330226db5efSMatthias Ringwald  * @param address
93316b65794dSMilanka Ringwald  * @return 0 if ok
9332226db5efSMatthias Ringwald  */
9333667ba9d1SMatthias Ringwald uint8_t gap_auto_connection_stop(bd_addr_type_t address_type, const bd_addr_t address){
933495e257d9SMatthias Ringwald     if (hci_stack->le_connecting_request == LE_CONNECTING_DIRECT){
933595e257d9SMatthias Ringwald         return ERROR_CODE_COMMAND_DISALLOWED;
933695e257d9SMatthias Ringwald     }
933795e257d9SMatthias Ringwald 
9338226db5efSMatthias Ringwald     hci_whitelist_remove(address_type, address);
933995e257d9SMatthias Ringwald     if (btstack_linked_list_empty(&hci_stack->le_whitelist)){
934095e257d9SMatthias Ringwald         hci_stack->le_connecting_request = LE_CONNECTING_IDLE;
934195e257d9SMatthias Ringwald     }
9342226db5efSMatthias Ringwald     hci_run();
9343226db5efSMatthias Ringwald     return 0;
9344226db5efSMatthias Ringwald }
9345226db5efSMatthias Ringwald 
9346226db5efSMatthias Ringwald /**
9347226db5efSMatthias Ringwald  * @brief Auto Connection Establishment - Stop everything
9348226db5efSMatthias Ringwald  * @note  Convenience function to stop all active auto connection attempts
9349226db5efSMatthias Ringwald  */
935095e257d9SMatthias Ringwald uint8_t gap_auto_connection_stop_all(void){
935195e257d9SMatthias Ringwald     if (hci_stack->le_connecting_request == LE_CONNECTING_DIRECT) {
935295e257d9SMatthias Ringwald         return ERROR_CODE_COMMAND_DISALLOWED;
935395e257d9SMatthias Ringwald     }
9354226db5efSMatthias Ringwald     hci_whitelist_clear();
9355226db5efSMatthias Ringwald     hci_stack->le_connecting_request = LE_CONNECTING_IDLE;
9356e83201bcSMatthias Ringwald     hci_run();
935795e257d9SMatthias Ringwald     return ERROR_CODE_SUCCESS;
9358ac9c45e0SMatthias Ringwald }
9359c9db5c21SMilanka Ringwald 
9360b45b7749SMilanka Ringwald uint16_t gap_le_connection_interval(hci_con_handle_t con_handle){
9361b45b7749SMilanka Ringwald     hci_connection_t * conn = hci_connection_for_handle(con_handle);
9362c9db5c21SMilanka Ringwald     if (!conn) return 0;
9363c9db5c21SMilanka Ringwald     return conn->le_connection_interval;
9364c9db5c21SMilanka Ringwald }
9365d70217a2SMatthias Ringwald #endif
93664f551432SMatthias Ringwald #endif
93674f551432SMatthias Ringwald 
936835454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
9369ac9c45e0SMatthias Ringwald /**
9370ff00ed1cSMatthias Ringwald  * @brief Set Extended Inquiry Response data
9371a8c4e5adSMatthias Ringwald  * @param eir_data size HCI_EXTENDED_INQUIRY_RESPONSE_DATA_LEN (240) bytes, is not copied make sure memory is accessible during stack startup
9372ff00ed1cSMatthias Ringwald  * @note has to be done before stack starts up
9373ff00ed1cSMatthias Ringwald  */
9374ff00ed1cSMatthias Ringwald void gap_set_extended_inquiry_response(const uint8_t * data){
9375ff00ed1cSMatthias Ringwald     hci_stack->eir_data = data;
9376baa4881eSMatthias Ringwald     hci_stack->gap_tasks_classic |= GAP_TASK_SET_EIR_DATA;
937759d59ecfSMatthias Ringwald     hci_run();
9378ff00ed1cSMatthias Ringwald }
9379ff00ed1cSMatthias Ringwald 
9380ff00ed1cSMatthias Ringwald /**
9381f5875de5SMatthias Ringwald  * @brief Start GAP Classic Inquiry
9382f5875de5SMatthias Ringwald  * @param duration in 1.28s units
9383f5875de5SMatthias Ringwald  * @return 0 if ok
9384f5875de5SMatthias Ringwald  * @events: GAP_EVENT_INQUIRY_RESULT, GAP_EVENT_INQUIRY_COMPLETE
9385f5875de5SMatthias Ringwald  */
9386f5875de5SMatthias Ringwald int gap_inquiry_start(uint8_t duration_in_1280ms_units){
938799449554SMatthias Ringwald     if (hci_stack->state != HCI_STATE_WORKING) return ERROR_CODE_COMMAND_DISALLOWED;
9388f5875de5SMatthias Ringwald     if (hci_stack->inquiry_state != GAP_INQUIRY_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED;
9389a1df452eSMatthias Ringwald     if ((duration_in_1280ms_units < GAP_INQUIRY_DURATION_MIN) || (duration_in_1280ms_units > GAP_INQUIRY_DURATION_MAX)){
9390f5875de5SMatthias Ringwald         return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS;
9391f5875de5SMatthias Ringwald     }
9392f5875de5SMatthias Ringwald     hci_stack->inquiry_state = duration_in_1280ms_units;
939330199e24SMatthias Ringwald     hci_stack->inquiry_max_period_length = 0;
939430199e24SMatthias Ringwald     hci_stack->inquiry_min_period_length = 0;
939530199e24SMatthias Ringwald     hci_run();
939630199e24SMatthias Ringwald     return 0;
939730199e24SMatthias Ringwald }
939830199e24SMatthias Ringwald 
939930199e24SMatthias Ringwald uint8_t gap_inquiry_periodic_start(uint8_t duration, uint16_t max_period_length, uint16_t min_period_length){
940030199e24SMatthias Ringwald     if (hci_stack->state != HCI_STATE_WORKING)                return ERROR_CODE_COMMAND_DISALLOWED;
940130199e24SMatthias Ringwald     if (hci_stack->inquiry_state != GAP_INQUIRY_STATE_IDLE)   return ERROR_CODE_COMMAND_DISALLOWED;
940230199e24SMatthias Ringwald     if (duration < GAP_INQUIRY_DURATION_MIN)                  return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS;
940330199e24SMatthias Ringwald     if (duration > GAP_INQUIRY_DURATION_MAX)                  return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS;
940430199e24SMatthias Ringwald     if (max_period_length < GAP_INQUIRY_MAX_PERIODIC_LEN_MIN) return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS;;
940530199e24SMatthias Ringwald     if (min_period_length < GAP_INQUIRY_MIN_PERIODIC_LEN_MIN) return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS;;
940630199e24SMatthias Ringwald 
940730199e24SMatthias Ringwald     hci_stack->inquiry_state = duration;
940830199e24SMatthias Ringwald     hci_stack->inquiry_max_period_length = max_period_length;
940930199e24SMatthias Ringwald     hci_stack->inquiry_min_period_length = min_period_length;
9410f5875de5SMatthias Ringwald     hci_run();
9411f5875de5SMatthias Ringwald     return 0;
9412f5875de5SMatthias Ringwald }
9413f5875de5SMatthias Ringwald 
9414f5875de5SMatthias Ringwald /**
9415f5875de5SMatthias Ringwald  * @brief Stop GAP Classic Inquiry
94166b65794dSMilanka Ringwald  * @return 0 if ok
9417f5875de5SMatthias Ringwald  */
9418f5875de5SMatthias Ringwald int gap_inquiry_stop(void){
9419a1df452eSMatthias Ringwald     if ((hci_stack->inquiry_state >= GAP_INQUIRY_DURATION_MIN) && (hci_stack->inquiry_state <= GAP_INQUIRY_DURATION_MAX)) {
9420f5875de5SMatthias Ringwald         // emit inquiry complete event, before it even started
9421f5875de5SMatthias Ringwald         uint8_t event[] = { GAP_EVENT_INQUIRY_COMPLETE, 1, 0};
94229da9850bSMatthias Ringwald         hci_emit_btstack_event(event, sizeof(event), 1);
9423f5875de5SMatthias Ringwald         return 0;
9424f5875de5SMatthias Ringwald     }
942530199e24SMatthias Ringwald     switch (hci_stack->inquiry_state){
942630199e24SMatthias Ringwald         case GAP_INQUIRY_STATE_ACTIVE:
9427f5875de5SMatthias Ringwald             hci_stack->inquiry_state = GAP_INQUIRY_STATE_W2_CANCEL;
9428f5875de5SMatthias Ringwald             hci_run();
942930199e24SMatthias Ringwald             return ERROR_CODE_SUCCESS;
943030199e24SMatthias Ringwald         case GAP_INQUIRY_STATE_PERIODIC:
943130199e24SMatthias Ringwald             hci_stack->inquiry_state = GAP_INQUIRY_STATE_W2_EXIT_PERIODIC;
943230199e24SMatthias Ringwald             hci_run();
943330199e24SMatthias Ringwald             return ERROR_CODE_SUCCESS;
943430199e24SMatthias Ringwald         default:
943530199e24SMatthias Ringwald             return ERROR_CODE_COMMAND_DISALLOWED;
943630199e24SMatthias Ringwald     }
9437f5875de5SMatthias Ringwald }
9438f5875de5SMatthias Ringwald 
9439496bb884SMatthias Ringwald void gap_inquiry_set_lap(uint32_t lap){
9440496bb884SMatthias Ringwald     hci_stack->inquiry_lap = lap;
9441496bb884SMatthias Ringwald }
9442496bb884SMatthias Ringwald 
94431dc973e7SMatthias Ringwald void gap_inquiry_set_scan_activity(uint16_t inquiry_scan_interval, uint16_t inquiry_scan_window){
9444c0c8a829SMatthias Ringwald     hci_stack->inquiry_scan_interval = inquiry_scan_interval;
9445c0c8a829SMatthias Ringwald     hci_stack->inquiry_scan_window   = inquiry_scan_window;
9446baa4881eSMatthias Ringwald     hci_stack->gap_tasks_classic |= GAP_TASK_WRITE_INQUIRY_SCAN_ACTIVITY;
9447c0c8a829SMatthias Ringwald     hci_run();
9448c0c8a829SMatthias Ringwald }
9449c0c8a829SMatthias Ringwald 
9450f50ed5acSAndrey Fominykh void gap_inquiry_set_transmit_power_level(int8_t tx_power)
9451f50ed5acSAndrey Fominykh {
9452f50ed5acSAndrey Fominykh     hci_stack->inquiry_tx_power_level = tx_power;
9453f50ed5acSAndrey Fominykh     hci_stack->gap_tasks_classic |= GAP_TASK_WRITE_INQUIRY_TX_POWER_LEVEL;
9454f50ed5acSAndrey Fominykh     hci_run();
9455f50ed5acSAndrey Fominykh }
9456f50ed5acSAndrey Fominykh 
9457b7f1ee76SMatthias Ringwald 
9458b7f1ee76SMatthias Ringwald /**
9459b7f1ee76SMatthias Ringwald  * @brief Remote Name Request
9460b7f1ee76SMatthias Ringwald  * @param addr
9461b7f1ee76SMatthias Ringwald  * @param page_scan_repetition_mode
9462b7f1ee76SMatthias Ringwald  * @param clock_offset only used when bit 15 is set
9463b7f1ee76SMatthias Ringwald  * @events: HCI_EVENT_REMOTE_NAME_REQUEST_COMPLETE
9464b7f1ee76SMatthias Ringwald  */
9465667ba9d1SMatthias Ringwald int gap_remote_name_request(const bd_addr_t addr, uint8_t page_scan_repetition_mode, uint16_t clock_offset){
9466b7f1ee76SMatthias Ringwald     if (hci_stack->remote_name_state != GAP_REMOTE_NAME_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED;
94676535961aSMatthias Ringwald     (void)memcpy(hci_stack->remote_name_addr, addr, 6);
9468b7f1ee76SMatthias Ringwald     hci_stack->remote_name_page_scan_repetition_mode = page_scan_repetition_mode;
9469b7f1ee76SMatthias Ringwald     hci_stack->remote_name_clock_offset = clock_offset;
9470b7f1ee76SMatthias Ringwald     hci_stack->remote_name_state = GAP_REMOTE_NAME_STATE_W2_SEND;
9471b7f1ee76SMatthias Ringwald     hci_run();
9472b7f1ee76SMatthias Ringwald     return 0;
9473b7f1ee76SMatthias Ringwald }
9474b7f1ee76SMatthias Ringwald 
9475667ba9d1SMatthias Ringwald static int gap_pairing_set_state_and_run(const bd_addr_t addr, uint8_t state){
94760a51f88bSMatthias Ringwald     hci_stack->gap_pairing_state = state;
94776535961aSMatthias Ringwald     (void)memcpy(hci_stack->gap_pairing_addr, addr, 6);
94780a51f88bSMatthias Ringwald     hci_run();
94790a51f88bSMatthias Ringwald     return 0;
94800a51f88bSMatthias Ringwald }
94810a51f88bSMatthias Ringwald 
94820a51f88bSMatthias Ringwald /**
9483aad97216SMatthias Ringwald  * @brief Legacy Pairing Pin Code Response for binary data / non-strings
9484aad97216SMatthias Ringwald  * @param addr
9485aad97216SMatthias Ringwald  * @param pin_data
9486aad97216SMatthias Ringwald  * @param pin_len
9487aad97216SMatthias Ringwald  * @return 0 if ok
9488aad97216SMatthias Ringwald  */
9489667ba9d1SMatthias Ringwald int gap_pin_code_response_binary(const bd_addr_t addr, const uint8_t * pin_data, uint8_t pin_len){
9490aad97216SMatthias Ringwald     if (hci_stack->gap_pairing_state != GAP_PAIRING_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED;
9491c26f2c7bSMatthias Ringwald     if (pin_len > PIN_CODE_LEN) return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS;
9492aad97216SMatthias Ringwald     hci_stack->gap_pairing_input.gap_pairing_pin = pin_data;
9493aad97216SMatthias Ringwald     hci_stack->gap_pairing_pin_len = pin_len;
9494aad97216SMatthias Ringwald     return gap_pairing_set_state_and_run(addr, GAP_PAIRING_STATE_SEND_PIN);
9495aad97216SMatthias Ringwald }
9496aad97216SMatthias Ringwald 
9497aad97216SMatthias Ringwald /**
94980a51f88bSMatthias Ringwald  * @brief Legacy Pairing Pin Code Response
94990a51f88bSMatthias Ringwald  * @param addr
95000a51f88bSMatthias Ringwald  * @param pin
95010a51f88bSMatthias Ringwald  * @return 0 if ok
95020a51f88bSMatthias Ringwald  */
9503667ba9d1SMatthias Ringwald int gap_pin_code_response(const bd_addr_t addr, const char * pin){
95049d78a7ecSMatthias Ringwald     return gap_pin_code_response_binary(addr, (const uint8_t*) pin, (uint8_t) strlen(pin));
95050a51f88bSMatthias Ringwald }
95060a51f88bSMatthias Ringwald 
95070a51f88bSMatthias Ringwald /**
95080a51f88bSMatthias Ringwald  * @brief Abort Legacy Pairing
95090a51f88bSMatthias Ringwald  * @param addr
95100a51f88bSMatthias Ringwald  * @param pin
95110a51f88bSMatthias Ringwald  * @return 0 if ok
95120a51f88bSMatthias Ringwald  */
95130a51f88bSMatthias Ringwald int gap_pin_code_negative(bd_addr_t addr){
9514cd74063aSMatthias Ringwald     if (hci_stack->gap_pairing_state != GAP_PAIRING_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED;
95150a51f88bSMatthias Ringwald     return gap_pairing_set_state_and_run(addr, GAP_PAIRING_STATE_SEND_PIN_NEGATIVE);
95160a51f88bSMatthias Ringwald }
95170a51f88bSMatthias Ringwald 
95180a51f88bSMatthias Ringwald /**
95190a51f88bSMatthias Ringwald  * @brief SSP Passkey Response
95200a51f88bSMatthias Ringwald  * @param addr
95210a51f88bSMatthias Ringwald  * @param passkey
95220a51f88bSMatthias Ringwald  * @return 0 if ok
95230a51f88bSMatthias Ringwald  */
9524667ba9d1SMatthias Ringwald int gap_ssp_passkey_response(const bd_addr_t addr, uint32_t passkey){
9525cd74063aSMatthias Ringwald     if (hci_stack->gap_pairing_state != GAP_PAIRING_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED;
9526d504181aSMatthias Ringwald     hci_stack->gap_pairing_input.gap_pairing_passkey = passkey;
95270a51f88bSMatthias Ringwald     return gap_pairing_set_state_and_run(addr, GAP_PAIRING_STATE_SEND_PASSKEY);
95280a51f88bSMatthias Ringwald }
95290a51f88bSMatthias Ringwald 
95300a51f88bSMatthias Ringwald /**
95310a51f88bSMatthias Ringwald  * @brief Abort SSP Passkey Entry/Pairing
95320a51f88bSMatthias Ringwald  * @param addr
95330a51f88bSMatthias Ringwald  * @param pin
95340a51f88bSMatthias Ringwald  * @return 0 if ok
95350a51f88bSMatthias Ringwald  */
9536667ba9d1SMatthias Ringwald int gap_ssp_passkey_negative(const bd_addr_t addr){
9537cd74063aSMatthias Ringwald     if (hci_stack->gap_pairing_state != GAP_PAIRING_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED;
95380a51f88bSMatthias Ringwald     return gap_pairing_set_state_and_run(addr, GAP_PAIRING_STATE_SEND_PASSKEY_NEGATIVE);
95390a51f88bSMatthias Ringwald }
95400a51f88bSMatthias Ringwald 
95410a51f88bSMatthias Ringwald /**
95420a51f88bSMatthias Ringwald  * @brief Accept SSP Numeric Comparison
95430a51f88bSMatthias Ringwald  * @param addr
95440a51f88bSMatthias Ringwald  * @param passkey
95450a51f88bSMatthias Ringwald  * @return 0 if ok
95460a51f88bSMatthias Ringwald  */
9547667ba9d1SMatthias Ringwald int gap_ssp_confirmation_response(const bd_addr_t addr){
9548cd74063aSMatthias Ringwald     if (hci_stack->gap_pairing_state != GAP_PAIRING_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED;
95490a51f88bSMatthias Ringwald     return gap_pairing_set_state_and_run(addr, GAP_PAIRING_STATE_SEND_CONFIRMATION);
95500a51f88bSMatthias Ringwald }
95510a51f88bSMatthias Ringwald 
95520a51f88bSMatthias Ringwald /**
95530a51f88bSMatthias Ringwald  * @brief Abort SSP Numeric Comparison/Pairing
95540a51f88bSMatthias Ringwald  * @param addr
95550a51f88bSMatthias Ringwald  * @param pin
95560a51f88bSMatthias Ringwald  * @return 0 if ok
95570a51f88bSMatthias Ringwald  */
9558667ba9d1SMatthias Ringwald int gap_ssp_confirmation_negative(const bd_addr_t addr){
9559cd74063aSMatthias Ringwald     if (hci_stack->gap_pairing_state != GAP_PAIRING_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED;
95600a51f88bSMatthias Ringwald     return gap_pairing_set_state_and_run(addr, GAP_PAIRING_STATE_SEND_CONFIRMATION_NEGATIVE);
95610a51f88bSMatthias Ringwald }
95620a51f88bSMatthias Ringwald 
9563308eeaffSMatthias Ringwald #if defined(ENABLE_EXPLICIT_IO_CAPABILITIES_REPLY) || defined(ENABLE_EXPLICIT_LINK_KEY_REPLY)
956444565b0cSMatthias Ringwald static uint8_t gap_set_auth_flag_and_run(const bd_addr_t addr, hci_authentication_flags_t flag){
956544565b0cSMatthias Ringwald     hci_connection_t * conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL);
956644565b0cSMatthias Ringwald     if (!conn) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
956744565b0cSMatthias Ringwald     connectionSetAuthenticationFlags(conn, flag);
956844565b0cSMatthias Ringwald     hci_run();
956944565b0cSMatthias Ringwald     return ERROR_CODE_SUCCESS;
957044565b0cSMatthias Ringwald }
9571308eeaffSMatthias Ringwald #endif
957244565b0cSMatthias Ringwald 
9573308eeaffSMatthias Ringwald #ifdef ENABLE_EXPLICIT_IO_CAPABILITIES_REPLY
957444565b0cSMatthias Ringwald uint8_t gap_ssp_io_capabilities_response(const bd_addr_t addr){
95757ca4a7edSMatthias Ringwald     return gap_set_auth_flag_and_run(addr, AUTH_FLAG_SEND_IO_CAPABILITIES_REPLY);
957644565b0cSMatthias Ringwald }
957744565b0cSMatthias Ringwald 
957844565b0cSMatthias Ringwald uint8_t gap_ssp_io_capabilities_negative(const bd_addr_t addr){
95797ca4a7edSMatthias Ringwald     return gap_set_auth_flag_and_run(addr, AUTH_FLAG_SEND_IO_CAPABILITIES_NEGATIVE_REPLY);
958044565b0cSMatthias Ringwald }
958144565b0cSMatthias Ringwald #endif
958244565b0cSMatthias Ringwald 
95831849becdSMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB
95841849becdSMatthias Ringwald /**
95851849becdSMatthias Ringwald  * @brief Report Remote OOB Data
95861849becdSMatthias Ringwald  * @param bd_addr
95871849becdSMatthias Ringwald  * @param c_192 Simple Pairing Hash C derived from P-192 public key
95881849becdSMatthias Ringwald  * @param r_192 Simple Pairing Randomizer derived from P-192 public key
95891849becdSMatthias Ringwald  * @param c_256 Simple Pairing Hash C derived from P-256 public key
95901849becdSMatthias Ringwald  * @param r_256 Simple Pairing Randomizer derived from P-256 public key
95911849becdSMatthias Ringwald  */
95921849becdSMatthias 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){
95931849becdSMatthias Ringwald     hci_connection_t * connection = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL);
95941849becdSMatthias Ringwald     if (connection == NULL) {
95951849becdSMatthias Ringwald         return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
95961849becdSMatthias Ringwald     }
95971849becdSMatthias Ringwald     connection->classic_oob_c_192 = c_192;
95981849becdSMatthias Ringwald     connection->classic_oob_r_192 = r_192;
9599204e8f1dSMatthias Ringwald 
9600204e8f1dSMatthias Ringwald     // ignore P-256 if not supported by us
9601204e8f1dSMatthias Ringwald     if (hci_stack->secure_connections_active){
96021849becdSMatthias Ringwald         connection->classic_oob_c_256 = c_256;
96031849becdSMatthias Ringwald         connection->classic_oob_r_256 = r_256;
9604204e8f1dSMatthias Ringwald     }
9605204e8f1dSMatthias Ringwald 
96061849becdSMatthias Ringwald     return ERROR_CODE_SUCCESS;
96071849becdSMatthias Ringwald }
9608cf01e888SMatthias Ringwald /**
9609cf01e888SMatthias Ringwald  * @brief Generate new OOB data
9610cf01e888SMatthias Ringwald  * @note OOB data will be provided in GAP_EVENT_LOCAL_OOB_DATA and be used in future pairing procedures
9611cf01e888SMatthias Ringwald  */
9612cf01e888SMatthias Ringwald void gap_ssp_generate_oob_data(void){
9613cf01e888SMatthias Ringwald     hci_stack->classic_read_local_oob_data = true;
9614cf01e888SMatthias Ringwald     hci_run();
9615cf01e888SMatthias Ringwald }
9616cf01e888SMatthias Ringwald 
96171849becdSMatthias Ringwald #endif
96181849becdSMatthias Ringwald 
9619308eeaffSMatthias Ringwald #ifdef ENABLE_EXPLICIT_LINK_KEY_REPLY
9620308eeaffSMatthias Ringwald uint8_t gap_send_link_key_response(const bd_addr_t addr, link_key_t link_key, link_key_type_t type){
9621308eeaffSMatthias Ringwald     hci_connection_t * connection = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL);
9622308eeaffSMatthias Ringwald     if (connection == NULL) {
9623308eeaffSMatthias Ringwald         return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
9624308eeaffSMatthias Ringwald     }
9625308eeaffSMatthias Ringwald 
9626308eeaffSMatthias Ringwald     memcpy(connection->link_key, link_key, sizeof(link_key_t));
9627308eeaffSMatthias Ringwald     connection->link_key_type = type;
9628308eeaffSMatthias Ringwald 
9629308eeaffSMatthias Ringwald     return gap_set_auth_flag_and_run(addr, AUTH_FLAG_HANDLE_LINK_KEY_REQUEST);
9630308eeaffSMatthias Ringwald }
9631308eeaffSMatthias Ringwald 
9632308eeaffSMatthias Ringwald #endif // ENABLE_EXPLICIT_LINK_KEY_REPLY
9633f5875de5SMatthias Ringwald /**
9634f6858d14SMatthias Ringwald  * @brief Set inquiry mode: standard, with RSSI, with RSSI + Extended Inquiry Results. Has to be called before power on.
9635f5875de5SMatthias Ringwald  * @param inquiry_mode see bluetooth_defines.h
9636f6858d14SMatthias Ringwald  */
9637b45b7749SMilanka Ringwald void hci_set_inquiry_mode(inquiry_mode_t inquiry_mode){
9638b45b7749SMilanka Ringwald     hci_stack->inquiry_mode = inquiry_mode;
9639f6858d14SMatthias Ringwald }
9640f6858d14SMatthias Ringwald 
9641f6858d14SMatthias Ringwald /**
9642d950d659SMatthias Ringwald  * @brief Configure Voice Setting for use with SCO data in HSP/HFP
9643d950d659SMatthias Ringwald  */
9644d950d659SMatthias Ringwald void hci_set_sco_voice_setting(uint16_t voice_setting){
9645d950d659SMatthias Ringwald     hci_stack->sco_voice_setting = voice_setting;
9646d950d659SMatthias Ringwald }
9647d950d659SMatthias Ringwald 
9648d950d659SMatthias Ringwald /**
9649d950d659SMatthias Ringwald  * @brief Get SCO Voice Setting
9650d950d659SMatthias Ringwald  * @return current voice setting
9651d950d659SMatthias Ringwald  */
96520cb5b971SMatthias Ringwald uint16_t hci_get_sco_voice_setting(void){
9653d950d659SMatthias Ringwald     return hci_stack->sco_voice_setting;
9654d950d659SMatthias Ringwald }
9655d950d659SMatthias Ringwald 
9656400ff5abSMatthias Ringwald static int hci_have_usb_transport(void){
9657400ff5abSMatthias Ringwald     if (!hci_stack->hci_transport) return 0;
9658400ff5abSMatthias Ringwald     const char * transport_name = hci_stack->hci_transport->name;
9659400ff5abSMatthias Ringwald     if (!transport_name) return 0;
9660400ff5abSMatthias Ringwald     return (transport_name[0] == 'H') && (transport_name[1] == '2');
9661400ff5abSMatthias Ringwald }
9662400ff5abSMatthias Ringwald 
96639427aeb5SMatthias Ringwald static uint16_t hci_sco_packet_length_for_payload_length(uint16_t payload_size){
966420dcdd22SMatthias Ringwald     uint16_t sco_packet_length = 0;
9665cf119f3bSMatthias Ringwald 
966691dfed7eSMatthias Ringwald #if defined(ENABLE_SCO_OVER_HCI) || defined (HAVE_SCO_TRANSPORT)
9667a086dc35SMatthias Ringwald     // Transparent = mSBC => 1, CVSD with 16-bit samples requires twice as many bytes
966873f498e7SMatthias Ringwald     int multiplier;
966973f498e7SMatthias Ringwald     if (((hci_stack->sco_voice_setting_active & 0x03) != 0x03) &&
967073f498e7SMatthias Ringwald         ((hci_stack->sco_voice_setting_active & 0x20) == 0x20)) {
967173f498e7SMatthias Ringwald         multiplier = 2;
967273f498e7SMatthias Ringwald     } else {
967373f498e7SMatthias Ringwald         multiplier = 1;
967473f498e7SMatthias Ringwald     }
967591dfed7eSMatthias Ringwald #endif
967691dfed7eSMatthias Ringwald 
96779427aeb5SMatthias Ringwald #ifdef ENABLE_SCO_OVER_HCI
9678400ff5abSMatthias Ringwald     if (hci_have_usb_transport()){
9679400ff5abSMatthias Ringwald         // see Core Spec for H2 USB Transfer.
9680cf119f3bSMatthias Ringwald         // 3 byte SCO header + 24 bytes per connection
96819427aeb5SMatthias Ringwald         // @note multiple sco connections not supported currently
96829427aeb5SMatthias Ringwald         sco_packet_length = 3 + 24 * multiplier;
9683400ff5abSMatthias Ringwald     } else {
96849427aeb5SMatthias Ringwald         // 3 byte SCO header + SCO packet length over the air
96859427aeb5SMatthias Ringwald         sco_packet_length = 3 + payload_size * multiplier;
9686d966a453SMatthias Ringwald         // assert that it still fits inside an SCO buffer
9687ad915196SMatthias Ringwald         if (sco_packet_length > (hci_stack->sco_data_packet_length + 3)){
96889427aeb5SMatthias Ringwald             sco_packet_length = 3 + hci_stack->sco_data_packet_length;
9689d966a453SMatthias Ringwald         }
9690400ff5abSMatthias Ringwald     }
9691a3069afeSMatthias Ringwald #endif
96925b7087c7SMatthias Ringwald #ifdef HAVE_SCO_TRANSPORT
96939427aeb5SMatthias Ringwald     // 3 byte SCO header + SCO packet length over the air
96949427aeb5SMatthias Ringwald     sco_packet_length = 3 + payload_size * multiplier;
96959427aeb5SMatthias Ringwald     // assert that it still fits inside an SCO buffer
96969427aeb5SMatthias Ringwald     if (sco_packet_length > (hci_stack->sco_data_packet_length + 3)){
96979427aeb5SMatthias Ringwald         sco_packet_length = 3 + hci_stack->sco_data_packet_length;
96989427aeb5SMatthias Ringwald     }
96995b7087c7SMatthias Ringwald #endif
9700a3069afeSMatthias Ringwald     return sco_packet_length;
9701b3aad8daSMatthias Ringwald }
9702b3aad8daSMatthias Ringwald 
97039427aeb5SMatthias Ringwald uint16_t hci_get_sco_packet_length_for_connection(hci_con_handle_t sco_con_handle){
97049427aeb5SMatthias Ringwald     hci_connection_t * connection = hci_connection_for_handle(sco_con_handle);
97059427aeb5SMatthias Ringwald     if (connection != NULL){
97069427aeb5SMatthias Ringwald         return hci_sco_packet_length_for_payload_length(connection->sco_payload_length);
97079427aeb5SMatthias Ringwald     }
97089427aeb5SMatthias Ringwald     return 0;
97099427aeb5SMatthias Ringwald }
97109427aeb5SMatthias Ringwald 
97119427aeb5SMatthias Ringwald uint16_t hci_get_sco_packet_length(void){
97129427aeb5SMatthias Ringwald     btstack_linked_list_iterator_t it;
97139427aeb5SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->connections);
97149427aeb5SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
97159427aeb5SMatthias Ringwald         hci_connection_t * connection = (hci_connection_t *) btstack_linked_list_iterator_next(&it);
97169427aeb5SMatthias Ringwald         if ( connection->address_type == BD_ADDR_TYPE_SCO ) {
97179427aeb5SMatthias Ringwald             return hci_sco_packet_length_for_payload_length(connection->sco_payload_length);;
97189427aeb5SMatthias Ringwald         }
97199427aeb5SMatthias Ringwald     }
97209427aeb5SMatthias Ringwald     return 0;
97219427aeb5SMatthias Ringwald }
97229427aeb5SMatthias Ringwald 
9723c4c88f1bSJakob Krantz /**
9724c4c88f1bSJakob Krantz * @brief Sets the master/slave policy
9725c4c88f1bSJakob Krantz * @param policy (0: attempt to become master, 1: let connecting device decide)
9726c4c88f1bSJakob Krantz */
9727c4c88f1bSJakob Krantz void hci_set_master_slave_policy(uint8_t policy){
9728c4c88f1bSJakob Krantz     hci_stack->master_slave_policy = policy;
9729c4c88f1bSJakob Krantz }
9730c4c88f1bSJakob Krantz 
9731c4c88f1bSJakob Krantz #endif
9732ec111c8bSMatthias Ringwald 
9733ec111c8bSMatthias Ringwald HCI_STATE hci_get_state(void){
9734ec111c8bSMatthias Ringwald     return hci_stack->state;
9735ec111c8bSMatthias Ringwald }
9736ec111c8bSMatthias Ringwald 
973707e010b6SMilanka Ringwald #ifdef ENABLE_CLASSIC
97385e91d96cSMatthias Ringwald void gap_register_classic_connection_filter(int (*accept_callback)(bd_addr_t addr, hci_link_type_t link_type)){
973907e010b6SMilanka Ringwald     hci_stack->gap_classic_accept_callback = accept_callback;
974007e010b6SMilanka Ringwald }
974107e010b6SMilanka Ringwald #endif
9742ec111c8bSMatthias Ringwald 
9743d950d659SMatthias Ringwald /**
9744d23838ecSMatthias Ringwald  * @brief Set callback for Bluetooth Hardware Error
9745d23838ecSMatthias Ringwald  */
9746c2e1fa60SMatthias Ringwald void hci_set_hardware_error_callback(void (*fn)(uint8_t error)){
9747d23838ecSMatthias Ringwald     hci_stack->hardware_error_callback = fn;
9748d23838ecSMatthias Ringwald }
9749d23838ecSMatthias Ringwald 
975071de195eSMatthias Ringwald void hci_disconnect_all(void){
9751665d90f2SMatthias Ringwald     btstack_linked_list_iterator_t it;
9752665d90f2SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->connections);
9753665d90f2SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
9754665d90f2SMatthias Ringwald         hci_connection_t * con = (hci_connection_t*) btstack_linked_list_iterator_next(&it);
975504a6ef8cSmatthias.ringwald         if (con->state == SENT_DISCONNECT) continue;
975604a6ef8cSmatthias.ringwald         con->state = SEND_DISCONNECT;
975704a6ef8cSmatthias.ringwald     }
9758d31fba26S[email protected]     hci_run();
975904a6ef8cSmatthias.ringwald }
976033373e40SMatthias Ringwald 
976133373e40SMatthias Ringwald uint16_t hci_get_manufacturer(void){
976233373e40SMatthias Ringwald     return hci_stack->manufacturer;
976333373e40SMatthias Ringwald }
97649c6e867eSMatthias Ringwald 
97653e329ddfSandryblack #ifdef ENABLE_BLE
97669c6e867eSMatthias Ringwald static sm_connection_t * sm_get_connection_for_handle(hci_con_handle_t con_handle){
97679c6e867eSMatthias Ringwald     hci_connection_t * hci_con = hci_connection_for_handle(con_handle);
97689c6e867eSMatthias Ringwald     if (!hci_con) return NULL;
97699c6e867eSMatthias Ringwald     return &hci_con->sm_connection;
97709c6e867eSMatthias Ringwald }
97719c6e867eSMatthias Ringwald 
97729c6e867eSMatthias Ringwald // extracted from sm.c to allow enabling of l2cap le data channels without adding sm.c to the build
9773a086dc35SMatthias Ringwald // without sm.c default values from create_connection_for_bd_addr_and_type() result in non-encrypted, not-authenticated
97746a79f6baSMatthias Ringwald #endif
97759c6e867eSMatthias Ringwald 
97766d105c71SMatthias Ringwald uint8_t gap_encryption_key_size(hci_con_handle_t con_handle){
9777c5fb5ca4SMatthias Ringwald     hci_connection_t * hci_connection = hci_connection_for_handle(con_handle);
9778c5fb5ca4SMatthias Ringwald     if (hci_connection == NULL) return 0;
9779c5fb5ca4SMatthias Ringwald     if (hci_is_le_connection(hci_connection)){
97806a79f6baSMatthias Ringwald #ifdef ENABLE_BLE
9781c5fb5ca4SMatthias Ringwald         sm_connection_t * sm_conn = &hci_connection->sm_connection;
9782c7bead46SMatthias Ringwald         if (sm_conn->sm_connection_encrypted != 0u) {
97839c6e867eSMatthias Ringwald             return sm_conn->sm_actual_encryption_key_size;
97849c6e867eSMatthias Ringwald         }
97856a79f6baSMatthias Ringwald #endif
97866a79f6baSMatthias Ringwald     } else {
9787c5fb5ca4SMatthias Ringwald #ifdef ENABLE_CLASSIC
97888daf94bcSMatthias Ringwald         if ((hci_connection->authentication_flags & AUTH_FLAG_CONNECTION_ENCRYPTED)){
9789c5fb5ca4SMatthias Ringwald             return hci_connection->encryption_key_size;
9790c5fb5ca4SMatthias Ringwald         }
9791c5fb5ca4SMatthias Ringwald #endif
97926a79f6baSMatthias Ringwald     }
9793c5fb5ca4SMatthias Ringwald     return 0;
9794c5fb5ca4SMatthias Ringwald }
97959c6e867eSMatthias Ringwald 
9796ff3f1026SMatthias Ringwald bool gap_authenticated(hci_con_handle_t con_handle){
9797c5fb5ca4SMatthias Ringwald     hci_connection_t * hci_connection = hci_connection_for_handle(con_handle);
9798ff3f1026SMatthias Ringwald     if (hci_connection == NULL) return false;
97995f3981bfSMatthias Ringwald 
9800c5fb5ca4SMatthias Ringwald     switch (hci_connection->address_type){
98016a79f6baSMatthias Ringwald #ifdef ENABLE_BLE
98025f3981bfSMatthias Ringwald         case BD_ADDR_TYPE_LE_PUBLIC:
98035f3981bfSMatthias Ringwald         case BD_ADDR_TYPE_LE_RANDOM:
9804d9e1bf33SMatthias Ringwald         case BD_ADDR_TYPE_LE_PUBLIC_IDENTITY:
9805d9e1bf33SMatthias Ringwald         case BD_ADDR_TYPE_LE_RANDOM_IDENTITY:
9806c5fb5ca4SMatthias Ringwald             if (hci_connection->sm_connection.sm_connection_encrypted == 0) return 0; // unencrypted connection cannot be authenticated
9807ff3f1026SMatthias Ringwald             return hci_connection->sm_connection.sm_connection_authenticated != 0;
98086a79f6baSMatthias Ringwald #endif
980959a1a47aSMatthias Ringwald #ifdef ENABLE_CLASSIC
98105f3981bfSMatthias Ringwald         case BD_ADDR_TYPE_SCO:
9811f16129ceSMatthias Ringwald         case BD_ADDR_TYPE_ACL:
9812ff3f1026SMatthias Ringwald             return gap_authenticated_for_link_key_type(hci_connection->link_key_type);
981359a1a47aSMatthias Ringwald #endif
98145f3981bfSMatthias Ringwald         default:
9815ff3f1026SMatthias Ringwald             return false;
98165f3981bfSMatthias Ringwald     }
98179c6e867eSMatthias Ringwald }
98189c6e867eSMatthias Ringwald 
9819f461b3dfSMatthias Ringwald bool gap_secure_connection(hci_con_handle_t con_handle){
9820c5fb5ca4SMatthias Ringwald     hci_connection_t * hci_connection = hci_connection_for_handle(con_handle);
9821c5fb5ca4SMatthias Ringwald     if (hci_connection == NULL) return 0;
98228b35e16aSMatthias Ringwald 
9823c5fb5ca4SMatthias Ringwald     switch (hci_connection->address_type){
98246a79f6baSMatthias Ringwald #ifdef ENABLE_BLE
98258b35e16aSMatthias Ringwald         case BD_ADDR_TYPE_LE_PUBLIC:
98268b35e16aSMatthias Ringwald         case BD_ADDR_TYPE_LE_RANDOM:
9827d9e1bf33SMatthias Ringwald         case BD_ADDR_TYPE_LE_PUBLIC_IDENTITY:
9828d9e1bf33SMatthias Ringwald         case BD_ADDR_TYPE_LE_RANDOM_IDENTITY:
9829f461b3dfSMatthias Ringwald             if (hci_connection->sm_connection.sm_connection_encrypted == 0) return false; // unencrypted connection cannot be authenticated
9830d7dbf891SMatthias Ringwald             return hci_connection->sm_connection.sm_connection_sc;
98316a79f6baSMatthias Ringwald #endif
983259a1a47aSMatthias Ringwald #ifdef ENABLE_CLASSIC
98338b35e16aSMatthias Ringwald         case BD_ADDR_TYPE_SCO:
9834f16129ceSMatthias Ringwald         case BD_ADDR_TYPE_ACL:
9835f461b3dfSMatthias Ringwald             return gap_secure_connection_for_link_key_type(hci_connection->link_key_type);
983659a1a47aSMatthias Ringwald #endif
98378b35e16aSMatthias Ringwald         default:
9838f461b3dfSMatthias Ringwald             return false;
98398b35e16aSMatthias Ringwald     }
9840f1dfbe18SMatthias Ringwald }
9841f1dfbe18SMatthias Ringwald 
98421e122704SMatthias Ringwald bool gap_bonded(hci_con_handle_t con_handle){
98431e122704SMatthias Ringwald 	hci_connection_t * hci_connection = hci_connection_for_handle(con_handle);
98441e122704SMatthias Ringwald 	if (hci_connection == NULL) return 0;
98451e122704SMatthias Ringwald 
984648f33f37SMatthias Ringwald #ifdef ENABLE_CLASSIC
98471e122704SMatthias Ringwald 	link_key_t link_key;
98481e122704SMatthias Ringwald 	link_key_type_t link_key_type;
984948f33f37SMatthias Ringwald #endif
98501e122704SMatthias Ringwald 	switch (hci_connection->address_type){
98516a79f6baSMatthias Ringwald #ifdef ENABLE_BLE
98521e122704SMatthias Ringwald 		case BD_ADDR_TYPE_LE_PUBLIC:
98531e122704SMatthias Ringwald 		case BD_ADDR_TYPE_LE_RANDOM:
9854d9e1bf33SMatthias Ringwald 	    case BD_ADDR_TYPE_LE_PUBLIC_IDENTITY:
9855d9e1bf33SMatthias Ringwald         case BD_ADDR_TYPE_LE_RANDOM_IDENTITY:
98561e122704SMatthias Ringwald             return hci_connection->sm_connection.sm_le_db_index >= 0;
98576a79f6baSMatthias Ringwald #endif
98581e122704SMatthias Ringwald #ifdef ENABLE_CLASSIC
98591e122704SMatthias Ringwald 		case BD_ADDR_TYPE_SCO:
98601e122704SMatthias Ringwald 		case BD_ADDR_TYPE_ACL:
98611e122704SMatthias Ringwald 			return hci_stack->link_key_db && hci_stack->link_key_db->get_link_key(hci_connection->address, link_key, &link_key_type);
98621e122704SMatthias Ringwald #endif
98631e122704SMatthias Ringwald 		default:
98641e122704SMatthias Ringwald 			return false;
98651e122704SMatthias Ringwald 	}
98661e122704SMatthias Ringwald }
98671e122704SMatthias Ringwald 
98686a79f6baSMatthias Ringwald #ifdef ENABLE_BLE
98699c6e867eSMatthias Ringwald authorization_state_t gap_authorization_state(hci_con_handle_t con_handle){
98709c6e867eSMatthias Ringwald     sm_connection_t * sm_conn = sm_get_connection_for_handle(con_handle);
9871c7bead46SMatthias Ringwald     if (sm_conn == NULL)                             return AUTHORIZATION_UNKNOWN; // wrong connection
9872c7bead46SMatthias Ringwald     if (sm_conn->sm_connection_encrypted == 0u)      return AUTHORIZATION_UNKNOWN; // unencrypted connection cannot be authorized
9873a086dc35SMatthias Ringwald     if (sm_conn->sm_connection_authenticated == 0u)  return AUTHORIZATION_UNKNOWN; // unauthenticated connection cannot be authorized
98749c6e867eSMatthias Ringwald     return sm_conn->sm_connection_authorization_state;
98759c6e867eSMatthias Ringwald }
98769c6e867eSMatthias Ringwald #endif
9877f8ee3071SMatthias Ringwald 
9878f8ee3071SMatthias Ringwald #ifdef ENABLE_CLASSIC
9879f8ee3071SMatthias 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){
9880f8ee3071SMatthias Ringwald     hci_connection_t * conn = hci_connection_for_handle(con_handle);
98817f839e2cSMatthias Ringwald     if (!conn) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
9882f8ee3071SMatthias Ringwald     conn->sniff_min_interval = sniff_min_interval;
9883f8ee3071SMatthias Ringwald     conn->sniff_max_interval = sniff_max_interval;
9884f8ee3071SMatthias Ringwald     conn->sniff_attempt = sniff_attempt;
9885f8ee3071SMatthias Ringwald     conn->sniff_timeout = sniff_timeout;
9886f8ee3071SMatthias Ringwald     hci_run();
9887f8ee3071SMatthias Ringwald     return 0;
9888f8ee3071SMatthias Ringwald }
9889f8ee3071SMatthias Ringwald 
9890f8ee3071SMatthias Ringwald /**
9891f8ee3071SMatthias Ringwald  * @brief Exit Sniff mode
9892f8ee3071SMatthias Ringwald  * @param con_handle
9893f8ee3071SMatthias Ringwald  @ @return 0 if ok
9894f8ee3071SMatthias Ringwald  */
9895f8ee3071SMatthias Ringwald uint8_t gap_sniff_mode_exit(hci_con_handle_t con_handle){
9896f8ee3071SMatthias Ringwald     hci_connection_t * conn = hci_connection_for_handle(con_handle);
98977f839e2cSMatthias Ringwald     if (!conn) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
9898f8ee3071SMatthias Ringwald     conn->sniff_min_interval = 0xffff;
9899f8ee3071SMatthias Ringwald     hci_run();
9900f8ee3071SMatthias Ringwald     return 0;
9901f8ee3071SMatthias Ringwald }
9902bea424a5SMatthias Ringwald 
9903140c0557SMatthias 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){
9904140c0557SMatthias Ringwald     hci_connection_t * conn = hci_connection_for_handle(con_handle);
99057f839e2cSMatthias Ringwald     if (!conn) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
9906140c0557SMatthias Ringwald     conn->sniff_subrating_max_latency = max_latency;
9907140c0557SMatthias Ringwald     conn->sniff_subrating_min_remote_timeout = min_remote_timeout;
9908140c0557SMatthias Ringwald     conn->sniff_subrating_min_local_timeout = min_local_timeout;
9909140c0557SMatthias Ringwald     hci_run();
9910dc8d5bd3SMatthias Ringwald     return ERROR_CODE_SUCCESS;
9911140c0557SMatthias Ringwald }
9912140c0557SMatthias Ringwald 
9913278ff8a9SMatthias 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){
9914278ff8a9SMatthias Ringwald     hci_connection_t * conn = hci_connection_for_handle(con_handle);
99157f839e2cSMatthias Ringwald     if (!conn) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
9916278ff8a9SMatthias Ringwald     conn->qos_service_type = service_type;
9917278ff8a9SMatthias Ringwald     conn->qos_token_rate = token_rate;
9918278ff8a9SMatthias Ringwald     conn->qos_peak_bandwidth = peak_bandwidth;
9919278ff8a9SMatthias Ringwald     conn->qos_latency = latency;
9920278ff8a9SMatthias Ringwald     conn->qos_delay_variation = delay_variation;
9921278ff8a9SMatthias Ringwald     hci_run();
9922278ff8a9SMatthias Ringwald     return ERROR_CODE_SUCCESS;
9923278ff8a9SMatthias Ringwald }
9924278ff8a9SMatthias Ringwald 
9925bea424a5SMatthias Ringwald void gap_set_page_scan_activity(uint16_t page_scan_interval, uint16_t page_scan_window){
9926bea424a5SMatthias Ringwald     hci_stack->new_page_scan_interval = page_scan_interval;
9927bea424a5SMatthias Ringwald     hci_stack->new_page_scan_window = page_scan_window;
9928baa4881eSMatthias Ringwald     hci_stack->gap_tasks_classic |= GAP_TASK_WRITE_PAGE_SCAN_ACTIVITY;
9929bea424a5SMatthias Ringwald     hci_run();
9930bea424a5SMatthias Ringwald }
9931bea424a5SMatthias Ringwald 
9932bea424a5SMatthias Ringwald void gap_set_page_scan_type(page_scan_type_t page_scan_type){
9933bea424a5SMatthias Ringwald     hci_stack->new_page_scan_type = (uint8_t) page_scan_type;
9934baa4881eSMatthias Ringwald     hci_stack->gap_tasks_classic |= GAP_TASK_WRITE_PAGE_SCAN_TYPE;
9935bea424a5SMatthias Ringwald     hci_run();
9936bea424a5SMatthias Ringwald }
9937bea424a5SMatthias Ringwald 
993832a12730SMatthias Ringwald void gap_set_page_timeout(uint16_t page_timeout){
993932a12730SMatthias Ringwald     hci_stack->page_timeout = page_timeout;
9940baa4881eSMatthias Ringwald     hci_stack->gap_tasks_classic |= GAP_TASK_WRITE_PAGE_TIMEOUT;
994132a12730SMatthias Ringwald     hci_run();
994232a12730SMatthias Ringwald }
994332a12730SMatthias Ringwald 
9944f8ee3071SMatthias Ringwald #endif
9945beceeddeSMatthias Ringwald 
994621debf25SMatthias Ringwald #ifdef ENABLE_LE_PRIVACY_ADDRESS_RESOLUTION
994721debf25SMatthias Ringwald void hci_load_le_device_db_entry_into_resolving_list(uint16_t le_device_db_index){
994821debf25SMatthias Ringwald     if (le_device_db_index >= MAX_NUM_RESOLVING_LIST_ENTRIES) return;
994921debf25SMatthias Ringwald     if (le_device_db_index >= le_device_db_max_count()) return;
995021debf25SMatthias Ringwald     uint8_t offset = le_device_db_index >> 3;
995121debf25SMatthias Ringwald     uint8_t mask = 1 << (le_device_db_index & 7);
995202b02cffSMatthias Ringwald     hci_stack->le_resolving_list_add_entries[offset] |= mask;
9953e8ca66c6SMatthias Ringwald     hci_stack->le_resolving_list_set_privacy_mode[offset] |= mask;
995421debf25SMatthias Ringwald     if (hci_stack->le_resolving_list_state == LE_RESOLVING_LIST_DONE){
995502b02cffSMatthias Ringwald     	// note: go back to remove entries, otherwise, a remove + add will skip the add
99565f3ccd83SMatthias Ringwald         hci_stack->le_resolving_list_state = LE_RESOLVING_LIST_UPDATES_ENTRIES;
995702b02cffSMatthias Ringwald     }
995802b02cffSMatthias Ringwald }
995902b02cffSMatthias Ringwald 
996002b02cffSMatthias Ringwald void hci_remove_le_device_db_entry_from_resolving_list(uint16_t le_device_db_index){
996102b02cffSMatthias Ringwald 	if (le_device_db_index >= MAX_NUM_RESOLVING_LIST_ENTRIES) return;
996202b02cffSMatthias Ringwald 	if (le_device_db_index >= le_device_db_max_count()) return;
996302b02cffSMatthias Ringwald 	uint8_t offset = le_device_db_index >> 3;
996402b02cffSMatthias Ringwald 	uint8_t mask = 1 << (le_device_db_index & 7);
996502b02cffSMatthias Ringwald 	hci_stack->le_resolving_list_remove_entries[offset] |= mask;
996602b02cffSMatthias Ringwald 	if (hci_stack->le_resolving_list_state == LE_RESOLVING_LIST_DONE){
99675f3ccd83SMatthias Ringwald 		hci_stack->le_resolving_list_state = LE_RESOLVING_LIST_UPDATES_ENTRIES;
996821debf25SMatthias Ringwald 	}
996921debf25SMatthias Ringwald }
9970cf38a091SMatthias Ringwald 
9971cf38a091SMatthias Ringwald uint8_t gap_load_resolving_list_from_le_device_db(void){
99721ffa425cSMatthias Ringwald     if (hci_command_supported(SUPPORTED_HCI_COMMAND_LE_SET_ADDRESS_RESOLUTION_ENABLE) == false){
9973cf38a091SMatthias Ringwald 		return ERROR_CODE_UNSUPPORTED_FEATURE_OR_PARAMETER_VALUE;
9974cf38a091SMatthias Ringwald 	}
9975cf38a091SMatthias Ringwald 	if (hci_stack->le_resolving_list_state != LE_RESOLVING_LIST_SEND_ENABLE_ADDRESS_RESOLUTION){
9976cf38a091SMatthias Ringwald 		// restart le resolving list update
9977cf38a091SMatthias Ringwald 		hci_stack->le_resolving_list_state = LE_RESOLVING_LIST_READ_SIZE;
9978cf38a091SMatthias Ringwald 	}
9979cf38a091SMatthias Ringwald 	return ERROR_CODE_SUCCESS;
9980cf38a091SMatthias Ringwald }
9981c3d19a30SMatthias Ringwald 
9982c3d19a30SMatthias Ringwald void gap_set_peer_privacy_mode(le_privacy_mode_t privacy_mode ){
9983c3d19a30SMatthias Ringwald     hci_stack->le_privacy_mode = privacy_mode;
9984c3d19a30SMatthias Ringwald }
998521debf25SMatthias Ringwald #endif
998621debf25SMatthias Ringwald 
9987f40c73b4SMatthias Ringwald #ifdef ENABLE_BLE
9988f40c73b4SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
9989f40c73b4SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
9990f40c73b4SMatthias Ringwald 
9991f40c73b4SMatthias Ringwald static uint8_t hci_periodic_advertiser_list_add(bd_addr_type_t address_type, const bd_addr_t address, uint8_t advertising_sid){
9992100da355SMatthias Ringwald 
9993100da355SMatthias Ringwald #if !defined(HAVE_MALLOC) && (!defined(MAX_NR_PERIODIC_ADVERTISER_LIST_ENTRIES) || (MAX_NR_PERIODIC_ADVERTISER_LIST_ENTRIES == 0))
9994100da355SMatthias Ringwald     // incorrect configuration:
9995100da355SMatthias Ringwald     // - as MAX_NR_PERIODIC_ADVERTISER_LIST_ENTRIES is not defined or zero this function always fails
9996100da355SMatthias Ringwald     // - please set MAX_NR_PERIODIC_ADVERTISER_LIST_ENTRIES in btstack_config.h
9997100da355SMatthias Ringwald     btstack_assert(false);
9998100da355SMatthias Ringwald #endif
9999100da355SMatthias Ringwald 
10000f40c73b4SMatthias Ringwald     // check if already in list
10001f40c73b4SMatthias Ringwald     btstack_linked_list_iterator_t it;
10002f40c73b4SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->le_periodic_advertiser_list);
10003f40c73b4SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)) {
10004f40c73b4SMatthias Ringwald         periodic_advertiser_list_entry_t *entry = (periodic_advertiser_list_entry_t *) btstack_linked_list_iterator_next(&it);
10005f40c73b4SMatthias Ringwald         if (entry->sid != advertising_sid) {
10006f40c73b4SMatthias Ringwald             continue;
10007f40c73b4SMatthias Ringwald         }
10008f40c73b4SMatthias Ringwald         if (entry->address_type != address_type) {
10009f40c73b4SMatthias Ringwald             continue;
10010f40c73b4SMatthias Ringwald         }
10011f40c73b4SMatthias Ringwald         if (memcmp(entry->address, address, 6) != 0) {
10012f40c73b4SMatthias Ringwald             continue;
10013f40c73b4SMatthias Ringwald         }
10014f40c73b4SMatthias Ringwald         // disallow if already scheduled to add
10015f40c73b4SMatthias Ringwald         if ((entry->state & LE_PERIODIC_ADVERTISER_LIST_ENTRY_ADD_TO_CONTROLLER) != 0){
10016f40c73b4SMatthias Ringwald             return ERROR_CODE_COMMAND_DISALLOWED;
10017f40c73b4SMatthias Ringwald         }
10018f40c73b4SMatthias Ringwald         // still on controller, but scheduled to remove -> re-add
10019f40c73b4SMatthias Ringwald         entry->state |= LE_PERIODIC_ADVERTISER_LIST_ENTRY_ADD_TO_CONTROLLER;
10020f40c73b4SMatthias Ringwald         return ERROR_CODE_SUCCESS;
10021f40c73b4SMatthias Ringwald     }
10022f40c73b4SMatthias Ringwald     // alloc and add to list
10023f40c73b4SMatthias Ringwald     periodic_advertiser_list_entry_t * entry = btstack_memory_periodic_advertiser_list_entry_get();
10024f40c73b4SMatthias Ringwald     if (!entry) return BTSTACK_MEMORY_ALLOC_FAILED;
10025f40c73b4SMatthias Ringwald     entry->sid = advertising_sid;
10026f40c73b4SMatthias Ringwald     entry->address_type = address_type;
10027f40c73b4SMatthias Ringwald     (void)memcpy(entry->address, address, 6);
10028f40c73b4SMatthias Ringwald     entry->state = LE_PERIODIC_ADVERTISER_LIST_ENTRY_ADD_TO_CONTROLLER;
10029f40c73b4SMatthias Ringwald     btstack_linked_list_add(&hci_stack->le_periodic_advertiser_list, (btstack_linked_item_t*) entry);
10030f40c73b4SMatthias Ringwald     return ERROR_CODE_SUCCESS;
10031f40c73b4SMatthias Ringwald }
10032f40c73b4SMatthias Ringwald 
10033f40c73b4SMatthias Ringwald static uint8_t hci_periodic_advertiser_list_remove(bd_addr_type_t address_type, const bd_addr_t address, uint8_t advertising_sid){
10034f40c73b4SMatthias Ringwald     btstack_linked_list_iterator_t it;
10035f40c73b4SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->le_periodic_advertiser_list);
10036f40c73b4SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
10037f40c73b4SMatthias Ringwald         periodic_advertiser_list_entry_t * entry = (periodic_advertiser_list_entry_t*) btstack_linked_list_iterator_next(&it);
10038f40c73b4SMatthias Ringwald         if (entry->sid != advertising_sid) {
10039f40c73b4SMatthias Ringwald             continue;
10040f40c73b4SMatthias Ringwald         }
10041f40c73b4SMatthias Ringwald         if (entry->address_type != address_type) {
10042f40c73b4SMatthias Ringwald             continue;
10043f40c73b4SMatthias Ringwald         }
10044f40c73b4SMatthias Ringwald         if (memcmp(entry->address, address, 6) != 0) {
10045f40c73b4SMatthias Ringwald             continue;
10046f40c73b4SMatthias Ringwald         }
10047f40c73b4SMatthias Ringwald         if (entry->state & LE_PERIODIC_ADVERTISER_LIST_ENTRY_ON_CONTROLLER){
10048f40c73b4SMatthias Ringwald             // remove from controller if already present
10049f40c73b4SMatthias Ringwald             entry->state |= LE_PERIODIC_ADVERTISER_LIST_ENTRY_REMOVE_FROM_CONTROLLER;
10050f40c73b4SMatthias Ringwald         }  else {
10051f40c73b4SMatthias Ringwald             // directly remove entry from whitelist
10052f40c73b4SMatthias Ringwald             btstack_linked_list_iterator_remove(&it);
10053f40c73b4SMatthias Ringwald             btstack_memory_periodic_advertiser_list_entry_free(entry);
10054f40c73b4SMatthias Ringwald         }
10055f40c73b4SMatthias Ringwald         return ERROR_CODE_SUCCESS;
10056f40c73b4SMatthias Ringwald     }
10057f40c73b4SMatthias Ringwald     return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
10058f40c73b4SMatthias Ringwald }
10059f40c73b4SMatthias Ringwald 
10060f40c73b4SMatthias Ringwald static void hci_periodic_advertiser_list_clear(void){
10061f40c73b4SMatthias Ringwald     btstack_linked_list_iterator_t it;
10062f40c73b4SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->le_periodic_advertiser_list);
10063f40c73b4SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
10064f40c73b4SMatthias Ringwald         periodic_advertiser_list_entry_t * entry = (periodic_advertiser_list_entry_t*) btstack_linked_list_iterator_next(&it);
10065f40c73b4SMatthias Ringwald         if (entry->state & LE_PERIODIC_ADVERTISER_LIST_ENTRY_ON_CONTROLLER){
10066f40c73b4SMatthias Ringwald             // remove from controller if already present
10067f40c73b4SMatthias Ringwald             entry->state |= LE_PERIODIC_ADVERTISER_LIST_ENTRY_REMOVE_FROM_CONTROLLER;
10068f40c73b4SMatthias Ringwald             continue;
10069f40c73b4SMatthias Ringwald         }
10070f40c73b4SMatthias Ringwald         // directly remove entry from whitelist
10071f40c73b4SMatthias Ringwald         btstack_linked_list_iterator_remove(&it);
10072f40c73b4SMatthias Ringwald         btstack_memory_periodic_advertiser_list_entry_free(entry);
10073f40c73b4SMatthias Ringwald     }
10074f40c73b4SMatthias Ringwald }
10075f40c73b4SMatthias Ringwald 
10076f40c73b4SMatthias Ringwald uint8_t gap_periodic_advertiser_list_clear(void){
10077f40c73b4SMatthias Ringwald     hci_periodic_advertiser_list_clear();
10078f40c73b4SMatthias Ringwald     hci_run();
10079f40c73b4SMatthias Ringwald     return ERROR_CODE_SUCCESS;
10080f40c73b4SMatthias Ringwald }
10081f40c73b4SMatthias Ringwald 
10082f40c73b4SMatthias Ringwald uint8_t gap_periodic_advertiser_list_add(bd_addr_type_t address_type, const bd_addr_t address, uint8_t advertising_sid){
10083f40c73b4SMatthias Ringwald     uint8_t status = hci_periodic_advertiser_list_add(address_type, address, advertising_sid);
10084f40c73b4SMatthias Ringwald     if (status){
10085f40c73b4SMatthias Ringwald         return status;
10086f40c73b4SMatthias Ringwald     }
10087f40c73b4SMatthias Ringwald     hci_run();
10088f40c73b4SMatthias Ringwald     return ERROR_CODE_SUCCESS;
10089f40c73b4SMatthias Ringwald }
10090f40c73b4SMatthias Ringwald 
10091f40c73b4SMatthias Ringwald uint8_t gap_periodic_advertiser_list_remove(bd_addr_type_t address_type, const bd_addr_t address, uint8_t advertising_sid){
10092f40c73b4SMatthias Ringwald     uint8_t status = hci_periodic_advertiser_list_remove(address_type, address, advertising_sid);
10093f40c73b4SMatthias Ringwald     if (status){
10094f40c73b4SMatthias Ringwald         return status;
10095f40c73b4SMatthias Ringwald     }
10096f40c73b4SMatthias Ringwald     hci_run();
10097f40c73b4SMatthias Ringwald     return ERROR_CODE_SUCCESS;
10098f40c73b4SMatthias Ringwald }
100994bafedd5SMatthias Ringwald 
101004bafedd5SMatthias Ringwald uint8_t gap_periodic_advertising_create_sync(uint8_t options, uint8_t advertising_sid, bd_addr_type_t advertiser_address_type,
101014bafedd5SMatthias Ringwald                                              bd_addr_t advertiser_address, uint16_t skip, uint16_t sync_timeout, uint8_t sync_cte_type){
101024bafedd5SMatthias Ringwald     // abort if already active
101034bafedd5SMatthias Ringwald     if (hci_stack->le_periodic_sync_request != LE_CONNECTING_IDLE) {
101044bafedd5SMatthias Ringwald         return ERROR_CODE_COMMAND_DISALLOWED;
101054bafedd5SMatthias Ringwald     }
101064bafedd5SMatthias Ringwald     // store request
101074bafedd5SMatthias Ringwald     hci_stack->le_periodic_sync_request = ((options & 0) != 0) ? LE_CONNECTING_WHITELIST : LE_CONNECTING_DIRECT;
101084bafedd5SMatthias Ringwald     hci_stack->le_periodic_sync_options = options;
101094bafedd5SMatthias Ringwald     hci_stack->le_periodic_sync_advertising_sid = advertising_sid;
101104bafedd5SMatthias Ringwald     hci_stack->le_periodic_sync_advertiser_address_type = advertiser_address_type;
101114bafedd5SMatthias Ringwald     memcpy(hci_stack->le_periodic_sync_advertiser_address, advertiser_address, 6);
101124bafedd5SMatthias Ringwald     hci_stack->le_periodic_sync_skip = skip;
101134bafedd5SMatthias Ringwald     hci_stack->le_periodic_sync_timeout = sync_timeout;
101144bafedd5SMatthias Ringwald     hci_stack->le_periodic_sync_cte_type = sync_cte_type;
101154bafedd5SMatthias Ringwald 
101164bafedd5SMatthias Ringwald     hci_run();
101174bafedd5SMatthias Ringwald     return ERROR_CODE_SUCCESS;
101184bafedd5SMatthias Ringwald }
101194bafedd5SMatthias Ringwald 
101204bafedd5SMatthias Ringwald uint8_t gap_periodic_advertising_create_sync_cancel(void){
101214bafedd5SMatthias Ringwald     // abort if not requested
101224bafedd5SMatthias Ringwald     if (hci_stack->le_periodic_sync_request == LE_CONNECTING_IDLE) {
101234bafedd5SMatthias Ringwald         return ERROR_CODE_COMMAND_DISALLOWED;
101244bafedd5SMatthias Ringwald     }
101254bafedd5SMatthias Ringwald     hci_stack->le_periodic_sync_request = LE_CONNECTING_IDLE;
101264bafedd5SMatthias Ringwald     hci_run();
101274bafedd5SMatthias Ringwald     return ERROR_CODE_SUCCESS;
101284bafedd5SMatthias Ringwald }
101294bafedd5SMatthias Ringwald 
101304bafedd5SMatthias Ringwald uint8_t gap_periodic_advertising_terminate_sync(uint16_t sync_handle){
1013149a6c69cSMatthias Ringwald     if (hci_stack->le_periodic_terminate_sync_handle != HCI_CON_HANDLE_INVALID){
1013249a6c69cSMatthias Ringwald         return ERROR_CODE_COMMAND_DISALLOWED;
1013349a6c69cSMatthias Ringwald     }
1013449a6c69cSMatthias Ringwald     hci_stack->le_periodic_terminate_sync_handle = sync_handle;
1013549a6c69cSMatthias Ringwald     hci_run();
1013649a6c69cSMatthias Ringwald     return ERROR_CODE_SUCCESS;
101374bafedd5SMatthias Ringwald }
101384bafedd5SMatthias Ringwald 
10139f40c73b4SMatthias Ringwald #endif
10140f40c73b4SMatthias Ringwald #endif
101414ae8623eSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
10142969d876aSMatthias Ringwald static hci_iso_stream_t *
10143969d876aSMatthias 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) {
101444ae8623eSMatthias Ringwald     hci_iso_stream_t * iso_stream = btstack_memory_hci_iso_stream_get();
10145969d876aSMatthias Ringwald     if (iso_stream != NULL){
101468d72db10SMatthias Ringwald         iso_stream->iso_type = iso_type;
1014726b93350SMatthias Ringwald         iso_stream->state = state;
101488d72db10SMatthias Ringwald         iso_stream->group_id = group_id;
10149969d876aSMatthias Ringwald         iso_stream->stream_id = stream_id;
10150969d876aSMatthias Ringwald         iso_stream->cis_handle = HCI_CON_HANDLE_INVALID;
10151969d876aSMatthias Ringwald         iso_stream->acl_handle = HCI_CON_HANDLE_INVALID;
101524ae8623eSMatthias Ringwald         btstack_linked_list_add(&hci_stack->iso_streams, (btstack_linked_item_t*) iso_stream);
101534ae8623eSMatthias Ringwald     }
10154969d876aSMatthias Ringwald     return iso_stream;
101554ae8623eSMatthias Ringwald }
101564ae8623eSMatthias Ringwald 
1015715a15be3SMatthias Ringwald static hci_iso_stream_t * hci_iso_stream_for_con_handle(hci_con_handle_t con_handle){
101584ae8623eSMatthias Ringwald     btstack_linked_list_iterator_t it;
101594ae8623eSMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->iso_streams);
101604ae8623eSMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
101614ae8623eSMatthias Ringwald         hci_iso_stream_t * iso_stream = (hci_iso_stream_t *) btstack_linked_list_iterator_next(&it);
10162969d876aSMatthias Ringwald         if (iso_stream->cis_handle == con_handle ) {
101634ae8623eSMatthias Ringwald             return iso_stream;
101644ae8623eSMatthias Ringwald         }
101654ae8623eSMatthias Ringwald     }
101664ae8623eSMatthias Ringwald     return NULL;
101674ae8623eSMatthias Ringwald }
101684ae8623eSMatthias Ringwald 
101694ae8623eSMatthias Ringwald static void hci_iso_stream_finalize(hci_iso_stream_t * iso_stream){
10170969d876aSMatthias Ringwald     log_info("hci_iso_stream_finalize con_handle 0x%04x, group_id 0x%02x", iso_stream->cis_handle, iso_stream->group_id);
101714ae8623eSMatthias Ringwald     btstack_linked_list_remove(&hci_stack->iso_streams, (btstack_linked_item_t*) iso_stream);
101724ae8623eSMatthias Ringwald     btstack_memory_hci_iso_stream_free(iso_stream);
101734ae8623eSMatthias Ringwald }
101744ae8623eSMatthias Ringwald 
10175778463d0SMatthias Ringwald static void hci_iso_stream_finalize_by_type_and_group_id(hci_iso_type_t iso_type, uint8_t group_id) {
10176778463d0SMatthias Ringwald     btstack_linked_list_iterator_t it;
10177778463d0SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->iso_streams);
10178778463d0SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
10179778463d0SMatthias Ringwald         hci_iso_stream_t * iso_stream = (hci_iso_stream_t *) btstack_linked_list_iterator_next(&it);
10180778463d0SMatthias Ringwald         if ((iso_stream->group_id == group_id) &&
10181778463d0SMatthias Ringwald             (iso_stream->iso_type == iso_type)){
10182778463d0SMatthias Ringwald             btstack_linked_list_iterator_remove(&it);
10183778463d0SMatthias Ringwald             btstack_memory_hci_iso_stream_free(iso_stream);
10184778463d0SMatthias Ringwald         }
10185778463d0SMatthias Ringwald     }
10186778463d0SMatthias Ringwald }
10187778463d0SMatthias Ringwald 
101888d72db10SMatthias Ringwald static void hci_iso_stream_requested_finalize(uint8_t group_id) {
101894ae8623eSMatthias Ringwald     btstack_linked_list_iterator_t it;
101904ae8623eSMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->iso_streams);
101914ae8623eSMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
101924ae8623eSMatthias Ringwald         hci_iso_stream_t * iso_stream = (hci_iso_stream_t *) btstack_linked_list_iterator_next(&it);
10193a90016deSMatthias Ringwald         if ((iso_stream->state == HCI_ISO_STREAM_STATE_REQUESTED ) &&
101948d72db10SMatthias Ringwald             (iso_stream->group_id == group_id)){
101954ae8623eSMatthias Ringwald             btstack_linked_list_iterator_remove(&it);
101964ae8623eSMatthias Ringwald             btstack_memory_hci_iso_stream_free(iso_stream);
101974ae8623eSMatthias Ringwald         }
101984ae8623eSMatthias Ringwald     }
101994ae8623eSMatthias Ringwald }
1020036916f81SDirk Helbig 
10201a90016deSMatthias Ringwald static void hci_iso_stream_requested_confirm(uint8_t big_handle){
1020236916f81SDirk Helbig     UNUSED(big_handle);
1020336916f81SDirk Helbig 
102044ae8623eSMatthias Ringwald     btstack_linked_list_iterator_t it;
102054ae8623eSMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->iso_streams);
102064ae8623eSMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
102074ae8623eSMatthias Ringwald         hci_iso_stream_t * iso_stream = (hci_iso_stream_t *) btstack_linked_list_iterator_next(&it);
102084ae8623eSMatthias Ringwald         if ( iso_stream->state == HCI_ISO_STREAM_STATE_REQUESTED ) {
102094ae8623eSMatthias Ringwald             iso_stream->state = HCI_ISO_STREAM_STATE_W4_ESTABLISHED;
102104ae8623eSMatthias Ringwald         }
102114ae8623eSMatthias Ringwald     }
102124ae8623eSMatthias Ringwald }
10213d39e4f95SMatthias Ringwald 
10214d39e4f95SMatthias Ringwald static bool hci_iso_sdu_complete(uint8_t * packet, uint16_t size){
10215d39e4f95SMatthias Ringwald     uint8_t  sdu_ts_flag = (packet[1] >> 6) & 1;
10216d39e4f95SMatthias Ringwald     uint16_t sdu_len_offset = 6 + (sdu_ts_flag * 4);
10217d39e4f95SMatthias Ringwald     uint16_t sdu_len = little_endian_read_16(packet, sdu_len_offset) & 0x0fff;
10218d39e4f95SMatthias Ringwald     return (sdu_len_offset + 2 + sdu_len) == size;
10219d39e4f95SMatthias Ringwald }
10220d39e4f95SMatthias Ringwald 
10221750818acSMatthias Ringwald static void hci_iso_packet_handler(hci_iso_stream_t *iso_stream, uint8_t *packet, uint16_t size) {
10222750818acSMatthias Ringwald     if (iso_stream == NULL){
10223750818acSMatthias Ringwald         log_error("acl_handler called with non-registered handle %u!" , READ_ISO_CONNECTION_HANDLE(packet));
10224d39e4f95SMatthias Ringwald         return;
10225d39e4f95SMatthias Ringwald     }
10226750818acSMatthias Ringwald 
10227750818acSMatthias Ringwald     if (hci_stack->iso_packet_handler == NULL) {
10228d39e4f95SMatthias Ringwald         return;
10229d39e4f95SMatthias Ringwald     }
10230d39e4f95SMatthias Ringwald 
10231d39e4f95SMatthias Ringwald     // parse header
10232a14c18deSMatthias Ringwald     uint16_t con_handle_and_flags = little_endian_read_16(packet, 0);
10233a14c18deSMatthias Ringwald     uint16_t data_total_length = little_endian_read_16(packet, 2);
10234a14c18deSMatthias Ringwald     uint8_t  pb_flag = (con_handle_and_flags >> 12) & 3;
10235d39e4f95SMatthias Ringwald 
10236d39e4f95SMatthias Ringwald     // assert packet is complete
10237a14c18deSMatthias Ringwald     if ((data_total_length + 4u) != size){
10238d39e4f95SMatthias Ringwald         return;
10239d39e4f95SMatthias Ringwald     }
10240d39e4f95SMatthias Ringwald 
10241d39e4f95SMatthias Ringwald     if ((pb_flag & 0x01) == 0){
10242d39e4f95SMatthias Ringwald         if (pb_flag == 0x02){
10243a14c18deSMatthias Ringwald             // The ISO_SDU_Fragment field contains a header and a complete SDU.
10244d39e4f95SMatthias Ringwald             if (hci_iso_sdu_complete(packet, size)) {
10245d39e4f95SMatthias Ringwald                 (hci_stack->iso_packet_handler)(HCI_ISO_DATA_PACKET, 0, packet, size);
10246d39e4f95SMatthias Ringwald             }
10247d39e4f95SMatthias Ringwald         } else {
10248d39e4f95SMatthias Ringwald             // The ISO_Data_Load field contains a header and the first fragment of a fragmented SDU.
1024960468fb4SMatthias Ringwald             if (size > sizeof(iso_stream->reassembly_buffer)){
10250d39e4f95SMatthias Ringwald                 return;
10251d39e4f95SMatthias Ringwald             }
10252d39e4f95SMatthias Ringwald             memcpy(iso_stream->reassembly_buffer, packet, size);
10253d39e4f95SMatthias Ringwald             // fix pb_flag
10254d39e4f95SMatthias Ringwald             iso_stream->reassembly_buffer[1] = (iso_stream->reassembly_buffer[1] & 0xcf) | 0x20;
10255d39e4f95SMatthias Ringwald             iso_stream->reassembly_pos = size;
10256d39e4f95SMatthias Ringwald         }
10257d39e4f95SMatthias Ringwald     } else {
10258a14c18deSMatthias Ringwald         // ISO_SDU_Fragment contains continuation or last fragment of an SDU
10259a14c18deSMatthias Ringwald         uint8_t ts_flag = (con_handle_and_flags >> 14) & 1;
10260d39e4f95SMatthias Ringwald         if (ts_flag != 0){
10261d39e4f95SMatthias Ringwald            return;
10262d39e4f95SMatthias Ringwald         }
10263d39e4f95SMatthias Ringwald         // append fragment
10264d39e4f95SMatthias Ringwald         if (iso_stream->reassembly_pos == 0){
10265d39e4f95SMatthias Ringwald             return;
10266d39e4f95SMatthias Ringwald         }
1026760468fb4SMatthias Ringwald 
10268a14c18deSMatthias Ringwald         if ((iso_stream->reassembly_pos + data_total_length) > sizeof(iso_stream->reassembly_buffer)){
10269d39e4f95SMatthias Ringwald             // reset reassembly buffer
10270d39e4f95SMatthias Ringwald             iso_stream->reassembly_pos = 0;
10271d39e4f95SMatthias Ringwald             return;
10272d39e4f95SMatthias Ringwald         }
10273a14c18deSMatthias Ringwald         memcpy(&iso_stream->reassembly_buffer[iso_stream->reassembly_pos], &packet[4], data_total_length);
10274a14c18deSMatthias Ringwald         iso_stream->reassembly_pos += data_total_length;
10275d39e4f95SMatthias Ringwald 
10276d39e4f95SMatthias Ringwald         // deliver if last fragment and SDU complete
10277d39e4f95SMatthias Ringwald         if (pb_flag == 0x03){
10278d39e4f95SMatthias Ringwald             if (hci_iso_sdu_complete(iso_stream->reassembly_buffer, iso_stream->reassembly_pos)){
10279a14c18deSMatthias Ringwald                 // fix data_total_length
1028060468fb4SMatthias Ringwald                 little_endian_store_16(iso_stream->reassembly_buffer, 2, iso_stream->reassembly_pos - HCI_ISO_HEADER_SIZE);
10281d39e4f95SMatthias Ringwald                 (hci_stack->iso_packet_handler)(HCI_ISO_DATA_PACKET, 0, iso_stream->reassembly_buffer, iso_stream->reassembly_pos);
10282d39e4f95SMatthias Ringwald             }
10283a14c18deSMatthias Ringwald             // reset reassembly buffer
10284d39e4f95SMatthias Ringwald             iso_stream->reassembly_pos = 0;
10285d39e4f95SMatthias Ringwald         }
10286d39e4f95SMatthias Ringwald     }
10287d39e4f95SMatthias Ringwald }
10288d39e4f95SMatthias Ringwald 
102897aa35f6aSMatthias Ringwald static void hci_emit_big_created(const le_audio_big_t * big, uint8_t status){
102907aa35f6aSMatthias Ringwald     uint8_t event [6 + (MAX_NR_BIS * 2)];
102917aa35f6aSMatthias Ringwald     uint16_t pos = 0;
102927aa35f6aSMatthias Ringwald     event[pos++] = HCI_EVENT_META_GAP;
102937aa35f6aSMatthias Ringwald     event[pos++] = 4 + (2 * big->num_bis);
102947aa35f6aSMatthias Ringwald     event[pos++] = GAP_SUBEVENT_BIG_CREATED;
102957aa35f6aSMatthias Ringwald     event[pos++] = status;
102967aa35f6aSMatthias Ringwald     event[pos++] = big->big_handle;
102977aa35f6aSMatthias Ringwald     event[pos++] = big->num_bis;
102987aa35f6aSMatthias Ringwald     uint8_t i;
102997aa35f6aSMatthias Ringwald     for (i=0;i<big->num_bis;i++){
103007aa35f6aSMatthias Ringwald         little_endian_store_16(event, pos, big->bis_con_handles[i]);
103017aa35f6aSMatthias Ringwald         pos += 2;
103027aa35f6aSMatthias Ringwald     }
103039da9850bSMatthias Ringwald     hci_emit_btstack_event(event, pos, 0);
103047aa35f6aSMatthias Ringwald }
103057aa35f6aSMatthias Ringwald 
10306d3a89d91SMatthias Ringwald static void hci_emit_cig_created(const le_audio_cig_t * cig, uint8_t status){
10307d3a89d91SMatthias Ringwald     uint8_t event [6 + (MAX_NR_CIS * 2)];
10308d3a89d91SMatthias Ringwald     uint16_t pos = 0;
10309d3a89d91SMatthias Ringwald     event[pos++] = HCI_EVENT_META_GAP;
10310d3a89d91SMatthias Ringwald     event[pos++] = 4 + (2 * cig->num_cis);
10311d3a89d91SMatthias Ringwald     event[pos++] = GAP_SUBEVENT_CIG_CREATED;
10312d3a89d91SMatthias Ringwald     event[pos++] = status;
10313d3a89d91SMatthias Ringwald     event[pos++] = cig->cig_id;
10314d3a89d91SMatthias Ringwald     event[pos++] = cig->num_cis;
10315d3a89d91SMatthias Ringwald     uint8_t i;
10316d3a89d91SMatthias Ringwald     for (i=0;i<cig->num_cis;i++){
10317d3a89d91SMatthias Ringwald         little_endian_store_16(event, pos, cig->cis_con_handles[i]);
10318d3a89d91SMatthias Ringwald         pos += 2;
10319d3a89d91SMatthias Ringwald     }
103209da9850bSMatthias Ringwald     hci_emit_btstack_event(event, pos, 0);
10321d3a89d91SMatthias Ringwald }
10322f06bb90fSMatthias Ringwald 
10323620553bdSMatthias Ringwald static uint16_t hci_setup_cis_created(uint8_t * event, hci_iso_stream_t * iso_stream, uint8_t status) {
10324f06bb90fSMatthias Ringwald     uint16_t pos = 0;
10325f06bb90fSMatthias Ringwald     event[pos++] = HCI_EVENT_META_GAP;
10326cf439c63SMatthias Ringwald     event[pos++] = 8;
10327f06bb90fSMatthias Ringwald     event[pos++] = GAP_SUBEVENT_CIS_CREATED;
10328f06bb90fSMatthias Ringwald     event[pos++] = status;
10329620553bdSMatthias Ringwald     event[pos++] = iso_stream->group_id;
10330620553bdSMatthias Ringwald     event[pos++] = iso_stream->stream_id;
10331620553bdSMatthias Ringwald     little_endian_store_16(event, pos, iso_stream->cis_handle);
10332f06bb90fSMatthias Ringwald     pos += 2;
10333620553bdSMatthias Ringwald     little_endian_store_16(event, pos, iso_stream->acl_handle);
10334cf439c63SMatthias Ringwald     pos += 2;
103357dd97f73SMatthias Ringwald     little_endian_store_16(event, pos, iso_stream->iso_interval_1250us);
103367dd97f73SMatthias Ringwald     pos += 2;
103377dd97f73SMatthias Ringwald     event[pos++] = iso_stream->number_of_subevents;
103387dd97f73SMatthias Ringwald     event[pos++] = iso_stream->burst_number_c_to_p;
103397dd97f73SMatthias Ringwald     event[pos++] = iso_stream->burst_number_p_to_c;
103407dd97f73SMatthias Ringwald     event[pos++] = iso_stream->flush_timeout_c_to_p;
103417dd97f73SMatthias Ringwald     event[pos++] = iso_stream->flush_timeout_p_to_c;
10342620553bdSMatthias Ringwald     return pos;
10343f06bb90fSMatthias Ringwald }
10344f06bb90fSMatthias Ringwald 
1034514045fdbSMatthias Ringwald // emits GAP_SUBEVENT_CIS_CREATED after calling hci_iso_finalize
1034614045fdbSMatthias Ringwald static void hci_cis_handle_created(hci_iso_stream_t * iso_stream, uint8_t status){
1034714045fdbSMatthias Ringwald     // cache data before finalizing struct
103487dd97f73SMatthias Ringwald     uint8_t event [17];
10349620553bdSMatthias Ringwald     uint16_t pos = hci_setup_cis_created(event, iso_stream, status);
10350620553bdSMatthias Ringwald     btstack_assert(pos <= sizeof(event));
1035114045fdbSMatthias Ringwald     if (status != ERROR_CODE_SUCCESS){
1035214045fdbSMatthias Ringwald         hci_iso_stream_finalize(iso_stream);
1035314045fdbSMatthias Ringwald     }
103549da9850bSMatthias Ringwald     hci_emit_btstack_event(event, pos, 0);
1035514045fdbSMatthias Ringwald }
1035614045fdbSMatthias Ringwald 
103577aa35f6aSMatthias Ringwald static void hci_emit_big_terminated(const le_audio_big_t * big){
103587aa35f6aSMatthias Ringwald     uint8_t event [4];
103597aa35f6aSMatthias Ringwald     uint16_t pos = 0;
103607aa35f6aSMatthias Ringwald     event[pos++] = HCI_EVENT_META_GAP;
103617aa35f6aSMatthias Ringwald     event[pos++] = 2;
103627aa35f6aSMatthias Ringwald     event[pos++] = GAP_SUBEVENT_BIG_TERMINATED;
103637aa35f6aSMatthias Ringwald     event[pos++] = big->big_handle;
103649da9850bSMatthias Ringwald     hci_emit_btstack_event(event, pos, 0);
103657aa35f6aSMatthias Ringwald }
103667aa35f6aSMatthias Ringwald 
103672a6c0f82SMatthias Ringwald static void hci_emit_big_sync_created(const le_audio_big_sync_t * big_sync, uint8_t status){
103682a6c0f82SMatthias Ringwald     uint8_t event [6 + (MAX_NR_BIS * 2)];
103692a6c0f82SMatthias Ringwald     uint16_t pos = 0;
103702a6c0f82SMatthias Ringwald     event[pos++] = HCI_EVENT_META_GAP;
103712a6c0f82SMatthias Ringwald     event[pos++] = 4;
103722a6c0f82SMatthias Ringwald     event[pos++] = GAP_SUBEVENT_BIG_SYNC_CREATED;
103732a6c0f82SMatthias Ringwald     event[pos++] = status;
103742a6c0f82SMatthias Ringwald     event[pos++] = big_sync->big_handle;
103752a6c0f82SMatthias Ringwald     event[pos++] = big_sync->num_bis;
103762a6c0f82SMatthias Ringwald     uint8_t i;
103772a6c0f82SMatthias Ringwald     for (i=0;i<big_sync->num_bis;i++){
103782a6c0f82SMatthias Ringwald         little_endian_store_16(event, pos, big_sync->bis_con_handles[i]);
103792a6c0f82SMatthias Ringwald         pos += 2;
103802a6c0f82SMatthias Ringwald     }
103819da9850bSMatthias Ringwald     hci_emit_btstack_event(event, pos, 0);
103822a6c0f82SMatthias Ringwald }
103832a6c0f82SMatthias Ringwald 
10384d04a9afcSMatthias Ringwald static void hci_emit_big_sync_stopped(uint8_t big_handle){
103852a6c0f82SMatthias Ringwald     uint8_t event [4];
103862a6c0f82SMatthias Ringwald     uint16_t pos = 0;
103872a6c0f82SMatthias Ringwald     event[pos++] = HCI_EVENT_META_GAP;
103882a6c0f82SMatthias Ringwald     event[pos++] = 2;
103892a6c0f82SMatthias Ringwald     event[pos++] = GAP_SUBEVENT_BIG_SYNC_STOPPED;
10390d04a9afcSMatthias Ringwald     event[pos++] = big_handle;
103919da9850bSMatthias Ringwald     hci_emit_btstack_event(event, pos, 0);
103922a6c0f82SMatthias Ringwald }
103932a6c0f82SMatthias Ringwald 
103945ade6657SMatthias Ringwald static void hci_emit_bis_can_send_now(const le_audio_big_t *big, uint8_t bis_index) {
103955ade6657SMatthias Ringwald     uint8_t event[6];
103965ade6657SMatthias Ringwald     uint16_t pos = 0;
103975ade6657SMatthias Ringwald     event[pos++] = HCI_EVENT_BIS_CAN_SEND_NOW;
103985ade6657SMatthias Ringwald     event[pos++] = sizeof(event) - 2;
103995ade6657SMatthias Ringwald     event[pos++] = big->big_handle;
104005ade6657SMatthias Ringwald     event[pos++] = bis_index;
104015ade6657SMatthias Ringwald     little_endian_store_16(event, pos, big->bis_con_handles[bis_index]);
104029da9850bSMatthias Ringwald     hci_emit_btstack_event(&event[0], sizeof(event), 0);  // don't dump
104035ade6657SMatthias Ringwald }
104045ade6657SMatthias Ringwald 
104052c077771SMatthias Ringwald static void hci_emit_cis_can_send_now(hci_con_handle_t cis_con_handle) {
104062c077771SMatthias Ringwald     uint8_t event[4];
104072c077771SMatthias Ringwald     uint16_t pos = 0;
104082c077771SMatthias Ringwald     event[pos++] = HCI_EVENT_CIS_CAN_SEND_NOW;
104092c077771SMatthias Ringwald     event[pos++] = sizeof(event) - 2;
104102c077771SMatthias Ringwald     little_endian_store_16(event, pos, cis_con_handle);
104119da9850bSMatthias Ringwald     hci_emit_btstack_event(&event[0], sizeof(event), 0);  // don't dump
104122c077771SMatthias Ringwald }
104132c077771SMatthias Ringwald 
104147aa35f6aSMatthias Ringwald static le_audio_big_t * hci_big_for_handle(uint8_t big_handle){
104157aa35f6aSMatthias Ringwald     btstack_linked_list_iterator_t it;
104167aa35f6aSMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->le_audio_bigs);
104177aa35f6aSMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
104187aa35f6aSMatthias Ringwald         le_audio_big_t * big = (le_audio_big_t *) btstack_linked_list_iterator_next(&it);
104197aa35f6aSMatthias Ringwald         if ( big->big_handle == big_handle ) {
104207aa35f6aSMatthias Ringwald             return big;
104217aa35f6aSMatthias Ringwald         }
104227aa35f6aSMatthias Ringwald     }
104237aa35f6aSMatthias Ringwald     return NULL;
104247aa35f6aSMatthias Ringwald }
104257aa35f6aSMatthias Ringwald 
104262a6c0f82SMatthias Ringwald static le_audio_big_sync_t * hci_big_sync_for_handle(uint8_t big_handle){
104272a6c0f82SMatthias Ringwald     btstack_linked_list_iterator_t it;
104282a6c0f82SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->le_audio_big_syncs);
104292a6c0f82SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
104302a6c0f82SMatthias Ringwald         le_audio_big_sync_t * big_sync = (le_audio_big_sync_t *) btstack_linked_list_iterator_next(&it);
104312a6c0f82SMatthias Ringwald         if ( big_sync->big_handle == big_handle ) {
104322a6c0f82SMatthias Ringwald             return big_sync;
104332a6c0f82SMatthias Ringwald         }
104342a6c0f82SMatthias Ringwald     }
104352a6c0f82SMatthias Ringwald     return NULL;
104362a6c0f82SMatthias Ringwald }
104372a6c0f82SMatthias Ringwald 
1043801d4f05fSMatthias Ringwald void hci_set_num_iso_packets_to_queue(uint8_t num_packets){
1043901d4f05fSMatthias Ringwald     hci_stack->iso_packets_to_queue = num_packets;
1044001d4f05fSMatthias Ringwald }
1044101d4f05fSMatthias Ringwald 
10442d3a89d91SMatthias Ringwald static le_audio_cig_t * hci_cig_for_id(uint8_t cig_id){
10443d3a89d91SMatthias Ringwald     btstack_linked_list_iterator_t it;
10444d3a89d91SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->le_audio_cigs);
10445d3a89d91SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
10446d3a89d91SMatthias Ringwald         le_audio_cig_t * cig = (le_audio_cig_t *) btstack_linked_list_iterator_next(&it);
10447d3a89d91SMatthias Ringwald         if ( cig->cig_id == cig_id ) {
10448d3a89d91SMatthias Ringwald             return cig;
10449d3a89d91SMatthias Ringwald         }
10450d3a89d91SMatthias Ringwald     }
10451d3a89d91SMatthias Ringwald     return NULL;
10452d3a89d91SMatthias Ringwald }
10453d3a89d91SMatthias Ringwald 
104545ade6657SMatthias Ringwald static void hci_iso_notify_can_send_now(void){
104552c077771SMatthias Ringwald 
104562c077771SMatthias Ringwald     // BIG
104572c077771SMatthias Ringwald 
104585ade6657SMatthias Ringwald     btstack_linked_list_iterator_t it;
104595ade6657SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->le_audio_bigs);
104605ade6657SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
104615ade6657SMatthias Ringwald         le_audio_big_t * big = (le_audio_big_t *) btstack_linked_list_iterator_next(&it);
10462aacb1081SMatthias Ringwald         // track number completed packet timestamps
10463aacb1081SMatthias Ringwald         if (big->num_completed_timestamp_current_valid){
10464aacb1081SMatthias Ringwald             big->num_completed_timestamp_current_valid = false;
10465aacb1081SMatthias Ringwald             if (big->num_completed_timestamp_previous_valid){
10466aacb1081SMatthias Ringwald                 // detect delayed sending of all BIS: tolerate up to 50% delayed event handling
1046736916f81SDirk Helbig                 int32_t iso_interval_missed_threshold_ms = big->params->sdu_interval_us * 3 / 2000;
10468aacb1081SMatthias Ringwald                 int32_t num_completed_timestamp_delta_ms = btstack_time_delta(big->num_completed_timestamp_current_ms,
10469aacb1081SMatthias Ringwald                                                                                big->num_completed_timestamp_previous_ms);
10470aacb1081SMatthias Ringwald                 if (num_completed_timestamp_delta_ms > iso_interval_missed_threshold_ms){
10471aacb1081SMatthias Ringwald                     // to catch up, skip packet on all BIS
10472aacb1081SMatthias Ringwald                     uint8_t i;
10473aacb1081SMatthias Ringwald                     for (i=0;i<big->num_bis;i++){
10474aacb1081SMatthias Ringwald                         hci_iso_stream_t * iso_stream = hci_iso_stream_for_con_handle(big->bis_con_handles[i]);
10475aacb1081SMatthias Ringwald                         if (iso_stream){
10476aacb1081SMatthias Ringwald                             iso_stream->num_packets_to_skip++;
10477aacb1081SMatthias Ringwald                         }
10478aacb1081SMatthias Ringwald                     }
10479aacb1081SMatthias Ringwald                 }
10480aacb1081SMatthias Ringwald             }
10481aacb1081SMatthias Ringwald             big->num_completed_timestamp_previous_valid = true;
10482aacb1081SMatthias Ringwald             big->num_completed_timestamp_previous_ms = big->num_completed_timestamp_current_ms;
10483aacb1081SMatthias Ringwald         }
10484aacb1081SMatthias Ringwald 
104855ade6657SMatthias Ringwald         if (big->can_send_now_requested){
10486d4e5d4faSMatthias Ringwald             // check if no outgoing iso packets pending and no can send now have to be emitted
104875ade6657SMatthias Ringwald             uint8_t i;
104885ade6657SMatthias Ringwald             bool can_send = true;
10489aacb1081SMatthias Ringwald             uint8_t num_iso_queued_minimum = 0;
104905ade6657SMatthias Ringwald             for (i=0;i<big->num_bis;i++){
104915ade6657SMatthias Ringwald                 hci_iso_stream_t * iso_stream = hci_iso_stream_for_con_handle(big->bis_con_handles[i]);
10492aacb1081SMatthias Ringwald                 if (iso_stream == NULL) continue;
10493aacb1081SMatthias Ringwald                 // handle case where individual ISO packet was sent too late:
10494aacb1081SMatthias Ringwald                 // for each additionally queued packet, a new one needs to get skipped
10495aacb1081SMatthias Ringwald                 if (i==0){
10496aacb1081SMatthias Ringwald                     num_iso_queued_minimum = iso_stream->num_packets_sent;
10497aacb1081SMatthias Ringwald                 } else if (iso_stream->num_packets_sent > num_iso_queued_minimum){
10498aacb1081SMatthias Ringwald                     uint8_t num_packets_to_skip = iso_stream->num_packets_sent - num_iso_queued_minimum;
10499aacb1081SMatthias Ringwald                     iso_stream->num_packets_to_skip += num_packets_to_skip;
10500aacb1081SMatthias Ringwald                     iso_stream->num_packets_sent    -= num_packets_to_skip;
10501aacb1081SMatthias Ringwald                 }
10502aacb1081SMatthias Ringwald                 // check if we can send now
10503aacb1081SMatthias Ringwald                 if  ((iso_stream->num_packets_sent >= hci_stack->iso_packets_to_queue) || (iso_stream->emit_ready_to_send)){
105045ade6657SMatthias Ringwald                     can_send = false;
105055ade6657SMatthias Ringwald                     break;
105065ade6657SMatthias Ringwald                 }
105075ade6657SMatthias Ringwald             }
105085ade6657SMatthias Ringwald             if (can_send){
105095ade6657SMatthias Ringwald                 // propagate can send now to individual streams
105105ade6657SMatthias Ringwald                 big->can_send_now_requested = false;
105115ade6657SMatthias Ringwald                 for (i=0;i<big->num_bis;i++){
105125ade6657SMatthias Ringwald                     hci_iso_stream_t * iso_stream = hci_iso_stream_for_con_handle(big->bis_con_handles[i]);
105135ade6657SMatthias Ringwald                     iso_stream->emit_ready_to_send = true;
105145ade6657SMatthias Ringwald                 }
105155ade6657SMatthias Ringwald             }
105165ade6657SMatthias Ringwald         }
105175ade6657SMatthias Ringwald     }
105185ade6657SMatthias Ringwald 
105195ade6657SMatthias Ringwald     if (hci_stack->hci_packet_buffer_reserved) return;
105205ade6657SMatthias Ringwald 
105215ade6657SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->le_audio_bigs);
105225ade6657SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
105235ade6657SMatthias Ringwald         le_audio_big_t * big = (le_audio_big_t *) btstack_linked_list_iterator_next(&it);
105245ade6657SMatthias Ringwald         // report bis ready
105255ade6657SMatthias Ringwald         uint8_t i;
105265ade6657SMatthias Ringwald         for (i=0;i<big->num_bis;i++){
105275ade6657SMatthias Ringwald             hci_iso_stream_t * iso_stream = hci_iso_stream_for_con_handle(big->bis_con_handles[i]);
105285ade6657SMatthias Ringwald             if ((iso_stream != NULL) && iso_stream->emit_ready_to_send){
105295ade6657SMatthias Ringwald                 iso_stream->emit_ready_to_send = false;
105305ade6657SMatthias Ringwald                 hci_emit_bis_can_send_now(big, i);
105310fc451bcSMatthias Ringwald                 if (hci_stack->hci_packet_buffer_reserved) return;
105325ade6657SMatthias Ringwald             }
105335ade6657SMatthias Ringwald         }
105345ade6657SMatthias Ringwald     }
105352c077771SMatthias Ringwald 
105360fc451bcSMatthias Ringwald 
105372c077771SMatthias Ringwald     // CIS
105382c077771SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->iso_streams);
105392c077771SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)) {
105402c077771SMatthias Ringwald         hci_iso_stream_t *iso_stream = (hci_iso_stream_t *) btstack_linked_list_iterator_next(&it);
105412c077771SMatthias Ringwald         if ((iso_stream->can_send_now_requested) &&
105422c077771SMatthias Ringwald             (iso_stream->num_packets_sent < hci_stack->iso_packets_to_queue)){
105432c077771SMatthias Ringwald             iso_stream->can_send_now_requested = false;
10544969d876aSMatthias Ringwald             hci_emit_cis_can_send_now(iso_stream->cis_handle);
105450fc451bcSMatthias Ringwald             if (hci_stack->hci_packet_buffer_reserved) return;
105462c077771SMatthias Ringwald         }
105472c077771SMatthias Ringwald     }
105485ade6657SMatthias Ringwald }
105495ade6657SMatthias Ringwald 
10550c7308688SMatthias Ringwald static uint8_t gap_big_setup_iso_streams(uint8_t num_bis, uint8_t big_handle){
10551d034696aSMatthias Ringwald     // make big handle unique and usuable for big and big sync
10552c7308688SMatthias Ringwald     if (hci_big_for_handle(big_handle) != NULL){
105537aa35f6aSMatthias Ringwald         return ERROR_CODE_ACL_CONNECTION_ALREADY_EXISTS;
105547aa35f6aSMatthias Ringwald     }
10555c7308688SMatthias Ringwald     if (hci_big_sync_for_handle(big_handle) != NULL){
10556d034696aSMatthias Ringwald         return ERROR_CODE_ACL_CONNECTION_ALREADY_EXISTS;
10557d034696aSMatthias Ringwald     }
10558c7308688SMatthias Ringwald     if (num_bis == 0){
105597aa35f6aSMatthias Ringwald         return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS;
105607aa35f6aSMatthias Ringwald     }
10561c7308688SMatthias Ringwald     if (num_bis > MAX_NR_BIS){
105627aa35f6aSMatthias Ringwald         return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS;
105637aa35f6aSMatthias Ringwald     }
105647aa35f6aSMatthias Ringwald 
10565fb16346aSMatthias Ringwald     // reserve ISO Streams
10566fb16346aSMatthias Ringwald     uint8_t i;
10567fb16346aSMatthias Ringwald     uint8_t status = ERROR_CODE_SUCCESS;
10568c7308688SMatthias Ringwald     for (i=0;i<num_bis;i++){
10569c7308688SMatthias Ringwald         hci_iso_stream_t * iso_stream = hci_iso_stream_create(HCI_ISO_TYPE_BIS, HCI_ISO_STREAM_STATE_REQUESTED, big_handle, i);
10570969d876aSMatthias Ringwald         if (iso_stream == NULL) {
10571969d876aSMatthias Ringwald             status = ERROR_CODE_MEMORY_CAPACITY_EXCEEDED;
10572fb16346aSMatthias Ringwald             break;
10573fb16346aSMatthias Ringwald         }
10574fb16346aSMatthias Ringwald     }
10575fb16346aSMatthias Ringwald 
10576fb16346aSMatthias Ringwald     // free structs on error
10577fb16346aSMatthias Ringwald     if (status != ERROR_CODE_SUCCESS){
10578c7308688SMatthias Ringwald         hci_iso_stream_finalize_by_type_and_group_id(HCI_ISO_TYPE_BIS, big_handle);
10579c7308688SMatthias Ringwald     }
10580c7308688SMatthias Ringwald 
10581c7308688SMatthias Ringwald     return status;
10582c7308688SMatthias Ringwald }
10583c7308688SMatthias Ringwald 
10584c7308688SMatthias Ringwald uint8_t gap_big_create(le_audio_big_t * storage, le_audio_big_params_t * big_params){
10585c7308688SMatthias Ringwald     uint8_t status = gap_big_setup_iso_streams(big_params->num_bis, big_params->big_handle);
10586c7308688SMatthias Ringwald     if (status != ERROR_CODE_SUCCESS){
10587fb16346aSMatthias Ringwald         return status;
10588fb16346aSMatthias Ringwald     }
10589fb16346aSMatthias Ringwald 
105907aa35f6aSMatthias Ringwald     le_audio_big_t * big = storage;
105917aa35f6aSMatthias Ringwald     big->big_handle = big_params->big_handle;
105927aa35f6aSMatthias Ringwald     big->params = big_params;
105937aa35f6aSMatthias Ringwald     big->state = LE_AUDIO_BIG_STATE_CREATE;
105947aa35f6aSMatthias Ringwald     big->num_bis = big_params->num_bis;
105957aa35f6aSMatthias Ringwald     btstack_linked_list_add(&hci_stack->le_audio_bigs, (btstack_linked_item_t *) big);
105967aa35f6aSMatthias Ringwald 
105977aa35f6aSMatthias Ringwald     hci_run();
105987aa35f6aSMatthias Ringwald 
105997aa35f6aSMatthias Ringwald     return ERROR_CODE_SUCCESS;
106007aa35f6aSMatthias Ringwald }
106017aa35f6aSMatthias Ringwald 
106022a6c0f82SMatthias Ringwald uint8_t gap_big_sync_create(le_audio_big_sync_t * storage, le_audio_big_sync_params_t * big_sync_params){
10603c7308688SMatthias Ringwald     uint8_t status = gap_big_setup_iso_streams(big_sync_params->num_bis, big_sync_params->big_handle);
1060402e19895SMatthias Ringwald     if (status != ERROR_CODE_SUCCESS){
1060502e19895SMatthias Ringwald         return status;
1060602e19895SMatthias Ringwald     }
1060702e19895SMatthias Ringwald 
106082a6c0f82SMatthias Ringwald     le_audio_big_sync_t * big_sync = storage;
106092a6c0f82SMatthias Ringwald     big_sync->big_handle = big_sync_params->big_handle;
106102a6c0f82SMatthias Ringwald     big_sync->params = big_sync_params;
106112a6c0f82SMatthias Ringwald     big_sync->state = LE_AUDIO_BIG_STATE_CREATE;
106122a6c0f82SMatthias Ringwald     big_sync->num_bis = big_sync_params->num_bis;
106132a6c0f82SMatthias Ringwald     btstack_linked_list_add(&hci_stack->le_audio_big_syncs, (btstack_linked_item_t *) big_sync);
106142a6c0f82SMatthias Ringwald 
106152a6c0f82SMatthias Ringwald     hci_run();
106162a6c0f82SMatthias Ringwald 
106172a6c0f82SMatthias Ringwald     return ERROR_CODE_SUCCESS;
106182a6c0f82SMatthias Ringwald }
106192a6c0f82SMatthias Ringwald 
106207aa35f6aSMatthias Ringwald uint8_t gap_big_terminate(uint8_t big_handle){
106217aa35f6aSMatthias Ringwald     le_audio_big_t * big = hci_big_for_handle(big_handle);
106227aa35f6aSMatthias Ringwald     if (big == NULL){
106237aa35f6aSMatthias Ringwald         return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
106247aa35f6aSMatthias Ringwald     }
106257aa35f6aSMatthias Ringwald     switch (big->state){
106267aa35f6aSMatthias Ringwald         case LE_AUDIO_BIG_STATE_CREATE:
106277aa35f6aSMatthias Ringwald             btstack_linked_list_remove(&hci_stack->le_audio_bigs, (btstack_linked_item_t *) big);
106282a6c0f82SMatthias Ringwald             hci_emit_big_terminated(big);
106292a6c0f82SMatthias Ringwald             break;
106302a6c0f82SMatthias Ringwald         case LE_AUDIO_BIG_STATE_W4_SETUP_ISO_PATH:
106312a6c0f82SMatthias Ringwald             big->state = LE_AUDIO_BIG_STATE_W4_SETUP_ISO_PATH_THEN_TERMINATE;
106327aa35f6aSMatthias Ringwald             break;
106337aa35f6aSMatthias Ringwald         case LE_AUDIO_BIG_STATE_W4_ESTABLISHED:
106347aa35f6aSMatthias Ringwald         case LE_AUDIO_BIG_STATE_SETUP_ISO_PATH:
106357aa35f6aSMatthias Ringwald         case LE_AUDIO_BIG_STATE_ACTIVE:
106367aa35f6aSMatthias Ringwald             big->state = LE_AUDIO_BIG_STATE_TERMINATE;
106377aa35f6aSMatthias Ringwald             hci_run();
106387aa35f6aSMatthias Ringwald             break;
106392a6c0f82SMatthias Ringwald         default:
106402a6c0f82SMatthias Ringwald             return ERROR_CODE_COMMAND_DISALLOWED;
106412a6c0f82SMatthias Ringwald     }
106422a6c0f82SMatthias Ringwald     return ERROR_CODE_SUCCESS;
106432a6c0f82SMatthias Ringwald }
106442a6c0f82SMatthias Ringwald 
106452a6c0f82SMatthias Ringwald uint8_t gap_big_sync_terminate(uint8_t big_handle){
106462a6c0f82SMatthias Ringwald     le_audio_big_sync_t * big_sync = hci_big_sync_for_handle(big_handle);
106472a6c0f82SMatthias Ringwald     if (big_sync == NULL){
106482a6c0f82SMatthias Ringwald         return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
106492a6c0f82SMatthias Ringwald     }
106502a6c0f82SMatthias Ringwald     switch (big_sync->state){
106512a6c0f82SMatthias Ringwald         case LE_AUDIO_BIG_STATE_CREATE:
106522a6c0f82SMatthias Ringwald             btstack_linked_list_remove(&hci_stack->le_audio_big_syncs, (btstack_linked_item_t *) big_sync);
10653d04a9afcSMatthias Ringwald             hci_emit_big_sync_stopped(big_handle);
106542a6c0f82SMatthias Ringwald             break;
106557aa35f6aSMatthias Ringwald         case LE_AUDIO_BIG_STATE_W4_SETUP_ISO_PATH:
106562a6c0f82SMatthias Ringwald             big_sync->state = LE_AUDIO_BIG_STATE_W4_SETUP_ISO_PATH_THEN_TERMINATE;
106572a6c0f82SMatthias Ringwald             break;
106582a6c0f82SMatthias Ringwald         case LE_AUDIO_BIG_STATE_W4_ESTABLISHED:
106592a6c0f82SMatthias Ringwald         case LE_AUDIO_BIG_STATE_SETUP_ISO_PATH:
106602a6c0f82SMatthias Ringwald         case LE_AUDIO_BIG_STATE_ACTIVE:
106612a6c0f82SMatthias Ringwald             big_sync->state = LE_AUDIO_BIG_STATE_TERMINATE;
106622a6c0f82SMatthias Ringwald             hci_run();
106637aa35f6aSMatthias Ringwald             break;
106647aa35f6aSMatthias Ringwald         default:
106657aa35f6aSMatthias Ringwald             return ERROR_CODE_COMMAND_DISALLOWED;
106667aa35f6aSMatthias Ringwald     }
106677aa35f6aSMatthias Ringwald     return ERROR_CODE_SUCCESS;
106687aa35f6aSMatthias Ringwald }
10669d39e4f95SMatthias Ringwald 
106705ade6657SMatthias Ringwald uint8_t hci_request_bis_can_send_now_events(uint8_t big_handle){
106715ade6657SMatthias Ringwald     le_audio_big_t * big = hci_big_for_handle(big_handle);
106725ade6657SMatthias Ringwald     if (big == NULL){
106735ade6657SMatthias Ringwald         return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
106745ade6657SMatthias Ringwald     }
106755ade6657SMatthias Ringwald     if (big->state != LE_AUDIO_BIG_STATE_ACTIVE){
106765ade6657SMatthias Ringwald         return ERROR_CODE_COMMAND_DISALLOWED;
106775ade6657SMatthias Ringwald     }
106785ade6657SMatthias Ringwald     big->can_send_now_requested = true;
106795ade6657SMatthias Ringwald     hci_iso_notify_can_send_now();
106805ade6657SMatthias Ringwald     return ERROR_CODE_SUCCESS;
106815ade6657SMatthias Ringwald }
10682d3a89d91SMatthias Ringwald 
106832c077771SMatthias Ringwald uint8_t hci_request_cis_can_send_now_events(hci_con_handle_t cis_con_handle){
106842c077771SMatthias Ringwald     hci_iso_stream_t * iso_stream = hci_iso_stream_for_con_handle(cis_con_handle);
106852c077771SMatthias Ringwald     if (iso_stream == NULL){
106862c077771SMatthias Ringwald         return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
106872c077771SMatthias Ringwald     }
106882c077771SMatthias Ringwald     if ((iso_stream->iso_type != HCI_ISO_TYPE_CIS) && (iso_stream->state != HCI_ISO_STREAM_STATE_ESTABLISHED)) {
106892c077771SMatthias Ringwald         return ERROR_CODE_COMMAND_DISALLOWED;
106902c077771SMatthias Ringwald     }
106912c077771SMatthias Ringwald     iso_stream->can_send_now_requested = true;
106922c077771SMatthias Ringwald     hci_iso_notify_can_send_now();
106932c077771SMatthias Ringwald     return ERROR_CODE_SUCCESS;
106942c077771SMatthias Ringwald }
106952c077771SMatthias Ringwald 
10696d3a89d91SMatthias Ringwald uint8_t gap_cig_create(le_audio_cig_t * storage, le_audio_cig_params_t * cig_params){
10697d3a89d91SMatthias Ringwald     if (hci_cig_for_id(cig_params->cig_id) != NULL){
10698d3a89d91SMatthias Ringwald         return ERROR_CODE_ACL_CONNECTION_ALREADY_EXISTS;
10699d3a89d91SMatthias Ringwald     }
10700d3a89d91SMatthias Ringwald     if (cig_params->num_cis == 0){
10701d3a89d91SMatthias Ringwald         return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS;
10702d3a89d91SMatthias Ringwald     }
107033e377057SMatthias Ringwald     if (cig_params->num_cis > MAX_NR_CIS){
10704d3a89d91SMatthias Ringwald         return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS;
10705d3a89d91SMatthias Ringwald     }
10706d3a89d91SMatthias Ringwald 
10707d3a89d91SMatthias Ringwald     // reserve ISO Streams
10708d3a89d91SMatthias Ringwald     uint8_t i;
10709d3a89d91SMatthias Ringwald     uint8_t status = ERROR_CODE_SUCCESS;
10710d3a89d91SMatthias Ringwald     for (i=0;i<cig_params->num_cis;i++){
10711969d876aSMatthias 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);
1071236468e6fSMatthias Ringwald         if (iso_stream == NULL) {
10713969d876aSMatthias Ringwald             status = ERROR_CODE_MEMORY_CAPACITY_EXCEEDED;
10714d3a89d91SMatthias Ringwald             break;
10715d3a89d91SMatthias Ringwald         }
10716d3a89d91SMatthias Ringwald     }
10717d3a89d91SMatthias Ringwald 
10718d3a89d91SMatthias Ringwald     // free structs on error
10719d3a89d91SMatthias Ringwald     if (status != ERROR_CODE_SUCCESS){
10720d3a89d91SMatthias Ringwald         hci_iso_stream_finalize_by_type_and_group_id(HCI_ISO_TYPE_CIS, cig_params->cig_id);
10721d3a89d91SMatthias Ringwald         return status;
10722d3a89d91SMatthias Ringwald     }
10723d3a89d91SMatthias Ringwald 
10724d3a89d91SMatthias Ringwald     le_audio_cig_t * cig = storage;
10725d3a89d91SMatthias Ringwald     cig->cig_id = cig_params->cig_id;
10726d3a89d91SMatthias Ringwald     cig->num_cis = cig_params->num_cis;
10727d3a89d91SMatthias Ringwald     cig->params = cig_params;
10728d3a89d91SMatthias Ringwald     cig->state = LE_AUDIO_CIG_STATE_CREATE;
10729444e371eSMatthias Ringwald     for (i=0;i<cig->num_cis;i++){
10730444e371eSMatthias Ringwald         cig->cis_con_handles[i] = HCI_CON_HANDLE_INVALID;
10731444e371eSMatthias Ringwald         cig->acl_con_handles[i] = HCI_CON_HANDLE_INVALID;
107320f0ba168SMatthias Ringwald         cig->cis_setup_active[i] = false;
107330f0ba168SMatthias Ringwald         cig->cis_established[i] = false;
10734444e371eSMatthias Ringwald     }
10735d3a89d91SMatthias Ringwald     btstack_linked_list_add(&hci_stack->le_audio_cigs, (btstack_linked_item_t *) cig);
10736d3a89d91SMatthias Ringwald 
10737d3a89d91SMatthias Ringwald     hci_run();
10738d3a89d91SMatthias Ringwald 
10739d3a89d91SMatthias Ringwald     return ERROR_CODE_SUCCESS;
10740d3a89d91SMatthias Ringwald }
10741d3a89d91SMatthias Ringwald 
10742d90722d4SMatthias Ringwald uint8_t gap_cig_remove(uint8_t cig_id){
10743d90722d4SMatthias Ringwald     le_audio_cig_t * cig = hci_cig_for_id(cig_id);
10744d90722d4SMatthias Ringwald     if (cig == NULL){
10745d90722d4SMatthias Ringwald         return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
10746d90722d4SMatthias Ringwald     }
10747d90722d4SMatthias Ringwald 
10748d90722d4SMatthias Ringwald     // close active CIS
10749d90722d4SMatthias Ringwald     uint8_t i;
10750d90722d4SMatthias Ringwald     for (i=0;i<cig->num_cis;i++){
10751d90722d4SMatthias Ringwald         hci_iso_stream_t * stream = hci_iso_stream_for_con_handle(cig->cis_con_handles[i]);
10752d90722d4SMatthias Ringwald         if (stream != NULL){
10753d90722d4SMatthias Ringwald             stream->state = HCI_ISO_STREAM_STATE_W2_CLOSE;
10754d90722d4SMatthias Ringwald         }
10755d90722d4SMatthias Ringwald     }
10756d90722d4SMatthias Ringwald     cig->state = LE_AUDIO_CIG_STATE_REMOVE;
10757d90722d4SMatthias Ringwald 
10758d90722d4SMatthias Ringwald     hci_run();
10759d90722d4SMatthias Ringwald 
10760d90722d4SMatthias Ringwald     return ERROR_CODE_SUCCESS;
10761d90722d4SMatthias Ringwald }
10762d90722d4SMatthias Ringwald 
10763f2e409f3SMatthias Ringwald uint8_t gap_cis_create(uint8_t cig_id, hci_con_handle_t cis_con_handles [], hci_con_handle_t acl_con_handles []){
10764f2e409f3SMatthias Ringwald     le_audio_cig_t * cig = hci_cig_for_id(cig_id);
10765444e371eSMatthias Ringwald     if (cig == NULL){
10766444e371eSMatthias Ringwald         return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
10767444e371eSMatthias Ringwald     }
10768444e371eSMatthias Ringwald 
10769444e371eSMatthias Ringwald     if (cig->state != LE_AUDIO_CIG_STATE_W4_CIS_REQUEST){
10770444e371eSMatthias Ringwald         return ERROR_CODE_COMMAND_DISALLOWED;
10771444e371eSMatthias Ringwald     }
10772444e371eSMatthias Ringwald 
10773444e371eSMatthias Ringwald     // store ACL Connection Handles
10774444e371eSMatthias Ringwald     uint8_t i;
10775444e371eSMatthias Ringwald     for (i=0;i<cig->num_cis;i++){
1077656bd2ec0SMatthias Ringwald         // check that all con handles exist and store
10777444e371eSMatthias Ringwald         hci_con_handle_t cis_handle = cis_con_handles[i];
1077836468e6fSMatthias Ringwald         if (cis_handle == HCI_CON_HANDLE_INVALID){
1077936468e6fSMatthias Ringwald             return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
1078036468e6fSMatthias Ringwald         }
10781444e371eSMatthias Ringwald         uint8_t j;
10782444e371eSMatthias Ringwald         bool found = false;
10783444e371eSMatthias Ringwald         for (j=0;j<cig->num_cis;j++){
10784444e371eSMatthias Ringwald             if (cig->cis_con_handles[j] == cis_handle){
10785444e371eSMatthias Ringwald                 cig->acl_con_handles[j] = acl_con_handles[j];
1078656bd2ec0SMatthias Ringwald                 hci_iso_stream_t * iso_stream = hci_iso_stream_for_con_handle(cis_handle);
1078756bd2ec0SMatthias Ringwald                 btstack_assert(iso_stream != NULL);
1078856bd2ec0SMatthias Ringwald                 iso_stream->acl_handle = acl_con_handles[j];
1078936468e6fSMatthias Ringwald                 found = true;
10790444e371eSMatthias Ringwald                 break;
10791444e371eSMatthias Ringwald             }
10792444e371eSMatthias Ringwald         }
10793444e371eSMatthias Ringwald         if (!found){
10794444e371eSMatthias Ringwald             return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
10795444e371eSMatthias Ringwald         }
10796444e371eSMatthias Ringwald     }
10797444e371eSMatthias Ringwald 
10798444e371eSMatthias Ringwald     cig->state = LE_AUDIO_CIG_STATE_CREATE_CIS;
10799444e371eSMatthias Ringwald     hci_run();
10800444e371eSMatthias Ringwald 
10801444e371eSMatthias Ringwald     return ERROR_CODE_SUCCESS;
10802444e371eSMatthias Ringwald }
10803444e371eSMatthias Ringwald 
10804969d876aSMatthias Ringwald static uint8_t hci_cis_accept_or_reject(hci_con_handle_t cis_handle, hci_iso_stream_state_t state){
10805969d876aSMatthias Ringwald     hci_iso_stream_t * iso_stream = hci_iso_stream_for_con_handle(cis_handle);
108066fd1d2c8SMatthias Ringwald     if (iso_stream == NULL){
108076fd1d2c8SMatthias Ringwald         // if we got a CIS Request but fail to allocate a hci_iso_stream_t object, we won't find it here
10808969d876aSMatthias Ringwald         return ERROR_CODE_MEMORY_CAPACITY_EXCEEDED;
1080926b93350SMatthias Ringwald     }
1081026b93350SMatthias Ringwald 
108116fd1d2c8SMatthias Ringwald     // set next state and continue
108126fd1d2c8SMatthias Ringwald     iso_stream->state = state;
1081326b93350SMatthias Ringwald     hci_run();
1081426b93350SMatthias Ringwald     return ERROR_CODE_SUCCESS;
1081526b93350SMatthias Ringwald }
1081626b93350SMatthias Ringwald 
1081726b93350SMatthias Ringwald uint8_t gap_cis_accept(hci_con_handle_t cis_con_handle){
1081826b93350SMatthias Ringwald     return hci_cis_accept_or_reject(cis_con_handle, HCI_ISO_STREAM_W2_ACCEPT);
1081926b93350SMatthias Ringwald }
1082026b93350SMatthias Ringwald 
1082126b93350SMatthias Ringwald uint8_t gap_cis_reject(hci_con_handle_t cis_con_handle){
1082226b93350SMatthias Ringwald     return hci_cis_accept_or_reject(cis_con_handle, HCI_ISO_STREAM_W2_REJECT);
1082326b93350SMatthias Ringwald }
1082426b93350SMatthias Ringwald 
10825137a570aSMatthias Ringwald #endif /* ENABLE_LE_ISOCHRONOUS_STREAMS */
1082626b93350SMatthias Ringwald 
10827137a570aSMatthias Ringwald // GAP Privacy - notify clients before random address update
10828137a570aSMatthias Ringwald 
10829137a570aSMatthias Ringwald static bool gap_privacy_client_all_ready(void){
10830137a570aSMatthias Ringwald     // check if all ready
10831137a570aSMatthias Ringwald     btstack_linked_list_iterator_t it;
10832137a570aSMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->gap_privacy_clients);
10833137a570aSMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)) {
10834137a570aSMatthias Ringwald         gap_privacy_client_t *client = (gap_privacy_client_t *) btstack_linked_list_iterator_next(&it);
10835137a570aSMatthias Ringwald         if (client->state != GAP_PRIVACY_CLIENT_STATE_READY){
10836137a570aSMatthias Ringwald             return false;
10837137a570aSMatthias Ringwald         }
10838137a570aSMatthias Ringwald     }
10839137a570aSMatthias Ringwald     return true;
10840137a570aSMatthias Ringwald }
10841137a570aSMatthias Ringwald 
10842137a570aSMatthias Ringwald static void gap_privacy_clients_handle_ready(void){
10843137a570aSMatthias Ringwald     // clear 'ready'
10844137a570aSMatthias Ringwald     btstack_linked_list_iterator_t it;
10845137a570aSMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->gap_privacy_clients);
10846137a570aSMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)) {
10847137a570aSMatthias Ringwald         gap_privacy_client_t *client = (gap_privacy_client_t *) btstack_linked_list_iterator_next(&it);
10848137a570aSMatthias Ringwald         client->state = GAP_PRIVACY_CLIENT_STATE_IDLE;
10849137a570aSMatthias Ringwald     }
10850137a570aSMatthias Ringwald     hci_stack->le_advertisements_state &= ~LE_ADVERTISEMENT_STATE_PRIVACY_PENDING;
10851137a570aSMatthias Ringwald     hci_run();
10852137a570aSMatthias Ringwald }
10853137a570aSMatthias Ringwald 
10854137a570aSMatthias Ringwald static void gap_privacy_clients_notify(bd_addr_t new_random_address){
10855137a570aSMatthias Ringwald     btstack_linked_list_iterator_t it;
10856137a570aSMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->gap_privacy_clients);
10857137a570aSMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)) {
10858137a570aSMatthias Ringwald         gap_privacy_client_t *client = (gap_privacy_client_t *) btstack_linked_list_iterator_next(&it);
10859137a570aSMatthias Ringwald         if (client->state == GAP_PRIVACY_CLIENT_STATE_IDLE){
10860137a570aSMatthias Ringwald             client->state = GAP_PRIVACY_CLIENT_STATE_PENDING;
10861137a570aSMatthias Ringwald             (*client->callback)(client, new_random_address);
10862137a570aSMatthias Ringwald         }
10863137a570aSMatthias Ringwald     }
10864137a570aSMatthias Ringwald     if (gap_privacy_client_all_ready()){
10865137a570aSMatthias Ringwald         gap_privacy_clients_handle_ready();
10866137a570aSMatthias Ringwald     }
10867137a570aSMatthias Ringwald }
10868137a570aSMatthias Ringwald 
10869137a570aSMatthias Ringwald void gap_privacy_client_register(gap_privacy_client_t * client){
10870137a570aSMatthias Ringwald     client->state = GAP_PRIVACY_CLIENT_STATE_IDLE;
10871137a570aSMatthias Ringwald     btstack_linked_list_add(&hci_stack->gap_privacy_clients, (btstack_linked_item_t *) client);
10872137a570aSMatthias Ringwald }
10873137a570aSMatthias Ringwald 
10874137a570aSMatthias Ringwald void gap_privacy_client_ready(gap_privacy_client_t * client){
10875137a570aSMatthias Ringwald     client->state = GAP_PRIVACY_CLIENT_STATE_READY;
10876137a570aSMatthias Ringwald     if (gap_privacy_client_all_ready()){
10877137a570aSMatthias Ringwald         gap_privacy_clients_handle_ready();
10878137a570aSMatthias Ringwald     }
10879137a570aSMatthias Ringwald }
10880137a570aSMatthias Ringwald 
10881137a570aSMatthias Ringwald void gap_privacy_client_unregister(gap_privacy_client_t * client){
10882137a570aSMatthias Ringwald     btstack_linked_list_remove(&hci_stack->gap_privacy_clients, (btstack_linked_item_t *) client);
10883137a570aSMatthias Ringwald }
10884137a570aSMatthias Ringwald 
108854ae8623eSMatthias Ringwald #endif /* ENABLE_BLE */
10886f40c73b4SMatthias Ringwald 
10887eddac615SMatthias Ringwald #ifdef FUZZING_BUILD_MODE_UNSAFE_FOR_PRODUCTION
1088818976c74SMatthias Ringwald void hci_setup_test_connections_fuzz(void){
1088918976c74SMatthias Ringwald     hci_connection_t * conn;
1089018976c74SMatthias Ringwald 
1089118976c74SMatthias Ringwald     // default address: 66:55:44:33:00:01
1089218976c74SMatthias Ringwald     bd_addr_t addr = { 0x66, 0x55, 0x44, 0x33, 0x00, 0x00};
1089318976c74SMatthias Ringwald 
108947d33cb26SMilanka Ringwald     // setup Controller info
108957d33cb26SMilanka Ringwald     hci_stack->num_cmd_packets = 255;
108967d33cb26SMilanka Ringwald     hci_stack->acl_packets_total_num = 255;
108977d33cb26SMilanka Ringwald 
1089818976c74SMatthias Ringwald     // setup incoming Classic ACL connection with con handle 0x0001, 66:55:44:33:22:01
1089918976c74SMatthias Ringwald     addr[5] = 0x01;
1090017ab8643SMatthias Ringwald     conn = create_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL, HCI_ROLE_SLAVE);
1090118976c74SMatthias Ringwald     conn->con_handle = addr[5];
1090218976c74SMatthias Ringwald     conn->state = RECEIVED_CONNECTION_REQUEST;
109037d33cb26SMilanka Ringwald     conn->sm_connection.sm_role = HCI_ROLE_SLAVE;
1090418976c74SMatthias Ringwald 
1090518976c74SMatthias Ringwald     // setup incoming Classic SCO connection with con handle 0x0002
1090618976c74SMatthias Ringwald     addr[5] = 0x02;
1090717ab8643SMatthias Ringwald     conn = create_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_SCO, HCI_ROLE_SLAVE);
1090818976c74SMatthias Ringwald     conn->con_handle = addr[5];
1090918976c74SMatthias Ringwald     conn->state = RECEIVED_CONNECTION_REQUEST;
109107d33cb26SMilanka Ringwald     conn->sm_connection.sm_role = HCI_ROLE_SLAVE;
1091118976c74SMatthias Ringwald 
1091218976c74SMatthias Ringwald     // setup ready Classic ACL connection with con handle 0x0003
1091318976c74SMatthias Ringwald     addr[5] = 0x03;
1091417ab8643SMatthias Ringwald     conn = create_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL, HCI_ROLE_SLAVE);
1091518976c74SMatthias Ringwald     conn->con_handle = addr[5];
1091618976c74SMatthias Ringwald     conn->state = OPEN;
109177d33cb26SMilanka Ringwald     conn->sm_connection.sm_role = HCI_ROLE_SLAVE;
1091818976c74SMatthias Ringwald 
1091918976c74SMatthias Ringwald     // setup ready Classic SCO connection with con handle 0x0004
1092018976c74SMatthias Ringwald     addr[5] = 0x04;
1092117ab8643SMatthias Ringwald     conn = create_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_SCO, HCI_ROLE_SLAVE);
1092218976c74SMatthias Ringwald     conn->con_handle = addr[5];
1092318976c74SMatthias Ringwald     conn->state = OPEN;
109247d33cb26SMilanka Ringwald     conn->sm_connection.sm_role = HCI_ROLE_SLAVE;
1092518976c74SMatthias Ringwald 
1092618976c74SMatthias Ringwald     // setup ready LE ACL connection with con handle 0x005 and public address
1092718976c74SMatthias Ringwald     addr[5] = 0x05;
1092817ab8643SMatthias Ringwald     conn = create_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_LE_PUBLIC, HCI_ROLE_SLAVE);
1092918976c74SMatthias Ringwald     conn->con_handle = addr[5];
1093018976c74SMatthias Ringwald     conn->state = OPEN;
109317d33cb26SMilanka Ringwald     conn->sm_connection.sm_role = HCI_ROLE_SLAVE;
109328046a24aSMatthias Ringwald     conn->sm_connection.sm_connection_encrypted = 1;
1093318976c74SMatthias Ringwald }
1093418976c74SMatthias Ringwald 
10935eddac615SMatthias Ringwald void hci_free_connections_fuzz(void){
10936eddac615SMatthias Ringwald     btstack_linked_list_iterator_t it;
10937eddac615SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->connections);
10938eddac615SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
10939eddac615SMatthias Ringwald         hci_connection_t * con = (hci_connection_t*) btstack_linked_list_iterator_next(&it);
10940eddac615SMatthias Ringwald         btstack_linked_list_iterator_remove(&it);
10941eddac615SMatthias Ringwald         btstack_memory_hci_connection_free(con);
10942eddac615SMatthias Ringwald     }
10943eddac615SMatthias Ringwald }
109441470db0cSMatthias Ringwald void hci_simulate_working_fuzz(void){
10945b6ffb67fSMatthias Ringwald     hci_stack->le_scanning_param_update = false;
109461470db0cSMatthias Ringwald     hci_init_done();
109471470db0cSMatthias Ringwald     hci_stack->num_cmd_packets = 255;
109481470db0cSMatthias Ringwald }
10949eddac615SMatthias Ringwald #endif
10950