xref: /btstack/src/hci.c (revision c1281a25f93a8bcd77e18e17314d9a374e5a068f)
11f504dbdSmatthias.ringwald /*
2a0c35809S[email protected]  * Copyright (C) 2014 BlueKitchen GmbH
31713bceaSmatthias.ringwald  *
41713bceaSmatthias.ringwald  * Redistribution and use in source and binary forms, with or without
51713bceaSmatthias.ringwald  * modification, are permitted provided that the following conditions
61713bceaSmatthias.ringwald  * are met:
71713bceaSmatthias.ringwald  *
81713bceaSmatthias.ringwald  * 1. Redistributions of source code must retain the above copyright
91713bceaSmatthias.ringwald  *    notice, this list of conditions and the following disclaimer.
101713bceaSmatthias.ringwald  * 2. Redistributions in binary form must reproduce the above copyright
111713bceaSmatthias.ringwald  *    notice, this list of conditions and the following disclaimer in the
121713bceaSmatthias.ringwald  *    documentation and/or other materials provided with the distribution.
131713bceaSmatthias.ringwald  * 3. Neither the name of the copyright holders nor the names of
141713bceaSmatthias.ringwald  *    contributors may be used to endorse or promote products derived
151713bceaSmatthias.ringwald  *    from this software without specific prior written permission.
166b64433eSmatthias.ringwald  * 4. Any redistribution, use, or modification is done solely for
176b64433eSmatthias.ringwald  *    personal benefit and not for any commercial purpose or for
186b64433eSmatthias.ringwald  *    monetary gain.
191713bceaSmatthias.ringwald  *
20a0c35809S[email protected]  * THIS SOFTWARE IS PROVIDED BY BLUEKITCHEN GMBH AND CONTRIBUTORS
211713bceaSmatthias.ringwald  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
221713bceaSmatthias.ringwald  * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
232fca4dadSMilanka Ringwald  * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL BLUEKITCHEN
242fca4dadSMilanka Ringwald  * GMBH OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
251713bceaSmatthias.ringwald  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
261713bceaSmatthias.ringwald  * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
271713bceaSmatthias.ringwald  * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
281713bceaSmatthias.ringwald  * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
291713bceaSmatthias.ringwald  * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF
301713bceaSmatthias.ringwald  * THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
311713bceaSmatthias.ringwald  * SUCH DAMAGE.
321713bceaSmatthias.ringwald  *
33a0c35809S[email protected]  * Please inquire about commercial licensing options at
34a0c35809S[email protected]  * [email protected]
356b64433eSmatthias.ringwald  *
361713bceaSmatthias.ringwald  */
371713bceaSmatthias.ringwald 
38e501bae0SMatthias Ringwald #define BTSTACK_FILE__ "hci.c"
39ab2c6ae4SMatthias Ringwald 
401713bceaSmatthias.ringwald /*
411f504dbdSmatthias.ringwald  *  hci.c
421f504dbdSmatthias.ringwald  *
431f504dbdSmatthias.ringwald  *  Created by Matthias Ringwald on 4/29/09.
441f504dbdSmatthias.ringwald  *
451f504dbdSmatthias.ringwald  */
461f504dbdSmatthias.ringwald 
477907f069SMatthias Ringwald #include "btstack_config.h"
4828171530Smatthias.ringwald 
497f2435e6Smatthias.ringwald 
5006b9e820SMatthias Ringwald #ifdef ENABLE_CLASSIC
51aec7654dSMatthias Ringwald #ifdef HAVE_EMBEDDED_TICK
528f2a52f4SMatthias Ringwald #include "btstack_run_loop_embedded.h"
53a484130cSMatthias Ringwald #endif
5406b9e820SMatthias Ringwald #endif
55a484130cSMatthias Ringwald 
56a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE
57472a5742SMatthias Ringwald #include "gap.h"
5821debf25SMatthias Ringwald #include "ble/le_device_db.h"
5945c102fdSMatthias Ringwald #endif
6045c102fdSMatthias Ringwald 
6193b8dc03Smatthias.ringwald #include <stdarg.h>
6293b8dc03Smatthias.ringwald #include <string.h>
635838a2edSMatthias Ringwald #include <inttypes.h>
647f2435e6Smatthias.ringwald 
6516ece135SMatthias Ringwald #include "btstack_debug.h"
660e2df43fSMatthias Ringwald #include "btstack_event.h"
674a3574a1SMatthias Ringwald #include "btstack_linked_list.h"
684a3574a1SMatthias Ringwald #include "btstack_memory.h"
6961f37892SMatthias Ringwald #include "bluetooth_company_id.h"
701cfb383eSMatthias Ringwald #include "bluetooth_data_types.h"
714a3574a1SMatthias Ringwald #include "gap.h"
724a3574a1SMatthias Ringwald #include "hci.h"
734a3574a1SMatthias Ringwald #include "hci_cmd.h"
74d8905019Smatthias.ringwald #include "hci_dump.h"
751cfb383eSMatthias Ringwald #include "ad_parser.h"
7693b8dc03Smatthias.ringwald 
778ad9cf99SMatthias Ringwald #ifdef ENABLE_CONTROLLER_DUMP_PACKETS
788ad9cf99SMatthias Ringwald #include <stdio.h>  // sprintf
798ad9cf99SMatthias Ringwald #endif
808ad9cf99SMatthias Ringwald 
812b838201SMatthias Ringwald #ifdef ENABLE_HCI_CONTROLLER_TO_HOST_FLOW_CONTROL
822b838201SMatthias Ringwald #ifndef HCI_HOST_ACL_PACKET_NUM
832b838201SMatthias Ringwald #error "ENABLE_HCI_CONTROLLER_TO_HOST_FLOW_CONTROL requires to define HCI_HOST_ACL_PACKET_NUM"
842b838201SMatthias Ringwald #endif
852b838201SMatthias Ringwald #ifndef HCI_HOST_ACL_PACKET_LEN
862b838201SMatthias Ringwald #error "ENABLE_HCI_CONTROLLER_TO_HOST_FLOW_CONTROL requires to define HCI_HOST_ACL_PACKET_LEN"
872b838201SMatthias Ringwald #endif
882b838201SMatthias Ringwald #ifndef HCI_HOST_SCO_PACKET_NUM
892b838201SMatthias Ringwald #error "ENABLE_HCI_CONTROLLER_TO_HOST_FLOW_CONTROL requires to define HCI_HOST_SCO_PACKET_NUM"
902b838201SMatthias Ringwald #endif
912b838201SMatthias Ringwald #ifndef HCI_HOST_SCO_PACKET_LEN
922b838201SMatthias Ringwald #error "ENABLE_HCI_CONTROLLER_TO_HOST_FLOW_CONTROL requires to define HCI_HOST_SCO_PACKET_LEN"
932b838201SMatthias Ringwald #endif
942b838201SMatthias Ringwald #endif
951b0e3922Smatthias.ringwald 
96616cfd90SMatthias Ringwald #ifndef MAX_NR_CONTROLLER_ACL_BUFFERS
97616cfd90SMatthias Ringwald #define MAX_NR_CONTROLLER_ACL_BUFFERS 255
98616cfd90SMatthias Ringwald #endif
99616cfd90SMatthias Ringwald #ifndef MAX_NR_CONTROLLER_SCO_PACKETS
100616cfd90SMatthias Ringwald #define MAX_NR_CONTROLLER_SCO_PACKETS 255
101616cfd90SMatthias Ringwald #endif
102616cfd90SMatthias Ringwald 
1036bcf18c2SMatthias Ringwald #ifndef HCI_ACL_CHUNK_SIZE_ALIGNMENT
1046bcf18c2SMatthias Ringwald #define HCI_ACL_CHUNK_SIZE_ALIGNMENT 1
1056bcf18c2SMatthias Ringwald #endif
1066bcf18c2SMatthias Ringwald 
107aa81e641SMatthias Ringwald #if defined(ENABLE_SCO_OVER_HCI) && defined(ENABLE_SCO_OVER_PCM)
108aa81e641SMatthias Ringwald #error "SCO data can either be routed over HCI or over PCM, but not over both. Please only enable ENABLE_SCO_OVER_HCI or ENABLE_SCO_OVER_PCM."
109aa81e641SMatthias Ringwald #endif
110aa81e641SMatthias Ringwald 
1111e20a53eSMatthias Ringwald #if defined(ENABLE_SCO_OVER_HCI) && defined(HAVE_SCO_TRANSPORT)
1121e20a53eSMatthias Ringwald #error "SCO data can either be routed over HCI or over PCM, but not over both. Please only enable ENABLE_SCO_OVER_HCI or HAVE_SCO_TRANSPORT."
1131e20a53eSMatthias Ringwald #endif
1141e20a53eSMatthias Ringwald 
115169f8b28Smatthias.ringwald #define HCI_CONNECTION_TIMEOUT_MS 10000
11662473419SMatthias Ringwald 
11762473419SMatthias Ringwald #ifndef HCI_RESET_RESEND_TIMEOUT_MS
118659d758cSMatthias Ringwald #define HCI_RESET_RESEND_TIMEOUT_MS 200
11962473419SMatthias Ringwald #endif
120ee091cf1Smatthias.ringwald 
1211cfb383eSMatthias Ringwald // Names are arbitrarily shortened to 32 bytes if not requested otherwise
1221cfb383eSMatthias Ringwald #ifndef GAP_INQUIRY_MAX_NAME_LEN
1231cfb383eSMatthias Ringwald #define GAP_INQUIRY_MAX_NAME_LEN 32
1241cfb383eSMatthias Ringwald #endif
1251cfb383eSMatthias Ringwald 
126f5875de5SMatthias Ringwald // GAP inquiry state: 0 = off, 0x01 - 0x30 = requested duration, 0xfe = active, 0xff = stop requested
127f5875de5SMatthias Ringwald #define GAP_INQUIRY_DURATION_MIN       0x01
128f5875de5SMatthias Ringwald #define GAP_INQUIRY_DURATION_MAX       0x30
12930199e24SMatthias Ringwald #define GAP_INQUIRY_MIN_PERIODIC_LEN_MIN 0x02
13030199e24SMatthias Ringwald #define GAP_INQUIRY_MAX_PERIODIC_LEN_MIN 0x03
131beb3c81dSMatthias Ringwald #define GAP_INQUIRY_STATE_IDLE         0x00
132beb3c81dSMatthias Ringwald #define GAP_INQUIRY_STATE_W4_ACTIVE    0x80
133beb3c81dSMatthias Ringwald #define GAP_INQUIRY_STATE_ACTIVE       0x81
134beb3c81dSMatthias Ringwald #define GAP_INQUIRY_STATE_W2_CANCEL    0x82
135beb3c81dSMatthias Ringwald #define GAP_INQUIRY_STATE_W4_CANCELLED 0x83
13630199e24SMatthias Ringwald #define GAP_INQUIRY_STATE_PERIODIC     0x84
13730199e24SMatthias Ringwald #define GAP_INQUIRY_STATE_W2_EXIT_PERIODIC 0x85
138f5875de5SMatthias Ringwald 
139b7f1ee76SMatthias Ringwald // GAP Remote Name Request
140b7f1ee76SMatthias Ringwald #define GAP_REMOTE_NAME_STATE_IDLE 0
141b7f1ee76SMatthias Ringwald #define GAP_REMOTE_NAME_STATE_W2_SEND 1
142b7f1ee76SMatthias Ringwald #define GAP_REMOTE_NAME_STATE_W4_COMPLETE 2
143b7f1ee76SMatthias Ringwald 
1440a51f88bSMatthias Ringwald // GAP Pairing
1450a51f88bSMatthias Ringwald #define GAP_PAIRING_STATE_IDLE                       0
1460a51f88bSMatthias Ringwald #define GAP_PAIRING_STATE_SEND_PIN                   1
1470a51f88bSMatthias Ringwald #define GAP_PAIRING_STATE_SEND_PIN_NEGATIVE          2
1480a51f88bSMatthias Ringwald #define GAP_PAIRING_STATE_SEND_PASSKEY               3
1490a51f88bSMatthias Ringwald #define GAP_PAIRING_STATE_SEND_PASSKEY_NEGATIVE      4
1500a51f88bSMatthias Ringwald #define GAP_PAIRING_STATE_SEND_CONFIRMATION          5
1510a51f88bSMatthias Ringwald #define GAP_PAIRING_STATE_SEND_CONFIRMATION_NEGATIVE 6
152cc15bb2cSMatthias Ringwald #define GAP_PAIRING_STATE_WAIT_FOR_COMMAND_COMPLETE  7
1530a51f88bSMatthias Ringwald 
15425e46151SMatthias Ringwald //
1559ce37759SMatthias Ringwald // compact storage of relevant supported HCI Commands.
1569ce37759SMatthias Ringwald // X-Macro below provides enumeration and mapping table into the supported
15725e46151SMatthias Ringwald // commands bitmap (64 bytes) from HCI Read Local Supported Commands
15825e46151SMatthias Ringwald //
15925e46151SMatthias Ringwald 
16025e46151SMatthias Ringwald // format: command name, byte offset, bit nr in 64-byte supported commands
1618c021356SMatthias Ringwald // currently stored in 32-bit variable
16225e46151SMatthias Ringwald #define SUPPORTED_HCI_COMMANDS \
1639ce37759SMatthias Ringwald     X( SUPPORTED_HCI_COMMAND_READ_REMOTE_EXTENDED_FEATURES         ,  2, 5) \
16425e46151SMatthias Ringwald     X( SUPPORTED_HCI_COMMAND_WRITE_SYNCHRONOUS_FLOW_CONTROL_ENABLE , 10, 4) \
1659ce37759SMatthias Ringwald     X( SUPPORTED_HCI_COMMAND_READ_BUFFER_SIZE                      , 14, 7) \
16625e46151SMatthias Ringwald     X( SUPPORTED_HCI_COMMAND_WRITE_DEFAULT_ERRONEOUS_DATA_REPORTING, 18, 3) \
1679ce37759SMatthias Ringwald     X( SUPPORTED_HCI_COMMAND_READ_ENCRYPTION_KEY_SIZE              , 20, 4) \
168ff7d1758SMatthias Ringwald     X( SUPPORTED_HCI_COMMAND_SET_EVENT_MASK_PAGE_2                 , 22, 2) \
1699ce37759SMatthias Ringwald     X( SUPPORTED_HCI_COMMAND_WRITE_LE_HOST_SUPPORTED               , 24, 6) \
1709ce37759SMatthias Ringwald     X( SUPPORTED_HCI_COMMAND_REMOTE_OOB_EXTENDED_DATA_REQUEST_REPLY, 32, 1) \
1719ce37759SMatthias Ringwald     X( SUPPORTED_HCI_COMMAND_WRITE_SECURE_CONNECTIONS_HOST         , 32, 3) \
1729ce37759SMatthias Ringwald     X( SUPPORTED_HCI_COMMAND_READ_LOCAL_OOB_EXTENDED_DATA_COMMAND  , 32, 6) \
17325e46151SMatthias Ringwald     X( SUPPORTED_HCI_COMMAND_LE_WRITE_SUGGESTED_DEFAULT_DATA_LENGTH, 34, 0) \
17425e46151SMatthias Ringwald     X( SUPPORTED_HCI_COMMAND_LE_SET_ADDRESS_RESOLUTION_ENABLE      , 35, 1) \
175a391128dSMatthias Ringwald     X( SUPPORTED_HCI_COMMAND_LE_READ_MAXIMUM_DATA_LENGTH           , 35, 3) \
1769ce37759SMatthias Ringwald     X( SUPPORTED_HCI_COMMAND_LE_SET_DEFAULT_PHY                    , 35, 5) \
17763671e69SMatthias Ringwald     X( SUPPORTED_HCI_COMMAND_LE_SET_EXTENDED_ADVERTISING_ENABLE    , 36, 6) \
17879b7ea2dSMatthias Ringwald     X( SUPPORTED_HCI_COMMAND_LE_READ_BUFFER_SIZE_V2                , 41, 5) \
179a391128dSMatthias Ringwald     X( SUPPORTED_HCI_COMMAND_SET_MIN_ENCRYPTION_KEY_SIZE           , 45, 7) \
18025e46151SMatthias Ringwald 
18125e46151SMatthias Ringwald // enumerate supported commands
18225e46151SMatthias Ringwald #define X(name, offset, bit) name,
18325e46151SMatthias Ringwald enum {
18425e46151SMatthias Ringwald     SUPPORTED_HCI_COMMANDS
18525e46151SMatthias Ringwald     SUPPORTED_HCI_COMMANDS_COUNT
18625e46151SMatthias Ringwald };
18725e46151SMatthias Ringwald #undef X
18825e46151SMatthias Ringwald 
189b83d5eabSMatthias Ringwald // prototypes
19035454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
191758b46ceSmatthias.ringwald static void hci_update_scan_enable(void);
19271fd255dSMatthias Ringwald static void hci_emit_scan_mode_changed(uint8_t discoverable, uint8_t connectable);
19335454696SMatthias Ringwald static int  hci_local_ssp_activated(void);
19420dcdd22SMatthias Ringwald static bool hci_remote_ssp_supported(hci_con_handle_t con_handle);
19567aae551SMatthias Ringwald static bool hci_ssp_supported(hci_connection_t * connection);
19635454696SMatthias Ringwald static void hci_notify_if_sco_can_send_now(void);
19735454696SMatthias Ringwald static void hci_emit_connection_complete(bd_addr_t address, hci_con_handle_t con_handle, uint8_t status);
198a00031e2S[email protected] static gap_security_level_t gap_security_level_for_connection(hci_connection_t * connection);
19935454696SMatthias Ringwald static void hci_emit_security_level(hci_con_handle_t con_handle, gap_security_level_t level);
200ec820d77SMatthias Ringwald static void hci_connection_timeout_handler(btstack_timer_source_t *timer);
20196a45072S[email protected] static void hci_connection_timestamp(hci_connection_t *connection);
20252db98b2SMatthias Ringwald static void hci_emit_l2cap_check_timeout(hci_connection_t *conn);
2039784dac1SMatthias Ringwald static void gap_inquiry_explode(uint8_t *packet, uint16_t size);
20452db98b2SMatthias Ringwald #endif
2051cfb383eSMatthias Ringwald 
2067586ee35S[email protected] static int  hci_power_control_on(void);
2077586ee35S[email protected] static void hci_power_control_off(void);
2086da48142SSean Wilson static void hci_state_reset(void);
209685ec254SMatthias Ringwald static void hci_halting_timeout_handler(btstack_timer_source_t * ds);
210fd43c0e0SMatthias Ringwald static void hci_emit_transport_packet_sent(void);
211fc64f94aSMatthias Ringwald static void hci_emit_disconnection_complete(hci_con_handle_t con_handle, uint8_t reason);
212b83d5eabSMatthias Ringwald static void hci_emit_nr_connections_changed(void);
213b83d5eabSMatthias Ringwald static void hci_emit_hci_open_failed(void);
214b83d5eabSMatthias Ringwald static void hci_emit_dedicated_bonding_result(bd_addr_t address, uint8_t status);
215b83d5eabSMatthias Ringwald static void hci_emit_event(uint8_t * event, uint16_t size, int dump);
216b83d5eabSMatthias Ringwald static void hci_emit_acl_packet(uint8_t * packet, uint16_t size);
21795d71764SMatthias Ringwald static void hci_run(void);
218617c03d6SMatthias Ringwald static bool hci_is_le_connection(hci_connection_t * connection);
2196a5ffed8SMatthias Ringwald 
2206a5ffed8SMatthias Ringwald #ifdef ENABLE_CLASSIC
221f234b250SMatthias Ringwald static int hci_have_usb_transport(void);
222dbe0d85cSMatthias Ringwald static void hci_trigger_remote_features_for_connection(hci_connection_t * connection);
2236a5ffed8SMatthias Ringwald #endif
2245d509858SMatthias Ringwald 
225a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE
226e8c8828eSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
22739677e66SMatthias Ringwald // called from test/ble_client/advertising_data_parser.c
228384b59deSMatthias Ringwald void le_handle_advertisement_report(uint8_t *packet, uint16_t size);
229667ba9d1SMatthias Ringwald static uint8_t hci_whitelist_remove(bd_addr_type_t address_type, const bd_addr_t address);
2309c77c9dbSMatthias Ringwald static hci_connection_t * gap_get_outgoing_connection(void);
231c42da3bcSMatthias Ringwald static void hci_le_scan_stop(void);
23273799937SMatthias Ringwald static bool hci_run_general_gap_le(void);
2335d509858SMatthias Ringwald #endif
23425df6c61SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
235ee54aff5SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
23625df6c61SMatthias Ringwald static le_advertising_set_t * hci_advertising_set_for_handle(uint8_t advertising_handle);
237ee54aff5SMatthias Ringwald #endif /* ENABLE_LE_EXTENDED_ADVERTISING */
238ee54aff5SMatthias Ringwald #endif /* ENABLE_LE_PERIPHERAL */
2394ae8623eSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
240969d876aSMatthias 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);
2414ae8623eSMatthias Ringwald static void hci_iso_stream_finalize(hci_iso_stream_t * iso_stream);
242778463d0SMatthias Ringwald static void hci_iso_stream_finalize_by_type_and_group_id(hci_iso_type_t iso_type, uint8_t group_id);
24315a15be3SMatthias Ringwald static hci_iso_stream_t * hci_iso_stream_for_con_handle(hci_con_handle_t con_handle);
24415a15be3SMatthias Ringwald static void hci_iso_stream_requested_finalize(uint8_t big_handle);
24515a15be3SMatthias Ringwald static void hci_iso_stream_requested_confirm(uint8_t big_handle);
246750818acSMatthias Ringwald static void hci_iso_packet_handler(hci_iso_stream_t *iso_stream, uint8_t *packet, uint16_t size);
2477aa35f6aSMatthias Ringwald static le_audio_big_t * hci_big_for_handle(uint8_t big_handle);
248d3a89d91SMatthias Ringwald static le_audio_cig_t * hci_cig_for_id(uint8_t cig_id);
2495ade6657SMatthias Ringwald static void hci_iso_notify_can_send_now(void);
2507aa35f6aSMatthias Ringwald static void hci_emit_big_created(const le_audio_big_t * big, uint8_t status);
2517aa35f6aSMatthias Ringwald static void hci_emit_big_terminated(const le_audio_big_t * big);
2522a6c0f82SMatthias Ringwald static void hci_emit_big_sync_created(const le_audio_big_sync_t * big_sync, uint8_t status);
253d04a9afcSMatthias Ringwald static void hci_emit_big_sync_stopped(uint8_t big_handle);
254d3a89d91SMatthias Ringwald static void hci_emit_cig_created(const le_audio_cig_t * cig, uint8_t status);
25514045fdbSMatthias Ringwald static void hci_cis_handle_created(hci_iso_stream_t * iso_stream, uint8_t status);
2562a6c0f82SMatthias Ringwald static le_audio_big_sync_t * hci_big_sync_for_handle(uint8_t big_handle);
25714045fdbSMatthias Ringwald 
2584ae8623eSMatthias Ringwald #endif /* ENABLE_LE_ISOCHRONOUS_STREAMS */
259ee54aff5SMatthias Ringwald #endif /* ENABLE_BLE */
260758b46ceSmatthias.ringwald 
26106b35ec0Smatthias.ringwald // the STACK is here
2623a9fb326S[email protected] #ifndef HAVE_MALLOC
2633a9fb326S[email protected] static hci_stack_t   hci_stack_static;
2643a9fb326S[email protected] #endif
2653a9fb326S[email protected] static hci_stack_t * hci_stack = NULL;
26616833f0aSmatthias.ringwald 
2671c9e5e9dSMatthias Ringwald #ifdef ENABLE_CLASSIC
26863168530SMatthias Ringwald // default name
26963168530SMatthias Ringwald static const char * default_classic_name = "BTstack 00:00:00:00:00:00";
27063168530SMatthias Ringwald 
27166fb9560S[email protected] // test helper
27266fb9560S[email protected] static uint8_t disable_l2cap_timeouts = 0;
2731c9e5e9dSMatthias Ringwald #endif
27466fb9560S[email protected] 
275aee5d5c1SMatthias Ringwald // reset connection state on create and on reconnect
276aee5d5c1SMatthias Ringwald // don't overwrite addr, con handle, role
277aee5d5c1SMatthias Ringwald static void hci_connection_init(hci_connection_t * conn){
2788daf94bcSMatthias Ringwald     conn->authentication_flags = AUTH_FLAG_NONE;
27996a45072S[email protected]     conn->bonding_flags = 0;
28096a45072S[email protected]     conn->requested_security_level = LEVEL_0;
28152db98b2SMatthias Ringwald #ifdef ENABLE_CLASSIC
28288a03c8dSMatthias Ringwald     conn->request_role = HCI_ROLE_INVALID;
283140c0557SMatthias Ringwald     conn->sniff_subrating_max_latency = 0xffff;
284965a4ccfSMatthias Ringwald     conn->qos_service_type = HCI_SERVICE_TYPE_INVALID;
285e9f98c4aSMatthias Ringwald     conn->link_key_type = INVALID_LINK_KEY;
28691a977e8SMatthias Ringwald     btstack_run_loop_set_timer_handler(&conn->timeout, hci_connection_timeout_handler);
28791a977e8SMatthias Ringwald     btstack_run_loop_set_timer_context(&conn->timeout, conn);
28896a45072S[email protected]     hci_connection_timestamp(conn);
28952db98b2SMatthias Ringwald #endif
29096a45072S[email protected]     conn->acl_recombination_length = 0;
29196a45072S[email protected]     conn->acl_recombination_pos = 0;
292ce41473eSMatthias Ringwald     conn->num_packets_sent = 0;
293760b20efSMatthias Ringwald 
294da886c03S[email protected]     conn->le_con_parameter_update_state = CON_PARAMETER_UPDATE_NONE;
295b90f6e0aSMatthias Ringwald #ifdef ENABLE_BLE
296b90f6e0aSMatthias Ringwald     conn->le_phy_update_all_phys = 0xff;
297b90f6e0aSMatthias Ringwald #endif
2980f3b27c5SMatthias Ringwald #ifdef ENABLE_LE_LIMIT_ACL_FRAGMENT_BY_MAX_OCTETS
2990f3b27c5SMatthias Ringwald     conn->le_max_tx_octets = 27;
3000f3b27c5SMatthias Ringwald #endif
301cb439cf1SMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB
302cb439cf1SMatthias Ringwald     conn->classic_oob_c_192 = NULL;
303cb439cf1SMatthias Ringwald     conn->classic_oob_r_192 = NULL;
304cb439cf1SMatthias Ringwald     conn->classic_oob_c_256 = NULL;
305cb439cf1SMatthias Ringwald     conn->classic_oob_r_256 = NULL;
306cb439cf1SMatthias Ringwald #endif
3074dcab8b6SMatthias Ringwald #ifdef ENABLE_LE_PERIODIC_ADVERTISING
3084dcab8b6SMatthias Ringwald     conn->le_past_sync_handle = HCI_CON_HANDLE_INVALID;
3094dcab8b6SMatthias Ringwald     conn->le_past_advertising_handle = 0xff;
3104dcab8b6SMatthias Ringwald #endif
311aee5d5c1SMatthias Ringwald }
312aee5d5c1SMatthias Ringwald 
313aee5d5c1SMatthias Ringwald /**
314aee5d5c1SMatthias Ringwald  * create connection for given address
315aee5d5c1SMatthias Ringwald  *
316aee5d5c1SMatthias Ringwald  * @return connection OR NULL, if no memory left
317aee5d5c1SMatthias Ringwald  */
31888f925b1SMatthias Ringwald static hci_connection_t *
31988f925b1SMatthias Ringwald create_connection_for_bd_addr_and_type(const bd_addr_t addr, bd_addr_type_t addr_type, hci_role_t role) {
320aee5d5c1SMatthias Ringwald     log_info("create_connection_for_addr %s, type %x", bd_addr_to_str(addr), addr_type);
321aee5d5c1SMatthias Ringwald 
322aee5d5c1SMatthias Ringwald     hci_connection_t * conn = btstack_memory_hci_connection_get();
323aee5d5c1SMatthias Ringwald     if (!conn) return NULL;
324aee5d5c1SMatthias Ringwald     hci_connection_init(conn);
325aee5d5c1SMatthias Ringwald 
326aee5d5c1SMatthias Ringwald     bd_addr_copy(conn->address, addr);
327aee5d5c1SMatthias Ringwald     conn->address_type = addr_type;
328aee5d5c1SMatthias Ringwald     conn->con_handle = HCI_CON_HANDLE_INVALID;
32988f925b1SMatthias Ringwald     conn->role = role;
330665d90f2SMatthias Ringwald     btstack_linked_list_add(&hci_stack->connections, (btstack_linked_item_t *) conn);
331aee5d5c1SMatthias Ringwald 
33296a45072S[email protected]     return conn;
33396a45072S[email protected] }
33466fb9560S[email protected] 
335da886c03S[email protected] 
336da886c03S[email protected] /**
337da886c03S[email protected]  * get le connection parameter range
338da886c03S[email protected] *
339da886c03S[email protected]  * @return le connection parameter range struct
340da886c03S[email protected]  */
3414ced4e8cSMatthias Ringwald void gap_get_connection_parameter_range(le_connection_parameter_range_t * range){
3424ced4e8cSMatthias Ringwald     *range = hci_stack->le_connection_parameter_range;
343da886c03S[email protected] }
344da886c03S[email protected] 
345da886c03S[email protected] /**
346da886c03S[email protected]  * set le connection parameter range
347da886c03S[email protected]  *
348da886c03S[email protected]  */
349da886c03S[email protected] 
3504ced4e8cSMatthias Ringwald void gap_set_connection_parameter_range(le_connection_parameter_range_t *range){
3514ced4e8cSMatthias Ringwald     hci_stack->le_connection_parameter_range = *range;
352da886c03S[email protected] }
353da886c03S[email protected] 
354da886c03S[email protected] /**
35573cd8a2aSMatthias Ringwald  * @brief Test if connection parameters are inside in existing rage
35673cd8a2aSMatthias Ringwald  * @param conn_interval_min (unit: 1.25ms)
35773cd8a2aSMatthias Ringwald  * @param conn_interval_max (unit: 1.25ms)
35873cd8a2aSMatthias Ringwald  * @param conn_latency
35973cd8a2aSMatthias Ringwald  * @param supervision_timeout (unit: 10ms)
3606b65794dSMilanka Ringwald  * @return 1 if included
36173cd8a2aSMatthias Ringwald  */
36273cd8a2aSMatthias 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){
36373cd8a2aSMatthias Ringwald     if (le_conn_interval_min < existing_range->le_conn_interval_min) return 0;
36473cd8a2aSMatthias Ringwald     if (le_conn_interval_max > existing_range->le_conn_interval_max) return 0;
36573cd8a2aSMatthias Ringwald 
36673cd8a2aSMatthias Ringwald     if (le_conn_latency < existing_range->le_conn_latency_min) return 0;
36773cd8a2aSMatthias Ringwald     if (le_conn_latency > existing_range->le_conn_latency_max) return 0;
36873cd8a2aSMatthias Ringwald 
36973cd8a2aSMatthias Ringwald     if (le_supervision_timeout < existing_range->le_supervision_timeout_min) return 0;
37073cd8a2aSMatthias Ringwald     if (le_supervision_timeout > existing_range->le_supervision_timeout_max) return 0;
37173cd8a2aSMatthias Ringwald 
37273cd8a2aSMatthias Ringwald     return 1;
37373cd8a2aSMatthias Ringwald }
37473cd8a2aSMatthias Ringwald 
37573cd8a2aSMatthias Ringwald /**
3762b6ab3e6SMatthias Ringwald  * @brief Set max number of connections in LE Peripheral role (if Bluetooth Controller supports it)
3772b6ab3e6SMatthias Ringwald  * @note: default: 1
3782b6ab3e6SMatthias Ringwald  * @param max_peripheral_connections
3792b6ab3e6SMatthias Ringwald  */
380d4e4907bSMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
3812b6ab3e6SMatthias Ringwald void gap_set_max_number_peripheral_connections(int max_peripheral_connections){
3822b6ab3e6SMatthias Ringwald     hci_stack->le_max_number_peripheral_connections = max_peripheral_connections;
3832b6ab3e6SMatthias Ringwald }
384d4e4907bSMatthias Ringwald #endif
3852b6ab3e6SMatthias Ringwald 
3862b6ab3e6SMatthias Ringwald /**
387da886c03S[email protected]  * get hci connections iterator
388da886c03S[email protected]  *
389da886c03S[email protected]  * @return hci connections iterator
390da886c03S[email protected]  */
391da886c03S[email protected] 
392665d90f2SMatthias Ringwald void hci_connections_get_iterator(btstack_linked_list_iterator_t *it){
393665d90f2SMatthias Ringwald     btstack_linked_list_iterator_init(it, &hci_stack->connections);
394da886c03S[email protected] }
395da886c03S[email protected] 
39697addcc5Smatthias.ringwald /**
397ee091cf1Smatthias.ringwald  * get connection for a given handle
398ee091cf1Smatthias.ringwald  *
399ee091cf1Smatthias.ringwald  * @return connection OR NULL, if not found
400ee091cf1Smatthias.ringwald  */
4015061f3afS[email protected] hci_connection_t * hci_connection_for_handle(hci_con_handle_t con_handle){
402665d90f2SMatthias Ringwald     btstack_linked_list_iterator_t it;
403665d90f2SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->connections);
404665d90f2SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
405665d90f2SMatthias Ringwald         hci_connection_t * item = (hci_connection_t *) btstack_linked_list_iterator_next(&it);
4063ac2fe56S[email protected]         if ( item->con_handle == con_handle ) {
407da886c03S[email protected]             return item;
408ee091cf1Smatthias.ringwald         }
409ee091cf1Smatthias.ringwald     }
410ee091cf1Smatthias.ringwald     return NULL;
411ee091cf1Smatthias.ringwald }
412ee091cf1Smatthias.ringwald 
41396a45072S[email protected] /**
41496a45072S[email protected]  * get connection for given address
41596a45072S[email protected]  *
41696a45072S[email protected]  * @return connection OR NULL, if not found
41796a45072S[email protected]  */
418667ba9d1SMatthias Ringwald hci_connection_t * hci_connection_for_bd_addr_and_type(const bd_addr_t  addr, bd_addr_type_t addr_type){
419665d90f2SMatthias Ringwald     btstack_linked_list_iterator_t it;
420665d90f2SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->connections);
421665d90f2SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
422665d90f2SMatthias Ringwald         hci_connection_t * connection = (hci_connection_t *) btstack_linked_list_iterator_next(&it);
42396a45072S[email protected]         if (connection->address_type != addr_type)  continue;
42496a45072S[email protected]         if (memcmp(addr, connection->address, 6) != 0) continue;
42562bda3fbS[email protected]         return connection;
42662bda3fbS[email protected]     }
42762bda3fbS[email protected]     return NULL;
42862bda3fbS[email protected] }
42962bda3fbS[email protected] 
430d5f71a7eSMatthias Ringwald #ifdef ENABLE_CLASSIC
431d5f71a7eSMatthias Ringwald 
4323e5e0926SMatthias Ringwald inline static void connectionClearAuthenticationFlags(hci_connection_t * conn, hci_authentication_flags_t flags){
4333e5e0926SMatthias Ringwald     conn->authentication_flags = (hci_authentication_flags_t)(conn->authentication_flags & ~flags);
4343e5e0926SMatthias Ringwald }
43552db98b2SMatthias Ringwald 
436228e430cSMatthias Ringwald inline static void connectionSetAuthenticationFlags(hci_connection_t * conn, hci_authentication_flags_t flags){
437228e430cSMatthias Ringwald     conn->authentication_flags = (hci_authentication_flags_t)(conn->authentication_flags | flags);
438228e430cSMatthias Ringwald }
439228e430cSMatthias Ringwald 
440ee752bb8SMatthias Ringwald #ifdef ENABLE_SCO_OVER_HCI
441ee752bb8SMatthias Ringwald static int hci_number_sco_connections(void){
442ee752bb8SMatthias Ringwald     int connections = 0;
443ee752bb8SMatthias Ringwald     btstack_linked_list_iterator_t it;
444ee752bb8SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->connections);
445ee752bb8SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
446ee752bb8SMatthias Ringwald         hci_connection_t * connection = (hci_connection_t *) btstack_linked_list_iterator_next(&it);
447ee752bb8SMatthias Ringwald         if (connection->address_type != BD_ADDR_TYPE_SCO) continue;
448ee752bb8SMatthias Ringwald         connections++;
449ee752bb8SMatthias Ringwald     }
450ee752bb8SMatthias Ringwald     return connections;
451ee752bb8SMatthias Ringwald }
452ee752bb8SMatthias Ringwald #endif
453ee752bb8SMatthias Ringwald 
454ec820d77SMatthias Ringwald static void hci_connection_timeout_handler(btstack_timer_source_t *timer){
45591a977e8SMatthias Ringwald     hci_connection_t * connection = (hci_connection_t *) btstack_run_loop_get_timer_context(timer);
456aec7654dSMatthias Ringwald #ifdef HAVE_EMBEDDED_TICK
457528a4a3bSMatthias Ringwald     if (btstack_run_loop_embedded_get_ticks() > connection->timestamp + btstack_run_loop_embedded_ticks_for_ms(HCI_CONNECTION_TIMEOUT_MS)){
458c785ef68Smatthias.ringwald         // connections might be timed out
459c785ef68Smatthias.ringwald         hci_emit_l2cap_check_timeout(connection);
460c785ef68Smatthias.ringwald     }
461f316a845SMatthias Ringwald #else
462c1ab6cc1SMatthias Ringwald     if (btstack_run_loop_get_time_ms() > (connection->timestamp + HCI_CONNECTION_TIMEOUT_MS)){
4635f26aadcSMatthias Ringwald         // connections might be timed out
4645f26aadcSMatthias Ringwald         hci_emit_l2cap_check_timeout(connection);
4655f26aadcSMatthias Ringwald     }
4665f26aadcSMatthias Ringwald #endif
467c785ef68Smatthias.ringwald }
468ee091cf1Smatthias.ringwald 
469ee091cf1Smatthias.ringwald static void hci_connection_timestamp(hci_connection_t *connection){
470aec7654dSMatthias Ringwald #ifdef HAVE_EMBEDDED_TICK
471528a4a3bSMatthias Ringwald     connection->timestamp = btstack_run_loop_embedded_get_ticks();
472f316a845SMatthias Ringwald #else
473528a4a3bSMatthias Ringwald     connection->timestamp = btstack_run_loop_get_time_ms();
4745f26aadcSMatthias Ringwald #endif
475ee091cf1Smatthias.ringwald }
476ee091cf1Smatthias.ringwald 
47743bfb1bdSmatthias.ringwald /**
47880ca58a0Smatthias.ringwald  * add authentication flags and reset timer
47996a45072S[email protected]  * @note: assumes classic connection
4802e77e513S[email protected]  * @note: bd_addr is passed in as litle endian uint8_t * as it is called from parsing packets
4817fde4af9Smatthias.ringwald  */
4827fde4af9Smatthias.ringwald static void hci_add_connection_flags_for_flipped_bd_addr(uint8_t *bd_addr, hci_authentication_flags_t flags){
4837fde4af9Smatthias.ringwald     bd_addr_t addr;
484724d70a2SMatthias Ringwald     reverse_bd_addr(bd_addr, addr);
485f16129ceSMatthias Ringwald     hci_connection_t * conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL);
4867fde4af9Smatthias.ringwald     if (conn) {
48728ca2b46S[email protected]         connectionSetAuthenticationFlags(conn, flags);
48880ca58a0Smatthias.ringwald         hci_connection_timestamp(conn);
4897fde4af9Smatthias.ringwald     }
4907fde4af9Smatthias.ringwald }
4917fde4af9Smatthias.ringwald 
4921714cbbdSMatthias Ringwald static bool hci_pairing_active(hci_connection_t * hci_connection){
4938daf94bcSMatthias Ringwald     return (hci_connection->authentication_flags & AUTH_FLAG_PAIRING_ACTIVE_MASK) != 0;
4941714cbbdSMatthias Ringwald }
4951714cbbdSMatthias Ringwald 
4961714cbbdSMatthias Ringwald static void hci_pairing_started(hci_connection_t * hci_connection, bool ssp){
4971714cbbdSMatthias Ringwald     if (hci_pairing_active(hci_connection)) return;
4981714cbbdSMatthias Ringwald     if (ssp){
4998daf94bcSMatthias Ringwald         hci_connection->authentication_flags |= AUTH_FLAG_SSP_PAIRING_ACTIVE;
5001714cbbdSMatthias Ringwald     } else {
5018daf94bcSMatthias Ringwald         hci_connection->authentication_flags |= AUTH_FLAG_LEGACY_PAIRING_ACTIVE;
5021714cbbdSMatthias Ringwald     }
5031714cbbdSMatthias Ringwald     // if we are initiator, we have sent an HCI Authenticate Request
5041714cbbdSMatthias Ringwald     bool initiator = (hci_connection->bonding_flags & BONDING_SENT_AUTHENTICATE_REQUEST) != 0;
5051714cbbdSMatthias Ringwald 
5065a561920SMatthias Ringwald     // if we are responder, use minimal service security level as required level
5075a561920SMatthias Ringwald     if (!initiator){
508acadfdd0SMatthias 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);
5095a561920SMatthias Ringwald     }
5105a561920SMatthias Ringwald 
5115a561920SMatthias Ringwald     log_info("pairing started, ssp %u, initiator %u, requested level %u", (int) ssp, (int) initiator, hci_connection->requested_security_level);
51277208d90SMatthias Ringwald 
51377208d90SMatthias Ringwald     uint8_t event[12];
51477208d90SMatthias Ringwald     event[0] = GAP_EVENT_PAIRING_STARTED;
51577208d90SMatthias Ringwald     event[1] = 10;
516bfaf6993SMatthias Ringwald     little_endian_store_16(event, 2, (uint16_t) hci_connection->con_handle);
5174159a80bSMatthias Ringwald     reverse_bd_addr(hci_connection->address, &event[4]);
51877208d90SMatthias Ringwald     event[10] = (uint8_t) ssp;
51977208d90SMatthias Ringwald     event[11] = (uint8_t) initiator;
52077208d90SMatthias Ringwald     hci_emit_event(event, sizeof(event), 1);
5211714cbbdSMatthias Ringwald }
5221714cbbdSMatthias Ringwald 
5231714cbbdSMatthias Ringwald static void hci_pairing_complete(hci_connection_t * hci_connection, uint8_t status){
5243c439ac4SMatthias Ringwald     hci_connection->requested_security_level = LEVEL_0;
5251714cbbdSMatthias Ringwald     if (!hci_pairing_active(hci_connection)) return;
5268daf94bcSMatthias Ringwald     hci_connection->authentication_flags &= ~AUTH_FLAG_PAIRING_ACTIVE_MASK;
5271e7371deSMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB
528cb439cf1SMatthias Ringwald     hci_connection->classic_oob_c_192 = NULL;
529cb439cf1SMatthias Ringwald     hci_connection->classic_oob_r_192 = NULL;
530cb439cf1SMatthias Ringwald     hci_connection->classic_oob_c_256 = NULL;
531cb439cf1SMatthias Ringwald     hci_connection->classic_oob_r_256 = NULL;
5321e7371deSMatthias Ringwald #endif
5331714cbbdSMatthias Ringwald     log_info("pairing complete, status %02x", status);
53477208d90SMatthias Ringwald 
5353176c896SMatthias Ringwald     uint8_t event[11];
53677208d90SMatthias Ringwald     event[0] = GAP_EVENT_PAIRING_COMPLETE;
53777208d90SMatthias Ringwald     event[1] = 9;
538bfaf6993SMatthias Ringwald     little_endian_store_16(event, 2, (uint16_t) hci_connection->con_handle);
5394159a80bSMatthias Ringwald     reverse_bd_addr(hci_connection->address, &event[4]);
54077208d90SMatthias Ringwald     event[10] = status;
54177208d90SMatthias Ringwald     hci_emit_event(event, sizeof(event), 1);
5425999ee11SMatthias Ringwald 
5435999ee11SMatthias Ringwald     // emit dedicated bonding done on failure, otherwise verify that connection can be encrypted
5445999ee11SMatthias Ringwald     if ((status != ERROR_CODE_SUCCESS) && ((hci_connection->bonding_flags & BONDING_DEDICATED) != 0)){
5455999ee11SMatthias Ringwald         hci_connection->bonding_flags &= ~BONDING_DEDICATED;
5465999ee11SMatthias Ringwald         hci_connection->bonding_flags |= BONDING_DISCONNECT_DEDICATED_DONE;
5475999ee11SMatthias Ringwald         hci_connection->bonding_status = status;
5485999ee11SMatthias Ringwald     }
5491714cbbdSMatthias Ringwald }
5501714cbbdSMatthias Ringwald 
55120dcdd22SMatthias Ringwald bool hci_authentication_active_for_handle(hci_con_handle_t handle){
5525061f3afS[email protected]     hci_connection_t * conn = hci_connection_for_handle(handle);
55320dcdd22SMatthias Ringwald     if (!conn) return false;
55420dcdd22SMatthias Ringwald     return hci_pairing_active(conn);
55580ca58a0Smatthias.ringwald }
55680ca58a0Smatthias.ringwald 
55715a95bd5SMatthias Ringwald void gap_drop_link_key_for_bd_addr(bd_addr_t addr){
55855597469SMatthias Ringwald     if (!hci_stack->link_key_db) return;
5592bacf595SMatthias Ringwald     log_info("gap_drop_link_key_for_bd_addr: %s", bd_addr_to_str(addr));
560a98592bcSMatthias Ringwald     hci_stack->link_key_db->delete_link_key(addr);
561c12e46e7Smatthias.ringwald }
56255597469SMatthias Ringwald 
56355597469SMatthias Ringwald void gap_store_link_key_for_bd_addr(bd_addr_t addr, link_key_t link_key, link_key_type_t type){
56455597469SMatthias Ringwald     if (!hci_stack->link_key_db) return;
5652bacf595SMatthias Ringwald     log_info("gap_store_link_key_for_bd_addr: %s, type %u", bd_addr_to_str(addr), type);
56655597469SMatthias Ringwald     hci_stack->link_key_db->put_link_key(addr, link_key, type);
567c12e46e7Smatthias.ringwald }
5681b6fb31bSMatthias Ringwald 
569e8ad470fSMatthias Ringwald bool gap_get_link_key_for_bd_addr(bd_addr_t addr, link_key_t link_key, link_key_type_t * type){
570e8ad470fSMatthias Ringwald 	if (!hci_stack->link_key_db) return false;
57176b0318eSMatthias Ringwald 	int result = hci_stack->link_key_db->get_link_key(addr, link_key, type) != 0;
57276b0318eSMatthias Ringwald 	log_info("link key for %s available %u, type %u", bd_addr_to_str(addr), result, (int) *type);
57376b0318eSMatthias Ringwald 	return result;
574e8ad470fSMatthias Ringwald }
575e8ad470fSMatthias Ringwald 
576ceecb9d9SMatthias Ringwald void gap_delete_all_link_keys(void){
577ceecb9d9SMatthias Ringwald     bd_addr_t  addr;
578ceecb9d9SMatthias Ringwald     link_key_t link_key;
579ceecb9d9SMatthias Ringwald     link_key_type_t type;
580ceecb9d9SMatthias Ringwald     btstack_link_key_iterator_t it;
581ceecb9d9SMatthias Ringwald     int ok = gap_link_key_iterator_init(&it);
582ceecb9d9SMatthias Ringwald     if (!ok) {
583ceecb9d9SMatthias Ringwald         log_error("could not initialize iterator");
584ceecb9d9SMatthias Ringwald         return;
585ceecb9d9SMatthias Ringwald     }
586ceecb9d9SMatthias Ringwald     while (gap_link_key_iterator_get_next(&it, addr, link_key, &type)){
587ceecb9d9SMatthias Ringwald         gap_drop_link_key_for_bd_addr(addr);
588ceecb9d9SMatthias Ringwald     }
589ceecb9d9SMatthias Ringwald     gap_link_key_iterator_done(&it);
590ceecb9d9SMatthias Ringwald }
591ceecb9d9SMatthias Ringwald 
5921b6fb31bSMatthias Ringwald int gap_link_key_iterator_init(btstack_link_key_iterator_t * it){
5931b6fb31bSMatthias Ringwald     if (!hci_stack->link_key_db) return 0;
5941b6fb31bSMatthias Ringwald     if (!hci_stack->link_key_db->iterator_init) return 0;
5951b6fb31bSMatthias Ringwald     return hci_stack->link_key_db->iterator_init(it);
5961b6fb31bSMatthias Ringwald }
5971b6fb31bSMatthias 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){
5981b6fb31bSMatthias Ringwald     if (!hci_stack->link_key_db) return 0;
5991b6fb31bSMatthias Ringwald     return hci_stack->link_key_db->iterator_get_next(it, bd_addr, link_key, type);
6001b6fb31bSMatthias Ringwald }
6011b6fb31bSMatthias Ringwald void gap_link_key_iterator_done(btstack_link_key_iterator_t * it){
6021b6fb31bSMatthias Ringwald     if (!hci_stack->link_key_db) return;
6031b6fb31bSMatthias Ringwald     hci_stack->link_key_db->iterator_done(it);
6041b6fb31bSMatthias Ringwald }
60535454696SMatthias Ringwald #endif
606c12e46e7Smatthias.ringwald 
6078e97a820SMatthias Ringwald bool hci_is_le_connection_type(bd_addr_type_t address_type){
608eb8076ddSMatthias Ringwald     switch (address_type){
609ce41473eSMatthias Ringwald         case BD_ADDR_TYPE_LE_PUBLIC:
610ce41473eSMatthias Ringwald         case BD_ADDR_TYPE_LE_RANDOM:
6113739bc96SMatthias Ringwald         case BD_ADDR_TYPE_LE_PUBLIC_IDENTITY:
6123739bc96SMatthias Ringwald         case BD_ADDR_TYPE_LE_RANDOM_IDENTITY:
613eb8076ddSMatthias Ringwald             return true;
614ce41473eSMatthias Ringwald         default:
615eb8076ddSMatthias Ringwald             return false;
616ce41473eSMatthias Ringwald     }
6170bf6344aS[email protected] }
6180bf6344aS[email protected] 
619617c03d6SMatthias Ringwald static bool hci_is_le_connection(hci_connection_t * connection){
620eb8076ddSMatthias Ringwald     return hci_is_le_connection_type(connection->address_type);
621eb8076ddSMatthias Ringwald }
622eb8076ddSMatthias Ringwald 
6237fde4af9Smatthias.ringwald /**
62443bfb1bdSmatthias.ringwald  * count connections
62543bfb1bdSmatthias.ringwald  */
62640d1c7a4Smatthias.ringwald static int nr_hci_connections(void){
62756c253c9Smatthias.ringwald     int count = 0;
628665d90f2SMatthias Ringwald     btstack_linked_item_t *it;
629a0da043fSMatthias Ringwald     for (it = (btstack_linked_item_t *) hci_stack->connections; it != NULL ; it = it->next){
63015a27967SMatthias Ringwald         count++;
63115a27967SMatthias Ringwald     }
63243bfb1bdSmatthias.ringwald     return count;
63343bfb1bdSmatthias.ringwald }
634c8e4258aSmatthias.ringwald 
6358f733c6fSMatthias Ringwald uint16_t hci_number_free_acl_slots_for_connection_type(bd_addr_type_t address_type){
636ee303eddS[email protected] 
637f04a0c31SMatthias Ringwald     unsigned int num_packets_sent_classic = 0;
638f04a0c31SMatthias Ringwald     unsigned int num_packets_sent_le = 0;
639ee303eddS[email protected] 
640665d90f2SMatthias Ringwald     btstack_linked_item_t *it;
641a0da043fSMatthias Ringwald     for (it = (btstack_linked_item_t *) hci_stack->connections; it != NULL; it = it->next){
642998906cdSmatthias.ringwald         hci_connection_t * connection = (hci_connection_t *) it;
643ce41473eSMatthias Ringwald         if (hci_is_le_connection(connection)){
644ce41473eSMatthias Ringwald             num_packets_sent_le += connection->num_packets_sent;
645ce41473eSMatthias Ringwald         }
646f16129ceSMatthias Ringwald         if (connection->address_type == BD_ADDR_TYPE_ACL){
647ce41473eSMatthias Ringwald             num_packets_sent_classic += connection->num_packets_sent;
648ee303eddS[email protected]         }
649ee303eddS[email protected]     }
650d999b54eSMatthias Ringwald     log_debug("ACL classic buffers: %u used of %u", num_packets_sent_classic, hci_stack->acl_packets_total_num);
651ee303eddS[email protected]     int free_slots_classic = hci_stack->acl_packets_total_num - num_packets_sent_classic;
652ee303eddS[email protected]     int free_slots_le = 0;
653ee303eddS[email protected] 
654ee303eddS[email protected]     if (free_slots_classic < 0){
6559da54300S[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);
656998906cdSmatthias.ringwald         return 0;
657998906cdSmatthias.ringwald     }
658ee303eddS[email protected] 
659ee303eddS[email protected]     if (hci_stack->le_acl_packets_total_num){
660ee303eddS[email protected]         // if we have LE slots, they are used
661ee303eddS[email protected]         free_slots_le = hci_stack->le_acl_packets_total_num - num_packets_sent_le;
662ee303eddS[email protected]         if (free_slots_le < 0){
6639da54300S[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);
664ee303eddS[email protected]             return 0;
665998906cdSmatthias.ringwald         }
666ee303eddS[email protected]     } else {
667ee303eddS[email protected]         // otherwise, classic slots are used for LE, too
668ee303eddS[email protected]         free_slots_classic -= num_packets_sent_le;
669ee303eddS[email protected]         if (free_slots_classic < 0){
6709da54300S[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);
671ee303eddS[email protected]             return 0;
672ee303eddS[email protected]         }
673ee303eddS[email protected]     }
674ee303eddS[email protected] 
675ee303eddS[email protected]     switch (address_type){
676ee303eddS[email protected]         case BD_ADDR_TYPE_UNKNOWN:
6772125de09SMatthias Ringwald             log_error("hci_number_free_acl_slots: unknown address type");
678ee303eddS[email protected]             return 0;
679ee303eddS[email protected] 
680f16129ceSMatthias Ringwald         case BD_ADDR_TYPE_ACL:
6818f733c6fSMatthias Ringwald             return (uint16_t) free_slots_classic;
682ee303eddS[email protected] 
683ee303eddS[email protected]         default:
6848f733c6fSMatthias Ringwald            if (hci_stack->le_acl_packets_total_num > 0){
6858f733c6fSMatthias Ringwald                return (uint16_t) free_slots_le;
686ee303eddS[email protected]            }
6878f733c6fSMatthias Ringwald            return (uint16_t) free_slots_classic;
688cb00d3aaS[email protected]     }
689998906cdSmatthias.ringwald }
690998906cdSmatthias.ringwald 
6912125de09SMatthias Ringwald int hci_number_free_acl_slots_for_handle(hci_con_handle_t con_handle){
6922125de09SMatthias Ringwald     // get connection type
6932125de09SMatthias Ringwald     hci_connection_t * connection = hci_connection_for_handle(con_handle);
6942125de09SMatthias Ringwald     if (!connection){
6952125de09SMatthias Ringwald         log_error("hci_number_free_acl_slots: handle 0x%04x not in connection list", con_handle);
6962125de09SMatthias Ringwald         return 0;
6972125de09SMatthias Ringwald     }
6982125de09SMatthias Ringwald     return hci_number_free_acl_slots_for_connection_type(connection->address_type);
6992125de09SMatthias Ringwald }
7002125de09SMatthias Ringwald 
70135454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
702701e3307SMatthias Ringwald static int hci_number_free_sco_slots(void){
703f04a0c31SMatthias Ringwald     unsigned int num_sco_packets_sent  = 0;
704665d90f2SMatthias Ringwald     btstack_linked_item_t *it;
705760b20efSMatthias Ringwald     if (hci_stack->synchronous_flow_control_enabled){
706760b20efSMatthias Ringwald         // explicit flow control
707665d90f2SMatthias Ringwald         for (it = (btstack_linked_item_t *) hci_stack->connections; it ; it = it->next){
708e35edcc1S[email protected]             hci_connection_t * connection = (hci_connection_t *) it;
709ce41473eSMatthias Ringwald             if (connection->address_type != BD_ADDR_TYPE_SCO) continue;
710ce41473eSMatthias Ringwald             num_sco_packets_sent += connection->num_packets_sent;
711e35edcc1S[email protected]         }
712e35edcc1S[email protected]         if (num_sco_packets_sent > hci_stack->sco_packets_total_num){
713701e3307SMatthias Ringwald             log_info("hci_number_free_sco_slots:packets (%u) > total packets (%u)", num_sco_packets_sent, hci_stack->sco_packets_total_num);
71444d0e3d5S[email protected]             return 0;
71544d0e3d5S[email protected]         }
716e35edcc1S[email protected]         return hci_stack->sco_packets_total_num - num_sco_packets_sent;
71749205f5dSMatthias Ringwald     } else {
718fa7f2dfdSMatthias Ringwald         // implicit flow control
7196f28d2eeSMatthias Ringwald         int num_ready = 0;
7206f28d2eeSMatthias Ringwald         for (it = (btstack_linked_item_t *) hci_stack->connections; it ; it = it->next){
7216f28d2eeSMatthias Ringwald             hci_connection_t * connection = (hci_connection_t *) it;
7226f28d2eeSMatthias Ringwald             if (connection->address_type != BD_ADDR_TYPE_SCO) continue;
7236f28d2eeSMatthias Ringwald             if (connection->sco_tx_ready == 0) continue;
7246f28d2eeSMatthias Ringwald             num_ready++;
72549205f5dSMatthias Ringwald         }
7266f28d2eeSMatthias Ringwald         return num_ready;
7276f28d2eeSMatthias Ringwald     }
728e35edcc1S[email protected] }
72935454696SMatthias Ringwald #endif
73044d0e3d5S[email protected] 
7312b838201SMatthias Ringwald // only used to send HCI Host Number Completed Packets
7322b838201SMatthias Ringwald static int hci_can_send_comand_packet_transport(void){
733ac928cc2S[email protected]     if (hci_stack->hci_packet_buffer_reserved) return 0;
734ac928cc2S[email protected] 
735ac928cc2S[email protected]     // check for async hci transport implementations
736ac928cc2S[email protected]     if (hci_stack->hci_transport->can_send_packet_now){
737ac928cc2S[email protected]         if (!hci_stack->hci_transport->can_send_packet_now(HCI_COMMAND_DATA_PACKET)){
738ac928cc2S[email protected]             return 0;
739ac928cc2S[email protected]         }
740ac928cc2S[email protected]     }
7412b838201SMatthias Ringwald     return 1;
7422b838201SMatthias Ringwald }
743ac928cc2S[email protected] 
7442b838201SMatthias Ringwald // new functions replacing hci_can_send_packet_now[_using_packet_buffer]
7451972f31fSMatthias Ringwald bool hci_can_send_command_packet_now(void){
7461972f31fSMatthias Ringwald     if (hci_can_send_comand_packet_transport() == 0) return false;
7474ea43905SMatthias Ringwald     return hci_stack->num_cmd_packets > 0u;
748ac928cc2S[email protected] }
749ac928cc2S[email protected] 
7509d04d3a7SMatthias Ringwald static int hci_transport_can_send_prepared_packet_now(uint8_t packet_type){
751ac928cc2S[email protected]     // check for async hci transport implementations
7521972f31fSMatthias Ringwald     if (!hci_stack->hci_transport->can_send_packet_now) return true;
7539d04d3a7SMatthias Ringwald     return hci_stack->hci_transport->can_send_packet_now(packet_type);
754ac928cc2S[email protected] }
7559d04d3a7SMatthias Ringwald 
7561972f31fSMatthias Ringwald static bool hci_can_send_prepared_acl_packet_for_address_type(bd_addr_type_t address_type){
7571972f31fSMatthias Ringwald     if (!hci_transport_can_send_prepared_packet_now(HCI_ACL_DATA_PACKET)) return false;
7589d04d3a7SMatthias Ringwald     return hci_number_free_acl_slots_for_connection_type(address_type) > 0;
759ac928cc2S[email protected] }
7609d04d3a7SMatthias Ringwald 
7611972f31fSMatthias Ringwald bool hci_can_send_acl_le_packet_now(void){
7621972f31fSMatthias Ringwald     if (hci_stack->hci_packet_buffer_reserved) return false;
7639d04d3a7SMatthias Ringwald     return hci_can_send_prepared_acl_packet_for_address_type(BD_ADDR_TYPE_LE_PUBLIC);
7649d04d3a7SMatthias Ringwald }
7659d04d3a7SMatthias Ringwald 
7661972f31fSMatthias Ringwald bool hci_can_send_prepared_acl_packet_now(hci_con_handle_t con_handle) {
7671972f31fSMatthias Ringwald     if (!hci_transport_can_send_prepared_packet_now(HCI_ACL_DATA_PACKET)) return false;
768e79abdd6S[email protected]     return hci_number_free_acl_slots_for_handle(con_handle) > 0;
769ac928cc2S[email protected] }
770ac928cc2S[email protected] 
7711972f31fSMatthias Ringwald bool hci_can_send_acl_packet_now(hci_con_handle_t con_handle){
7721972f31fSMatthias Ringwald     if (hci_stack->hci_packet_buffer_reserved) return false;
773ac928cc2S[email protected]     return hci_can_send_prepared_acl_packet_now(con_handle);
7746b4af23dS[email protected] }
7756b4af23dS[email protected] 
77635454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
7771972f31fSMatthias Ringwald bool hci_can_send_acl_classic_packet_now(void){
7781972f31fSMatthias Ringwald     if (hci_stack->hci_packet_buffer_reserved) return false;
779f16129ceSMatthias Ringwald     return hci_can_send_prepared_acl_packet_for_address_type(BD_ADDR_TYPE_ACL);
78035454696SMatthias Ringwald }
78135454696SMatthias Ringwald 
7821972f31fSMatthias Ringwald bool hci_can_send_prepared_sco_packet_now(void){
7831972f31fSMatthias Ringwald     if (!hci_transport_can_send_prepared_packet_now(HCI_SCO_DATA_PACKET)) return false;
784f234b250SMatthias Ringwald     if (hci_have_usb_transport()){
785f234b250SMatthias Ringwald         return hci_stack->sco_can_send_now;
786f234b250SMatthias Ringwald     } else {
787701e3307SMatthias Ringwald         return hci_number_free_sco_slots() > 0;
78844d0e3d5S[email protected]     }
789f234b250SMatthias Ringwald }
79044d0e3d5S[email protected] 
7911972f31fSMatthias Ringwald bool hci_can_send_sco_packet_now(void){
7921972f31fSMatthias Ringwald     if (hci_stack->hci_packet_buffer_reserved) return false;
793701e3307SMatthias Ringwald     return hci_can_send_prepared_sco_packet_now();
79444d0e3d5S[email protected] }
79544d0e3d5S[email protected] 
796d057580eSMatthias Ringwald void hci_request_sco_can_send_now_event(void){
797d057580eSMatthias Ringwald     hci_stack->sco_waiting_for_can_send_now = 1;
798d057580eSMatthias Ringwald     hci_notify_if_sco_can_send_now();
799d057580eSMatthias Ringwald }
80035454696SMatthias Ringwald #endif
801d057580eSMatthias Ringwald 
80295d71764SMatthias Ringwald // used for internal checks in l2cap.c
80302c7fc01SMatthias Ringwald bool hci_is_packet_buffer_reserved(void){
804c8b9416aS[email protected]     return hci_stack->hci_packet_buffer_reserved;
805c8b9416aS[email protected] }
806c8b9416aS[email protected] 
8076b65794dSMilanka Ringwald // reserves outgoing packet buffer.
8086b65794dSMilanka Ringwald // @return 1 if successful
809cafc12e8SMatthias Ringwald bool hci_reserve_packet_buffer(void){
8109d14b626S[email protected]     if (hci_stack->hci_packet_buffer_reserved) {
8119d14b626S[email protected]         log_error("hci_reserve_packet_buffer called but buffer already reserved");
812cafc12e8SMatthias Ringwald         return false;
8139d14b626S[email protected]     }
81402c7fc01SMatthias Ringwald     hci_stack->hci_packet_buffer_reserved = true;
815cafc12e8SMatthias Ringwald     return true;
8166b4af23dS[email protected] }
8176b4af23dS[email protected] 
81868a0fcf7S[email protected] void hci_release_packet_buffer(void){
81902c7fc01SMatthias Ringwald     hci_stack->hci_packet_buffer_reserved = false;
82068a0fcf7S[email protected] }
82168a0fcf7S[email protected] 
8226b4af23dS[email protected] // assumption: synchronous implementations don't provide can_send_packet_now as they don't keep the buffer after the call
8237f02f414SMatthias Ringwald static int hci_transport_synchronous(void){
8246b4af23dS[email protected]     return hci_stack->hci_transport->can_send_packet_now == NULL;
8256b4af23dS[email protected] }
8266b4af23dS[email protected] 
8278ad9cf99SMatthias Ringwald // used for debugging
8288ad9cf99SMatthias Ringwald #ifdef ENABLE_CONTROLLER_DUMP_PACKETS
8298ad9cf99SMatthias Ringwald static void hci_controller_dump_packets(void){
8308ad9cf99SMatthias Ringwald     // format: "{handle:04x}:{count:02d} "
8318ad9cf99SMatthias Ringwald     char summaries[3][7 * 8 + 1];
8328ad9cf99SMatthias Ringwald     uint16_t totals[3];
8338ad9cf99SMatthias Ringwald     uint8_t index;
8348ad9cf99SMatthias Ringwald     for (index = 0 ; index < 3 ; index++){
8358ad9cf99SMatthias Ringwald         summaries[index][0] = 0;
8368ad9cf99SMatthias Ringwald         totals[index] = 0;
8378ad9cf99SMatthias Ringwald     }
8388ad9cf99SMatthias Ringwald     btstack_linked_item_t *it;
8398ad9cf99SMatthias Ringwald     for (it = (btstack_linked_item_t *) hci_stack->connections; it != NULL; it = it->next){
8408ad9cf99SMatthias Ringwald         hci_connection_t * connection = (hci_connection_t *) it;
8418ad9cf99SMatthias Ringwald         switch (connection->address_type){
8428ad9cf99SMatthias Ringwald             case BD_ADDR_TYPE_ACL:
8438ad9cf99SMatthias Ringwald                 index = 0;
8448ad9cf99SMatthias Ringwald                 break;
8458ad9cf99SMatthias Ringwald             case BD_ADDR_TYPE_SCO:
8468ad9cf99SMatthias Ringwald                 index = 2;
8478ad9cf99SMatthias Ringwald                 break;
8488ad9cf99SMatthias Ringwald             default:
8498ad9cf99SMatthias Ringwald                 index = 1;
850ce7ca7c8SMatthias Ringwald                 break;
8518ad9cf99SMatthias Ringwald         }
8528ad9cf99SMatthias Ringwald         totals[index] += connection->num_packets_sent;
8538ad9cf99SMatthias Ringwald         char item_text[10];
8548ad9cf99SMatthias Ringwald         sprintf(item_text, "%04x:%02d ", connection->con_handle,connection->num_packets_sent);
8558ad9cf99SMatthias Ringwald         btstack_strcat(summaries[index], sizeof(summaries[0]), item_text);
8568ad9cf99SMatthias Ringwald     }
8578ad9cf99SMatthias Ringwald     for (index = 0 ; index < 3 ; index++){
8588ad9cf99SMatthias Ringwald         if (summaries[index][0] == 0){
8598ad9cf99SMatthias Ringwald             summaries[index][0] = '-';
8608ad9cf99SMatthias Ringwald             summaries[index][1] = 0;
8618ad9cf99SMatthias Ringwald         }
8628ad9cf99SMatthias Ringwald     }
8638ad9cf99SMatthias 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]);
8648ad9cf99SMatthias Ringwald }
8658ad9cf99SMatthias Ringwald #endif
8668ad9cf99SMatthias Ringwald 
8673e2050f7SMatthias Ringwald static uint8_t hci_send_acl_packet_fragments(hci_connection_t *connection){
868452cf3bbS[email protected] 
869452cf3bbS[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);
870452cf3bbS[email protected] 
871452cf3bbS[email protected]     // max ACL data packet length depends on connection type (LE vs. Classic) and available buffers
872452cf3bbS[email protected]     uint16_t max_acl_data_packet_length = hci_stack->acl_data_packet_length;
8734ea43905SMatthias Ringwald     if (hci_is_le_connection(connection) && (hci_stack->le_data_packets_length > 0u)){
874452cf3bbS[email protected]         max_acl_data_packet_length = hci_stack->le_data_packets_length;
875452cf3bbS[email protected]     }
876452cf3bbS[email protected] 
8770f3b27c5SMatthias Ringwald #ifdef ENABLE_LE_LIMIT_ACL_FRAGMENT_BY_MAX_OCTETS
878fcf88f47SMatthias Ringwald     if (hci_is_le_connection(connection) && (connection->le_max_tx_octets < max_acl_data_packet_length)){
8790f3b27c5SMatthias Ringwald         max_acl_data_packet_length = connection->le_max_tx_octets;
8800f3b27c5SMatthias Ringwald     }
8810f3b27c5SMatthias Ringwald #endif
882452cf3bbS[email protected] 
883d999b54eSMatthias Ringwald     log_debug("hci_send_acl_packet_fragments entered");
884d999b54eSMatthias Ringwald 
8853e2050f7SMatthias Ringwald     uint8_t status = ERROR_CODE_SUCCESS;
886452cf3bbS[email protected]     // multiple packets could be send on a synchronous HCI transport
887ff3cc4a5SMatthias Ringwald     while (true){
888452cf3bbS[email protected] 
889d999b54eSMatthias Ringwald         log_debug("hci_send_acl_packet_fragments loop entered");
890d999b54eSMatthias Ringwald 
891452cf3bbS[email protected]         // get current data
8924ea43905SMatthias Ringwald         const uint16_t acl_header_pos = hci_stack->acl_fragmentation_pos - 4u;
893452cf3bbS[email protected]         int current_acl_data_packet_length = hci_stack->acl_fragmentation_total_size - hci_stack->acl_fragmentation_pos;
8941979f09cSMatthias Ringwald         bool more_fragments = false;
895452cf3bbS[email protected] 
896452cf3bbS[email protected]         // if ACL packet is larger than Bluetooth packet buffer, only send max_acl_data_packet_length
897452cf3bbS[email protected]         if (current_acl_data_packet_length > max_acl_data_packet_length){
8981979f09cSMatthias Ringwald             more_fragments = true;
8996bcf18c2SMatthias Ringwald             current_acl_data_packet_length = max_acl_data_packet_length & (~(HCI_ACL_CHUNK_SIZE_ALIGNMENT-1));
900452cf3bbS[email protected]         }
901452cf3bbS[email protected] 
902452cf3bbS[email protected]         // copy handle_and_flags if not first fragment and update packet boundary flags to be 01 (continuing fragmnent)
9034ea43905SMatthias Ringwald         if (acl_header_pos > 0u){
904f8fbdce0SMatthias Ringwald             uint16_t handle_and_flags = little_endian_read_16(hci_stack->hci_packet_buffer, 0);
9054ea43905SMatthias Ringwald             handle_and_flags = (handle_and_flags & 0xcfffu) | (1u << 12u);
906f8fbdce0SMatthias Ringwald             little_endian_store_16(hci_stack->hci_packet_buffer, acl_header_pos, handle_and_flags);
907452cf3bbS[email protected]         }
908452cf3bbS[email protected] 
909452cf3bbS[email protected]         // update header len
9104ea43905SMatthias Ringwald         little_endian_store_16(hci_stack->hci_packet_buffer, acl_header_pos + 2u, current_acl_data_packet_length);
911452cf3bbS[email protected] 
912452cf3bbS[email protected]         // count packet
913ce41473eSMatthias Ringwald         connection->num_packets_sent++;
9141979f09cSMatthias Ringwald         log_debug("hci_send_acl_packet_fragments loop before send (more fragments %d)", (int) more_fragments);
915d999b54eSMatthias Ringwald 
916d999b54eSMatthias Ringwald         // update state for next fragment (if any) as "transport done" might be sent during send_packet already
917d999b54eSMatthias Ringwald         if (more_fragments){
918d999b54eSMatthias Ringwald             // update start of next fragment to send
919d999b54eSMatthias Ringwald             hci_stack->acl_fragmentation_pos += current_acl_data_packet_length;
920d999b54eSMatthias Ringwald         } else {
921d999b54eSMatthias Ringwald             // done
922d999b54eSMatthias Ringwald             hci_stack->acl_fragmentation_pos = 0;
923d999b54eSMatthias Ringwald             hci_stack->acl_fragmentation_total_size = 0;
924d999b54eSMatthias Ringwald         }
925452cf3bbS[email protected] 
926452cf3bbS[email protected]         // send packet
927452cf3bbS[email protected]         uint8_t * packet = &hci_stack->hci_packet_buffer[acl_header_pos];
928452cf3bbS[email protected]         const int size = current_acl_data_packet_length + 4;
9295bb5bc3eS[email protected]         hci_dump_packet(HCI_ACL_DATA_PACKET, 0, packet, size);
93081d2bdb2SMatthias Ringwald         hci_stack->acl_fragmentation_tx_active = 1;
9313e2050f7SMatthias Ringwald         int err = hci_stack->hci_transport->send_packet(HCI_ACL_DATA_PACKET, packet, size);
9323e2050f7SMatthias Ringwald         if (err != 0){
9333e2050f7SMatthias Ringwald             // no error from HCI Transport expected
9343e2050f7SMatthias Ringwald             status = ERROR_CODE_HARDWARE_FAILURE;
9353e2050f7SMatthias Ringwald         }
936452cf3bbS[email protected] 
9378ad9cf99SMatthias Ringwald #ifdef ENABLE_CONTROLLER_DUMP_PACKETS
9388ad9cf99SMatthias Ringwald         hci_controller_dump_packets();
9398ad9cf99SMatthias Ringwald #endif
9408ad9cf99SMatthias Ringwald 
9411979f09cSMatthias Ringwald         log_debug("hci_send_acl_packet_fragments loop after send (more fragments %d)", (int) more_fragments);
942d999b54eSMatthias Ringwald 
943452cf3bbS[email protected]         // done yet?
944452cf3bbS[email protected]         if (!more_fragments) break;
945452cf3bbS[email protected] 
946452cf3bbS[email protected]         // can send more?
9473e2050f7SMatthias Ringwald         if (!hci_can_send_prepared_acl_packet_now(connection->con_handle)) return status;
948452cf3bbS[email protected]     }
949452cf3bbS[email protected] 
950d999b54eSMatthias Ringwald     log_debug("hci_send_acl_packet_fragments loop over");
951452cf3bbS[email protected] 
952d051460cS[email protected]     // release buffer now for synchronous transport
953203bace6S[email protected]     if (hci_transport_synchronous()){
95481d2bdb2SMatthias Ringwald         hci_stack->acl_fragmentation_tx_active = 0;
955452cf3bbS[email protected]         hci_release_packet_buffer();
956fd43c0e0SMatthias Ringwald         hci_emit_transport_packet_sent();
957452cf3bbS[email protected]     }
958452cf3bbS[email protected] 
9593e2050f7SMatthias Ringwald     return status;
960452cf3bbS[email protected] }
961452cf3bbS[email protected] 
962826f7347S[email protected] // pre: caller has reserved the packet buffer
9633e2050f7SMatthias Ringwald uint8_t hci_send_acl_packet_buffer(int size){
9643e2050f7SMatthias Ringwald     btstack_assert(hci_stack->hci_packet_buffer_reserved);
965826f7347S[email protected] 
966d713a683S[email protected]     uint8_t * packet = hci_stack->hci_packet_buffer;
967d713a683S[email protected]     hci_con_handle_t con_handle = READ_ACL_CONNECTION_HANDLE(packet);
968d713a683S[email protected] 
9695061f3afS[email protected]     hci_connection_t *connection = hci_connection_for_handle( con_handle);
97097b61c7bS[email protected]     if (!connection) {
9715fa0b7cfS[email protected]         log_error("hci_send_acl_packet_buffer called but no connection for handle 0x%04x", con_handle);
97297b61c7bS[email protected]         hci_release_packet_buffer();
973068b8592SMatthias Ringwald         hci_emit_transport_packet_sent();
9743e2050f7SMatthias Ringwald         return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
97597b61c7bS[email protected]     }
97652db98b2SMatthias Ringwald 
97779a2851bSMilanka Ringwald     // check for free places on Bluetooth module
97879a2851bSMilanka Ringwald     if (!hci_can_send_prepared_acl_packet_now(con_handle)) {
97979a2851bSMilanka Ringwald         log_error("hci_send_acl_packet_buffer called but no free ACL buffers on controller");
98079a2851bSMilanka Ringwald         hci_release_packet_buffer();
98179a2851bSMilanka Ringwald         hci_emit_transport_packet_sent();
98279a2851bSMilanka Ringwald         return BTSTACK_ACL_BUFFERS_FULL;
98379a2851bSMilanka Ringwald     }
98479a2851bSMilanka Ringwald 
98552db98b2SMatthias Ringwald #ifdef ENABLE_CLASSIC
98656cf178bSmatthias.ringwald     hci_connection_timestamp(connection);
98752db98b2SMatthias Ringwald #endif
98856cf178bSmatthias.ringwald 
989452cf3bbS[email protected]     // hci_dump_packet( HCI_ACL_DATA_PACKET, 0, packet, size);
9907856c818Smatthias.ringwald 
991452cf3bbS[email protected]     // setup data
992452cf3bbS[email protected]     hci_stack->acl_fragmentation_total_size = size;
993452cf3bbS[email protected]     hci_stack->acl_fragmentation_pos = 4;   // start of L2CAP packet
9946218e6f1Smatthias.ringwald 
995452cf3bbS[email protected]     return hci_send_acl_packet_fragments(connection);
996ee091cf1Smatthias.ringwald }
997ee091cf1Smatthias.ringwald 
99835454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
99944d0e3d5S[email protected] // pre: caller has reserved the packet buffer
10003e2050f7SMatthias Ringwald uint8_t hci_send_sco_packet_buffer(int size){
10013e2050f7SMatthias Ringwald     btstack_assert(hci_stack->hci_packet_buffer_reserved);
100244d0e3d5S[email protected] 
100344d0e3d5S[email protected]     uint8_t * packet = hci_stack->hci_packet_buffer;
10044b3e1e19SMatthias Ringwald 
10054b3e1e19SMatthias Ringwald     // skip checks in loopback mode
10064b3e1e19SMatthias Ringwald     if (!hci_stack->loopback_mode){
100744d0e3d5S[email protected]         hci_con_handle_t con_handle = READ_ACL_CONNECTION_HANDLE(packet);   // same for ACL and SCO
100844d0e3d5S[email protected] 
100944d0e3d5S[email protected]         // check for free places on Bluetooth module
1010701e3307SMatthias Ringwald         if (!hci_can_send_prepared_sco_packet_now()) {
1011cbf638a9SMatthias Ringwald             log_error("hci_send_sco_packet_buffer called but no free SCO buffers on controller");
101244d0e3d5S[email protected]             hci_release_packet_buffer();
1013068b8592SMatthias Ringwald             hci_emit_transport_packet_sent();
101444d0e3d5S[email protected]             return BTSTACK_ACL_BUFFERS_FULL;
101544d0e3d5S[email protected]         }
101644d0e3d5S[email protected] 
1017e35edcc1S[email protected]         // track send packet in connection struct
1018e35edcc1S[email protected]         hci_connection_t *connection = hci_connection_for_handle( con_handle);
1019e35edcc1S[email protected]         if (!connection) {
1020e35edcc1S[email protected]             log_error("hci_send_sco_packet_buffer called but no connection for handle 0x%04x", con_handle);
1021e35edcc1S[email protected]             hci_release_packet_buffer();
1022068b8592SMatthias Ringwald             hci_emit_transport_packet_sent();
10233e2050f7SMatthias Ringwald             return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
1024e35edcc1S[email protected]         }
1025f234b250SMatthias Ringwald 
1026f234b250SMatthias Ringwald         if (hci_have_usb_transport()){
1027f234b250SMatthias Ringwald             // token used
10281972f31fSMatthias Ringwald             hci_stack->sco_can_send_now = false;
1029f234b250SMatthias Ringwald         } else {
1030760b20efSMatthias Ringwald             if (hci_stack->synchronous_flow_control_enabled){
1031ce41473eSMatthias Ringwald                 connection->num_packets_sent++;
10326f28d2eeSMatthias Ringwald             } else {
1033e4157653SMatthias Ringwald                 connection->sco_tx_ready--;
1034760b20efSMatthias Ringwald             }
10354b3e1e19SMatthias Ringwald         }
1036f234b250SMatthias Ringwald     }
103744d0e3d5S[email protected] 
103844d0e3d5S[email protected]     hci_dump_packet( HCI_SCO_DATA_PACKET, 0, packet, size);
1039543e835cSMatthias Ringwald 
104043149fc9SMatthias Ringwald #ifdef HAVE_SCO_TRANSPORT
104143149fc9SMatthias Ringwald     hci_stack->sco_transport->send_packet(packet, size);
104243149fc9SMatthias Ringwald     hci_release_packet_buffer();
104343149fc9SMatthias Ringwald     hci_emit_transport_packet_sent();
104443149fc9SMatthias Ringwald 
104543149fc9SMatthias Ringwald     return 0;
104643149fc9SMatthias Ringwald #else
104743149fc9SMatthias Ringwald     int err = hci_stack->hci_transport->send_packet(HCI_SCO_DATA_PACKET, packet, size);
1048543e835cSMatthias Ringwald     if (hci_transport_synchronous()){
1049543e835cSMatthias Ringwald         hci_release_packet_buffer();
1050fd43c0e0SMatthias Ringwald         hci_emit_transport_packet_sent();
1051543e835cSMatthias Ringwald     }
1052543e835cSMatthias Ringwald 
10533e2050f7SMatthias Ringwald     if (err != 0){
10543e2050f7SMatthias Ringwald         return ERROR_CODE_HARDWARE_FAILURE;
10553e2050f7SMatthias Ringwald     }
10563e2050f7SMatthias Ringwald     return ERROR_CODE_SUCCESS;
105743149fc9SMatthias Ringwald #endif
105844d0e3d5S[email protected] }
105935454696SMatthias Ringwald #endif
106044d0e3d5S[email protected] 
10610a8cccd5SMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
106268ab6207SMatthias Ringwald static uint8_t hci_send_iso_packet_fragments(void){
106368ab6207SMatthias Ringwald 
106468ab6207SMatthias Ringwald     uint16_t max_iso_data_packet_length = hci_stack->le_iso_packets_length;
106568ab6207SMatthias Ringwald     uint8_t status = ERROR_CODE_SUCCESS;
106668ab6207SMatthias Ringwald     // multiple packets could be send on a synchronous HCI transport
106768ab6207SMatthias Ringwald     while (true){
106868ab6207SMatthias Ringwald 
106968ab6207SMatthias Ringwald         // get current data
107068ab6207SMatthias Ringwald         const uint16_t iso_header_pos = hci_stack->iso_fragmentation_pos - 4u;
107168ab6207SMatthias Ringwald         int current_iso_data_packet_length = hci_stack->iso_fragmentation_total_size - hci_stack->iso_fragmentation_pos;
107268ab6207SMatthias Ringwald         bool more_fragments = false;
107368ab6207SMatthias Ringwald 
107468ab6207SMatthias Ringwald         // if ISO packet is larger than Bluetooth packet buffer, only send max_acl_data_packet_length
107568ab6207SMatthias Ringwald         if (current_iso_data_packet_length > max_iso_data_packet_length){
107668ab6207SMatthias Ringwald             more_fragments = true;
107768ab6207SMatthias Ringwald             current_iso_data_packet_length = max_iso_data_packet_length;
107868ab6207SMatthias Ringwald         }
107968ab6207SMatthias Ringwald 
108068ab6207SMatthias Ringwald         // copy handle_and_flags if not first fragment and update packet boundary flags to be 01 (continuing fragmnent)
108168ab6207SMatthias Ringwald         uint16_t handle_and_flags = little_endian_read_16(hci_stack->hci_packet_buffer, 0);
108268ab6207SMatthias Ringwald         uint8_t pb_flags;
108368ab6207SMatthias Ringwald         if (iso_header_pos == 0u){
108468ab6207SMatthias Ringwald             // first fragment, keep TS field
108568ab6207SMatthias Ringwald             pb_flags = more_fragments ? 0x00 : 0x02;
108668ab6207SMatthias Ringwald             handle_and_flags = (handle_and_flags & 0x4fffu) | (pb_flags << 12u);
108768ab6207SMatthias Ringwald         } else {
108868ab6207SMatthias Ringwald             // later fragment, drop TS field
108968ab6207SMatthias Ringwald             pb_flags = more_fragments ? 0x01 : 0x03;
109068ab6207SMatthias Ringwald             handle_and_flags = (handle_and_flags & 0x0fffu) | (pb_flags << 12u);
109168ab6207SMatthias Ringwald         }
109268ab6207SMatthias Ringwald         little_endian_store_16(hci_stack->hci_packet_buffer, iso_header_pos, handle_and_flags);
109368ab6207SMatthias Ringwald 
109468ab6207SMatthias Ringwald         // update header len
109568ab6207SMatthias Ringwald         little_endian_store_16(hci_stack->hci_packet_buffer, iso_header_pos + 2u, current_iso_data_packet_length);
109668ab6207SMatthias Ringwald 
109768ab6207SMatthias Ringwald         // update state for next fragment (if any) as "transport done" might be sent during send_packet already
109868ab6207SMatthias Ringwald         if (more_fragments){
109968ab6207SMatthias Ringwald             // update start of next fragment to send
110068ab6207SMatthias Ringwald             hci_stack->iso_fragmentation_pos += current_iso_data_packet_length;
110168ab6207SMatthias Ringwald         } else {
110268ab6207SMatthias Ringwald             // done
110368ab6207SMatthias Ringwald             hci_stack->iso_fragmentation_pos = 0;
110468ab6207SMatthias Ringwald             hci_stack->iso_fragmentation_total_size = 0;
110568ab6207SMatthias Ringwald         }
110668ab6207SMatthias Ringwald 
110768ab6207SMatthias Ringwald         // send packet
110868ab6207SMatthias Ringwald         uint8_t * packet = &hci_stack->hci_packet_buffer[iso_header_pos];
110968ab6207SMatthias Ringwald         const int size = current_iso_data_packet_length + 4;
111068ab6207SMatthias Ringwald         hci_dump_packet(HCI_ISO_DATA_PACKET, 0, packet, size);
111168ab6207SMatthias Ringwald         hci_stack->iso_fragmentation_tx_active = true;
111268ab6207SMatthias Ringwald         int err = hci_stack->hci_transport->send_packet(HCI_ISO_DATA_PACKET, packet, size);
111368ab6207SMatthias Ringwald         if (err != 0){
111468ab6207SMatthias Ringwald             // no error from HCI Transport expected
111568ab6207SMatthias Ringwald             status = ERROR_CODE_HARDWARE_FAILURE;
111668ab6207SMatthias Ringwald         }
111768ab6207SMatthias Ringwald 
111868ab6207SMatthias Ringwald         // done yet?
111968ab6207SMatthias Ringwald         if (!more_fragments) break;
112068ab6207SMatthias Ringwald 
112168ab6207SMatthias Ringwald         // can send more?
112268ab6207SMatthias Ringwald         if (!hci_transport_can_send_prepared_packet_now(HCI_ISO_DATA_PACKET)) return false;
112368ab6207SMatthias Ringwald     }
112468ab6207SMatthias Ringwald 
112568ab6207SMatthias Ringwald     // release buffer now for synchronous transport
112668ab6207SMatthias Ringwald     if (hci_transport_synchronous()){
112768ab6207SMatthias Ringwald         hci_stack->iso_fragmentation_tx_active = false;
112868ab6207SMatthias Ringwald         hci_release_packet_buffer();
112968ab6207SMatthias Ringwald         hci_emit_transport_packet_sent();
113068ab6207SMatthias Ringwald     }
113168ab6207SMatthias Ringwald 
113268ab6207SMatthias Ringwald     return status;
113368ab6207SMatthias Ringwald }
113468ab6207SMatthias Ringwald 
1135ace08712SMatthias Ringwald uint8_t hci_send_iso_packet_buffer(uint16_t size){
1136ace08712SMatthias Ringwald     btstack_assert(hci_stack->hci_packet_buffer_reserved);
1137ace08712SMatthias Ringwald 
1138e5413aa0SMatthias Ringwald     hci_con_handle_t con_handle = (hci_con_handle_t) little_endian_read_16(hci_stack->hci_packet_buffer, 0) & 0xfff;
1139e5413aa0SMatthias Ringwald     hci_iso_stream_t * iso_stream = hci_iso_stream_for_con_handle(con_handle);
1140e5413aa0SMatthias Ringwald     if (iso_stream == NULL){
1141977f918dSMatthias Ringwald         hci_release_packet_buffer();
1142977f918dSMatthias Ringwald         hci_iso_notify_can_send_now();
1143e5413aa0SMatthias Ringwald         return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
1144e5413aa0SMatthias Ringwald     }
1145e5413aa0SMatthias Ringwald 
1146e5413aa0SMatthias Ringwald     // TODO: check for space on controller
1147e5413aa0SMatthias Ringwald 
1148977f918dSMatthias Ringwald     // skip iso packets if needed
1149977f918dSMatthias Ringwald     if (iso_stream->num_packets_to_skip > 0){
1150977f918dSMatthias Ringwald         iso_stream->num_packets_to_skip--;
1151977f918dSMatthias Ringwald         // pretend it was processed and trigger next one
1152977f918dSMatthias Ringwald         hci_release_packet_buffer();
1153977f918dSMatthias Ringwald         hci_iso_notify_can_send_now();
1154977f918dSMatthias Ringwald         return ERROR_CODE_SUCCESS;
1155977f918dSMatthias Ringwald     }
1156977f918dSMatthias Ringwald 
1157e5413aa0SMatthias Ringwald     // track outgoing packet sent
1158e5413aa0SMatthias Ringwald     log_info("Outgoing ISO packet for con handle 0x%04x", con_handle);
1159e5413aa0SMatthias Ringwald     iso_stream->num_packets_sent++;
1160e5413aa0SMatthias Ringwald 
116168ab6207SMatthias Ringwald     // setup data
116268ab6207SMatthias Ringwald     hci_stack->iso_fragmentation_total_size = size;
116368ab6207SMatthias Ringwald     hci_stack->iso_fragmentation_pos = 4;   // start of L2CAP packet
116468ab6207SMatthias Ringwald 
116568ab6207SMatthias Ringwald     return hci_send_iso_packet_fragments();
1166ace08712SMatthias Ringwald }
1167ace08712SMatthias Ringwald #endif
1168ace08712SMatthias Ringwald 
1169c3b46f5aSMatthias Ringwald static void acl_handler(uint8_t *packet, uint16_t size){
1170e76a89eeS[email protected] 
11717856c818Smatthias.ringwald     // get info
11727856c818Smatthias.ringwald     hci_con_handle_t con_handle = READ_ACL_CONNECTION_HANDLE(packet);
11735061f3afS[email protected]     hci_connection_t *conn      = hci_connection_for_handle(con_handle);
11747856c818Smatthias.ringwald     uint8_t  acl_flags          = READ_ACL_FLAGS(packet);
11757856c818Smatthias.ringwald     uint16_t acl_length         = READ_ACL_LENGTH(packet);
11767856c818Smatthias.ringwald 
11777856c818Smatthias.ringwald     // ignore non-registered handle
11787856c818Smatthias.ringwald     if (!conn){
1179c3b46f5aSMatthias Ringwald         log_error("acl_handler called with non-registered handle %u!" , con_handle);
11807856c818Smatthias.ringwald         return;
11817856c818Smatthias.ringwald     }
11827856c818Smatthias.ringwald 
1183e76a89eeS[email protected]     // assert packet is complete
11844ea43905SMatthias Ringwald     if ((acl_length + 4u) != size){
1185c3b46f5aSMatthias Ringwald         log_error("acl_handler called with ACL packet of wrong size %d, expected %u => dropping packet", size, acl_length + 4);
1186e76a89eeS[email protected]         return;
1187e76a89eeS[email protected]     }
1188e76a89eeS[email protected] 
118952db98b2SMatthias Ringwald #ifdef ENABLE_CLASSIC
11907856c818Smatthias.ringwald     // update idle timestamp
11917856c818Smatthias.ringwald     hci_connection_timestamp(conn);
119252db98b2SMatthias Ringwald #endif
11937856c818Smatthias.ringwald 
11942b838201SMatthias Ringwald #ifdef ENABLE_HCI_CONTROLLER_TO_HOST_FLOW_CONTROL
11952b838201SMatthias Ringwald     hci_stack->host_completed_packets = 1;
11962b838201SMatthias Ringwald     conn->num_packets_completed++;
11972b838201SMatthias Ringwald #endif
11982b838201SMatthias Ringwald 
11997856c818Smatthias.ringwald     // handle different packet types
12004ea43905SMatthias Ringwald     switch (acl_flags & 0x03u) {
12017856c818Smatthias.ringwald 
12027856c818Smatthias.ringwald         case 0x01: // continuation fragment
12037856c818Smatthias.ringwald 
12040ca847afS[email protected]             // sanity checks
12054ea43905SMatthias Ringwald             if (conn->acl_recombination_pos == 0u) {
12069da54300S[email protected]                 log_error( "ACL Cont Fragment but no first fragment for handle 0x%02x", con_handle);
12077856c818Smatthias.ringwald                 return;
12087856c818Smatthias.ringwald             }
12094ea43905SMatthias Ringwald             if ((conn->acl_recombination_pos + acl_length) > (4u + HCI_ACL_BUFFER_SIZE)){
12100ca847afS[email protected]                 log_error( "ACL Cont Fragment to large: combined packet %u > buffer size %u for handle 0x%02x",
12110ca847afS[email protected]                     conn->acl_recombination_pos + acl_length, 4 + HCI_ACL_BUFFER_SIZE, con_handle);
12120ca847afS[email protected]                 conn->acl_recombination_pos = 0;
12130ca847afS[email protected]                 return;
12140ca847afS[email protected]             }
12157856c818Smatthias.ringwald 
12167856c818Smatthias.ringwald             // append fragment payload (header already stored)
12176535961aSMatthias Ringwald             (void)memcpy(&conn->acl_recombination_buffer[HCI_INCOMING_PRE_BUFFER_SIZE + conn->acl_recombination_pos],
12186535961aSMatthias Ringwald                          &packet[4], acl_length);
12197856c818Smatthias.ringwald             conn->acl_recombination_pos += acl_length;
12207856c818Smatthias.ringwald 
12217856c818Smatthias.ringwald             // forward complete L2CAP packet if complete.
12224ea43905SMatthias Ringwald             if (conn->acl_recombination_pos >= (conn->acl_recombination_length + 4u + 4u)){ // pos already incl. ACL header
1223d6b06661SMatthias Ringwald                 hci_emit_acl_packet(&conn->acl_recombination_buffer[HCI_INCOMING_PRE_BUFFER_SIZE], conn->acl_recombination_pos);
12247856c818Smatthias.ringwald                 // reset recombination buffer
12257856c818Smatthias.ringwald                 conn->acl_recombination_length = 0;
12267856c818Smatthias.ringwald                 conn->acl_recombination_pos = 0;
12277856c818Smatthias.ringwald             }
12287856c818Smatthias.ringwald             break;
12297856c818Smatthias.ringwald 
12307856c818Smatthias.ringwald         case 0x02: { // first fragment
12317856c818Smatthias.ringwald 
123223a77e1aS[email protected]             // sanity check
123323a77e1aS[email protected]             if (conn->acl_recombination_pos) {
123460737d2bSMatthias Ringwald                 // we just received the first fragment, but still have data. Only warn if the packet wasn't a flushable packet
123560737d2bSMatthias Ringwald                 if ((conn->acl_recombination_buffer[HCI_INCOMING_PRE_BUFFER_SIZE+1] >> 4) != 0x02){
123660737d2bSMatthias Ringwald                     log_error( "ACL First Fragment but %u bytes in buffer for handle 0x%02x, dropping stale fragments", conn->acl_recombination_pos, con_handle);
123760737d2bSMatthias Ringwald                 }
123823a77e1aS[email protected]                 conn->acl_recombination_pos = 0;
123923a77e1aS[email protected]             }
124023a77e1aS[email protected] 
12417856c818Smatthias.ringwald             // peek into L2CAP packet!
12427856c818Smatthias.ringwald             uint16_t l2cap_length = READ_L2CAP_LENGTH( packet );
12437856c818Smatthias.ringwald 
12447856c818Smatthias.ringwald             // compare fragment size to L2CAP packet size
12454ea43905SMatthias Ringwald             if (acl_length >= (l2cap_length + 4u)){
12467856c818Smatthias.ringwald                 // forward fragment as L2CAP packet
12474ea43905SMatthias Ringwald                 hci_emit_acl_packet(packet, acl_length + 4u);
12487856c818Smatthias.ringwald             } else {
12490ca847afS[email protected] 
12500ca847afS[email protected]                 if (acl_length > HCI_ACL_BUFFER_SIZE){
12510ca847afS[email protected]                     log_error( "ACL First Fragment to large: fragment %u > buffer size %u for handle 0x%02x",
12520ca847afS[email protected]                         4 + acl_length, 4 + HCI_ACL_BUFFER_SIZE, con_handle);
12530ca847afS[email protected]                     return;
12540ca847afS[email protected]                 }
12550ca847afS[email protected] 
12567856c818Smatthias.ringwald                 // store first fragment and tweak acl length for complete package
12576535961aSMatthias Ringwald                 (void)memcpy(&conn->acl_recombination_buffer[HCI_INCOMING_PRE_BUFFER_SIZE],
12584ea43905SMatthias Ringwald                              packet, acl_length + 4u);
12594ea43905SMatthias Ringwald                 conn->acl_recombination_pos    = acl_length + 4u;
12607856c818Smatthias.ringwald                 conn->acl_recombination_length = l2cap_length;
12614ea43905SMatthias Ringwald                 little_endian_store_16(conn->acl_recombination_buffer, HCI_INCOMING_PRE_BUFFER_SIZE + 2u, l2cap_length +4u);
12627856c818Smatthias.ringwald             }
12637856c818Smatthias.ringwald             break;
12647856c818Smatthias.ringwald 
12657856c818Smatthias.ringwald         }
12667856c818Smatthias.ringwald         default:
1267c3b46f5aSMatthias Ringwald             log_error( "acl_handler called with invalid packet boundary flags %u", acl_flags & 0x03);
12687856c818Smatthias.ringwald             return;
12697856c818Smatthias.ringwald     }
127094ab26f8Smatthias.ringwald 
127194ab26f8Smatthias.ringwald     // execute main loop
127294ab26f8Smatthias.ringwald     hci_run();
127316833f0aSmatthias.ringwald }
127422909952Smatthias.ringwald 
12751ab2dc58SMatthias Ringwald static void hci_connection_stop_timer(hci_connection_t * conn){
12761ab2dc58SMatthias Ringwald     btstack_run_loop_remove_timer(&conn->timeout);
12771ab2dc58SMatthias Ringwald #ifdef ENABLE_CLASSIC
12781ab2dc58SMatthias Ringwald     btstack_run_loop_remove_timer(&conn->timeout_sco);
12791ab2dc58SMatthias Ringwald #endif
12801ab2dc58SMatthias Ringwald }
12811ab2dc58SMatthias Ringwald 
128267a3e8ecSmatthias.ringwald static void hci_shutdown_connection(hci_connection_t *conn){
12839da54300S[email protected]     log_info("Connection closed: handle 0x%x, %s", conn->con_handle, bd_addr_to_str(conn->address));
12843c4d4b90Smatthias.ringwald 
1285b3264428SMatthias Ringwald #ifdef ENABLE_CLASSIC
1286cb70c5abSMatthias Ringwald #if defined(ENABLE_SCO_OVER_HCI) || defined(HAVE_SCO_TRANSPORT)
1287cb70c5abSMatthias Ringwald     bd_addr_type_t addr_type = conn->address_type;
1288cb70c5abSMatthias Ringwald #endif
1289cb70c5abSMatthias Ringwald #ifdef HAVE_SCO_TRANSPORT
1290cb70c5abSMatthias Ringwald     hci_con_handle_t con_handle = conn->con_handle;
1291ee752bb8SMatthias Ringwald #endif
1292b3264428SMatthias Ringwald #endif
1293ee752bb8SMatthias Ringwald 
12941ab2dc58SMatthias Ringwald     hci_connection_stop_timer(conn);
1295c785ef68Smatthias.ringwald 
1296665d90f2SMatthias Ringwald     btstack_linked_list_remove(&hci_stack->connections, (btstack_linked_item_t *) conn);
1297a3b02b71Smatthias.ringwald     btstack_memory_hci_connection_free( conn );
12983c4d4b90Smatthias.ringwald 
12993c4d4b90Smatthias.ringwald     // now it's gone
1300c7e0c5f6Smatthias.ringwald     hci_emit_nr_connections_changed();
1301ee752bb8SMatthias Ringwald 
1302b3264428SMatthias Ringwald #ifdef ENABLE_CLASSIC
1303034e9b53SMatthias Ringwald #ifdef ENABLE_SCO_OVER_HCI
1304ee752bb8SMatthias Ringwald     // update SCO
1305cb70c5abSMatthias Ringwald     if ((addr_type == BD_ADDR_TYPE_SCO) && (hci_stack->hci_transport != NULL) && (hci_stack->hci_transport->set_sco_config != NULL)){
1306ee752bb8SMatthias Ringwald         hci_stack->hci_transport->set_sco_config(hci_stack->sco_voice_setting_active, hci_number_sco_connections());
1307ee752bb8SMatthias Ringwald     }
1308034e9b53SMatthias Ringwald #endif
1309cb70c5abSMatthias Ringwald #ifdef HAVE_SCO_TRANSPORT
1310cb70c5abSMatthias Ringwald     if ((addr_type == BD_ADDR_TYPE_SCO) && (hci_stack->sco_transport != NULL)){
1311cb70c5abSMatthias Ringwald         hci_stack->sco_transport->close(con_handle);
1312cb70c5abSMatthias Ringwald     }
1313cb70c5abSMatthias Ringwald #endif
1314b3264428SMatthias Ringwald #endif
1315c7e0c5f6Smatthias.ringwald }
1316c7e0c5f6Smatthias.ringwald 
131735454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
131835454696SMatthias Ringwald 
131929e39de4SMatthias Ringwald static const uint16_t hci_acl_packet_type_sizes[] = {
13208f8108aaSmatthias.ringwald     0, HCI_ACL_2DH1_SIZE, HCI_ACL_3DH1_SIZE, HCI_ACL_DM1_SIZE,
13218f8108aaSmatthias.ringwald     HCI_ACL_DH1_SIZE, 0, 0, 0,
13228f8108aaSmatthias.ringwald     HCI_ACL_2DH3_SIZE, HCI_ACL_3DH3_SIZE, HCI_ACL_DM3_SIZE, HCI_ACL_DH3_SIZE,
13238f8108aaSmatthias.ringwald     HCI_ACL_2DH5_SIZE, HCI_ACL_3DH5_SIZE, HCI_ACL_DM5_SIZE, HCI_ACL_DH5_SIZE
13248f8108aaSmatthias.ringwald };
132529e39de4SMatthias Ringwald static const uint8_t hci_acl_packet_type_feature_requirement_bit[] = {
132665389bfcS[email protected]      0, // 3 slot packets
132765389bfcS[email protected]      1, // 5 slot packets
132865389bfcS[email protected]     25, // EDR 2 mpbs
132965389bfcS[email protected]     26, // EDR 3 mbps
133065389bfcS[email protected]     39, // 3 slot EDR packts
133165389bfcS[email protected]     40, // 5 slot EDR packet
133265389bfcS[email protected] };
133329e39de4SMatthias Ringwald static const uint16_t hci_acl_packet_type_feature_packet_mask[] = {
133465389bfcS[email protected]     0x0f00, // 3 slot packets
133565389bfcS[email protected]     0xf000, // 5 slot packets
133665389bfcS[email protected]     0x1102, // EDR 2 mpbs
133765389bfcS[email protected]     0x2204, // EDR 3 mbps
133865389bfcS[email protected]     0x0300, // 3 slot EDR packts
133965389bfcS[email protected]     0x3000, // 5 slot EDR packet
134065389bfcS[email protected] };
13418f8108aaSmatthias.ringwald 
134265389bfcS[email protected] static uint16_t hci_acl_packet_types_for_buffer_size_and_local_features(uint16_t buffer_size, uint8_t * local_supported_features){
134365389bfcS[email protected]     // enable packet types based on size
13448f8108aaSmatthias.ringwald     uint16_t packet_types = 0;
1345f16a69bbS[email protected]     unsigned int i;
13468f8108aaSmatthias.ringwald     for (i=0;i<16;i++){
134729e39de4SMatthias Ringwald         if (hci_acl_packet_type_sizes[i] == 0) continue;
134829e39de4SMatthias Ringwald         if (hci_acl_packet_type_sizes[i] <= buffer_size){
13498f8108aaSmatthias.ringwald             packet_types |= 1 << i;
13508f8108aaSmatthias.ringwald         }
13518f8108aaSmatthias.ringwald     }
135265389bfcS[email protected]     // disable packet types due to missing local supported features
135329e39de4SMatthias Ringwald     for (i=0;i<sizeof(hci_acl_packet_type_feature_requirement_bit); i++){
135429e39de4SMatthias Ringwald         unsigned int bit_idx = hci_acl_packet_type_feature_requirement_bit[i];
135565389bfcS[email protected]         int feature_set = (local_supported_features[bit_idx >> 3] & (1<<(bit_idx & 7))) != 0;
135665389bfcS[email protected]         if (feature_set) continue;
135729e39de4SMatthias Ringwald         log_info("Features bit %02u is not set, removing packet types 0x%04x", bit_idx, hci_acl_packet_type_feature_packet_mask[i]);
135829e39de4SMatthias Ringwald         packet_types &= ~hci_acl_packet_type_feature_packet_mask[i];
135965389bfcS[email protected]     }
13608f8108aaSmatthias.ringwald     return packet_types;
13618f8108aaSmatthias.ringwald }
13628f8108aaSmatthias.ringwald 
13638f8108aaSmatthias.ringwald uint16_t hci_usable_acl_packet_types(void){
1364028ead5eSMatthias Ringwald     uint16_t active_packet_types = (hci_stack->usable_packet_types_acl &  hci_stack->enabled_packet_types_acl);
136529e39de4SMatthias Ringwald     // flip bits for "may not be used"
1366028ead5eSMatthias Ringwald     return  active_packet_types ^ 0x3306;
1367028ead5eSMatthias Ringwald }
1368028ead5eSMatthias Ringwald 
1369028ead5eSMatthias Ringwald void hci_enable_acl_packet_types(uint16_t packet_types){
1370028ead5eSMatthias Ringwald     hci_stack->enabled_packet_types_acl = packet_types;
13718f8108aaSmatthias.ringwald }
137229e39de4SMatthias Ringwald 
1373c92ca2c8SMatthias Ringwald static const struct {
1374c92ca2c8SMatthias Ringwald     uint8_t feature_index;
1375c92ca2c8SMatthias Ringwald     uint16_t feature_packet_mask;
1376c92ca2c8SMatthias Ringwald } hci_sco_packet_type_feature_requirements[] = {
1377c92ca2c8SMatthias Ringwald         { 12, SCO_PACKET_TYPES_HV2 },                           // HV2 packets
1378c92ca2c8SMatthias Ringwald         { 13, SCO_PACKET_TYPES_HV3 },                           // HV3 packets
1379c92ca2c8SMatthias Ringwald         { 31, SCO_PACKET_TYPES_ESCO },                          // eSCO links (EV3 packets)
1380c92ca2c8SMatthias Ringwald         { 32, SCO_PACKET_TYPES_EV4 },                           // EV4 packets
1381c92ca2c8SMatthias Ringwald         { 45, SCO_PACKET_TYPES_2EV3 | SCO_PACKET_TYPES_2EV5 },  // EDR eSCO 2 Mb/s
1382c92ca2c8SMatthias Ringwald         { 46, SCO_PACKET_TYPES_3EV3 | SCO_PACKET_TYPES_3EV5 },  // EDR eSCO 3 Mb/s
13836afff830SMatthias Ringwald         { 47, SCO_PACKET_TYPES_2EV5 | SCO_PACKET_TYPES_3EV5 },  // 3-slot EDR eSCO packets, 2-EV3/3-EV3 use single slot
1384c92ca2c8SMatthias Ringwald };
1385c92ca2c8SMatthias Ringwald 
1386d7891039SMatthias Ringwald // map packet types to payload length, prefer eSCO over SCO and large over small packets
1387d7891039SMatthias Ringwald static const struct {
1388d7891039SMatthias Ringwald     uint16_t type;
1389d7891039SMatthias Ringwald     uint16_t payload_length;
1390d7891039SMatthias Ringwald } hci_sco_packet_type_to_payload_length[] = {
1391d7891039SMatthias Ringwald         {SCO_PACKET_TYPES_3EV5, HCI_SCO_3EV5_SIZE}, // 540
1392d7891039SMatthias Ringwald         {SCO_PACKET_TYPES_2EV5, HCI_SCO_2EV5_SIZE}, // 360
1393d7891039SMatthias Ringwald         {SCO_PACKET_TYPES_EV5,  HCI_SCO_EV5_SIZE},  // 180
1394d7891039SMatthias Ringwald         {SCO_PACKET_TYPES_EV4,  HCI_SCO_EV4_SIZE},  // 120
1395d7891039SMatthias Ringwald         {SCO_PACKET_TYPES_3EV3, HCI_SCO_3EV3_SIZE}, //  90
1396d7891039SMatthias Ringwald         {SCO_PACKET_TYPES_2EV3, HCI_SCO_2EV3_SIZE}, //  60
1397d7891039SMatthias Ringwald         {SCO_PACKET_TYPES_EV3,  HCI_SCO_EV3_SIZE},  //  30
1398d7891039SMatthias Ringwald         {SCO_PACKET_TYPES_HV3,  HCI_SCO_HV3_SIZE},  //  30
1399d7891039SMatthias Ringwald         {SCO_PACKET_TYPES_HV2,  HCI_SCO_HV2_SIZE},  //  20
1400d7891039SMatthias Ringwald         {SCO_PACKET_TYPES_HV1,  HCI_SCO_HV1_SIZE}   //  10
1401d7891039SMatthias Ringwald };
1402d7891039SMatthias Ringwald 
1403c92ca2c8SMatthias Ringwald static uint16_t hci_sco_packet_types_for_features(const uint8_t * local_supported_features){
1404c92ca2c8SMatthias Ringwald     uint16_t packet_types = SCO_PACKET_TYPES_ALL;
1405c92ca2c8SMatthias Ringwald     unsigned int i;
1406c92ca2c8SMatthias Ringwald     // disable packet types due to missing local supported features
1407c92ca2c8SMatthias Ringwald     for (i=0;i<(sizeof(hci_sco_packet_type_feature_requirements)/sizeof(hci_sco_packet_type_feature_requirements[0])); i++){
1408c92ca2c8SMatthias Ringwald         unsigned int bit_idx = hci_sco_packet_type_feature_requirements[i].feature_index;
1409c92ca2c8SMatthias Ringwald         bool feature_set = (local_supported_features[bit_idx >> 3] & (1<<(bit_idx & 7))) != 0;
1410c92ca2c8SMatthias Ringwald         if (feature_set) continue;
1411c92ca2c8SMatthias 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);
1412c92ca2c8SMatthias Ringwald         packet_types &= ~hci_sco_packet_type_feature_requirements[i].feature_packet_mask;
1413c92ca2c8SMatthias Ringwald     }
1414c92ca2c8SMatthias Ringwald     return packet_types;
1415c92ca2c8SMatthias Ringwald }
1416c92ca2c8SMatthias Ringwald 
1417c92ca2c8SMatthias Ringwald uint16_t hci_usable_sco_packet_types(void){
1418c92ca2c8SMatthias Ringwald     return hci_stack->usable_packet_types_sco;
1419c92ca2c8SMatthias Ringwald }
1420c92ca2c8SMatthias Ringwald 
1421d7891039SMatthias Ringwald static uint16_t hci_sco_payload_length_for_packet_types(uint16_t packet_types){
1422d7891039SMatthias Ringwald     uint8_t i;
1423d7891039SMatthias Ringwald     for (i=0;i<sizeof(hci_sco_packet_type_to_payload_length)/sizeof(hci_sco_packet_type_to_payload_length[0]);i++){
1424d7891039SMatthias Ringwald         if ((hci_sco_packet_type_to_payload_length[i].type & packet_types) != 0){
1425d7891039SMatthias Ringwald             return hci_sco_packet_type_to_payload_length[i].payload_length;
1426d7891039SMatthias Ringwald         }
1427d7891039SMatthias Ringwald     }
1428d7891039SMatthias Ringwald     return 0;
1429d7891039SMatthias Ringwald }
1430d7891039SMatthias Ringwald 
143135454696SMatthias Ringwald #endif
14328f8108aaSmatthias.ringwald 
1433facf93fdS[email protected] uint8_t* hci_get_outgoing_packet_buffer(void){
14347dc17943Smatthias.ringwald     // hci packet buffer is >= acl data packet length
14353a9fb326S[email protected]     return hci_stack->hci_packet_buffer;
14367dc17943Smatthias.ringwald }
14377dc17943Smatthias.ringwald 
1438f5d8d141S[email protected] uint16_t hci_max_acl_data_packet_length(void){
14393a9fb326S[email protected]     return hci_stack->acl_data_packet_length;
14407dc17943Smatthias.ringwald }
14417dc17943Smatthias.ringwald 
144206b9e820SMatthias Ringwald #ifdef ENABLE_CLASSIC
144320dcdd22SMatthias Ringwald bool hci_extended_sco_link_supported(void){
14443e68d23dSMatthias Ringwald     // No. 31, byte 3, bit 7
14453e68d23dSMatthias Ringwald     return (hci_stack->local_supported_features[3] & (1 << 7)) != 0;
14463e68d23dSMatthias Ringwald }
144706b9e820SMatthias Ringwald #endif
14483e68d23dSMatthias Ringwald 
144920dcdd22SMatthias Ringwald bool hci_non_flushable_packet_boundary_flag_supported(void){
14506ac9a97eS[email protected]     // No. 54, byte 6, bit 6
14514ea43905SMatthias Ringwald     return (hci_stack->local_supported_features[6u] & (1u << 6u)) != 0u;
14526ac9a97eS[email protected] }
14536ac9a97eS[email protected] 
14549885fb2dSMatthias Ringwald #ifdef ENABLE_CLASSIC
145557514786SMatthias Ringwald static bool gap_ssp_supported(void){
14566ac9a97eS[email protected]     // No. 51, byte 6, bit 3
14574ea43905SMatthias Ringwald     return (hci_stack->local_supported_features[6u] & (1u << 3u)) != 0u;
1458f5d8d141S[email protected] }
14599885fb2dSMatthias Ringwald #endif
1460f5d8d141S[email protected] 
1461ad58a385SMatthias Ringwald bool hci_classic_supported(void){
146235454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
14636ac9a97eS[email protected]     // No. 37, byte 4, bit 5, = No BR/EDR Support
14643a9fb326S[email protected]     return (hci_stack->local_supported_features[4] & (1 << 5)) == 0;
146535454696SMatthias Ringwald #else
146657514786SMatthias Ringwald     return false;
146735454696SMatthias Ringwald #endif
1468f5d8d141S[email protected] }
1469f5d8d141S[email protected] 
1470ad58a385SMatthias Ringwald bool hci_le_supported(void){
1471a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE
14726ac9a97eS[email protected]     // No. 37, byte 4, bit 6 = LE Supported (Controller)
14734ea43905SMatthias Ringwald     return (hci_stack->local_supported_features[4u] & (1u << 6u)) != 0u;
1474f5d8d141S[email protected] #else
147557514786SMatthias Ringwald     return false;
1476f5d8d141S[email protected] #endif
1477f5d8d141S[email protected] }
1478f5d8d141S[email protected] 
14791ffa425cSMatthias Ringwald static bool hci_command_supported(uint8_t command_index){
14801ffa425cSMatthias Ringwald     return (hci_stack->local_supported_commands & (1LU << command_index)) != 0;
14811ffa425cSMatthias Ringwald }
14821ffa425cSMatthias Ringwald 
1483b95a5a35SMatthias Ringwald #ifdef ENABLE_BLE
1484b95a5a35SMatthias Ringwald 
148563671e69SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
148663671e69SMatthias Ringwald static bool hci_extended_advertising_supported(void){
148763671e69SMatthias Ringwald     return hci_command_supported(SUPPORTED_HCI_COMMAND_LE_SET_EXTENDED_ADVERTISING_ENABLE);
148863671e69SMatthias Ringwald }
148963671e69SMatthias Ringwald #endif
149063671e69SMatthias Ringwald 
1491f5873674SMatthias Ringwald static void hci_get_own_address_for_addr_type(uint8_t own_addr_type, bd_addr_t own_addr){
14926bcfa632SMatthias Ringwald     if (own_addr_type == BD_ADDR_TYPE_LE_PUBLIC){
14936bcfa632SMatthias Ringwald         (void)memcpy(own_addr, hci_stack->local_bd_addr, 6);
149469a97523S[email protected]     } else {
14956bcfa632SMatthias Ringwald         (void)memcpy(own_addr, hci_stack->le_random_address, 6);
149669a97523S[email protected]     }
149769a97523S[email protected] }
149869a97523S[email protected] 
14996bcfa632SMatthias Ringwald void gap_le_get_own_address(uint8_t * addr_type, bd_addr_t addr){
15006bcfa632SMatthias Ringwald     *addr_type = hci_stack->le_own_addr_type;
15016bcfa632SMatthias Ringwald     hci_get_own_address_for_addr_type(hci_stack->le_own_addr_type, addr);
15026bcfa632SMatthias Ringwald }
15036bcfa632SMatthias Ringwald 
15046bcfa632SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
15056bcfa632SMatthias Ringwald void gap_le_get_own_advertisements_address(uint8_t * addr_type, bd_addr_t addr){
15066bcfa632SMatthias Ringwald     *addr_type = hci_stack->le_advertisements_own_addr_type;
15076bcfa632SMatthias Ringwald     hci_get_own_address_for_addr_type(hci_stack->le_advertisements_own_addr_type, addr);
15086bcfa632SMatthias Ringwald };
15096bcfa632SMatthias Ringwald #endif
15106bcfa632SMatthias Ringwald 
1511e8c8828eSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
15126bcfa632SMatthias Ringwald 
15136bcfa632SMatthias Ringwald /**
15146bcfa632SMatthias Ringwald  * @brief Get own addr type and address used for LE connections (Central)
15156bcfa632SMatthias Ringwald  */
15166bcfa632SMatthias Ringwald void gap_le_get_own_connection_address(uint8_t * addr_type, bd_addr_t addr){
15176bcfa632SMatthias Ringwald     *addr_type = hci_stack->le_connection_own_addr_type;
15186bcfa632SMatthias Ringwald     hci_get_own_address_for_addr_type(hci_stack->le_connection_own_addr_type, addr);
15196bcfa632SMatthias Ringwald }
15206bcfa632SMatthias Ringwald 
1521384b59deSMatthias Ringwald void le_handle_advertisement_report(uint8_t *packet, uint16_t size){
15229ec2630cSMatthias Ringwald 
1523a0698cb4SMatthias Ringwald     uint16_t offset = 3;
1524a0698cb4SMatthias Ringwald     uint8_t num_reports = packet[offset];
1525d1dc057bS[email protected]     offset += 1;
1526d1dc057bS[email protected] 
1527a0698cb4SMatthias Ringwald     uint16_t i;
152803fbe9c6S[email protected]     uint8_t event[12 + LE_ADVERTISING_DATA_SIZE]; // use upper bound to avoid var size automatic var
1529a1df452eSMatthias Ringwald     for (i=0; (i<num_reports) && (offset < size);i++){
153033e6948bSMatthias Ringwald         // sanity checks on data_length:
153133e6948bSMatthias Ringwald         uint8_t data_length = packet[offset + 8];
153233e6948bSMatthias Ringwald         if (data_length > LE_ADVERTISING_DATA_SIZE) return;
15334ea43905SMatthias Ringwald         if ((offset + 9u + data_length + 1u) > size)    return;
153433e6948bSMatthias Ringwald         // setup event
15354ea43905SMatthias Ringwald         uint8_t event_size = 10u + data_length;
1536a0698cb4SMatthias Ringwald         uint16_t pos = 0;
1537045013feSMatthias Ringwald         event[pos++] = GAP_EVENT_ADVERTISING_REPORT;
153857c9da5bS[email protected]         event[pos++] = event_size;
15396535961aSMatthias Ringwald         (void)memcpy(&event[pos], &packet[offset], 1 + 1 + 6); // event type + address type + address
1540d1dc057bS[email protected]         offset += 8;
1541d1dc057bS[email protected]         pos += 8;
1542d1dc057bS[email protected]         event[pos++] = packet[offset + 1 + data_length]; // rssi
154333e6948bSMatthias Ringwald         event[pos++] = data_length;
154433e6948bSMatthias Ringwald         offset++;
15456535961aSMatthias Ringwald         (void)memcpy(&event[pos], &packet[offset], data_length);
154657c9da5bS[email protected]         pos +=    data_length;
15474ea43905SMatthias Ringwald         offset += data_length + 1u; // rssi
1548d6b06661SMatthias Ringwald         hci_emit_event(event, pos, 1);
154957c9da5bS[email protected]     }
155057c9da5bS[email protected] }
1551a0698cb4SMatthias Ringwald 
1552a0698cb4SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
1553a0698cb4SMatthias Ringwald void le_handle_extended_advertisement_report(uint8_t *packet, uint16_t size) {
1554a0698cb4SMatthias Ringwald     uint16_t offset = 3;
1555a0698cb4SMatthias Ringwald     uint8_t num_reports = packet[offset++];
1556c95a0fc7SMatthias Ringwald     uint8_t event[2 + 255]; // use upper bound to avoid var size automatic var
1557a0698cb4SMatthias Ringwald     uint8_t i;
1558a0698cb4SMatthias Ringwald     for (i=0; (i<num_reports) && (offset < size);i++){
1559a0698cb4SMatthias Ringwald         // sanity checks on data_length:
1560a0698cb4SMatthias Ringwald         uint16_t data_length = packet[offset + 23];
156143ce0351SMatthias Ringwald         if (data_length > LE_EXTENDED_ADVERTISING_DATA_SIZE) return;
1562a0698cb4SMatthias Ringwald         if ((offset + 24u + data_length) > size)    return;
1563a0698cb4SMatthias Ringwald         uint16_t event_type = little_endian_read_16(packet, offset);
1564a0698cb4SMatthias Ringwald         offset += 2;
1565a0698cb4SMatthias Ringwald         if ((event_type & 0x10) != 0) {
1566a0698cb4SMatthias Ringwald            // setup legacy event
1567a0698cb4SMatthias Ringwald             uint8_t legacy_event_type;
1568a0698cb4SMatthias Ringwald             switch (event_type){
1569a0698cb4SMatthias Ringwald                 case 0b0010011:
1570a0698cb4SMatthias Ringwald                     // ADV_IND
1571a0698cb4SMatthias Ringwald                     legacy_event_type = 0;
1572a0698cb4SMatthias Ringwald                     break;
1573a0698cb4SMatthias Ringwald                 case 0b0010101:
1574a0698cb4SMatthias Ringwald                     // ADV_DIRECT_IND
1575a0698cb4SMatthias Ringwald                     legacy_event_type = 1;
1576a0698cb4SMatthias Ringwald                     break;
1577a0698cb4SMatthias Ringwald                 case 0b0010010:
1578a0698cb4SMatthias Ringwald                     // ADV_SCAN_IND
1579a0698cb4SMatthias Ringwald                     legacy_event_type = 2;
1580a0698cb4SMatthias Ringwald                     break;
1581a0698cb4SMatthias Ringwald                 case 0b0010000:
1582a0698cb4SMatthias Ringwald                     // ADV_NONCONN_IND
1583a0698cb4SMatthias Ringwald                     legacy_event_type = 3;
1584a0698cb4SMatthias Ringwald                     break;
1585a0698cb4SMatthias Ringwald                 case 0b0011011:
1586a0698cb4SMatthias Ringwald                 case 0b0011010:
1587a0698cb4SMatthias Ringwald                     // SCAN_RSP
1588a0698cb4SMatthias Ringwald                     legacy_event_type = 4;
1589a0698cb4SMatthias Ringwald                     break;
1590a0698cb4SMatthias Ringwald                 default:
1591a0698cb4SMatthias Ringwald                     legacy_event_type = 0;
1592a0698cb4SMatthias Ringwald                     break;
1593a0698cb4SMatthias Ringwald             }
1594a0698cb4SMatthias Ringwald             uint16_t pos = 0;
1595a0698cb4SMatthias Ringwald             event[pos++] = GAP_EVENT_ADVERTISING_REPORT;
1596a0698cb4SMatthias Ringwald             event[pos++] = 10u + data_length;
1597a0698cb4SMatthias Ringwald             event[pos++] = legacy_event_type;
1598a0698cb4SMatthias Ringwald             // copy address type + address
1599a0698cb4SMatthias Ringwald             (void) memcpy(&event[pos], &packet[offset], 1 + 6);
1600a0698cb4SMatthias Ringwald             offset += 7;
1601a0698cb4SMatthias Ringwald             pos += 7;
1602a0698cb4SMatthias Ringwald             // skip primary_phy, secondary_phy, advertising_sid, tx_power
1603a0698cb4SMatthias Ringwald             offset += 4;
1604a0698cb4SMatthias Ringwald             // copy rssi
1605a0698cb4SMatthias Ringwald             event[pos++] = packet[offset++];
1606a0698cb4SMatthias Ringwald             // skip periodic advertising interval and direct address
1607a0698cb4SMatthias Ringwald             offset += 9;
1608a0698cb4SMatthias Ringwald             // copy data len + data;
1609a0698cb4SMatthias Ringwald             (void) memcpy(&event[pos], &packet[offset], 1 + data_length);
1610a0698cb4SMatthias Ringwald             pos    += 1 +data_length;
1611a0698cb4SMatthias Ringwald             offset += 1+ data_length;
1612a0698cb4SMatthias Ringwald             hci_emit_event(event, pos, 1);
1613a0698cb4SMatthias Ringwald         } else {
1614c95a0fc7SMatthias Ringwald             event[0] = GAP_EVENT_EXTENDED_ADVERTISING_REPORT;
1615c95a0fc7SMatthias Ringwald             uint8_t report_len = 24 + data_length;
1616c95a0fc7SMatthias Ringwald             event[1] = report_len;
16170f7610adSMatthias Ringwald             little_endian_store_16(event, 2, event_type);
16180f7610adSMatthias Ringwald             memcpy(&event[4], &packet[offset], report_len);
1619c95a0fc7SMatthias Ringwald             offset += report_len;
1620c95a0fc7SMatthias Ringwald             hci_emit_event(event, 2 + report_len, 1);
1621a0698cb4SMatthias Ringwald         }
1622a0698cb4SMatthias Ringwald     }
1623a0698cb4SMatthias Ringwald }
1624a0698cb4SMatthias Ringwald #endif
1625a0698cb4SMatthias Ringwald 
1626b2f949feS[email protected] #endif
1627e8c8828eSMatthias Ringwald #endif
162857c9da5bS[email protected] 
16292b6ab3e6SMatthias Ringwald #ifdef ENABLE_BLE
16302b6ab3e6SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
1631bbc366e6SMatthias Ringwald static void hci_update_advertisements_enabled_for_current_roles(void){
1632a408e724SMatthias Ringwald     if ((hci_stack->le_advertisements_state & LE_ADVERTISEMENT_STATE_ENABLED) != 0){
16332b6ab3e6SMatthias Ringwald         // get number of active le slave connections
16342b6ab3e6SMatthias Ringwald         int num_slave_connections = 0;
16352b6ab3e6SMatthias Ringwald         btstack_linked_list_iterator_t it;
16362b6ab3e6SMatthias Ringwald         btstack_linked_list_iterator_init(&it, &hci_stack->connections);
16372b6ab3e6SMatthias Ringwald         while (btstack_linked_list_iterator_has_next(&it)){
16382b6ab3e6SMatthias Ringwald             hci_connection_t * con = (hci_connection_t*) btstack_linked_list_iterator_next(&it);
16392b6ab3e6SMatthias Ringwald             log_info("state %u, role %u, le_con %u", con->state, con->role, hci_is_le_connection(con));
16402b6ab3e6SMatthias Ringwald             if (con->state != OPEN) continue;
16412b6ab3e6SMatthias Ringwald             if (con->role  != HCI_ROLE_SLAVE) continue;
16422b6ab3e6SMatthias Ringwald             if (!hci_is_le_connection(con)) continue;
16432b6ab3e6SMatthias Ringwald             num_slave_connections++;
16442b6ab3e6SMatthias Ringwald         }
16452b6ab3e6SMatthias Ringwald         log_info("Num LE Peripheral roles: %u of %u", num_slave_connections, hci_stack->le_max_number_peripheral_connections);
1646bbc366e6SMatthias Ringwald         hci_stack->le_advertisements_enabled_for_current_roles = num_slave_connections < hci_stack->le_max_number_peripheral_connections;
1647bbc366e6SMatthias Ringwald     } else {
1648bbc366e6SMatthias Ringwald         hci_stack->le_advertisements_enabled_for_current_roles = false;
16492b6ab3e6SMatthias Ringwald     }
16502b6ab3e6SMatthias Ringwald }
16512b6ab3e6SMatthias Ringwald #endif
16522b6ab3e6SMatthias Ringwald #endif
16532b6ab3e6SMatthias Ringwald 
165459d59ecfSMatthias Ringwald #ifdef ENABLE_CLASSIC
165559d59ecfSMatthias Ringwald static void gap_run_set_local_name(void){
165659d59ecfSMatthias Ringwald     hci_reserve_packet_buffer();
165759d59ecfSMatthias Ringwald     uint8_t * packet = hci_stack->hci_packet_buffer;
165859d59ecfSMatthias Ringwald     // construct HCI Command and send
165959d59ecfSMatthias Ringwald     uint16_t opcode = hci_write_local_name.opcode;
166059d59ecfSMatthias Ringwald     hci_stack->last_cmd_opcode = opcode;
166159d59ecfSMatthias Ringwald     packet[0] = opcode & 0xff;
166259d59ecfSMatthias Ringwald     packet[1] = opcode >> 8;
166359d59ecfSMatthias Ringwald     packet[2] = DEVICE_NAME_LEN;
166459d59ecfSMatthias Ringwald     memset(&packet[3], 0, DEVICE_NAME_LEN);
166559d59ecfSMatthias Ringwald     uint16_t name_len = (uint16_t) strlen(hci_stack->local_name);
166659d59ecfSMatthias Ringwald     uint16_t bytes_to_copy = btstack_min(name_len, DEVICE_NAME_LEN);
166759d59ecfSMatthias Ringwald     // if shorter than DEVICE_NAME_LEN, it's implicitly NULL-terminated by memset call
166859d59ecfSMatthias Ringwald     (void)memcpy(&packet[3], hci_stack->local_name, bytes_to_copy);
166959d59ecfSMatthias Ringwald     // expand '00:00:00:00:00:00' in name with bd_addr
167059d59ecfSMatthias Ringwald     btstack_replace_bd_addr_placeholder(&packet[3], bytes_to_copy, hci_stack->local_bd_addr);
167159d59ecfSMatthias Ringwald     hci_send_cmd_packet(packet, HCI_CMD_HEADER_SIZE + DEVICE_NAME_LEN);
167259d59ecfSMatthias Ringwald }
167359d59ecfSMatthias Ringwald 
167459d59ecfSMatthias Ringwald static void gap_run_set_eir_data(void){
167559d59ecfSMatthias Ringwald     hci_reserve_packet_buffer();
167659d59ecfSMatthias Ringwald     uint8_t * packet = hci_stack->hci_packet_buffer;
167759d59ecfSMatthias Ringwald     // construct HCI Command in-place and send
167859d59ecfSMatthias Ringwald     uint16_t opcode = hci_write_extended_inquiry_response.opcode;
167959d59ecfSMatthias Ringwald     hci_stack->last_cmd_opcode = opcode;
168059d59ecfSMatthias Ringwald     uint16_t offset = 0;
168159d59ecfSMatthias Ringwald     packet[offset++] = opcode & 0xff;
168259d59ecfSMatthias Ringwald     packet[offset++] = opcode >> 8;
168359d59ecfSMatthias Ringwald     packet[offset++] = 1 + EXTENDED_INQUIRY_RESPONSE_DATA_LEN;
168459d59ecfSMatthias Ringwald     packet[offset++] = 0;  // FEC not required
168559d59ecfSMatthias Ringwald     memset(&packet[offset], 0, EXTENDED_INQUIRY_RESPONSE_DATA_LEN);
168659d59ecfSMatthias Ringwald     if (hci_stack->eir_data){
168759d59ecfSMatthias Ringwald         // copy items and expand '00:00:00:00:00:00' in name with bd_addr
168859d59ecfSMatthias Ringwald         ad_context_t context;
168959d59ecfSMatthias Ringwald         for (ad_iterator_init(&context, EXTENDED_INQUIRY_RESPONSE_DATA_LEN, hci_stack->eir_data) ; ad_iterator_has_more(&context) ; ad_iterator_next(&context)) {
169059d59ecfSMatthias Ringwald             uint8_t data_type   = ad_iterator_get_data_type(&context);
169159d59ecfSMatthias Ringwald             uint8_t size        = ad_iterator_get_data_len(&context);
169259d59ecfSMatthias Ringwald             const uint8_t *data = ad_iterator_get_data(&context);
169359d59ecfSMatthias Ringwald             // copy item
169459d59ecfSMatthias Ringwald             packet[offset++] = size + 1;
169559d59ecfSMatthias Ringwald             packet[offset++] = data_type;
169659d59ecfSMatthias Ringwald             memcpy(&packet[offset], data, size);
169759d59ecfSMatthias Ringwald             // update name item
169859d59ecfSMatthias Ringwald             if ((data_type == BLUETOOTH_DATA_TYPE_SHORTENED_LOCAL_NAME) || (data_type == BLUETOOTH_DATA_TYPE_COMPLETE_LOCAL_NAME)){
169959d59ecfSMatthias Ringwald                 btstack_replace_bd_addr_placeholder(&packet[offset], size, hci_stack->local_bd_addr);
170059d59ecfSMatthias Ringwald             }
170159d59ecfSMatthias Ringwald             offset += size;
170259d59ecfSMatthias Ringwald         }
170359d59ecfSMatthias Ringwald     } else {
170459d59ecfSMatthias Ringwald         uint16_t name_len = (uint16_t) strlen(hci_stack->local_name);
170559d59ecfSMatthias Ringwald         uint16_t bytes_to_copy = btstack_min(name_len, EXTENDED_INQUIRY_RESPONSE_DATA_LEN - 2);
170659d59ecfSMatthias Ringwald         packet[offset++] = bytes_to_copy + 1;
170759d59ecfSMatthias Ringwald         packet[offset++] = BLUETOOTH_DATA_TYPE_COMPLETE_LOCAL_NAME;
170859d59ecfSMatthias Ringwald         (void)memcpy(&packet[6], hci_stack->local_name, bytes_to_copy);
170959d59ecfSMatthias Ringwald         // expand '00:00:00:00:00:00' in name with bd_addr
171059d59ecfSMatthias Ringwald         btstack_replace_bd_addr_placeholder(&packet[offset], bytes_to_copy, hci_stack->local_bd_addr);
171159d59ecfSMatthias Ringwald     }
171259d59ecfSMatthias Ringwald     hci_send_cmd_packet(packet, HCI_CMD_HEADER_SIZE + 1 + EXTENDED_INQUIRY_RESPONSE_DATA_LEN);
171359d59ecfSMatthias Ringwald }
1714ab4831a3SMatthias Ringwald 
1715ab4831a3SMatthias Ringwald static void hci_run_gap_tasks_classic(void){
1716baa4881eSMatthias Ringwald     if ((hci_stack->gap_tasks_classic & GAP_TASK_SET_CLASS_OF_DEVICE) != 0) {
1717baa4881eSMatthias Ringwald         hci_stack->gap_tasks_classic &= ~GAP_TASK_SET_CLASS_OF_DEVICE;
1718ab4831a3SMatthias Ringwald         hci_send_cmd(&hci_write_class_of_device, hci_stack->class_of_device);
1719ab4831a3SMatthias Ringwald         return;
1720ab4831a3SMatthias Ringwald     }
1721baa4881eSMatthias Ringwald     if ((hci_stack->gap_tasks_classic & GAP_TASK_SET_LOCAL_NAME) != 0) {
1722baa4881eSMatthias Ringwald         hci_stack->gap_tasks_classic &= ~GAP_TASK_SET_LOCAL_NAME;
1723ab4831a3SMatthias Ringwald         gap_run_set_local_name();
1724ab4831a3SMatthias Ringwald         return;
1725ab4831a3SMatthias Ringwald     }
1726baa4881eSMatthias Ringwald     if ((hci_stack->gap_tasks_classic & GAP_TASK_SET_EIR_DATA) != 0) {
1727baa4881eSMatthias Ringwald         hci_stack->gap_tasks_classic &= ~GAP_TASK_SET_EIR_DATA;
1728ab4831a3SMatthias Ringwald         gap_run_set_eir_data();
1729ab4831a3SMatthias Ringwald         return;
1730ab4831a3SMatthias Ringwald     }
1731baa4881eSMatthias Ringwald     if ((hci_stack->gap_tasks_classic & GAP_TASK_SET_DEFAULT_LINK_POLICY) != 0) {
1732baa4881eSMatthias Ringwald         hci_stack->gap_tasks_classic &= ~GAP_TASK_SET_DEFAULT_LINK_POLICY;
1733ab4831a3SMatthias Ringwald         hci_send_cmd(&hci_write_default_link_policy_setting, hci_stack->default_link_policy_settings);
1734ab4831a3SMatthias Ringwald         return;
1735ab4831a3SMatthias Ringwald     }
1736ab4831a3SMatthias Ringwald     // write page scan activity
1737baa4881eSMatthias Ringwald     if ((hci_stack->gap_tasks_classic & GAP_TASK_WRITE_PAGE_SCAN_ACTIVITY) != 0) {
1738baa4881eSMatthias Ringwald         hci_stack->gap_tasks_classic &= ~GAP_TASK_WRITE_PAGE_SCAN_ACTIVITY;
1739ab4831a3SMatthias Ringwald         hci_send_cmd(&hci_write_page_scan_activity, hci_stack->new_page_scan_interval, hci_stack->new_page_scan_window);
1740ab4831a3SMatthias Ringwald         return;
1741ab4831a3SMatthias Ringwald     }
1742ab4831a3SMatthias Ringwald     // write page scan type
1743baa4881eSMatthias Ringwald     if ((hci_stack->gap_tasks_classic & GAP_TASK_WRITE_PAGE_SCAN_TYPE) != 0) {
1744baa4881eSMatthias Ringwald         hci_stack->gap_tasks_classic &= ~GAP_TASK_WRITE_PAGE_SCAN_TYPE;
1745ab4831a3SMatthias Ringwald         hci_send_cmd(&hci_write_page_scan_type, hci_stack->new_page_scan_type);
1746ab4831a3SMatthias Ringwald         return;
1747ab4831a3SMatthias Ringwald     }
174832a12730SMatthias Ringwald     // write page timeout
1749baa4881eSMatthias Ringwald     if ((hci_stack->gap_tasks_classic & GAP_TASK_WRITE_PAGE_TIMEOUT) != 0) {
1750baa4881eSMatthias Ringwald         hci_stack->gap_tasks_classic &= ~GAP_TASK_WRITE_PAGE_TIMEOUT;
175132a12730SMatthias Ringwald         hci_send_cmd(&hci_write_page_timeout, hci_stack->page_timeout);
175232a12730SMatthias Ringwald         return;
175332a12730SMatthias Ringwald     }
1754ab4831a3SMatthias Ringwald     // send scan enable
1755baa4881eSMatthias Ringwald     if ((hci_stack->gap_tasks_classic & GAP_TASK_WRITE_SCAN_ENABLE) != 0) {
1756baa4881eSMatthias Ringwald         hci_stack->gap_tasks_classic &= ~GAP_TASK_WRITE_SCAN_ENABLE;
1757ab4831a3SMatthias Ringwald         hci_send_cmd(&hci_write_scan_enable, hci_stack->new_scan_enable_value);
1758ab4831a3SMatthias Ringwald         return;
1759ab4831a3SMatthias Ringwald     }
1760c0c8a829SMatthias Ringwald     // send write scan activity
1761baa4881eSMatthias Ringwald     if ((hci_stack->gap_tasks_classic & GAP_TASK_WRITE_INQUIRY_SCAN_ACTIVITY) != 0) {
1762baa4881eSMatthias Ringwald         hci_stack->gap_tasks_classic &= ~GAP_TASK_WRITE_INQUIRY_SCAN_ACTIVITY;
1763c0c8a829SMatthias Ringwald         hci_send_cmd(&hci_write_inquiry_scan_activity, hci_stack->inquiry_scan_interval, hci_stack->inquiry_scan_window);
1764c0c8a829SMatthias Ringwald         return;
1765c0c8a829SMatthias Ringwald     }
1766f50ed5acSAndrey Fominykh     // send write inquiry transmit power level
1767f50ed5acSAndrey Fominykh     if ((hci_stack->gap_tasks_classic & GAP_TASK_WRITE_INQUIRY_TX_POWER_LEVEL) != 0) {
1768f50ed5acSAndrey Fominykh         hci_stack->gap_tasks_classic &= ~GAP_TASK_WRITE_INQUIRY_TX_POWER_LEVEL;
1769f50ed5acSAndrey Fominykh         hci_send_cmd(&hci_write_inquiry_transmit_power_level, hci_stack->inquiry_tx_power_level);
1770f50ed5acSAndrey Fominykh         return;
1771f50ed5acSAndrey Fominykh     }
1772ab4831a3SMatthias Ringwald }
177359d59ecfSMatthias Ringwald #endif
177459d59ecfSMatthias Ringwald 
17756fad2c37SMatthias Ringwald #ifndef HAVE_HOST_CONTROLLER_API
177606b9e820SMatthias Ringwald 
177796b53536SMatthias Ringwald static uint32_t hci_transport_uart_get_main_baud_rate(void){
177896b53536SMatthias Ringwald     if (!hci_stack->config) return 0;
17799796ebeaSMatthias Ringwald     uint32_t baud_rate = ((hci_transport_config_uart_t *)hci_stack->config)->baudrate_main;
178096b53536SMatthias Ringwald     // Limit baud rate for Broadcom chipsets to 3 mbps
1781a1df452eSMatthias Ringwald     if ((hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_BROADCOM_CORPORATION) && (baud_rate > 3000000)){
178296b53536SMatthias Ringwald         baud_rate = 3000000;
178396b53536SMatthias Ringwald     }
178496b53536SMatthias Ringwald     return baud_rate;
178596b53536SMatthias Ringwald }
178696b53536SMatthias Ringwald 
1787ec820d77SMatthias Ringwald static void hci_initialization_timeout_handler(btstack_timer_source_t * ds){
17889ec2630cSMatthias Ringwald     UNUSED(ds);
17899ec2630cSMatthias Ringwald 
17900305bdeaSMatthias Ringwald     switch (hci_stack->substate){
17910305bdeaSMatthias Ringwald         case HCI_INIT_W4_SEND_RESET:
17927b0d7667SMatthias Ringwald             log_info("Resend HCI Reset");
17930305bdeaSMatthias Ringwald             hci_stack->substate = HCI_INIT_SEND_RESET;
17947b0d7667SMatthias Ringwald             hci_stack->num_cmd_packets = 1;
17950305bdeaSMatthias Ringwald             hci_run();
17960305bdeaSMatthias Ringwald             break;
17979f007422SMatthias Ringwald         case HCI_INIT_W4_CUSTOM_INIT_CSR_WARM_BOOT_LINK_RESET:
17989f007422SMatthias Ringwald             log_info("Resend HCI Reset - CSR Warm Boot with Link Reset");
17999f007422SMatthias Ringwald             if (hci_stack->hci_transport->reset_link){
18009f007422SMatthias Ringwald                 hci_stack->hci_transport->reset_link();
18019f007422SMatthias Ringwald             }
1802cf373d3aSMatthias Ringwald 
1803cf373d3aSMatthias Ringwald             /* fall through */
1804cf373d3aSMatthias Ringwald 
1805e47e68c7SMatthias Ringwald         case HCI_INIT_W4_CUSTOM_INIT_CSR_WARM_BOOT:
1806e47e68c7SMatthias Ringwald             log_info("Resend HCI Reset - CSR Warm Boot");
1807e47e68c7SMatthias Ringwald             hci_stack->substate = HCI_INIT_SEND_RESET_CSR_WARM_BOOT;
1808e47e68c7SMatthias Ringwald             hci_stack->num_cmd_packets = 1;
1809e47e68c7SMatthias Ringwald             hci_run();
1810688c2635SMatthias Ringwald             break;
18117224be7eSMatthias Ringwald         case HCI_INIT_W4_SEND_BAUD_CHANGE:
18127224be7eSMatthias Ringwald             if (hci_stack->hci_transport->set_baudrate){
181396b53536SMatthias Ringwald                 uint32_t baud_rate = hci_transport_uart_get_main_baud_rate();
1814cd724cb7SMatthias Ringwald                 log_info("Local baud rate change to %" PRIu32 "(timeout handler)", baud_rate);
18157dd9d0ecSMatthias Ringwald                 hci_stack->hci_transport->set_baudrate(baud_rate);
18167224be7eSMatthias Ringwald             }
1817834bce8cSMatthias Ringwald             // For CSR, HCI Reset is sent on new baud rate. Don't forget to reset link for H5/BCSP
181861f37892SMatthias Ringwald             if (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_CAMBRIDGE_SILICON_RADIO){
1819834bce8cSMatthias Ringwald                 if (hci_stack->hci_transport->reset_link){
1820834bce8cSMatthias Ringwald                     log_info("Link Reset");
1821834bce8cSMatthias Ringwald                     hci_stack->hci_transport->reset_link();
1822834bce8cSMatthias Ringwald                 }
1823772a36d3SMatthias Ringwald                 hci_stack->substate = HCI_INIT_SEND_RESET_CSR_WARM_BOOT;
1824772a36d3SMatthias Ringwald                 hci_run();
1825772a36d3SMatthias Ringwald             }
18264696bddbSMatthias Ringwald             break;
1827559961d0SMatthias Ringwald         case HCI_INIT_W4_CUSTOM_INIT_BCM_DELAY:
1828559961d0SMatthias Ringwald             // otherwise continue
1829559961d0SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_READ_LOCAL_SUPPORTED_COMMANDS;
1830559961d0SMatthias Ringwald             hci_send_cmd(&hci_read_local_supported_commands);
1831559961d0SMatthias Ringwald             break;
18320305bdeaSMatthias Ringwald         default:
18330305bdeaSMatthias Ringwald             break;
18340305bdeaSMatthias Ringwald     }
18350305bdeaSMatthias Ringwald }
183606b9e820SMatthias Ringwald #endif
18370305bdeaSMatthias Ringwald 
183871de195eSMatthias Ringwald static void hci_initializing_next_state(void){
183974b323a9SMatthias Ringwald     hci_stack->substate = (hci_substate_t )( ((int) hci_stack->substate) + 1);
184074b323a9SMatthias Ringwald }
184174b323a9SMatthias Ringwald 
1842f795c86eSMatthias Ringwald static void hci_init_done(void){
1843f795c86eSMatthias Ringwald     // done. tell the app
1844f795c86eSMatthias Ringwald     log_info("hci_init_done -> HCI_STATE_WORKING");
1845f795c86eSMatthias Ringwald     hci_stack->state = HCI_STATE_WORKING;
1846f795c86eSMatthias Ringwald     hci_emit_state();
1847f795c86eSMatthias Ringwald }
1848f795c86eSMatthias Ringwald 
184974b323a9SMatthias Ringwald // assumption: hci_can_send_command_packet_now() == true
185071de195eSMatthias Ringwald static void hci_initializing_run(void){
1851148ca237SMatthias Ringwald     log_debug("hci_initializing_run: substate %u, can send %u", hci_stack->substate, hci_can_send_command_packet_now());
1852f4c579d4SMatthias Ringwald 
18530d37aff3SMatthias Ringwald     if (!hci_can_send_command_packet_now()) return;
18540d37aff3SMatthias Ringwald 
1855f4c579d4SMatthias Ringwald #ifndef HAVE_HOST_CONTROLLER_API
1856f9fd20c2SMatthias Ringwald     bool need_baud_change = hci_stack->config
1857f4c579d4SMatthias Ringwald             && hci_stack->chipset
1858f4c579d4SMatthias Ringwald             && hci_stack->chipset->set_baudrate_command
1859f4c579d4SMatthias Ringwald             && hci_stack->hci_transport->set_baudrate
1860f4c579d4SMatthias Ringwald             && ((hci_transport_config_uart_t *)hci_stack->config)->baudrate_main;
1861f4c579d4SMatthias Ringwald #endif
1862f4c579d4SMatthias Ringwald 
186374b323a9SMatthias Ringwald     switch (hci_stack->substate){
186474b323a9SMatthias Ringwald         case HCI_INIT_SEND_RESET:
186574b323a9SMatthias Ringwald             hci_state_reset();
1866a0cf2f3fSMatthias Ringwald 
18676fad2c37SMatthias Ringwald #ifndef HAVE_HOST_CONTROLLER_API
18680305bdeaSMatthias Ringwald             // prepare reset if command complete not received in 100ms
1869659d758cSMatthias Ringwald             btstack_run_loop_set_timer(&hci_stack->timeout, HCI_RESET_RESEND_TIMEOUT_MS);
1870528a4a3bSMatthias Ringwald             btstack_run_loop_set_timer_handler(&hci_stack->timeout, hci_initialization_timeout_handler);
1871528a4a3bSMatthias Ringwald             btstack_run_loop_add_timer(&hci_stack->timeout);
1872a0cf2f3fSMatthias Ringwald #endif
18730305bdeaSMatthias Ringwald             // send command
187474b323a9SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_SEND_RESET;
18750305bdeaSMatthias Ringwald             hci_send_cmd(&hci_reset);
187674b323a9SMatthias Ringwald             break;
187776fcb19bSMatthias Ringwald         case HCI_INIT_SEND_READ_LOCAL_VERSION_INFORMATION:
187876fcb19bSMatthias Ringwald             hci_send_cmd(&hci_read_local_version_information);
187976fcb19bSMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_SEND_READ_LOCAL_VERSION_INFORMATION;
188076fcb19bSMatthias Ringwald             break;
1881e28e41c0SMatthias Ringwald 
1882e28e41c0SMatthias Ringwald #ifndef HAVE_HOST_CONTROLLER_API
1883e47e68c7SMatthias Ringwald         case HCI_INIT_SEND_RESET_CSR_WARM_BOOT:
1884e47e68c7SMatthias Ringwald             hci_state_reset();
1885e47e68c7SMatthias Ringwald             // prepare reset if command complete not received in 100ms
1886659d758cSMatthias Ringwald             btstack_run_loop_set_timer(&hci_stack->timeout, HCI_RESET_RESEND_TIMEOUT_MS);
1887528a4a3bSMatthias Ringwald             btstack_run_loop_set_timer_handler(&hci_stack->timeout, hci_initialization_timeout_handler);
1888528a4a3bSMatthias Ringwald             btstack_run_loop_add_timer(&hci_stack->timeout);
1889e47e68c7SMatthias Ringwald             // send command
1890e47e68c7SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_CUSTOM_INIT_CSR_WARM_BOOT;
1891e47e68c7SMatthias Ringwald             hci_send_cmd(&hci_reset);
1892e47e68c7SMatthias Ringwald             break;
18938d29070eSMatthias Ringwald         case HCI_INIT_SEND_RESET_ST_WARM_BOOT:
18948d29070eSMatthias Ringwald             hci_state_reset();
18958d29070eSMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_SEND_RESET_ST_WARM_BOOT;
18968d29070eSMatthias Ringwald             hci_send_cmd(&hci_reset);
18978d29070eSMatthias Ringwald             break;
1898f4c579d4SMatthias Ringwald         case HCI_INIT_SEND_BAUD_CHANGE_BCM: {
1899f4c579d4SMatthias Ringwald             uint32_t baud_rate = hci_transport_uart_get_main_baud_rate();
1900f4c579d4SMatthias Ringwald             hci_stack->chipset->set_baudrate_command(baud_rate, hci_stack->hci_packet_buffer);
1901f4c579d4SMatthias Ringwald             hci_stack->last_cmd_opcode = little_endian_read_16(hci_stack->hci_packet_buffer, 0);
1902f4c579d4SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_SEND_BAUD_CHANGE_BCM;
1903f4c579d4SMatthias Ringwald             hci_send_cmd_packet(hci_stack->hci_packet_buffer, 3u + hci_stack->hci_packet_buffer[2u]);
1904f4c579d4SMatthias Ringwald             break;
1905f4c579d4SMatthias Ringwald         }
1906c97af506SMatthias Ringwald         case HCI_INIT_SET_BD_ADDR:
1907c97af506SMatthias Ringwald             log_info("Set Public BD ADDR to %s", bd_addr_to_str(hci_stack->custom_bd_addr));
1908c97af506SMatthias Ringwald             hci_stack->chipset->set_bd_addr_command(hci_stack->custom_bd_addr, hci_stack->hci_packet_buffer);
1909c97af506SMatthias Ringwald             hci_stack->last_cmd_opcode = little_endian_read_16(hci_stack->hci_packet_buffer, 0);
1910c97af506SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_SET_BD_ADDR;
1911c97af506SMatthias Ringwald             hci_send_cmd_packet(hci_stack->hci_packet_buffer, 3u + hci_stack->hci_packet_buffer[2u]);
1912c97af506SMatthias Ringwald             break;
19138250c242SMatthias Ringwald         case HCI_INIT_SEND_READ_LOCAL_NAME:
19148250c242SMatthias Ringwald #ifdef ENABLE_CLASSIC
19158250c242SMatthias Ringwald             hci_send_cmd(&hci_read_local_name);
19168250c242SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_SEND_READ_LOCAL_NAME;
19178250c242SMatthias Ringwald             break;
19188250c242SMatthias Ringwald #endif
19198250c242SMatthias Ringwald             /* fall through */
19208250c242SMatthias Ringwald 
1921f4c579d4SMatthias Ringwald         case HCI_INIT_SEND_BAUD_CHANGE:
1922f4c579d4SMatthias Ringwald             if (need_baud_change) {
192396b53536SMatthias Ringwald                 uint32_t baud_rate = hci_transport_uart_get_main_baud_rate();
19243fb36a29SMatthias Ringwald                 hci_stack->chipset->set_baudrate_command(baud_rate, hci_stack->hci_packet_buffer);
1925f8fbdce0SMatthias Ringwald                 hci_stack->last_cmd_opcode = little_endian_read_16(hci_stack->hci_packet_buffer, 0);
192674b323a9SMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_SEND_BAUD_CHANGE;
19274ea43905SMatthias Ringwald                 hci_send_cmd_packet(hci_stack->hci_packet_buffer, 3u + hci_stack->hci_packet_buffer[2u]);
19284696bddbSMatthias Ringwald                 // STLC25000D: baudrate change happens within 0.5 s after command was send,
19294696bddbSMatthias Ringwald                 // use timer to update baud rate after 100 ms (knowing exactly, when command was sent is non-trivial)
193061f37892SMatthias Ringwald                 if (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_ST_MICROELECTRONICS){
1931659d758cSMatthias Ringwald                     btstack_run_loop_set_timer(&hci_stack->timeout, HCI_RESET_RESEND_TIMEOUT_MS);
1932528a4a3bSMatthias Ringwald                     btstack_run_loop_add_timer(&hci_stack->timeout);
19334696bddbSMatthias Ringwald                }
193474b323a9SMatthias Ringwald                break;
1935fab26ab3SMatthias Ringwald             }
19366fe16221SMatthias Ringwald             hci_stack->substate = HCI_INIT_CUSTOM_INIT;
1937f4c579d4SMatthias Ringwald 
1938f4c579d4SMatthias Ringwald             /* fall through */
1939f4c579d4SMatthias Ringwald 
194074b323a9SMatthias Ringwald         case HCI_INIT_CUSTOM_INIT:
19416fe16221SMatthias Ringwald         case HCI_INIT_CUSTOM_PRE_INIT:
194274b323a9SMatthias Ringwald             // Custom initialization
19433fb36a29SMatthias Ringwald             if (hci_stack->chipset && hci_stack->chipset->next_command){
1944ae334e9eSMatthias Ringwald                 hci_stack->chipset_result = (*hci_stack->chipset->next_command)(hci_stack->hci_packet_buffer);
19451979f09cSMatthias Ringwald                 bool send_cmd = false;
1946ae334e9eSMatthias Ringwald                 switch (hci_stack->chipset_result){
1947f41911edSMatthias Ringwald                     case BTSTACK_CHIPSET_VALID_COMMAND:
19481979f09cSMatthias Ringwald                         send_cmd = true;
19496fe16221SMatthias Ringwald                         switch (hci_stack->substate){
19506fe16221SMatthias Ringwald                             case HCI_INIT_CUSTOM_INIT:
1951e47e68c7SMatthias Ringwald                                 hci_stack->substate = HCI_INIT_W4_CUSTOM_INIT;
1952e47e68c7SMatthias Ringwald                                 break;
19536fe16221SMatthias Ringwald                             case HCI_INIT_CUSTOM_PRE_INIT:
19546fe16221SMatthias Ringwald                                 hci_stack->substate = HCI_INIT_W4_CUSTOM_PRE_INIT;
19556fe16221SMatthias Ringwald                                 break;
19566fe16221SMatthias Ringwald                             default:
19576fe16221SMatthias Ringwald                                 btstack_assert(false);
19586fe16221SMatthias Ringwald                                 break;
19596fe16221SMatthias Ringwald                         }
19606fe16221SMatthias Ringwald                         break;
1961f41911edSMatthias Ringwald                     case BTSTACK_CHIPSET_WARMSTART_REQUIRED:
19621979f09cSMatthias Ringwald                         send_cmd = true;
1963f41911edSMatthias Ringwald                         // CSR Warm Boot: Wait a bit, then send HCI Reset until HCI Command Complete
1964e47e68c7SMatthias Ringwald                         log_info("CSR Warm Boot");
1965659d758cSMatthias Ringwald                         btstack_run_loop_set_timer(&hci_stack->timeout, HCI_RESET_RESEND_TIMEOUT_MS);
1966528a4a3bSMatthias Ringwald                         btstack_run_loop_set_timer_handler(&hci_stack->timeout, hci_initialization_timeout_handler);
1967528a4a3bSMatthias Ringwald                         btstack_run_loop_add_timer(&hci_stack->timeout);
1968a1df452eSMatthias Ringwald                         if ((hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_CAMBRIDGE_SILICON_RADIO)
1969772a36d3SMatthias Ringwald                             && hci_stack->config
19703fb36a29SMatthias Ringwald                             && hci_stack->chipset
19713fb36a29SMatthias Ringwald                             // && hci_stack->chipset->set_baudrate_command -- there's no such command
1972772a36d3SMatthias Ringwald                             && hci_stack->hci_transport->set_baudrate
19732caefae9SMatthias Ringwald                             && hci_transport_uart_get_main_baud_rate()){
1974772a36d3SMatthias Ringwald                             hci_stack->substate = HCI_INIT_W4_SEND_BAUD_CHANGE;
1975772a36d3SMatthias Ringwald                         } else {
19769f007422SMatthias Ringwald                            hci_stack->substate = HCI_INIT_W4_CUSTOM_INIT_CSR_WARM_BOOT_LINK_RESET;
1977772a36d3SMatthias Ringwald                         }
1978e47e68c7SMatthias Ringwald                         break;
1979f41911edSMatthias Ringwald                     default:
1980f41911edSMatthias Ringwald                         break;
1981e47e68c7SMatthias Ringwald                 }
1982ee720f3aSMatthias Ringwald 
1983ee720f3aSMatthias Ringwald                 if (send_cmd){
19844ea43905SMatthias Ringwald                     int size = 3u + hci_stack->hci_packet_buffer[2u];
1985ee720f3aSMatthias Ringwald                     hci_stack->last_cmd_opcode = little_endian_read_16(hci_stack->hci_packet_buffer, 0);
1986ee720f3aSMatthias Ringwald                     hci_dump_packet(HCI_COMMAND_DATA_PACKET, 0, hci_stack->hci_packet_buffer, size);
19870305bdeaSMatthias Ringwald                     hci_stack->hci_transport->send_packet(HCI_COMMAND_DATA_PACKET, hci_stack->hci_packet_buffer, size);
198874b323a9SMatthias Ringwald                     break;
198974b323a9SMatthias Ringwald                 }
1990148ca237SMatthias Ringwald                 log_info("Init script done");
199192a0d36dSMatthias Ringwald 
19926fe16221SMatthias Ringwald                 // Custom Pre-Init complete, start regular init with HCI Reset
19936fe16221SMatthias Ringwald                 if (hci_stack->substate == HCI_INIT_CUSTOM_PRE_INIT){
19946fe16221SMatthias Ringwald                     hci_stack->substate = HCI_INIT_W4_SEND_RESET;
19956fe16221SMatthias Ringwald                     hci_send_cmd(&hci_reset);
19966fe16221SMatthias Ringwald                     break;
19976fe16221SMatthias Ringwald                 }
19986fe16221SMatthias Ringwald 
1999559961d0SMatthias Ringwald                 // Init script download on Broadcom chipsets causes:
2000ae334e9eSMatthias Ringwald                 if ( (hci_stack->chipset_result != BTSTACK_CHIPSET_NO_INIT_SCRIPT) &&
2001a1df452eSMatthias Ringwald                    (  (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_BROADCOM_CORPORATION)
2002a1df452eSMatthias Ringwald                 ||    (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_EM_MICROELECTRONIC_MARIN_SA)) ){
2003e021ff1eSMatthias Ringwald 
2004559961d0SMatthias Ringwald                     // - baud rate to reset, restore UART baud rate if needed
200592a0d36dSMatthias Ringwald                     if (need_baud_change) {
20069796ebeaSMatthias Ringwald                         uint32_t baud_rate = ((hci_transport_config_uart_t *)hci_stack->config)->baudrate_init;
2007cd724cb7SMatthias Ringwald                         log_info("Local baud rate change to %" PRIu32 " after init script (bcm)", baud_rate);
200892a0d36dSMatthias Ringwald                         hci_stack->hci_transport->set_baudrate(baud_rate);
200992a0d36dSMatthias Ringwald                     }
2010559961d0SMatthias Ringwald 
2011f19b3c9eSMatthias Ringwald                     uint16_t bcm_delay_ms = 300;
2012f19b3c9eSMatthias Ringwald                     // - UART may or may not be disabled during update and Controller RTS may or may not be high during this time
2013f19b3c9eSMatthias Ringwald                     //   -> Work around: wait here.
2014f19b3c9eSMatthias Ringwald                     log_info("BCM delay (%u ms) after init script", bcm_delay_ms);
2015559961d0SMatthias Ringwald                     hci_stack->substate = HCI_INIT_W4_CUSTOM_INIT_BCM_DELAY;
2016f19b3c9eSMatthias Ringwald                     btstack_run_loop_set_timer(&hci_stack->timeout, bcm_delay_ms);
2017559961d0SMatthias Ringwald                     btstack_run_loop_set_timer_handler(&hci_stack->timeout, hci_initialization_timeout_handler);
2018559961d0SMatthias Ringwald                     btstack_run_loop_add_timer(&hci_stack->timeout);
2019559961d0SMatthias Ringwald                     break;
202092a0d36dSMatthias Ringwald                 }
202174b323a9SMatthias Ringwald             }
202206b9e820SMatthias Ringwald #endif
2023521bd5ffSMatthias Ringwald             /* fall through */
202406b9e820SMatthias Ringwald 
202506b9e820SMatthias Ringwald         case HCI_INIT_READ_LOCAL_SUPPORTED_COMMANDS:
202606b9e820SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_READ_LOCAL_SUPPORTED_COMMANDS;
202706b9e820SMatthias Ringwald             hci_send_cmd(&hci_read_local_supported_commands);
202806b9e820SMatthias Ringwald             break;
202953860077SMatthias Ringwald         case HCI_INIT_READ_BD_ADDR:
203053860077SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_READ_BD_ADDR;
203153860077SMatthias Ringwald             hci_send_cmd(&hci_read_bd_addr);
203253860077SMatthias Ringwald             break;
203374b323a9SMatthias Ringwald         case HCI_INIT_READ_BUFFER_SIZE:
20345ffe9d0bSMatthias Ringwald             // only read buffer size if supported
20351ffa425cSMatthias Ringwald             if (hci_command_supported(SUPPORTED_HCI_COMMAND_READ_BUFFER_SIZE)){
203674b323a9SMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_READ_BUFFER_SIZE;
20370305bdeaSMatthias Ringwald                 hci_send_cmd(&hci_read_buffer_size);
203874b323a9SMatthias Ringwald                 break;
20395ffe9d0bSMatthias Ringwald             }
2040521bd5ffSMatthias Ringwald 
20415ffe9d0bSMatthias Ringwald             /* fall through */
20425ffe9d0bSMatthias Ringwald 
204353860077SMatthias Ringwald         case HCI_INIT_READ_LOCAL_SUPPORTED_FEATURES:
204453860077SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_READ_LOCAL_SUPPORTED_FEATURES;
20450305bdeaSMatthias Ringwald             hci_send_cmd(&hci_read_local_supported_features);
204674b323a9SMatthias Ringwald             break;
20472b838201SMatthias Ringwald 
20482b838201SMatthias Ringwald #ifdef ENABLE_HCI_CONTROLLER_TO_HOST_FLOW_CONTROL
20492b838201SMatthias Ringwald         case HCI_INIT_SET_CONTROLLER_TO_HOST_FLOW_CONTROL:
20502b838201SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_SET_CONTROLLER_TO_HOST_FLOW_CONTROL;
20512b838201SMatthias Ringwald             hci_send_cmd(&hci_set_controller_to_host_flow_control, 3);  // ACL + SCO Flow Control
20522b838201SMatthias Ringwald             break;
20532b838201SMatthias Ringwald         case HCI_INIT_HOST_BUFFER_SIZE:
20542b838201SMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_HOST_BUFFER_SIZE;
20552b838201SMatthias Ringwald             hci_send_cmd(&hci_host_buffer_size, HCI_HOST_ACL_PACKET_LEN, HCI_HOST_SCO_PACKET_LEN,
20562b838201SMatthias Ringwald                                                 HCI_HOST_ACL_PACKET_NUM, HCI_HOST_SCO_PACKET_NUM);
20572b838201SMatthias Ringwald             break;
20582b838201SMatthias Ringwald #endif
20592b838201SMatthias Ringwald 
206074b323a9SMatthias Ringwald         case HCI_INIT_SET_EVENT_MASK:
20610305bdeaSMatthias Ringwald             hci_stack->substate = HCI_INIT_W4_SET_EVENT_MASK;
206274b323a9SMatthias Ringwald             if (hci_le_supported()){
20635ce1359eSMatthias Ringwald                 hci_send_cmd(&hci_set_event_mask,0xFFFFFFFFU, 0x3FFFFFFFU);
206474b323a9SMatthias Ringwald             } else {
206574b323a9SMatthias Ringwald                 // Kensington Bluetooth 2.1 USB Dongle (CSR Chipset) returns an error for 0xffff...
20665ce1359eSMatthias Ringwald                 hci_send_cmd(&hci_set_event_mask,0xFFFFFFFFU, 0x1FFFFFFFU);
206774b323a9SMatthias Ringwald             }
206874b323a9SMatthias Ringwald             break;
20692b838201SMatthias Ringwald 
2070ff7d1758SMatthias Ringwald         case HCI_INIT_SET_EVENT_MASK_2:
20718254e329SMatthias Ringwald             // On Bluettooth PTS dongle (BL 654) with PacketCraft HCI Firmware (LMP subversion) 0x5244,
20728254e329SMatthias Ringwald             // setting Event Mask 2 causes Controller to drop Encryption Change events.
20738254e329SMatthias Ringwald             if (hci_command_supported(SUPPORTED_HCI_COMMAND_SET_EVENT_MASK_PAGE_2)
20748254e329SMatthias Ringwald             && (hci_stack->manufacturer != BLUETOOTH_COMPANY_ID_PACKETCRAFT_INC)){
2075ff7d1758SMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_SET_EVENT_MASK_2;
2076ff7d1758SMatthias Ringwald                 // Encryption Change Event v2 - bit 25
2077ff7d1758SMatthias Ringwald                 hci_send_cmd(&hci_set_event_mask_2,0x02000000U, 0x0);
2078ff7d1758SMatthias Ringwald                 break;
2079ff7d1758SMatthias Ringwald             }
2080ff7d1758SMatthias Ringwald 
208135454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
2082ff7d1758SMatthias Ringwald             /* fall through */
2083ff7d1758SMatthias Ringwald 
208474b323a9SMatthias Ringwald         case HCI_INIT_WRITE_SIMPLE_PAIRING_MODE:
2085f795c86eSMatthias Ringwald             if (hci_classic_supported() && gap_ssp_supported()){
208674b323a9SMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_WRITE_SIMPLE_PAIRING_MODE;
20870305bdeaSMatthias Ringwald                 hci_send_cmd(&hci_write_simple_pairing_mode, hci_stack->ssp_enable);
208874b323a9SMatthias Ringwald                 break;
2089e7c662faSMatthias Ringwald             }
2090521bd5ffSMatthias Ringwald 
2091e7c662faSMatthias Ringwald             /* fall through */
2092e7c662faSMatthias Ringwald 
2093f6858d14SMatthias Ringwald         case HCI_INIT_WRITE_INQUIRY_MODE:
2094f795c86eSMatthias Ringwald             if (hci_classic_supported()){
2095f6858d14SMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_WRITE_INQUIRY_MODE;
20968a114470SMatthias Ringwald                 hci_send_cmd(&hci_write_inquiry_mode, (int) hci_stack->inquiry_mode);
2097f6858d14SMatthias Ringwald                 break;
2098f795c86eSMatthias Ringwald             }
2099521bd5ffSMatthias Ringwald 
2100f795c86eSMatthias Ringwald             /* fall through */
2101f795c86eSMatthias Ringwald 
21025d23aae8SMatthias Ringwald         case HCI_INIT_WRITE_SECURE_CONNECTIONS_HOST_ENABLE:
2103f3052906SMatthias Ringwald             // skip write secure connections host support if not supported or disabled
21041ffa425cSMatthias Ringwald             if (hci_classic_supported() && hci_stack->secure_connections_enable
21051ffa425cSMatthias Ringwald             && hci_command_supported(SUPPORTED_HCI_COMMAND_WRITE_SECURE_CONNECTIONS_HOST)) {
2106c214d65bSMatthias Ringwald                 hci_stack->secure_connections_active = true;
21075d23aae8SMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_WRITE_SECURE_CONNECTIONS_HOST_ENABLE;
21081ffa425cSMatthias Ringwald                 hci_send_cmd(&hci_write_secure_connections_host_support, 1);
21095d23aae8SMatthias Ringwald                 break;
2110f3052906SMatthias Ringwald             }
2111521bd5ffSMatthias Ringwald 
2112a391128dSMatthias Ringwald             /* fall through */
2113a391128dSMatthias Ringwald 
2114a391128dSMatthias Ringwald         case HCI_INIT_SET_MIN_ENCRYPTION_KEY_SIZE:
2115a391128dSMatthias Ringwald             // skip set min encryption key size
2116a391128dSMatthias Ringwald             if (hci_classic_supported() && hci_command_supported(SUPPORTED_HCI_COMMAND_SET_MIN_ENCRYPTION_KEY_SIZE)) {
2117a391128dSMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_SET_MIN_ENCRYPTION_KEY_SIZE;
2118a391128dSMatthias Ringwald                 hci_send_cmd(&hci_set_min_encryption_key_size, hci_stack->gap_required_encyrption_key_size);
2119a391128dSMatthias Ringwald                 break;
2120a391128dSMatthias Ringwald             }
2121a391128dSMatthias Ringwald 
2122e4c6114dSMatthias Ringwald #ifdef ENABLE_SCO_OVER_HCI
2123521bd5ffSMatthias Ringwald             /* fall through */
2124521bd5ffSMatthias Ringwald 
2125483c5078SMatthias Ringwald         // only sent if ENABLE_SCO_OVER_HCI is defined
2126729ed62eSMatthias Ringwald         case HCI_INIT_WRITE_SYNCHRONOUS_FLOW_CONTROL_ENABLE:
2127e4c6114dSMatthias Ringwald             // skip write synchronous flow control if not supported
21281ffa425cSMatthias Ringwald             if (hci_classic_supported()
21291ffa425cSMatthias Ringwald             && hci_command_supported(SUPPORTED_HCI_COMMAND_WRITE_SYNCHRONOUS_FLOW_CONTROL_ENABLE)) {
2130729ed62eSMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_WRITE_SYNCHRONOUS_FLOW_CONTROL_ENABLE;
2131729ed62eSMatthias Ringwald                 hci_send_cmd(&hci_write_synchronous_flow_control_enable, 1); // SCO tracking enabled
2132729ed62eSMatthias Ringwald                 break;
2133f795c86eSMatthias Ringwald             }
2134f795c86eSMatthias Ringwald             /* fall through */
2135f795c86eSMatthias Ringwald 
2136483c5078SMatthias Ringwald         case HCI_INIT_WRITE_DEFAULT_ERRONEOUS_DATA_REPORTING:
2137e4c6114dSMatthias Ringwald             // skip write default erroneous data reporting if not supported
21381ffa425cSMatthias Ringwald             if (hci_classic_supported()
21391ffa425cSMatthias Ringwald             && hci_command_supported(SUPPORTED_HCI_COMMAND_WRITE_DEFAULT_ERRONEOUS_DATA_REPORTING)) {
2140483c5078SMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_WRITE_DEFAULT_ERRONEOUS_DATA_REPORTING;
2141483c5078SMatthias Ringwald                 hci_send_cmd(&hci_write_default_erroneous_data_reporting, 1);
2142483c5078SMatthias Ringwald                 break;
2143f795c86eSMatthias Ringwald             }
2144e4c6114dSMatthias Ringwald #endif
2145f795c86eSMatthias Ringwald 
2146f795c86eSMatthias Ringwald #if defined(ENABLE_SCO_OVER_HCI) || defined(ENABLE_SCO_OVER_PCM)
2147521bd5ffSMatthias Ringwald             /* fall through */
2148521bd5ffSMatthias Ringwald 
21498051253fSMatthias Ringwald         // only sent if manufacturer is Broadcom and ENABLE_SCO_OVER_HCI or ENABLE_SCO_OVER_PCM is defined
2150a42798c3SMatthias Ringwald         case HCI_INIT_BCM_WRITE_SCO_PCM_INT:
2151e4c6114dSMatthias Ringwald             if (hci_classic_supported() && (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_BROADCOM_CORPORATION)){
2152a42798c3SMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_BCM_WRITE_SCO_PCM_INT;
21538051253fSMatthias Ringwald #ifdef ENABLE_SCO_OVER_HCI
2154a42798c3SMatthias Ringwald                 log_info("BCM: Route SCO data via HCI transport");
2155a42798c3SMatthias Ringwald                 hci_send_cmd(&hci_bcm_write_sco_pcm_int, 1, 0, 0, 0, 0);
21568051253fSMatthias Ringwald #endif
21578051253fSMatthias Ringwald #ifdef ENABLE_SCO_OVER_PCM
21588051253fSMatthias Ringwald                 log_info("BCM: Route SCO data via PCM interface");
21591d2bbd54SMatthias Ringwald #ifdef ENABLE_BCM_PCM_WBS
2160f795c86eSMatthias Ringwald                 // 512 kHz bit clock for 2 channels x 16 bit x 16 kHz
21611d2bbd54SMatthias Ringwald                 hci_send_cmd(&hci_bcm_write_sco_pcm_int, 0, 2, 0, 1, 1);
21621d2bbd54SMatthias Ringwald #else
21631d2bbd54SMatthias Ringwald                 // 256 kHz bit clock for 2 channels x 16 bit x 8 kHz
21641d2bbd54SMatthias Ringwald                 hci_send_cmd(&hci_bcm_write_sco_pcm_int, 0, 1, 0, 1, 1);
21651d2bbd54SMatthias Ringwald #endif
21668051253fSMatthias Ringwald #endif
2167a42798c3SMatthias Ringwald                 break;
2168f795c86eSMatthias Ringwald             }
2169f795c86eSMatthias Ringwald #endif
2170f795c86eSMatthias Ringwald 
21714e821764SMatthias Ringwald #ifdef ENABLE_SCO_OVER_PCM
2172521bd5ffSMatthias Ringwald             /* fall through */
2173521bd5ffSMatthias Ringwald 
21744e821764SMatthias Ringwald         case HCI_INIT_BCM_WRITE_I2SPCM_INTERFACE_PARAM:
2175e4c6114dSMatthias Ringwald             if (hci_classic_supported() && (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_BROADCOM_CORPORATION)){
21764e821764SMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_BCM_WRITE_I2SPCM_INTERFACE_PARAM;
21774e821764SMatthias Ringwald                 log_info("BCM: Config PCM interface for I2S");
21781d2bbd54SMatthias Ringwald #ifdef ENABLE_BCM_PCM_WBS
21791d2bbd54SMatthias Ringwald                 // 512 kHz bit clock for 2 channels x 16 bit x 8 kHz
21801d2bbd54SMatthias Ringwald                 hci_send_cmd(&hci_bcm_write_i2spcm_interface_param, 1, 1, 0, 2);
21811d2bbd54SMatthias Ringwald #else
21821d2bbd54SMatthias Ringwald                 // 256 kHz bit clock for 2 channels x 16 bit x 8 kHz
21831d2bbd54SMatthias Ringwald                 hci_send_cmd(&hci_bcm_write_i2spcm_interface_param, 1, 1, 0, 1);
21841d2bbd54SMatthias Ringwald #endif
21854e821764SMatthias Ringwald                 break;
2186f795c86eSMatthias Ringwald             }
21871be678e9SMatthias Ringwald         case HCI_INIT_BCM_WRITE_PCM_DATA_FORMAT_PARAM:
21881be678e9SMatthias Ringwald             if (hci_classic_supported() && (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_BROADCOM_CORPORATION)){
21891be678e9SMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_BCM_WRITE_PCM_DATA_FORMAT_PARAM;
21901be678e9SMatthias Ringwald                 log_info("BCM: Config PCM Data format");
21911be678e9SMatthias Ringwald                 // msb first, fill bits 0, left justified
21921be678e9SMatthias Ringwald                 hci_send_cmd(&hci_bcm_write_pcm_data_format_param, 0, 0, 3, 3, 0);
21931be678e9SMatthias Ringwald                 break;
21941be678e9SMatthias Ringwald             }
2195dd1f98b4SMatthias Ringwald #ifdef HAVE_BCM_PCM2
2196dd1f98b4SMatthias Ringwald         case HCI_INIT_BCM_PCM2_SETUP:
2197dd1f98b4SMatthias Ringwald             if (hci_classic_supported() && (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_BROADCOM_CORPORATION)) {
2198dd1f98b4SMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_BCM_PCM2_SETUP;
2199dd1f98b4SMatthias Ringwald                 uint8_t  op_mode = 0;  // Op_Mode = 0 = PCM, 1 = I2S
2200dd1f98b4SMatthias Ringwald                 uint32_t pcm_clock_freq;
2201dd1f98b4SMatthias Ringwald                 uint8_t  ch_0_period;
2202dd1f98b4SMatthias Ringwald #ifdef ENABLE_BCM_PCM_WBS
2203dd1f98b4SMatthias Ringwald                 // 512 kHz, resample 8 kHz to 16 khz
2204dd1f98b4SMatthias Ringwald                 pcm_clock_freq = 512000;
2205dd1f98b4SMatthias Ringwald                 ch_0_period = 1;
2206dd1f98b4SMatthias Ringwald #else
2207dd1f98b4SMatthias Ringwald                 // 256 khz, 8 khz output
2208dd1f98b4SMatthias Ringwald                 pcm_clock_freq = 256000;
2209dd1f98b4SMatthias Ringwald                 ch_0_period = 0;
221035454696SMatthias Ringwald #endif
2211dd1f98b4SMatthias Ringwald                 log_info("BCM: Config PCM2 - op mode %u, pcm clock %" PRIu32 ", ch0_period %u", op_mode, pcm_clock_freq, ch_0_period);
2212dd1f98b4SMatthias Ringwald                 hci_send_cmd(&hci_bcm_pcm2_setup,
2213dd1f98b4SMatthias Ringwald                              0x00, // Action = Write
2214dd1f98b4SMatthias Ringwald                              0x00, // Test_Options = None
2215dd1f98b4SMatthias Ringwald                              op_mode, // Op_Mode
2216dd1f98b4SMatthias Ringwald                              0x1D, // Sync_and_Clock_Options Sync = Signal | Sync Output Enable | Generate PCM_CLK | Tristate When Idle
2217dd1f98b4SMatthias Ringwald                              pcm_clock_freq, // PCM_Clock_Freq
2218dd1f98b4SMatthias Ringwald                              0x01, // Sync_Signal_Width
2219dd1f98b4SMatthias Ringwald                              0x0F, // Slot_Width
2220dd1f98b4SMatthias Ringwald                              0x01, // NumberOfSlots
2221dd1f98b4SMatthias Ringwald                              0x00, // Bank_0_Fill_Mode = 0s
2222dd1f98b4SMatthias Ringwald                              0x00, // Bank_0_Number_of_Fill_Bits
2223dd1f98b4SMatthias Ringwald                              0x00, // Bank_0_Programmable_Fill_Data
2224dd1f98b4SMatthias Ringwald                              0x00, // Bank_1_Fill_Mode = 0s
2225dd1f98b4SMatthias Ringwald                              0x00, // Bank_1_Number_of_Fill_Bits
2226dd1f98b4SMatthias Ringwald                              0x00, // Bank_1_Programmable_Fill_Data
2227dd1f98b4SMatthias Ringwald                              0x00, // Data_Justify_And_Bit_Order_Options = Left Justify
2228dd1f98b4SMatthias Ringwald                              0x00, // Ch_0_Slot_Number
2229dd1f98b4SMatthias Ringwald                              0x01, // Ch_1_Slot_Number
2230dd1f98b4SMatthias Ringwald                              0x02, // Ch_2_Slot_Number
2231dd1f98b4SMatthias Ringwald                              0x03, // Ch_3_Slot_Number
2232dd1f98b4SMatthias Ringwald                              0x04, // Ch_4_Slot_Number
2233dd1f98b4SMatthias Ringwald                              ch_0_period, // Ch_0_Period
2234dd1f98b4SMatthias Ringwald                              0x00, // Ch_1_Period
2235dd1f98b4SMatthias Ringwald                              0x00  // Ch_2_Period
2236dd1f98b4SMatthias Ringwald                 );
2237dd1f98b4SMatthias Ringwald                 break;
2238dd1f98b4SMatthias Ringwald             }
22394e821764SMatthias Ringwald #endif
2240dd1f98b4SMatthias Ringwald #endif /* ENABLE_SCO_OVER_PCM */
2241dd1f98b4SMatthias Ringwald #endif /* ENABLE_CLASSIC */
22424e821764SMatthias Ringwald 
2243a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE
2244521bd5ffSMatthias Ringwald             /* fall through */
2245521bd5ffSMatthias Ringwald 
224674b323a9SMatthias Ringwald         // LE INIT
224774b323a9SMatthias Ringwald         case HCI_INIT_LE_READ_BUFFER_SIZE:
2248f795c86eSMatthias Ringwald             if (hci_le_supported()){
224974b323a9SMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_LE_READ_BUFFER_SIZE;
225079b7ea2dSMatthias Ringwald                 if (hci_command_supported(SUPPORTED_HCI_COMMAND_LE_READ_BUFFER_SIZE_V2)){
225179b7ea2dSMatthias Ringwald                     hci_send_cmd(&hci_le_read_buffer_size_v2);
225279b7ea2dSMatthias Ringwald                 } else {
22530305bdeaSMatthias Ringwald                     hci_send_cmd(&hci_le_read_buffer_size);
225479b7ea2dSMatthias Ringwald                 }
225574b323a9SMatthias Ringwald                 break;
2256f795c86eSMatthias Ringwald             }
2257521bd5ffSMatthias Ringwald 
2258f795c86eSMatthias Ringwald             /* fall through */
2259f795c86eSMatthias Ringwald 
2260699a5fcaSMatthias Ringwald         case HCI_INIT_WRITE_LE_HOST_SUPPORTED:
2261699a5fcaSMatthias Ringwald             // skip write le host if not supported (e.g. on LE only EM9301)
22621ffa425cSMatthias Ringwald             if (hci_le_supported()
22631ffa425cSMatthias Ringwald             && hci_command_supported(SUPPORTED_HCI_COMMAND_WRITE_LE_HOST_SUPPORTED)) {
2264699a5fcaSMatthias Ringwald                 // LE Supported Host = 1, Simultaneous Host = 0
2265699a5fcaSMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_WRITE_LE_HOST_SUPPORTED;
2266699a5fcaSMatthias Ringwald                 hci_send_cmd(&hci_write_le_host_supported, 1, 0);
2267daabb8b8SMatthias Ringwald                 break;
2268f795c86eSMatthias Ringwald             }
2269521bd5ffSMatthias Ringwald 
2270f795c86eSMatthias Ringwald             /* fall through */
2271f795c86eSMatthias Ringwald 
2272699a5fcaSMatthias Ringwald         case HCI_INIT_LE_SET_EVENT_MASK:
2273f795c86eSMatthias Ringwald             if (hci_le_supported()){
2274699a5fcaSMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_LE_SET_EVENT_MASK;
22755d6688b0SMatthias Ringwald #ifdef ENABLE_LE_ENHANCED_CONNECTION_COMPLETE_EVENT
2276920a6ac5SMatthias Ringwald                 hci_send_cmd(&hci_le_set_event_mask, 0xffffffff, 0x0107); // all events from core v5.3
22775d6688b0SMatthias Ringwald #else
2278920a6ac5SMatthias Ringwald                 hci_send_cmd(&hci_le_set_event_mask, 0xfffffdff, 0x0007); // all events from core v5.3 without LE Enhanced Connection Complete
22795d6688b0SMatthias Ringwald #endif
228074b323a9SMatthias Ringwald                 break;
2281f795c86eSMatthias Ringwald             }
2282b435e062SMatthias Ringwald #endif
2283b435e062SMatthias Ringwald 
2284b435e062SMatthias Ringwald #ifdef ENABLE_LE_DATA_LENGTH_EXTENSION
2285521bd5ffSMatthias Ringwald             /* fall through */
2286521bd5ffSMatthias Ringwald 
2287dcd678baSMatthias Ringwald         case HCI_INIT_LE_READ_MAX_DATA_LENGTH:
22881ffa425cSMatthias Ringwald             if (hci_le_supported()
22891ffa425cSMatthias Ringwald             && hci_command_supported(SUPPORTED_HCI_COMMAND_LE_READ_MAXIMUM_DATA_LENGTH)) {
2290dcd678baSMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_LE_READ_MAX_DATA_LENGTH;
2291dcd678baSMatthias Ringwald                 hci_send_cmd(&hci_le_read_maximum_data_length);
2292dcd678baSMatthias Ringwald                 break;
2293f795c86eSMatthias Ringwald             }
2294521bd5ffSMatthias Ringwald 
2295f795c86eSMatthias Ringwald             /* fall through */
2296f795c86eSMatthias Ringwald 
2297dcd678baSMatthias Ringwald         case HCI_INIT_LE_WRITE_SUGGESTED_DATA_LENGTH:
22981ffa425cSMatthias Ringwald             if (hci_le_supported()
22991ffa425cSMatthias Ringwald             && hci_command_supported(SUPPORTED_HCI_COMMAND_LE_WRITE_SUGGESTED_DEFAULT_DATA_LENGTH)) {
2300dcd678baSMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_LE_WRITE_SUGGESTED_DATA_LENGTH;
2301b435e062SMatthias 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);
2302dcd678baSMatthias Ringwald                 break;
2303f795c86eSMatthias Ringwald             }
2304b435e062SMatthias Ringwald #endif
2305b435e062SMatthias Ringwald 
2306b95a5a35SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
2307521bd5ffSMatthias Ringwald             /* fall through */
2308521bd5ffSMatthias Ringwald 
23093b6d4121SMatthias Ringwald         case HCI_INIT_READ_WHITE_LIST_SIZE:
2310f795c86eSMatthias Ringwald             if (hci_le_supported()){
23113b6d4121SMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_READ_WHITE_LIST_SIZE;
23123b6d4121SMatthias Ringwald                 hci_send_cmd(&hci_le_read_white_list_size);
23133b6d4121SMatthias Ringwald                 break;
2314f795c86eSMatthias Ringwald             }
2315521bd5ffSMatthias Ringwald 
231674b323a9SMatthias Ringwald #endif
23174f982f31SMatthias Ringwald 
23183a74541eSMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
23193a74541eSMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
23203a74541eSMatthias Ringwald             /* fall through */
23213a74541eSMatthias Ringwald 
23223a74541eSMatthias Ringwald         case HCI_INIT_LE_READ_MAX_ADV_DATA_LEN:
23233a74541eSMatthias Ringwald             if (hci_extended_advertising_supported()){
23243a74541eSMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_LE_READ_MAX_ADV_DATA_LEN;
23253a74541eSMatthias Ringwald                 hci_send_cmd(&hci_le_read_maximum_advertising_data_length);
23263a74541eSMatthias Ringwald                 break;
23273a74541eSMatthias Ringwald             }
23283a74541eSMatthias Ringwald #endif
23293a74541eSMatthias Ringwald #endif
2330521bd5ffSMatthias Ringwald             /* fall through */
2331521bd5ffSMatthias Ringwald 
2332c63ee49aSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
2333c63ee49aSMatthias Ringwald     case HCI_INIT_LE_SET_HOST_FEATURE_CONNECTED_ISO_STREAMS:
2334c63ee49aSMatthias Ringwald             if (hci_le_supported()) {
2335c63ee49aSMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_LE_SET_HOST_FEATURE_CONNECTED_ISO_STREAMS;
2336c63ee49aSMatthias Ringwald                 hci_send_cmd(&hci_le_set_host_feature, 32, 1);
2337c63ee49aSMatthias Ringwald                 break;
2338c63ee49aSMatthias Ringwald             }
2339c63ee49aSMatthias Ringwald #endif
2340c63ee49aSMatthias Ringwald 
2341c63ee49aSMatthias Ringwald             /* fall through */
2342c63ee49aSMatthias Ringwald 
2343f795c86eSMatthias Ringwald         case HCI_INIT_DONE:
23444f982f31SMatthias Ringwald             hci_stack->substate = HCI_INIT_DONE;
234573799937SMatthias Ringwald             // main init sequence complete
23464f982f31SMatthias Ringwald #ifdef ENABLE_CLASSIC
234773799937SMatthias Ringwald             // check if initial Classic GAP Tasks are completed
2348baa4881eSMatthias Ringwald             if (hci_classic_supported() && (hci_stack->gap_tasks_classic != 0)) {
23494f982f31SMatthias Ringwald                 hci_run_gap_tasks_classic();
23504f982f31SMatthias Ringwald                 break;
23514f982f31SMatthias Ringwald             }
23524f982f31SMatthias Ringwald #endif
235373799937SMatthias Ringwald #ifdef ENABLE_BLE
235473799937SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
235573799937SMatthias Ringwald             // check if initial LE GAP Tasks are completed
235673799937SMatthias Ringwald             if (hci_le_supported() && hci_stack->le_scanning_param_update) {
235773799937SMatthias Ringwald                 hci_run_general_gap_le();
235873799937SMatthias Ringwald                 break;
235973799937SMatthias Ringwald             }
236073799937SMatthias Ringwald #endif
236173799937SMatthias Ringwald #endif
2362f795c86eSMatthias Ringwald             hci_init_done();
2363f795c86eSMatthias Ringwald             break;
2364f795c86eSMatthias Ringwald 
236574b323a9SMatthias Ringwald         default:
236674b323a9SMatthias Ringwald             return;
236774b323a9SMatthias Ringwald     }
236855975f88SMatthias Ringwald }
236955975f88SMatthias Ringwald 
237007fd2f31SMatthias Ringwald static bool hci_initializing_event_handler_command_completed(const uint8_t * packet){
237107fd2f31SMatthias Ringwald     bool command_completed = false;
23720e2df43fSMatthias Ringwald     if (hci_event_packet_get_type(packet) == HCI_EVENT_COMMAND_COMPLETE){
2373f8fbdce0SMatthias Ringwald         uint16_t opcode = little_endian_read_16(packet,3);
23746155b3d3S[email protected]         if (opcode == hci_stack->last_cmd_opcode){
237507fd2f31SMatthias Ringwald             command_completed = true;
2376148ca237SMatthias Ringwald             log_debug("Command complete for expected opcode %04x at substate %u", opcode, hci_stack->substate);
23776155b3d3S[email protected]         } else {
2378d58dd308SMatthias Ringwald             log_info("Command complete for different opcode %04x, expected %04x, at substate %u", opcode, hci_stack->last_cmd_opcode, hci_stack->substate);
23796155b3d3S[email protected]         }
23806155b3d3S[email protected]     }
23810f97eae7SMatthias Ringwald 
23820e2df43fSMatthias Ringwald     if (hci_event_packet_get_type(packet) == HCI_EVENT_COMMAND_STATUS){
23836155b3d3S[email protected]         uint8_t  status = packet[2];
2384f8fbdce0SMatthias Ringwald         uint16_t opcode = little_endian_read_16(packet,4);
23856155b3d3S[email protected]         if (opcode == hci_stack->last_cmd_opcode){
23866155b3d3S[email protected]             if (status){
238707fd2f31SMatthias Ringwald                 command_completed = true;
2388148ca237SMatthias Ringwald                 log_debug("Command status error 0x%02x for expected opcode %04x at substate %u", status, opcode, hci_stack->substate);
23896155b3d3S[email protected]             } else {
23906155b3d3S[email protected]                 log_info("Command status OK for expected opcode %04x, waiting for command complete", opcode);
23916155b3d3S[email protected]             }
23926155b3d3S[email protected]         } else {
2393148ca237SMatthias Ringwald             log_debug("Command status for opcode %04x, expected %04x", opcode, hci_stack->last_cmd_opcode);
23946155b3d3S[email protected]         }
23956155b3d3S[email protected]     }
23966fad2c37SMatthias Ringwald #ifndef HAVE_HOST_CONTROLLER_API
2397e47e68c7SMatthias Ringwald     // Vendor == CSR
23980e588213SMatthias Ringwald     if ((hci_stack->substate == HCI_INIT_W4_CUSTOM_INIT) && (hci_event_packet_get_type(packet) == HCI_EVENT_VENDOR_SPECIFIC)){
2399e47e68c7SMatthias Ringwald         // TODO: track actual command
240007fd2f31SMatthias Ringwald         command_completed = true;
2401e47e68c7SMatthias Ringwald     }
2402a2481739S[email protected] 
24034e9daa6fSMatthias Ringwald     // Vendor == Toshiba
24040e588213SMatthias Ringwald     if ((hci_stack->substate == HCI_INIT_W4_SEND_BAUD_CHANGE) && (hci_event_packet_get_type(packet) == HCI_EVENT_VENDOR_SPECIFIC)){
24054e9daa6fSMatthias Ringwald         // TODO: track actual command
240607fd2f31SMatthias Ringwald         command_completed = true;
2407004902f1SMatthias Ringwald         // Fix: no HCI Command Complete received, so num_cmd_packets not reset
2408004902f1SMatthias Ringwald         hci_stack->num_cmd_packets = 1;
24094e9daa6fSMatthias Ringwald     }
241007fd2f31SMatthias Ringwald #endif
241107fd2f31SMatthias Ringwald 
241207fd2f31SMatthias Ringwald     return command_completed;
241307fd2f31SMatthias Ringwald }
241407fd2f31SMatthias Ringwald 
241507fd2f31SMatthias Ringwald static void hci_initializing_event_handler(const uint8_t * packet, uint16_t size){
241607fd2f31SMatthias Ringwald 
241707fd2f31SMatthias Ringwald     UNUSED(size);   // ok: less than 6 bytes are read from our buffer
241807fd2f31SMatthias Ringwald 
241907fd2f31SMatthias Ringwald     bool command_completed =  hci_initializing_event_handler_command_completed(packet);
242007fd2f31SMatthias Ringwald 
24216fad2c37SMatthias Ringwald #ifndef HAVE_HOST_CONTROLLER_API
24224e9daa6fSMatthias Ringwald 
24230f97eae7SMatthias Ringwald     // Late response (> 100 ms) for HCI Reset e.g. on Toshiba TC35661:
24240f97eae7SMatthias Ringwald     // Command complete for HCI Reset arrives after we've resent the HCI Reset command
24250f97eae7SMatthias Ringwald     //
24260f97eae7SMatthias Ringwald     // HCI Reset
24270f97eae7SMatthias Ringwald     // Timeout 100 ms
24280f97eae7SMatthias Ringwald     // HCI Reset
24290f97eae7SMatthias Ringwald     // Command Complete Reset
24300f97eae7SMatthias Ringwald     // HCI Read Local Version Information
24310f97eae7SMatthias Ringwald     // Command Complete Reset - but we expected Command Complete Read Local Version Information
24320f97eae7SMatthias Ringwald     // hang...
24330f97eae7SMatthias Ringwald     //
24340f97eae7SMatthias Ringwald     // Fix: Command Complete for HCI Reset in HCI_INIT_W4_SEND_READ_LOCAL_VERSION_INFORMATION trigger resend
24350f97eae7SMatthias Ringwald     if (!command_completed
2436a1df452eSMatthias Ringwald             && (hci_event_packet_get_type(packet) == HCI_EVENT_COMMAND_COMPLETE)
24370e588213SMatthias Ringwald             && (hci_stack->substate == HCI_INIT_W4_SEND_READ_LOCAL_VERSION_INFORMATION)){
24380f97eae7SMatthias Ringwald 
2439f8fbdce0SMatthias Ringwald         uint16_t opcode = little_endian_read_16(packet,3);
24400f97eae7SMatthias Ringwald         if (opcode == hci_reset.opcode){
24410f97eae7SMatthias Ringwald             hci_stack->substate = HCI_INIT_SEND_READ_LOCAL_VERSION_INFORMATION;
24420f97eae7SMatthias Ringwald             return;
24430f97eae7SMatthias Ringwald         }
24440f97eae7SMatthias Ringwald     }
24450f97eae7SMatthias Ringwald 
24469f007422SMatthias Ringwald     // CSR & H5
24479f007422SMatthias Ringwald     // Fix: Command Complete for HCI Reset in HCI_INIT_W4_SEND_READ_LOCAL_VERSION_INFORMATION trigger resend
24489f007422SMatthias Ringwald     if (!command_completed
2449a1df452eSMatthias Ringwald             && (hci_event_packet_get_type(packet) == HCI_EVENT_COMMAND_COMPLETE)
24500e588213SMatthias Ringwald             && (hci_stack->substate == HCI_INIT_W4_READ_LOCAL_SUPPORTED_COMMANDS)){
24519f007422SMatthias Ringwald 
24529f007422SMatthias Ringwald         uint16_t opcode = little_endian_read_16(packet,3);
24539f007422SMatthias Ringwald         if (opcode == hci_reset.opcode){
24549f007422SMatthias Ringwald             hci_stack->substate = HCI_INIT_READ_LOCAL_SUPPORTED_COMMANDS;
24559f007422SMatthias Ringwald             return;
24569f007422SMatthias Ringwald         }
24579f007422SMatthias Ringwald     }
24589f007422SMatthias Ringwald 
24599f007422SMatthias 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
24609f007422SMatthias Ringwald     // fix: Correct substate and behave as command below
24619f007422SMatthias Ringwald     if (command_completed){
24629f007422SMatthias Ringwald         switch (hci_stack->substate){
24639f007422SMatthias Ringwald             case HCI_INIT_SEND_RESET:
24649f007422SMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_SEND_RESET;
24659f007422SMatthias Ringwald                 break;
24669f007422SMatthias Ringwald             case HCI_INIT_SEND_RESET_CSR_WARM_BOOT:
24679f007422SMatthias Ringwald                 hci_stack->substate = HCI_INIT_W4_CUSTOM_INIT_CSR_WARM_BOOT;
24689f007422SMatthias Ringwald                 break;
24699f007422SMatthias Ringwald             default:
24709f007422SMatthias Ringwald                 break;
24719f007422SMatthias Ringwald         }
24729f007422SMatthias Ringwald     }
24730f97eae7SMatthias Ringwald 
247406b9e820SMatthias Ringwald #endif
24750f97eae7SMatthias Ringwald 
2476a2481739S[email protected]     if (!command_completed) return;
2477a2481739S[email protected] 
247807fd2f31SMatthias Ringwald     bool need_baud_change = false;
247907fd2f31SMatthias Ringwald     bool need_addr_change = false;
248006b9e820SMatthias Ringwald 
24816fad2c37SMatthias Ringwald #ifndef HAVE_HOST_CONTROLLER_API
248206b9e820SMatthias Ringwald     need_baud_change = hci_stack->config
24833fb36a29SMatthias Ringwald                         && hci_stack->chipset
24843fb36a29SMatthias Ringwald                         && hci_stack->chipset->set_baudrate_command
2485db8bc6ffSMatthias Ringwald                         && hci_stack->hci_transport->set_baudrate
24869796ebeaSMatthias Ringwald                         && ((hci_transport_config_uart_t *)hci_stack->config)->baudrate_main;
2487db8bc6ffSMatthias Ringwald 
248806b9e820SMatthias Ringwald     need_addr_change = hci_stack->custom_bd_addr_set
24893fb36a29SMatthias Ringwald                         && hci_stack->chipset
24903fb36a29SMatthias Ringwald                         && hci_stack->chipset->set_bd_addr_command;
249106b9e820SMatthias Ringwald #endif
2492a80162e9SMatthias Ringwald 
24935c363727SMatthias Ringwald     switch(hci_stack->substate){
249406b9e820SMatthias Ringwald 
24956fad2c37SMatthias Ringwald #ifndef HAVE_HOST_CONTROLLER_API
24969f007422SMatthias Ringwald         case HCI_INIT_SEND_RESET:
2497d58dd308SMatthias Ringwald             // on CSR with BCSP/H5, resend triggers resend of HCI Reset and leads to substate == HCI_INIT_SEND_RESET
24989f007422SMatthias Ringwald             // fix: just correct substate and behave as command below
2499f4c579d4SMatthias Ringwald 
2500f4c579d4SMatthias Ringwald             /* fall through */
2501f4c579d4SMatthias Ringwald #endif
2502f4c579d4SMatthias Ringwald 
250374b323a9SMatthias Ringwald         case HCI_INIT_W4_SEND_RESET:
2504528a4a3bSMatthias Ringwald             btstack_run_loop_remove_timer(&hci_stack->timeout);
2505f4c579d4SMatthias Ringwald             hci_stack->substate = HCI_INIT_SEND_READ_LOCAL_VERSION_INFORMATION;
25062f48d920SMatthias Ringwald             return;
2507f4c579d4SMatthias Ringwald 
2508f4c579d4SMatthias Ringwald #ifndef HAVE_HOST_CONTROLLER_API
2509a80162e9SMatthias Ringwald         case HCI_INIT_W4_SEND_BAUD_CHANGE:
25104696bddbSMatthias Ringwald             // for STLC2500D, baud rate change already happened.
2511fab26ab3SMatthias Ringwald             // for others, baud rate gets changed now
251261f37892SMatthias Ringwald             if ((hci_stack->manufacturer != BLUETOOTH_COMPANY_ID_ST_MICROELECTRONICS) && need_baud_change){
251396b53536SMatthias Ringwald                 uint32_t baud_rate = hci_transport_uart_get_main_baud_rate();
2514cd724cb7SMatthias Ringwald                 log_info("Local baud rate change to %" PRIu32 "(w4_send_baud_change)", baud_rate);
2515fab26ab3SMatthias Ringwald                 hci_stack->hci_transport->set_baudrate(baud_rate);
25164696bddbSMatthias Ringwald             }
251774b323a9SMatthias Ringwald             hci_stack->substate = HCI_INIT_CUSTOM_INIT;
251874b323a9SMatthias Ringwald             return;
2519a80162e9SMatthias Ringwald         case HCI_INIT_W4_CUSTOM_INIT_CSR_WARM_BOOT:
2520528a4a3bSMatthias Ringwald             btstack_run_loop_remove_timer(&hci_stack->timeout);
2521a80162e9SMatthias Ringwald             hci_stack->substate = HCI_INIT_CUSTOM_INIT;
2522a80162e9SMatthias Ringwald             return;
252374b323a9SMatthias Ringwald         case HCI_INIT_W4_CUSTOM_INIT:
252474b323a9SMatthias Ringwald             // repeat custom init
252574b323a9SMatthias Ringwald             hci_stack->substate = HCI_INIT_CUSTOM_INIT;
252674b323a9SMatthias Ringwald             return;
25276fe16221SMatthias Ringwald         case HCI_INIT_W4_CUSTOM_PRE_INIT:
25286fe16221SMatthias Ringwald             // repeat custom init
25296fe16221SMatthias Ringwald             hci_stack->substate = HCI_INIT_CUSTOM_PRE_INIT;
25306fe16221SMatthias Ringwald             return;
253106b9e820SMatthias Ringwald #endif
253206b9e820SMatthias Ringwald 
2533a828a756SMatthias Ringwald         case HCI_INIT_W4_READ_LOCAL_SUPPORTED_COMMANDS:
25340e588213SMatthias Ringwald             if (need_baud_change && (hci_stack->chipset_result != BTSTACK_CHIPSET_NO_INIT_SCRIPT) &&
2535efd3b327SMatthias Ringwald               ((hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_BROADCOM_CORPORATION) ||
2536efd3b327SMatthias Ringwald                (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_EM_MICROELECTRONIC_MARIN_SA))) {
2537eb3a5314SMatthias Ringwald                 hci_stack->substate = HCI_INIT_SEND_BAUD_CHANGE_BCM;
2538eb3a5314SMatthias Ringwald                 return;
2539eb3a5314SMatthias Ringwald             }
254053860077SMatthias Ringwald             if (need_addr_change){
254153860077SMatthias Ringwald                 hci_stack->substate = HCI_INIT_SET_BD_ADDR;
254253860077SMatthias Ringwald                 return;
254353860077SMatthias Ringwald             }
254453860077SMatthias Ringwald             hci_stack->substate = HCI_INIT_READ_BD_ADDR;
254553860077SMatthias Ringwald             return;
25466fad2c37SMatthias Ringwald #ifndef HAVE_HOST_CONTROLLER_API
25477224be7eSMatthias Ringwald         case HCI_INIT_W4_SEND_BAUD_CHANGE_BCM:
25487224be7eSMatthias Ringwald             if (need_baud_change){
254996b53536SMatthias Ringwald                 uint32_t baud_rate = hci_transport_uart_get_main_baud_rate();
2550cd724cb7SMatthias Ringwald                 log_info("Local baud rate change to %" PRIu32 "(w4_send_baud_change_bcm))", baud_rate);
2551fab26ab3SMatthias Ringwald                 hci_stack->hci_transport->set_baudrate(baud_rate);
25527224be7eSMatthias Ringwald             }
2553eb3a5314SMatthias Ringwald             if (need_addr_change){
2554eb3a5314SMatthias Ringwald                 hci_stack->substate = HCI_INIT_SET_BD_ADDR;
2555eb3a5314SMatthias Ringwald                 return;
2556eb3a5314SMatthias Ringwald             }
2557eb3a5314SMatthias Ringwald             hci_stack->substate = HCI_INIT_READ_BD_ADDR;
2558eb3a5314SMatthias Ringwald             return;
255953860077SMatthias Ringwald         case HCI_INIT_W4_SET_BD_ADDR:
25606ca9a99aSMatthias Ringwald             // for STLC2500D + ATWILC3000, bd addr change only gets active after sending reset command
25616ca9a99aSMatthias Ringwald             if ((hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_ST_MICROELECTRONICS)
25626ca9a99aSMatthias Ringwald             ||  (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_ATMEL_CORPORATION)){
256353860077SMatthias Ringwald                 hci_stack->substate = HCI_INIT_SEND_RESET_ST_WARM_BOOT;
256453860077SMatthias Ringwald                 return;
256553860077SMatthias Ringwald             }
256653860077SMatthias Ringwald             // skipping st warm boot
256753860077SMatthias Ringwald             hci_stack->substate = HCI_INIT_READ_BD_ADDR;
256853860077SMatthias Ringwald             return;
256953860077SMatthias Ringwald         case HCI_INIT_W4_SEND_RESET_ST_WARM_BOOT:
257053860077SMatthias Ringwald             hci_stack->substate = HCI_INIT_READ_BD_ADDR;
257153860077SMatthias Ringwald             return;
257206b9e820SMatthias Ringwald #endif
2573e7c662faSMatthias Ringwald 
2574f795c86eSMatthias Ringwald         case HCI_INIT_DONE:
2575eb8d95caSMatthias Ringwald             // set state if we came here by fall through
2576eb8d95caSMatthias Ringwald             hci_stack->substate = HCI_INIT_DONE;
2577f795c86eSMatthias Ringwald             return;
2578a650ba4dSMatthias Ringwald 
25796155b3d3S[email protected]         default:
258074b323a9SMatthias Ringwald             break;
25816155b3d3S[email protected]     }
258255975f88SMatthias Ringwald     hci_initializing_next_state();
25836155b3d3S[email protected] }
25846155b3d3S[email protected] 
25850bbba85bSMatthias Ringwald static void hci_handle_connection_failed(hci_connection_t * conn, uint8_t status){
25863bb5ff27SMatthias Ringwald     // CC2564C might emit Connection Complete for rejected incoming SCO connection
25871a4fdac4SMatthias Ringwald     // To prevent accidentally free'ing the HCI connection for the ACL connection,
25881a4fdac4SMatthias Ringwald     // check if we have been aware of the HCI connection
25891f34df2cSMatthias Ringwald     switch (conn->state){
25901a4fdac4SMatthias Ringwald         case SENT_CREATE_CONNECTION:
25911f34df2cSMatthias Ringwald         case RECEIVED_CONNECTION_REQUEST:
25929071873aSMatthias Ringwald         case ACCEPTED_CONNECTION_REQUEST:
25931f34df2cSMatthias Ringwald             break;
25941f34df2cSMatthias Ringwald         default:
25951f34df2cSMatthias Ringwald             return;
25961f34df2cSMatthias Ringwald     }
25973bb5ff27SMatthias Ringwald 
2598229331c6SMatthias Ringwald     log_info("Outgoing connection to %s failed", bd_addr_to_str(conn->address));
25990bbba85bSMatthias Ringwald     bd_addr_t bd_address;
26006535961aSMatthias Ringwald     (void)memcpy(&bd_address, conn->address, 6);
26010bbba85bSMatthias Ringwald 
26026bc9fa5eSMatthias Ringwald #ifdef ENABLE_CLASSIC
26036bc9fa5eSMatthias Ringwald     // cache needed data
26046bc9fa5eSMatthias Ringwald     int notify_dedicated_bonding_failed = conn->bonding_flags & BONDING_DEDICATED;
26056bc9fa5eSMatthias Ringwald #endif
26066bc9fa5eSMatthias Ringwald 
26070bbba85bSMatthias Ringwald     // connection failed, remove entry
26080bbba85bSMatthias Ringwald     btstack_linked_list_remove(&hci_stack->connections, (btstack_linked_item_t *) conn);
26090bbba85bSMatthias Ringwald     btstack_memory_hci_connection_free( conn );
26100bbba85bSMatthias Ringwald 
26116bc9fa5eSMatthias Ringwald #ifdef ENABLE_CLASSIC
26120bbba85bSMatthias Ringwald     // notify client if dedicated bonding
26130bbba85bSMatthias Ringwald     if (notify_dedicated_bonding_failed){
26140bbba85bSMatthias Ringwald         log_info("hci notify_dedicated_bonding_failed");
26150bbba85bSMatthias Ringwald         hci_emit_dedicated_bonding_result(bd_address, status);
26160bbba85bSMatthias Ringwald     }
26170bbba85bSMatthias Ringwald 
26180bbba85bSMatthias Ringwald     // if authentication error, also delete link key
26190bbba85bSMatthias Ringwald     if (status == ERROR_CODE_AUTHENTICATION_FAILURE) {
26200bbba85bSMatthias Ringwald         gap_drop_link_key_for_bd_addr(bd_address);
26210bbba85bSMatthias Ringwald     }
26221c79b5e3SMatthias Ringwald #else
26231c79b5e3SMatthias Ringwald     UNUSED(status);
26246bc9fa5eSMatthias Ringwald #endif
26250bbba85bSMatthias Ringwald }
26260bbba85bSMatthias Ringwald 
2627be500194SMatthias Ringwald #ifdef ENABLE_CLASSIC
26282f5c44baSMatthias Ringwald static void hci_handle_remote_features_page_0(hci_connection_t * conn, const uint8_t * features){
26292f5c44baSMatthias Ringwald     // SSP Controller
26302f5c44baSMatthias Ringwald     if (features[6] & (1 << 3)){
26312f5c44baSMatthias Ringwald         conn->bonding_flags |= BONDING_REMOTE_SUPPORTS_SSP_CONTROLLER;
26322f5c44baSMatthias Ringwald     }
26332f5c44baSMatthias Ringwald     // eSCO
26342f5c44baSMatthias Ringwald     if (features[3] & (1<<7)){
26352f5c44baSMatthias Ringwald         conn->remote_supported_features[0] |= 1;
26362f5c44baSMatthias Ringwald     }
26372f5c44baSMatthias Ringwald     // Extended features
26382f5c44baSMatthias Ringwald     if (features[7] & (1<<7)){
26392f5c44baSMatthias Ringwald         conn->remote_supported_features[0] |= 2;
26402f5c44baSMatthias Ringwald     }
26410b78a447SMatthias Ringwald     // SCO packet types
26420b78a447SMatthias Ringwald     conn->remote_supported_sco_packets = hci_sco_packet_types_for_features(features);
26432f5c44baSMatthias Ringwald }
26442f5c44baSMatthias Ringwald 
26452f5c44baSMatthias Ringwald static void hci_handle_remote_features_page_1(hci_connection_t * conn, const uint8_t * features){
26462f5c44baSMatthias Ringwald     // SSP Host
26472f5c44baSMatthias Ringwald     if (features[0] & (1 << 0)){
26482f5c44baSMatthias Ringwald         conn->bonding_flags |= BONDING_REMOTE_SUPPORTS_SSP_HOST;
26492f5c44baSMatthias Ringwald     }
265050c51a77SMatthias Ringwald     // SC Host
265150c51a77SMatthias Ringwald     if (features[0] & (1 << 3)){
265250c51a77SMatthias Ringwald         conn->bonding_flags |= BONDING_REMOTE_SUPPORTS_SC_HOST;
265350c51a77SMatthias Ringwald     }
265450c51a77SMatthias Ringwald }
265550c51a77SMatthias Ringwald 
265650c51a77SMatthias Ringwald static void hci_handle_remote_features_page_2(hci_connection_t * conn, const uint8_t * features){
265750c51a77SMatthias Ringwald     // SC Controller
265850c51a77SMatthias Ringwald     if (features[1] & (1 << 0)){
265950c51a77SMatthias Ringwald         conn->bonding_flags |= BONDING_REMOTE_SUPPORTS_SC_CONTROLLER;
266050c51a77SMatthias Ringwald     }
26612f5c44baSMatthias Ringwald }
26622f5c44baSMatthias Ringwald 
2663de0df013SMatthias Ringwald static void hci_handle_remote_features_received(hci_connection_t * conn){
2664461a2bc4SMatthias Ringwald     conn->bonding_flags &= ~BONDING_REMOTE_FEATURES_QUERY_ACTIVE;
2665de0df013SMatthias Ringwald     conn->bonding_flags |= BONDING_RECEIVED_REMOTE_FEATURES;
2666cb7b3e6fSMatthias Ringwald     log_info("Remote features %02x, bonding flags %" PRIx32, conn->remote_supported_features[0], conn->bonding_flags);
2667de0df013SMatthias Ringwald     if (conn->bonding_flags & BONDING_DEDICATED){
2668de0df013SMatthias Ringwald         conn->bonding_flags |= BONDING_SEND_AUTHENTICATE_REQUEST;
2669de0df013SMatthias Ringwald     }
2670de0df013SMatthias Ringwald }
2671128825c3SMatthias Ringwald static bool hci_remote_sc_enabled(hci_connection_t * connection){
2672128825c3SMatthias Ringwald     const uint16_t sc_enabled_mask = BONDING_REMOTE_SUPPORTS_SC_HOST | BONDING_REMOTE_SUPPORTS_SC_CONTROLLER;
2673128825c3SMatthias Ringwald     return (connection->bonding_flags & sc_enabled_mask) == sc_enabled_mask;
2674128825c3SMatthias Ringwald }
2675128825c3SMatthias Ringwald 
2676be500194SMatthias Ringwald #endif
2677de0df013SMatthias Ringwald 
267867c6c9dcSMatthias Ringwald static void handle_event_for_current_stack_state(const uint8_t * packet, uint16_t size) {
267967c6c9dcSMatthias Ringwald     // handle BT initialization
268067c6c9dcSMatthias Ringwald     if (hci_stack->state == HCI_STATE_INITIALIZING) {
268167c6c9dcSMatthias Ringwald         hci_initializing_event_handler(packet, size);
268267c6c9dcSMatthias Ringwald     }
268367c6c9dcSMatthias Ringwald 
268467c6c9dcSMatthias Ringwald     // help with BT sleep
268567c6c9dcSMatthias Ringwald     if ((hci_stack->state == HCI_STATE_FALLING_ASLEEP)
268667c6c9dcSMatthias Ringwald         && (hci_stack->substate == HCI_FALLING_ASLEEP_W4_WRITE_SCAN_ENABLE)
268772a2585aSMatthias Ringwald         && (hci_event_packet_get_type(packet) == HCI_EVENT_COMMAND_COMPLETE)
268872a2585aSMatthias Ringwald         && (hci_event_command_complete_get_command_opcode(packet) == HCI_OPCODE_HCI_WRITE_SCAN_ENABLE)){
268967c6c9dcSMatthias Ringwald         hci_initializing_next_state();
269067c6c9dcSMatthias Ringwald     }
269167c6c9dcSMatthias Ringwald }
269267c6c9dcSMatthias Ringwald 
26939866fdc7SMatthias Ringwald #ifdef ENABLE_CLASSIC
26944aa2f135SMatthias Ringwald static void hci_handle_mutual_authentication_completed(hci_connection_t * conn){
26954aa2f135SMatthias Ringwald     // bonding complete if connection is authenticated (either initiated or BR/EDR SC)
26964aa2f135SMatthias Ringwald     conn->requested_security_level = LEVEL_0;
26974aa2f135SMatthias Ringwald     gap_security_level_t security_level = gap_security_level_for_connection(conn);
26984aa2f135SMatthias Ringwald     hci_emit_security_level(conn->con_handle, security_level);
26994aa2f135SMatthias Ringwald 
270067718330SMatthias Ringwald     // dedicated bonding
2701de9f0299SMatthias Ringwald     if ((conn->bonding_flags & BONDING_DEDICATED) != 0){
2702de9f0299SMatthias Ringwald         conn->bonding_flags &= ~BONDING_DEDICATED;
2703de9f0299SMatthias Ringwald         conn->bonding_status = security_level == 0 ? ERROR_CODE_INSUFFICIENT_SECURITY : ERROR_CODE_SUCCESS;
2704db3c1f89SMatthias Ringwald #ifdef ENABLE_EXPLICIT_DEDICATED_BONDING_DISCONNECT
2705db3c1f89SMatthias Ringwald         // emit dedicated bonding complete, don't disconnect
2706db3c1f89SMatthias Ringwald         hci_emit_dedicated_bonding_result(conn->address, conn->bonding_status);
2707db3c1f89SMatthias Ringwald #else
2708db3c1f89SMatthias Ringwald         // request disconnect, event is emitted after disconnect
2709db3c1f89SMatthias Ringwald         conn->bonding_flags |= BONDING_DISCONNECT_DEDICATED_DONE;
2710db3c1f89SMatthias Ringwald #endif
2711de9f0299SMatthias Ringwald     }
271267718330SMatthias Ringwald }
2713abdad579SMatthias Ringwald 
271467718330SMatthias Ringwald static void hci_handle_read_encryption_key_size_complete(hci_connection_t * conn, uint8_t encryption_key_size) {
271567718330SMatthias Ringwald     conn->authentication_flags |= AUTH_FLAG_CONNECTION_ENCRYPTED;
271667718330SMatthias Ringwald     conn->encryption_key_size = encryption_key_size;
271767718330SMatthias Ringwald 
271867718330SMatthias Ringwald     // mutual authentication complete if authenticated and we have retrieved the encryption key size
27198daf94bcSMatthias Ringwald     if ((conn->authentication_flags & AUTH_FLAG_CONNECTION_AUTHENTICATED) != 0) {
27204aa2f135SMatthias Ringwald         hci_handle_mutual_authentication_completed(conn);
27214cd03f8aSMatthias Ringwald     } else {
27224cd03f8aSMatthias Ringwald         // otherwise trigger remote feature request and send authentication request
2723dbe0d85cSMatthias Ringwald         hci_trigger_remote_features_for_connection(conn);
27244cd03f8aSMatthias Ringwald         if ((conn->bonding_flags & BONDING_SENT_AUTHENTICATE_REQUEST) == 0) {
2725abdad579SMatthias Ringwald             conn->bonding_flags |= BONDING_SEND_AUTHENTICATE_REQUEST;
27269866fdc7SMatthias Ringwald         }
27274cd03f8aSMatthias Ringwald     }
27284cd03f8aSMatthias Ringwald }
27299866fdc7SMatthias Ringwald #endif
27309866fdc7SMatthias Ringwald 
27313b631737SMatthias Ringwald static void hci_store_local_supported_commands(const uint8_t * packet){
273225e46151SMatthias Ringwald     // create mapping table
273325e46151SMatthias Ringwald #define X(name, offset, bit) { offset, bit },
273425e46151SMatthias Ringwald     static struct {
273525e46151SMatthias Ringwald         uint8_t byte_offset;
273625e46151SMatthias Ringwald         uint8_t bit_position;
273725e46151SMatthias Ringwald     } supported_hci_commands_map [] = {
273825e46151SMatthias Ringwald         SUPPORTED_HCI_COMMANDS
273925e46151SMatthias Ringwald     };
274025e46151SMatthias Ringwald #undef X
274125e46151SMatthias Ringwald 
274225e46151SMatthias Ringwald     // create names for debug purposes
274325e46151SMatthias Ringwald #ifdef ENABLE_LOG_DEBUG
274425e46151SMatthias Ringwald #define X(name, offset, bit) #name,
274525e46151SMatthias Ringwald     static const char * command_names[] = {
274625e46151SMatthias Ringwald         SUPPORTED_HCI_COMMANDS
274725e46151SMatthias Ringwald     };
274825e46151SMatthias Ringwald #undef X
274925e46151SMatthias Ringwald #endif
275025e46151SMatthias Ringwald 
27511ffa425cSMatthias Ringwald     hci_stack->local_supported_commands = 0;
275225e46151SMatthias Ringwald     const uint8_t * commands_map = &packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1];
275325e46151SMatthias Ringwald     uint16_t i;
275425e46151SMatthias Ringwald     for (i = 0 ; i < SUPPORTED_HCI_COMMANDS_COUNT ; i++){
275525e46151SMatthias Ringwald         if ((commands_map[supported_hci_commands_map[i].byte_offset] & (1 << supported_hci_commands_map[i].bit_position)) != 0){
275625e46151SMatthias Ringwald #ifdef ENABLE_LOG_DEBUG
275725e46151SMatthias Ringwald             log_info("Command %s (%u) supported %u/%u", command_names[i], i, supported_hci_commands_map[i].byte_offset, supported_hci_commands_map[i].bit_position);
275825e46151SMatthias Ringwald #else
27591ffa425cSMatthias Ringwald             log_info("Command 0x%02x supported %u/%u", i, supported_hci_commands_map[i].byte_offset, supported_hci_commands_map[i].bit_position);
276025e46151SMatthias Ringwald #endif
27611ffa425cSMatthias Ringwald             hci_stack->local_supported_commands |= (1LU << i);
276225e46151SMatthias Ringwald         }
276325e46151SMatthias Ringwald     }
2764cb7b3e6fSMatthias Ringwald     log_info("Local supported commands summary %08" PRIx32, hci_stack->local_supported_commands);
27653b631737SMatthias Ringwald }
27663b631737SMatthias Ringwald 
27674f781026SMatthias Ringwald static void handle_command_complete_event(uint8_t * packet, uint16_t size){
2768b08371a9SMilanka Ringwald     UNUSED(size);
2769e76a89eeS[email protected] 
27704781fa78SDirk Helbig     uint8_t status = 0;
27714781fa78SDirk Helbig     if( size > OFFSET_OF_DATA_IN_COMMAND_COMPLETE ) {
27724781fa78SDirk Helbig         status = hci_event_command_complete_get_return_parameters(packet)[0];
27734781fa78SDirk Helbig     }
27749cbd2215SMatthias Ringwald     uint16_t manufacturer;
27759cbd2215SMatthias Ringwald #ifdef ENABLE_CLASSIC
27761f7b95a1Smatthias.ringwald     hci_connection_t * conn;
2777c7a108afSMatthias Ringwald #endif
2778c7a108afSMatthias Ringwald #if defined(ENABLE_CLASSIC) || (defined(ENABLE_BLE) && defined(ENABLE_LE_ISOCHRONOUS_STREAMS))
27794781fa78SDirk Helbig     hci_con_handle_t handle;
27809cbd2215SMatthias Ringwald #endif
2781d3a89d91SMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
2782d3a89d91SMatthias Ringwald     le_audio_cig_t * cig;
2783d3a89d91SMatthias Ringwald #endif
278491036612SMatthias Ringwald #if defined(ENABLE_BLE) && defined(ENABLE_HCI_COMMAND_STATUS_DISCARDED_FOR_FAILED_CONNECTIONS_WORKAROUND)
2785f48a5586SMatthias Ringwald     hci_stack->hci_command_con_handle = HCI_CON_HANDLE_INVALID;
2786f48a5586SMatthias Ringwald #endif
2787d3a89d91SMatthias Ringwald 
27886bef4003SMatthias Ringwald     // get num cmd packets - limit to 1 to reduce complexity
27896bef4003SMatthias Ringwald     hci_stack->num_cmd_packets = packet[2] ? 1 : 0;
27907ec5eeaaSmatthias.ringwald 
2791645b7c25SMatthias Ringwald     uint16_t opcode = hci_event_command_complete_get_command_opcode(packet);
2792645b7c25SMatthias Ringwald     switch (opcode){
2793645b7c25SMatthias Ringwald         case HCI_OPCODE_HCI_READ_LOCAL_NAME:
27944781fa78SDirk Helbig             if (status) break;
27959e263bd7SMatthias Ringwald             // terminate, name 248 chars
27969e263bd7SMatthias Ringwald             packet[6+248] = 0;
27979e263bd7SMatthias Ringwald             log_info("local name: %s", &packet[6]);
2798645b7c25SMatthias Ringwald             break;
2799645b7c25SMatthias Ringwald         case HCI_OPCODE_HCI_READ_BUFFER_SIZE:
28001d279b20Smatthias.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"
2801c3b46f5aSMatthias Ringwald             if (hci_stack->state == HCI_STATE_INITIALIZING) {
2802429122ccSMatthias Ringwald                 uint16_t acl_len = little_endian_read_16(packet, 6);
2803429122ccSMatthias Ringwald                 uint16_t sco_len = packet[8];
2804429122ccSMatthias Ringwald 
2805429122ccSMatthias Ringwald                 // determine usable ACL/SCO payload size
2806429122ccSMatthias Ringwald                 hci_stack->acl_data_packet_length = btstack_min(acl_len, HCI_ACL_PAYLOAD_SIZE);
2807429122ccSMatthias Ringwald                 hci_stack->sco_data_packet_length = btstack_min(sco_len, HCI_ACL_PAYLOAD_SIZE);
2808429122ccSMatthias Ringwald 
2809616cfd90SMatthias Ringwald                 hci_stack->acl_packets_total_num = (uint8_t) btstack_min(little_endian_read_16(packet,  9), MAX_NR_CONTROLLER_ACL_BUFFERS);
2810616cfd90SMatthias Ringwald                 hci_stack->sco_packets_total_num = (uint8_t) btstack_min(little_endian_read_16(packet, 11), MAX_NR_CONTROLLER_SCO_PACKETS);
2811a8b12447S[email protected] 
2812429122ccSMatthias Ringwald                 log_info("hci_read_buffer_size: ACL size module %u -> used %u, count %u / SCO size %u, count %u",
2813429122ccSMatthias Ringwald                          acl_len, hci_stack->acl_data_packet_length, hci_stack->acl_packets_total_num,
28141a06f663S[email protected]                          hci_stack->sco_data_packet_length, hci_stack->sco_packets_total_num);
2815c3b46f5aSMatthias Ringwald             }
2816645b7c25SMatthias Ringwald             break;
2817645b7c25SMatthias Ringwald         case HCI_OPCODE_HCI_READ_RSSI:
28184781fa78SDirk Helbig             if (status == ERROR_CODE_SUCCESS){
2819891b9fc2SMatthias Ringwald                 uint8_t event[5];
2820891b9fc2SMatthias Ringwald                 event[0] = GAP_EVENT_RSSI_MEASUREMENT;
2821891b9fc2SMatthias Ringwald                 event[1] = 3;
28226535961aSMatthias Ringwald                 (void)memcpy(&event[2], &packet[6], 3);
2823891b9fc2SMatthias Ringwald                 hci_emit_event(event, sizeof(event), 1);
2824891b9fc2SMatthias Ringwald             }
2825645b7c25SMatthias Ringwald             break;
2826a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE
282779b7ea2dSMatthias Ringwald         case HCI_OPCODE_HCI_LE_READ_BUFFER_SIZE_V2:
282879b7ea2dSMatthias Ringwald             hci_stack->le_iso_packets_length = little_endian_read_16(packet, 9);
282979b7ea2dSMatthias Ringwald             hci_stack->le_iso_packets_total_num = packet[11];
283079b7ea2dSMatthias Ringwald             log_info("hci_le_read_buffer_size_v2: iso size %u, iso count %u",
283179b7ea2dSMatthias Ringwald                      hci_stack->le_iso_packets_length, hci_stack->le_iso_packets_total_num);
283279b7ea2dSMatthias Ringwald 
283379b7ea2dSMatthias Ringwald             /* fall through */
283479b7ea2dSMatthias Ringwald 
2835645b7c25SMatthias Ringwald         case HCI_OPCODE_HCI_LE_READ_BUFFER_SIZE:
2836f8fbdce0SMatthias Ringwald             hci_stack->le_data_packets_length = little_endian_read_16(packet, 6);
2837ee303eddS[email protected]             hci_stack->le_acl_packets_total_num = packet[8];
28386c26b087S[email protected]             // determine usable ACL payload size
28396c26b087S[email protected]             if (HCI_ACL_PAYLOAD_SIZE < hci_stack->le_data_packets_length){
28406c26b087S[email protected]                 hci_stack->le_data_packets_length = HCI_ACL_PAYLOAD_SIZE;
28416c26b087S[email protected]             }
284279b7ea2dSMatthias 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);
2843645b7c25SMatthias Ringwald             break;
2844b435e062SMatthias Ringwald #endif
2845b435e062SMatthias Ringwald #ifdef ENABLE_LE_DATA_LENGTH_EXTENSION
2846645b7c25SMatthias Ringwald         case HCI_OPCODE_HCI_LE_READ_MAXIMUM_DATA_LENGTH:
2847dcd678baSMatthias Ringwald             hci_stack->le_supported_max_tx_octets = little_endian_read_16(packet, 6);
2848dcd678baSMatthias Ringwald             hci_stack->le_supported_max_tx_time = little_endian_read_16(packet, 8);
2849dcd678baSMatthias 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);
2850645b7c25SMatthias Ringwald             break;
2851b435e062SMatthias Ringwald #endif
2852d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
2853645b7c25SMatthias Ringwald         case HCI_OPCODE_HCI_LE_READ_WHITE_LIST_SIZE:
2854e691bb38SMatthias Ringwald             hci_stack->le_whitelist_capacity = packet[6];
285515d0a15bSMatthias Ringwald             log_info("hci_le_read_white_list_size: size %u", hci_stack->le_whitelist_capacity);
2856645b7c25SMatthias Ringwald             break;
285765a46ef3S[email protected] #endif
28583a74541eSMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
28593a74541eSMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
28603a74541eSMatthias Ringwald         case HCI_OPCODE_HCI_LE_READ_MAXIMUM_ADVERTISING_DATA_LENGTH:
28613a74541eSMatthias Ringwald             hci_stack->le_maximum_advertising_data_length = little_endian_read_16(packet, 6);
28623a74541eSMatthias Ringwald             break;
286325df6c61SMatthias Ringwald         case HCI_OPCODE_HCI_LE_SET_EXTENDED_ADVERTISING_PARAMETERS:
286425df6c61SMatthias Ringwald             if (hci_stack->le_advertising_set_in_current_command != 0) {
286525df6c61SMatthias Ringwald                 le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(hci_stack->le_advertising_set_in_current_command);
286625df6c61SMatthias Ringwald                 hci_stack->le_advertising_set_in_current_command = 0;
286725df6c61SMatthias Ringwald                 if (advertising_set == NULL) break;
286825df6c61SMatthias Ringwald                 uint8_t adv_status = packet[6];
286925df6c61SMatthias Ringwald                 uint8_t tx_power   = packet[7];
287025df6c61SMatthias 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 };
287125df6c61SMatthias Ringwald                 if (adv_status == 0){
287225df6c61SMatthias Ringwald                     advertising_set->state |= LE_ADVERTISEMENT_STATE_PARAMS_SET;
287325df6c61SMatthias Ringwald                 }
287425df6c61SMatthias Ringwald                 hci_emit_event(event, sizeof(event), 1);
287525df6c61SMatthias Ringwald             }
287625df6c61SMatthias Ringwald             break;
287725df6c61SMatthias Ringwald         case HCI_OPCODE_HCI_LE_REMOVE_ADVERTISING_SET:
287825df6c61SMatthias Ringwald             if (hci_stack->le_advertising_set_in_current_command != 0) {
287925df6c61SMatthias Ringwald                 le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(hci_stack->le_advertising_set_in_current_command);
288025df6c61SMatthias Ringwald                 hci_stack->le_advertising_set_in_current_command = 0;
288125df6c61SMatthias Ringwald                 if (advertising_set == NULL) break;
28824781fa78SDirk Helbig                 uint8_t event[] = { HCI_EVENT_META_GAP, 3, GAP_SUBEVENT_ADVERTISING_SET_REMOVED, hci_stack->le_advertising_set_in_current_command, status };
28834781fa78SDirk Helbig                 if (status == 0){
288425df6c61SMatthias Ringwald                     btstack_linked_list_remove(&hci_stack->le_advertising_sets, (btstack_linked_item_t *) advertising_set);
288525df6c61SMatthias Ringwald                 }
288625df6c61SMatthias Ringwald                 hci_emit_event(event, sizeof(event), 1);
288725df6c61SMatthias Ringwald             }
288825df6c61SMatthias Ringwald             break;
28893a74541eSMatthias Ringwald #endif
28903a74541eSMatthias Ringwald #endif
2891645b7c25SMatthias Ringwald         case HCI_OPCODE_HCI_READ_BD_ADDR:
2892645b7c25SMatthias Ringwald             reverse_bd_addr(&packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE + 1], hci_stack->local_bd_addr);
28934781fa78SDirk Helbig             log_info("Local Address, Status: 0x%02x: Addr: %s", status, bd_addr_to_str(hci_stack->local_bd_addr));
289433373e40SMatthias Ringwald #ifdef ENABLE_CLASSIC
28951624665aSMatthias Ringwald             if (hci_stack->link_key_db){
28961624665aSMatthias Ringwald                 hci_stack->link_key_db->set_local_bd_addr(hci_stack->local_bd_addr);
28971624665aSMatthias Ringwald             }
289833373e40SMatthias Ringwald #endif
2899645b7c25SMatthias Ringwald             break;
290035454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
2901645b7c25SMatthias Ringwald         case HCI_OPCODE_HCI_WRITE_SCAN_ENABLE:
290271fd255dSMatthias Ringwald             hci_emit_scan_mode_changed(hci_stack->discoverable, hci_stack->connectable);
2903645b7c25SMatthias Ringwald             break;
29043d1f2d24SMatthias Ringwald         case HCI_OPCODE_HCI_PERIODIC_INQUIRY_MODE:
29053d1f2d24SMatthias Ringwald             if (status == ERROR_CODE_SUCCESS) {
29063d1f2d24SMatthias Ringwald                 hci_stack->inquiry_state = GAP_INQUIRY_STATE_PERIODIC;
29073d1f2d24SMatthias Ringwald             } else {
29083d1f2d24SMatthias Ringwald                 hci_stack->inquiry_state = GAP_INQUIRY_STATE_IDLE;
29093d1f2d24SMatthias Ringwald             }
29103d1f2d24SMatthias Ringwald             break;
2911645b7c25SMatthias Ringwald         case HCI_OPCODE_HCI_INQUIRY_CANCEL:
291230199e24SMatthias Ringwald         case HCI_OPCODE_HCI_EXIT_PERIODIC_INQUIRY_MODE:
2913f5875de5SMatthias Ringwald             if (hci_stack->inquiry_state == GAP_INQUIRY_STATE_W4_CANCELLED){
2914f5875de5SMatthias Ringwald                 hci_stack->inquiry_state = GAP_INQUIRY_STATE_IDLE;
2915f5875de5SMatthias Ringwald                 uint8_t event[] = { GAP_EVENT_INQUIRY_COMPLETE, 1, 0};
2916f5875de5SMatthias Ringwald                 hci_emit_event(event, sizeof(event), 1);
2917f5875de5SMatthias Ringwald             }
2918645b7c25SMatthias Ringwald             break;
291935454696SMatthias Ringwald #endif
2920645b7c25SMatthias Ringwald         case HCI_OPCODE_HCI_READ_LOCAL_SUPPORTED_FEATURES:
29214f781026SMatthias Ringwald             (void)memcpy(hci_stack->local_supported_features, &packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE + 1], 8);
292265389bfcS[email protected] 
292335454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
2924a5a23fc2S[email protected]             // determine usable ACL packet types based on host buffer size and supported features
292529e39de4SMatthias 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]);
2926c92ca2c8SMatthias Ringwald             log_info("ACL Packet types %04x", hci_stack->usable_packet_types_acl);
2927c92ca2c8SMatthias Ringwald             // determine usable SCO packet types based on supported features
2928c92ca2c8SMatthias Ringwald             hci_stack->usable_packet_types_sco = hci_sco_packet_types_for_features(
2929c92ca2c8SMatthias Ringwald                     &hci_stack->local_supported_features[0]);
2930c92ca2c8SMatthias Ringwald             log_info("SCO Packet types %04x - eSCO %u", hci_stack->usable_packet_types_sco, hci_extended_sco_link_supported());
293135454696SMatthias Ringwald #endif
2932f5d8d141S[email protected]             // Classic/LE
2933f5d8d141S[email protected]             log_info("BR/EDR support %u, LE support %u", hci_classic_supported(), hci_le_supported());
2934645b7c25SMatthias Ringwald             break;
2935645b7c25SMatthias Ringwald         case HCI_OPCODE_HCI_READ_LOCAL_VERSION_INFORMATION:
2936645b7c25SMatthias Ringwald             manufacturer = little_endian_read_16(packet, 10);
2937547a29a6SMatthias Ringwald             // map Cypress & Infineon to Broadcom
2938547a29a6SMatthias Ringwald             switch (manufacturer){
2939547a29a6SMatthias Ringwald                 case BLUETOOTH_COMPANY_ID_CYPRESS_SEMICONDUCTOR:
2940547a29a6SMatthias Ringwald                 case BLUETOOTH_COMPANY_ID_INFINEON_TECHNOLOGIES_AG:
2941547a29a6SMatthias Ringwald                     log_info("Treat Cypress/Infineon as Broadcom");
2942c21d89f3SMatthias Ringwald                     manufacturer = BLUETOOTH_COMPANY_ID_BROADCOM_CORPORATION;
2943c21d89f3SMatthias Ringwald                     little_endian_store_16(packet, 10, manufacturer);
2944547a29a6SMatthias Ringwald                     break;
2945547a29a6SMatthias Ringwald                 default:
2946547a29a6SMatthias Ringwald                     break;
2947c21d89f3SMatthias Ringwald             }
2948c21d89f3SMatthias Ringwald             hci_stack->manufacturer = manufacturer;
29494696bddbSMatthias Ringwald             log_info("Manufacturer: 0x%04x", hci_stack->manufacturer);
2950645b7c25SMatthias Ringwald             break;
2951645b7c25SMatthias Ringwald         case HCI_OPCODE_HCI_READ_LOCAL_SUPPORTED_COMMANDS:
29523b631737SMatthias Ringwald             hci_store_local_supported_commands(packet);
2953645b7c25SMatthias Ringwald             break;
2954e8c8828eSMatthias Ringwald #ifdef ENABLE_CLASSIC
2955645b7c25SMatthias Ringwald         case HCI_OPCODE_HCI_WRITE_SYNCHRONOUS_FLOW_CONTROL_ENABLE:
29564781fa78SDirk Helbig             if (status) return;
29575b9b590fSMatthias Ringwald             hci_stack->synchronous_flow_control_enabled = 1;
2958645b7c25SMatthias Ringwald             break;
2959645b7c25SMatthias Ringwald         case HCI_OPCODE_HCI_READ_ENCRYPTION_KEY_SIZE:
2960573897a0SMatthias Ringwald             handle = little_endian_read_16(packet, OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1);
2961573897a0SMatthias Ringwald             conn   = hci_connection_for_handle(handle);
2962c3b46f5aSMatthias Ringwald             if (conn != NULL) {
29639866fdc7SMatthias Ringwald                 uint8_t key_size = 0;
2964573897a0SMatthias Ringwald                 if (status == 0){
29659866fdc7SMatthias Ringwald                     key_size = packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+3];
29664a659b0eSMatthias Ringwald                     log_info("Handle %04x key Size: %u", handle, key_size);
2967170fafaeSMatthias Ringwald                 } else {
2968e9f98c4aSMatthias Ringwald                     key_size = 1;
29699866fdc7SMatthias Ringwald                     log_info("Read Encryption Key Size failed 0x%02x-> assuming insecure connection with key size of 1", status);
2970573897a0SMatthias Ringwald                 }
29719866fdc7SMatthias Ringwald                 hci_handle_read_encryption_key_size_complete(conn, key_size);
2972c3b46f5aSMatthias Ringwald             }
2973645b7c25SMatthias Ringwald             break;
2974cc15bb2cSMatthias Ringwald         // assert pairing complete event is emitted.
2975cc15bb2cSMatthias Ringwald         // note: for SSP, Simple Pairing Complete Event is sufficient, but we want to be more robust
2976cc15bb2cSMatthias Ringwald         case HCI_OPCODE_HCI_PIN_CODE_REQUEST_NEGATIVE_REPLY:
2977cc15bb2cSMatthias Ringwald         case HCI_OPCODE_HCI_USER_PASSKEY_REQUEST_NEGATIVE_REPLY:
2978cc15bb2cSMatthias Ringwald         case HCI_OPCODE_HCI_USER_CONFIRMATION_REQUEST_NEGATIVE_REPLY:
29798cc1507eSMatthias Ringwald             hci_stack->gap_pairing_state = GAP_PAIRING_STATE_IDLE;
2980cc15bb2cSMatthias Ringwald             // lookup connection by gap pairing addr
2981cc15bb2cSMatthias Ringwald             conn = hci_connection_for_bd_addr_and_type(hci_stack->gap_pairing_addr, BD_ADDR_TYPE_ACL);
2982cc15bb2cSMatthias Ringwald             if (conn == NULL) break;
2983cc15bb2cSMatthias Ringwald             hci_pairing_complete(conn, ERROR_CODE_AUTHENTICATION_FAILURE);
2984cc15bb2cSMatthias Ringwald             break;
2985cc15bb2cSMatthias Ringwald 
298675a8e4faSMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB
298775a8e4faSMatthias Ringwald         case HCI_OPCODE_HCI_READ_LOCAL_OOB_DATA:
298875a8e4faSMatthias Ringwald         case HCI_OPCODE_HCI_READ_LOCAL_EXTENDED_OOB_DATA:{
298975a8e4faSMatthias Ringwald             uint8_t event[67];
299075a8e4faSMatthias Ringwald             event[0] = GAP_EVENT_LOCAL_OOB_DATA;
299175a8e4faSMatthias Ringwald             event[1] = 65;
299275a8e4faSMatthias Ringwald             (void)memset(&event[2], 0, 65);
29934781fa78SDirk Helbig             if (status == ERROR_CODE_SUCCESS){
299475a8e4faSMatthias Ringwald                 (void)memcpy(&event[3], &packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1], 32);
299575a8e4faSMatthias Ringwald                 if (opcode == HCI_OPCODE_HCI_READ_LOCAL_EXTENDED_OOB_DATA){
299675a8e4faSMatthias Ringwald                     event[2] = 3;
299775a8e4faSMatthias Ringwald                     (void)memcpy(&event[35], &packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+33], 32);
299875a8e4faSMatthias Ringwald                 } else {
299975a8e4faSMatthias Ringwald                     event[2] = 1;
300075a8e4faSMatthias Ringwald                 }
300175a8e4faSMatthias Ringwald             }
300275a8e4faSMatthias Ringwald             hci_emit_event(event, sizeof(event), 0);
300375a8e4faSMatthias Ringwald             break;
300475a8e4faSMatthias Ringwald         }
30051ae74bf3SMatthias Ringwald 
30061ae74bf3SMatthias Ringwald         // note: only needed if user does not provide OOB data
30071ae74bf3SMatthias Ringwald         case HCI_OPCODE_HCI_REMOTE_OOB_DATA_REQUEST_NEGATIVE_REPLY:
30081ae74bf3SMatthias Ringwald             conn = hci_connection_for_handle(hci_stack->classic_oob_con_handle);
30091ae74bf3SMatthias Ringwald             hci_stack->classic_oob_con_handle = HCI_CON_HANDLE_INVALID;
30101ae74bf3SMatthias Ringwald             if (conn == NULL) break;
30111ae74bf3SMatthias Ringwald             hci_pairing_complete(conn, ERROR_CODE_AUTHENTICATION_FAILURE);
30121ae74bf3SMatthias Ringwald             break;
3013e8c8828eSMatthias Ringwald #endif
301475a8e4faSMatthias Ringwald #endif
30154ae8623eSMatthias Ringwald #ifdef ENABLE_BLE
30164ae8623eSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
3017d3a89d91SMatthias Ringwald         case HCI_OPCODE_HCI_LE_SET_CIG_PARAMETERS:
3018d3a89d91SMatthias Ringwald             // lookup CIG
3019d3a89d91SMatthias Ringwald             cig = hci_cig_for_id(hci_stack->iso_active_operation_group_id);
3020d3a89d91SMatthias Ringwald             if (cig != NULL){
3021d3a89d91SMatthias Ringwald                 uint8_t i = 0;
3022d3a89d91SMatthias Ringwald                 if (status == ERROR_CODE_SUCCESS){
3023d3a89d91SMatthias Ringwald                     // assign CIS handles to pre-allocated CIS
3024d3a89d91SMatthias Ringwald                     btstack_linked_list_iterator_t it;
3025d3a89d91SMatthias Ringwald                     btstack_linked_list_iterator_init(&it, &hci_stack->iso_streams);
3026d3a89d91SMatthias Ringwald                     while (btstack_linked_list_iterator_has_next(&it) && (i < cig->num_cis)) {
3027d3a89d91SMatthias Ringwald                         hci_iso_stream_t *iso_stream = (hci_iso_stream_t *) btstack_linked_list_iterator_next(&it);
3028d3a89d91SMatthias Ringwald                         if ((iso_stream->group_id == hci_stack->iso_active_operation_group_id) &&
3029d3a89d91SMatthias Ringwald                             (iso_stream->iso_type == HCI_ISO_TYPE_CIS)){
3030d3a89d91SMatthias Ringwald                             hci_con_handle_t cis_handle = little_endian_read_16(packet, OFFSET_OF_DATA_IN_COMMAND_COMPLETE+3+(2*i));
3031969d876aSMatthias Ringwald                             iso_stream->cis_handle  = cis_handle;
3032d3a89d91SMatthias Ringwald                             cig->cis_con_handles[i] = cis_handle;
3033d3a89d91SMatthias Ringwald                             i++;
3034d3a89d91SMatthias Ringwald                         }
3035d3a89d91SMatthias Ringwald                     }
3036444e371eSMatthias Ringwald                     cig->state = LE_AUDIO_CIG_STATE_W4_CIS_REQUEST;
3037d3a89d91SMatthias Ringwald                     hci_emit_cig_created(cig, status);
3038d3a89d91SMatthias Ringwald                 } else {
3039d3a89d91SMatthias Ringwald                     hci_emit_cig_created(cig, status);
3040d3a89d91SMatthias Ringwald                     btstack_linked_list_remove(&hci_stack->le_audio_cigs, (btstack_linked_item_t *) cig);
3041d3a89d91SMatthias Ringwald                 }
3042d3a89d91SMatthias Ringwald             }
304326b93350SMatthias Ringwald             hci_stack->iso_active_operation_type = HCI_ISO_TYPE_INVALID;
3044d3a89d91SMatthias Ringwald             break;
30454ae8623eSMatthias Ringwald         case HCI_OPCODE_HCI_LE_CREATE_CIS:
30464ae8623eSMatthias Ringwald             if (status != ERROR_CODE_SUCCESS){
3047d75a6bbfSMatthias Ringwald                 hci_iso_stream_requested_finalize(HCI_ISO_GROUP_ID_INVALID);
30484ae8623eSMatthias Ringwald             }
30494ae8623eSMatthias Ringwald             break;
305042529435SMatthias Ringwald         case HCI_OPCODE_HCI_LE_ACCEPT_CIS_REQUEST:
305142529435SMatthias Ringwald             if (status != ERROR_CODE_SUCCESS){
3052d75a6bbfSMatthias Ringwald                 hci_iso_stream_requested_finalize(HCI_ISO_GROUP_ID_INVALID);
305342529435SMatthias Ringwald             }
305442529435SMatthias Ringwald             break;
30557aa35f6aSMatthias Ringwald         case HCI_OPCODE_HCI_LE_SETUP_ISO_DATA_PATH: {
30567aa35f6aSMatthias Ringwald             // lookup BIG by state
30577aa35f6aSMatthias Ringwald             btstack_linked_list_iterator_t it;
30587aa35f6aSMatthias Ringwald             btstack_linked_list_iterator_init(&it, &hci_stack->le_audio_bigs);
30597aa35f6aSMatthias Ringwald             while (btstack_linked_list_iterator_has_next(&it)) {
30607aa35f6aSMatthias Ringwald                 le_audio_big_t *big = (le_audio_big_t *) btstack_linked_list_iterator_next(&it);
30617aa35f6aSMatthias Ringwald                 if (big->state == LE_AUDIO_BIG_STATE_W4_SETUP_ISO_PATH){
30627aa35f6aSMatthias Ringwald                     if (status == ERROR_CODE_SUCCESS){
30637aa35f6aSMatthias Ringwald                         big->state_vars.next_bis++;
30647aa35f6aSMatthias Ringwald                         if (big->state_vars.next_bis == big->num_bis){
30657aa35f6aSMatthias Ringwald                             big->state = LE_AUDIO_BIG_STATE_ACTIVE;
30667aa35f6aSMatthias Ringwald                             hci_emit_big_created(big, ERROR_CODE_SUCCESS);
30677aa35f6aSMatthias Ringwald                         } else {
30687aa35f6aSMatthias Ringwald                             big->state = LE_AUDIO_BIG_STATE_SETUP_ISO_PATH;
30697aa35f6aSMatthias Ringwald                         }
30707aa35f6aSMatthias Ringwald                     } else {
30717aa35f6aSMatthias Ringwald                         big->state = LE_AUDIO_BIG_STATE_SETUP_ISO_PATHS_FAILED;
30727aa35f6aSMatthias Ringwald                         big->state_vars.status = status;
30732a6c0f82SMatthias Ringwald                     }
30742a6c0f82SMatthias Ringwald                     return;
30752a6c0f82SMatthias Ringwald                 }
30762a6c0f82SMatthias Ringwald             }
30772a6c0f82SMatthias Ringwald             btstack_linked_list_iterator_init(&it, &hci_stack->le_audio_big_syncs);
30782a6c0f82SMatthias Ringwald             while (btstack_linked_list_iterator_has_next(&it)) {
30792a6c0f82SMatthias Ringwald                 le_audio_big_sync_t *big_sync = (le_audio_big_sync_t *) btstack_linked_list_iterator_next(&it);
30802a6c0f82SMatthias Ringwald                 if (big_sync->state == LE_AUDIO_BIG_STATE_W4_SETUP_ISO_PATH){
30812a6c0f82SMatthias Ringwald                     if (status == ERROR_CODE_SUCCESS){
30822a6c0f82SMatthias Ringwald                         big_sync->state_vars.next_bis++;
30832a6c0f82SMatthias Ringwald                         if (big_sync->state_vars.next_bis == big_sync->num_bis){
30842a6c0f82SMatthias Ringwald                             big_sync->state = LE_AUDIO_BIG_STATE_ACTIVE;
30852a6c0f82SMatthias Ringwald                             hci_emit_big_sync_created(big_sync, ERROR_CODE_SUCCESS);
30862a6c0f82SMatthias Ringwald                         } else {
30872a6c0f82SMatthias Ringwald                             big_sync->state = LE_AUDIO_BIG_STATE_SETUP_ISO_PATH;
30882a6c0f82SMatthias Ringwald                         }
30892a6c0f82SMatthias Ringwald                     } else {
30902a6c0f82SMatthias Ringwald                         big_sync->state = LE_AUDIO_BIG_STATE_SETUP_ISO_PATHS_FAILED;
30912a6c0f82SMatthias Ringwald                         big_sync->state_vars.status = status;
30922a6c0f82SMatthias Ringwald                     }
30932a6c0f82SMatthias Ringwald                     return;
30942a6c0f82SMatthias Ringwald                 }
30952a6c0f82SMatthias Ringwald             }
3096f9306a1aSMatthias Ringwald             // Lookup CIS via active group operation
3097f9306a1aSMatthias Ringwald             if (hci_stack->iso_active_operation_type == HCI_ISO_TYPE_CIS){
309826b93350SMatthias Ringwald                 if (hci_stack->iso_active_operation_group_id == HCI_ISO_GROUP_ID_SINGLE_CIS){
309926b93350SMatthias Ringwald                     hci_stack->iso_active_operation_type = HCI_ISO_TYPE_INVALID;
310026b93350SMatthias Ringwald 
310126b93350SMatthias Ringwald                     // lookup CIS by state
310226b93350SMatthias Ringwald                     btstack_linked_list_iterator_init(&it, &hci_stack->iso_streams);
310326b93350SMatthias Ringwald                     while (btstack_linked_list_iterator_has_next(&it)){
310426b93350SMatthias Ringwald                         hci_iso_stream_t * iso_stream = (hci_iso_stream_t *) btstack_linked_list_iterator_next(&it);
3105969d876aSMatthias Ringwald                         handle = iso_stream->cis_handle;
3106532211feSMatthias Ringwald                         bool emit_cis_created = false;
310726b93350SMatthias Ringwald                         switch (iso_stream->state){
310826b93350SMatthias Ringwald                             case HCI_ISO_STREAM_STATE_W4_ISO_SETUP_INPUT:
310926b93350SMatthias Ringwald                                 if (status != ERROR_CODE_SUCCESS){
3110532211feSMatthias Ringwald                                     emit_cis_created = true;
311126b93350SMatthias Ringwald                                     break;
311226b93350SMatthias Ringwald                                 }
311326b93350SMatthias Ringwald                                 if (iso_stream->max_sdu_c_to_p > 0){
31141418332dSMatthias Ringwald                                     iso_stream->state = HCI_ISO_STREAM_STATE_W2_SETUP_ISO_OUTPUT;
311526b93350SMatthias Ringwald                                 } else {
3116532211feSMatthias Ringwald                                     emit_cis_created = true;
311726b93350SMatthias Ringwald                                 }
311826b93350SMatthias Ringwald                                 break;
311926b93350SMatthias Ringwald                             case HCI_ISO_STREAM_STATE_W4_ISO_SETUP_OUTPUT:
3120532211feSMatthias Ringwald                                 emit_cis_created = true;
312126b93350SMatthias Ringwald                                 break;
312226b93350SMatthias Ringwald                             default:
312326b93350SMatthias Ringwald                                 break;
312426b93350SMatthias Ringwald                         }
3125532211feSMatthias Ringwald                         if (emit_cis_created){
312614045fdbSMatthias Ringwald                             hci_cis_handle_created(iso_stream, status);
3127532211feSMatthias Ringwald                         }
312826b93350SMatthias Ringwald                     }
312926b93350SMatthias Ringwald                 } else {
3130f9306a1aSMatthias Ringwald                     cig = hci_cig_for_id(hci_stack->iso_active_operation_group_id);
3131532211feSMatthias Ringwald                     hci_stack->iso_active_operation_type = HCI_ISO_TYPE_INVALID;
3132f9306a1aSMatthias Ringwald                     if (cig != NULL) {
3133f9306a1aSMatthias Ringwald                         // emit cis created if all ISO Paths have been created
3134f9306a1aSMatthias Ringwald                         // assume we are central
3135f9306a1aSMatthias Ringwald                         uint8_t cis_index     = cig->state_vars.next_cis >> 1;
3136f9306a1aSMatthias Ringwald                         uint8_t cis_direction = cig->state_vars.next_cis & 1;
3137f9306a1aSMatthias Ringwald                         bool outgoing_needed  = cig->params->cis_params[cis_index].max_sdu_p_to_c > 0;
3138f9306a1aSMatthias Ringwald                         // if outgoing has been setup, or incoming was setup but outgoing not required
3139f9306a1aSMatthias Ringwald                         if ((cis_direction == 1) || (outgoing_needed == false)){
3140532211feSMatthias Ringwald                             // lookup iso stream by cig/cis
3141b5ecaedbSMatthias Ringwald                             btstack_linked_list_iterator_init(&it, &hci_stack->iso_streams);
3142532211feSMatthias Ringwald                             while (btstack_linked_list_iterator_has_next(&it)) {
3143532211feSMatthias Ringwald                                 hci_iso_stream_t *iso_stream = (hci_iso_stream_t *) btstack_linked_list_iterator_next(&it);
3144532211feSMatthias Ringwald                                 if ((iso_stream->group_id == cig->cig_id) && (iso_stream->stream_id == cis_index)){
314514045fdbSMatthias Ringwald                                     hci_cis_handle_created(iso_stream, status);
3146532211feSMatthias Ringwald                                 }
3147532211feSMatthias Ringwald                             }
3148f9306a1aSMatthias Ringwald                         }
3149f9306a1aSMatthias Ringwald                         // next state
3150f9306a1aSMatthias Ringwald                         cig->state_vars.next_cis++;
3151f9306a1aSMatthias Ringwald                         cig->state = LE_AUDIO_CIG_STATE_SETUP_ISO_PATH;
3152f9306a1aSMatthias Ringwald                     }
3153f9306a1aSMatthias Ringwald                 }
315426b93350SMatthias Ringwald             }
31552a6c0f82SMatthias Ringwald             break;
31562a6c0f82SMatthias Ringwald         }
31572a6c0f82SMatthias Ringwald         case HCI_OPCODE_HCI_LE_BIG_TERMINATE_SYNC: {
31582a6c0f82SMatthias Ringwald             // lookup BIG by state
31592a6c0f82SMatthias Ringwald             btstack_linked_list_iterator_t it;
31602a6c0f82SMatthias Ringwald             btstack_linked_list_iterator_init(&it, &hci_stack->le_audio_big_syncs);
31612a6c0f82SMatthias Ringwald             while (btstack_linked_list_iterator_has_next(&it)) {
31622a6c0f82SMatthias Ringwald                 le_audio_big_sync_t *big_sync = (le_audio_big_sync_t *) btstack_linked_list_iterator_next(&it);
3163d04a9afcSMatthias Ringwald                 uint8_t big_handle = big_sync->big_handle;
31642a6c0f82SMatthias Ringwald                 switch (big_sync->state){
31652a6c0f82SMatthias Ringwald                     case LE_AUDIO_BIG_STATE_W4_TERMINATED_AFTER_SETUP_FAILED:
3166d04a9afcSMatthias Ringwald                         btstack_linked_list_iterator_remove(&it);
31672a6c0f82SMatthias Ringwald                         hci_emit_big_sync_created(big_sync, big_sync->state_vars.status);
3168d04a9afcSMatthias Ringwald                         return;
31692a6c0f82SMatthias Ringwald                     default:
3170d04a9afcSMatthias Ringwald                         btstack_linked_list_iterator_remove(&it);
3171d04a9afcSMatthias Ringwald                         hci_emit_big_sync_stopped(big_handle);
31727aa35f6aSMatthias Ringwald                         return;
31737aa35f6aSMatthias Ringwald                 }
31747aa35f6aSMatthias Ringwald             }
31757aa35f6aSMatthias Ringwald             break;
31767aa35f6aSMatthias Ringwald         }
31774ae8623eSMatthias Ringwald #endif
31784ae8623eSMatthias Ringwald #endif
31796f35bb46SMatthias Ringwald         default:
31806f35bb46SMatthias Ringwald             break;
31814f781026SMatthias Ringwald     }
3182645b7c25SMatthias Ringwald }
31834f781026SMatthias Ringwald 
3184afbf1cd7SMatthias Ringwald static void handle_command_status_event(uint8_t * packet, uint16_t size) {
3185afbf1cd7SMatthias Ringwald     UNUSED(size);
3186afbf1cd7SMatthias Ringwald 
3187afbf1cd7SMatthias Ringwald     // get num cmd packets - limit to 1 to reduce complexity
3188afbf1cd7SMatthias Ringwald     hci_stack->num_cmd_packets = packet[3] ? 1 : 0;
3189afbf1cd7SMatthias Ringwald 
3190c70df5f8SMatthias Ringwald     // get opcode and command status
3191c70df5f8SMatthias Ringwald     uint16_t opcode = hci_event_command_status_get_command_opcode(packet);
3192c70df5f8SMatthias Ringwald 
3193c70df5f8SMatthias Ringwald #if defined(ENABLE_CLASSIC) || defined(ENABLE_LE_CENTRAL) || defined(ENABLE_LE_ISOCHRONOUS_STREAMS)
3194c70df5f8SMatthias Ringwald     uint8_t status = hci_event_command_status_get_status(packet);
3195c70df5f8SMatthias Ringwald #endif
3196c70df5f8SMatthias Ringwald 
3197c70df5f8SMatthias Ringwald #if defined(ENABLE_CLASSIC) || defined(ENABLE_LE_CENTRAL)
3198c70df5f8SMatthias Ringwald     bd_addr_type_t addr_type;
319973bccf35Slouislee91     bd_addr_t addr;
3200c70df5f8SMatthias Ringwald #endif
3201c70df5f8SMatthias Ringwald 
320291036612SMatthias Ringwald #if defined(ENABLE_BLE) && defined (ENABLE_HCI_COMMAND_STATUS_DISCARDED_FOR_FAILED_CONNECTIONS_WORKAROUND)
3203f48a5586SMatthias Ringwald     hci_stack->hci_command_con_handle = HCI_CON_HANDLE_INVALID;
3204f48a5586SMatthias Ringwald #endif
3205f48a5586SMatthias Ringwald 
3206c70df5f8SMatthias Ringwald     switch (opcode){
3207afbf1cd7SMatthias Ringwald #ifdef ENABLE_CLASSIC
3208c70df5f8SMatthias Ringwald         case HCI_OPCODE_HCI_CREATE_CONNECTION:
32099071873aSMatthias Ringwald         case HCI_OPCODE_HCI_SETUP_SYNCHRONOUS_CONNECTION:
3210c70df5f8SMatthias Ringwald         case HCI_OPCODE_HCI_ACCEPT_SYNCHRONOUS_CONNECTION:
3211afbf1cd7SMatthias Ringwald #endif
3212afbf1cd7SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
3213c70df5f8SMatthias Ringwald         case HCI_OPCODE_HCI_LE_CREATE_CONNECTION:
3214afbf1cd7SMatthias Ringwald #endif
3215c70df5f8SMatthias Ringwald #if defined(ENABLE_CLASSIC) || defined(ENABLE_LE_CENTRAL)
3216afbf1cd7SMatthias Ringwald             addr_type = hci_stack->outgoing_addr_type;
321773bccf35Slouislee91             memcpy(addr, hci_stack->outgoing_addr, 6);
3218afbf1cd7SMatthias Ringwald 
3219afbf1cd7SMatthias Ringwald             // reset outgoing address info
3220afbf1cd7SMatthias Ringwald             memset(hci_stack->outgoing_addr, 0, 6);
3221afbf1cd7SMatthias Ringwald             hci_stack->outgoing_addr_type = BD_ADDR_TYPE_UNKNOWN;
3222afbf1cd7SMatthias Ringwald 
3223afbf1cd7SMatthias Ringwald             // on error
3224afbf1cd7SMatthias Ringwald             if (status != ERROR_CODE_SUCCESS){
3225afbf1cd7SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
3226afbf1cd7SMatthias Ringwald                 if (hci_is_le_connection_type(addr_type)){
3227afbf1cd7SMatthias Ringwald                     hci_stack->le_connecting_state = LE_CONNECTING_IDLE;
3228afbf1cd7SMatthias Ringwald                     hci_stack->le_connecting_request = LE_CONNECTING_IDLE;
3229afbf1cd7SMatthias Ringwald                 }
3230afbf1cd7SMatthias Ringwald #endif
3231afbf1cd7SMatthias Ringwald                 // error => outgoing connection failed
323273bccf35Slouislee91                 hci_connection_t * conn = hci_connection_for_bd_addr_and_type(addr, addr_type);
3233afbf1cd7SMatthias Ringwald                 if (conn != NULL){
3234afbf1cd7SMatthias Ringwald                     hci_handle_connection_failed(conn, status);
3235afbf1cd7SMatthias Ringwald                 }
3236afbf1cd7SMatthias Ringwald             }
3237c70df5f8SMatthias Ringwald             break;
3238c70df5f8SMatthias Ringwald #endif
3239afbf1cd7SMatthias Ringwald #ifdef ENABLE_CLASSIC
3240c70df5f8SMatthias Ringwald         case HCI_OPCODE_HCI_INQUIRY:
3241afbf1cd7SMatthias Ringwald             if (status == ERROR_CODE_SUCCESS) {
3242afbf1cd7SMatthias Ringwald                 hci_stack->inquiry_state = GAP_INQUIRY_STATE_ACTIVE;
3243afbf1cd7SMatthias Ringwald             } else {
3244afbf1cd7SMatthias Ringwald                 hci_stack->inquiry_state = GAP_INQUIRY_STATE_IDLE;
3245afbf1cd7SMatthias Ringwald             }
3246c70df5f8SMatthias Ringwald             break;
3247c70df5f8SMatthias Ringwald #endif
3248afbf1cd7SMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
3249c70df5f8SMatthias Ringwald         case HCI_OPCODE_HCI_LE_CREATE_CIS:
3250c70df5f8SMatthias Ringwald         case HCI_OPCODE_HCI_LE_ACCEPT_CIS_REQUEST:
3251afbf1cd7SMatthias Ringwald             if (status == ERROR_CODE_SUCCESS){
3252d75a6bbfSMatthias Ringwald                 hci_iso_stream_requested_confirm(HCI_ISO_GROUP_ID_INVALID);
3253afbf1cd7SMatthias Ringwald             } else {
3254d75a6bbfSMatthias Ringwald                 hci_iso_stream_requested_finalize(HCI_ISO_GROUP_ID_INVALID);
3255afbf1cd7SMatthias Ringwald             }
3256c70df5f8SMatthias Ringwald             break;
3257afbf1cd7SMatthias Ringwald #endif /* ENABLE_LE_ISOCHRONOUS_STREAMS */
3258c70df5f8SMatthias Ringwald         default:
3259c70df5f8SMatthias Ringwald             break;
3260c70df5f8SMatthias Ringwald     }
3261afbf1cd7SMatthias Ringwald }
3262afbf1cd7SMatthias Ringwald 
32630ce3f217SMatthias Ringwald #ifdef ENABLE_BLE
3264e4def797SMatthias Ringwald static void hci_create_gap_connection_complete_event(const uint8_t * hci_event, uint8_t * gap_event) {
3265e4def797SMatthias Ringwald     gap_event[0] = HCI_EVENT_META_GAP;
3266e4def797SMatthias Ringwald     gap_event[1] = 36 - 2;
3267e4def797SMatthias Ringwald     gap_event[2] = GAP_SUBEVENT_LE_CONNECTION_COMPLETE;
3268a9212437SMatthias Ringwald     switch (hci_event[2]){
3269a9212437SMatthias Ringwald         case HCI_SUBEVENT_LE_CONNECTION_COMPLETE:
3270e4def797SMatthias Ringwald             memcpy(&gap_event[3], &hci_event[3], 11);
3271e4def797SMatthias Ringwald             memset(&gap_event[14], 0, 12);
3272e4def797SMatthias Ringwald             memcpy(&gap_event[26], &hci_event[14], 7);
3273e4def797SMatthias Ringwald             memset(&gap_event[33], 0xff, 3);
3274a9212437SMatthias Ringwald             break;
3275a9212437SMatthias Ringwald         case HCI_SUBEVENT_LE_ENHANCED_CONNECTION_COMPLETE_V1:
3276e4def797SMatthias Ringwald             memcpy(&gap_event[3], &hci_event[3], 30);
3277e4def797SMatthias Ringwald             memset(&gap_event[33], 0xff, 3);
3278a9212437SMatthias Ringwald             break;
3279a9212437SMatthias Ringwald         case HCI_SUBEVENT_LE_ENHANCED_CONNECTION_COMPLETE_V2:
3280e4def797SMatthias Ringwald             memcpy(&gap_event[3], &hci_event[3], 33);
3281a9212437SMatthias Ringwald             break;
3282a9212437SMatthias Ringwald         default:
3283a9212437SMatthias Ringwald             btstack_unreachable();
3284a9212437SMatthias Ringwald             break;
3285a9212437SMatthias Ringwald     }
3286a9212437SMatthias Ringwald }
3287a9212437SMatthias Ringwald 
3288a9212437SMatthias Ringwald static void event_handle_le_connection_complete(const uint8_t * hci_event){
32890ce3f217SMatthias Ringwald 	bd_addr_t addr;
32900ce3f217SMatthias Ringwald 	bd_addr_type_t addr_type;
32910ce3f217SMatthias Ringwald 	hci_connection_t * conn;
32920ce3f217SMatthias Ringwald 
329398e0165dSMatthias Ringwald     // create GAP_SUBEVENT_LE_CONNECTION_COMPLETE
3294a9212437SMatthias Ringwald     uint8_t gap_event[36];
3295a9212437SMatthias Ringwald     hci_create_gap_connection_complete_event(hci_event, gap_event);
329660fb273dSMatthias Ringwald 
329798e0165dSMatthias Ringwald     // read fields
3298a9212437SMatthias Ringwald     uint8_t status = gap_subevent_le_connection_complete_get_status(gap_event);
3299a9212437SMatthias Ringwald     hci_role_t role = (hci_role_t) gap_subevent_le_connection_complete_get_role(gap_event);
3300a9212437SMatthias Ringwald     uint16_t conn_interval = gap_subevent_le_connection_complete_get_conn_interval(gap_event);
330198e0165dSMatthias Ringwald 
33020ce3f217SMatthias Ringwald 	// Connection management
3303a9212437SMatthias Ringwald     gap_subevent_le_connection_complete_get_peer_address(gap_event, addr);
3304a9212437SMatthias Ringwald 	addr_type = (bd_addr_type_t) gap_subevent_le_connection_complete_get_peer_address_type(gap_event);
330560fb273dSMatthias Ringwald     log_info("LE Connection_complete (status=%u) type %u, %s", status, addr_type, bd_addr_to_str(addr));
33060ce3f217SMatthias Ringwald 	conn = hci_connection_for_bd_addr_and_type(addr, addr_type);
33070ce3f217SMatthias Ringwald 
33080ce3f217SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
33090ce3f217SMatthias Ringwald 	// handle error: error is reported only to the initiator -> outgoing connection
331060fb273dSMatthias Ringwald 	if (status){
33110ce3f217SMatthias Ringwald 
33120ce3f217SMatthias Ringwald 		// handle cancelled outgoing connection
33130ce3f217SMatthias Ringwald 		// "If the cancellation was successful then, after the Command Complete event for the LE_Create_Connection_Cancel command,
33140ce3f217SMatthias Ringwald 		//  either an LE Connection Complete or an LE Enhanced Connection Complete event shall be generated.
33150ce3f217SMatthias Ringwald 		//  In either case, the event shall be sent with the error code Unknown Connection Identifier (0x02)."
331660fb273dSMatthias Ringwald 		if (status == ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER){
33171f468175SMatthias Ringwald 		    // reset state
33180ce3f217SMatthias Ringwald             hci_stack->le_connecting_state   = LE_CONNECTING_IDLE;
33190ce3f217SMatthias Ringwald 			// get outgoing connection conn struct for direct connect
33200ce3f217SMatthias Ringwald 			conn = gap_get_outgoing_connection();
33210ce3f217SMatthias Ringwald 		}
33220ce3f217SMatthias Ringwald 
3323*c1281a25SMatthias Ringwald 		// free connection if cancelled by user (request == IDLE)
3324*c1281a25SMatthias Ringwald 		if ((conn != NULL) && (hci_stack->le_connecting_request == LE_CONNECTING_IDLE)){
33250ce3f217SMatthias Ringwald 			// remove entry
33260ce3f217SMatthias Ringwald 			btstack_linked_list_remove(&hci_stack->connections, (btstack_linked_item_t *) conn);
33270ce3f217SMatthias Ringwald 			btstack_memory_hci_connection_free( conn );
33280ce3f217SMatthias Ringwald 		}
33290ce3f217SMatthias Ringwald 		return;
33300ce3f217SMatthias Ringwald 	}
33310ce3f217SMatthias Ringwald #endif
33320ce3f217SMatthias Ringwald 
33330ce3f217SMatthias Ringwald 	// on success, both hosts receive connection complete event
333460fb273dSMatthias Ringwald     if (role == HCI_ROLE_MASTER){
33350ce3f217SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
33360ce3f217SMatthias Ringwald 		// if we're master on an le connection, it was an outgoing connection and we're done with it
33370ce3f217SMatthias Ringwald 		// note: no hci_connection_t object exists yet for connect with whitelist
33380ce3f217SMatthias Ringwald 		if (hci_is_le_connection_type(addr_type)){
33390ce3f217SMatthias Ringwald 			hci_stack->le_connecting_state   = LE_CONNECTING_IDLE;
33400ce3f217SMatthias Ringwald 			hci_stack->le_connecting_request = LE_CONNECTING_IDLE;
33410ce3f217SMatthias Ringwald 		}
33420ce3f217SMatthias Ringwald #endif
33430ce3f217SMatthias Ringwald 	} else {
33440ce3f217SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
33450ce3f217SMatthias Ringwald 		// if we're slave, it was an incoming connection, advertisements have stopped
3346935aa76eSMatthias Ringwald         hci_stack->le_advertisements_state &= ~LE_ADVERTISEMENT_STATE_ACTIVE;
33470ce3f217SMatthias Ringwald #endif
33480ce3f217SMatthias Ringwald 	}
33490ce3f217SMatthias Ringwald 
33500ce3f217SMatthias Ringwald 	// LE connections are auto-accepted, so just create a connection if there isn't one already
33510ce3f217SMatthias Ringwald 	if (!conn){
335288f925b1SMatthias Ringwald 		conn = create_connection_for_bd_addr_and_type(addr, addr_type, role);
33530ce3f217SMatthias Ringwald 	}
33540ce3f217SMatthias Ringwald 
33550ce3f217SMatthias Ringwald 	// no memory, sorry.
33560ce3f217SMatthias Ringwald 	if (!conn){
33570ce3f217SMatthias Ringwald 		return;
33580ce3f217SMatthias Ringwald 	}
33590ce3f217SMatthias Ringwald 
33600ce3f217SMatthias Ringwald 	conn->state = OPEN;
3361a9212437SMatthias Ringwald 	conn->con_handle             = gap_subevent_le_connection_complete_get_connection_handle(gap_event);
336260fb273dSMatthias Ringwald     conn->le_connection_interval = conn_interval;
33630ce3f217SMatthias Ringwald 
3364ac0f6b83SMatthias Ringwald     // workaround: PAST doesn't work without LE Read Remote Features on PacketCraft Controller with LMP 568B
3365ac0f6b83SMatthias Ringwald     conn->gap_connection_tasks = GAP_CONNECTION_TASK_LE_READ_REMOTE_FEATURES;
3366ac0f6b83SMatthias Ringwald 
33670ce3f217SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
336860fb273dSMatthias Ringwald 	if (role == HCI_ROLE_SLAVE){
33690ce3f217SMatthias Ringwald 		hci_update_advertisements_enabled_for_current_roles();
33700ce3f217SMatthias Ringwald 	}
33710ce3f217SMatthias Ringwald #endif
33720ce3f217SMatthias Ringwald 
3373dde9ff1eSMatthias Ringwald     // init unenhanced att bearer mtu
3374dde9ff1eSMatthias Ringwald     conn->att_connection.mtu = ATT_DEFAULT_MTU;
3375dde9ff1eSMatthias Ringwald     conn->att_connection.mtu_exchanged = false;
3376dde9ff1eSMatthias Ringwald 
33770ce3f217SMatthias Ringwald     // TODO: store - role, peer address type, conn_interval, conn_latency, supervision timeout, master clock
33780ce3f217SMatthias Ringwald 
33790ce3f217SMatthias Ringwald 	// restart timer
33800ce3f217SMatthias Ringwald 	// btstack_run_loop_set_timer(&conn->timeout, HCI_CONNECTION_TIMEOUT_MS);
33810ce3f217SMatthias Ringwald 	// btstack_run_loop_add_timer(&conn->timeout);
33820ce3f217SMatthias Ringwald 
33830ce3f217SMatthias Ringwald 	log_info("New connection: handle %u, %s", conn->con_handle, bd_addr_to_str(conn->address));
33840ce3f217SMatthias Ringwald 
338598e0165dSMatthias Ringwald     // emit GAP_SUBEVENT_LE_CONNECTION_COMPLETE
3386a9212437SMatthias Ringwald     hci_emit_event(gap_event, sizeof(gap_event), 1);
338798e0165dSMatthias Ringwald 
338898e0165dSMatthias Ringwald     // emit BTSTACK_EVENT_NR_CONNECTIONS_CHANGED;
33890ce3f217SMatthias Ringwald 	hci_emit_nr_connections_changed();
33900ce3f217SMatthias Ringwald }
33910ce3f217SMatthias Ringwald #endif
33920ce3f217SMatthias Ringwald 
339317c6fe5cSMatthias Ringwald #ifdef ENABLE_CLASSIC
339417c6fe5cSMatthias 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){
339517c6fe5cSMatthias Ringwald     if (io_cap_local == SSP_IO_CAPABILITY_UNKNOWN) return false;
339617c6fe5cSMatthias Ringwald     // LEVEL_4 is tested by l2cap
33979a8f78c1SMatthias Ringwald     // LEVEL 3 requires MITM protection -> check io capabilities if Authenticated is possible
33989a8f78c1SMatthias Ringwald     // @see: Core Spec v5.3, Vol 3, Part C, Table 5.7
339917c6fe5cSMatthias Ringwald     if (level >= LEVEL_3){
34009a8f78c1SMatthias Ringwald         // MITM not possible without keyboard or display
340117c6fe5cSMatthias Ringwald         if (io_cap_remote >= SSP_IO_CAPABILITY_NO_INPUT_NO_OUTPUT) return false;
340217c6fe5cSMatthias Ringwald         if (io_cap_local  >= SSP_IO_CAPABILITY_NO_INPUT_NO_OUTPUT) return false;
34039a8f78c1SMatthias Ringwald 
34049a8f78c1SMatthias Ringwald         // MITM possible if one side has keyboard and the other has keyboard or display
34059a8f78c1SMatthias Ringwald         if (io_cap_remote == SSP_IO_CAPABILITY_KEYBOARD_ONLY)      return true;
34069a8f78c1SMatthias Ringwald         if (io_cap_local  == SSP_IO_CAPABILITY_KEYBOARD_ONLY)      return true;
34079a8f78c1SMatthias Ringwald 
34089a8f78c1SMatthias Ringwald         // MITM not possible if one side has only display and other side has no keyboard
34099a8f78c1SMatthias Ringwald         if (io_cap_remote == SSP_IO_CAPABILITY_DISPLAY_ONLY)       return false;
34109a8f78c1SMatthias Ringwald         if (io_cap_local  == SSP_IO_CAPABILITY_DISPLAY_ONLY)       return false;
341117c6fe5cSMatthias Ringwald     }
341217c6fe5cSMatthias Ringwald     // LEVEL 2 requires SSP, which is a given
341317c6fe5cSMatthias Ringwald     return true;
341417c6fe5cSMatthias Ringwald }
34153817f9dfSMatthias Ringwald 
3416b3c4163bSMatthias Ringwald static void hci_ssp_assess_security_on_io_cap_request(hci_connection_t * conn){
34172dd8985bSMatthias Ringwald     // get requested security level
34182dd8985bSMatthias Ringwald     gap_security_level_t requested_security_level = conn->requested_security_level;
34192dd8985bSMatthias Ringwald     if (hci_stack->gap_secure_connections_only_mode){
34202dd8985bSMatthias Ringwald         requested_security_level = LEVEL_4;
34212dd8985bSMatthias Ringwald     }
34222dd8985bSMatthias Ringwald 
3423b3c4163bSMatthias Ringwald     // assess security: LEVEL 4 requires SC
34242dd8985bSMatthias Ringwald     // skip this preliminary test if remote features are not available yet to work around potential issue in ESP32 controller
34252dd8985bSMatthias Ringwald     if ((requested_security_level == LEVEL_4) &&
34262dd8985bSMatthias Ringwald         ((conn->bonding_flags & BONDING_RECEIVED_REMOTE_FEATURES) != 0) &&
34272dd8985bSMatthias Ringwald         !hci_remote_sc_enabled(conn)){
3428b3c4163bSMatthias Ringwald         log_info("Level 4 required, but SC not supported -> abort");
3429b3c4163bSMatthias Ringwald         hci_pairing_complete(conn, ERROR_CODE_INSUFFICIENT_SECURITY);
3430b3c4163bSMatthias Ringwald         connectionSetAuthenticationFlags(conn, AUTH_FLAG_SEND_IO_CAPABILITIES_NEGATIVE_REPLY);
3431b3c4163bSMatthias Ringwald         return;
3432b3c4163bSMatthias Ringwald     }
3433b3c4163bSMatthias Ringwald 
3434c2414c00SMatthias Ringwald     // assess bonding requirements: abort if remote in dedicated bonding mode but we are non-bonding
3435c2414c00SMatthias Ringwald     // - GAP/MOD/NBON/BV-02-C
3436c2414c00SMatthias Ringwald     // - GAP/DM/NBON/BV-01-C
3437c2414c00SMatthias Ringwald     if (conn->authentication_flags & AUTH_FLAG_RECV_IO_CAPABILITIES_RESPONSE){
3438c2414c00SMatthias Ringwald         switch (conn->io_cap_response_auth_req){
3439c2414c00SMatthias Ringwald             case SSP_IO_AUTHREQ_MITM_PROTECTION_NOT_REQUIRED_DEDICATED_BONDING:
3440c2414c00SMatthias Ringwald             case SSP_IO_AUTHREQ_MITM_PROTECTION_REQUIRED_DEDICATED_BONDING:
3441c2414c00SMatthias Ringwald                 if (hci_stack->bondable == false){
3442c2414c00SMatthias Ringwald                     log_info("Dedicated vs. non-bondable -> abort");
3443c2414c00SMatthias Ringwald                     hci_pairing_complete(conn, ERROR_CODE_INSUFFICIENT_SECURITY);
3444c2414c00SMatthias Ringwald                     connectionSetAuthenticationFlags(conn, AUTH_FLAG_SEND_IO_CAPABILITIES_NEGATIVE_REPLY);
3445c2414c00SMatthias Ringwald                     return;
3446c2414c00SMatthias Ringwald                 }
3447c2414c00SMatthias Ringwald             default:
3448c2414c00SMatthias Ringwald                 break;
3449c2414c00SMatthias Ringwald         }
3450c2414c00SMatthias Ringwald     }
3451c2414c00SMatthias Ringwald 
3452b3c4163bSMatthias Ringwald     // assess security based on io capabilities
3453b3c4163bSMatthias Ringwald     if (conn->authentication_flags & AUTH_FLAG_RECV_IO_CAPABILITIES_RESPONSE){
3454b3c4163bSMatthias Ringwald         // responder: fully validate io caps of both sides as well as OOB data
3455b3c4163bSMatthias Ringwald         bool security_possible = false;
3456b3c4163bSMatthias Ringwald         security_possible = hci_ssp_security_level_possible_for_io_cap(requested_security_level, hci_stack->ssp_io_capability, conn->io_cap_response_io);
3457b3c4163bSMatthias Ringwald 
3458b3c4163bSMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB
3459b3c4163bSMatthias Ringwald         // We assume that both Controller can reach LEVEL 4, if one side has received P-192 and the other has received P-256,
3460b3c4163bSMatthias Ringwald         // so we merge the OOB data availability
3461b3c4163bSMatthias Ringwald         uint8_t have_oob_data = conn->io_cap_response_oob_data;
3462b3c4163bSMatthias Ringwald         if (conn->classic_oob_c_192 != NULL){
3463b3c4163bSMatthias Ringwald             have_oob_data |= 1;
3464b3c4163bSMatthias Ringwald         }
3465b3c4163bSMatthias Ringwald         if (conn->classic_oob_c_256 != NULL){
3466b3c4163bSMatthias Ringwald             have_oob_data |= 2;
3467b3c4163bSMatthias Ringwald         }
3468b3c4163bSMatthias Ringwald         // for up to Level 3, either P-192 as well as P-256 will do
3469b3c4163bSMatthias 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
3470b3c4163bSMatthias Ringwald         // if remote does not SC, we should not receive P-256 data either
3471b3c4163bSMatthias Ringwald         if ((requested_security_level <= LEVEL_3) && (have_oob_data != 0)){
3472b3c4163bSMatthias Ringwald             security_possible = true;
3473b3c4163bSMatthias Ringwald         }
3474b3c4163bSMatthias Ringwald         // for Level 4, P-256 is needed
3475b3c4163bSMatthias Ringwald         if ((requested_security_level == LEVEL_4 && ((have_oob_data & 2) != 0))){
3476b3c4163bSMatthias Ringwald             security_possible = true;
3477b3c4163bSMatthias Ringwald         }
3478b3c4163bSMatthias Ringwald #endif
3479b3c4163bSMatthias Ringwald 
3480b3c4163bSMatthias Ringwald         if (security_possible == false){
34812dd8985bSMatthias Ringwald             log_info("IOCap/OOB insufficient for level %u -> abort", requested_security_level);
3482b3c4163bSMatthias Ringwald             hci_pairing_complete(conn, ERROR_CODE_INSUFFICIENT_SECURITY);
3483b3c4163bSMatthias Ringwald             connectionSetAuthenticationFlags(conn, AUTH_FLAG_SEND_IO_CAPABILITIES_NEGATIVE_REPLY);
3484b3c4163bSMatthias Ringwald             return;
3485b3c4163bSMatthias Ringwald         }
3486b3c4163bSMatthias Ringwald     } else {
3487b3c4163bSMatthias Ringwald         // initiator: remote io cap not yet, only check if we have ability for MITM protection if requested and OOB is not supported
34881fe968f5SMatthias Ringwald #ifndef ENABLE_CLASSIC_PAIRING_OOB
34891fe968f5SMatthias Ringwald #ifndef ENABLE_EXPLICIT_IO_CAPABILITIES_REPLY
3490b3c4163bSMatthias Ringwald         if ((conn->requested_security_level >= LEVEL_3) && (hci_stack->ssp_io_capability >= SSP_IO_CAPABILITY_NO_INPUT_NO_OUTPUT)){
3491b3c4163bSMatthias Ringwald             log_info("Level 3+ required, but no input/output -> abort");
3492b3c4163bSMatthias Ringwald             hci_pairing_complete(conn, ERROR_CODE_INSUFFICIENT_SECURITY);
3493b3c4163bSMatthias Ringwald             connectionSetAuthenticationFlags(conn, AUTH_FLAG_SEND_IO_CAPABILITIES_NEGATIVE_REPLY);
3494b3c4163bSMatthias Ringwald             return;
3495b3c4163bSMatthias Ringwald         }
3496b3c4163bSMatthias Ringwald #endif
34971fe968f5SMatthias Ringwald #endif
3498b3c4163bSMatthias Ringwald     }
3499b3c4163bSMatthias Ringwald 
3500b3c4163bSMatthias Ringwald #ifndef ENABLE_EXPLICIT_IO_CAPABILITIES_REPLY
3501b3c4163bSMatthias Ringwald     if (hci_stack->ssp_io_capability != SSP_IO_CAPABILITY_UNKNOWN){
3502b3c4163bSMatthias Ringwald         connectionSetAuthenticationFlags(conn, AUTH_FLAG_SEND_IO_CAPABILITIES_REPLY);
3503b3c4163bSMatthias Ringwald     } else {
3504b3c4163bSMatthias Ringwald         connectionSetAuthenticationFlags(conn, AUTH_FLAG_SEND_IO_CAPABILITIES_NEGATIVE_REPLY);
3505b3c4163bSMatthias Ringwald     }
3506b3c4163bSMatthias Ringwald #endif
3507b3c4163bSMatthias Ringwald }
3508b3c4163bSMatthias Ringwald 
350917c6fe5cSMatthias Ringwald #endif
351017c6fe5cSMatthias Ringwald 
3511c3b46f5aSMatthias Ringwald static void event_handler(uint8_t *packet, uint16_t size){
35124f781026SMatthias Ringwald 
35134f781026SMatthias Ringwald     uint16_t event_length = packet[1];
35144f781026SMatthias Ringwald 
35154f781026SMatthias Ringwald     // assert packet is complete
35164ea43905SMatthias Ringwald     if (size != (event_length + 2u)){
35174f781026SMatthias Ringwald         log_error("event_handler called with packet of wrong size %d, expected %u => dropping packet", size, event_length + 2);
35184f781026SMatthias Ringwald         return;
35194f781026SMatthias Ringwald     }
35204f781026SMatthias Ringwald 
35214f781026SMatthias Ringwald     hci_con_handle_t handle;
35224f781026SMatthias Ringwald     hci_connection_t * conn;
35234f781026SMatthias Ringwald     int i;
35244f781026SMatthias Ringwald 
35254f781026SMatthias Ringwald #ifdef ENABLE_CLASSIC
35265e91d96cSMatthias Ringwald     hci_link_type_t link_type;
352748f33f37SMatthias Ringwald     bd_addr_t addr;
3528cef94710SMatthias Ringwald     bd_addr_type_t addr_type;
35294f781026SMatthias Ringwald #endif
35304ae8623eSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
35314ae8623eSMatthias Ringwald     hci_iso_stream_t * iso_stream;
35327aa35f6aSMatthias Ringwald     le_audio_big_t   * big;
35332a6c0f82SMatthias Ringwald     le_audio_big_sync_t * big_sync;
35344ae8623eSMatthias Ringwald #endif
353589254d99SMatthias Ringwald #if defined(ENABLE_LE_ISOCHRONOUS_STREAMS) || defined(ENABLE_LE_EXTENDED_ADVERTISING)
353689254d99SMatthias Ringwald     btstack_linked_list_iterator_t it;
353789254d99SMatthias Ringwald #endif
353889254d99SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
353989254d99SMatthias Ringwald     uint8_t advertising_handle;
354089254d99SMatthias Ringwald #endif
35414f781026SMatthias Ringwald 
35424f781026SMatthias Ringwald     // log_info("HCI:EVENT:%02x", hci_event_packet_get_type(packet));
35434f781026SMatthias Ringwald 
35444f781026SMatthias Ringwald     switch (hci_event_packet_get_type(packet)) {
35454f781026SMatthias Ringwald 
35464f781026SMatthias Ringwald         case HCI_EVENT_COMMAND_COMPLETE:
35474f781026SMatthias Ringwald             handle_command_complete_event(packet, size);
354856cf178bSmatthias.ringwald             break;
354956cf178bSmatthias.ringwald 
35507ec5eeaaSmatthias.ringwald         case HCI_EVENT_COMMAND_STATUS:
3551afbf1cd7SMatthias Ringwald             handle_command_status_event(packet, size);
35527ec5eeaaSmatthias.ringwald             break;
35537ec5eeaaSmatthias.ringwald 
35542e440c8aS[email protected]         case HCI_EVENT_NUMBER_OF_COMPLETED_PACKETS:{
35559784dac1SMatthias Ringwald             if (size < 3) return;
35569784dac1SMatthias Ringwald             uint16_t num_handles = packet[2];
35574ea43905SMatthias Ringwald             if (size != (3u + num_handles * 4u)) return;
3558d9a1d8edSMatthias Ringwald #ifdef ENABLE_CLASSIC
3559d9a1d8edSMatthias Ringwald             bool notify_sco = false;
3560d9a1d8edSMatthias Ringwald #endif
3561d9a1d8edSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
3562d9a1d8edSMatthias Ringwald             bool notify_iso = false;
3563d9a1d8edSMatthias Ringwald #endif
35649784dac1SMatthias Ringwald             uint16_t offset = 3;
35659784dac1SMatthias Ringwald             for (i=0; i<num_handles;i++){
35664ea43905SMatthias Ringwald                 handle = little_endian_read_16(packet, offset) & 0x0fffu;
35674ea43905SMatthias Ringwald                 offset += 2u;
3568f8fbdce0SMatthias Ringwald                 uint16_t num_packets = little_endian_read_16(packet, offset);
35694ea43905SMatthias Ringwald                 offset += 2u;
35702e440c8aS[email protected] 
35715061f3afS[email protected]                 conn = hci_connection_for_handle(handle);
3572e5413aa0SMatthias Ringwald                 if (conn != NULL) {
357323bed257S[email protected] 
3574ce41473eSMatthias Ringwald                     if (conn->num_packets_sent >= num_packets) {
3575ce41473eSMatthias Ringwald                         conn->num_packets_sent -= num_packets;
3576e35edcc1S[email protected]                     } else {
3577ce41473eSMatthias Ringwald                         log_error("hci_number_completed_packets, more packet slots freed then sent.");
3578ce41473eSMatthias Ringwald                         conn->num_packets_sent = 0;
3579e35edcc1S[email protected]                     }
3580ce41473eSMatthias Ringwald                     // log_info("hci_number_completed_packet %u processed for handle %u, outstanding %u", num_packets, handle, conn->num_packets_sent);
3581d9a1d8edSMatthias Ringwald #ifdef ENABLE_CLASSIC
3582d9a1d8edSMatthias Ringwald                     if (conn->address_type == BD_ADDR_TYPE_SCO){
3583d9a1d8edSMatthias Ringwald                         notify_sco = true;
3584d9a1d8edSMatthias Ringwald                     }
3585d9a1d8edSMatthias Ringwald #endif
3586e5413aa0SMatthias Ringwald                 }
3587e5413aa0SMatthias Ringwald 
35888ad9cf99SMatthias Ringwald #ifdef ENABLE_CONTROLLER_DUMP_PACKETS
35898ad9cf99SMatthias Ringwald                 hci_controller_dump_packets();
35908ad9cf99SMatthias Ringwald #endif
35918ad9cf99SMatthias Ringwald 
3592e5413aa0SMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
3593e5413aa0SMatthias Ringwald                 if (conn == NULL){
3594e5413aa0SMatthias Ringwald                     hci_iso_stream_t * iso_stream = hci_iso_stream_for_con_handle(handle);
3595e5413aa0SMatthias Ringwald                     if (iso_stream != NULL){
3596e5413aa0SMatthias Ringwald                         if (iso_stream->num_packets_sent >= num_packets) {
3597e5413aa0SMatthias Ringwald                             iso_stream->num_packets_sent -= num_packets;
3598e5413aa0SMatthias Ringwald                         } else {
3599e5413aa0SMatthias Ringwald                             log_error("hci_number_completed_packets, more packet slots freed then sent.");
3600e5413aa0SMatthias Ringwald                             iso_stream->num_packets_sent = 0;
3601e5413aa0SMatthias Ringwald                         }
36028d72db10SMatthias Ringwald                         if (iso_stream->iso_type == HCI_ISO_TYPE_BIS){
36038d72db10SMatthias Ringwald                             le_audio_big_t * big = hci_big_for_handle(iso_stream->group_id);
3604fe977b37SMatthias Ringwald                             if (big != NULL){
3605fe977b37SMatthias Ringwald                                 big->num_completed_timestamp_current_valid = true;
3606fe977b37SMatthias Ringwald                                 big->num_completed_timestamp_current_ms = btstack_run_loop_get_time_ms();
3607fe977b37SMatthias Ringwald                             }
3608fe977b37SMatthias Ringwald                         }
3609e5413aa0SMatthias Ringwald                         log_info("hci_number_completed_packet %u processed for handle %u, outstanding %u",
3610e5413aa0SMatthias Ringwald                                  num_packets, handle, iso_stream->num_packets_sent);
3611d9a1d8edSMatthias Ringwald                         notify_iso = true;
3612e5413aa0SMatthias Ringwald                     }
3613d9a1d8edSMatthias Ringwald                 }
3614d9a1d8edSMatthias Ringwald #endif
3615d9a1d8edSMatthias Ringwald             }
3616d9a1d8edSMatthias Ringwald 
3617d9a1d8edSMatthias Ringwald #ifdef ENABLE_CLASSIC
3618d9a1d8edSMatthias Ringwald             if (notify_sco){
3619d9a1d8edSMatthias Ringwald                 hci_notify_if_sco_can_send_now();
3620d9a1d8edSMatthias Ringwald             }
3621d9a1d8edSMatthias Ringwald #endif
3622d9a1d8edSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
3623d9a1d8edSMatthias Ringwald             if (notify_iso){
36245ade6657SMatthias Ringwald                 hci_iso_notify_can_send_now();
3625e5413aa0SMatthias Ringwald             }
3626e5413aa0SMatthias Ringwald #endif
36276772a24cSmatthias.ringwald             break;
36282e440c8aS[email protected]         }
362935454696SMatthias Ringwald 
363035454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
36319afaa4d4SMatthias Ringwald         case HCI_EVENT_FLUSH_OCCURRED:
36329afaa4d4SMatthias Ringwald             // flush occurs only if automatic flush has been enabled by gap_enable_link_watchdog()
36339afaa4d4SMatthias Ringwald             handle = hci_event_flush_occurred_get_handle(packet);
36349afaa4d4SMatthias Ringwald             conn = hci_connection_for_handle(handle);
36359afaa4d4SMatthias Ringwald             if (conn) {
36369afaa4d4SMatthias Ringwald                 log_info("Flush occurred, disconnect 0x%04x", handle);
36379afaa4d4SMatthias Ringwald                 conn->state = SEND_DISCONNECT;
36389afaa4d4SMatthias Ringwald             }
36399afaa4d4SMatthias Ringwald             break;
36409afaa4d4SMatthias Ringwald 
3641f5875de5SMatthias Ringwald         case HCI_EVENT_INQUIRY_COMPLETE:
3642f5875de5SMatthias Ringwald             if (hci_stack->inquiry_state == GAP_INQUIRY_STATE_ACTIVE){
3643f5875de5SMatthias Ringwald                 hci_stack->inquiry_state = GAP_INQUIRY_STATE_IDLE;
3644f5875de5SMatthias Ringwald                 uint8_t event[] = { GAP_EVENT_INQUIRY_COMPLETE, 1, 0};
3645f5875de5SMatthias Ringwald                 hci_emit_event(event, sizeof(event), 1);
3646f5875de5SMatthias Ringwald             }
3647f5875de5SMatthias Ringwald             break;
3648b7f1ee76SMatthias Ringwald         case HCI_EVENT_REMOTE_NAME_REQUEST_COMPLETE:
3649b7f1ee76SMatthias Ringwald             if (hci_stack->remote_name_state == GAP_REMOTE_NAME_STATE_W4_COMPLETE){
3650b7f1ee76SMatthias Ringwald                 hci_stack->remote_name_state = GAP_REMOTE_NAME_STATE_IDLE;
3651b7f1ee76SMatthias Ringwald             }
3652b7f1ee76SMatthias Ringwald             break;
36531f7b95a1Smatthias.ringwald         case HCI_EVENT_CONNECTION_REQUEST:
3654724d70a2SMatthias Ringwald             reverse_bd_addr(&packet[2], addr);
36555e91d96cSMatthias Ringwald             link_type = (hci_link_type_t) packet[11];
365672cf8859SMatthias Ringwald 
365772cf8859SMatthias Ringwald             // CVE-2020-26555: reject incoming connection from device with same BD ADDR
365872cf8859SMatthias Ringwald             if (memcmp(hci_stack->local_bd_addr, addr, 6) == 0){
365972cf8859SMatthias Ringwald                 hci_stack->decline_reason = ERROR_CODE_CONNECTION_REJECTED_DUE_TO_UNACCEPTABLE_BD_ADDR;
366072cf8859SMatthias Ringwald                 bd_addr_copy(hci_stack->decline_addr, addr);
366172cf8859SMatthias Ringwald                 break;
366272cf8859SMatthias Ringwald             }
366372cf8859SMatthias Ringwald 
366407e010b6SMilanka Ringwald             if (hci_stack->gap_classic_accept_callback != NULL){
36655e91d96cSMatthias Ringwald                 if ((*hci_stack->gap_classic_accept_callback)(addr, link_type) == 0){
3666d152b6c6SMatthias Ringwald                     hci_stack->decline_reason = ERROR_CODE_CONNECTION_REJECTED_DUE_TO_SECURITY_REASONS;
366707e010b6SMilanka Ringwald                     bd_addr_copy(hci_stack->decline_addr, addr);
366807e010b6SMilanka Ringwald                     break;
366907e010b6SMilanka Ringwald                 }
367007e010b6SMilanka Ringwald             }
367107e010b6SMilanka Ringwald 
367237eaa4cfSmatthias.ringwald             // TODO: eval COD 8-10
36735e91d96cSMatthias Ringwald             log_info("Connection_incoming: %s, type %u", bd_addr_to_str(addr), (unsigned int) link_type);
36745e91d96cSMatthias Ringwald             addr_type = (link_type == HCI_LINK_TYPE_ACL) ? BD_ADDR_TYPE_ACL : BD_ADDR_TYPE_SCO;
36752e77e513S[email protected]             conn = hci_connection_for_bd_addr_and_type(addr, addr_type);
36761f7b95a1Smatthias.ringwald             if (!conn) {
367788f925b1SMatthias Ringwald                 conn = create_connection_for_bd_addr_and_type(addr, addr_type, HCI_ROLE_SLAVE);
36781f7b95a1Smatthias.ringwald             }
3679ce4c8fabSmatthias.ringwald             if (!conn) {
3680ce4c8fabSmatthias.ringwald                 // CONNECTION REJECTED DUE TO LIMITED RESOURCES (0X0D)
36814536712cSMilanka Ringwald                 hci_stack->decline_reason = ERROR_CODE_CONNECTION_REJECTED_DUE_TO_LIMITED_RESOURCES;
3682058e3d6bSMatthias Ringwald                 bd_addr_copy(hci_stack->decline_addr, addr);
3683f23819bcSMatthias Ringwald                 hci_run();
3684f23819bcSMatthias Ringwald                 // avoid event to higher layer
3685f23819bcSMatthias Ringwald                 return;
3686ce4c8fabSmatthias.ringwald             }
368732ab9390Smatthias.ringwald             conn->state = RECEIVED_CONNECTION_REQUEST;
3688f3a16b9aSMatthias Ringwald             // store info about eSCO
36895e91d96cSMatthias Ringwald             if (link_type == HCI_LINK_TYPE_ESCO){
369076ccfb2aSMatthias Ringwald                 conn->remote_supported_features[0] |= 1;
3691f3a16b9aSMatthias Ringwald             }
3692d7891039SMatthias Ringwald             // propagate remote supported sco packet packets from existing ACL to new SCO connection
3693d7891039SMatthias Ringwald             if (addr_type == BD_ADDR_TYPE_SCO){
3694182d886dSMatthias Ringwald                 const hci_connection_t * acl_conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL);
3695182d886dSMatthias Ringwald                 // ACL exists unless fuzzing
3696182d886dSMatthias Ringwald                 if (acl_conn != NULL) {
3697d7891039SMatthias Ringwald                     conn->remote_supported_sco_packets = acl_conn->remote_supported_sco_packets;
3698d7891039SMatthias Ringwald                 }
3699182d886dSMatthias Ringwald             }
370032ab9390Smatthias.ringwald             hci_run();
37011f7b95a1Smatthias.ringwald             break;
37021f7b95a1Smatthias.ringwald 
37036772a24cSmatthias.ringwald         case HCI_EVENT_CONNECTION_COMPLETE:
3704fe1ed1b8Smatthias.ringwald             // Connection management
3705724d70a2SMatthias Ringwald             reverse_bd_addr(&packet[5], addr);
37069da54300S[email protected]             log_info("Connection_complete (status=%u) %s", packet[2], bd_addr_to_str(addr));
3707f16129ceSMatthias Ringwald             addr_type = BD_ADDR_TYPE_ACL;
37082e77e513S[email protected]             conn = hci_connection_for_bd_addr_and_type(addr, addr_type);
3709fe1ed1b8Smatthias.ringwald             if (conn) {
3710893b4ccdSMatthias Ringwald                 switch (conn->state){
3711893b4ccdSMatthias Ringwald                     // expected states
3712893b4ccdSMatthias Ringwald                     case ACCEPTED_CONNECTION_REQUEST:
3713893b4ccdSMatthias Ringwald                     case SENT_CREATE_CONNECTION:
3714893b4ccdSMatthias Ringwald                         break;
3715893b4ccdSMatthias Ringwald                     // unexpected state -> ignore
3716893b4ccdSMatthias Ringwald                     default:
3717893b4ccdSMatthias Ringwald                         // don't forward event to app
3718893b4ccdSMatthias Ringwald                         return;
3719893b4ccdSMatthias Ringwald                 }
3720b448a0e7Smatthias.ringwald                 if (!packet[2]){
3721c8e4258aSmatthias.ringwald                     conn->state = OPEN;
3722f8fbdce0SMatthias Ringwald                     conn->con_handle = little_endian_read_16(packet, 3);
37236909f064SMatthias Ringwald 
372422df2fe2SMatthias Ringwald                     // trigger write supervision timeout if we're master
3725d821984bSMatthias Ringwald                     if ((hci_stack->link_supervision_timeout != HCI_LINK_SUPERVISION_TIMEOUT_DEFAULT) && (conn->role == HCI_ROLE_MASTER)){
372622df2fe2SMatthias Ringwald                         conn->gap_connection_tasks |= GAP_CONNECTION_TASK_WRITE_SUPERVISION_TIMEOUT;
37276909f064SMatthias Ringwald                     }
37286909f064SMatthias Ringwald 
372922df2fe2SMatthias Ringwald                     // trigger write automatic flush timeout
37309afaa4d4SMatthias Ringwald                     if (hci_stack->automatic_flush_timeout != 0){
37319afaa4d4SMatthias Ringwald                         conn->gap_connection_tasks |= GAP_CONNECTION_TASK_WRITE_AUTOMATIC_FLUSH_TIMEOUT;
37329afaa4d4SMatthias Ringwald                     }
37339afaa4d4SMatthias Ringwald 
3734c785ef68Smatthias.ringwald                     // restart timer
3735528a4a3bSMatthias Ringwald                     btstack_run_loop_set_timer(&conn->timeout, HCI_CONNECTION_TIMEOUT_MS);
3736528a4a3bSMatthias Ringwald                     btstack_run_loop_add_timer(&conn->timeout);
3737c785ef68Smatthias.ringwald 
373818c4a0a3SMatthias Ringwald                     // trigger remote features for dedicated bonding
373918c4a0a3SMatthias Ringwald                     if ((conn->bonding_flags & BONDING_DEDICATED) != 0){
374018c4a0a3SMatthias Ringwald                         hci_trigger_remote_features_for_connection(conn);
374118c4a0a3SMatthias Ringwald                     }
374218c4a0a3SMatthias Ringwald 
37439da54300S[email protected]                     log_info("New connection: handle %u, %s", conn->con_handle, bd_addr_to_str(conn->address));
374443bfb1bdSmatthias.ringwald 
374543bfb1bdSmatthias.ringwald                     hci_emit_nr_connections_changed();
3746b448a0e7Smatthias.ringwald                 } else {
37470bbba85bSMatthias Ringwald                     // connection failed
37480bbba85bSMatthias Ringwald                     hci_handle_connection_failed(conn, packet[2]);
3749fe1ed1b8Smatthias.ringwald                 }
3750fe1ed1b8Smatthias.ringwald             }
37516772a24cSmatthias.ringwald             break;
3752fe1ed1b8Smatthias.ringwald 
375344d0e3d5S[email protected]         case HCI_EVENT_SYNCHRONOUS_CONNECTION_COMPLETE:
3754724d70a2SMatthias Ringwald             reverse_bd_addr(&packet[5], addr);
37551f34df2cSMatthias Ringwald             conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_SCO);
37561f34df2cSMatthias Ringwald             log_info("Synchronous Connection Complete for %p (status=%u) %s", conn, packet[2], bd_addr_to_str(addr));
3757182d886dSMatthias Ringwald 
3758182d886dSMatthias Ringwald             // SCO exists unless fuzzer
3759182d886dSMatthias Ringwald             if (conn == NULL) break;
37609071873aSMatthias Ringwald 
37619071873aSMatthias Ringwald             if (packet[2] != ERROR_CODE_SUCCESS){
37629071873aSMatthias Ringwald                 // connection failed, remove entry
37631f34df2cSMatthias Ringwald                 hci_handle_connection_failed(conn, packet[2]);
376444d0e3d5S[email protected]                 break;
376544d0e3d5S[email protected]             }
37669071873aSMatthias Ringwald 
37671a06f663S[email protected]             conn->state = OPEN;
3768f8fbdce0SMatthias Ringwald             conn->con_handle = little_endian_read_16(packet, 3);
3769ee752bb8SMatthias Ringwald 
3770d7891039SMatthias Ringwald             // update sco payload length for eSCO connections
3771d7891039SMatthias Ringwald             if (hci_event_synchronous_connection_complete_get_tx_packet_length(packet) > 0){
3772d7891039SMatthias Ringwald                 conn->sco_payload_length = hci_event_synchronous_connection_complete_get_tx_packet_length(packet);
3773d7891039SMatthias Ringwald                 log_info("eSCO Complete, set payload len %u", conn->sco_payload_length);
3774d7891039SMatthias Ringwald             }
3775d7891039SMatthias Ringwald 
3776ee752bb8SMatthias Ringwald #ifdef ENABLE_SCO_OVER_HCI
3777ee752bb8SMatthias Ringwald             // update SCO
3778ee752bb8SMatthias Ringwald             if (conn->address_type == BD_ADDR_TYPE_SCO && hci_stack->hci_transport && hci_stack->hci_transport->set_sco_config){
3779ee752bb8SMatthias Ringwald                 hci_stack->hci_transport->set_sco_config(hci_stack->sco_voice_setting_active, hci_number_sco_connections());
3780ee752bb8SMatthias Ringwald             }
3781f234b250SMatthias Ringwald             // trigger can send now
3782f234b250SMatthias Ringwald             if (hci_have_usb_transport()){
37831972f31fSMatthias Ringwald                 hci_stack->sco_can_send_now = true;
3784f234b250SMatthias Ringwald             }
3785fa7f2dfdSMatthias Ringwald 
3786fa7f2dfdSMatthias Ringwald             // setup implict sco flow control
3787fa7f2dfdSMatthias Ringwald             conn->sco_tx_ready = 0;
3788fa7f2dfdSMatthias Ringwald             conn->sco_tx_active  = 0;
3789fa7f2dfdSMatthias Ringwald             conn->sco_established_ms = btstack_run_loop_get_time_ms();
3790fa7f2dfdSMatthias Ringwald 
3791ee752bb8SMatthias Ringwald #endif
3792cb70c5abSMatthias Ringwald #ifdef HAVE_SCO_TRANSPORT
3793cb70c5abSMatthias Ringwald             // configure sco transport
3794cb70c5abSMatthias Ringwald             if (hci_stack->sco_transport != NULL){
3795cb70c5abSMatthias Ringwald                 sco_format_t sco_format = ((hci_stack->sco_voice_setting_active & 0x03) == 0x03) ? SCO_FORMAT_8_BIT : SCO_FORMAT_16_BIT;
3796cb70c5abSMatthias Ringwald                 hci_stack->sco_transport->open(conn->con_handle, sco_format);
3797cb70c5abSMatthias Ringwald             }
3798cb70c5abSMatthias Ringwald #endif
379944d0e3d5S[email protected]             break;
380044d0e3d5S[email protected] 
3801afd4e962S[email protected]         case HCI_EVENT_READ_REMOTE_SUPPORTED_FEATURES_COMPLETE:
3802f8fbdce0SMatthias Ringwald             handle = little_endian_read_16(packet, 3);
3803afd4e962S[email protected]             conn = hci_connection_for_handle(handle);
3804afd4e962S[email protected]             if (!conn) break;
3805afd4e962S[email protected]             if (!packet[2]){
38062f5c44baSMatthias Ringwald                 const uint8_t * features = &packet[5];
38072f5c44baSMatthias Ringwald                 hci_handle_remote_features_page_0(conn, features);
38082f5c44baSMatthias Ringwald 
38095ccef624SMatthias Ringwald                 // read extended features if possible
38101ffa425cSMatthias Ringwald                 if (hci_command_supported(SUPPORTED_HCI_COMMAND_READ_REMOTE_EXTENDED_FEATURES)
38111ffa425cSMatthias Ringwald                 && ((conn->remote_supported_features[0] & 2) != 0)) {
38125ccef624SMatthias Ringwald                     conn->bonding_flags |= BONDING_REQUEST_REMOTE_FEATURES_PAGE_1;
38135ccef624SMatthias Ringwald                     break;
38145ccef624SMatthias Ringwald                 }
38155ccef624SMatthias Ringwald             }
38165ccef624SMatthias Ringwald             hci_handle_remote_features_received(conn);
38175ccef624SMatthias Ringwald             break;
38185ccef624SMatthias Ringwald 
38195ccef624SMatthias Ringwald         case HCI_EVENT_READ_REMOTE_EXTENDED_FEATURES_COMPLETE:
38205ccef624SMatthias Ringwald             handle = little_endian_read_16(packet, 3);
38215ccef624SMatthias Ringwald             conn = hci_connection_for_handle(handle);
38225ccef624SMatthias Ringwald             if (!conn) break;
38235ccef624SMatthias Ringwald             // status = ok, page = 1
382450c51a77SMatthias Ringwald             if (!packet[2]) {
382550c51a77SMatthias Ringwald                 uint8_t page_number = packet[5];
382650c51a77SMatthias Ringwald                 uint8_t maximum_page_number = packet[6];
38275ccef624SMatthias Ringwald                 const uint8_t * features = &packet[7];
382850c51a77SMatthias Ringwald                 bool done = false;
382950c51a77SMatthias Ringwald                 switch (page_number){
383050c51a77SMatthias Ringwald                     case 1:
38312f5c44baSMatthias Ringwald                         hci_handle_remote_features_page_1(conn, features);
383250c51a77SMatthias Ringwald                         if (maximum_page_number >= 2){
383350c51a77SMatthias Ringwald                             // get Secure Connections (Controller) from Page 2 if available
383450c51a77SMatthias Ringwald                             conn->bonding_flags |= BONDING_REQUEST_REMOTE_FEATURES_PAGE_2;
383550c51a77SMatthias Ringwald                         } else {
383650c51a77SMatthias Ringwald                             // otherwise, assume SC (Controller) == SC (Host)
383750c51a77SMatthias Ringwald                             if ((conn->bonding_flags & BONDING_REMOTE_SUPPORTS_SC_HOST) != 0){
383850c51a77SMatthias Ringwald                                 conn->bonding_flags |= BONDING_REMOTE_SUPPORTS_SC_CONTROLLER;
383950c51a77SMatthias Ringwald                             }
384050c51a77SMatthias Ringwald                             done = true;
384150c51a77SMatthias Ringwald                         }
384250c51a77SMatthias Ringwald                         break;
384350c51a77SMatthias Ringwald                     case 2:
384450c51a77SMatthias Ringwald                         hci_handle_remote_features_page_2(conn, features);
384550c51a77SMatthias Ringwald                         done = true;
384650c51a77SMatthias Ringwald                         break;
384750c51a77SMatthias Ringwald                     default:
384850c51a77SMatthias Ringwald                         break;
384950c51a77SMatthias Ringwald                 }
385050c51a77SMatthias Ringwald                 if (!done) break;
3851afd4e962S[email protected]             }
3852de0df013SMatthias Ringwald             hci_handle_remote_features_received(conn);
3853afd4e962S[email protected]             break;
3854afd4e962S[email protected] 
38557fde4af9Smatthias.ringwald         case HCI_EVENT_LINK_KEY_REQUEST:
3856308eeaffSMatthias Ringwald #ifndef ENABLE_EXPLICIT_LINK_KEY_REPLY
385763c0b2fdSMatthias Ringwald             hci_event_link_key_request_get_bd_addr(packet, addr);
385863c0b2fdSMatthias Ringwald             conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL);
385963c0b2fdSMatthias Ringwald             if (!conn) break;
386063c0b2fdSMatthias Ringwald 
386163c0b2fdSMatthias Ringwald             // lookup link key in db if not cached
386263c0b2fdSMatthias Ringwald             if ((conn->link_key_type == INVALID_LINK_KEY) && (hci_stack->link_key_db != NULL)){
386363c0b2fdSMatthias Ringwald                 hci_stack->link_key_db->get_link_key(conn->address, conn->link_key, &conn->link_key_type);
386463c0b2fdSMatthias Ringwald             }
386563c0b2fdSMatthias Ringwald 
386663c0b2fdSMatthias Ringwald             // response sent by hci_run()
386763c0b2fdSMatthias Ringwald             conn->authentication_flags |= AUTH_FLAG_HANDLE_LINK_KEY_REQUEST;
386863c0b2fdSMatthias Ringwald #endif
3869608f51bbSMatthias Ringwald             break;
38707fde4af9Smatthias.ringwald 
38719ab95c90S[email protected]         case HCI_EVENT_LINK_KEY_NOTIFICATION: {
38721714cbbdSMatthias Ringwald             hci_event_link_key_request_get_bd_addr(packet, addr);
3873f16129ceSMatthias Ringwald             conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL);
38749ab95c90S[email protected]             if (!conn) break;
38751714cbbdSMatthias Ringwald 
38761714cbbdSMatthias Ringwald             hci_pairing_complete(conn, ERROR_CODE_SUCCESS);
38771714cbbdSMatthias Ringwald 
38783817f9dfSMatthias Ringwald             // CVE-2020-26555: ignore NULL link key
38793817f9dfSMatthias Ringwald             // default link_key_type = INVALID_LINK_KEY asserts that NULL key won't be used for encryption
38803817f9dfSMatthias Ringwald             if (btstack_is_null(&packet[8], 16)) break;
38813817f9dfSMatthias Ringwald 
38827bdc6798S[email protected]             link_key_type_t link_key_type = (link_key_type_t)packet[24];
38839ab95c90S[email protected]             // Change Connection Encryption keeps link key type
38849ab95c90S[email protected]             if (link_key_type != CHANGED_COMBINATION_KEY){
38859ab95c90S[email protected]                 conn->link_key_type = link_key_type;
38869ab95c90S[email protected]             }
38873817f9dfSMatthias Ringwald 
3888e9f98c4aSMatthias Ringwald             // cache link key. link keys stored in little-endian format for legacy reasons
3889e9f98c4aSMatthias Ringwald             memcpy(&conn->link_key, &packet[8], 16);
3890e9f98c4aSMatthias Ringwald 
3891bec5f683SMatthias Ringwald             // only store link key:
3892bec5f683SMatthias Ringwald             // - if bondable enabled
3893bec5f683SMatthias Ringwald             if (hci_stack->bondable == false) break;
38946edaed7fSMatthias Ringwald             // - if security level sufficient
38956edaed7fSMatthias Ringwald             if (gap_security_level_for_link_key_type(link_key_type) < conn->requested_security_level) break;
389655597469SMatthias Ringwald             gap_store_link_key_for_bd_addr(addr, &packet[8], conn->link_key_type);
38977fde4af9Smatthias.ringwald             break;
38989ab95c90S[email protected]         }
38997fde4af9Smatthias.ringwald 
39007fde4af9Smatthias.ringwald         case HCI_EVENT_PIN_CODE_REQUEST:
39011714cbbdSMatthias Ringwald             hci_event_pin_code_request_get_bd_addr(packet, addr);
39021714cbbdSMatthias Ringwald             conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL);
39031714cbbdSMatthias Ringwald             if (!conn) break;
39041714cbbdSMatthias Ringwald 
39051714cbbdSMatthias Ringwald             hci_pairing_started(conn, false);
3906a800d95eSMatthias Ringwald             // abort pairing if: non-bondable mode (pin code request is not forwarded to app)
39073a9fb326S[email protected]             if (!hci_stack->bondable ){
39088daf94bcSMatthias Ringwald                 conn->authentication_flags |= AUTH_FLAG_DENY_PIN_CODE_REQUEST;
39091714cbbdSMatthias Ringwald                 hci_pairing_complete(conn, ERROR_CODE_PAIRING_NOT_ALLOWED);
3910f8fb5f6eS[email protected]                 hci_run();
3911f8fb5f6eS[email protected]                 return;
39124c57c146S[email protected]             }
3913a800d95eSMatthias Ringwald             // abort pairing if: LEVEL_4 required (pin code request is not forwarded to app)
3914a800d95eSMatthias Ringwald             if ((hci_stack->gap_secure_connections_only_mode) || (conn->requested_security_level == LEVEL_4)){
3915a800d95eSMatthias Ringwald                 log_info("Level 4 required, but SC not supported -> abort");
391650dcc63cSMatthias Ringwald                 conn->authentication_flags |= AUTH_FLAG_DENY_PIN_CODE_REQUEST;
391750dcc63cSMatthias Ringwald                 hci_pairing_complete(conn, ERROR_CODE_INSUFFICIENT_SECURITY);
391850dcc63cSMatthias Ringwald                 hci_run();
391950dcc63cSMatthias Ringwald                 return;
392050dcc63cSMatthias Ringwald             }
39217fde4af9Smatthias.ringwald             break;
39227fde4af9Smatthias.ringwald 
392350d7398cSMatthias Ringwald         case HCI_EVENT_IO_CAPABILITY_RESPONSE:
392450d7398cSMatthias Ringwald             hci_event_io_capability_response_get_bd_addr(packet, addr);
392550d7398cSMatthias Ringwald             conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL);
392650d7398cSMatthias Ringwald             if (!conn) break;
39271714cbbdSMatthias Ringwald 
39288daf94bcSMatthias Ringwald             hci_add_connection_flags_for_flipped_bd_addr(&packet[2], AUTH_FLAG_RECV_IO_CAPABILITIES_RESPONSE);
39291714cbbdSMatthias Ringwald             hci_pairing_started(conn, true);
393050d7398cSMatthias Ringwald             conn->io_cap_response_auth_req = hci_event_io_capability_response_get_authentication_requirements(packet);
3931e276e383SMatthias Ringwald             conn->io_cap_response_io       = hci_event_io_capability_response_get_io_capability(packet);
3932d22b82d6SMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB
3933d22b82d6SMatthias Ringwald             conn->io_cap_response_oob_data = hci_event_io_capability_response_get_oob_data_present(packet);
3934d22b82d6SMatthias Ringwald #endif
393550d7398cSMatthias Ringwald             break;
393650d7398cSMatthias Ringwald 
39371d6b20aeS[email protected]         case HCI_EVENT_IO_CAPABILITY_REQUEST:
39381714cbbdSMatthias Ringwald             hci_event_io_capability_response_get_bd_addr(packet, addr);
39391714cbbdSMatthias Ringwald             conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL);
39401714cbbdSMatthias Ringwald             if (!conn) break;
39411714cbbdSMatthias Ringwald 
3942c950c316SMatthias Ringwald             hci_add_connection_flags_for_flipped_bd_addr(&packet[2], AUTH_FLAG_RECV_IO_CAPABILITIES_REQUEST);
39439671e615SMatthias Ringwald             hci_connection_timestamp(conn);
39441714cbbdSMatthias Ringwald             hci_pairing_started(conn, true);
3945dbe1a790S[email protected]             break;
3946dbe1a790S[email protected] 
39471849becdSMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB
39481849becdSMatthias Ringwald         case HCI_EVENT_REMOTE_OOB_DATA_REQUEST:
39497ca4a7edSMatthias Ringwald             hci_event_remote_oob_data_request_get_bd_addr(packet, addr);
39507ca4a7edSMatthias Ringwald             conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL);
39517ca4a7edSMatthias Ringwald             if (!conn) break;
39527ca4a7edSMatthias Ringwald 
39537ca4a7edSMatthias Ringwald             hci_connection_timestamp(conn);
39547ca4a7edSMatthias Ringwald 
39557ca4a7edSMatthias Ringwald             hci_pairing_started(conn, true);
39567ca4a7edSMatthias Ringwald 
39577ca4a7edSMatthias Ringwald             connectionSetAuthenticationFlags(conn, AUTH_FLAG_SEND_REMOTE_OOB_DATA_REPLY);
39581849becdSMatthias Ringwald             break;
39591849becdSMatthias Ringwald #endif
39601849becdSMatthias Ringwald 
3961dbe1a790S[email protected]         case HCI_EVENT_USER_CONFIRMATION_REQUEST:
396217c6fe5cSMatthias Ringwald             hci_event_user_confirmation_request_get_bd_addr(packet, addr);
3963367aedc0SMatthias Ringwald             conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL);
3964367aedc0SMatthias Ringwald             if (!conn) break;
3965367aedc0SMatthias Ringwald             if (hci_ssp_security_level_possible_for_io_cap(conn->requested_security_level, hci_stack->ssp_io_capability, conn->io_cap_response_io)) {
3966367aedc0SMatthias Ringwald                 if (hci_stack->ssp_auto_accept){
39678daf94bcSMatthias Ringwald                     hci_add_connection_flags_for_flipped_bd_addr(&packet[2], AUTH_FLAG_SEND_USER_CONFIRM_REPLY);
3968367aedc0SMatthias Ringwald                 };
3969367aedc0SMatthias Ringwald             } else {
3970367aedc0SMatthias Ringwald                 hci_pairing_complete(conn, ERROR_CODE_INSUFFICIENT_SECURITY);
3971367aedc0SMatthias Ringwald                 hci_add_connection_flags_for_flipped_bd_addr(&packet[2], AUTH_FLAG_SEND_USER_CONFIRM_NEGATIVE_REPLY);
3972367aedc0SMatthias Ringwald                 // don't forward event to app
3973367aedc0SMatthias Ringwald                 hci_run();
3974367aedc0SMatthias Ringwald                 return;
3975367aedc0SMatthias Ringwald             }
3976dbe1a790S[email protected]             break;
3977dbe1a790S[email protected] 
3978dbe1a790S[email protected]         case HCI_EVENT_USER_PASSKEY_REQUEST:
3979367aedc0SMatthias Ringwald             // Pairing using Passkey results in MITM protection. If Level 4 is required, support for SC is validated on IO Cap Request
3980367aedc0SMatthias Ringwald             if (hci_stack->ssp_auto_accept){
39818daf94bcSMatthias Ringwald                 hci_add_connection_flags_for_flipped_bd_addr(&packet[2], AUTH_FLAG_SEND_USER_PASSKEY_REPLY);
3982367aedc0SMatthias Ringwald             };
39831d6b20aeS[email protected]             break;
39841849becdSMatthias Ringwald 
39853dce6128SMatthias Ringwald         case HCI_EVENT_MODE_CHANGE:
39863dce6128SMatthias Ringwald             handle = hci_event_mode_change_get_handle(packet);
39873dce6128SMatthias Ringwald             conn = hci_connection_for_handle(handle);
39883dce6128SMatthias Ringwald             if (!conn) break;
39893dce6128SMatthias Ringwald             conn->connection_mode = hci_event_mode_change_get_mode(packet);
39903dce6128SMatthias Ringwald             log_info("HCI_EVENT_MODE_CHANGE, handle 0x%04x, mode %u", handle, conn->connection_mode);
39913dce6128SMatthias Ringwald             break;
399235454696SMatthias Ringwald #endif
39931d6b20aeS[email protected] 
3994f0944df2S[email protected]         case HCI_EVENT_ENCRYPTION_CHANGE:
3995a355334eSMatthias Ringwald         case HCI_EVENT_ENCRYPTION_CHANGE_V2:
3996254b78eeSMatthias Ringwald             handle = hci_event_encryption_change_get_connection_handle(packet);
3997f0944df2S[email protected]             conn = hci_connection_for_handle(handle);
3998f0944df2S[email protected]             if (!conn) break;
3999db3c1f89SMatthias Ringwald             if (hci_event_encryption_change_get_status(packet) == ERROR_CODE_SUCCESS) {
4000254b78eeSMatthias Ringwald                 uint8_t encryption_enabled = hci_event_encryption_change_get_encryption_enabled(packet);
4001254b78eeSMatthias Ringwald                 if (encryption_enabled){
4002573897a0SMatthias Ringwald                     if (hci_is_le_connection(conn)){
4003573897a0SMatthias Ringwald                         // For LE, we accept connection as encrypted
40048daf94bcSMatthias Ringwald                         conn->authentication_flags |= AUTH_FLAG_CONNECTION_ENCRYPTED;
4005573897a0SMatthias Ringwald                     }
4006573897a0SMatthias Ringwald #ifdef ENABLE_CLASSIC
4007573897a0SMatthias Ringwald                     else {
4008fcaf38b9SMatthias Ringwald 
4009254b78eeSMatthias Ringwald                         // Detect Secure Connection -> Legacy Connection Downgrade Attack (BIAS)
401036c3546bSMatthias Ringwald                         bool sc_used_during_pairing = gap_secure_connection_for_link_key_type(conn->link_key_type);
4011254b78eeSMatthias Ringwald                         bool connected_uses_aes_ccm = encryption_enabled == 2;
4012edc1ac20SMatthias Ringwald                         if (hci_stack->secure_connections_active && sc_used_during_pairing && !connected_uses_aes_ccm){
4013813a09c6SMatthias Ringwald #ifdef ENABLE_TESTING_SUPPORT
4014813a09c6SMatthias Ringwald                             // The following tests require to reject L2CAP connection as SC has been disabled on the remote
4015813a09c6SMatthias Ringwald                             // - GAP/SEC/SEM/BI-31-C
4016813a09c6SMatthias Ringwald                             // - GAP/SEC/SEM/BI-32-C
4017813a09c6SMatthias Ringwald                             // - GAP/SEC/SEM/BI-33-C
4018813a09c6SMatthias Ringwald 
4019813a09c6SMatthias Ringwald                             // Our release code (aggressively) disconnects the HCI connection, without a chance to respond to PTS
4020813a09c6SMatthias Ringwald                             // To pass the tests, we only downgrade the link key type instead of the more secure disconnect
402129d4766dSMatthias Ringwald                             link_key_type_t new_link_key_type = UNAUTHENTICATED_COMBINATION_KEY_GENERATED_FROM_P192;
402229d4766dSMatthias Ringwald                             if (conn->link_key_type == AUTHENTICATED_COMBINATION_KEY_GENERATED_FROM_P256){
4023813a09c6SMatthias Ringwald                                 new_link_key_type = AUTHENTICATED_COMBINATION_KEY_GENERATED_FROM_P192;
4024813a09c6SMatthias Ringwald                             }
4025813a09c6SMatthias Ringwald                             log_info("SC during pairing, but only E0 now -> downgrade link key type from %u to %u",
4026813a09c6SMatthias Ringwald                                      conn->link_key_type, new_link_key_type);
4027813a09c6SMatthias Ringwald                             conn->link_key_type = new_link_key_type;
4028813a09c6SMatthias Ringwald #else
4029254b78eeSMatthias Ringwald                             log_info("SC during pairing, but only E0 now -> abort");
40309ece71c2SMatthias Ringwald                             conn->bonding_flags |= BONDING_DISCONNECT_SECURITY_BLOCK;
4031254b78eeSMatthias Ringwald                             break;
4032813a09c6SMatthias Ringwald #endif
4033254b78eeSMatthias Ringwald                         }
4034254b78eeSMatthias Ringwald 
4035aa2fe986SMatthias Ringwald                         // if AES-CCM is used, authentication used SC -> authentication was mutual and we can skip explicit authentication
4036aa2fe986SMatthias Ringwald                         if (connected_uses_aes_ccm){
4037aa2fe986SMatthias Ringwald                             conn->authentication_flags |= AUTH_FLAG_CONNECTION_AUTHENTICATED;
4038aa2fe986SMatthias Ringwald                         }
4039aa2fe986SMatthias Ringwald 
4040aa2fe986SMatthias Ringwald #ifdef ENABLE_TESTING_SUPPORT
4041aa2fe986SMatthias Ringwald                         // work around for issue with PTS dongle
4042aa2fe986SMatthias Ringwald                         conn->authentication_flags |= AUTH_FLAG_CONNECTION_AUTHENTICATED;
4043aa2fe986SMatthias Ringwald #endif
4044a355334eSMatthias Ringwald                         // validate encryption key size
4045a355334eSMatthias Ringwald                         if (hci_event_packet_get_type(packet) == HCI_EVENT_ENCRYPTION_CHANGE_V2) {
4046a355334eSMatthias Ringwald                             uint8_t encryption_key_size = hci_event_encryption_change_v2_get_encryption_key_size(packet);
4047a355334eSMatthias Ringwald                             // already got encryption key size
4048a355334eSMatthias Ringwald                             hci_handle_read_encryption_key_size_complete(conn, encryption_key_size);
4049a355334eSMatthias Ringwald                         } else {
40501ffa425cSMatthias Ringwald                             if (hci_command_supported(SUPPORTED_HCI_COMMAND_READ_ENCRYPTION_KEY_SIZE)) {
40516e058d3fSMatthias Ringwald                                 // For Classic, we need to validate encryption key size first, if possible (== supported by Controller)
4052573897a0SMatthias Ringwald                                 conn->bonding_flags |= BONDING_SEND_READ_ENCRYPTION_KEY_SIZE;
40536e058d3fSMatthias Ringwald                             } else {
40546e058d3fSMatthias Ringwald                                 // if not, pretend everything is perfect
40559866fdc7SMatthias Ringwald                                 hci_handle_read_encryption_key_size_complete(conn, 16);
40566e058d3fSMatthias Ringwald                             }
4057573897a0SMatthias Ringwald                         }
4058a355334eSMatthias Ringwald                     }
4059573897a0SMatthias Ringwald #endif
4060f0944df2S[email protected]                 } else {
40618daf94bcSMatthias Ringwald                     conn->authentication_flags &= ~AUTH_FLAG_CONNECTION_ENCRYPTED;
4062f0944df2S[email protected]                 }
40635999ee11SMatthias Ringwald             } else {
40648eae094cSMatthias Ringwald #ifdef ENABLE_CLASSIC
40658eae094cSMatthias Ringwald                 if (!hci_is_le_connection(conn)){
40665999ee11SMatthias Ringwald                     uint8_t status = hci_event_encryption_change_get_status(packet);
40675999ee11SMatthias Ringwald                     if ((conn->bonding_flags & BONDING_DEDICATED) != 0){
40685999ee11SMatthias Ringwald                         conn->bonding_flags &= ~BONDING_DEDICATED;
40695999ee11SMatthias Ringwald                         conn->bonding_flags |= BONDING_DISCONNECT_DEDICATED_DONE;
40705999ee11SMatthias Ringwald                         conn->bonding_status = status;
40715999ee11SMatthias Ringwald                     }
407227b992efSMatthias Ringwald                     // trigger security update -> level 0
407327b992efSMatthias Ringwald                     hci_handle_mutual_authentication_completed(conn);
4074ad83dc6aS[email protected]                 }
40758eae094cSMatthias Ringwald #endif
40768eae094cSMatthias Ringwald             }
4077573897a0SMatthias Ringwald 
4078f0944df2S[email protected]             break;
4079f0944df2S[email protected] 
408035454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
40811eb2563eS[email protected]         case HCI_EVENT_AUTHENTICATION_COMPLETE_EVENT:
4082abdad579SMatthias Ringwald             handle = hci_event_authentication_complete_get_connection_handle(packet);
40831eb2563eS[email protected]             conn = hci_connection_for_handle(handle);
40841eb2563eS[email protected]             if (!conn) break;
4085ad83dc6aS[email protected] 
4086dbd5dcc3SMatthias Ringwald             // clear authentication active flag
4087dbd5dcc3SMatthias Ringwald             conn->bonding_flags &= ~BONDING_SENT_AUTHENTICATE_REQUEST;
40881714cbbdSMatthias Ringwald             hci_pairing_complete(conn, hci_event_authentication_complete_get_status(packet));
4089dbd5dcc3SMatthias Ringwald 
4090abdad579SMatthias Ringwald             // authenticated only if auth status == 0
4091abdad579SMatthias Ringwald             if (hci_event_authentication_complete_get_status(packet) == 0){
4092abdad579SMatthias Ringwald                 // authenticated
40938daf94bcSMatthias Ringwald                 conn->authentication_flags |= AUTH_FLAG_CONNECTION_AUTHENTICATED;
4094abdad579SMatthias Ringwald 
4095131ef17aSMatthias Ringwald                 // If not already encrypted, start encryption
40968daf94bcSMatthias Ringwald                 if ((conn->authentication_flags & AUTH_FLAG_CONNECTION_ENCRYPTED) == 0){
40971eb2563eS[email protected]                     conn->bonding_flags |= BONDING_SEND_ENCRYPTION_REQUEST;
4098ad83dc6aS[email protected]                     break;
4099ad83dc6aS[email protected]                 }
4100abdad579SMatthias Ringwald             }
4101abdad579SMatthias Ringwald 
41024aa2f135SMatthias Ringwald             // emit updated security level (will be 0 if not authenticated)
41034aa2f135SMatthias Ringwald             hci_handle_mutual_authentication_completed(conn);
41041eb2563eS[email protected]             break;
41051714cbbdSMatthias Ringwald 
41061714cbbdSMatthias Ringwald         case HCI_EVENT_SIMPLE_PAIRING_COMPLETE:
41071714cbbdSMatthias Ringwald             hci_event_simple_pairing_complete_get_bd_addr(packet, addr);
41081714cbbdSMatthias Ringwald             conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL);
41091714cbbdSMatthias Ringwald             if (!conn) break;
41101714cbbdSMatthias Ringwald 
4111aa2fe986SMatthias Ringwald             // treat successfully paired connection as authenticated
4112aa2fe986SMatthias Ringwald             if (hci_event_simple_pairing_complete_get_status(packet) == ERROR_CODE_SUCCESS){
4113f3aafff1SMatthias Ringwald                 conn->authentication_flags |= AUTH_FLAG_CONNECTION_AUTHENTICATED;
4114aa2fe986SMatthias Ringwald             }
4115aa2fe986SMatthias Ringwald 
41161714cbbdSMatthias Ringwald             hci_pairing_complete(conn, hci_event_simple_pairing_complete_get_status(packet));
41171714cbbdSMatthias Ringwald             break;
411835454696SMatthias Ringwald #endif
411934d2123cS[email protected] 
412086805605S[email protected]         // HCI_EVENT_DISCONNECTION_COMPLETE
4121ccda6e14S[email protected]         // has been split, to first notify stack before shutting connection down
4122ccda6e14S[email protected]         // see end of function, too.
4123a4f30ec0S[email protected]         case HCI_EVENT_DISCONNECTION_COMPLETE:
4124a4f30ec0S[email protected]             if (packet[2]) break;   // status != 0
4125f8fbdce0SMatthias Ringwald             handle = little_endian_read_16(packet, 3);
412681d2bdb2SMatthias Ringwald             // drop outgoing ACL fragments if it is for closed connection and release buffer if tx not active
41274ea43905SMatthias Ringwald             if (hci_stack->acl_fragmentation_total_size > 0u) {
4128c6a37cfdSMatthias Ringwald                 if (handle == READ_ACL_CONNECTION_HANDLE(hci_stack->hci_packet_buffer)){
41294ea43905SMatthias Ringwald                     int release_buffer = hci_stack->acl_fragmentation_tx_active == 0u;
413081d2bdb2SMatthias Ringwald                     log_info("drop fragmented ACL data for closed connection, release buffer %u", release_buffer);
4131c6a37cfdSMatthias Ringwald                     hci_stack->acl_fragmentation_total_size = 0;
4132c6a37cfdSMatthias Ringwald                     hci_stack->acl_fragmentation_pos = 0;
413381d2bdb2SMatthias Ringwald                     if (release_buffer){
413481d2bdb2SMatthias Ringwald                         hci_release_packet_buffer();
413581d2bdb2SMatthias Ringwald                     }
4136c6a37cfdSMatthias Ringwald                 }
4137c6a37cfdSMatthias Ringwald             }
413835454696SMatthias Ringwald 
41394ae8623eSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
4140098c2716SMatthias Ringwald             // drop outgoing ISO fragments if it is for closed connection and release buffer if tx not active
4141098c2716SMatthias Ringwald             if (hci_stack->iso_fragmentation_total_size > 0u) {
4142098c2716SMatthias Ringwald                 if (handle == READ_ISO_CONNECTION_HANDLE(hci_stack->hci_packet_buffer)){
4143098c2716SMatthias Ringwald                     int release_buffer = hci_stack->iso_fragmentation_tx_active == 0u;
4144098c2716SMatthias Ringwald                     log_info("drop fragmented ISO data for closed connection, release buffer %u", release_buffer);
4145098c2716SMatthias Ringwald                     hci_stack->iso_fragmentation_total_size = 0;
4146098c2716SMatthias Ringwald                     hci_stack->iso_fragmentation_pos = 0;
4147098c2716SMatthias Ringwald                     if (release_buffer){
4148098c2716SMatthias Ringwald                         hci_release_packet_buffer();
4149098c2716SMatthias Ringwald                     }
4150098c2716SMatthias Ringwald                 }
4151098c2716SMatthias Ringwald             }
4152098c2716SMatthias Ringwald 
41536fd1d2c8SMatthias Ringwald             // finalize iso stream for CIS handle
415415a15be3SMatthias Ringwald             iso_stream = hci_iso_stream_for_con_handle(handle);
41554ae8623eSMatthias Ringwald             if (iso_stream != NULL){
41564ae8623eSMatthias Ringwald                 hci_iso_stream_finalize(iso_stream);
41574ae8623eSMatthias Ringwald                 break;
41584ae8623eSMatthias Ringwald             }
41596fd1d2c8SMatthias Ringwald 
41606fd1d2c8SMatthias Ringwald             // finalize iso stream(s) for ACL handle
41616fd1d2c8SMatthias Ringwald             btstack_linked_list_iterator_init(&it, &hci_stack->iso_streams);
41626fd1d2c8SMatthias Ringwald             while (btstack_linked_list_iterator_has_next(&it)){
41636fd1d2c8SMatthias Ringwald                 hci_iso_stream_t * iso_stream = (hci_iso_stream_t *) btstack_linked_list_iterator_next(&it);
41646fd1d2c8SMatthias Ringwald                 if (iso_stream->acl_handle == handle ) {
41656fd1d2c8SMatthias Ringwald                     hci_iso_stream_finalize(iso_stream);
41666fd1d2c8SMatthias Ringwald                 }
41676fd1d2c8SMatthias Ringwald             }
41684ae8623eSMatthias Ringwald #endif
41694ae8623eSMatthias Ringwald 
417091036612SMatthias Ringwald #if defined(ENABLE_BLE) && defined (ENABLE_HCI_COMMAND_STATUS_DISCARDED_FOR_FAILED_CONNECTIONS_WORKAROUND)
4171f48a5586SMatthias Ringwald             if ((handle != HCI_CON_HANDLE_INVALID) && (handle == hci_stack->hci_command_con_handle)){
4172f48a5586SMatthias Ringwald                 // we did not receive a HCI Command Complete or HCI Command Status event for the disconnected connection
4173f48a5586SMatthias Ringwald                 // if needed, we could also track the hci command opcode and simulate a hci command complete with status
4174f48a5586SMatthias Ringwald                 // but the connection has failed anyway, so for now, we only set the num hci commands back to 1
417505acf48bSMatthias Ringwald                 log_info("Disconnect for conn handle 0x%04x in pending HCI command, assume command failed", handle);
417605acf48bSMatthias Ringwald                 hci_stack->hci_command_con_handle = HCI_CON_HANDLE_INVALID;
4177f48a5586SMatthias Ringwald                 hci_stack->num_cmd_packets = 1;
4178f48a5586SMatthias Ringwald             }
4179f48a5586SMatthias Ringwald #endif
4180f48a5586SMatthias Ringwald 
4181c6a37cfdSMatthias Ringwald             conn = hci_connection_for_handle(handle);
4182c6a37cfdSMatthias Ringwald             if (!conn) break;
41831714cbbdSMatthias Ringwald #ifdef ENABLE_CLASSIC
41841714cbbdSMatthias Ringwald             // pairing failed if it was ongoing
41851714cbbdSMatthias Ringwald             hci_pairing_complete(conn, ERROR_CODE_REMOTE_USER_TERMINATED_CONNECTION);
41861714cbbdSMatthias Ringwald #endif
4187046ec007SMatthias Ringwald 
4188046ec007SMatthias Ringwald             // emit dedicatd bonding event
4189046ec007SMatthias Ringwald             if (conn->bonding_flags & BONDING_EMIT_COMPLETE_ON_DISCONNECT){
4190046ec007SMatthias Ringwald                 hci_emit_dedicated_bonding_result(conn->address, conn->bonding_status);
4191046ec007SMatthias Ringwald             }
4192046ec007SMatthias Ringwald 
4193459d27b9SMatthias Ringwald             // mark connection for shutdown, stop timers, reset state
4194459d27b9SMatthias Ringwald             conn->state = RECEIVED_DISCONNECTION_COMPLETE;
4195459d27b9SMatthias Ringwald             hci_connection_stop_timer(conn);
4196459d27b9SMatthias Ringwald             hci_connection_init(conn);
4197459d27b9SMatthias Ringwald 
419835454696SMatthias Ringwald #ifdef ENABLE_BLE
4199d70217a2SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
4200046ec007SMatthias Ringwald             // re-enable advertisements for le connections if active
42012b6ab3e6SMatthias Ringwald             if (hci_is_le_connection(conn)){
4202bbc366e6SMatthias Ringwald                 hci_update_advertisements_enabled_for_current_roles();
42039a2e4658SMatthias Ringwald             }
420435454696SMatthias Ringwald #endif
4205d70217a2SMatthias Ringwald #endif
4206ccda6e14S[email protected]             break;
42076772a24cSmatthias.ringwald 
4208c68bdf90Smatthias.ringwald         case HCI_EVENT_HARDWARE_ERROR:
4209313e5f9cSMatthias Ringwald             log_error("Hardware Error: 0x%02x", packet[2]);
4210d23838ecSMatthias Ringwald             if (hci_stack->hardware_error_callback){
4211c2e1fa60SMatthias Ringwald                 (*hci_stack->hardware_error_callback)(packet[2]);
42127586ee35S[email protected]             } else {
42137586ee35S[email protected]                 // if no special requests, just reboot stack
42147586ee35S[email protected]                 hci_power_control_off();
42157586ee35S[email protected]                 hci_power_control_on();
4216c68bdf90Smatthias.ringwald             }
4217c68bdf90Smatthias.ringwald             break;
4218c68bdf90Smatthias.ringwald 
42190e6f3837SMatthias Ringwald #ifdef ENABLE_CLASSIC
42205cf766e8SMatthias Ringwald         case HCI_EVENT_ROLE_CHANGE:
42215cf766e8SMatthias Ringwald             if (packet[2]) break;   // status != 0
4222c4c88f1bSJakob Krantz             reverse_bd_addr(&packet[3], addr);
4223f16129ceSMatthias Ringwald             addr_type = BD_ADDR_TYPE_ACL;
4224c4c88f1bSJakob Krantz             conn = hci_connection_for_bd_addr_and_type(addr, addr_type);
4225c4c88f1bSJakob Krantz             if (!conn) break;
422688f925b1SMatthias Ringwald             conn->role = (hci_role_t) packet[9];
42275cf766e8SMatthias Ringwald             break;
42280e6f3837SMatthias Ringwald #endif
42295cf766e8SMatthias Ringwald 
423063fa3374SMatthias Ringwald         case HCI_EVENT_TRANSPORT_PACKET_SENT:
4231098c2716SMatthias Ringwald             // release packet buffer only for asynchronous transport and if there are not further fragments
42324fa24b5fS[email protected]             if (hci_transport_synchronous()) {
423363fa3374SMatthias Ringwald                 log_error("Synchronous HCI Transport shouldn't send HCI_EVENT_TRANSPORT_PACKET_SENT");
42344fa24b5fS[email protected]                 return; // instead of break: to avoid re-entering hci_run()
42354fa24b5fS[email protected]             }
423681d2bdb2SMatthias Ringwald             hci_stack->acl_fragmentation_tx_active = 0;
4237098c2716SMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
4238098c2716SMatthias Ringwald             hci_stack->iso_fragmentation_tx_active = 0;
4239098c2716SMatthias Ringwald             if (hci_stack->iso_fragmentation_total_size) break;
4240098c2716SMatthias Ringwald #endif
4241d051460cS[email protected]             if (hci_stack->acl_fragmentation_total_size) break;
4242d051460cS[email protected]             hci_release_packet_buffer();
4243701e3307SMatthias Ringwald 
42445ade6657SMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
42455ade6657SMatthias Ringwald             hci_iso_notify_can_send_now();
42465ade6657SMatthias Ringwald #endif
424763fa3374SMatthias Ringwald             // L2CAP receives this event via the hci_emit_event below
424863fa3374SMatthias Ringwald 
424935454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
425063fa3374SMatthias Ringwald             // For SCO, we do the can_send_now_check here
4251701e3307SMatthias Ringwald             hci_notify_if_sco_can_send_now();
425235454696SMatthias Ringwald #endif
42536b4af23dS[email protected]             break;
42546b4af23dS[email protected] 
425535454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
425663fa3374SMatthias Ringwald         case HCI_EVENT_SCO_CAN_SEND_NOW:
425763fa3374SMatthias Ringwald             // For SCO, we do the can_send_now_check here
42581972f31fSMatthias Ringwald             hci_stack->sco_can_send_now = true;
425963fa3374SMatthias Ringwald             hci_notify_if_sco_can_send_now();
426063fa3374SMatthias Ringwald             return;
42611cfb383eSMatthias Ringwald 
42621cfb383eSMatthias Ringwald         // explode inquriy results for easier consumption
42631cfb383eSMatthias Ringwald         case HCI_EVENT_INQUIRY_RESULT:
42641cfb383eSMatthias Ringwald         case HCI_EVENT_INQUIRY_RESULT_WITH_RSSI:
42651cfb383eSMatthias Ringwald         case HCI_EVENT_EXTENDED_INQUIRY_RESPONSE:
42669784dac1SMatthias Ringwald             gap_inquiry_explode(packet, size);
42671cfb383eSMatthias Ringwald             break;
426835454696SMatthias Ringwald #endif
426963fa3374SMatthias Ringwald 
4270a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE
42715909f7f2Smatthias.ringwald         case HCI_EVENT_LE_META:
42725909f7f2Smatthias.ringwald             switch (packet[2]){
4273d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
427457c9da5bS[email protected]                 case HCI_SUBEVENT_LE_ADVERTISING_REPORT:
42756fab74dbSMatthias Ringwald                     if (!hci_stack->le_scanning_enabled) break;
427657c9da5bS[email protected]                     le_handle_advertisement_report(packet, size);
42777bdc6798S[email protected]                     break;
4278a0698cb4SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
4279a0698cb4SMatthias Ringwald                 case HCI_SUBEVENT_LE_EXTENDED_ADVERTISING_REPORT:
4280a0698cb4SMatthias Ringwald                     if (!hci_stack->le_scanning_enabled) break;
4281a0698cb4SMatthias Ringwald                     le_handle_extended_advertisement_report(packet, size);
4282a0698cb4SMatthias Ringwald                     break;
4283ce56b945SMatthias Ringwald                 case HCI_SUBEVENT_LE_PERIODIC_ADVERTISING_SYNC_ESTABLISHMENT:
4284ce56b945SMatthias Ringwald                     hci_stack->le_periodic_sync_request = LE_CONNECTING_IDLE;
4285ce56b945SMatthias Ringwald                     hci_stack->le_periodic_sync_state = LE_CONNECTING_IDLE;
4286ce56b945SMatthias Ringwald                     break;
428789254d99SMatthias Ringwald                 case HCI_SUBEVENT_LE_ADVERTISING_SET_TERMINATED:
428889254d99SMatthias Ringwald                     advertising_handle = hci_subevent_le_advertising_set_terminated_get_advertising_handle(packet);
428989254d99SMatthias Ringwald                     btstack_linked_list_iterator_init(&it, &hci_stack->le_advertising_sets);
429089254d99SMatthias Ringwald                     while (btstack_linked_list_iterator_has_next(&it)) {
429189254d99SMatthias Ringwald                         le_advertising_set_t *advertising_set = (le_advertising_set_t *) btstack_linked_list_iterator_next(&it);
429289254d99SMatthias Ringwald                         if (advertising_set->advertising_handle == advertising_handle){
429389254d99SMatthias Ringwald                             advertising_set->state &= ~(LE_ADVERTISEMENT_STATE_ACTIVE | LE_ADVERTISEMENT_STATE_ENABLED);
429489254d99SMatthias Ringwald                         }
429589254d99SMatthias Ringwald                     }
429689254d99SMatthias Ringwald                     break;
4297a0698cb4SMatthias Ringwald #endif
4298d70217a2SMatthias Ringwald #endif
42995909f7f2Smatthias.ringwald                 case HCI_SUBEVENT_LE_CONNECTION_COMPLETE:
430060fb273dSMatthias Ringwald                 case HCI_SUBEVENT_LE_ENHANCED_CONNECTION_COMPLETE_V1:
430160fb273dSMatthias Ringwald                 case HCI_SUBEVENT_LE_ENHANCED_CONNECTION_COMPLETE_V2:
43020ce3f217SMatthias Ringwald 					event_handle_le_connection_complete(packet);
43035909f7f2Smatthias.ringwald                     break;
43045909f7f2Smatthias.ringwald 
4305f8fbdce0SMatthias Ringwald                 // log_info("LE buffer size: %u, count %u", little_endian_read_16(packet,6), packet[8]);
4306c9db5c21SMilanka Ringwald                 case HCI_SUBEVENT_LE_CONNECTION_UPDATE_COMPLETE:
4307c9db5c21SMilanka Ringwald                     handle = hci_subevent_le_connection_update_complete_get_connection_handle(packet);
4308c9db5c21SMilanka Ringwald                     conn = hci_connection_for_handle(handle);
4309c9db5c21SMilanka Ringwald                     if (!conn) break;
4310c9db5c21SMilanka Ringwald                     conn->le_connection_interval = hci_subevent_le_connection_update_complete_get_conn_interval(packet);
4311c9db5c21SMilanka Ringwald                     break;
431265a46ef3S[email protected] 
431373cd8a2aSMatthias Ringwald                 case HCI_SUBEVENT_LE_REMOTE_CONNECTION_PARAMETER_REQUEST:
431473cd8a2aSMatthias Ringwald                     // connection
431573cd8a2aSMatthias Ringwald                     handle = hci_subevent_le_remote_connection_parameter_request_get_connection_handle(packet);
431673cd8a2aSMatthias Ringwald                     conn = hci_connection_for_handle(handle);
431773cd8a2aSMatthias Ringwald                     if (conn) {
431873cd8a2aSMatthias Ringwald                         // read arguments
431973cd8a2aSMatthias Ringwald                         uint16_t le_conn_interval_min   = hci_subevent_le_remote_connection_parameter_request_get_interval_min(packet);
432073cd8a2aSMatthias Ringwald                         uint16_t le_conn_interval_max   = hci_subevent_le_remote_connection_parameter_request_get_interval_max(packet);
432173cd8a2aSMatthias Ringwald                         uint16_t le_conn_latency        = hci_subevent_le_remote_connection_parameter_request_get_latency(packet);
432273cd8a2aSMatthias Ringwald                         uint16_t le_supervision_timeout = hci_subevent_le_remote_connection_parameter_request_get_timeout(packet);
432373cd8a2aSMatthias Ringwald 
432473cd8a2aSMatthias Ringwald                         // validate against current connection parameter range
432573cd8a2aSMatthias Ringwald                         le_connection_parameter_range_t existing_range;
432673cd8a2aSMatthias Ringwald                         gap_get_connection_parameter_range(&existing_range);
432773cd8a2aSMatthias 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);
432873cd8a2aSMatthias Ringwald                         if (update_parameter){
432973cd8a2aSMatthias Ringwald                             conn->le_con_parameter_update_state = CON_PARAMETER_UPDATE_REPLY;
433073cd8a2aSMatthias Ringwald                             conn->le_conn_interval_min = le_conn_interval_min;
433173cd8a2aSMatthias Ringwald                             conn->le_conn_interval_max = le_conn_interval_max;
433273cd8a2aSMatthias Ringwald                             conn->le_conn_latency = le_conn_latency;
433373cd8a2aSMatthias Ringwald                             conn->le_supervision_timeout = le_supervision_timeout;
433473cd8a2aSMatthias Ringwald                         } else {
4335c3898ca4SMatthias Ringwald                             conn->le_con_parameter_update_state = CON_PARAMETER_UPDATE_NEGATIVE_REPLY;
433673cd8a2aSMatthias Ringwald                         }
433773cd8a2aSMatthias Ringwald                     }
433873cd8a2aSMatthias Ringwald                     break;
43390f3b27c5SMatthias Ringwald #ifdef ENABLE_LE_LIMIT_ACL_FRAGMENT_BY_MAX_OCTETS
43400f3b27c5SMatthias Ringwald                 case HCI_SUBEVENT_LE_DATA_LENGTH_CHANGE:
43410f3b27c5SMatthias Ringwald                     handle = hci_subevent_le_data_length_change_get_connection_handle(packet);
43420f3b27c5SMatthias Ringwald                     conn = hci_connection_for_handle(handle);
43430f3b27c5SMatthias Ringwald                     if (conn) {
43440f3b27c5SMatthias Ringwald                         conn->le_max_tx_octets = hci_subevent_le_data_length_change_get_max_tx_octets(packet);
43450f3b27c5SMatthias Ringwald                     }
43460f3b27c5SMatthias Ringwald                     break;
43470f3b27c5SMatthias Ringwald #endif
43484ae8623eSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
43496fd1d2c8SMatthias Ringwald                 case HCI_SUBEVENT_LE_CIS_REQUEST:
43506fd1d2c8SMatthias Ringwald                     // incoming CIS request, allocate iso stream object and cache metadata
43516fd1d2c8SMatthias Ringwald                     iso_stream = hci_iso_stream_create(HCI_ISO_TYPE_CIS, HCI_ISO_STREAM_W4_USER,
43526fd1d2c8SMatthias Ringwald                                                        hci_subevent_le_cis_request_get_cig_id(packet),
43536fd1d2c8SMatthias Ringwald                                                        hci_subevent_le_cis_request_get_cis_id(packet));
43546fd1d2c8SMatthias Ringwald                     // if there's no memory, gap_cis_accept/gap_cis_reject will fail
43556fd1d2c8SMatthias Ringwald                     if (iso_stream != NULL){
43566fd1d2c8SMatthias Ringwald                         iso_stream->cis_handle = hci_subevent_le_cis_request_get_cis_connection_handle(packet);
43576fd1d2c8SMatthias Ringwald                         iso_stream->acl_handle = hci_subevent_le_cis_request_get_acl_connection_handle(packet);
43586fd1d2c8SMatthias Ringwald                     }
43596fd1d2c8SMatthias Ringwald                     break;
43604ae8623eSMatthias Ringwald                 case HCI_SUBEVENT_LE_CIS_ESTABLISHED:
43618e58e4f7SMatthias Ringwald                     if (hci_stack->iso_active_operation_type == HCI_ISO_TYPE_CIS){
43624ae8623eSMatthias Ringwald                         handle = hci_subevent_le_cis_established_get_connection_handle(packet);
43634ae8623eSMatthias Ringwald                         uint8_t status = hci_subevent_le_cis_established_get_status(packet);
43648e58e4f7SMatthias Ringwald                         iso_stream = hci_iso_stream_for_con_handle(handle);
43658e58e4f7SMatthias Ringwald                         btstack_assert(iso_stream != NULL);
43667dd97f73SMatthias Ringwald                         // track connection info
43677dd97f73SMatthias Ringwald                         iso_stream->number_of_subevents  = hci_subevent_le_cis_established_get_nse(packet);
43687dd97f73SMatthias Ringwald                         iso_stream->burst_number_c_to_p  = hci_subevent_le_cis_established_get_bn_c_to_p(packet);
43697dd97f73SMatthias Ringwald                         iso_stream->burst_number_p_to_c  = hci_subevent_le_cis_established_get_bn_p_to_c(packet);
43707dd97f73SMatthias Ringwald                         iso_stream->flush_timeout_c_to_p = hci_subevent_le_cis_established_get_ft_c_to_p(packet);
43717dd97f73SMatthias Ringwald                         iso_stream->flush_timeout_p_to_c = hci_subevent_le_cis_established_get_ft_p_to_c(packet);
437226b93350SMatthias Ringwald                         iso_stream->max_sdu_c_to_p       = hci_subevent_le_cis_established_get_max_pdu_c_to_p(packet);
437326b93350SMatthias Ringwald                         iso_stream->max_sdu_p_to_c       = hci_subevent_le_cis_established_get_max_pdu_p_to_c(packet);
43747dd97f73SMatthias Ringwald                         iso_stream->iso_interval_1250us  = hci_subevent_le_cis_established_get_iso_interval(packet);
437526b93350SMatthias Ringwald                         if (hci_stack->iso_active_operation_group_id == HCI_ISO_GROUP_ID_SINGLE_CIS){
437626b93350SMatthias Ringwald                             // CIS Accept by Peripheral
437726b93350SMatthias Ringwald                             if (status == ERROR_CODE_SUCCESS){
437826b93350SMatthias Ringwald                                 if (iso_stream->max_sdu_p_to_c > 0){
437926b93350SMatthias Ringwald                                     // we're peripheral and we will send data
438026b93350SMatthias Ringwald                                     iso_stream->state = HCI_ISO_STREAM_STATE_W2_SETUP_ISO_INPUT;
438126b93350SMatthias Ringwald                                 } else {
438226b93350SMatthias Ringwald                                     // we're peripheral and we will only receive data
438326b93350SMatthias Ringwald                                     iso_stream->state = HCI_ISO_STREAM_STATE_W2_SETUP_ISO_OUTPUT;
438426b93350SMatthias Ringwald                                 }
438526b93350SMatthias Ringwald                             } else {
438614045fdbSMatthias Ringwald                                 hci_cis_handle_created(iso_stream, status);
438726b93350SMatthias Ringwald                             }
438826b93350SMatthias Ringwald                             hci_stack->iso_active_operation_type = HCI_ISO_TYPE_INVALID;
438926b93350SMatthias Ringwald                         } else {
439026b93350SMatthias Ringwald                             // CIG Setup by Central
439126b93350SMatthias Ringwald                             le_audio_cig_t * cig = hci_cig_for_id(hci_stack->iso_active_operation_group_id);
439226b93350SMatthias Ringwald                             btstack_assert(cig != NULL);
439326b93350SMatthias Ringwald                             // update iso stream state
43944ae8623eSMatthias Ringwald                             if (status == ERROR_CODE_SUCCESS){
43954ae8623eSMatthias Ringwald                                 iso_stream->state = HCI_ISO_STREAM_STATE_ESTABLISHED;
43964ae8623eSMatthias Ringwald                             } else {
43978e58e4f7SMatthias Ringwald                                 iso_stream->state = HCI_ISO_STREAM_STATE_IDLE;
43984ae8623eSMatthias Ringwald                             }
43998e58e4f7SMatthias Ringwald                             // update cig state
4400f06bb90fSMatthias Ringwald                             uint8_t i;
4401f06bb90fSMatthias Ringwald                             for (i=0;i<cig->num_cis;i++){
4402f06bb90fSMatthias Ringwald                                 if (cig->cis_con_handles[i] == handle){
44033abcd16cSMatthias Ringwald                                     cig->cis_setup_active[i] = false;
4404f9306a1aSMatthias Ringwald                                     if (status == ERROR_CODE_SUCCESS){
4405f9306a1aSMatthias Ringwald                                         cig->cis_established[i] = true;
4406f9306a1aSMatthias Ringwald                                     } else {
440714045fdbSMatthias Ringwald                                         hci_cis_handle_created(iso_stream, status);
4408f06bb90fSMatthias Ringwald                                     }
4409f06bb90fSMatthias Ringwald                                 }
4410f06bb90fSMatthias Ringwald                             }
44118e58e4f7SMatthias Ringwald 
44128e58e4f7SMatthias Ringwald                             // trigger iso path setup if complete
44130f0ba168SMatthias Ringwald                             bool cis_setup_active = false;
4414f9306a1aSMatthias Ringwald                             for (i=0;i<cig->num_cis;i++){
44150f0ba168SMatthias Ringwald                                 cis_setup_active |= cig->cis_setup_active[i];
4416f9306a1aSMatthias Ringwald                             }
44170f0ba168SMatthias Ringwald                             if (cis_setup_active == false){
4418f9306a1aSMatthias Ringwald                                 cig->state_vars.next_cis = 0;
4419f9306a1aSMatthias Ringwald                                 cig->state = LE_AUDIO_CIG_STATE_SETUP_ISO_PATH;
442026b93350SMatthias Ringwald                                 hci_stack->iso_active_operation_type = HCI_ISO_TYPE_INVALID;
442126b93350SMatthias Ringwald                             }
4422f06bb90fSMatthias Ringwald                         }
44234ae8623eSMatthias Ringwald                     }
44247aa35f6aSMatthias Ringwald                     break;
44257aa35f6aSMatthias Ringwald                 case HCI_SUBEVENT_LE_CREATE_BIG_COMPLETE:
442626b93350SMatthias Ringwald                     hci_stack->iso_active_operation_type = HCI_ISO_TYPE_INVALID;
44277aa35f6aSMatthias Ringwald                     big = hci_big_for_handle(packet[4]);
44287aa35f6aSMatthias Ringwald                     if (big != NULL){
44297aa35f6aSMatthias Ringwald                         uint8_t status = packet[3];
44307aa35f6aSMatthias Ringwald                         if (status == ERROR_CODE_SUCCESS){
44317aa35f6aSMatthias Ringwald                             // store bis_con_handles and trigger iso path setup
44325fd415a6SMatthias Ringwald                             uint8_t num_bis = btstack_min(big->num_bis, packet[20]);
44337aa35f6aSMatthias Ringwald                             uint8_t i;
44347aa35f6aSMatthias Ringwald                             for (i=0;i<num_bis;i++){
4435fb16346aSMatthias Ringwald                                 hci_con_handle_t bis_handle = (hci_con_handle_t) little_endian_read_16(packet, 21 + (2 * i));
4436fb16346aSMatthias Ringwald                                 big->bis_con_handles[i] = bis_handle;
4437fb16346aSMatthias Ringwald                                 // assign bis handle
4438fb16346aSMatthias Ringwald                                 btstack_linked_list_iterator_t it;
4439fb16346aSMatthias Ringwald                                 btstack_linked_list_iterator_init(&it, &hci_stack->iso_streams);
4440fb16346aSMatthias Ringwald                                 while (btstack_linked_list_iterator_has_next(&it)){
4441fb16346aSMatthias Ringwald                                     hci_iso_stream_t * iso_stream = (hci_iso_stream_t *) btstack_linked_list_iterator_next(&it);
4442fb16346aSMatthias Ringwald                                     if ((iso_stream->state == HCI_ISO_STREAM_STATE_REQUESTED ) &&
44438d72db10SMatthias Ringwald                                         (iso_stream->group_id == big->big_handle)){
4444969d876aSMatthias Ringwald                                         iso_stream->cis_handle = bis_handle;
4445fb16346aSMatthias Ringwald                                         iso_stream->state = HCI_ISO_STREAM_STATE_ESTABLISHED;
4446cd1139aaSMatthias Ringwald                                         break;
4447fb16346aSMatthias Ringwald                                     }
4448fb16346aSMatthias Ringwald                                 }
44497aa35f6aSMatthias Ringwald                             }
44502a6c0f82SMatthias Ringwald                             if (big->state == LE_AUDIO_BIG_STATE_W4_ESTABLISHED) {
44517aa35f6aSMatthias Ringwald                                 big->state = LE_AUDIO_BIG_STATE_SETUP_ISO_PATH;
44527aa35f6aSMatthias Ringwald                                 big->state_vars.next_bis = 0;
44532a6c0f82SMatthias Ringwald                             }
44547aa35f6aSMatthias Ringwald                         } else {
44552a6c0f82SMatthias Ringwald                             // create BIG failed or has been stopped by us
4456778463d0SMatthias Ringwald                             hci_iso_stream_finalize_by_type_and_group_id(HCI_ISO_TYPE_BIS, big->big_handle);
44577aa35f6aSMatthias Ringwald                             btstack_linked_list_remove(&hci_stack->le_audio_bigs, (btstack_linked_item_t *) big);
44582a6c0f82SMatthias Ringwald                             if (big->state == LE_AUDIO_BIG_STATE_W4_ESTABLISHED){
44597aa35f6aSMatthias Ringwald                                 hci_emit_big_created(big, status);
44602a6c0f82SMatthias Ringwald                             } else {
44612a6c0f82SMatthias Ringwald                                 hci_emit_big_terminated(big);
44622a6c0f82SMatthias Ringwald                             }
44637aa35f6aSMatthias Ringwald                         }
44647aa35f6aSMatthias Ringwald                     }
44657aa35f6aSMatthias Ringwald                     break;
44667aa35f6aSMatthias Ringwald                 case HCI_SUBEVENT_LE_TERMINATE_BIG_COMPLETE:
4467c45ca112SMatthias Ringwald                     hci_stack->iso_active_operation_type = HCI_ISO_TYPE_INVALID;
44687aa35f6aSMatthias Ringwald                     big = hci_big_for_handle(hci_subevent_le_terminate_big_complete_get_big_handle(packet));
44697aa35f6aSMatthias Ringwald                     if (big != NULL){
4470fb16346aSMatthias Ringwald                         // finalize associated ISO streams
4471fb16346aSMatthias Ringwald                         btstack_linked_list_iterator_t it;
4472fb16346aSMatthias Ringwald                         btstack_linked_list_iterator_init(&it, &hci_stack->iso_streams);
4473fb16346aSMatthias Ringwald                         while (btstack_linked_list_iterator_has_next(&it)){
4474fb16346aSMatthias Ringwald                             hci_iso_stream_t * iso_stream = (hci_iso_stream_t *) btstack_linked_list_iterator_next(&it);
44758d72db10SMatthias Ringwald                             if (iso_stream->group_id == big->big_handle){
4476969d876aSMatthias Ringwald                                 log_info("BIG Terminated, big_handle 0x%02x, con handle 0x%04x", iso_stream->group_id, iso_stream->cis_handle);
4477fb16346aSMatthias Ringwald                                 btstack_linked_list_iterator_remove(&it);
4478fb16346aSMatthias Ringwald                                 btstack_memory_hci_iso_stream_free(iso_stream);
4479fb16346aSMatthias Ringwald                             }
4480fb16346aSMatthias Ringwald                         }
44817aa35f6aSMatthias Ringwald                         btstack_linked_list_remove(&hci_stack->le_audio_bigs, (btstack_linked_item_t *) big);
44827aa35f6aSMatthias Ringwald                         switch (big->state){
44837aa35f6aSMatthias Ringwald                             case LE_AUDIO_BIG_STATE_W4_TERMINATED_AFTER_SETUP_FAILED:
44847aa35f6aSMatthias Ringwald                                 hci_emit_big_created(big, big->state_vars.status);
44857aa35f6aSMatthias Ringwald                                 break;
44867aa35f6aSMatthias Ringwald                             default:
44877aa35f6aSMatthias Ringwald                                 hci_emit_big_terminated(big);
44887aa35f6aSMatthias Ringwald                                 break;
44897aa35f6aSMatthias Ringwald                         }
44907aa35f6aSMatthias Ringwald                     }
44917aa35f6aSMatthias Ringwald                     break;
44922a6c0f82SMatthias Ringwald                 case HCI_SUBEVENT_LE_BIG_SYNC_ESTABLISHED:
4493c45ca112SMatthias Ringwald                     hci_stack->iso_active_operation_type = HCI_ISO_TYPE_INVALID;
44942a6c0f82SMatthias Ringwald                     big_sync = hci_big_sync_for_handle(packet[4]);
44952a6c0f82SMatthias Ringwald                     if (big_sync != NULL){
44962a6c0f82SMatthias Ringwald                         uint8_t status = packet[3];
4497d04a9afcSMatthias Ringwald                         uint8_t big_handle = packet[4];
44982a6c0f82SMatthias Ringwald                         if (status == ERROR_CODE_SUCCESS){
44992a6c0f82SMatthias Ringwald                             // store bis_con_handles and trigger iso path setup
45005fd415a6SMatthias Ringwald                             uint8_t num_bis = btstack_min(big_sync->num_bis, packet[16]);
45012a6c0f82SMatthias Ringwald                             uint8_t i;
45022a6c0f82SMatthias Ringwald                             for (i=0;i<num_bis;i++){
450302e19895SMatthias Ringwald                                 hci_con_handle_t bis_handle = little_endian_read_16(packet, 17 + (2 * i));
450402e19895SMatthias Ringwald                                 big_sync->bis_con_handles[i] = bis_handle;
450502e19895SMatthias Ringwald                                 // setup iso_stream_t
450602e19895SMatthias Ringwald                                 btstack_linked_list_iterator_t it;
450702e19895SMatthias Ringwald                                 btstack_linked_list_iterator_init(&it, &hci_stack->iso_streams);
450802e19895SMatthias Ringwald                                 while (btstack_linked_list_iterator_has_next(&it)){
450902e19895SMatthias Ringwald                                     hci_iso_stream_t * iso_stream = (hci_iso_stream_t *) btstack_linked_list_iterator_next(&it);
451002e19895SMatthias Ringwald                                     if ((iso_stream->state == HCI_ISO_STREAM_STATE_REQUESTED ) &&
451102e19895SMatthias Ringwald                                         (iso_stream->group_id == big_sync->big_handle)){
451202e19895SMatthias Ringwald                                         iso_stream->cis_handle = bis_handle;
451302e19895SMatthias Ringwald                                         iso_stream->state = HCI_ISO_STREAM_STATE_ESTABLISHED;
451402e19895SMatthias Ringwald                                         break;
451502e19895SMatthias Ringwald                                     }
451602e19895SMatthias Ringwald                                 }
45172a6c0f82SMatthias Ringwald                             }
45182a6c0f82SMatthias Ringwald                             if (big_sync->state == LE_AUDIO_BIG_STATE_W4_ESTABLISHED) {
45192a6c0f82SMatthias Ringwald                                 // trigger iso path setup
45202a6c0f82SMatthias Ringwald                                 big_sync->state = LE_AUDIO_BIG_STATE_SETUP_ISO_PATH;
45212a6c0f82SMatthias Ringwald                                 big_sync->state_vars.next_bis = 0;
45222a6c0f82SMatthias Ringwald                             }
45232a6c0f82SMatthias Ringwald                         } else {
45242a6c0f82SMatthias Ringwald                             // create BIG Sync failed or has been stopped by us
45252a6c0f82SMatthias Ringwald                             btstack_linked_list_remove(&hci_stack->le_audio_big_syncs, (btstack_linked_item_t *) big_sync);
45262a6c0f82SMatthias Ringwald                             if (big_sync->state == LE_AUDIO_BIG_STATE_W4_ESTABLISHED) {
45272a6c0f82SMatthias Ringwald                                 hci_emit_big_sync_created(big_sync, status);
45282a6c0f82SMatthias Ringwald                             } else {
4529d04a9afcSMatthias Ringwald                                 hci_emit_big_sync_stopped(big_handle);
45302a6c0f82SMatthias Ringwald                             }
45312a6c0f82SMatthias Ringwald                         }
45322a6c0f82SMatthias Ringwald                     }
45332a6c0f82SMatthias Ringwald                     break;
45342a6c0f82SMatthias Ringwald                 case HCI_SUBEVENT_LE_BIG_SYNC_LOST:
4535c45ca112SMatthias Ringwald                     hci_stack->iso_active_operation_type = HCI_ISO_TYPE_INVALID;
45362a6c0f82SMatthias Ringwald                     big_sync = hci_big_sync_for_handle(packet[4]);
45372a6c0f82SMatthias Ringwald                     if (big_sync != NULL){
4538d04a9afcSMatthias Ringwald                         uint8_t big_handle = packet[4];
45392a6c0f82SMatthias Ringwald                         btstack_linked_list_remove(&hci_stack->le_audio_big_syncs, (btstack_linked_item_t *) big_sync);
4540d04a9afcSMatthias Ringwald                         hci_emit_big_sync_stopped(big_handle);
45412a6c0f82SMatthias Ringwald                     }
45422a6c0f82SMatthias Ringwald                     break;
45434ae8623eSMatthias Ringwald #endif
45445909f7f2Smatthias.ringwald                 default:
45455909f7f2Smatthias.ringwald                     break;
45465909f7f2Smatthias.ringwald             }
45475909f7f2Smatthias.ringwald             break;
45485909f7f2Smatthias.ringwald #endif
45490b36101dSMatthias Ringwald         case HCI_EVENT_VENDOR_SPECIFIC:
45500b36101dSMatthias Ringwald             // Vendor specific commands often create vendor specific event instead of num completed packets
45510b36101dSMatthias Ringwald             // To avoid getting stuck as num_cmds_packets is zero, reset it to 1 for controllers with this behaviour
45520b36101dSMatthias Ringwald             switch (hci_stack->manufacturer){
45530b36101dSMatthias Ringwald                 case BLUETOOTH_COMPANY_ID_CAMBRIDGE_SILICON_RADIO:
45540b36101dSMatthias Ringwald                     hci_stack->num_cmd_packets = 1;
45550b36101dSMatthias Ringwald                     break;
45560b36101dSMatthias Ringwald                 default:
45570b36101dSMatthias Ringwald                     break;
45580b36101dSMatthias Ringwald             }
45590b36101dSMatthias Ringwald             break;
45606772a24cSmatthias.ringwald         default:
45616772a24cSmatthias.ringwald             break;
4562fe1ed1b8Smatthias.ringwald     }
4563fe1ed1b8Smatthias.ringwald 
456467c6c9dcSMatthias Ringwald     handle_event_for_current_stack_state(packet, size);
456589db417bSmatthias.ringwald 
456686805605S[email protected]     // notify upper stack
4567d6b06661SMatthias Ringwald 	hci_emit_event(packet, size, 0);   // don't dump, already happened in packet handler
456894ab26f8Smatthias.ringwald 
456986805605S[email protected]     // moved here to give upper stack a chance to close down everything with hci_connection_t intact
4570797b2a3fSMatthias Ringwald     if ((hci_event_packet_get_type(packet) == HCI_EVENT_DISCONNECTION_COMPLETE) && (packet[2] == 0)){
4571f8fbdce0SMatthias Ringwald 		handle = little_endian_read_16(packet, 3);
457205ae8de3SMatthias Ringwald 		hci_connection_t * aConn = hci_connection_for_handle(handle);
4573046ec007SMatthias Ringwald 		// discard connection if app did not trigger a reconnect in the event handler
4574797b2a3fSMatthias Ringwald 		if (aConn && aConn->state == RECEIVED_DISCONNECTION_COMPLETE){
457505ae8de3SMatthias Ringwald 			hci_shutdown_connection(aConn);
4576b0136355SMatthias Ringwald 		}
45778ad9cf99SMatthias Ringwald #ifdef ENABLE_CONTROLLER_DUMP_PACKETS
45788ad9cf99SMatthias Ringwald         hci_controller_dump_packets();
45798ad9cf99SMatthias Ringwald #endif
458086805605S[email protected]     }
458186805605S[email protected] 
458294ab26f8Smatthias.ringwald 	// execute main loop
458394ab26f8Smatthias.ringwald 	hci_run();
458416833f0aSmatthias.ringwald }
458516833f0aSmatthias.ringwald 
458635454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
45876f28d2eeSMatthias Ringwald 
4588c91d150bS[email protected] static void sco_handler(uint8_t * packet, uint16_t size){
45890b3f95dfSMatthias Ringwald     // lookup connection struct
45902b838201SMatthias Ringwald     hci_con_handle_t con_handle = READ_SCO_CONNECTION_HANDLE(packet);
45912b838201SMatthias Ringwald     hci_connection_t * conn     = hci_connection_for_handle(con_handle);
45920b3f95dfSMatthias Ringwald     if (!conn) return;
45930b3f95dfSMatthias Ringwald 
45946be3cf7fSMatthias Ringwald #ifdef ENABLE_SCO_OVER_HCI
4595760b20efSMatthias Ringwald     // CSR 8811 prefixes 60 byte SCO packet in transparent mode with 20 zero bytes -> skip first 20 payload bytes
4596760b20efSMatthias Ringwald     if (hci_stack->manufacturer == BLUETOOTH_COMPANY_ID_CAMBRIDGE_SILICON_RADIO){
4597a1df452eSMatthias Ringwald         if ((size == 83) && ((hci_stack->sco_voice_setting_active & 0x03) == 0x03)){
4598760b20efSMatthias Ringwald             packet[2] = 0x3c;
4599760b20efSMatthias Ringwald             memmove(&packet[3], &packet[23], 63);
4600760b20efSMatthias Ringwald             size = 63;
46010b3f95dfSMatthias Ringwald         }
46020b3f95dfSMatthias Ringwald     }
4603760b20efSMatthias Ringwald 
4604f234b250SMatthias Ringwald     if (hci_have_usb_transport()){
4605f234b250SMatthias Ringwald         // Nothing to do
4606f234b250SMatthias Ringwald     } else {
460749205f5dSMatthias 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);
4608760b20efSMatthias Ringwald         if (hci_stack->synchronous_flow_control_enabled == 0){
4609fa7f2dfdSMatthias Ringwald             // ignore received SCO packets for the first 10 ms, then allow for max two HCI_SCO_2EV3_SIZE packets
4610fa7f2dfdSMatthias Ringwald             uint16_t max_sco_packets = btstack_min(2 * HCI_SCO_2EV3_SIZE / conn->sco_payload_length, hci_stack->sco_packets_total_num);
4611fa7f2dfdSMatthias Ringwald             if (conn->sco_tx_active == 0){
4612fa7f2dfdSMatthias Ringwald                 if (btstack_time_delta(btstack_run_loop_get_time_ms(), conn->sco_established_ms) > 10){
4613fa7f2dfdSMatthias Ringwald                     conn->sco_tx_active = 1;
4614fa7f2dfdSMatthias Ringwald                     conn->sco_tx_ready = max_sco_packets;
4615fa7f2dfdSMatthias Ringwald                     log_info("Start SCO sending, %u packets", conn->sco_tx_ready);
4616fa7f2dfdSMatthias Ringwald                     hci_notify_if_sco_can_send_now();
461759c33575SMatthias Ringwald                 }
461859c33575SMatthias Ringwald             } else {
4619fa7f2dfdSMatthias Ringwald                 if (conn->sco_tx_ready < max_sco_packets){
4620fa7f2dfdSMatthias Ringwald                     conn->sco_tx_ready++;
462159c33575SMatthias Ringwald                 }
4622fa7f2dfdSMatthias Ringwald                 hci_notify_if_sco_can_send_now();
46236f28d2eeSMatthias Ringwald             }
4624760b20efSMatthias Ringwald         }
4625f234b250SMatthias Ringwald     }
46266be3cf7fSMatthias Ringwald #endif
46276be3cf7fSMatthias Ringwald 
46280b3f95dfSMatthias Ringwald     // deliver to app
46290b3f95dfSMatthias Ringwald     if (hci_stack->sco_packet_handler) {
46300b3f95dfSMatthias Ringwald         hci_stack->sco_packet_handler(HCI_SCO_DATA_PACKET, 0, packet, size);
46310b3f95dfSMatthias Ringwald     }
46320b3f95dfSMatthias Ringwald 
4633ed325439SMatthias Ringwald #ifdef HAVE_SCO_TRANSPORT
4634ed325439SMatthias Ringwald     // We can send one packet for each received packet
4635ed325439SMatthias Ringwald     conn->sco_tx_ready++;
4636ed325439SMatthias Ringwald     hci_notify_if_sco_can_send_now();
4637ed325439SMatthias Ringwald #endif
4638ed325439SMatthias Ringwald 
46390b3f95dfSMatthias Ringwald #ifdef ENABLE_HCI_CONTROLLER_TO_HOST_FLOW_CONTROL
46402b838201SMatthias Ringwald     conn->num_packets_completed++;
46412b838201SMatthias Ringwald     hci_stack->host_completed_packets = 1;
46422b838201SMatthias Ringwald     hci_run();
46432b838201SMatthias Ringwald #endif
4644c91d150bS[email protected] }
464535454696SMatthias Ringwald #endif
4646c91d150bS[email protected] 
46470a57e69fSmatthias.ringwald static void packet_handler(uint8_t packet_type, uint8_t *packet, uint16_t size){
46484248f37eSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
46494248f37eSMatthias Ringwald     // propagate ISO packets received as ACL
4650062276f9SMatthias Ringwald     hci_iso_stream_t * iso_stream = NULL;
46514248f37eSMatthias Ringwald     if ((packet_type == HCI_ACL_DATA_PACKET) && (size >= HCI_ACL_HEADER_SIZE)){
46524248f37eSMatthias Ringwald         hci_con_handle_t con_handle = READ_ACL_CONNECTION_HANDLE(packet);
46534248f37eSMatthias Ringwald         iso_stream = hci_iso_stream_for_con_handle(con_handle);
46544248f37eSMatthias Ringwald         if (iso_stream != NULL){
46554248f37eSMatthias Ringwald             packet_type = HCI_ISO_DATA_PACKET;
46564248f37eSMatthias Ringwald         }
46574248f37eSMatthias Ringwald     }
46584248f37eSMatthias Ringwald #endif
46594248f37eSMatthias Ringwald 
46605bb5bc3eS[email protected]     hci_dump_packet(packet_type, 1, packet, size);
466110e830c9Smatthias.ringwald     switch (packet_type) {
466210e830c9Smatthias.ringwald         case HCI_EVENT_PACKET:
466310e830c9Smatthias.ringwald             event_handler(packet, size);
466410e830c9Smatthias.ringwald             break;
466510e830c9Smatthias.ringwald         case HCI_ACL_DATA_PACKET:
466610e830c9Smatthias.ringwald             acl_handler(packet, size);
466710e830c9Smatthias.ringwald             break;
466835454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
4669c91d150bS[email protected]         case HCI_SCO_DATA_PACKET:
4670c91d150bS[email protected]             sco_handler(packet, size);
4671202c8a4cSMatthias Ringwald             break;
467235454696SMatthias Ringwald #endif
46730a8cccd5SMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
46745027c498SMatthias Ringwald         case HCI_ISO_DATA_PACKET:
4675750818acSMatthias Ringwald             if ((iso_stream == NULL) && (size >= HCI_ISO_HEADER_SIZE)){
4676750818acSMatthias Ringwald                 hci_con_handle_t con_handle = READ_ISO_CONNECTION_HANDLE(packet);
4677750818acSMatthias Ringwald                 iso_stream = hci_iso_stream_for_con_handle(con_handle);
4678750818acSMatthias Ringwald             }
4679750818acSMatthias Ringwald             hci_iso_packet_handler(iso_stream, packet, size);
46805027c498SMatthias Ringwald             break;
46815027c498SMatthias Ringwald #endif
468210e830c9Smatthias.ringwald         default:
468310e830c9Smatthias.ringwald             break;
468410e830c9Smatthias.ringwald     }
468510e830c9Smatthias.ringwald }
468610e830c9Smatthias.ringwald 
4687d6b06661SMatthias Ringwald /**
4688d6b06661SMatthias Ringwald  * @brief Add event packet handler.
4689d6b06661SMatthias Ringwald  */
4690d6b06661SMatthias Ringwald void hci_add_event_handler(btstack_packet_callback_registration_t * callback_handler){
4691d6b06661SMatthias Ringwald     btstack_linked_list_add_tail(&hci_stack->event_handlers, (btstack_linked_item_t*) callback_handler);
4692d6b06661SMatthias Ringwald }
4693d6b06661SMatthias Ringwald 
469467f708e0SMatthias Ringwald /**
469567f708e0SMatthias Ringwald  * @brief Remove event packet handler.
469667f708e0SMatthias Ringwald  */
469767f708e0SMatthias Ringwald void hci_remove_event_handler(btstack_packet_callback_registration_t * callback_handler){
469867f708e0SMatthias Ringwald     btstack_linked_list_remove(&hci_stack->event_handlers, (btstack_linked_item_t*) callback_handler);
469967f708e0SMatthias Ringwald }
4700d6b06661SMatthias Ringwald 
4701fcadd0caSmatthias.ringwald /** Register HCI packet handlers */
47023d50b4baSMatthias Ringwald void hci_register_acl_packet_handler(btstack_packet_handler_t handler){
4703fb37a842SMatthias Ringwald     hci_stack->acl_packet_handler = handler;
470416833f0aSmatthias.ringwald }
470516833f0aSmatthias.ringwald 
470635454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
47078abbe8b5SMatthias Ringwald /**
47088abbe8b5SMatthias Ringwald  * @brief Registers a packet handler for SCO data. Used for HSP and HFP profiles.
47098abbe8b5SMatthias Ringwald  */
47103d50b4baSMatthias Ringwald void hci_register_sco_packet_handler(btstack_packet_handler_t handler){
47118abbe8b5SMatthias Ringwald     hci_stack->sco_packet_handler = handler;
47128abbe8b5SMatthias Ringwald }
471335454696SMatthias Ringwald #endif
47148abbe8b5SMatthias Ringwald 
47150a8cccd5SMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
47165027c498SMatthias Ringwald void hci_register_iso_packet_handler(btstack_packet_handler_t handler){
47175027c498SMatthias Ringwald     hci_stack->iso_packet_handler = handler;
47185027c498SMatthias Ringwald }
47195027c498SMatthias Ringwald #endif
47205027c498SMatthias Ringwald 
472171de195eSMatthias Ringwald static void hci_state_reset(void){
4722595bdbfbS[email protected]     // no connections yet
4723595bdbfbS[email protected]     hci_stack->connections = NULL;
472474308b23Smatthias.ringwald 
472574308b23Smatthias.ringwald     // keep discoverable/connectable as this has been requested by the client(s)
472674308b23Smatthias.ringwald     // hci_stack->discoverable = 0;
472774308b23Smatthias.ringwald     // hci_stack->connectable = 0;
472874308b23Smatthias.ringwald     // hci_stack->bondable = 1;
4729b95a5a35SMatthias Ringwald     // hci_stack->own_addr_type = 0;
4730595bdbfbS[email protected] 
473144935e40S[email protected]     // buffer is free
473202c7fc01SMatthias Ringwald     hci_stack->hci_packet_buffer_reserved = false;
473344935e40S[email protected] 
4734595bdbfbS[email protected]     // no pending cmds
4735595bdbfbS[email protected]     hci_stack->decline_reason = 0;
4736595bdbfbS[email protected] 
4737c214d65bSMatthias Ringwald     hci_stack->secure_connections_active = false;
4738c214d65bSMatthias Ringwald 
4739bea424a5SMatthias Ringwald #ifdef ENABLE_CLASSIC
4740496bb884SMatthias Ringwald     hci_stack->inquiry_lap = GAP_IAC_GENERAL_INQUIRY;
474132a12730SMatthias Ringwald     hci_stack->page_timeout = 0x6000;  // ca. 15 sec
474232a12730SMatthias Ringwald 
4743baa4881eSMatthias Ringwald     hci_stack->gap_tasks_classic =
474459d59ecfSMatthias Ringwald             GAP_TASK_SET_DEFAULT_LINK_POLICY |
474559d59ecfSMatthias Ringwald             GAP_TASK_SET_CLASS_OF_DEVICE |
474659d59ecfSMatthias Ringwald             GAP_TASK_SET_LOCAL_NAME |
4747bc2dcc03SMatthias Ringwald             GAP_TASK_SET_EIR_DATA |
474832a12730SMatthias Ringwald             GAP_TASK_WRITE_SCAN_ENABLE |
474932a12730SMatthias Ringwald             GAP_TASK_WRITE_PAGE_TIMEOUT;
4750bea424a5SMatthias Ringwald #endif
4751bea424a5SMatthias Ringwald 
4752cf01e888SMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB
47538d5f0979SMatthias Ringwald     hci_stack->classic_read_local_oob_data = false;
47541ae74bf3SMatthias Ringwald     hci_stack->classic_oob_con_handle = HCI_CON_HANDLE_INVALID;
4755cf01e888SMatthias Ringwald #endif
4756cf01e888SMatthias Ringwald 
4757595bdbfbS[email protected]     // LE
4758b95a5a35SMatthias Ringwald #ifdef ENABLE_BLE
4759b95a5a35SMatthias Ringwald     memset(hci_stack->le_random_address, 0, 6);
4760b95a5a35SMatthias Ringwald     hci_stack->le_random_address_set = 0;
4761d70217a2SMatthias Ringwald #endif
4762d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
4763a61834b6SMatthias Ringwald     hci_stack->le_scanning_active  = false;
476473799937SMatthias Ringwald     hci_stack->le_scanning_param_update = true;
4765b04dfa37SMatthias Ringwald     hci_stack->le_connecting_state = LE_CONNECTING_IDLE;
4766d5b1a89eSMatthias Ringwald     hci_stack->le_connecting_request = LE_CONNECTING_IDLE;
4767e83201bcSMatthias Ringwald     hci_stack->le_whitelist_capacity = 0;
47684bafedd5SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
47694bafedd5SMatthias Ringwald     hci_stack->le_periodic_terminate_sync_handle = HCI_CON_HANDLE_INVALID;
47704bafedd5SMatthias Ringwald #endif
4771d70217a2SMatthias Ringwald #endif
4772a61834b6SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
4773935aa76eSMatthias Ringwald     hci_stack->le_advertisements_state &= ~LE_ADVERTISEMENT_STATE_ACTIVE;
47746bf435a6SMatthias Ringwald     if ((hci_stack->le_advertisements_state & LE_ADVERTISEMENT_STATE_PARAMS_SET) != 0){
4775a61834b6SMatthias Ringwald         hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_SET_PARAMS;
4776a61834b6SMatthias Ringwald     }
4777a61834b6SMatthias Ringwald     if (hci_stack->le_advertisements_data != NULL){
4778a61834b6SMatthias Ringwald         hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_SET_ADV_DATA;
4779a61834b6SMatthias Ringwald     }
4780a61834b6SMatthias Ringwald #endif
4781d320e123SMatthias Ringwald #ifdef ENABLE_LE_PRIVACY_ADDRESS_RESOLUTION
4782d320e123SMatthias Ringwald     hci_stack->le_resolving_list_state = LE_RESOLVING_LIST_SEND_ENABLE_ADDRESS_RESOLUTION;
4783d320e123SMatthias Ringwald #endif
478440f86dfdSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
478526b93350SMatthias Ringwald     hci_stack->iso_active_operation_type = HCI_ISO_TYPE_INVALID;
4786d75a6bbfSMatthias Ringwald     hci_stack->iso_active_operation_group_id = HCI_ISO_GROUP_ID_INVALID;
478740f86dfdSMatthias Ringwald #endif
478891036612SMatthias Ringwald #ifdef ENABLE_HCI_COMMAND_STATUS_DISCARDED_FOR_FAILED_CONNECTIONS_WORKAROUND
4789f48a5586SMatthias Ringwald     hci_stack->hci_command_con_handle = HCI_CON_HANDLE_INVALID;
4790f48a5586SMatthias Ringwald #endif
4791595bdbfbS[email protected] }
4792595bdbfbS[email protected] 
479335454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
47942d5e09d6SMatthias Ringwald /**
47952d5e09d6SMatthias Ringwald  * @brief Configure Bluetooth hardware control. Has to be called before power on.
47962d5e09d6SMatthias Ringwald  */
47972d5e09d6SMatthias Ringwald void hci_set_link_key_db(btstack_link_key_db_t const * link_key_db){
47982d5e09d6SMatthias Ringwald     // store and open remote device db
47992d5e09d6SMatthias Ringwald     hci_stack->link_key_db = link_key_db;
48002d5e09d6SMatthias Ringwald     if (hci_stack->link_key_db) {
48012d5e09d6SMatthias Ringwald         hci_stack->link_key_db->open();
48022d5e09d6SMatthias Ringwald     }
48032d5e09d6SMatthias Ringwald }
480435454696SMatthias Ringwald #endif
48052d5e09d6SMatthias Ringwald 
48062d5e09d6SMatthias Ringwald void hci_init(const hci_transport_t *transport, const void *config){
4807475c8125Smatthias.ringwald 
48083a9fb326S[email protected] #ifdef HAVE_MALLOC
48093a9fb326S[email protected]     if (!hci_stack) {
48103a9fb326S[email protected]         hci_stack = (hci_stack_t*) malloc(sizeof(hci_stack_t));
48113a9fb326S[email protected]     }
48123a9fb326S[email protected] #else
48133a9fb326S[email protected]     hci_stack = &hci_stack_static;
48143a9fb326S[email protected] #endif
481566fb9560S[email protected]     memset(hci_stack, 0, sizeof(hci_stack_t));
48163a9fb326S[email protected] 
4817475c8125Smatthias.ringwald     // reference to use transport layer implementation
48183a9fb326S[email protected]     hci_stack->hci_transport = transport;
4819475c8125Smatthias.ringwald 
482011e23e5fSmatthias.ringwald     // reference to used config
48213a9fb326S[email protected]     hci_stack->config = config;
482211e23e5fSmatthias.ringwald 
482326a9b6daSMatthias Ringwald     // setup pointer for outgoing packet buffer
482426a9b6daSMatthias Ringwald     hci_stack->hci_packet_buffer = &hci_stack->hci_packet_buffer_data[HCI_OUTGOING_PRE_BUFFER_SIZE];
482526a9b6daSMatthias Ringwald 
48268fcba05dSmatthias.ringwald     // max acl payload size defined in config.h
48273a9fb326S[email protected]     hci_stack->acl_data_packet_length = HCI_ACL_PAYLOAD_SIZE;
48288fcba05dSmatthias.ringwald 
482916833f0aSmatthias.ringwald     // register packet handlers with transport
483010e830c9Smatthias.ringwald     transport->register_packet_handler(&packet_handler);
4831f5454fc6Smatthias.ringwald 
48323a9fb326S[email protected]     hci_stack->state = HCI_STATE_OFF;
4833e2386ba1S[email protected] 
4834e2386ba1S[email protected]     // class of device
48353a9fb326S[email protected]     hci_stack->class_of_device = 0x007a020c; // Smartphone
4836a45d6b9fS[email protected] 
4837f20168b8Smatthias.ringwald     // bondable by default
4838f20168b8Smatthias.ringwald     hci_stack->bondable = 1;
4839f20168b8Smatthias.ringwald 
4840e9f343c8SMatthias Ringwald #ifdef ENABLE_CLASSIC
484163168530SMatthias Ringwald     // classic name
484263168530SMatthias Ringwald     hci_stack->local_name = default_classic_name;
4843c4c88f1bSJakob Krantz 
4844c4c88f1bSJakob Krantz     // Master slave policy
4845c4c88f1bSJakob Krantz     hci_stack->master_slave_policy = 1;
4846170fafaeSMatthias Ringwald 
4847b4eb4420SMatthias Ringwald     // Allow Role Switch
4848b4eb4420SMatthias Ringwald     hci_stack->allow_role_switch = 1;
4849b4eb4420SMatthias Ringwald 
485078315a58SMatthias Ringwald     // Default / minimum security level = 2
485178315a58SMatthias Ringwald     hci_stack->gap_security_level = LEVEL_2;
485278315a58SMatthias Ringwald 
48535dbec6b3SMatthias Ringwald     // Default Security Mode 4
48545dbec6b3SMatthias Ringwald     hci_stack->gap_security_mode = GAP_SECURITY_MODE_4;
48555dbec6b3SMatthias Ringwald 
4856cd345294SMatthias Ringwald     // Errata-11838 mandates 7 bytes for GAP Security Level 1-3
4857cd345294SMatthias Ringwald     hci_stack->gap_required_encyrption_key_size = 7;
4858d821984bSMatthias Ringwald 
4859d821984bSMatthias Ringwald     // Link Supervision Timeout
4860d821984bSMatthias Ringwald     hci_stack->link_supervision_timeout = HCI_LINK_SUPERVISION_TIMEOUT_DEFAULT;
4861d821984bSMatthias Ringwald 
4862028ead5eSMatthias Ringwald     // All ACL packet types are enabledh
4863028ead5eSMatthias Ringwald     hci_stack->enabled_packet_types_acl = ACL_PACKET_TYPES_ALL;
4864e9f343c8SMatthias Ringwald #endif
486563168530SMatthias Ringwald 
486663048403S[email protected]     // Secure Simple Pairing default: enable, no I/O capabilities, general bonding, mitm not required, auto accept
48673a9fb326S[email protected]     hci_stack->ssp_enable = 1;
48683a9fb326S[email protected]     hci_stack->ssp_io_capability = SSP_IO_CAPABILITY_NO_INPUT_NO_OUTPUT;
48693a9fb326S[email protected]     hci_stack->ssp_authentication_requirement = SSP_IO_AUTHREQ_MITM_PROTECTION_NOT_REQUIRED_GENERAL_BONDING;
48703a9fb326S[email protected]     hci_stack->ssp_auto_accept = 1;
487169a97523S[email protected] 
48725d23aae8SMatthias Ringwald     // Secure Connections: enable (requires support from Controller)
48735d23aae8SMatthias Ringwald     hci_stack->secure_connections_enable = true;
48745d23aae8SMatthias Ringwald 
4875fac2e2feSMatthias Ringwald     // voice setting - signed 16 bit pcm data with CVSD over the air
4876fac2e2feSMatthias Ringwald     hci_stack->sco_voice_setting = 0x60;
4877d950d659SMatthias Ringwald 
48780c2c5f79SMatthias Ringwald #ifdef ENABLE_BLE
4879cbe54ab2SJakob Krantz     hci_stack->le_connection_scan_interval = 0x0060;   //    60 ms
4880cbe54ab2SJakob Krantz     hci_stack->le_connection_scan_window   = 0x0030;    //   30 ms
4881831711daSMatthias Ringwald     hci_stack->le_connection_interval_min  = 0x0008;    //   10 ms
4882831711daSMatthias Ringwald     hci_stack->le_connection_interval_max  = 0x0018;    //   30 ms
4883831711daSMatthias Ringwald     hci_stack->le_connection_latency       =      4;    //    4
4884831711daSMatthias Ringwald     hci_stack->le_supervision_timeout      = 0x0048;    //  720 ms
488524d14ae3SMatthias Ringwald     hci_stack->le_minimum_ce_length        =      0;    //    0 ms
488624d14ae3SMatthias Ringwald     hci_stack->le_maximum_ce_length        =      0;    //    0 ms
48870c2c5f79SMatthias Ringwald #endif
48880c2c5f79SMatthias Ringwald 
48890c2c5f79SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
48907eb5b27eSMatthias Ringwald     hci_stack->le_connection_phys          =   0x01;    // LE 1M PHY
48917261e5d8SMatthias Ringwald 
48927261e5d8SMatthias Ringwald     // default LE Scanning
48937eb5b27eSMatthias Ringwald     hci_stack->le_scan_type     =  0x01; // active
48948b69e4c7SMatthias Ringwald     hci_stack->le_scan_interval = 0x1e0; // 300 ms
48958b69e4c7SMatthias Ringwald     hci_stack->le_scan_window   =  0x30; //  30 ms
48967eb5b27eSMatthias Ringwald     hci_stack->le_scan_phys     =  0x01; // LE 1M PHY
4897831711daSMatthias Ringwald #endif
4898831711daSMatthias Ringwald 
48992b6ab3e6SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
49002b6ab3e6SMatthias Ringwald     hci_stack->le_max_number_peripheral_connections = 1; // only single connection as peripheral
4901ee605458SMatthias Ringwald 
4902ee605458SMatthias Ringwald     // default advertising parameters from Core v5.4 -- needed to use random address without prior adv setup
4903ee605458SMatthias Ringwald     hci_stack->le_advertisements_interval_min =                         0x0800;
4904ee605458SMatthias Ringwald     hci_stack->le_advertisements_interval_max =                         0x0800;
4905ee605458SMatthias Ringwald     hci_stack->le_advertisements_type =                                      0;
4906ee605458SMatthias Ringwald     hci_stack->le_own_addr_type =                       BD_ADDR_TYPE_LE_PUBLIC;
4907ee605458SMatthias Ringwald     hci_stack->le_advertisements_direct_address_type =  BD_ADDR_TYPE_LE_PUBLIC;
4908ee605458SMatthias Ringwald     hci_stack->le_advertisements_channel_map =                            0x07;
4909ee605458SMatthias Ringwald     hci_stack->le_advertisements_filter_policy =                             0;
49102b6ab3e6SMatthias Ringwald #endif
49112b6ab3e6SMatthias Ringwald 
4912831711daSMatthias Ringwald     // connection parameter range used to answer connection parameter update requests in l2cap
4913831711daSMatthias Ringwald     hci_stack->le_connection_parameter_range.le_conn_interval_min =          6;
4914831711daSMatthias Ringwald     hci_stack->le_connection_parameter_range.le_conn_interval_max =       3200;
4915831711daSMatthias Ringwald     hci_stack->le_connection_parameter_range.le_conn_latency_min =           0;
4916831711daSMatthias Ringwald     hci_stack->le_connection_parameter_range.le_conn_latency_max =         500;
4917831711daSMatthias Ringwald     hci_stack->le_connection_parameter_range.le_supervision_timeout_min =   10;
4918831711daSMatthias Ringwald     hci_stack->le_connection_parameter_range.le_supervision_timeout_max = 3200;
4919831711daSMatthias Ringwald 
492001d4f05fSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
492101d4f05fSMatthias Ringwald     hci_stack->iso_packets_to_queue = 1;
492201d4f05fSMatthias Ringwald #endif
492301d4f05fSMatthias Ringwald 
4924c3d19a30SMatthias Ringwald #ifdef ENABLE_LE_PRIVACY_ADDRESS_RESOLUTION
4925c3d19a30SMatthias Ringwald     hci_stack->le_privacy_mode = LE_PRIVACY_MODE_DEVICE;
4926c3d19a30SMatthias Ringwald #endif
4927c3d19a30SMatthias Ringwald 
4928595bdbfbS[email protected]     hci_state_reset();
4929475c8125Smatthias.ringwald }
4930475c8125Smatthias.ringwald 
49314688f216SMatthias Ringwald void hci_deinit(void){
4932b02cfc15SMatthias Ringwald     btstack_run_loop_remove_timer(&hci_stack->timeout);
49334688f216SMatthias Ringwald #ifdef HAVE_MALLOC
49344688f216SMatthias Ringwald     if (hci_stack) {
49354688f216SMatthias Ringwald         free(hci_stack);
49364688f216SMatthias Ringwald     }
49374688f216SMatthias Ringwald #endif
49384688f216SMatthias Ringwald     hci_stack = NULL;
4939b5bbcbf4SMatthias Ringwald 
4940b5bbcbf4SMatthias Ringwald #ifdef ENABLE_CLASSIC
49414688f216SMatthias Ringwald     disable_l2cap_timeouts = 0;
4942b5bbcbf4SMatthias Ringwald #endif
49434688f216SMatthias Ringwald }
49444688f216SMatthias Ringwald 
49453fb36a29SMatthias Ringwald /**
49463fb36a29SMatthias Ringwald  * @brief Configure Bluetooth chipset driver. Has to be called before power on, or right after receiving the local version information
49473fb36a29SMatthias Ringwald  */
49483fb36a29SMatthias Ringwald void hci_set_chipset(const btstack_chipset_t *chipset_driver){
49493fb36a29SMatthias Ringwald     hci_stack->chipset = chipset_driver;
49503fb36a29SMatthias Ringwald 
49513fb36a29SMatthias Ringwald     // reset chipset driver - init is also called on power_up
49523fb36a29SMatthias Ringwald     if (hci_stack->chipset && hci_stack->chipset->init){
49533fb36a29SMatthias Ringwald         hci_stack->chipset->init(hci_stack->config);
49543fb36a29SMatthias Ringwald     }
49553fb36a29SMatthias Ringwald }
49563fb36a29SMatthias Ringwald 
49576fe16221SMatthias Ringwald void hci_enable_custom_pre_init(void){
49586fe16221SMatthias Ringwald     hci_stack->chipset_pre_init = true;
49596fe16221SMatthias Ringwald }
49606fe16221SMatthias Ringwald 
4961fb55bd0aSMatthias Ringwald /**
4962d0b87befSMatthias Ringwald  * @brief Configure Bluetooth hardware control. Has to be called after hci_init() but before power on.
4963fb55bd0aSMatthias Ringwald  */
4964fb55bd0aSMatthias Ringwald void hci_set_control(const btstack_control_t *hardware_control){
4965fb55bd0aSMatthias Ringwald     // references to used control implementation
4966fb55bd0aSMatthias Ringwald     hci_stack->control = hardware_control;
4967d0b87befSMatthias Ringwald     // init with transport config
4968d0b87befSMatthias Ringwald     hardware_control->init(hci_stack->config);
4969fb55bd0aSMatthias Ringwald }
4970fb55bd0aSMatthias Ringwald 
49711f9eb2ccSMatthias Ringwald static void hci_discard_connections(void){
4972346f8c2cSMatthias Ringwald     btstack_linked_list_iterator_t it;
4973346f8c2cSMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->connections);
4974346f8c2cSMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
49751f9eb2ccSMatthias Ringwald         // cancel all l2cap connections by emitting dicsconnection complete before shutdown (free) connection
4976346f8c2cSMatthias Ringwald         hci_connection_t * connection = (hci_connection_t*) btstack_linked_list_iterator_next(&it);
49771f9eb2ccSMatthias Ringwald         hci_emit_disconnection_complete(connection->con_handle, 0x16); // terminated by local host
49781f9eb2ccSMatthias Ringwald         hci_shutdown_connection(connection);
49791f9eb2ccSMatthias Ringwald     }
4980346f8c2cSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
4981346f8c2cSMatthias Ringwald     while (hci_stack->iso_streams != NULL){
4982346f8c2cSMatthias Ringwald         hci_iso_stream_finalize((hci_iso_stream_t *) hci_stack->iso_streams);
4983346f8c2cSMatthias Ringwald     }
4984346f8c2cSMatthias Ringwald #endif
49851f9eb2ccSMatthias Ringwald }
49861f9eb2ccSMatthias Ringwald 
498771de195eSMatthias Ringwald void hci_close(void){
4988e6d6524dSMatthias Ringwald 
4989e6d6524dSMatthias Ringwald #ifdef ENABLE_CLASSIC
4990404843c1Smatthias.ringwald     // close remote device db
4991a98592bcSMatthias Ringwald     if (hci_stack->link_key_db) {
4992a98592bcSMatthias Ringwald         hci_stack->link_key_db->close();
4993404843c1Smatthias.ringwald     }
4994e6d6524dSMatthias Ringwald #endif
49957224be7eSMatthias Ringwald 
49961f9eb2ccSMatthias Ringwald     hci_discard_connections();
49977224be7eSMatthias Ringwald 
4998f5454fc6Smatthias.ringwald     hci_power_control(HCI_POWER_OFF);
49993a9fb326S[email protected] 
50003a9fb326S[email protected] #ifdef HAVE_MALLOC
50013a9fb326S[email protected]     free(hci_stack);
50023a9fb326S[email protected] #endif
50033a9fb326S[email protected]     hci_stack = NULL;
5004404843c1Smatthias.ringwald }
5005404843c1Smatthias.ringwald 
5006cb70c5abSMatthias Ringwald #ifdef HAVE_SCO_TRANSPORT
5007cb70c5abSMatthias Ringwald void hci_set_sco_transport(const btstack_sco_transport_t *sco_transport){
5008cb70c5abSMatthias Ringwald     hci_stack->sco_transport = sco_transport;
5009cb70c5abSMatthias Ringwald     sco_transport->register_packet_handler(&packet_handler);
5010cb70c5abSMatthias Ringwald }
5011cb70c5abSMatthias Ringwald #endif
5012cb70c5abSMatthias Ringwald 
501335454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
5014170fafaeSMatthias Ringwald void gap_set_required_encryption_key_size(uint8_t encryption_key_size){
5015170fafaeSMatthias Ringwald     // validate ranage and set
5016170fafaeSMatthias Ringwald     if (encryption_key_size < 7)  return;
5017170fafaeSMatthias Ringwald     if (encryption_key_size > 16) return;
5018170fafaeSMatthias Ringwald     hci_stack->gap_required_encyrption_key_size = encryption_key_size;
5019170fafaeSMatthias Ringwald }
502078315a58SMatthias Ringwald 
5021137715ebSMatthias Ringwald uint8_t gap_set_security_mode(gap_security_mode_t security_mode){
5022137715ebSMatthias Ringwald     if ((security_mode == GAP_SECURITY_MODE_4) || (security_mode == GAP_SECURITY_MODE_2)){
50235dbec6b3SMatthias Ringwald         hci_stack->gap_security_mode = security_mode;
5024137715ebSMatthias Ringwald         return ERROR_CODE_SUCCESS;
5025137715ebSMatthias Ringwald     } else {
5026137715ebSMatthias Ringwald         return ERROR_CODE_UNSUPPORTED_FEATURE_OR_PARAMETER_VALUE;
5027137715ebSMatthias Ringwald     }
50285dbec6b3SMatthias Ringwald }
50295dbec6b3SMatthias Ringwald 
50305dbec6b3SMatthias Ringwald gap_security_mode_t gap_get_security_mode(void){
50315dbec6b3SMatthias Ringwald     return hci_stack->gap_security_mode;
50325dbec6b3SMatthias Ringwald }
50335dbec6b3SMatthias Ringwald 
503478315a58SMatthias Ringwald void gap_set_security_level(gap_security_level_t security_level){
503578315a58SMatthias Ringwald     hci_stack->gap_security_level = security_level;
503678315a58SMatthias Ringwald }
503778315a58SMatthias Ringwald 
503878315a58SMatthias Ringwald gap_security_level_t gap_get_security_level(void){
5039d7387af3SMatthias Ringwald     if (hci_stack->gap_secure_connections_only_mode){
5040d7387af3SMatthias Ringwald         return LEVEL_4;
5041d7387af3SMatthias Ringwald     }
504278315a58SMatthias Ringwald     return hci_stack->gap_security_level;
504378315a58SMatthias Ringwald }
504430cdf3c6SMatthias Ringwald 
50458ad4dfffSMatthias Ringwald void gap_set_minimal_service_security_level(gap_security_level_t security_level){
50468ad4dfffSMatthias Ringwald     hci_stack->gap_minimal_service_security_level = security_level;
50478ad4dfffSMatthias Ringwald }
50488ad4dfffSMatthias Ringwald 
504930cdf3c6SMatthias Ringwald void gap_set_secure_connections_only_mode(bool enable){
505030cdf3c6SMatthias Ringwald     hci_stack->gap_secure_connections_only_mode = enable;
505130cdf3c6SMatthias Ringwald }
505230cdf3c6SMatthias Ringwald 
505330cdf3c6SMatthias Ringwald bool gap_get_secure_connections_only_mode(void){
505430cdf3c6SMatthias Ringwald     return hci_stack->gap_secure_connections_only_mode;
505530cdf3c6SMatthias Ringwald }
5056170fafaeSMatthias Ringwald #endif
5057170fafaeSMatthias Ringwald 
5058170fafaeSMatthias Ringwald #ifdef ENABLE_CLASSIC
505960b9e82fSMatthias Ringwald void gap_set_class_of_device(uint32_t class_of_device){
50609e61646fS[email protected]     hci_stack->class_of_device = class_of_device;
5061baa4881eSMatthias Ringwald     hci_stack->gap_tasks_classic |= GAP_TASK_SET_CLASS_OF_DEVICE;
506259d59ecfSMatthias Ringwald     hci_run();
50639e61646fS[email protected] }
506476f27cffSMatthias Ringwald 
5065c33e56d3SMatthias Ringwald void gap_set_default_link_policy_settings(uint16_t default_link_policy_settings){
5066c33e56d3SMatthias Ringwald     hci_stack->default_link_policy_settings = default_link_policy_settings;
5067baa4881eSMatthias Ringwald     hci_stack->gap_tasks_classic |= GAP_TASK_SET_DEFAULT_LINK_POLICY;
506859d59ecfSMatthias Ringwald     hci_run();
5069c33e56d3SMatthias Ringwald }
5070c33e56d3SMatthias Ringwald 
5071b4eb4420SMatthias Ringwald void gap_set_allow_role_switch(bool allow_role_switch){
5072b4eb4420SMatthias Ringwald     hci_stack->allow_role_switch = allow_role_switch ? 1 : 0;
5073b4eb4420SMatthias Ringwald }
5074b4eb4420SMatthias Ringwald 
5075b4eb4420SMatthias Ringwald uint8_t hci_get_allow_role_switch(void){
5076b4eb4420SMatthias Ringwald     return  hci_stack->allow_role_switch;
5077b4eb4420SMatthias Ringwald }
5078b4eb4420SMatthias Ringwald 
50790c3eb48dSMatthias Ringwald void gap_set_link_supervision_timeout(uint16_t link_supervision_timeout){
50800c3eb48dSMatthias Ringwald     hci_stack->link_supervision_timeout = link_supervision_timeout;
50810c3eb48dSMatthias Ringwald }
50820c3eb48dSMatthias Ringwald 
50839afaa4d4SMatthias Ringwald void gap_enable_link_watchdog(uint16_t timeout_ms){
50849afaa4d4SMatthias Ringwald     hci_stack->automatic_flush_timeout = btstack_min(timeout_ms, 1280) * 8 / 5; // divide by 0.625
50859afaa4d4SMatthias Ringwald }
50869afaa4d4SMatthias Ringwald 
50879afaa4d4SMatthias Ringwald uint16_t hci_automatic_flush_timeout(void){
50889afaa4d4SMatthias Ringwald     return hci_stack->automatic_flush_timeout;
50899afaa4d4SMatthias Ringwald }
50909afaa4d4SMatthias Ringwald 
509176f27cffSMatthias Ringwald void hci_disable_l2cap_timeout_check(void){
509276f27cffSMatthias Ringwald     disable_l2cap_timeouts = 1;
509376f27cffSMatthias Ringwald }
509435454696SMatthias Ringwald #endif
50959e61646fS[email protected] 
50966fad2c37SMatthias Ringwald #ifndef HAVE_HOST_CONTROLLER_API
5097f456b2d0S[email protected] // Set Public BD ADDR - passed on to Bluetooth chipset if supported in bt_control_h
5098f456b2d0S[email protected] void hci_set_bd_addr(bd_addr_t addr){
50996535961aSMatthias Ringwald     (void)memcpy(hci_stack->custom_bd_addr, addr, 6);
5100f456b2d0S[email protected]     hci_stack->custom_bd_addr_set = 1;
5101f456b2d0S[email protected] }
510276f27cffSMatthias Ringwald #endif
5103f456b2d0S[email protected] 
51048d213e1aSmatthias.ringwald // State-Module-Driver overview
51058d213e1aSmatthias.ringwald // state                    module  low-level
51068d213e1aSmatthias.ringwald // HCI_STATE_OFF             off      close
51078d213e1aSmatthias.ringwald // HCI_STATE_INITIALIZING,   on       open
51088d213e1aSmatthias.ringwald // HCI_STATE_WORKING,        on       open
51098d213e1aSmatthias.ringwald // HCI_STATE_HALTING,        on       open
5110d661ed19Smatthias.ringwald // HCI_STATE_SLEEPING,    off/sleep   close
5111d661ed19Smatthias.ringwald // HCI_STATE_FALLING_ASLEEP  on       open
5112c7e0c5f6Smatthias.ringwald 
511340d1c7a4Smatthias.ringwald static int hci_power_control_on(void){
51147301ad89Smatthias.ringwald 
5115038bc64cSmatthias.ringwald     // power on
5116f9a30166Smatthias.ringwald     int err = 0;
51173a9fb326S[email protected]     if (hci_stack->control && hci_stack->control->on){
5118d0b87befSMatthias Ringwald         err = (*hci_stack->control->on)();
5119f9a30166Smatthias.ringwald     }
5120038bc64cSmatthias.ringwald     if (err){
51219da54300S[email protected]         log_error( "POWER_ON failed");
5122038bc64cSmatthias.ringwald         hci_emit_hci_open_failed();
5123038bc64cSmatthias.ringwald         return err;
5124038bc64cSmatthias.ringwald     }
5125038bc64cSmatthias.ringwald 
512624b3c629SMatthias Ringwald     // int chipset driver
51273fb36a29SMatthias Ringwald     if (hci_stack->chipset && hci_stack->chipset->init){
51283fb36a29SMatthias Ringwald         hci_stack->chipset->init(hci_stack->config);
51293fb36a29SMatthias Ringwald     }
51303fb36a29SMatthias Ringwald 
513124b3c629SMatthias Ringwald     // init transport
513224b3c629SMatthias Ringwald     if (hci_stack->hci_transport->init){
513324b3c629SMatthias Ringwald         hci_stack->hci_transport->init(hci_stack->config);
513424b3c629SMatthias Ringwald     }
513524b3c629SMatthias Ringwald 
513624b3c629SMatthias Ringwald     // open transport
513724b3c629SMatthias Ringwald     err = hci_stack->hci_transport->open();
5138038bc64cSmatthias.ringwald     if (err){
51399da54300S[email protected]         log_error( "HCI_INIT failed, turning Bluetooth off again");
51403a9fb326S[email protected]         if (hci_stack->control && hci_stack->control->off){
5141d0b87befSMatthias Ringwald             (*hci_stack->control->off)();
5142f9a30166Smatthias.ringwald         }
5143038bc64cSmatthias.ringwald         hci_emit_hci_open_failed();
5144038bc64cSmatthias.ringwald         return err;
5145038bc64cSmatthias.ringwald     }
51468d213e1aSmatthias.ringwald     return 0;
51478d213e1aSmatthias.ringwald }
5148038bc64cSmatthias.ringwald 
514940d1c7a4Smatthias.ringwald static void hci_power_control_off(void){
51508d213e1aSmatthias.ringwald 
51519da54300S[email protected]     log_info("hci_power_control_off");
51529418f9c9Smatthias.ringwald 
51538d213e1aSmatthias.ringwald     // close low-level device
515424b3c629SMatthias Ringwald     hci_stack->hci_transport->close();
51558d213e1aSmatthias.ringwald 
51569da54300S[email protected]     log_info("hci_power_control_off - hci_transport closed");
51579418f9c9Smatthias.ringwald 
51588d213e1aSmatthias.ringwald     // power off
51593a9fb326S[email protected]     if (hci_stack->control && hci_stack->control->off){
5160d0b87befSMatthias Ringwald         (*hci_stack->control->off)();
51618d213e1aSmatthias.ringwald     }
51629418f9c9Smatthias.ringwald 
51639da54300S[email protected]     log_info("hci_power_control_off - control closed");
51649418f9c9Smatthias.ringwald 
51653a9fb326S[email protected]     hci_stack->state = HCI_STATE_OFF;
516672ea5239Smatthias.ringwald }
516772ea5239Smatthias.ringwald 
516840d1c7a4Smatthias.ringwald static void hci_power_control_sleep(void){
516972ea5239Smatthias.ringwald 
51709da54300S[email protected]     log_info("hci_power_control_sleep");
51713144bce4Smatthias.ringwald 
5172b429b9b7Smatthias.ringwald #if 0
5173b429b9b7Smatthias.ringwald     // don't close serial port during sleep
5174b429b9b7Smatthias.ringwald 
517572ea5239Smatthias.ringwald     // close low-level device
51763a9fb326S[email protected]     hci_stack->hci_transport->close(hci_stack->config);
5177b429b9b7Smatthias.ringwald #endif
517872ea5239Smatthias.ringwald 
517972ea5239Smatthias.ringwald     // sleep mode
51803a9fb326S[email protected]     if (hci_stack->control && hci_stack->control->sleep){
5181d0b87befSMatthias Ringwald         (*hci_stack->control->sleep)();
518272ea5239Smatthias.ringwald     }
5183b429b9b7Smatthias.ringwald 
51843a9fb326S[email protected]     hci_stack->state = HCI_STATE_SLEEPING;
51858d213e1aSmatthias.ringwald }
51868d213e1aSmatthias.ringwald 
518740d1c7a4Smatthias.ringwald static int hci_power_control_wake(void){
5188b429b9b7Smatthias.ringwald 
51899da54300S[email protected]     log_info("hci_power_control_wake");
5190b429b9b7Smatthias.ringwald 
5191b429b9b7Smatthias.ringwald     // wake on
51923a9fb326S[email protected]     if (hci_stack->control && hci_stack->control->wake){
5193d0b87befSMatthias Ringwald         (*hci_stack->control->wake)();
5194b429b9b7Smatthias.ringwald     }
5195b429b9b7Smatthias.ringwald 
5196b429b9b7Smatthias.ringwald #if 0
5197b429b9b7Smatthias.ringwald     // open low-level device
51983a9fb326S[email protected]     int err = hci_stack->hci_transport->open(hci_stack->config);
5199b429b9b7Smatthias.ringwald     if (err){
52009da54300S[email protected]         log_error( "HCI_INIT failed, turning Bluetooth off again");
52013a9fb326S[email protected]         if (hci_stack->control && hci_stack->control->off){
5202d0b87befSMatthias Ringwald             (*hci_stack->control->off)();
5203b429b9b7Smatthias.ringwald         }
5204b429b9b7Smatthias.ringwald         hci_emit_hci_open_failed();
5205b429b9b7Smatthias.ringwald         return err;
5206b429b9b7Smatthias.ringwald     }
5207b429b9b7Smatthias.ringwald #endif
5208b429b9b7Smatthias.ringwald 
5209b429b9b7Smatthias.ringwald     return 0;
5210b429b9b7Smatthias.ringwald }
5211b429b9b7Smatthias.ringwald 
52120c88d5efSMatthias Ringwald static void hci_power_enter_initializing_state(void){
521344935e40S[email protected]     // set up state machine
521444935e40S[email protected]     hci_stack->num_cmd_packets = 1; // assume that one cmd can be sent
521502c7fc01SMatthias Ringwald     hci_stack->hci_packet_buffer_reserved = false;
521644935e40S[email protected]     hci_stack->state = HCI_STATE_INITIALIZING;
52176fe16221SMatthias Ringwald 
52180535e08cSMatthias Ringwald #ifndef HAVE_HOST_CONTROLLER_API
52196fe16221SMatthias Ringwald     if (hci_stack->chipset_pre_init) {
52206fe16221SMatthias Ringwald         hci_stack->substate = HCI_INIT_CUSTOM_PRE_INIT;
52210535e08cSMatthias Ringwald     } else
52220535e08cSMatthias Ringwald #endif
52230535e08cSMatthias Ringwald     {
52245c363727SMatthias Ringwald         hci_stack->substate = HCI_INIT_SEND_RESET;
522544935e40S[email protected]     }
52266fe16221SMatthias Ringwald }
5227b429b9b7Smatthias.ringwald 
52280c88d5efSMatthias Ringwald static void hci_power_enter_halting_state(void){
52290c88d5efSMatthias Ringwald #ifdef ENABLE_BLE
52301e907691SMatthias Ringwald     // drop entries scheduled for removal, mark others for re-adding
52311e907691SMatthias Ringwald     btstack_linked_list_iterator_t it;
52321e907691SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->le_whitelist);
52331e907691SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
52341e907691SMatthias Ringwald         whitelist_entry_t * entry = (whitelist_entry_t*) btstack_linked_list_iterator_next(&it);
52351e907691SMatthias Ringwald         if ((entry->state & (LE_WHITELIST_REMOVE_FROM_CONTROLLER | LE_WHITELIST_ADD_TO_CONTROLLER)) == LE_WHITELIST_REMOVE_FROM_CONTROLLER){
52361e907691SMatthias Ringwald             btstack_linked_list_iterator_remove(&it);
52371e907691SMatthias Ringwald             btstack_memory_whitelist_entry_free(entry);
52381e907691SMatthias Ringwald         } else {
52391e907691SMatthias Ringwald             entry->state = LE_WHITELIST_ADD_TO_CONTROLLER;
52401e907691SMatthias Ringwald         }
52411e907691SMatthias Ringwald     }
5242a2c9d908SMatthias Ringwald #ifdef ENABLE_LE_PERIODIC_ADVERTISING
5243e8d160b3SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->le_periodic_advertiser_list);
5244e8d160b3SMatthias Ringwald     const uint8_t mask = LE_PERIODIC_ADVERTISER_LIST_ENTRY_REMOVE_FROM_CONTROLLER | LE_PERIODIC_ADVERTISER_LIST_ENTRY_REMOVE_FROM_CONTROLLER;
5245e8d160b3SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
5246e8d160b3SMatthias Ringwald         periodic_advertiser_list_entry_t * entry = (periodic_advertiser_list_entry_t*) btstack_linked_list_iterator_next(&it);
5247e8d160b3SMatthias Ringwald         if ((entry->state & mask) == LE_PERIODIC_ADVERTISER_LIST_ENTRY_REMOVE_FROM_CONTROLLER) {
5248e8d160b3SMatthias Ringwald             btstack_linked_list_iterator_remove(&it);
5249e8d160b3SMatthias Ringwald             btstack_memory_periodic_advertiser_list_entry_free(entry);
5250e8d160b3SMatthias Ringwald         } else {
5251e8d160b3SMatthias Ringwald             entry->state |= LE_PERIODIC_ADVERTISER_LIST_ENTRY_ADD_TO_CONTROLLER;
5252e8d160b3SMatthias Ringwald             continue;
5253e8d160b3SMatthias Ringwald         }
5254e8d160b3SMatthias Ringwald     }
5255a2c9d908SMatthias Ringwald #endif
52560c88d5efSMatthias Ringwald #endif
5257184dbe2fSMatthias Ringwald     // see hci_run
5258184dbe2fSMatthias Ringwald     hci_stack->state = HCI_STATE_HALTING;
52590c88d5efSMatthias Ringwald     hci_stack->substate = HCI_HALTING_CLASSIC_STOP;
5260184dbe2fSMatthias Ringwald     // setup watchdog timer for disconnect - only triggers if Controller does not respond anymore
5261184dbe2fSMatthias Ringwald     btstack_run_loop_set_timer(&hci_stack->timeout, 1000);
5262184dbe2fSMatthias Ringwald     btstack_run_loop_set_timer_handler(&hci_stack->timeout, hci_halting_timeout_handler);
5263184dbe2fSMatthias Ringwald     btstack_run_loop_add_timer(&hci_stack->timeout);
5264184dbe2fSMatthias Ringwald }
5265184dbe2fSMatthias Ringwald 
526642bd3d77SMatthias Ringwald // returns error
526742bd3d77SMatthias Ringwald static int hci_power_control_state_off(HCI_POWER_MODE power_mode){
526842bd3d77SMatthias Ringwald     int err;
52698d213e1aSmatthias.ringwald     switch (power_mode){
52708d213e1aSmatthias.ringwald         case HCI_POWER_ON:
52718d213e1aSmatthias.ringwald             err = hci_power_control_on();
527242bd3d77SMatthias Ringwald             if (err != 0) {
5273f04a0c31SMatthias Ringwald                 log_error("hci_power_control_on() error %d", err);
527497b61c7bS[email protected]                 return err;
527597b61c7bS[email protected]             }
52760c88d5efSMatthias Ringwald             hci_power_enter_initializing_state();
52778d213e1aSmatthias.ringwald             break;
52788d213e1aSmatthias.ringwald         case HCI_POWER_OFF:
52798d213e1aSmatthias.ringwald             // do nothing
52808d213e1aSmatthias.ringwald             break;
52818d213e1aSmatthias.ringwald         case HCI_POWER_SLEEP:
5282b546ac54Smatthias.ringwald             // do nothing (with SLEEP == OFF)
52838d213e1aSmatthias.ringwald             break;
52847bbeb3adSMilanka Ringwald         default:
52857bbeb3adSMilanka Ringwald             btstack_assert(false);
52867bbeb3adSMilanka Ringwald             break;
52878d213e1aSmatthias.ringwald     }
528842bd3d77SMatthias Ringwald     return ERROR_CODE_SUCCESS;
528942bd3d77SMatthias Ringwald }
52907301ad89Smatthias.ringwald 
529142bd3d77SMatthias Ringwald static int hci_power_control_state_initializing(HCI_POWER_MODE power_mode){
52928d213e1aSmatthias.ringwald     switch (power_mode){
52938d213e1aSmatthias.ringwald         case HCI_POWER_ON:
52948d213e1aSmatthias.ringwald             // do nothing
52958d213e1aSmatthias.ringwald             break;
52968d213e1aSmatthias.ringwald         case HCI_POWER_OFF:
52978d213e1aSmatthias.ringwald             // no connections yet, just turn it off
52988d213e1aSmatthias.ringwald             hci_power_control_off();
52998d213e1aSmatthias.ringwald             break;
53008d213e1aSmatthias.ringwald         case HCI_POWER_SLEEP:
5301b546ac54Smatthias.ringwald             // no connections yet, just turn it off
530272ea5239Smatthias.ringwald             hci_power_control_sleep();
53038d213e1aSmatthias.ringwald             break;
53047bbeb3adSMilanka Ringwald         default:
53057bbeb3adSMilanka Ringwald             btstack_assert(false);
53067bbeb3adSMilanka Ringwald             break;
53078d213e1aSmatthias.ringwald     }
530842bd3d77SMatthias Ringwald     return ERROR_CODE_SUCCESS;
530942bd3d77SMatthias Ringwald }
53107301ad89Smatthias.ringwald 
531142bd3d77SMatthias Ringwald static int hci_power_control_state_working(HCI_POWER_MODE power_mode) {
53128d213e1aSmatthias.ringwald     switch (power_mode){
53138d213e1aSmatthias.ringwald         case HCI_POWER_ON:
53148d213e1aSmatthias.ringwald             // do nothing
53158d213e1aSmatthias.ringwald             break;
53168d213e1aSmatthias.ringwald         case HCI_POWER_OFF:
53170c88d5efSMatthias Ringwald             hci_power_enter_halting_state();
53188d213e1aSmatthias.ringwald             break;
53198d213e1aSmatthias.ringwald         case HCI_POWER_SLEEP:
5320b546ac54Smatthias.ringwald             // see hci_run
53213a9fb326S[email protected]             hci_stack->state = HCI_STATE_FALLING_ASLEEP;
532274b323a9SMatthias Ringwald             hci_stack->substate = HCI_FALLING_ASLEEP_DISCONNECT;
53238d213e1aSmatthias.ringwald             break;
53247bbeb3adSMilanka Ringwald         default:
53257bbeb3adSMilanka Ringwald             btstack_assert(false);
53267bbeb3adSMilanka Ringwald             break;
53278d213e1aSmatthias.ringwald     }
532842bd3d77SMatthias Ringwald     return ERROR_CODE_SUCCESS;
532942bd3d77SMatthias Ringwald }
53307301ad89Smatthias.ringwald 
533142bd3d77SMatthias Ringwald static int hci_power_control_state_halting(HCI_POWER_MODE power_mode) {
53328d213e1aSmatthias.ringwald     switch (power_mode){
53338d213e1aSmatthias.ringwald         case HCI_POWER_ON:
53340c88d5efSMatthias Ringwald             hci_power_enter_initializing_state();
53358d213e1aSmatthias.ringwald             break;
53368d213e1aSmatthias.ringwald         case HCI_POWER_OFF:
53378d213e1aSmatthias.ringwald             // do nothing
53388d213e1aSmatthias.ringwald             break;
53398d213e1aSmatthias.ringwald         case HCI_POWER_SLEEP:
5340b546ac54Smatthias.ringwald             // see hci_run
53413a9fb326S[email protected]             hci_stack->state = HCI_STATE_FALLING_ASLEEP;
534274b323a9SMatthias Ringwald             hci_stack->substate = HCI_FALLING_ASLEEP_DISCONNECT;
53438d213e1aSmatthias.ringwald             break;
53447bbeb3adSMilanka Ringwald         default:
53457bbeb3adSMilanka Ringwald             btstack_assert(false);
53467bbeb3adSMilanka Ringwald             break;
53478d213e1aSmatthias.ringwald     }
534800278272SMatthias Ringwald     return ERROR_CODE_SUCCESS;
534942bd3d77SMatthias Ringwald }
53508d213e1aSmatthias.ringwald 
535142bd3d77SMatthias Ringwald static int hci_power_control_state_falling_asleep(HCI_POWER_MODE power_mode) {
53528d213e1aSmatthias.ringwald     switch (power_mode){
53538d213e1aSmatthias.ringwald         case HCI_POWER_ON:
53540c88d5efSMatthias Ringwald             hci_power_enter_initializing_state();
53558d213e1aSmatthias.ringwald             break;
53568d213e1aSmatthias.ringwald         case HCI_POWER_OFF:
53570c88d5efSMatthias Ringwald             hci_power_enter_halting_state();
53588d213e1aSmatthias.ringwald             break;
53598d213e1aSmatthias.ringwald         case HCI_POWER_SLEEP:
5360b546ac54Smatthias.ringwald             // do nothing
53618d213e1aSmatthias.ringwald             break;
53627bbeb3adSMilanka Ringwald         default:
53637bbeb3adSMilanka Ringwald             btstack_assert(false);
53647bbeb3adSMilanka Ringwald             break;
53658d213e1aSmatthias.ringwald     }
536642bd3d77SMatthias Ringwald     return ERROR_CODE_SUCCESS;
536742bd3d77SMatthias Ringwald }
53688d213e1aSmatthias.ringwald 
536942bd3d77SMatthias Ringwald static int hci_power_control_state_sleeping(HCI_POWER_MODE power_mode) {
537042bd3d77SMatthias Ringwald     int err;
53718d213e1aSmatthias.ringwald     switch (power_mode){
53728d213e1aSmatthias.ringwald         case HCI_POWER_ON:
53733144bce4Smatthias.ringwald             err = hci_power_control_wake();
53743144bce4Smatthias.ringwald             if (err) return err;
53750c88d5efSMatthias Ringwald             hci_power_enter_initializing_state();
53768d213e1aSmatthias.ringwald             break;
53778d213e1aSmatthias.ringwald         case HCI_POWER_OFF:
53780c88d5efSMatthias Ringwald             hci_power_enter_halting_state();
53798d213e1aSmatthias.ringwald             break;
53808d213e1aSmatthias.ringwald         case HCI_POWER_SLEEP:
5381b546ac54Smatthias.ringwald             // do nothing
53828d213e1aSmatthias.ringwald             break;
53837bbeb3adSMilanka Ringwald         default:
53847bbeb3adSMilanka Ringwald             btstack_assert(false);
53857bbeb3adSMilanka Ringwald             break;
53868d213e1aSmatthias.ringwald     }
538742bd3d77SMatthias Ringwald     return ERROR_CODE_SUCCESS;
538842bd3d77SMatthias Ringwald }
53897bbeb3adSMilanka Ringwald 
539042bd3d77SMatthias Ringwald int hci_power_control(HCI_POWER_MODE power_mode){
539142bd3d77SMatthias Ringwald     log_info("hci_power_control: %d, current mode %u", power_mode, hci_stack->state);
5392bef627f1SMatthias Ringwald     btstack_run_loop_remove_timer(&hci_stack->timeout);
539324f87726SMatthias Ringwald     int err = 0;
539442bd3d77SMatthias Ringwald     switch (hci_stack->state){
539542bd3d77SMatthias Ringwald         case HCI_STATE_OFF:
539642bd3d77SMatthias Ringwald             err = hci_power_control_state_off(power_mode);
539742bd3d77SMatthias Ringwald             break;
539842bd3d77SMatthias Ringwald         case HCI_STATE_INITIALIZING:
539942bd3d77SMatthias Ringwald             err = hci_power_control_state_initializing(power_mode);
540042bd3d77SMatthias Ringwald             break;
540142bd3d77SMatthias Ringwald         case HCI_STATE_WORKING:
540242bd3d77SMatthias Ringwald             err = hci_power_control_state_working(power_mode);
540342bd3d77SMatthias Ringwald             break;
540442bd3d77SMatthias Ringwald         case HCI_STATE_HALTING:
540542bd3d77SMatthias Ringwald             err = hci_power_control_state_halting(power_mode);
540642bd3d77SMatthias Ringwald             break;
540742bd3d77SMatthias Ringwald         case HCI_STATE_FALLING_ASLEEP:
540842bd3d77SMatthias Ringwald             err = hci_power_control_state_falling_asleep(power_mode);
540942bd3d77SMatthias Ringwald             break;
541042bd3d77SMatthias Ringwald         case HCI_STATE_SLEEPING:
541142bd3d77SMatthias Ringwald             err = hci_power_control_state_sleeping(power_mode);
541242bd3d77SMatthias Ringwald             break;
54137bbeb3adSMilanka Ringwald         default:
54147bbeb3adSMilanka Ringwald             btstack_assert(false);
54157bbeb3adSMilanka Ringwald             break;
541611e23e5fSmatthias.ringwald     }
541724f87726SMatthias Ringwald     if (err != 0){
541842bd3d77SMatthias Ringwald         return err;
541942bd3d77SMatthias Ringwald     }
542068d92d03Smatthias.ringwald 
5421038bc64cSmatthias.ringwald     // create internal event
5422ee8bf225Smatthias.ringwald 	hci_emit_state();
5423ee8bf225Smatthias.ringwald 
542468d92d03Smatthias.ringwald 	// trigger next/first action
542568d92d03Smatthias.ringwald 	hci_run();
542668d92d03Smatthias.ringwald 
5427475c8125Smatthias.ringwald     return 0;
5428475c8125Smatthias.ringwald }
5429475c8125Smatthias.ringwald 
543035454696SMatthias Ringwald 
5431091e35e3SMatthias Ringwald static void hci_halting_run(void) {
5432091e35e3SMatthias Ringwald 
5433091e35e3SMatthias Ringwald     log_info("HCI_STATE_HALTING, substate %x\n", hci_stack->substate);
5434091e35e3SMatthias Ringwald 
5435091e35e3SMatthias Ringwald     hci_connection_t *connection;
5436d5f71a7eSMatthias Ringwald #ifdef ENABLE_BLE
5437d5f71a7eSMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
5438911801caSMatthias Ringwald     bool stop_advertismenets;
5439d5f71a7eSMatthias Ringwald #endif
5440d5f71a7eSMatthias Ringwald #endif
5441091e35e3SMatthias Ringwald 
5442091e35e3SMatthias Ringwald     switch (hci_stack->substate) {
54430c88d5efSMatthias Ringwald         case HCI_HALTING_CLASSIC_STOP:
54440c88d5efSMatthias Ringwald #ifdef ENABLE_CLASSIC
5445911801caSMatthias Ringwald             if (!hci_can_send_command_packet_now()) return;
5446911801caSMatthias Ringwald 
54470c88d5efSMatthias Ringwald             if (hci_stack->connectable || hci_stack->discoverable){
54480c88d5efSMatthias Ringwald                 hci_stack->substate = HCI_HALTING_LE_ADV_STOP;
54490c88d5efSMatthias Ringwald                 hci_send_cmd(&hci_write_scan_enable, 0);
54500c88d5efSMatthias Ringwald                 return;
54510c88d5efSMatthias Ringwald             }
54520c88d5efSMatthias Ringwald #endif
54530c88d5efSMatthias Ringwald             /* fall through */
54540c88d5efSMatthias Ringwald 
54550c88d5efSMatthias Ringwald         case HCI_HALTING_LE_ADV_STOP:
54560c88d5efSMatthias Ringwald             hci_stack->substate = HCI_HALTING_LE_ADV_STOP;
54570c88d5efSMatthias Ringwald 
54580c88d5efSMatthias Ringwald #ifdef ENABLE_BLE
54590c88d5efSMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
5460911801caSMatthias Ringwald             if (!hci_can_send_command_packet_now()) return;
5461911801caSMatthias Ringwald 
5462911801caSMatthias Ringwald             stop_advertismenets = (hci_stack->le_advertisements_state & LE_ADVERTISEMENT_STATE_ACTIVE) != 0;
5463911801caSMatthias Ringwald 
5464911801caSMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
5465911801caSMatthias Ringwald             if (hci_extended_advertising_supported()){
5466c814a904SMatthias Ringwald #ifdef ENABLE_LE_PERIODIC_ADVERTISING
5467911801caSMatthias Ringwald                 btstack_linked_list_iterator_t it;
5468911801caSMatthias Ringwald                 btstack_linked_list_iterator_init(&it, &hci_stack->le_advertising_sets);
5469911801caSMatthias Ringwald                 // stop all periodic advertisements and check if an extended set is active
5470911801caSMatthias Ringwald                 while (btstack_linked_list_iterator_has_next(&it)){
5471911801caSMatthias Ringwald                     le_advertising_set_t * advertising_set = (le_advertising_set_t*) btstack_linked_list_iterator_next(&it);
5472911801caSMatthias Ringwald                     if ((advertising_set->state & LE_ADVERTISEMENT_STATE_PERIODIC_ACTIVE) != 0) {
5473911801caSMatthias Ringwald                         advertising_set->state &= ~LE_ADVERTISEMENT_STATE_PERIODIC_ACTIVE;
5474911801caSMatthias Ringwald                         hci_send_cmd(&hci_le_set_periodic_advertising_enable, 0, advertising_set->advertising_handle);
54750c88d5efSMatthias Ringwald                         return;
54760c88d5efSMatthias Ringwald                     }
5477911801caSMatthias Ringwald                     if ((advertising_set->state & LE_ADVERTISEMENT_STATE_ACTIVE) != 0) {
5478911801caSMatthias Ringwald                         stop_advertismenets = true;
5479911801caSMatthias Ringwald                         advertising_set->state &= ~LE_ADVERTISEMENT_STATE_ACTIVE;
5480911801caSMatthias Ringwald                     }
5481911801caSMatthias Ringwald                 }
5482c814a904SMatthias Ringwald #endif /* ENABLE_LE_PERIODIC_ADVERTISING */
5483911801caSMatthias Ringwald                 if (stop_advertismenets){
5484911801caSMatthias Ringwald                     hci_stack->le_advertisements_state &= ~LE_ADVERTISEMENT_STATE_ACTIVE;
5485911801caSMatthias Ringwald                     hci_send_cmd(&hci_le_set_extended_advertising_enable, 0, 0, NULL, NULL, NULL);
5486911801caSMatthias Ringwald                     return;
5487911801caSMatthias Ringwald                 }
5488d935373dSMatthias Ringwald             } else
5489a2c9d908SMatthias Ringwald #else /* ENABLE_LE_PERIPHERAL */
5490911801caSMatthias Ringwald             {
5491911801caSMatthias Ringwald                 if (stop_advertismenets) {
5492911801caSMatthias Ringwald                     hci_stack->le_advertisements_state &= ~LE_ADVERTISEMENT_STATE_ACTIVE;
5493911801caSMatthias Ringwald                     hci_send_cmd(&hci_le_set_advertise_enable, 0);
5494911801caSMatthias Ringwald                     return;
5495911801caSMatthias Ringwald                 }
5496911801caSMatthias Ringwald             }
5497911801caSMatthias Ringwald #endif  /* ENABLE_LE_EXTENDED_ADVERTISING*/
5498911801caSMatthias Ringwald #endif  /* ENABLE_LE_PERIPHERAL */
5499911801caSMatthias Ringwald #endif  /* ENABLE_BLE */
5500911801caSMatthias Ringwald 
55010c88d5efSMatthias Ringwald             /* fall through */
55020c88d5efSMatthias Ringwald 
55030c88d5efSMatthias Ringwald         case HCI_HALTING_LE_SCAN_STOP:
55040c88d5efSMatthias Ringwald             hci_stack->substate = HCI_HALTING_LE_SCAN_STOP;
5505911801caSMatthias Ringwald             if (!hci_can_send_command_packet_now()) return;
5506091e35e3SMatthias Ringwald 
5507091e35e3SMatthias Ringwald #ifdef ENABLE_BLE
5508091e35e3SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
55090c88d5efSMatthias Ringwald             if (hci_stack->le_scanning_active){
5510c42da3bcSMatthias Ringwald                 hci_le_scan_stop();
55110c88d5efSMatthias Ringwald                 hci_stack->substate = HCI_HALTING_DISCONNECT_ALL;
55120c88d5efSMatthias Ringwald                 return;
55130c88d5efSMatthias Ringwald             }
5514091e35e3SMatthias Ringwald #endif
5515091e35e3SMatthias Ringwald #endif
55160c88d5efSMatthias Ringwald 
55170c88d5efSMatthias Ringwald             /* fall through */
55180c88d5efSMatthias Ringwald 
55190c88d5efSMatthias Ringwald         case HCI_HALTING_DISCONNECT_ALL:
55200c88d5efSMatthias Ringwald             hci_stack->substate = HCI_HALTING_DISCONNECT_ALL;
5521911801caSMatthias Ringwald             if (!hci_can_send_command_packet_now()) return;
55220c88d5efSMatthias Ringwald 
5523091e35e3SMatthias Ringwald             // close all open connections
5524091e35e3SMatthias Ringwald             connection = (hci_connection_t *) hci_stack->connections;
5525091e35e3SMatthias Ringwald             if (connection) {
5526091e35e3SMatthias Ringwald                 hci_con_handle_t con_handle = (uint16_t) connection->con_handle;
5527091e35e3SMatthias Ringwald 
552803270f05SMatthias Ringwald                 log_info("HCI_STATE_HALTING, connection %p, handle %u, state %u", connection, con_handle, connection->state);
5529091e35e3SMatthias Ringwald 
553003270f05SMatthias Ringwald                 // check state
553103270f05SMatthias Ringwald                 switch(connection->state) {
553203270f05SMatthias Ringwald                     case SENT_DISCONNECT:
553303270f05SMatthias Ringwald                     case RECEIVED_DISCONNECTION_COMPLETE:
553403270f05SMatthias Ringwald                         // wait until connection is gone
553503270f05SMatthias Ringwald                         return;
553603270f05SMatthias Ringwald                     default:
553703270f05SMatthias Ringwald                         break;
553803270f05SMatthias Ringwald                 }
5539091e35e3SMatthias Ringwald 
5540091e35e3SMatthias Ringwald                 // finally, send the disconnect command
554103270f05SMatthias Ringwald                 connection->state = SENT_DISCONNECT;
5542091e35e3SMatthias Ringwald                 hci_send_cmd(&hci_disconnect, con_handle, ERROR_CODE_REMOTE_USER_TERMINATED_CONNECTION);
5543091e35e3SMatthias Ringwald                 return;
5544091e35e3SMatthias Ringwald             }
5545091e35e3SMatthias Ringwald 
5546346f8c2cSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
5547346f8c2cSMatthias Ringwald             // stop BIGs and BIG Syncs
5548346f8c2cSMatthias Ringwald             if (hci_stack->le_audio_bigs != NULL){
5549346f8c2cSMatthias Ringwald                 le_audio_big_t * big = (le_audio_big_t*) hci_stack->le_audio_bigs;
5550346f8c2cSMatthias Ringwald                 if (big->state == LE_AUDIO_BIG_STATE_W4_TERMINATED) return;
5551346f8c2cSMatthias Ringwald                 big->state = LE_AUDIO_BIG_STATE_W4_TERMINATED;
5552346f8c2cSMatthias Ringwald                 hci_send_cmd(&hci_le_terminate_big, big->big_handle);
5553346f8c2cSMatthias Ringwald                 return;
5554346f8c2cSMatthias Ringwald             }
5555346f8c2cSMatthias Ringwald             if (hci_stack->le_audio_big_syncs != NULL){
5556346f8c2cSMatthias Ringwald                 le_audio_big_sync_t * big_sync = (le_audio_big_sync_t*) hci_stack->le_audio_big_syncs;
5557346f8c2cSMatthias Ringwald                 if (big_sync->state == LE_AUDIO_BIG_STATE_W4_TERMINATED) return;
5558346f8c2cSMatthias Ringwald                 big_sync->state = LE_AUDIO_BIG_STATE_W4_TERMINATED;
5559346f8c2cSMatthias Ringwald                 hci_send_cmd(&hci_le_big_terminate_sync, big_sync->big_handle);
5560346f8c2cSMatthias Ringwald                 return;
5561346f8c2cSMatthias Ringwald             }
5562346f8c2cSMatthias Ringwald #endif
5563346f8c2cSMatthias Ringwald 
5564091e35e3SMatthias Ringwald             btstack_run_loop_remove_timer(&hci_stack->timeout);
5565091e35e3SMatthias Ringwald 
5566091e35e3SMatthias Ringwald             // no connections left, wait a bit to assert that btstack_cyrpto isn't waiting for an HCI event
5567091e35e3SMatthias Ringwald             log_info("HCI_STATE_HALTING: wait 50 ms");
55680c88d5efSMatthias Ringwald             hci_stack->substate = HCI_HALTING_W4_CLOSE_TIMER;
5569091e35e3SMatthias Ringwald             btstack_run_loop_set_timer(&hci_stack->timeout, 50);
5570091e35e3SMatthias Ringwald             btstack_run_loop_set_timer_handler(&hci_stack->timeout, hci_halting_timeout_handler);
5571091e35e3SMatthias Ringwald             btstack_run_loop_add_timer(&hci_stack->timeout);
5572091e35e3SMatthias Ringwald             break;
5573091e35e3SMatthias Ringwald 
5574b188b5fcSMatthias Ringwald         case HCI_HALTING_W4_CLOSE_TIMER:
5575b188b5fcSMatthias Ringwald             // keep waiting
5576b188b5fcSMatthias Ringwald             break;
5577b188b5fcSMatthias Ringwald 
5578091e35e3SMatthias Ringwald         case HCI_HALTING_CLOSE:
5579091e35e3SMatthias Ringwald             // close left over connections (that had not been properly closed before)
5580b188b5fcSMatthias Ringwald             hci_stack->substate = HCI_HALTING_CLOSE_DISCARDING_CONNECTIONS;
5581091e35e3SMatthias Ringwald             hci_discard_connections();
5582091e35e3SMatthias Ringwald 
5583091e35e3SMatthias Ringwald             log_info("HCI_STATE_HALTING, calling off");
5584091e35e3SMatthias Ringwald 
5585091e35e3SMatthias Ringwald             // switch mode
5586091e35e3SMatthias Ringwald             hci_power_control_off();
5587091e35e3SMatthias Ringwald 
5588091e35e3SMatthias Ringwald             log_info("HCI_STATE_HALTING, emitting state");
5589091e35e3SMatthias Ringwald             hci_emit_state();
5590091e35e3SMatthias Ringwald             log_info("HCI_STATE_HALTING, done");
5591091e35e3SMatthias Ringwald             break;
5592091e35e3SMatthias Ringwald 
5593091e35e3SMatthias Ringwald         default:
5594091e35e3SMatthias Ringwald             break;
5595091e35e3SMatthias Ringwald     }
5596091e35e3SMatthias Ringwald };
5597091e35e3SMatthias Ringwald 
5598091e35e3SMatthias Ringwald static void hci_falling_asleep_run(void){
5599091e35e3SMatthias Ringwald     hci_connection_t * connection;
5600091e35e3SMatthias Ringwald     switch(hci_stack->substate) {
5601091e35e3SMatthias Ringwald         case HCI_FALLING_ASLEEP_DISCONNECT:
5602091e35e3SMatthias Ringwald             log_info("HCI_STATE_FALLING_ASLEEP");
5603091e35e3SMatthias Ringwald             // close all open connections
5604091e35e3SMatthias Ringwald             connection =  (hci_connection_t *) hci_stack->connections;
5605091e35e3SMatthias Ringwald             if (connection){
5606091e35e3SMatthias Ringwald 
5607091e35e3SMatthias Ringwald                 // send disconnect
5608091e35e3SMatthias Ringwald                 if (!hci_can_send_command_packet_now()) return;
5609091e35e3SMatthias Ringwald 
5610091e35e3SMatthias Ringwald                 log_info("HCI_STATE_FALLING_ASLEEP, connection %p, handle %u", connection, (uint16_t)connection->con_handle);
5611091e35e3SMatthias Ringwald                 hci_send_cmd(&hci_disconnect, connection->con_handle, ERROR_CODE_REMOTE_USER_TERMINATED_CONNECTION);
5612091e35e3SMatthias Ringwald 
5613091e35e3SMatthias Ringwald                 // send disconnected event right away - causes higher layer connections to get closed, too.
5614091e35e3SMatthias Ringwald                 hci_shutdown_connection(connection);
5615091e35e3SMatthias Ringwald                 return;
5616091e35e3SMatthias Ringwald             }
5617091e35e3SMatthias Ringwald 
5618091e35e3SMatthias Ringwald             if (hci_classic_supported()){
5619091e35e3SMatthias Ringwald                 // disable page and inquiry scan
5620091e35e3SMatthias Ringwald                 if (!hci_can_send_command_packet_now()) return;
5621091e35e3SMatthias Ringwald 
5622091e35e3SMatthias Ringwald                 log_info("HCI_STATE_HALTING, disabling inq scans");
5623091e35e3SMatthias Ringwald                 hci_send_cmd(&hci_write_scan_enable, hci_stack->connectable << 1); // drop inquiry scan but keep page scan
5624091e35e3SMatthias Ringwald 
5625091e35e3SMatthias Ringwald                 // continue in next sub state
5626091e35e3SMatthias Ringwald                 hci_stack->substate = HCI_FALLING_ASLEEP_W4_WRITE_SCAN_ENABLE;
5627091e35e3SMatthias Ringwald                 break;
5628091e35e3SMatthias Ringwald             }
5629091e35e3SMatthias Ringwald 
5630091e35e3SMatthias Ringwald             /* fall through */
5631091e35e3SMatthias Ringwald 
5632091e35e3SMatthias Ringwald             case HCI_FALLING_ASLEEP_COMPLETE:
5633091e35e3SMatthias Ringwald                 log_info("HCI_STATE_HALTING, calling sleep");
5634091e35e3SMatthias Ringwald                 // switch mode
5635091e35e3SMatthias Ringwald                 hci_power_control_sleep();  // changes hci_stack->state to SLEEP
5636091e35e3SMatthias Ringwald                 hci_emit_state();
5637091e35e3SMatthias Ringwald                 break;
5638091e35e3SMatthias Ringwald 
5639091e35e3SMatthias Ringwald                 default:
5640091e35e3SMatthias Ringwald                     break;
5641091e35e3SMatthias Ringwald     }
5642091e35e3SMatthias Ringwald }
5643091e35e3SMatthias Ringwald 
564435454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
564535454696SMatthias Ringwald 
5646758b46ceSmatthias.ringwald static void hci_update_scan_enable(void){
5647758b46ceSmatthias.ringwald     // 2 = page scan, 1 = inq scan
5648a1df452eSMatthias Ringwald     hci_stack->new_scan_enable_value  = (hci_stack->connectable << 1) | hci_stack->discoverable;
5649baa4881eSMatthias Ringwald     hci_stack->gap_tasks_classic |= GAP_TASK_WRITE_SCAN_ENABLE;
5650758b46ceSmatthias.ringwald     hci_run();
5651758b46ceSmatthias.ringwald }
5652758b46ceSmatthias.ringwald 
565315a95bd5SMatthias Ringwald void gap_discoverable_control(uint8_t enable){
5654381fbed8Smatthias.ringwald     if (enable) enable = 1; // normalize argument
5655381fbed8Smatthias.ringwald 
56563a9fb326S[email protected]     if (hci_stack->discoverable == enable){
565771fd255dSMatthias Ringwald         hci_emit_scan_mode_changed(hci_stack->discoverable, hci_stack->connectable);
5658381fbed8Smatthias.ringwald         return;
5659381fbed8Smatthias.ringwald     }
5660381fbed8Smatthias.ringwald 
56613a9fb326S[email protected]     hci_stack->discoverable = enable;
5662758b46ceSmatthias.ringwald     hci_update_scan_enable();
5663758b46ceSmatthias.ringwald }
5664b031bebbSmatthias.ringwald 
566515a95bd5SMatthias Ringwald void gap_connectable_control(uint8_t enable){
5666758b46ceSmatthias.ringwald     if (enable) enable = 1; // normalize argument
5667758b46ceSmatthias.ringwald 
5668758b46ceSmatthias.ringwald     // don't emit event
56693a9fb326S[email protected]     if (hci_stack->connectable == enable) return;
5670758b46ceSmatthias.ringwald 
56713a9fb326S[email protected]     hci_stack->connectable = enable;
5672758b46ceSmatthias.ringwald     hci_update_scan_enable();
5673381fbed8Smatthias.ringwald }
567435454696SMatthias Ringwald #endif
5675381fbed8Smatthias.ringwald 
567615a95bd5SMatthias Ringwald void gap_local_bd_addr(bd_addr_t address_buffer){
56776535961aSMatthias Ringwald     (void)memcpy(address_buffer, hci_stack->local_bd_addr, 6);
56785061f3afS[email protected] }
56795061f3afS[email protected] 
56802b838201SMatthias Ringwald #ifdef ENABLE_HCI_CONTROLLER_TO_HOST_FLOW_CONTROL
56812b838201SMatthias Ringwald static void hci_host_num_completed_packets(void){
56822b838201SMatthias Ringwald 
56832b838201SMatthias Ringwald     // create packet manually as arrays are not supported and num_commands should not get reduced
56842b838201SMatthias Ringwald     hci_reserve_packet_buffer();
56852b838201SMatthias Ringwald     uint8_t * packet = hci_get_outgoing_packet_buffer();
56862b838201SMatthias Ringwald 
56872b838201SMatthias Ringwald     uint16_t size = 0;
56882b838201SMatthias Ringwald     uint16_t num_handles = 0;
56892b838201SMatthias Ringwald     packet[size++] = 0x35;
56902b838201SMatthias Ringwald     packet[size++] = 0x0c;
56912b838201SMatthias Ringwald     size++;  // skip param len
56922b838201SMatthias Ringwald     size++;  // skip num handles
56932b838201SMatthias Ringwald 
56942b838201SMatthias Ringwald     // add { handle, packets } entries
56952b838201SMatthias Ringwald     btstack_linked_item_t * it;
56962b838201SMatthias Ringwald     for (it = (btstack_linked_item_t *) hci_stack->connections; it ; it = it->next){
56972b838201SMatthias Ringwald         hci_connection_t * connection = (hci_connection_t *) it;
56982b838201SMatthias Ringwald         if (connection->num_packets_completed){
56992b838201SMatthias Ringwald             little_endian_store_16(packet, size, connection->con_handle);
57002b838201SMatthias Ringwald             size += 2;
57012b838201SMatthias Ringwald             little_endian_store_16(packet, size, connection->num_packets_completed);
57022b838201SMatthias Ringwald             size += 2;
57032b838201SMatthias Ringwald             //
57042b838201SMatthias Ringwald             num_handles++;
57052b838201SMatthias Ringwald             connection->num_packets_completed = 0;
57062b838201SMatthias Ringwald         }
57072b838201SMatthias Ringwald     }
57082b838201SMatthias Ringwald 
57092b838201SMatthias Ringwald     packet[2] = size - 3;
57102b838201SMatthias Ringwald     packet[3] = num_handles;
57112b838201SMatthias Ringwald 
57122b838201SMatthias Ringwald     hci_stack->host_completed_packets = 0;
57132b838201SMatthias Ringwald 
57142b838201SMatthias Ringwald     hci_dump_packet(HCI_COMMAND_DATA_PACKET, 0, packet, size);
57152b838201SMatthias Ringwald     hci_stack->hci_transport->send_packet(HCI_COMMAND_DATA_PACKET, packet, size);
57162b838201SMatthias Ringwald 
57172b838201SMatthias Ringwald     // release packet buffer for synchronous transport implementations
57182b838201SMatthias Ringwald     if (hci_transport_synchronous()){
5719e2d22487SMatthias Ringwald         hci_release_packet_buffer();
5720068b8592SMatthias Ringwald         hci_emit_transport_packet_sent();
57212b838201SMatthias Ringwald     }
57222b838201SMatthias Ringwald }
57232b838201SMatthias Ringwald #endif
57242b838201SMatthias Ringwald 
572526fe9592SMatthias Ringwald static void hci_halting_timeout_handler(btstack_timer_source_t * ds){
572626fe9592SMatthias Ringwald     UNUSED(ds);
572726fe9592SMatthias Ringwald     hci_stack->substate = HCI_HALTING_CLOSE;
5728f021201aSMatthias Ringwald     hci_halting_run();
572926fe9592SMatthias Ringwald }
573026fe9592SMatthias Ringwald 
5731f30077b7SMatthias Ringwald static bool hci_run_acl_fragments(void){
57324ea43905SMatthias Ringwald     if (hci_stack->acl_fragmentation_total_size > 0u) {
5733b5d8b22bS[email protected]         hci_con_handle_t con_handle = READ_ACL_CONNECTION_HANDLE(hci_stack->hci_packet_buffer);
5734b5d8b22bS[email protected]         hci_connection_t *connection = hci_connection_for_handle(con_handle);
5735b5d8b22bS[email protected]         if (connection) {
573628a0332dSMatthias Ringwald             if (hci_can_send_prepared_acl_packet_now(con_handle)){
5737b5d8b22bS[email protected]                 hci_send_acl_packet_fragments(connection);
5738f30077b7SMatthias Ringwald                 return true;
5739b5d8b22bS[email protected]             }
574028a0332dSMatthias Ringwald         } else {
5741b5d8b22bS[email protected]             // connection gone -> discard further fragments
574228a0332dSMatthias Ringwald             log_info("hci_run: fragmented ACL packet no connection -> discard fragment");
5743b5d8b22bS[email protected]             hci_stack->acl_fragmentation_total_size = 0;
5744b5d8b22bS[email protected]             hci_stack->acl_fragmentation_pos = 0;
5745b5d8b22bS[email protected]         }
5746b5d8b22bS[email protected]     }
5747f30077b7SMatthias Ringwald     return false;
57482b838201SMatthias Ringwald }
5749b031bebbSmatthias.ringwald 
575068ab6207SMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
575168ab6207SMatthias Ringwald static bool hci_run_iso_fragments(void){
575268ab6207SMatthias Ringwald     if (hci_stack->iso_fragmentation_total_size > 0u) {
575368ab6207SMatthias Ringwald         // TODO: flow control
575468ab6207SMatthias Ringwald         if (hci_transport_can_send_prepared_packet_now(HCI_ISO_DATA_PACKET)){
575568ab6207SMatthias Ringwald             hci_send_iso_packet_fragments();
575668ab6207SMatthias Ringwald             return true;
575768ab6207SMatthias Ringwald         }
575868ab6207SMatthias Ringwald     }
575968ab6207SMatthias Ringwald     return false;
576068ab6207SMatthias Ringwald }
576168ab6207SMatthias Ringwald #endif
576268ab6207SMatthias Ringwald 
576335454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
57646c0d5426SMatthias Ringwald 
57656c0d5426SMatthias Ringwald #ifdef ENABLE_HCI_SERIALIZED_CONTROLLER_OPERATIONS
57666c0d5426SMatthias Ringwald static bool hci_classic_operation_active(void) {
57676c0d5426SMatthias Ringwald     if (hci_stack->inquiry_state >= GAP_INQUIRY_STATE_W4_ACTIVE){
57686c0d5426SMatthias Ringwald         return true;
57696c0d5426SMatthias Ringwald     }
57706c0d5426SMatthias Ringwald     if (hci_stack->remote_name_state == GAP_REMOTE_NAME_STATE_W4_COMPLETE){
57716c0d5426SMatthias Ringwald         return true;
57726c0d5426SMatthias Ringwald     }
57736c0d5426SMatthias Ringwald     btstack_linked_item_t * it;
57746c0d5426SMatthias Ringwald     for (it = (btstack_linked_item_t *) hci_stack->connections; it != NULL; it = it->next) {
57756c0d5426SMatthias Ringwald         hci_connection_t *connection = (hci_connection_t *) it;
57766c0d5426SMatthias Ringwald         switch (connection->state) {
57776c0d5426SMatthias Ringwald             case SENT_CREATE_CONNECTION:
57786c0d5426SMatthias Ringwald             case SENT_CANCEL_CONNECTION:
57796c0d5426SMatthias Ringwald             case SENT_DISCONNECT:
57806c0d5426SMatthias Ringwald                 return true;
57816c0d5426SMatthias Ringwald             default:
57826c0d5426SMatthias Ringwald                 break;
57836c0d5426SMatthias Ringwald         }
57846c0d5426SMatthias Ringwald     }
57856c0d5426SMatthias Ringwald     return false;
57866c0d5426SMatthias Ringwald }
57876c0d5426SMatthias Ringwald #endif
57886c0d5426SMatthias Ringwald 
5789f30077b7SMatthias Ringwald static bool hci_run_general_gap_classic(void){
5790f30077b7SMatthias Ringwald 
579159d59ecfSMatthias Ringwald     // assert stack is working and classic is active
579259d59ecfSMatthias Ringwald     if (hci_classic_supported() == false)      return false;
579359d59ecfSMatthias Ringwald     if (hci_stack->state != HCI_STATE_WORKING) return false;
579459d59ecfSMatthias Ringwald 
5795b031bebbSmatthias.ringwald     // decline incoming connections
57963a9fb326S[email protected]     if (hci_stack->decline_reason){
57973a9fb326S[email protected]         uint8_t reason = hci_stack->decline_reason;
57983a9fb326S[email protected]         hci_stack->decline_reason = 0;
57993a9fb326S[email protected]         hci_send_cmd(&hci_reject_connection_request, hci_stack->decline_addr, reason);
5800f30077b7SMatthias Ringwald         return true;
5801ce4c8fabSmatthias.ringwald     }
580259d59ecfSMatthias Ringwald 
5803baa4881eSMatthias Ringwald     if (hci_stack->gap_tasks_classic != 0){
5804ab4831a3SMatthias Ringwald         hci_run_gap_tasks_classic();
5805f30077b7SMatthias Ringwald         return true;
5806b031bebbSmatthias.ringwald     }
580727741fe7SMatthias Ringwald 
5808f5875de5SMatthias Ringwald     // start/stop inquiry
5809a1df452eSMatthias Ringwald     if ((hci_stack->inquiry_state >= GAP_INQUIRY_DURATION_MIN) && (hci_stack->inquiry_state <= GAP_INQUIRY_DURATION_MAX)){
58106c0d5426SMatthias Ringwald #ifdef ENABLE_HCI_SERIALIZED_CONTROLLER_OPERATIONS
58116c0d5426SMatthias Ringwald         if (hci_classic_operation_active() == false)
58126c0d5426SMatthias Ringwald #endif
58136c0d5426SMatthias Ringwald         {
5814f5875de5SMatthias Ringwald             uint8_t duration = hci_stack->inquiry_state;
5815beb3c81dSMatthias Ringwald             hci_stack->inquiry_state = GAP_INQUIRY_STATE_W4_ACTIVE;
581630199e24SMatthias Ringwald             if (hci_stack->inquiry_max_period_length != 0){
581730199e24SMatthias 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);
581830199e24SMatthias Ringwald             } else {
5819496bb884SMatthias Ringwald                 hci_send_cmd(&hci_inquiry, hci_stack->inquiry_lap, duration, 0);
582030199e24SMatthias Ringwald             }
5821f30077b7SMatthias Ringwald             return true;
5822f5875de5SMatthias Ringwald         }
58236c0d5426SMatthias Ringwald     }
5824f5875de5SMatthias Ringwald     if (hci_stack->inquiry_state == GAP_INQUIRY_STATE_W2_CANCEL){
5825f5875de5SMatthias Ringwald         hci_stack->inquiry_state = GAP_INQUIRY_STATE_W4_CANCELLED;
5826f5875de5SMatthias Ringwald         hci_send_cmd(&hci_inquiry_cancel);
5827f30077b7SMatthias Ringwald         return true;
5828f5875de5SMatthias Ringwald     }
582930199e24SMatthias Ringwald 
583030199e24SMatthias Ringwald     if (hci_stack->inquiry_state == GAP_INQUIRY_STATE_W2_EXIT_PERIODIC){
5831bc06f564SMatthias Ringwald         hci_stack->inquiry_state = GAP_INQUIRY_STATE_W4_CANCELLED;
583230199e24SMatthias Ringwald         hci_send_cmd(&hci_exit_periodic_inquiry_mode);
583330199e24SMatthias Ringwald         return true;
583430199e24SMatthias Ringwald     }
583530199e24SMatthias Ringwald 
5836b7f1ee76SMatthias Ringwald     // remote name request
5837b7f1ee76SMatthias Ringwald     if (hci_stack->remote_name_state == GAP_REMOTE_NAME_STATE_W2_SEND){
58386c0d5426SMatthias Ringwald #ifdef ENABLE_HCI_SERIALIZED_CONTROLLER_OPERATIONS
58396c0d5426SMatthias Ringwald         if (hci_classic_operation_active() == false)
58406c0d5426SMatthias Ringwald #endif
58416c0d5426SMatthias Ringwald         {
5842b7f1ee76SMatthias Ringwald             hci_stack->remote_name_state = GAP_REMOTE_NAME_STATE_W4_COMPLETE;
5843b7f1ee76SMatthias Ringwald             hci_send_cmd(&hci_remote_name_request, hci_stack->remote_name_addr,
5844ee8a36c8SMatthias Ringwald                          hci_stack->remote_name_page_scan_repetition_mode, 0, hci_stack->remote_name_clock_offset);
5845f30077b7SMatthias Ringwald             return true;
5846b7f1ee76SMatthias Ringwald         }
58476c0d5426SMatthias Ringwald     }
5848cf01e888SMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB
5849cf01e888SMatthias Ringwald     // Local OOB data
585059d59ecfSMatthias Ringwald     if (hci_stack->classic_read_local_oob_data){
5851cf01e888SMatthias Ringwald         hci_stack->classic_read_local_oob_data = false;
58521e83575aSMatthias Ringwald         if (hci_command_supported(SUPPORTED_HCI_COMMAND_READ_LOCAL_OOB_EXTENDED_DATA_COMMAND)){
5853cf01e888SMatthias Ringwald             hci_send_cmd(&hci_read_local_extended_oob_data);
5854cf01e888SMatthias Ringwald         } else {
5855cf01e888SMatthias Ringwald             hci_send_cmd(&hci_read_local_oob_data);
5856cf01e888SMatthias Ringwald         }
5857cf01e888SMatthias Ringwald     }
5858cf01e888SMatthias Ringwald #endif
58590a51f88bSMatthias Ringwald     // pairing
58600a51f88bSMatthias Ringwald     if (hci_stack->gap_pairing_state != GAP_PAIRING_STATE_IDLE){
58610a51f88bSMatthias Ringwald         uint8_t state = hci_stack->gap_pairing_state;
5862c26f2c7bSMatthias Ringwald         uint8_t pin_code[PIN_CODE_LEN];
58630a51f88bSMatthias Ringwald         switch (state){
58640a51f88bSMatthias Ringwald             case GAP_PAIRING_STATE_SEND_PIN:
5865cc15bb2cSMatthias Ringwald                 hci_stack->gap_pairing_state = GAP_PAIRING_STATE_IDLE;
58663f659ee4SMilanka Ringwald                 memset(pin_code, 0, 16);
58673f659ee4SMilanka Ringwald                 memcpy(pin_code, hci_stack->gap_pairing_input.gap_pairing_pin, hci_stack->gap_pairing_pin_len);
58683f659ee4SMilanka Ringwald                 hci_send_cmd(&hci_pin_code_request_reply, hci_stack->gap_pairing_addr, hci_stack->gap_pairing_pin_len, pin_code);
58690a51f88bSMatthias Ringwald                 break;
58700a51f88bSMatthias Ringwald             case GAP_PAIRING_STATE_SEND_PIN_NEGATIVE:
5871cc15bb2cSMatthias Ringwald                 hci_stack->gap_pairing_state = GAP_PAIRING_STATE_WAIT_FOR_COMMAND_COMPLETE;
58720a51f88bSMatthias Ringwald                 hci_send_cmd(&hci_pin_code_request_negative_reply, hci_stack->gap_pairing_addr);
58730a51f88bSMatthias Ringwald                 break;
58740a51f88bSMatthias Ringwald             case GAP_PAIRING_STATE_SEND_PASSKEY:
5875cc15bb2cSMatthias Ringwald                 hci_stack->gap_pairing_state = GAP_PAIRING_STATE_IDLE;
5876d504181aSMatthias Ringwald                 hci_send_cmd(&hci_user_passkey_request_reply, hci_stack->gap_pairing_addr, hci_stack->gap_pairing_input.gap_pairing_passkey);
58770a51f88bSMatthias Ringwald                 break;
58780a51f88bSMatthias Ringwald             case GAP_PAIRING_STATE_SEND_PASSKEY_NEGATIVE:
5879cc15bb2cSMatthias Ringwald                 hci_stack->gap_pairing_state = GAP_PAIRING_STATE_WAIT_FOR_COMMAND_COMPLETE;
58800a51f88bSMatthias Ringwald                 hci_send_cmd(&hci_user_passkey_request_negative_reply, hci_stack->gap_pairing_addr);
58810a51f88bSMatthias Ringwald                 break;
58820a51f88bSMatthias Ringwald             case GAP_PAIRING_STATE_SEND_CONFIRMATION:
5883cc15bb2cSMatthias Ringwald                 hci_stack->gap_pairing_state = GAP_PAIRING_STATE_IDLE;
58840a51f88bSMatthias Ringwald                 hci_send_cmd(&hci_user_confirmation_request_reply, hci_stack->gap_pairing_addr);
58850a51f88bSMatthias Ringwald                 break;
58860a51f88bSMatthias Ringwald             case GAP_PAIRING_STATE_SEND_CONFIRMATION_NEGATIVE:
5887cc15bb2cSMatthias Ringwald                 hci_stack->gap_pairing_state = GAP_PAIRING_STATE_WAIT_FOR_COMMAND_COMPLETE;
58880a51f88bSMatthias Ringwald                 hci_send_cmd(&hci_user_confirmation_request_negative_reply, hci_stack->gap_pairing_addr);
58890a51f88bSMatthias Ringwald                 break;
58900a51f88bSMatthias Ringwald             default:
58910a51f88bSMatthias Ringwald                 break;
58920a51f88bSMatthias Ringwald         }
5893f30077b7SMatthias Ringwald         return true;
5894f30077b7SMatthias Ringwald     }
5895f30077b7SMatthias Ringwald     return false;
58960a51f88bSMatthias Ringwald }
589735454696SMatthias Ringwald #endif
5898b031bebbSmatthias.ringwald 
5899a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE
5900be7ef9d8SMatthias Ringwald 
59017eb5b27eSMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
59027eb5b27eSMatthias Ringwald static uint8_t hci_le_num_phys(uint8_t phys){
59037eb5b27eSMatthias Ringwald     const uint8_t num_bits_set[] = { 0, 1, 1, 2, 1, 2, 2, 3 };
59047eb5b27eSMatthias Ringwald     btstack_assert(phys);
59057eb5b27eSMatthias Ringwald     return num_bits_set[phys];
59067eb5b27eSMatthias Ringwald }
59077eb5b27eSMatthias Ringwald #endif
59087eb5b27eSMatthias Ringwald 
5909c42da3bcSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
5910c42da3bcSMatthias Ringwald static void hci_le_scan_stop(void){
5911c42da3bcSMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
5912c42da3bcSMatthias Ringwald     if (hci_extended_advertising_supported()) {
5913c42da3bcSMatthias Ringwald             hci_send_cmd(&hci_le_set_extended_scan_enable, 0, 0, 0, 0);
5914c42da3bcSMatthias Ringwald     } else
5915c42da3bcSMatthias Ringwald #endif
5916c42da3bcSMatthias Ringwald     {
5917c42da3bcSMatthias Ringwald         hci_send_cmd(&hci_le_set_scan_enable, 0, 0);
5918c42da3bcSMatthias Ringwald     }
5919c42da3bcSMatthias Ringwald }
5920327f7f07SMatthias Ringwald 
5921f346015eSMatthias Ringwald static void
5922f346015eSMatthias Ringwald hci_send_le_create_connection(uint8_t initiator_filter_policy, bd_addr_type_t address_type, uint8_t *address) {
5923327f7f07SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
5924327f7f07SMatthias Ringwald     if (hci_extended_advertising_supported()) {
59257eb5b27eSMatthias Ringwald         // prepare arrays for all phys (LE Coded, LE 1M, LE 2M PHY)
59267eb5b27eSMatthias Ringwald         uint16_t le_connection_scan_interval[3];
59277eb5b27eSMatthias Ringwald         uint16_t le_connection_scan_window[3];
59287eb5b27eSMatthias Ringwald         uint16_t le_connection_interval_min[3];
59297eb5b27eSMatthias Ringwald         uint16_t le_connection_interval_max[3];
59307eb5b27eSMatthias Ringwald         uint16_t le_connection_latency[3];
59317eb5b27eSMatthias Ringwald         uint16_t le_supervision_timeout[3];
59327eb5b27eSMatthias Ringwald         uint16_t le_minimum_ce_length[3];
59337eb5b27eSMatthias Ringwald         uint16_t le_maximum_ce_length[3];
59347eb5b27eSMatthias Ringwald 
59357eb5b27eSMatthias Ringwald         uint8_t i;
59367eb5b27eSMatthias Ringwald         uint8_t num_phys = hci_le_num_phys(hci_stack->le_connection_phys);
59377eb5b27eSMatthias Ringwald         for (i=0;i<num_phys;i++){
59387eb5b27eSMatthias Ringwald             le_connection_scan_interval[i] = hci_stack->le_connection_scan_interval;
59397eb5b27eSMatthias Ringwald             le_connection_scan_window[i]   = hci_stack->le_connection_scan_window;
59407eb5b27eSMatthias Ringwald             le_connection_interval_min[i]  = hci_stack->le_connection_interval_min;
59417eb5b27eSMatthias Ringwald             le_connection_interval_max[i]  = hci_stack->le_connection_interval_max;
59427eb5b27eSMatthias Ringwald             le_connection_latency[i]       = hci_stack->le_connection_latency;
59437eb5b27eSMatthias Ringwald             le_supervision_timeout[i]      = hci_stack->le_supervision_timeout;
59447eb5b27eSMatthias Ringwald             le_minimum_ce_length[i]        = hci_stack->le_minimum_ce_length;
59457eb5b27eSMatthias Ringwald             le_maximum_ce_length[i]        = hci_stack->le_maximum_ce_length;
59467eb5b27eSMatthias Ringwald         }
5947327f7f07SMatthias Ringwald         hci_send_cmd(&hci_le_extended_create_connection,
5948f346015eSMatthias Ringwald                      initiator_filter_policy,
5949327f7f07SMatthias Ringwald                      hci_stack->le_connection_own_addr_type,   // our addr type:
5950f346015eSMatthias Ringwald                      address_type,                  // peer address type
5951f346015eSMatthias Ringwald                      address,                       // peer bd addr
59527eb5b27eSMatthias Ringwald                      hci_stack->le_connection_phys, // initiating PHY
5953327f7f07SMatthias Ringwald                      le_connection_scan_interval,   // conn scan interval
5954327f7f07SMatthias Ringwald                      le_connection_scan_window,     // conn scan windows
5955327f7f07SMatthias Ringwald                      le_connection_interval_min,    // conn interval min
5956327f7f07SMatthias Ringwald                      le_connection_interval_max,    // conn interval max
5957327f7f07SMatthias Ringwald                      le_connection_latency,         // conn latency
5958327f7f07SMatthias Ringwald                      le_supervision_timeout,        // conn latency
5959327f7f07SMatthias Ringwald                      le_minimum_ce_length,          // min ce length
5960327f7f07SMatthias Ringwald                      le_maximum_ce_length           // max ce length
5961327f7f07SMatthias Ringwald         );
5962d935373dSMatthias Ringwald     } else
5963327f7f07SMatthias Ringwald #endif
5964327f7f07SMatthias Ringwald     {
5965327f7f07SMatthias Ringwald         hci_send_cmd(&hci_le_create_connection,
5966327f7f07SMatthias Ringwald                      hci_stack->le_connection_scan_interval,  // conn scan interval
5967327f7f07SMatthias Ringwald                      hci_stack->le_connection_scan_window,    // conn scan windows
5968f346015eSMatthias Ringwald                      initiator_filter_policy,                 // don't use whitelist
5969f346015eSMatthias Ringwald                      address_type,                            // peer address type
5970f346015eSMatthias Ringwald                      address,                                 // peer bd addr
5971327f7f07SMatthias Ringwald                      hci_stack->le_connection_own_addr_type,  // our addr type:
5972327f7f07SMatthias Ringwald                      hci_stack->le_connection_interval_min,   // conn interval min
5973327f7f07SMatthias Ringwald                      hci_stack->le_connection_interval_max,   // conn interval max
5974327f7f07SMatthias Ringwald                      hci_stack->le_connection_latency,        // conn latency
5975327f7f07SMatthias Ringwald                      hci_stack->le_supervision_timeout,       // conn latency
5976327f7f07SMatthias Ringwald                      hci_stack->le_minimum_ce_length,         // min ce length
5977327f7f07SMatthias Ringwald                      hci_stack->le_maximum_ce_length          // max ce length
5978327f7f07SMatthias Ringwald         );
5979327f7f07SMatthias Ringwald     }
5980327f7f07SMatthias Ringwald }
5981c42da3bcSMatthias Ringwald #endif
5982c42da3bcSMatthias Ringwald 
5983be7ef9d8SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
5984be7ef9d8SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
5985be7ef9d8SMatthias Ringwald uint8_t hci_le_extended_advertising_operation_for_chunk(uint16_t pos, uint16_t len){
5986be7ef9d8SMatthias Ringwald     uint8_t  operation = 0;
5987be7ef9d8SMatthias Ringwald     if (pos == 0){
5988be7ef9d8SMatthias Ringwald         // first fragment or complete data
5989be7ef9d8SMatthias Ringwald         operation |= 1;
5990be7ef9d8SMatthias Ringwald     }
5991be7ef9d8SMatthias Ringwald     if (pos + LE_EXTENDED_ADVERTISING_MAX_CHUNK_LEN >= len){
5992be7ef9d8SMatthias Ringwald         // last fragment or complete data
5993be7ef9d8SMatthias Ringwald         operation |= 2;
5994be7ef9d8SMatthias Ringwald     }
5995be7ef9d8SMatthias Ringwald     return operation;
5996be7ef9d8SMatthias Ringwald }
5997be7ef9d8SMatthias Ringwald #endif
5998be7ef9d8SMatthias Ringwald #endif
5999be7ef9d8SMatthias Ringwald 
6000f30077b7SMatthias Ringwald static bool hci_run_general_gap_le(void){
6001f30077b7SMatthias Ringwald 
6002f40c73b4SMatthias Ringwald     btstack_linked_list_iterator_t lit;
6003f40c73b4SMatthias Ringwald 
60042052d96cSMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
60052052d96cSMatthias Ringwald     if (hci_stack->le_resolvable_private_address_update_s > 0){
60062052d96cSMatthias Ringwald         uint16_t update_s = hci_stack->le_resolvable_private_address_update_s;
60072052d96cSMatthias Ringwald         hci_stack->le_resolvable_private_address_update_s = 0;
60082052d96cSMatthias Ringwald         hci_send_cmd(&hci_le_set_resolvable_private_address_timeout, update_s);
60092052d96cSMatthias Ringwald         return true;
60102052d96cSMatthias Ringwald     }
60112052d96cSMatthias Ringwald #endif
60122052d96cSMatthias Ringwald 
6013a41310b7SMatthias Ringwald     // Phase 1: collect what to stop
6014a41310b7SMatthias Ringwald 
601549a6c69cSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
6016a41310b7SMatthias Ringwald     bool scanning_stop = false;
6017a41310b7SMatthias Ringwald     bool connecting_stop = false;
6018be7ef9d8SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
6019c814a904SMatthias Ringwald #ifdef ENABLE_LE_PERIODIC_ADVERTISING
60204bafedd5SMatthias Ringwald     bool periodic_sync_stop = false;
60214bafedd5SMatthias Ringwald #endif
6022be7ef9d8SMatthias Ringwald #endif
6023c814a904SMatthias Ringwald #endif
6024be7ef9d8SMatthias Ringwald 
602549a6c69cSMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
602649a6c69cSMatthias Ringwald     bool advertising_stop = false;
602749a6c69cSMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
602849a6c69cSMatthias Ringwald     le_advertising_set_t * advertising_stop_set = NULL;
602949a6c69cSMatthias Ringwald #ifdef ENABLE_LE_PERIODIC_ADVERTISING
603049a6c69cSMatthias Ringwald     bool periodic_advertising_stop = false;
6031a41310b7SMatthias Ringwald #endif
603249a6c69cSMatthias Ringwald #endif
6033a41310b7SMatthias Ringwald #endif
6034a41310b7SMatthias Ringwald 
60359136bde8SMatthias Ringwald     // check if own address changes
60369ce6dfa1SMatthias Ringwald     uint8_t address_change_mask = LE_ADVERTISEMENT_TASKS_SET_ADDRESS | LE_ADVERTISEMENT_TASKS_SET_ADDRESS_SET_0;
60379ce6dfa1SMatthias Ringwald     bool random_address_change = (hci_stack->le_advertisements_todo & address_change_mask) != 0;
60389136bde8SMatthias Ringwald 
603929c24bebSMatthias Ringwald     // check if whitelist needs modification
604029c24bebSMatthias Ringwald     bool whitelist_modification_pending = false;
604129c24bebSMatthias Ringwald     btstack_linked_list_iterator_init(&lit, &hci_stack->le_whitelist);
604229c24bebSMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&lit)){
604329c24bebSMatthias Ringwald         whitelist_entry_t * entry = (whitelist_entry_t*) btstack_linked_list_iterator_next(&lit);
604429c24bebSMatthias Ringwald         if (entry->state & (LE_WHITELIST_REMOVE_FROM_CONTROLLER | LE_WHITELIST_ADD_TO_CONTROLLER)){
604529c24bebSMatthias Ringwald             whitelist_modification_pending = true;
604629c24bebSMatthias Ringwald             break;
604729c24bebSMatthias Ringwald         }
604829c24bebSMatthias Ringwald     }
6049f40c73b4SMatthias Ringwald 
605021debf25SMatthias Ringwald     // check if resolving list needs modification
605121debf25SMatthias Ringwald     bool resolving_list_modification_pending = false;
605221debf25SMatthias Ringwald #ifdef ENABLE_LE_PRIVACY_ADDRESS_RESOLUTION
60531ffa425cSMatthias Ringwald     bool resolving_list_supported = hci_command_supported(SUPPORTED_HCI_COMMAND_LE_SET_ADDRESS_RESOLUTION_ENABLE);
6054ea151974SMatthias Ringwald 	if (resolving_list_supported && hci_stack->le_resolving_list_state != LE_RESOLVING_LIST_DONE){
605521debf25SMatthias Ringwald         resolving_list_modification_pending = true;
605621debf25SMatthias Ringwald     }
605721debf25SMatthias Ringwald #endif
605829c24bebSMatthias Ringwald 
6059f40c73b4SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
606049a6c69cSMatthias Ringwald 
6061f40c73b4SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
606249a6c69cSMatthias Ringwald     // check if periodic advertiser list needs modification
6063f40c73b4SMatthias Ringwald     bool periodic_list_modification_pending = false;
6064f40c73b4SMatthias Ringwald     btstack_linked_list_iterator_init(&lit, &hci_stack->le_periodic_advertiser_list);
6065f40c73b4SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&lit)){
6066f40c73b4SMatthias Ringwald         periodic_advertiser_list_entry_t * entry = (periodic_advertiser_list_entry_t*) btstack_linked_list_iterator_next(&lit);
6067f40c73b4SMatthias Ringwald         if (entry->state & (LE_PERIODIC_ADVERTISER_LIST_ENTRY_ADD_TO_CONTROLLER | LE_PERIODIC_ADVERTISER_LIST_ENTRY_REMOVE_FROM_CONTROLLER)){
6068f40c73b4SMatthias Ringwald             periodic_list_modification_pending = true;
6069f40c73b4SMatthias Ringwald             break;
6070f40c73b4SMatthias Ringwald         }
6071f40c73b4SMatthias Ringwald     }
6072f40c73b4SMatthias Ringwald #endif
6073f40c73b4SMatthias Ringwald 
6074fde725feSMatthias Ringwald     // scanning control
60753251a108SMatthias Ringwald     if (hci_stack->le_scanning_active) {
607629c24bebSMatthias Ringwald         // stop if:
607729c24bebSMatthias Ringwald         // - parameter change required
607829c24bebSMatthias Ringwald         // - it's disabled
607929c24bebSMatthias Ringwald         // - whitelist change required but used for scanning
608021debf25SMatthias Ringwald         // - resolving list modified
608151e51a58SMatthias Ringwald         // - own address changes
608229c24bebSMatthias Ringwald         bool scanning_uses_whitelist = (hci_stack->le_scan_filter_policy & 1) == 1;
608321debf25SMatthias Ringwald         if ((hci_stack->le_scanning_param_update) ||
608421debf25SMatthias Ringwald             !hci_stack->le_scanning_enabled ||
6085d54b2c94SMatthias Ringwald             (scanning_uses_whitelist && whitelist_modification_pending) ||
608651e51a58SMatthias Ringwald             resolving_list_modification_pending ||
608751e51a58SMatthias Ringwald             random_address_change){
608821debf25SMatthias Ringwald 
60892d5c2a27SMatthias Ringwald             scanning_stop = true;
6090fde725feSMatthias Ringwald         }
6091fde725feSMatthias Ringwald     }
6092fde725feSMatthias Ringwald 
609329c24bebSMatthias Ringwald     // connecting control
6094f496d06eSMatthias Ringwald     bool connecting_with_whitelist;
6095f496d06eSMatthias Ringwald     switch (hci_stack->le_connecting_state){
6096f496d06eSMatthias Ringwald         case LE_CONNECTING_DIRECT:
6097f496d06eSMatthias Ringwald         case LE_CONNECTING_WHITELIST:
6098af64f147SMatthias Ringwald             // stop connecting if:
6099af64f147SMatthias Ringwald             // - connecting uses white and whitelist modification pending
6100af64f147SMatthias Ringwald             // - if it got disabled
610121debf25SMatthias Ringwald             // - resolving list modified
610251e51a58SMatthias Ringwald             // - own address changes
6103f496d06eSMatthias Ringwald             connecting_with_whitelist = hci_stack->le_connecting_state == LE_CONNECTING_WHITELIST;
6104f496d06eSMatthias Ringwald             if ((connecting_with_whitelist && whitelist_modification_pending) ||
610521debf25SMatthias Ringwald                 (hci_stack->le_connecting_request == LE_CONNECTING_IDLE) ||
610651e51a58SMatthias Ringwald                 resolving_list_modification_pending ||
610751e51a58SMatthias Ringwald                 random_address_change) {
610821debf25SMatthias Ringwald 
610929c24bebSMatthias Ringwald                 connecting_stop = true;
611029c24bebSMatthias Ringwald             }
6111f496d06eSMatthias Ringwald             break;
6112f496d06eSMatthias Ringwald         default:
6113f496d06eSMatthias Ringwald             break;
611429c24bebSMatthias Ringwald     }
611549a6c69cSMatthias Ringwald 
61164bafedd5SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
611749a6c69cSMatthias Ringwald #ifdef ENABLE_LE_PERIODIC_ADVERTISING
61184bafedd5SMatthias Ringwald     // periodic sync control
61194bafedd5SMatthias Ringwald     bool sync_with_advertiser_list;
61204bafedd5SMatthias Ringwald     switch(hci_stack->le_periodic_sync_state){
61214bafedd5SMatthias Ringwald         case LE_CONNECTING_DIRECT:
61224bafedd5SMatthias Ringwald         case LE_CONNECTING_WHITELIST:
612349a6c69cSMatthias Ringwald             // stop sync if:
61244bafedd5SMatthias Ringwald             // - sync with advertiser list and advertiser list modification pending
612549a6c69cSMatthias Ringwald             // - if it got disabled
61264bafedd5SMatthias Ringwald             sync_with_advertiser_list = hci_stack->le_periodic_sync_state == LE_CONNECTING_WHITELIST;
61274bafedd5SMatthias Ringwald             if ((sync_with_advertiser_list && periodic_list_modification_pending) ||
61284bafedd5SMatthias Ringwald                     (hci_stack->le_periodic_sync_request == LE_CONNECTING_IDLE)){
61294bafedd5SMatthias Ringwald                 periodic_sync_stop = true;
61304bafedd5SMatthias Ringwald             }
61314bafedd5SMatthias Ringwald             break;
61324bafedd5SMatthias Ringwald         default:
61334bafedd5SMatthias Ringwald             break;
61344bafedd5SMatthias Ringwald     }
61354bafedd5SMatthias Ringwald #endif
6136d70217a2SMatthias Ringwald #endif
613729c24bebSMatthias Ringwald 
613849a6c69cSMatthias Ringwald #endif /* ENABLE_LE_CENTRAL */
613949a6c69cSMatthias Ringwald 
6140d70217a2SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
614145c102fdSMatthias Ringwald     // le advertisement control
6142935aa76eSMatthias Ringwald     if ((hci_stack->le_advertisements_state & LE_ADVERTISEMENT_STATE_ACTIVE) != 0){
614329c24bebSMatthias Ringwald         // stop if:
614429c24bebSMatthias Ringwald         // - parameter change required
61459136bde8SMatthias Ringwald         // - random address used in advertising and changes
614629c24bebSMatthias Ringwald         // - it's disabled
6147ba44ad41SMatthias Ringwald         // - whitelist change required but used for advertisement filter policy
614821debf25SMatthias Ringwald         // - resolving list modified
614951e51a58SMatthias Ringwald         // - own address changes
6150a61834b6SMatthias Ringwald         bool advertising_uses_whitelist = hci_stack->le_advertisements_filter_policy != 0;
61519136bde8SMatthias Ringwald         bool advertising_uses_random_address = hci_stack->le_own_addr_type != BD_ADDR_TYPE_LE_PUBLIC;
61524e5d21eaSMatthias Ringwald         bool advertising_change    = (hci_stack->le_advertisements_todo & LE_ADVERTISEMENT_TASKS_SET_PARAMS)  != 0;
6153a61834b6SMatthias Ringwald         if (advertising_change ||
61549136bde8SMatthias Ringwald             (advertising_uses_random_address && random_address_change) ||
6155a61834b6SMatthias Ringwald             (hci_stack->le_advertisements_enabled_for_current_roles == 0) ||
61569136bde8SMatthias Ringwald             (advertising_uses_whitelist && whitelist_modification_pending) ||
615751e51a58SMatthias Ringwald             resolving_list_modification_pending ||
615851e51a58SMatthias Ringwald             random_address_change) {
615921debf25SMatthias Ringwald 
6160fde725feSMatthias Ringwald             advertising_stop = true;
6161fde725feSMatthias Ringwald         }
6162fde725feSMatthias Ringwald     }
6163be7ef9d8SMatthias Ringwald 
6164be7ef9d8SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
6165be7ef9d8SMatthias Ringwald     if (hci_extended_advertising_supported() && (advertising_stop == false)){
6166be7ef9d8SMatthias Ringwald         btstack_linked_list_iterator_t it;
6167be7ef9d8SMatthias Ringwald         btstack_linked_list_iterator_init(&it, &hci_stack->le_advertising_sets);
6168be7ef9d8SMatthias Ringwald         while (btstack_linked_list_iterator_has_next(&it)){
6169be7ef9d8SMatthias Ringwald             le_advertising_set_t * advertising_set = (le_advertising_set_t*) btstack_linked_list_iterator_next(&it);
617053f240c0SMatthias Ringwald             if ((advertising_set->state & LE_ADVERTISEMENT_STATE_ACTIVE) != 0) {
6171be7ef9d8SMatthias Ringwald                 // stop if:
6172be7ef9d8SMatthias Ringwald                 // - parameter change required
6173be7ef9d8SMatthias Ringwald                 // - random address used in connectable advertising and changes
6174be7ef9d8SMatthias Ringwald                 // - it's disabled
6175be7ef9d8SMatthias Ringwald                 // - whitelist change required but used for advertisement filter policy
6176be7ef9d8SMatthias Ringwald                 // - resolving list modified
6177be7ef9d8SMatthias Ringwald                 // - own address changes
6178be7ef9d8SMatthias Ringwald                 // - advertisement set will be removed
617957a04237SMatthias Ringwald                 bool advertising_uses_whitelist = advertising_set->extended_params.advertising_filter_policy != 0;
618057a04237SMatthias Ringwald                 bool advertising_connectable = (advertising_set->extended_params.advertising_event_properties & 1) != 0;
618153f240c0SMatthias Ringwald                 bool advertising_uses_random_address =
618253f240c0SMatthias Ringwald                         (advertising_set->extended_params.own_address_type != BD_ADDR_TYPE_LE_PUBLIC) &&
618353f240c0SMatthias Ringwald                         advertising_connectable;
6184be7ef9d8SMatthias Ringwald                 bool advertising_parameter_change = (advertising_set->tasks & LE_ADVERTISEMENT_TASKS_SET_PARAMS) != 0;
6185be7ef9d8SMatthias Ringwald                 bool advertising_enabled = (advertising_set->state & LE_ADVERTISEMENT_STATE_ENABLED) != 0;
618653f240c0SMatthias Ringwald                 bool advertising_set_random_address_change =
618753f240c0SMatthias Ringwald                         (advertising_set->tasks & LE_ADVERTISEMENT_TASKS_SET_ADDRESS) != 0;
618853f240c0SMatthias Ringwald                 bool advertising_set_will_be_removed =
618953f240c0SMatthias Ringwald                         (advertising_set->state & LE_ADVERTISEMENT_TASKS_REMOVE_SET) != 0;
6190be7ef9d8SMatthias Ringwald                 if (advertising_parameter_change ||
6191be7ef9d8SMatthias Ringwald                     (advertising_uses_random_address && advertising_set_random_address_change) ||
6192be7ef9d8SMatthias Ringwald                     (advertising_enabled == false) ||
6193be7ef9d8SMatthias Ringwald                     (advertising_uses_whitelist && whitelist_modification_pending) ||
6194be7ef9d8SMatthias Ringwald                     resolving_list_modification_pending ||
6195be7ef9d8SMatthias Ringwald                     advertising_set_will_be_removed) {
6196be7ef9d8SMatthias Ringwald 
6197be7ef9d8SMatthias Ringwald                     advertising_stop = true;
6198be7ef9d8SMatthias Ringwald                     advertising_stop_set = advertising_set;
6199be7ef9d8SMatthias Ringwald                     break;
6200be7ef9d8SMatthias Ringwald                 }
6201be7ef9d8SMatthias Ringwald             }
6202c814a904SMatthias Ringwald #ifdef ENABLE_LE_PERIODIC_ADVERTISING
620353f240c0SMatthias Ringwald             if ((advertising_set->state & LE_ADVERTISEMENT_STATE_PERIODIC_ACTIVE) != 0) {
620453f240c0SMatthias Ringwald                 // stop if:
620553f240c0SMatthias Ringwald                 // - it's disabled
620653f240c0SMatthias Ringwald                 // - parameter change required
620753f240c0SMatthias Ringwald                 bool periodic_enabled = (advertising_set->state & LE_ADVERTISEMENT_STATE_PERIODIC_ENABLED) != 0;
620853f240c0SMatthias Ringwald                 bool periodic_parameter_change = (advertising_set->tasks & LE_ADVERTISEMENT_TASKS_SET_PERIODIC_PARAMS) != 0;
620953f240c0SMatthias Ringwald                 if ((periodic_enabled == false) || periodic_parameter_change){
621049a6c69cSMatthias Ringwald                     periodic_advertising_stop = true;
621153f240c0SMatthias Ringwald                     advertising_stop_set = advertising_set;
621253f240c0SMatthias Ringwald                 }
621353f240c0SMatthias Ringwald             }
621449a6c69cSMatthias Ringwald #endif /* ENABLE_LE_PERIODIC_ADVERTISING */
621553f240c0SMatthias Ringwald         }
6216be7ef9d8SMatthias Ringwald     }
6217be7ef9d8SMatthias Ringwald #endif
6218be7ef9d8SMatthias Ringwald 
6219a41310b7SMatthias Ringwald #endif
6220fde725feSMatthias Ringwald 
6221a41310b7SMatthias Ringwald 
6222a41310b7SMatthias Ringwald     // Phase 2: stop everything that should be off during modifications
6223a41310b7SMatthias Ringwald 
6224131d4778SMatthias Ringwald 
6225131d4778SMatthias Ringwald     // 2.1 Outgoing connection
6226131d4778SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
6227131d4778SMatthias Ringwald     if (connecting_stop){
6228131d4778SMatthias Ringwald         hci_send_cmd(&hci_le_create_connection_cancel);
6229131d4778SMatthias Ringwald         return true;
6230131d4778SMatthias Ringwald     }
6231131d4778SMatthias Ringwald #endif
6232131d4778SMatthias Ringwald 
6233131d4778SMatthias Ringwald     // 2.2 Scanning
6234a41310b7SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
6235a41310b7SMatthias Ringwald     if (scanning_stop){
62365226d7f2SMatthias Ringwald         hci_stack->le_scanning_active = false;
6237c42da3bcSMatthias Ringwald         hci_le_scan_stop();
6238a41310b7SMatthias Ringwald         return true;
6239a41310b7SMatthias Ringwald     }
6240a41310b7SMatthias Ringwald 
6241131d4778SMatthias Ringwald     // 2.3 Periodic Sync
62424bafedd5SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
624349a6c69cSMatthias Ringwald     if (hci_stack->le_periodic_terminate_sync_handle != HCI_CON_HANDLE_INVALID){
624449a6c69cSMatthias Ringwald         uint16_t sync_handle = hci_stack->le_periodic_terminate_sync_handle;
624549a6c69cSMatthias Ringwald         hci_stack->le_periodic_terminate_sync_handle = HCI_CON_HANDLE_INVALID;
624649a6c69cSMatthias Ringwald         hci_send_cmd(&hci_le_periodic_advertising_terminate_sync, sync_handle);
624749a6c69cSMatthias Ringwald         return true;
624849a6c69cSMatthias Ringwald     }
624949a6c69cSMatthias Ringwald #ifdef ENABLE_LE_PERIODIC_ADVERTISING
62504bafedd5SMatthias Ringwald     if (periodic_sync_stop){
62514bafedd5SMatthias Ringwald         hci_stack->le_periodic_sync_state = LE_CONNECTING_CANCEL;
62524bafedd5SMatthias Ringwald         hci_send_cmd(&hci_le_periodic_advertising_create_sync_cancel);
62534bafedd5SMatthias Ringwald         return true;
62544bafedd5SMatthias Ringwald     }
625549a6c69cSMatthias Ringwald #endif /* ENABLE_LE_PERIODIC_ADVERTISING */
6256a8016f96SMatthias Ringwald #endif /* ENABLE_LE_EXTENDED_ADVERTISING */
6257a8016f96SMatthias Ringwald #endif /* ENABLE_LE_CENTRAL */
6258a41310b7SMatthias Ringwald 
6259131d4778SMatthias Ringwald     // 2.4 Advertising: legacy, extended, periodic
6260a41310b7SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
6261fde725feSMatthias Ringwald     if (advertising_stop){
6262e464cd48SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
6263e464cd48SMatthias Ringwald         if (hci_extended_advertising_supported()) {
6264be7ef9d8SMatthias Ringwald             uint8_t advertising_stop_handle;
6265be7ef9d8SMatthias Ringwald             if (advertising_stop_set != NULL){
6266be7ef9d8SMatthias Ringwald                 advertising_stop_handle = advertising_stop_set->advertising_handle;
6267be7ef9d8SMatthias Ringwald                 advertising_stop_set->state &= ~LE_ADVERTISEMENT_STATE_ACTIVE;
6268be7ef9d8SMatthias Ringwald             } else {
6269be7ef9d8SMatthias Ringwald                 advertising_stop_handle = 0;
6270be7ef9d8SMatthias Ringwald                 hci_stack->le_advertisements_state &= ~LE_ADVERTISEMENT_STATE_ACTIVE;
6271be7ef9d8SMatthias Ringwald             }
6272be7ef9d8SMatthias Ringwald             const uint8_t advertising_handles[] = { advertising_stop_handle };
6273e464cd48SMatthias Ringwald             const uint16_t durations[] = { 0 };
6274e464cd48SMatthias Ringwald             const uint16_t max_events[] = { 0 };
6275e464cd48SMatthias Ringwald             hci_send_cmd(&hci_le_set_extended_advertising_enable, 0, 1, advertising_handles, durations, max_events);
6276e464cd48SMatthias Ringwald         } else
6277e464cd48SMatthias Ringwald #endif
6278e464cd48SMatthias Ringwald         {
6279be7ef9d8SMatthias Ringwald             hci_stack->le_advertisements_state &= ~LE_ADVERTISEMENT_STATE_ACTIVE;
628045c102fdSMatthias Ringwald             hci_send_cmd(&hci_le_set_advertise_enable, 0);
6281e464cd48SMatthias Ringwald         }
6282f30077b7SMatthias Ringwald         return true;
628345c102fdSMatthias Ringwald     }
628453f240c0SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
6285c814a904SMatthias Ringwald #ifdef ENABLE_LE_PERIODIC_ADVERTISING
628649a6c69cSMatthias Ringwald     if (periodic_advertising_stop){
628753f240c0SMatthias Ringwald         advertising_stop_set->state &= ~LE_ADVERTISEMENT_STATE_PERIODIC_ACTIVE;
628853f240c0SMatthias Ringwald         hci_send_cmd(&hci_le_set_periodic_advertising_enable, 0, advertising_stop_set->advertising_handle);
628953f240c0SMatthias Ringwald         return true;
629053f240c0SMatthias Ringwald     }
6291c814a904SMatthias Ringwald #endif /* ENABLE_LE_PERIODIC_ADVERTISING */
6292c814a904SMatthias Ringwald #endif /* ENABLE_LE_EXTENDED_ADVERTISING */
6293a8016f96SMatthias Ringwald #endif /* ENABLE_LE_PERIPHERAL */
6294fde725feSMatthias Ringwald 
6295131d4778SMatthias Ringwald 
6296a41310b7SMatthias Ringwald     // Phase 3: modify
6297a41310b7SMatthias Ringwald 
629864f9dabaSMatthias Ringwald     if (hci_stack->le_advertisements_todo & LE_ADVERTISEMENT_TASKS_SET_ADDRESS){
62999136bde8SMatthias Ringwald         hci_stack->le_advertisements_todo &= ~LE_ADVERTISEMENT_TASKS_SET_ADDRESS;
63009136bde8SMatthias Ringwald         hci_send_cmd(&hci_le_set_random_address, hci_stack->le_random_address);
6301ae35a99cSMatthias Ringwald #ifdef ENABLE_LE_SET_ADV_PARAMS_ON_RANDOM_ADDRESS_CHANGE
6302ae35a99cSMatthias Ringwald         // workaround: on some Controllers, address in advertisements is updated only after next dv params set
6303ae35a99cSMatthias Ringwald         hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_SET_PARAMS;
6304ae35a99cSMatthias Ringwald #endif
63059136bde8SMatthias Ringwald         return true;
63069136bde8SMatthias Ringwald     }
63079136bde8SMatthias Ringwald 
6308a41310b7SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
6309a41310b7SMatthias Ringwald     if (hci_stack->le_scanning_param_update){
6310a41310b7SMatthias Ringwald         hci_stack->le_scanning_param_update = false;
631163671e69SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
631263671e69SMatthias Ringwald         if (hci_extended_advertising_supported()){
63137eb5b27eSMatthias Ringwald             // prepare arrays for all phys (LE Coded and LE 1M PHY)
63147eb5b27eSMatthias Ringwald             uint8_t  scan_types[2];
63157eb5b27eSMatthias Ringwald             uint16_t scan_intervals[2];
63167eb5b27eSMatthias Ringwald             uint16_t scan_windows[2];
63177eb5b27eSMatthias Ringwald 
63187eb5b27eSMatthias Ringwald             uint8_t i;
63197eb5b27eSMatthias Ringwald             uint8_t num_phys = hci_le_num_phys(hci_stack->le_scan_phys);
63207eb5b27eSMatthias Ringwald             for (i=0;i<num_phys;i++){
63217eb5b27eSMatthias Ringwald                 scan_types[i]     = hci_stack->le_scan_type;
63227eb5b27eSMatthias Ringwald                 scan_intervals[i] = hci_stack->le_scan_interval;
63237eb5b27eSMatthias Ringwald                 scan_windows[i]   = hci_stack->le_scan_window;
63247eb5b27eSMatthias Ringwald             }
632563671e69SMatthias Ringwald             hci_send_cmd(&hci_le_set_extended_scan_parameters, hci_stack->le_own_addr_type,
63267eb5b27eSMatthias Ringwald                          hci_stack->le_scan_filter_policy, hci_stack->le_scan_phys, scan_types, scan_intervals, scan_windows);
632763671e69SMatthias Ringwald         } else
632863671e69SMatthias Ringwald #endif
632963671e69SMatthias Ringwald         {
6330a41310b7SMatthias Ringwald             hci_send_cmd(&hci_le_set_scan_parameters, hci_stack->le_scan_type, hci_stack->le_scan_interval, hci_stack->le_scan_window,
6331a41310b7SMatthias Ringwald                          hci_stack->le_own_addr_type, hci_stack->le_scan_filter_policy);
633263671e69SMatthias Ringwald         }
6333a41310b7SMatthias Ringwald         return true;
6334a41310b7SMatthias Ringwald     }
6335a41310b7SMatthias Ringwald #endif
6336a41310b7SMatthias Ringwald 
6337a41310b7SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
633845c102fdSMatthias Ringwald     if (hci_stack->le_advertisements_todo & LE_ADVERTISEMENT_TASKS_SET_PARAMS){
633945c102fdSMatthias Ringwald         hci_stack->le_advertisements_todo &= ~LE_ADVERTISEMENT_TASKS_SET_PARAMS;
63406bcfa632SMatthias Ringwald         hci_stack->le_advertisements_own_addr_type = hci_stack->le_own_addr_type;
6341e464cd48SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
6342e464cd48SMatthias Ringwald         if (hci_extended_advertising_supported()){
6343e464cd48SMatthias Ringwald             // map advertisment type to advertising event properties
6344e464cd48SMatthias Ringwald             uint16_t adv_event_properties = 0;
6345e464cd48SMatthias Ringwald             const uint16_t mapping[] = { 0b00010011, 0b00010101, 0b00011101, 0b00010010, 0b00010000};
6346e464cd48SMatthias Ringwald             if (hci_stack->le_advertisements_type < (sizeof(mapping)/sizeof(uint16_t))){
6347e464cd48SMatthias Ringwald                 adv_event_properties = mapping[hci_stack->le_advertisements_type];
6348e464cd48SMatthias Ringwald             }
6349174b4d21SMatthias Ringwald             hci_stack->le_advertising_set_in_current_command = 0;
6350e464cd48SMatthias Ringwald             hci_send_cmd(&hci_le_set_extended_advertising_parameters,
6351e464cd48SMatthias Ringwald                          0,
6352e464cd48SMatthias Ringwald                          adv_event_properties,
6353e464cd48SMatthias Ringwald                          hci_stack->le_advertisements_interval_min,
6354e464cd48SMatthias Ringwald                          hci_stack->le_advertisements_interval_max,
6355e464cd48SMatthias Ringwald                          hci_stack->le_advertisements_channel_map,
6356e464cd48SMatthias Ringwald                          hci_stack->le_advertisements_own_addr_type,
6357e464cd48SMatthias Ringwald                          hci_stack->le_advertisements_direct_address_type,
6358e464cd48SMatthias Ringwald                          hci_stack->le_advertisements_direct_address,
6359e464cd48SMatthias Ringwald                          hci_stack->le_advertisements_filter_policy,
6360e464cd48SMatthias Ringwald                          0x7f,  // tx power: no preference
6361e464cd48SMatthias Ringwald                          0x01,  // primary adv phy: LE 1M
6362e464cd48SMatthias Ringwald                          0,     // secondary adv max skip
63635375ad13SMatthias Ringwald                          0x01,  // secondary adv phy
6364e464cd48SMatthias Ringwald                          0,     // adv sid
6365e464cd48SMatthias Ringwald                          0      // scan request notification
6366e464cd48SMatthias Ringwald                          );
6367d935373dSMatthias Ringwald         } else
6368e464cd48SMatthias Ringwald #endif
6369e464cd48SMatthias Ringwald         {
637045c102fdSMatthias Ringwald             hci_send_cmd(&hci_le_set_advertising_parameters,
637145c102fdSMatthias Ringwald                          hci_stack->le_advertisements_interval_min,
637245c102fdSMatthias Ringwald                          hci_stack->le_advertisements_interval_max,
637345c102fdSMatthias Ringwald                          hci_stack->le_advertisements_type,
63746bcfa632SMatthias Ringwald                          hci_stack->le_advertisements_own_addr_type,
637545c102fdSMatthias Ringwald                          hci_stack->le_advertisements_direct_address_type,
637645c102fdSMatthias Ringwald                          hci_stack->le_advertisements_direct_address,
637745c102fdSMatthias Ringwald                          hci_stack->le_advertisements_channel_map,
637845c102fdSMatthias Ringwald                          hci_stack->le_advertisements_filter_policy);
6379e464cd48SMatthias Ringwald         }
6380f30077b7SMatthias Ringwald         return true;
638145c102fdSMatthias Ringwald     }
6382be7ef9d8SMatthias Ringwald 
63839ce6dfa1SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
63849ce6dfa1SMatthias Ringwald     // assumption: only set if extended advertising is supported
63859ce6dfa1SMatthias Ringwald     if ((hci_stack->le_advertisements_todo & LE_ADVERTISEMENT_TASKS_SET_ADDRESS_SET_0) != 0){
63869ce6dfa1SMatthias Ringwald         hci_stack->le_advertisements_todo &= ~LE_ADVERTISEMENT_TASKS_SET_ADDRESS_SET_0;
63879ce6dfa1SMatthias Ringwald         hci_send_cmd(&hci_le_set_advertising_set_random_address, 0, hci_stack->le_random_address);
63889ce6dfa1SMatthias Ringwald         return true;
63899ce6dfa1SMatthias Ringwald     }
63909ce6dfa1SMatthias Ringwald #endif
63919ce6dfa1SMatthias Ringwald 
6392501f56b3SMatthias Ringwald     if (hci_stack->le_advertisements_todo & LE_ADVERTISEMENT_TASKS_SET_ADV_DATA){
6393501f56b3SMatthias Ringwald         hci_stack->le_advertisements_todo &= ~LE_ADVERTISEMENT_TASKS_SET_ADV_DATA;
63947a85e4f5SMatthias Ringwald         uint8_t adv_data_clean[31];
63957a85e4f5SMatthias Ringwald         memset(adv_data_clean, 0, sizeof(adv_data_clean));
63966535961aSMatthias Ringwald         (void)memcpy(adv_data_clean, hci_stack->le_advertisements_data,
63976535961aSMatthias Ringwald                      hci_stack->le_advertisements_data_len);
63983c9da642SMatthias Ringwald         btstack_replace_bd_addr_placeholder(adv_data_clean, hci_stack->le_advertisements_data_len, hci_stack->local_bd_addr);
6399e464cd48SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
6400e464cd48SMatthias Ringwald         if (hci_extended_advertising_supported()){
6401174b4d21SMatthias Ringwald             hci_stack->le_advertising_set_in_current_command = 0;
6402e464cd48SMatthias Ringwald             hci_send_cmd(&hci_le_set_extended_advertising_data, 0, 0x03, 0x01, hci_stack->le_advertisements_data_len, adv_data_clean);
6403e464cd48SMatthias Ringwald         } else
6404e464cd48SMatthias Ringwald #endif
6405e464cd48SMatthias Ringwald         {
64067a85e4f5SMatthias Ringwald             hci_send_cmd(&hci_le_set_advertising_data, hci_stack->le_advertisements_data_len, adv_data_clean);
6407e464cd48SMatthias Ringwald         }
6408f30077b7SMatthias Ringwald         return true;
640945c102fdSMatthias Ringwald     }
6410be7ef9d8SMatthias Ringwald 
6411501f56b3SMatthias Ringwald     if (hci_stack->le_advertisements_todo & LE_ADVERTISEMENT_TASKS_SET_SCAN_DATA){
6412501f56b3SMatthias Ringwald         hci_stack->le_advertisements_todo &= ~LE_ADVERTISEMENT_TASKS_SET_SCAN_DATA;
6413f868b059SMatthias Ringwald         uint8_t scan_data_clean[31];
6414f868b059SMatthias Ringwald         memset(scan_data_clean, 0, sizeof(scan_data_clean));
64156535961aSMatthias Ringwald         (void)memcpy(scan_data_clean, hci_stack->le_scan_response_data,
64166535961aSMatthias Ringwald                      hci_stack->le_scan_response_data_len);
64173c9da642SMatthias Ringwald         btstack_replace_bd_addr_placeholder(scan_data_clean, hci_stack->le_scan_response_data_len, hci_stack->local_bd_addr);
6418e464cd48SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
6419e464cd48SMatthias Ringwald         if (hci_extended_advertising_supported()){
6420174b4d21SMatthias Ringwald             hci_stack->le_advertising_set_in_current_command = 0;
6421e464cd48SMatthias Ringwald             hci_send_cmd(&hci_le_set_extended_scan_response_data, 0, 0x03, 0x01, hci_stack->le_scan_response_data_len, scan_data_clean);
6422e464cd48SMatthias Ringwald         } else
6423e464cd48SMatthias Ringwald #endif
6424e464cd48SMatthias Ringwald         {
6425214bfd60SMatthias Ringwald             hci_send_cmd(&hci_le_set_scan_response_data, hci_stack->le_scan_response_data_len, scan_data_clean);
6426e464cd48SMatthias Ringwald         }
6427f30077b7SMatthias Ringwald         return true;
6428501f56b3SMatthias Ringwald     }
6429be7ef9d8SMatthias Ringwald 
6430be7ef9d8SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
6431be7ef9d8SMatthias Ringwald     if (hci_extended_advertising_supported()) {
6432be7ef9d8SMatthias Ringwald         btstack_linked_list_iterator_t it;
6433be7ef9d8SMatthias Ringwald         btstack_linked_list_iterator_init(&it, &hci_stack->le_advertising_sets);
6434be7ef9d8SMatthias Ringwald         while (btstack_linked_list_iterator_has_next(&it)){
6435be7ef9d8SMatthias Ringwald             le_advertising_set_t * advertising_set = (le_advertising_set_t*) btstack_linked_list_iterator_next(&it);
6436be7ef9d8SMatthias Ringwald             if ((advertising_set->tasks & LE_ADVERTISEMENT_TASKS_REMOVE_SET) != 0) {
6437be7ef9d8SMatthias Ringwald                 advertising_set->tasks &= ~LE_ADVERTISEMENT_TASKS_REMOVE_SET;
6438174b4d21SMatthias Ringwald                 hci_stack->le_advertising_set_in_current_command = advertising_set->advertising_handle;
6439be7ef9d8SMatthias Ringwald                 hci_send_cmd(&hci_le_remove_advertising_set, advertising_set->advertising_handle);
6440be7ef9d8SMatthias Ringwald                 return true;
6441be7ef9d8SMatthias Ringwald             }
6442be7ef9d8SMatthias Ringwald             if ((advertising_set->tasks & LE_ADVERTISEMENT_TASKS_SET_PARAMS) != 0){
6443be7ef9d8SMatthias Ringwald                 advertising_set->tasks &= ~LE_ADVERTISEMENT_TASKS_SET_PARAMS;
6444174b4d21SMatthias Ringwald                 hci_stack->le_advertising_set_in_current_command = advertising_set->advertising_handle;
6445be7ef9d8SMatthias Ringwald                 hci_send_cmd(&hci_le_set_extended_advertising_parameters,
6446be7ef9d8SMatthias Ringwald                              advertising_set->advertising_handle,
644757a04237SMatthias Ringwald                              advertising_set->extended_params.advertising_event_properties,
644857a04237SMatthias Ringwald                              advertising_set->extended_params.primary_advertising_interval_min,
644957a04237SMatthias Ringwald                              advertising_set->extended_params.primary_advertising_interval_max,
645057a04237SMatthias Ringwald                              advertising_set->extended_params.primary_advertising_channel_map,
645157a04237SMatthias Ringwald                              advertising_set->extended_params.own_address_type,
645257a04237SMatthias Ringwald                              advertising_set->extended_params.peer_address_type,
645357a04237SMatthias Ringwald                              advertising_set->extended_params.peer_address,
645457a04237SMatthias Ringwald                              advertising_set->extended_params.advertising_filter_policy,
645557a04237SMatthias Ringwald                              advertising_set->extended_params.advertising_tx_power,
645657a04237SMatthias Ringwald                              advertising_set->extended_params.primary_advertising_phy,
645757a04237SMatthias Ringwald                              advertising_set->extended_params.secondary_advertising_max_skip,
645857a04237SMatthias Ringwald                              advertising_set->extended_params.secondary_advertising_phy,
645957a04237SMatthias Ringwald                              advertising_set->extended_params.advertising_sid,
646057a04237SMatthias Ringwald                              advertising_set->extended_params.scan_request_notification_enable
6461be7ef9d8SMatthias Ringwald                 );
6462be7ef9d8SMatthias Ringwald                 return true;
6463be7ef9d8SMatthias Ringwald             }
64640f54aa8dSMatthias Ringwald             if ((advertising_set->tasks & LE_ADVERTISEMENT_TASKS_SET_ADDRESS) != 0){
64650f54aa8dSMatthias Ringwald                 advertising_set->tasks &= ~LE_ADVERTISEMENT_TASKS_SET_ADDRESS;
64660f54aa8dSMatthias Ringwald                 hci_send_cmd(&hci_le_set_advertising_set_random_address, advertising_set->advertising_handle, advertising_set->random_address);
64670f54aa8dSMatthias Ringwald                 return true;
64680f54aa8dSMatthias Ringwald             }
6469be7ef9d8SMatthias Ringwald             if ((advertising_set->tasks & LE_ADVERTISEMENT_TASKS_SET_ADV_DATA) != 0) {
6470be7ef9d8SMatthias Ringwald                 uint16_t pos = advertising_set->adv_data_pos;
6471be7ef9d8SMatthias Ringwald                 uint8_t  operation = hci_le_extended_advertising_operation_for_chunk(pos, advertising_set->adv_data_len);
6472be7ef9d8SMatthias Ringwald                 uint16_t data_to_upload = btstack_min(advertising_set->adv_data_len - pos, LE_EXTENDED_ADVERTISING_MAX_CHUNK_LEN);
6473be7ef9d8SMatthias Ringwald                 if ((operation & 0x02) != 0){
6474be7ef9d8SMatthias Ringwald                     // last fragment or complete data
6475be7ef9d8SMatthias Ringwald                     operation |= 2;
6476be7ef9d8SMatthias Ringwald                     advertising_set->adv_data_pos = 0;
6477be7ef9d8SMatthias Ringwald                     advertising_set->tasks &= ~LE_ADVERTISEMENT_TASKS_SET_ADV_DATA;
6478be7ef9d8SMatthias Ringwald                 } else {
6479be7ef9d8SMatthias Ringwald                     advertising_set->adv_data_pos += data_to_upload;
6480be7ef9d8SMatthias Ringwald                 }
6481174b4d21SMatthias Ringwald                 hci_stack->le_advertising_set_in_current_command = advertising_set->advertising_handle;
64820cbe4690SMatthias Ringwald                 hci_send_cmd(&hci_le_set_extended_advertising_data, advertising_set->advertising_handle, operation, 0x01, data_to_upload, &advertising_set->adv_data[pos]);
6483be7ef9d8SMatthias Ringwald                 return true;
6484be7ef9d8SMatthias Ringwald             }
6485be7ef9d8SMatthias Ringwald             if ((advertising_set->tasks & LE_ADVERTISEMENT_TASKS_SET_SCAN_DATA) != 0) {
6486be7ef9d8SMatthias Ringwald                 uint16_t pos = advertising_set->scan_data_pos;
6487be7ef9d8SMatthias Ringwald                 uint8_t  operation = hci_le_extended_advertising_operation_for_chunk(pos, advertising_set->scan_data_len);
6488be7ef9d8SMatthias Ringwald                 uint16_t data_to_upload = btstack_min(advertising_set->scan_data_len - pos, LE_EXTENDED_ADVERTISING_MAX_CHUNK_LEN);
6489be7ef9d8SMatthias Ringwald                 if ((operation & 0x02) != 0){
6490be7ef9d8SMatthias Ringwald                     advertising_set->scan_data_pos = 0;
6491be7ef9d8SMatthias Ringwald                     advertising_set->tasks &= ~LE_ADVERTISEMENT_TASKS_SET_SCAN_DATA;
6492be7ef9d8SMatthias Ringwald                 } else {
6493be7ef9d8SMatthias Ringwald                     advertising_set->scan_data_pos += data_to_upload;
6494be7ef9d8SMatthias Ringwald                 }
6495174b4d21SMatthias Ringwald                 hci_stack->le_advertising_set_in_current_command = advertising_set->advertising_handle;
64968ef6d15fSMatthias 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]);
6497be7ef9d8SMatthias Ringwald                 return true;
6498be7ef9d8SMatthias Ringwald             }
6499c814a904SMatthias Ringwald #ifdef ENABLE_LE_PERIODIC_ADVERTISING
650053f240c0SMatthias Ringwald             if ((advertising_set->tasks & LE_ADVERTISEMENT_TASKS_SET_PERIODIC_PARAMS) != 0){
650153f240c0SMatthias Ringwald                 advertising_set->tasks &= ~LE_ADVERTISEMENT_TASKS_SET_PERIODIC_PARAMS;
650253f240c0SMatthias Ringwald                 hci_stack->le_advertising_set_in_current_command = advertising_set->advertising_handle;
650353f240c0SMatthias Ringwald                 hci_send_cmd(&hci_le_set_periodic_advertising_parameters,
650453f240c0SMatthias Ringwald                              advertising_set->advertising_handle,
650553f240c0SMatthias Ringwald                              advertising_set->periodic_params.periodic_advertising_interval_min,
650653f240c0SMatthias Ringwald                              advertising_set->periodic_params.periodic_advertising_interval_max,
650753f240c0SMatthias Ringwald                              advertising_set->periodic_params.periodic_advertising_properties);
650853f240c0SMatthias Ringwald                 return true;
650953f240c0SMatthias Ringwald             }
651053f240c0SMatthias Ringwald             if ((advertising_set->tasks & LE_ADVERTISEMENT_TASKS_SET_PERIODIC_DATA) != 0) {
65110cbe4690SMatthias Ringwald                 uint16_t pos = advertising_set->periodic_data_pos;
651253f240c0SMatthias Ringwald                 uint8_t  operation = hci_le_extended_advertising_operation_for_chunk(pos, advertising_set->periodic_data_len);
651353f240c0SMatthias Ringwald                 uint16_t data_to_upload = btstack_min(advertising_set->periodic_data_len - pos, LE_EXTENDED_ADVERTISING_MAX_CHUNK_LEN);
651453f240c0SMatthias Ringwald                 if ((operation & 0x02) != 0){
651553f240c0SMatthias Ringwald                     // last fragment or complete data
651653f240c0SMatthias Ringwald                     operation |= 2;
65170cbe4690SMatthias Ringwald                     advertising_set->periodic_data_pos = 0;
651853f240c0SMatthias Ringwald                     advertising_set->tasks &= ~LE_ADVERTISEMENT_TASKS_SET_PERIODIC_DATA;
651953f240c0SMatthias Ringwald                 } else {
65200cbe4690SMatthias Ringwald                     advertising_set->periodic_data_pos += data_to_upload;
652153f240c0SMatthias Ringwald                 }
652253f240c0SMatthias Ringwald                 hci_stack->le_advertising_set_in_current_command = advertising_set->advertising_handle;
65230cbe4690SMatthias Ringwald                 hci_send_cmd(&hci_le_set_periodic_advertising_data, advertising_set->advertising_handle, operation, data_to_upload, &advertising_set->periodic_data[pos]);
652453f240c0SMatthias Ringwald                 return true;
652553f240c0SMatthias Ringwald             }
6526c814a904SMatthias Ringwald #endif /* ENABLE_LE_PERIODIC_ADVERTISING */
6527be7ef9d8SMatthias Ringwald         }
6528be7ef9d8SMatthias Ringwald     }
6529be7ef9d8SMatthias Ringwald #endif
6530be7ef9d8SMatthias Ringwald 
6531d70217a2SMatthias Ringwald #endif
65329956955bSMatthias Ringwald 
6533057ab60cSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
6534a41310b7SMatthias Ringwald     // if connect with whitelist was active and is not cancelled yet, wait until next time
6535a41310b7SMatthias Ringwald     if (hci_stack->le_connecting_state == LE_CONNECTING_CANCEL) return false;
65364bafedd5SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
65374bafedd5SMatthias Ringwald     // if periodic sync with advertiser list was active and is not cancelled yet, wait until next time
65384bafedd5SMatthias Ringwald     if (hci_stack->le_periodic_sync_state == LE_CONNECTING_CANCEL) return false;
65394bafedd5SMatthias Ringwald #endif
6540057ab60cSMatthias Ringwald #endif
6541057ab60cSMatthias Ringwald 
6542a41310b7SMatthias Ringwald     // LE Whitelist Management
6543a41310b7SMatthias Ringwald     if (whitelist_modification_pending){
65449956955bSMatthias Ringwald         // add/remove entries
6545665d90f2SMatthias Ringwald         btstack_linked_list_iterator_init(&lit, &hci_stack->le_whitelist);
6546665d90f2SMatthias Ringwald         while (btstack_linked_list_iterator_has_next(&lit)){
6547665d90f2SMatthias Ringwald             whitelist_entry_t * entry = (whitelist_entry_t*) btstack_linked_list_iterator_next(&lit);
6548453459ddSMatthias Ringwald 			if (entry->state & LE_WHITELIST_REMOVE_FROM_CONTROLLER){
6549453459ddSMatthias Ringwald 				entry->state &= ~LE_WHITELIST_REMOVE_FROM_CONTROLLER;
6550334e35acSMatthias Ringwald                 entry->state &= ~LE_WHITELIST_ON_CONTROLLER;
6551334e35acSMatthias Ringwald                 bd_addr_type_t address_type = entry->address_type;
6552334e35acSMatthias Ringwald                 bd_addr_t address;
6553334e35acSMatthias Ringwald                 memcpy(address, entry->address, 6);
6554334e35acSMatthias Ringwald                 if ((entry->state & LE_WHITELIST_ADD_TO_CONTROLLER) == 0){
6555334e35acSMatthias Ringwald                     // remove from whitelist if not scheduled for re-addition
6556334e35acSMatthias Ringwald                     btstack_linked_list_remove(&hci_stack->le_whitelist, (btstack_linked_item_t *) entry);
6557334e35acSMatthias Ringwald                     btstack_memory_whitelist_entry_free(entry);
6558334e35acSMatthias Ringwald                 }
6559334e35acSMatthias Ringwald 				hci_send_cmd(&hci_le_remove_device_from_white_list, address_type, address);
6560453459ddSMatthias Ringwald 				return true;
6561453459ddSMatthias Ringwald 			}
65629956955bSMatthias Ringwald             if (entry->state & LE_WHITELIST_ADD_TO_CONTROLLER){
6563453459ddSMatthias Ringwald 				entry->state &= ~LE_WHITELIST_ADD_TO_CONTROLLER;
6564453459ddSMatthias Ringwald                 entry->state |= LE_WHITELIST_ON_CONTROLLER;
65659956955bSMatthias Ringwald                 hci_send_cmd(&hci_le_add_device_to_white_list, entry->address_type, entry->address);
6566f30077b7SMatthias Ringwald                 return true;
65679956955bSMatthias Ringwald             }
65689956955bSMatthias Ringwald         }
656991915b0bSMatthias Ringwald     }
65709956955bSMatthias Ringwald 
657121debf25SMatthias Ringwald #ifdef ENABLE_LE_PRIVACY_ADDRESS_RESOLUTION
657221debf25SMatthias Ringwald     // LE Resolving List Management
6573ea151974SMatthias Ringwald     if (resolving_list_supported) {
657421debf25SMatthias Ringwald 		uint16_t i;
657521debf25SMatthias Ringwald 		switch (hci_stack->le_resolving_list_state) {
657621debf25SMatthias Ringwald 			case LE_RESOLVING_LIST_SEND_ENABLE_ADDRESS_RESOLUTION:
657721debf25SMatthias Ringwald 				hci_stack->le_resolving_list_state = LE_RESOLVING_LIST_READ_SIZE;
657821debf25SMatthias Ringwald 				hci_send_cmd(&hci_le_set_address_resolution_enabled, 1);
657921debf25SMatthias Ringwald 				return true;
658021debf25SMatthias Ringwald 			case LE_RESOLVING_LIST_READ_SIZE:
658121debf25SMatthias Ringwald 				hci_stack->le_resolving_list_state = LE_RESOLVING_LIST_SEND_CLEAR;
658221debf25SMatthias Ringwald 				hci_send_cmd(&hci_le_read_resolving_list_size);
658321debf25SMatthias Ringwald 				return true;
658421debf25SMatthias Ringwald 			case LE_RESOLVING_LIST_SEND_CLEAR:
65855f3ccd83SMatthias Ringwald 				hci_stack->le_resolving_list_state = LE_RESOLVING_LIST_UPDATES_ENTRIES;
6586ea151974SMatthias Ringwald 				(void) memset(hci_stack->le_resolving_list_add_entries, 0xff,
6587ea151974SMatthias Ringwald 							  sizeof(hci_stack->le_resolving_list_add_entries));
6588e8ca66c6SMatthias Ringwald                 (void) memset(hci_stack->le_resolving_list_set_privacy_mode, 0xff,
6589e8ca66c6SMatthias Ringwald                               sizeof(hci_stack->le_resolving_list_set_privacy_mode));
6590ea151974SMatthias Ringwald 				(void) memset(hci_stack->le_resolving_list_remove_entries, 0,
6591ea151974SMatthias Ringwald 							  sizeof(hci_stack->le_resolving_list_remove_entries));
659221debf25SMatthias Ringwald 				hci_send_cmd(&hci_le_clear_resolving_list);
659321debf25SMatthias Ringwald 				return true;
65945f3ccd83SMatthias Ringwald 			case LE_RESOLVING_LIST_UPDATES_ENTRIES:
65955f3ccd83SMatthias Ringwald                 // first remove old entries
659602b02cffSMatthias Ringwald 				for (i = 0; i < MAX_NUM_RESOLVING_LIST_ENTRIES && i < le_device_db_max_count(); i++) {
659702b02cffSMatthias Ringwald 					uint8_t offset = i >> 3;
659802b02cffSMatthias Ringwald 					uint8_t mask = 1 << (i & 7);
659902b02cffSMatthias Ringwald 					if ((hci_stack->le_resolving_list_remove_entries[offset] & mask) == 0) continue;
660002b02cffSMatthias Ringwald 					hci_stack->le_resolving_list_remove_entries[offset] &= ~mask;
660102b02cffSMatthias Ringwald 					bd_addr_t peer_identity_addreses;
660202b02cffSMatthias Ringwald 					int peer_identity_addr_type = (int) BD_ADDR_TYPE_UNKNOWN;
660302b02cffSMatthias Ringwald 					sm_key_t peer_irk;
660402b02cffSMatthias Ringwald 					le_device_db_info(i, &peer_identity_addr_type, peer_identity_addreses, peer_irk);
660502b02cffSMatthias Ringwald 					if (peer_identity_addr_type == BD_ADDR_TYPE_UNKNOWN) continue;
6606f5228c62SMatthias Ringwald 
6607f5228c62SMatthias Ringwald #ifdef ENABLE_LE_WHITELIST_TOUCH_AFTER_RESOLVING_LIST_UPDATE
6608f5228c62SMatthias Ringwald 					// trigger whitelist entry 'update' (work around for controller bug)
6609f5228c62SMatthias Ringwald 					btstack_linked_list_iterator_init(&lit, &hci_stack->le_whitelist);
6610f5228c62SMatthias Ringwald 					while (btstack_linked_list_iterator_has_next(&lit)) {
6611f5228c62SMatthias Ringwald 						whitelist_entry_t *entry = (whitelist_entry_t *) btstack_linked_list_iterator_next(&lit);
6612f5228c62SMatthias Ringwald 						if (entry->address_type != peer_identity_addr_type) continue;
6613f5228c62SMatthias Ringwald 						if (memcmp(entry->address, peer_identity_addreses, 6) != 0) continue;
6614f5228c62SMatthias Ringwald 						log_info("trigger whitelist update %s", bd_addr_to_str(peer_identity_addreses));
6615f5228c62SMatthias Ringwald 						entry->state |= LE_WHITELIST_REMOVE_FROM_CONTROLLER | LE_WHITELIST_ADD_TO_CONTROLLER;
6616f5228c62SMatthias Ringwald 					}
6617f5228c62SMatthias Ringwald #endif
6618f5228c62SMatthias Ringwald 
6619ea151974SMatthias Ringwald 					hci_send_cmd(&hci_le_remove_device_from_resolving_list, peer_identity_addr_type,
6620ea151974SMatthias Ringwald 								 peer_identity_addreses);
662102b02cffSMatthias Ringwald 					return true;
662202b02cffSMatthias Ringwald 				}
662302b02cffSMatthias Ringwald 
66245f3ccd83SMatthias Ringwald                 // then add new entries
662521debf25SMatthias Ringwald 				for (i = 0; i < MAX_NUM_RESOLVING_LIST_ENTRIES && i < le_device_db_max_count(); i++) {
662621debf25SMatthias Ringwald 					uint8_t offset = i >> 3;
662721debf25SMatthias Ringwald 					uint8_t mask = 1 << (i & 7);
662802b02cffSMatthias Ringwald 					if ((hci_stack->le_resolving_list_add_entries[offset] & mask) == 0) continue;
662902b02cffSMatthias Ringwald 					hci_stack->le_resolving_list_add_entries[offset] &= ~mask;
663021debf25SMatthias Ringwald 					bd_addr_t peer_identity_addreses;
663121debf25SMatthias Ringwald 					int peer_identity_addr_type = (int) BD_ADDR_TYPE_UNKNOWN;
663221debf25SMatthias Ringwald 					sm_key_t peer_irk;
663321debf25SMatthias Ringwald 					le_device_db_info(i, &peer_identity_addr_type, peer_identity_addreses, peer_irk);
663421debf25SMatthias Ringwald 					if (peer_identity_addr_type == BD_ADDR_TYPE_UNKNOWN) continue;
6635e938c062SMatthias Ringwald                     if (btstack_is_null(peer_irk, 16)) continue;
663621debf25SMatthias Ringwald 					const uint8_t *local_irk = gap_get_persistent_irk();
663721debf25SMatthias Ringwald 					// command uses format specifier 'P' that stores 16-byte value without flip
663821debf25SMatthias Ringwald 					uint8_t local_irk_flipped[16];
663921debf25SMatthias Ringwald 					uint8_t peer_irk_flipped[16];
664021debf25SMatthias Ringwald 					reverse_128(local_irk, local_irk_flipped);
664121debf25SMatthias Ringwald 					reverse_128(peer_irk, peer_irk_flipped);
6642ea151974SMatthias Ringwald 					hci_send_cmd(&hci_le_add_device_to_resolving_list, peer_identity_addr_type, peer_identity_addreses,
6643ea151974SMatthias Ringwald 								 peer_irk_flipped, local_irk_flipped);
664421debf25SMatthias Ringwald 					return true;
664521debf25SMatthias Ringwald 				}
6646e8ca66c6SMatthias Ringwald 
6647e8ca66c6SMatthias Ringwald                 // finally, set privacy mode
6648e8ca66c6SMatthias Ringwald                 for (i = 0; i < MAX_NUM_RESOLVING_LIST_ENTRIES && i < le_device_db_max_count(); i++) {
6649e8ca66c6SMatthias Ringwald                     uint8_t offset = i >> 3;
6650e8ca66c6SMatthias Ringwald                     uint8_t mask = 1 << (i & 7);
6651e8ca66c6SMatthias Ringwald                     if ((hci_stack->le_resolving_list_set_privacy_mode[offset] & mask) == 0) continue;
6652e8ca66c6SMatthias Ringwald                     hci_stack->le_resolving_list_set_privacy_mode[offset] &= ~mask;
6653e8ca66c6SMatthias Ringwald                     if (hci_stack->le_privacy_mode == LE_PRIVACY_MODE_NETWORK) {
6654e8ca66c6SMatthias Ringwald                         // Network Privacy Mode is default
6655e8ca66c6SMatthias Ringwald                         continue;
6656e8ca66c6SMatthias Ringwald                     }
6657e8ca66c6SMatthias Ringwald                     bd_addr_t peer_identity_address;
6658e8ca66c6SMatthias Ringwald                     int peer_identity_addr_type = (int) BD_ADDR_TYPE_UNKNOWN;
6659e8ca66c6SMatthias Ringwald                     sm_key_t peer_irk;
6660e8ca66c6SMatthias Ringwald                     le_device_db_info(i, &peer_identity_addr_type, peer_identity_address, peer_irk);
6661e8ca66c6SMatthias Ringwald                     if (peer_identity_addr_type == BD_ADDR_TYPE_UNKNOWN) continue;
6662e8ca66c6SMatthias Ringwald                     if (btstack_is_null(peer_irk, 16)) continue;
6663e8ca66c6SMatthias Ringwald                     // command uses format specifier 'P' that stores 16-byte value without flip
6664e8ca66c6SMatthias Ringwald                     uint8_t peer_irk_flipped[16];
6665e8ca66c6SMatthias Ringwald                     reverse_128(peer_irk, peer_irk_flipped);
6666e8ca66c6SMatthias Ringwald                     hci_send_cmd(&hci_le_set_privacy_mode, peer_identity_addr_type, peer_identity_address, hci_stack->le_privacy_mode);
6667e8ca66c6SMatthias Ringwald                     return true;
6668e8ca66c6SMatthias Ringwald                 }
666902b02cffSMatthias Ringwald 				hci_stack->le_resolving_list_state = LE_RESOLVING_LIST_DONE;
667021debf25SMatthias Ringwald 				break;
667102b02cffSMatthias Ringwald 
667221debf25SMatthias Ringwald 			default:
667321debf25SMatthias Ringwald 				break;
667421debf25SMatthias Ringwald 		}
6675ea151974SMatthias Ringwald 	}
667621debf25SMatthias Ringwald     hci_stack->le_resolving_list_state = LE_RESOLVING_LIST_DONE;
667721debf25SMatthias Ringwald #endif
6678a41310b7SMatthias Ringwald 
6679f40c73b4SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
6680f40c73b4SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
6681f40c73b4SMatthias Ringwald     // LE Whitelist Management
6682f40c73b4SMatthias Ringwald     if (periodic_list_modification_pending){
6683f40c73b4SMatthias Ringwald         // add/remove entries
6684f40c73b4SMatthias Ringwald         btstack_linked_list_iterator_init(&lit, &hci_stack->le_periodic_advertiser_list);
6685f40c73b4SMatthias Ringwald         while (btstack_linked_list_iterator_has_next(&lit)){
6686f40c73b4SMatthias Ringwald             periodic_advertiser_list_entry_t * entry = (periodic_advertiser_list_entry_t*) btstack_linked_list_iterator_next(&lit);
6687f40c73b4SMatthias Ringwald             if (entry->state & LE_PERIODIC_ADVERTISER_LIST_ENTRY_REMOVE_FROM_CONTROLLER){
6688f40c73b4SMatthias Ringwald                 entry->state &= ~LE_PERIODIC_ADVERTISER_LIST_ENTRY_REMOVE_FROM_CONTROLLER;
6689d946a741SMatthias Ringwald                 hci_send_cmd(&hci_le_remove_device_from_periodic_advertiser_list, entry->address_type, entry->address, entry->sid);
6690f40c73b4SMatthias Ringwald                 return true;
6691f40c73b4SMatthias Ringwald             }
6692f40c73b4SMatthias Ringwald             if (entry->state & LE_PERIODIC_ADVERTISER_LIST_ENTRY_ADD_TO_CONTROLLER){
6693f40c73b4SMatthias Ringwald                 entry->state &= ~LE_PERIODIC_ADVERTISER_LIST_ENTRY_ADD_TO_CONTROLLER;
6694f40c73b4SMatthias Ringwald                 entry->state |= LE_PERIODIC_ADVERTISER_LIST_ENTRY_ON_CONTROLLER;
66959e88556bSMatthias Ringwald                 hci_send_cmd(&hci_le_add_device_to_periodic_advertiser_list, entry->address_type, entry->address, entry->sid);
6696f40c73b4SMatthias Ringwald                 return true;
6697f40c73b4SMatthias Ringwald             }
6698f40c73b4SMatthias Ringwald             if ((entry->state & LE_PERIODIC_ADVERTISER_LIST_ENTRY_ON_CONTROLLER) == 0){
6699f40c73b4SMatthias Ringwald                 btstack_linked_list_remove(&hci_stack->le_periodic_advertiser_list, (btstack_linked_item_t *) entry);
6700f40c73b4SMatthias Ringwald                 btstack_memory_periodic_advertiser_list_entry_free(entry);
6701f40c73b4SMatthias Ringwald             }
6702f40c73b4SMatthias Ringwald         }
6703f40c73b4SMatthias Ringwald     }
6704f40c73b4SMatthias Ringwald #endif
6705f40c73b4SMatthias Ringwald #endif
6706f40c73b4SMatthias Ringwald 
670798aa715fSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
670898aa715fSMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
670998aa715fSMatthias Ringwald #ifdef ENABLE_LE_PERIODIC_ADVERTISING
671098aa715fSMatthias Ringwald     if (hci_stack->le_past_set_default_params){
671198aa715fSMatthias Ringwald         hci_stack->le_past_set_default_params = false;
671298aa715fSMatthias Ringwald         hci_send_cmd(&hci_le_set_default_periodic_advertising_sync_transfer_parameters,
671398aa715fSMatthias Ringwald                      hci_stack->le_past_mode,
671498aa715fSMatthias Ringwald                      hci_stack->le_past_skip,
671598aa715fSMatthias Ringwald                      hci_stack->le_past_sync_timeout,
671698aa715fSMatthias Ringwald                      hci_stack->le_past_cte_type);
671798aa715fSMatthias Ringwald         return true;
671898aa715fSMatthias Ringwald     }
671998aa715fSMatthias Ringwald #endif
672098aa715fSMatthias Ringwald #endif
672198aa715fSMatthias Ringwald #endif
672298aa715fSMatthias Ringwald 
672373799937SMatthias Ringwald     // post-pone all actions until stack is fully working
672473799937SMatthias Ringwald     if (hci_stack->state != HCI_STATE_WORKING) return false;
672573799937SMatthias Ringwald 
672673799937SMatthias Ringwald     // advertisements, active scanning, and creating connections requires random address to be set if using private address
672773799937SMatthias Ringwald     if ( (hci_stack->le_own_addr_type != BD_ADDR_TYPE_LE_PUBLIC) && (hci_stack->le_random_address_set == 0u) ) return false;
672873799937SMatthias Ringwald 
6729a41310b7SMatthias Ringwald     // Phase 4: restore state
673029c24bebSMatthias Ringwald 
673129c24bebSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
6732af64f147SMatthias Ringwald     // re-start scanning
673329c24bebSMatthias Ringwald     if ((hci_stack->le_scanning_enabled && !hci_stack->le_scanning_active)){
673429c24bebSMatthias Ringwald         hci_stack->le_scanning_active = true;
673563671e69SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
673663671e69SMatthias Ringwald         if (hci_extended_advertising_supported()){
67374856283bSMatthias Ringwald             hci_send_cmd(&hci_le_set_extended_scan_enable, 1, hci_stack->le_scan_filter_duplicates, 0, 0);
673863671e69SMatthias Ringwald         } else
673963671e69SMatthias Ringwald #endif
674063671e69SMatthias Ringwald         {
67414856283bSMatthias Ringwald             hci_send_cmd(&hci_le_set_scan_enable, 1, hci_stack->le_scan_filter_duplicates);
674263671e69SMatthias Ringwald         }
674329c24bebSMatthias Ringwald         return true;
674429c24bebSMatthias Ringwald     }
674529c24bebSMatthias Ringwald #endif
674629c24bebSMatthias Ringwald 
674713eb2a2eSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
6748af64f147SMatthias Ringwald     // re-start connecting
6749af64f147SMatthias Ringwald     if ( (hci_stack->le_connecting_state == LE_CONNECTING_IDLE) && (hci_stack->le_connecting_request == LE_CONNECTING_WHITELIST)){
67509956955bSMatthias Ringwald         bd_addr_t null_addr;
67519956955bSMatthias Ringwald         memset(null_addr, 0, 6);
67526bcfa632SMatthias Ringwald         hci_stack->le_connection_own_addr_type =  hci_stack->le_own_addr_type;
67536bcfa632SMatthias Ringwald         hci_get_own_address_for_addr_type(hci_stack->le_connection_own_addr_type, hci_stack->le_connection_own_address);
67546f34e9d6SMatthias Ringwald         hci_send_le_create_connection(1, 0, null_addr);
6755f30077b7SMatthias Ringwald         return true;
67569956955bSMatthias Ringwald     }
67574bafedd5SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
67584bafedd5SMatthias Ringwald     if (hci_stack->le_periodic_sync_state == LE_CONNECTING_IDLE){
67594bafedd5SMatthias Ringwald         switch(hci_stack->le_periodic_sync_request){
67604bafedd5SMatthias Ringwald             case LE_CONNECTING_DIRECT:
67614bafedd5SMatthias Ringwald             case LE_CONNECTING_WHITELIST:
67624bafedd5SMatthias Ringwald                 hci_stack->le_periodic_sync_state = ((hci_stack->le_periodic_sync_options & 1) != 0) ? LE_CONNECTING_WHITELIST : LE_CONNECTING_DIRECT;
67634bafedd5SMatthias Ringwald                 hci_send_cmd(&hci_le_periodic_advertising_create_sync,
67644bafedd5SMatthias Ringwald                              hci_stack->le_periodic_sync_options,
67654bafedd5SMatthias Ringwald                              hci_stack->le_periodic_sync_advertising_sid,
67664bafedd5SMatthias Ringwald                              hci_stack->le_periodic_sync_advertiser_address_type,
67674bafedd5SMatthias Ringwald                              hci_stack->le_periodic_sync_advertiser_address,
67684bafedd5SMatthias Ringwald                              hci_stack->le_periodic_sync_skip,
67694bafedd5SMatthias Ringwald                              hci_stack->le_periodic_sync_timeout,
67704bafedd5SMatthias Ringwald                              hci_stack->le_periodic_sync_cte_type);
67714bafedd5SMatthias Ringwald                 return true;
67724bafedd5SMatthias Ringwald             default:
67734bafedd5SMatthias Ringwald                 break;
67744bafedd5SMatthias Ringwald         }
67754bafedd5SMatthias Ringwald     }
67764bafedd5SMatthias Ringwald #endif
6777d70217a2SMatthias Ringwald #endif
6778a41310b7SMatthias Ringwald 
6779a41310b7SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
6780a41310b7SMatthias Ringwald     // re-start advertising
6781935aa76eSMatthias Ringwald     if (hci_stack->le_advertisements_enabled_for_current_roles && ((hci_stack->le_advertisements_state & LE_ADVERTISEMENT_STATE_ACTIVE) == 0)){
6782a41310b7SMatthias Ringwald         // check if advertisements should be enabled given
6783935aa76eSMatthias Ringwald         hci_stack->le_advertisements_state |= LE_ADVERTISEMENT_STATE_ACTIVE;
6784b892db1cSMatthias Ringwald         hci_get_own_address_for_addr_type(hci_stack->le_advertisements_own_addr_type, hci_stack->le_advertisements_own_address);
6785e464cd48SMatthias Ringwald 
6786e464cd48SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
6787e464cd48SMatthias Ringwald         if (hci_extended_advertising_supported()){
6788e464cd48SMatthias Ringwald             const uint8_t advertising_handles[] = { 0 };
6789e464cd48SMatthias Ringwald             const uint16_t durations[] = { 0 };
6790e464cd48SMatthias Ringwald             const uint16_t max_events[] = { 0 };
6791e464cd48SMatthias Ringwald             hci_send_cmd(&hci_le_set_extended_advertising_enable, 1, 1, advertising_handles, durations, max_events);
6792e464cd48SMatthias Ringwald         } else
6793e464cd48SMatthias Ringwald #endif
6794e464cd48SMatthias Ringwald         {
6795a41310b7SMatthias Ringwald             hci_send_cmd(&hci_le_set_advertise_enable, 1);
6796e464cd48SMatthias Ringwald         }
6797a41310b7SMatthias Ringwald         return true;
6798a41310b7SMatthias Ringwald     }
6799be7ef9d8SMatthias Ringwald 
6800be7ef9d8SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
6801be7ef9d8SMatthias Ringwald     if (hci_extended_advertising_supported()) {
6802be7ef9d8SMatthias Ringwald         btstack_linked_list_iterator_t it;
6803be7ef9d8SMatthias Ringwald         btstack_linked_list_iterator_init(&it, &hci_stack->le_advertising_sets);
6804be7ef9d8SMatthias Ringwald         while (btstack_linked_list_iterator_has_next(&it)) {
6805be7ef9d8SMatthias Ringwald             le_advertising_set_t *advertising_set = (le_advertising_set_t *) btstack_linked_list_iterator_next(&it);
6806be7ef9d8SMatthias Ringwald             if (((advertising_set->state & LE_ADVERTISEMENT_STATE_ENABLED) != 0) && ((advertising_set->state & LE_ADVERTISEMENT_STATE_ACTIVE) == 0)){
68078caa405cSMatthias Ringwald                 advertising_set->state |= LE_ADVERTISEMENT_STATE_ACTIVE;
6808be7ef9d8SMatthias Ringwald                 const uint8_t advertising_handles[] = { advertising_set->advertising_handle };
6809be7ef9d8SMatthias Ringwald                 const uint16_t durations[] = { advertising_set->enable_timeout };
6810be7ef9d8SMatthias Ringwald                 const uint16_t max_events[] = { advertising_set->enable_max_scan_events };
6811be7ef9d8SMatthias Ringwald                 hci_send_cmd(&hci_le_set_extended_advertising_enable, 1, 1, advertising_handles, durations, max_events);
6812be7ef9d8SMatthias Ringwald                 return true;
6813be7ef9d8SMatthias Ringwald             }
6814c814a904SMatthias Ringwald #ifdef ENABLE_LE_PERIODIC_ADVERTISING
681553f240c0SMatthias Ringwald             if (((advertising_set->state & LE_ADVERTISEMENT_STATE_PERIODIC_ENABLED) != 0) && ((advertising_set->state & LE_ADVERTISEMENT_STATE_PERIODIC_ACTIVE) == 0)){
681653f240c0SMatthias Ringwald                 advertising_set->state |= LE_ADVERTISEMENT_STATE_PERIODIC_ACTIVE;
681753f240c0SMatthias Ringwald                 uint8_t enable = 1;
681853f240c0SMatthias Ringwald                 if (advertising_set->periodic_include_adi){
681953f240c0SMatthias Ringwald                     enable |= 2;
682053f240c0SMatthias Ringwald                 }
682153f240c0SMatthias Ringwald                 hci_send_cmd(&hci_le_set_periodic_advertising_enable, enable, advertising_set->advertising_handle);
682253f240c0SMatthias Ringwald                 return true;
682353f240c0SMatthias Ringwald             }
6824c814a904SMatthias Ringwald #endif /* ENABLE_LE_PERIODIC_ADVERTISING */
6825be7ef9d8SMatthias Ringwald         }
6826be7ef9d8SMatthias Ringwald     }
6827be7ef9d8SMatthias Ringwald #endif
6828a41310b7SMatthias Ringwald #endif
6829a41310b7SMatthias Ringwald 
6830f30077b7SMatthias Ringwald     return false;
68317bdc6798S[email protected] }
68327aa35f6aSMatthias Ringwald 
68337aa35f6aSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
68347aa35f6aSMatthias Ringwald static bool hci_run_iso_tasks(void){
68357aa35f6aSMatthias Ringwald     btstack_linked_list_iterator_t it;
68362a6c0f82SMatthias Ringwald 
683726b93350SMatthias Ringwald     if (hci_stack->iso_active_operation_type != HCI_ISO_TYPE_INVALID) {
683840f86dfdSMatthias Ringwald         return false;
683940f86dfdSMatthias Ringwald     }
684040f86dfdSMatthias Ringwald 
68412a6c0f82SMatthias Ringwald     // BIG
68427aa35f6aSMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->le_audio_bigs);
68437aa35f6aSMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
68447aa35f6aSMatthias Ringwald         le_audio_big_t * big = (le_audio_big_t *) btstack_linked_list_iterator_next(&it);
68457aa35f6aSMatthias Ringwald         switch (big->state){
68467aa35f6aSMatthias Ringwald             case LE_AUDIO_BIG_STATE_CREATE:
684740f86dfdSMatthias Ringwald                 hci_stack->iso_active_operation_group_id = big->params->big_handle;
684840f86dfdSMatthias Ringwald                 hci_stack->iso_active_operation_type = HCI_ISO_TYPE_BIS;
68497aa35f6aSMatthias Ringwald                 big->state = LE_AUDIO_BIG_STATE_W4_ESTABLISHED;
68507aa35f6aSMatthias Ringwald                 hci_send_cmd(&hci_le_create_big,
68517aa35f6aSMatthias Ringwald                              big->params->big_handle,
68527aa35f6aSMatthias Ringwald                              big->params->advertising_handle,
68537aa35f6aSMatthias Ringwald                              big->params->num_bis,
68547aa35f6aSMatthias Ringwald                              big->params->sdu_interval_us,
68557aa35f6aSMatthias Ringwald                              big->params->max_sdu,
68567aa35f6aSMatthias Ringwald                              big->params->max_transport_latency_ms,
68577aa35f6aSMatthias Ringwald                              big->params->rtn,
68587aa35f6aSMatthias Ringwald                              big->params->phy,
68597aa35f6aSMatthias Ringwald                              big->params->packing,
68607aa35f6aSMatthias Ringwald                              big->params->framing,
68617aa35f6aSMatthias Ringwald                              big->params->encryption,
68627aa35f6aSMatthias Ringwald                              big->params->broadcast_code);
68637aa35f6aSMatthias Ringwald                 return true;
68647aa35f6aSMatthias Ringwald             case LE_AUDIO_BIG_STATE_SETUP_ISO_PATH:
68657aa35f6aSMatthias Ringwald                 big->state = LE_AUDIO_BIG_STATE_W4_SETUP_ISO_PATH;
686685dc435bSDirk 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);
68677aa35f6aSMatthias Ringwald                 return true;
68687aa35f6aSMatthias Ringwald             case LE_AUDIO_BIG_STATE_SETUP_ISO_PATHS_FAILED:
68697aa35f6aSMatthias Ringwald                 big->state = LE_AUDIO_BIG_STATE_W4_TERMINATED_AFTER_SETUP_FAILED;
68702a6c0f82SMatthias Ringwald                 hci_send_cmd(&hci_le_terminate_big, big->big_handle, big->state_vars.status);
6871c1f83111SMatthias Ringwald                 return true;
68727aa35f6aSMatthias Ringwald             case LE_AUDIO_BIG_STATE_TERMINATE:
68737aa35f6aSMatthias Ringwald                 big->state = LE_AUDIO_BIG_STATE_W4_TERMINATED;
68742a6c0f82SMatthias Ringwald                 hci_send_cmd(&hci_le_terminate_big, big->big_handle, ERROR_CODE_SUCCESS);
68757aa35f6aSMatthias Ringwald                 return true;
68767aa35f6aSMatthias Ringwald             default:
68777aa35f6aSMatthias Ringwald                 break;
68787aa35f6aSMatthias Ringwald         }
68797aa35f6aSMatthias Ringwald     }
68802a6c0f82SMatthias Ringwald 
68812a6c0f82SMatthias Ringwald     // BIG Sync
68822a6c0f82SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->le_audio_big_syncs);
68832a6c0f82SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
68842a6c0f82SMatthias Ringwald         le_audio_big_sync_t * big_sync = (le_audio_big_sync_t *) btstack_linked_list_iterator_next(&it);
68852a6c0f82SMatthias Ringwald         switch (big_sync->state){
68862a6c0f82SMatthias Ringwald             case LE_AUDIO_BIG_STATE_CREATE:
688740f86dfdSMatthias Ringwald                 hci_stack->iso_active_operation_group_id = big_sync->params->big_handle;
688840f86dfdSMatthias Ringwald                 hci_stack->iso_active_operation_type = HCI_ISO_TYPE_BIS;
68892a6c0f82SMatthias Ringwald                 big_sync->state = LE_AUDIO_BIG_STATE_W4_ESTABLISHED;
68902a6c0f82SMatthias Ringwald                 hci_send_cmd(&hci_le_big_create_sync,
68912a6c0f82SMatthias Ringwald                              big_sync->params->big_handle,
68922a6c0f82SMatthias Ringwald                              big_sync->params->sync_handle,
68932a6c0f82SMatthias Ringwald                              big_sync->params->encryption,
68942a6c0f82SMatthias Ringwald                              big_sync->params->broadcast_code,
68952a6c0f82SMatthias Ringwald                              big_sync->params->mse,
68962a6c0f82SMatthias Ringwald                              big_sync->params->big_sync_timeout_10ms,
68972a6c0f82SMatthias Ringwald                              big_sync->params->num_bis,
68982a6c0f82SMatthias Ringwald                              big_sync->params->bis_indices);
68992a6c0f82SMatthias Ringwald                 return true;
69002a6c0f82SMatthias Ringwald             case LE_AUDIO_BIG_STATE_SETUP_ISO_PATH:
69012a6c0f82SMatthias Ringwald                 big_sync->state = LE_AUDIO_BIG_STATE_W4_SETUP_ISO_PATH;
690285dc435bSDirk 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);
69032a6c0f82SMatthias Ringwald                 return true;
69042a6c0f82SMatthias Ringwald             case LE_AUDIO_BIG_STATE_SETUP_ISO_PATHS_FAILED:
69052a6c0f82SMatthias Ringwald                 big_sync->state = LE_AUDIO_BIG_STATE_W4_TERMINATED_AFTER_SETUP_FAILED;
69062a6c0f82SMatthias Ringwald                 hci_send_cmd(&hci_le_big_terminate_sync, big_sync->big_handle);
6907c1f83111SMatthias Ringwald                 return true;
69082a6c0f82SMatthias Ringwald             case LE_AUDIO_BIG_STATE_TERMINATE:
69092a6c0f82SMatthias Ringwald                 big_sync->state = LE_AUDIO_BIG_STATE_W4_TERMINATED;
69102a6c0f82SMatthias Ringwald                 hci_send_cmd(&hci_le_big_terminate_sync, big_sync->big_handle);
69112a6c0f82SMatthias Ringwald                 return true;
69122a6c0f82SMatthias Ringwald             default:
69132a6c0f82SMatthias Ringwald                 break;
69142a6c0f82SMatthias Ringwald         }
69152a6c0f82SMatthias Ringwald     }
69162a6c0f82SMatthias Ringwald 
6917d3a89d91SMatthias Ringwald     // CIG
6918d3a89d91SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->le_audio_cigs);
6919d3a89d91SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)) {
6920d3a89d91SMatthias Ringwald         le_audio_cig_t *cig = (le_audio_cig_t *) btstack_linked_list_iterator_next(&it);
6921d3a89d91SMatthias Ringwald         uint8_t i;
6922444e371eSMatthias Ringwald         // Set CIG Parameters
6923d3a89d91SMatthias Ringwald         uint8_t cis_id[MAX_NR_CIS];
6924d3a89d91SMatthias Ringwald         uint16_t max_sdu_c_to_p[MAX_NR_CIS];
6925d3a89d91SMatthias Ringwald         uint16_t max_sdu_p_to_c[MAX_NR_CIS];
6926d3a89d91SMatthias Ringwald         uint8_t phy_c_to_p[MAX_NR_CIS];
6927d3a89d91SMatthias Ringwald         uint8_t phy_p_to_c[MAX_NR_CIS];
6928d3a89d91SMatthias Ringwald         uint8_t rtn_c_to_p[MAX_NR_CIS];
6929d3a89d91SMatthias Ringwald         uint8_t rtn_p_to_c[MAX_NR_CIS];
6930d3a89d91SMatthias Ringwald         switch (cig->state) {
6931d3a89d91SMatthias Ringwald             case LE_AUDIO_CIG_STATE_CREATE:
6932d3a89d91SMatthias Ringwald                 hci_stack->iso_active_operation_group_id = cig->params->cig_id;
6933d3a89d91SMatthias Ringwald                 hci_stack->iso_active_operation_type = HCI_ISO_TYPE_CIS;
6934d3a89d91SMatthias Ringwald                 cig->state = LE_AUDIO_CIG_STATE_W4_ESTABLISHED;
6935d3a89d91SMatthias Ringwald                 le_audio_cig_params_t * params = cig->params;
6936d3a89d91SMatthias Ringwald                 for (i = 0; i < params->num_cis; i++) {
6937d3a89d91SMatthias Ringwald                     le_audio_cis_params_t * cis_params = &cig->params->cis_params[i];
6938d3a89d91SMatthias Ringwald                     cis_id[i]         = cis_params->cis_id;
6939d3a89d91SMatthias Ringwald                     max_sdu_c_to_p[i] = cis_params->max_sdu_c_to_p;
6940d3a89d91SMatthias Ringwald                     max_sdu_p_to_c[i] = cis_params->max_sdu_p_to_c;
6941d3a89d91SMatthias Ringwald                     phy_c_to_p[i]     = cis_params->phy_c_to_p;
6942d3a89d91SMatthias Ringwald                     phy_p_to_c[i]     = cis_params->phy_p_to_c;
6943d3a89d91SMatthias Ringwald                     rtn_c_to_p[i]     = cis_params->rtn_c_to_p;
6944d3a89d91SMatthias Ringwald                     rtn_p_to_c[i]     = cis_params->rtn_p_to_c;
6945d3a89d91SMatthias Ringwald                 }
6946d3a89d91SMatthias Ringwald                 hci_send_cmd(&hci_le_set_cig_parameters,
6947d3a89d91SMatthias Ringwald                              cig->cig_id,
6948d3a89d91SMatthias Ringwald                              params->sdu_interval_c_to_p,
6949d3a89d91SMatthias Ringwald                              params->sdu_interval_p_to_c,
6950d3a89d91SMatthias Ringwald                              params->worst_case_sca,
6951d3a89d91SMatthias Ringwald                              params->packing,
6952d3a89d91SMatthias Ringwald                              params->framing,
6953d3a89d91SMatthias Ringwald                              params->max_transport_latency_c_to_p,
6954d3a89d91SMatthias Ringwald                              params->max_transport_latency_p_to_c,
6955d3a89d91SMatthias Ringwald                              params->num_cis,
6956d3a89d91SMatthias Ringwald                              cis_id,
6957d3a89d91SMatthias Ringwald                              max_sdu_c_to_p,
6958d3a89d91SMatthias Ringwald                              max_sdu_p_to_c,
6959d3a89d91SMatthias Ringwald                              phy_c_to_p,
6960d3a89d91SMatthias Ringwald                              phy_p_to_c,
6961d3a89d91SMatthias Ringwald                              rtn_c_to_p,
6962d3a89d91SMatthias Ringwald                              rtn_p_to_c
6963d3a89d91SMatthias Ringwald                 );
6964bb42b5c0SMatthias Ringwald                 return true;
6965444e371eSMatthias Ringwald             case LE_AUDIO_CIG_STATE_CREATE_CIS:
6966bb42b5c0SMatthias Ringwald                 hci_stack->iso_active_operation_group_id = cig->params->cig_id;
6967bb42b5c0SMatthias Ringwald                 hci_stack->iso_active_operation_type = HCI_ISO_TYPE_CIS;
6968444e371eSMatthias Ringwald                 cig->state = LE_AUDIO_CIG_STATE_W4_CREATE_CIS;
69693abcd16cSMatthias Ringwald                 for (i=0;i<cig->num_cis;i++){
69703abcd16cSMatthias Ringwald                     cig->cis_setup_active[i] = true;
69713abcd16cSMatthias Ringwald                 }
6972444e371eSMatthias Ringwald                 hci_send_cmd(&hci_le_create_cis, cig->num_cis, cig->cis_con_handles, cig->acl_con_handles);
6973bb42b5c0SMatthias Ringwald                 return true;
6974f9306a1aSMatthias Ringwald             case LE_AUDIO_CIG_STATE_SETUP_ISO_PATH:
6975f9306a1aSMatthias Ringwald                 while (cig->state_vars.next_cis < (cig->num_cis * 2)){
6976f9306a1aSMatthias Ringwald                     // find next path to setup
6977f9306a1aSMatthias Ringwald                     uint8_t cis_index = cig->state_vars.next_cis >> 1;
6978f9306a1aSMatthias Ringwald                     if (cig->cis_established[cis_index] == false) {
6979f9306a1aSMatthias Ringwald                         continue;
6980f9306a1aSMatthias Ringwald                     }
6981f9306a1aSMatthias Ringwald                     uint8_t cis_direction = cig->state_vars.next_cis & 1;
6982f9306a1aSMatthias Ringwald                     bool setup = true;
69838e58e4f7SMatthias Ringwald                     if (cis_direction == 0){
6984f9306a1aSMatthias Ringwald                         // 0 - input - host to controller
6985f9306a1aSMatthias Ringwald                         // we are central => central to peripheral
6986f9306a1aSMatthias Ringwald                         setup &= cig->params->cis_params[cis_index].max_sdu_c_to_p > 0;
6987f9306a1aSMatthias Ringwald                     } else {
6988f9306a1aSMatthias Ringwald                         // 1 - output - controller to host
6989f9306a1aSMatthias Ringwald                         // we are central => peripheral to central
6990f9306a1aSMatthias Ringwald                         setup &= cig->params->cis_params[cis_index].max_sdu_p_to_c > 0;
6991f9306a1aSMatthias Ringwald                     }
6992f9306a1aSMatthias Ringwald                     if (setup){
6993f9306a1aSMatthias Ringwald                         hci_stack->iso_active_operation_group_id = cig->params->cig_id;
6994f9306a1aSMatthias Ringwald                         hci_stack->iso_active_operation_type = HCI_ISO_TYPE_CIS;
6995f9306a1aSMatthias Ringwald                         cig->state = LE_AUDIO_CIG_STATE_W4_SETUP_ISO_PATH;
699685dc435bSDirk 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);
6997f9306a1aSMatthias Ringwald                         return true;
6998f9306a1aSMatthias Ringwald                     }
69998e58e4f7SMatthias Ringwald                     cig->state_vars.next_cis++;
7000f9306a1aSMatthias Ringwald                 }
7001f9306a1aSMatthias Ringwald                 // emit done
7002f9306a1aSMatthias Ringwald                 cig->state = LE_AUDIO_CIG_STATE_ACTIVE;
7003d3a89d91SMatthias Ringwald             default:
7004d3a89d91SMatthias Ringwald                 break;
7005d3a89d91SMatthias Ringwald         }
7006d3a89d91SMatthias Ringwald     }
7007d3a89d91SMatthias Ringwald 
700826b93350SMatthias Ringwald     // CIS Accept/Reject
700926b93350SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->iso_streams);
701026b93350SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)) {
701126b93350SMatthias Ringwald         hci_iso_stream_t *iso_stream = (hci_iso_stream_t *) btstack_linked_list_iterator_next(&it);
701226b93350SMatthias Ringwald         hci_con_handle_t con_handle;
701326b93350SMatthias Ringwald         switch (iso_stream->state){
701426b93350SMatthias Ringwald             case HCI_ISO_STREAM_W2_ACCEPT:
701526b93350SMatthias Ringwald                 iso_stream->state = HCI_ISO_STREAM_STATE_W4_ESTABLISHED;
701626b93350SMatthias Ringwald                 hci_stack->iso_active_operation_type = HCI_ISO_TYPE_CIS;
701726b93350SMatthias Ringwald                 hci_stack->iso_active_operation_group_id = HCI_ISO_GROUP_ID_SINGLE_CIS;
7018969d876aSMatthias Ringwald                 hci_send_cmd(&hci_le_accept_cis_request, iso_stream->cis_handle);
701926b93350SMatthias Ringwald                 return true;
702026b93350SMatthias Ringwald             case HCI_ISO_STREAM_W2_REJECT:
7021969d876aSMatthias Ringwald                 con_handle = iso_stream->cis_handle;
702226b93350SMatthias Ringwald                 hci_stack->iso_active_operation_type = HCI_ISO_TYPE_CIS;
702326b93350SMatthias Ringwald                 hci_stack->iso_active_operation_group_id = HCI_ISO_GROUP_ID_SINGLE_CIS;
702426b93350SMatthias Ringwald                 hci_iso_stream_finalize(iso_stream);
702526b93350SMatthias Ringwald                 hci_send_cmd(&hci_le_reject_cis_request, con_handle, ERROR_CODE_REMOTE_DEVICE_TERMINATED_CONNECTION_DUE_TO_LOW_RESOURCES);
702626b93350SMatthias Ringwald                 return true;
702726b93350SMatthias Ringwald             case HCI_ISO_STREAM_STATE_W2_SETUP_ISO_INPUT:
702826b93350SMatthias Ringwald                 hci_stack->iso_active_operation_group_id = HCI_ISO_GROUP_ID_SINGLE_CIS;
702926b93350SMatthias Ringwald                 hci_stack->iso_active_operation_type = HCI_ISO_TYPE_CIS;
703026b93350SMatthias Ringwald                 iso_stream->state = HCI_ISO_STREAM_STATE_W4_ISO_SETUP_INPUT;
703185dc435bSDirk 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);
703226b93350SMatthias Ringwald                 break;
703326b93350SMatthias Ringwald             case HCI_ISO_STREAM_STATE_W2_SETUP_ISO_OUTPUT:
703426b93350SMatthias Ringwald                 hci_stack->iso_active_operation_group_id = HCI_ISO_GROUP_ID_SINGLE_CIS;
703526b93350SMatthias Ringwald                 hci_stack->iso_active_operation_type = HCI_ISO_TYPE_CIS;
703626b93350SMatthias Ringwald                 iso_stream->state = HCI_ISO_STREAM_STATE_W4_ISO_SETUP_OUTPUT;
703785dc435bSDirk 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);
703826b93350SMatthias Ringwald                 break;
703926b93350SMatthias Ringwald             default:
704026b93350SMatthias Ringwald                 break;
704126b93350SMatthias Ringwald         }
704226b93350SMatthias Ringwald     }
704326b93350SMatthias Ringwald 
70447aa35f6aSMatthias Ringwald     return false;
70457aa35f6aSMatthias Ringwald }
70467aa35f6aSMatthias Ringwald #endif /* ENABLE_LE_ISOCHRONOUS_STREAMS */
7047b2f949feS[email protected] #endif
70487bdc6798S[email protected] 
704988a03c8dSMatthias Ringwald static bool hci_run_general_pending_commands(void){
7050f30077b7SMatthias Ringwald     btstack_linked_item_t * it;
7051a0da043fSMatthias Ringwald     for (it = (btstack_linked_item_t *) hci_stack->connections; it != NULL; it = it->next){
705205ae8de3SMatthias Ringwald         hci_connection_t * connection = (hci_connection_t *) it;
705332ab9390Smatthias.ringwald 
70540bf6344aS[email protected]         switch(connection->state){
70550bf6344aS[email protected]             case SEND_CREATE_CONNECTION:
70564f3229d8S[email protected]                 switch(connection->address_type){
705735454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
7058f16129ceSMatthias Ringwald                     case BD_ADDR_TYPE_ACL:
70599da54300S[email protected]                         log_info("sending hci_create_connection");
7060b4eb4420SMatthias Ringwald                         hci_send_cmd(&hci_create_connection, connection->address, hci_usable_acl_packet_types(), 0, 0, 0, hci_stack->allow_role_switch);
70614f3229d8S[email protected]                         break;
706235454696SMatthias Ringwald #endif
70634f3229d8S[email protected]                     default:
7064a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE
7065d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
70669da54300S[email protected]                         log_info("sending hci_le_create_connection");
70676bcfa632SMatthias Ringwald                         hci_stack->le_connection_own_addr_type =  hci_stack->le_own_addr_type;
70686bcfa632SMatthias Ringwald                         hci_get_own_address_for_addr_type(hci_stack->le_connection_own_addr_type, hci_stack->le_connection_own_address);
7069f346015eSMatthias Ringwald                         hci_send_le_create_connection(0, connection->address_type, connection->address);
70704f3229d8S[email protected]                         connection->state = SENT_CREATE_CONNECTION;
7071b2f949feS[email protected] #endif
7072d70217a2SMatthias Ringwald #endif
70734f3229d8S[email protected]                         break;
70744f3229d8S[email protected]                 }
7075f30077b7SMatthias Ringwald                 return true;
7076ad83dc6aS[email protected] 
707735454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
70780bf6344aS[email protected]             case RECEIVED_CONNECTION_REQUEST:
7079f16129ceSMatthias Ringwald                 if (connection->address_type == BD_ADDR_TYPE_ACL){
708076ccfb2aSMatthias Ringwald                     log_info("sending hci_accept_connection_request");
7081895f6685SMilanka Ringwald                     connection->state = ACCEPTED_CONNECTION_REQUEST;
7082c4c88f1bSJakob Krantz                     hci_send_cmd(&hci_accept_connection_request, connection->address, hci_stack->master_slave_policy);
7083f30077b7SMatthias Ringwald                     return true;
7084ee025741SMatthias Ringwald                 }
7085ee025741SMatthias Ringwald                 break;
708635454696SMatthias Ringwald #endif
70870bf6344aS[email protected]             case SEND_DISCONNECT:
70880bf6344aS[email protected]                 connection->state = SENT_DISCONNECT;
70896ef3696aSMatthias Ringwald                 hci_send_cmd(&hci_disconnect, connection->con_handle, ERROR_CODE_REMOTE_USER_TERMINATED_CONNECTION);
7090f30077b7SMatthias Ringwald                 return true;
70910bf6344aS[email protected] 
70920bf6344aS[email protected]             default:
70930bf6344aS[email protected]                 break;
7094c7e0c5f6Smatthias.ringwald         }
7095c7e0c5f6Smatthias.ringwald 
7096cabf004eSMatthias Ringwald         // no further commands if connection is about to get shut down
7097cabf004eSMatthias Ringwald         if (connection->state == SENT_DISCONNECT) continue;
7098cabf004eSMatthias Ringwald 
709994418890SMatthias Ringwald #ifdef ENABLE_CLASSIC
710094418890SMatthias Ringwald 
7101ad20f0c8SMatthias Ringwald         // Handling link key request requires remote supported features
710250f49832SMatthias Ringwald         if (((connection->authentication_flags & AUTH_FLAG_HANDLE_LINK_KEY_REQUEST) != 0)){
7103608f51bbSMatthias Ringwald             log_info("responding to link key request, have link key db: %u", hci_stack->link_key_db != NULL);
71048daf94bcSMatthias Ringwald             connectionClearAuthenticationFlags(connection, AUTH_FLAG_HANDLE_LINK_KEY_REQUEST);
710530e72d78SMatthias Ringwald 
7106e9f98c4aSMatthias Ringwald             bool have_link_key = connection->link_key_type != INVALID_LINK_KEY;
7107e9f98c4aSMatthias Ringwald             bool security_level_sufficient = have_link_key && (gap_security_level_for_link_key_type(connection->link_key_type) >= connection->requested_security_level);
710830e72d78SMatthias Ringwald             if (have_link_key && security_level_sufficient){
7109e9f98c4aSMatthias Ringwald                 hci_send_cmd(&hci_link_key_request_reply, connection->address, &connection->link_key);
711032ab9390Smatthias.ringwald             } else {
711132ab9390Smatthias.ringwald                 hci_send_cmd(&hci_link_key_request_negative_reply, connection->address);
711232ab9390Smatthias.ringwald             }
7113f30077b7SMatthias Ringwald             return true;
711432ab9390Smatthias.ringwald         }
71151d6b20aeS[email protected] 
71168daf94bcSMatthias Ringwald         if (connection->authentication_flags & AUTH_FLAG_DENY_PIN_CODE_REQUEST){
71179da54300S[email protected]             log_info("denying to pin request");
71188daf94bcSMatthias Ringwald             connectionClearAuthenticationFlags(connection, AUTH_FLAG_DENY_PIN_CODE_REQUEST);
711934d2123cS[email protected]             hci_send_cmd(&hci_pin_code_request_negative_reply, connection->address);
7120f30077b7SMatthias Ringwald             return true;
71214c57c146S[email protected]         }
71224c57c146S[email protected] 
7123c950c316SMatthias Ringwald         // security assessment requires remote features
71242dd8985bSMatthias Ringwald         if ((connection->authentication_flags & AUTH_FLAG_RECV_IO_CAPABILITIES_REQUEST) != 0){
7125c950c316SMatthias Ringwald             connectionClearAuthenticationFlags(connection, AUTH_FLAG_RECV_IO_CAPABILITIES_REQUEST);
7126c950c316SMatthias Ringwald             hci_ssp_assess_security_on_io_cap_request(connection);
7127c950c316SMatthias 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
7128c950c316SMatthias Ringwald         }
7129c950c316SMatthias Ringwald 
71308daf94bcSMatthias Ringwald         if (connection->authentication_flags & AUTH_FLAG_SEND_IO_CAPABILITIES_REPLY){
71318daf94bcSMatthias Ringwald             connectionClearAuthenticationFlags(connection, AUTH_FLAG_SEND_IO_CAPABILITIES_REPLY);
7132a8d20135SMatthias Ringwald             // set authentication requirements:
7133a8d20135SMatthias Ringwald             // - MITM = ssp_authentication_requirement (USER) | requested_security_level (dynamic)
7134532454f9SMatthias Ringwald             // - BONDING MODE: dedicated if requested, bondable otherwise. Drop bondable if not set for remote
7135a8d20135SMatthias Ringwald             uint8_t authreq = hci_stack->ssp_authentication_requirement & 1;
71369faad3abS[email protected]             if (gap_mitm_protection_required_for_security_level(connection->requested_security_level)){
71379faad3abS[email protected]                 authreq |= 1;
7138106d6d11S[email protected]             }
7139532454f9SMatthias Ringwald             bool bonding = hci_stack->bondable;
71408daf94bcSMatthias Ringwald             if (connection->authentication_flags & AUTH_FLAG_RECV_IO_CAPABILITIES_RESPONSE){
7141532454f9SMatthias Ringwald                 // if we have received IO Cap Response, we're in responder role
7142532454f9SMatthias Ringwald                 bool remote_bonding = connection->io_cap_response_auth_req >= SSP_IO_AUTHREQ_MITM_PROTECTION_NOT_REQUIRED_DEDICATED_BONDING;
7143532454f9SMatthias Ringwald                 if (bonding && !remote_bonding){
7144532454f9SMatthias Ringwald                     log_info("Remote not bonding, dropping local flag");
7145532454f9SMatthias Ringwald                     bonding = false;
7146532454f9SMatthias Ringwald                 }
7147532454f9SMatthias Ringwald             }
7148532454f9SMatthias Ringwald             if (bonding){
7149a8d20135SMatthias Ringwald                 if (connection->bonding_flags & BONDING_DEDICATED){
7150a8d20135SMatthias Ringwald                     authreq |= SSP_IO_AUTHREQ_MITM_PROTECTION_NOT_REQUIRED_DEDICATED_BONDING;
7151532454f9SMatthias Ringwald                 } else {
7152a8d20135SMatthias Ringwald                     authreq |= SSP_IO_AUTHREQ_MITM_PROTECTION_NOT_REQUIRED_GENERAL_BONDING;
7153a8d20135SMatthias Ringwald                 }
7154532454f9SMatthias Ringwald             }
71551849becdSMatthias Ringwald             uint8_t have_oob_data = 0;
71561849becdSMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB
71571849becdSMatthias Ringwald             if (connection->classic_oob_c_192 != NULL){
71581849becdSMatthias Ringwald                     have_oob_data |= 1;
71591849becdSMatthias Ringwald             }
71601849becdSMatthias Ringwald             if (connection->classic_oob_c_256 != NULL){
71611849becdSMatthias Ringwald                 have_oob_data |= 2;
71621849becdSMatthias Ringwald             }
71631849becdSMatthias Ringwald #endif
71641849becdSMatthias Ringwald             hci_send_cmd(&hci_io_capability_request_reply, &connection->address, hci_stack->ssp_io_capability, have_oob_data, authreq);
716511b03efaSMatthias Ringwald             return true;
7166f8fb5f6eS[email protected]         }
716711b03efaSMatthias Ringwald 
71688daf94bcSMatthias Ringwald         if (connection->authentication_flags & AUTH_FLAG_SEND_IO_CAPABILITIES_NEGATIVE_REPLY) {
71698daf94bcSMatthias Ringwald             connectionClearAuthenticationFlags(connection, AUTH_FLAG_SEND_IO_CAPABILITIES_NEGATIVE_REPLY);
717011b03efaSMatthias Ringwald             hci_send_cmd(&hci_io_capability_request_negative_reply, &connection->address, ERROR_CODE_PAIRING_NOT_ALLOWED);
7171f30077b7SMatthias Ringwald             return true;
717232ab9390Smatthias.ringwald         }
717332ab9390Smatthias.ringwald 
71741849becdSMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB
71757ca4a7edSMatthias Ringwald         if (connection->authentication_flags & AUTH_FLAG_SEND_REMOTE_OOB_DATA_REPLY){
71767ca4a7edSMatthias Ringwald             connectionClearAuthenticationFlags(connection, AUTH_FLAG_SEND_REMOTE_OOB_DATA_REPLY);
71771849becdSMatthias Ringwald             const uint8_t zero[16] = { 0 };
71781849becdSMatthias Ringwald             const uint8_t * r_192 = zero;
71791849becdSMatthias Ringwald             const uint8_t * c_192 = zero;
71801849becdSMatthias Ringwald             const uint8_t * r_256 = zero;
71811849becdSMatthias Ringwald             const uint8_t * c_256 = zero;
71821849becdSMatthias Ringwald             // verify P-256 OOB
71831e83575aSMatthias Ringwald             if ((connection->classic_oob_c_256 != NULL) && hci_command_supported(SUPPORTED_HCI_COMMAND_REMOTE_OOB_EXTENDED_DATA_REQUEST_REPLY)) {
71841849becdSMatthias Ringwald                 c_256 = connection->classic_oob_c_256;
71851849becdSMatthias Ringwald                 if (connection->classic_oob_r_256 != NULL) {
71861849becdSMatthias Ringwald                     r_256 = connection->classic_oob_r_256;
71871849becdSMatthias Ringwald                 }
71881849becdSMatthias Ringwald             }
71891849becdSMatthias Ringwald             // verify P-192 OOB
71901849becdSMatthias Ringwald             if ((connection->classic_oob_c_192 != NULL)) {
71911849becdSMatthias Ringwald                 c_192 = connection->classic_oob_c_192;
71921849becdSMatthias Ringwald                 if (connection->classic_oob_r_192 != NULL) {
71931849becdSMatthias Ringwald                     r_192 = connection->classic_oob_r_192;
71941849becdSMatthias Ringwald                 }
71951849becdSMatthias Ringwald             }
71967ca4a7edSMatthias Ringwald 
71977ca4a7edSMatthias Ringwald             // assess security
71987ca4a7edSMatthias Ringwald             bool need_level_4 = hci_stack->gap_secure_connections_only_mode || (connection->requested_security_level == LEVEL_4);
71997ca4a7edSMatthias Ringwald             bool can_reach_level_4 = hci_remote_sc_enabled(connection) && (c_256 != NULL);
72007ca4a7edSMatthias Ringwald             if (need_level_4 && !can_reach_level_4){
72017ca4a7edSMatthias Ringwald                 log_info("Level 4 required, but not possible -> abort");
72027ca4a7edSMatthias Ringwald                 hci_pairing_complete(connection, ERROR_CODE_INSUFFICIENT_SECURITY);
72037ca4a7edSMatthias Ringwald                 // send oob negative reply
72047ca4a7edSMatthias Ringwald                 c_256 = NULL;
72057ca4a7edSMatthias Ringwald                 c_192 = NULL;
72067ca4a7edSMatthias Ringwald             }
72077ca4a7edSMatthias Ringwald 
72081849becdSMatthias Ringwald             // Reply
72091849becdSMatthias Ringwald             if (c_256 != zero) {
72101849becdSMatthias Ringwald                 hci_send_cmd(&hci_remote_oob_extended_data_request_reply, &connection->address, c_192, r_192, c_256, r_256);
72111849becdSMatthias Ringwald             } else if (c_192 != zero){
72121849becdSMatthias Ringwald                 hci_send_cmd(&hci_remote_oob_data_request_reply, &connection->address, c_192, r_192);
72131849becdSMatthias Ringwald             } else {
72141ae74bf3SMatthias Ringwald                 hci_stack->classic_oob_con_handle = connection->con_handle;
72151849becdSMatthias Ringwald                 hci_send_cmd(&hci_remote_oob_data_request_negative_reply, &connection->address);
72161849becdSMatthias Ringwald             }
72171849becdSMatthias Ringwald             return true;
72181849becdSMatthias Ringwald         }
72191849becdSMatthias Ringwald #endif
72201849becdSMatthias Ringwald 
72218daf94bcSMatthias Ringwald         if (connection->authentication_flags & AUTH_FLAG_SEND_USER_CONFIRM_REPLY){
72228daf94bcSMatthias Ringwald             connectionClearAuthenticationFlags(connection, AUTH_FLAG_SEND_USER_CONFIRM_REPLY);
722334d2123cS[email protected]             hci_send_cmd(&hci_user_confirmation_request_reply, &connection->address);
7224f30077b7SMatthias Ringwald             return true;
7225dbe1a790S[email protected]         }
7226dbe1a790S[email protected] 
7227367aedc0SMatthias Ringwald         if (connection->authentication_flags & AUTH_FLAG_SEND_USER_CONFIRM_NEGATIVE_REPLY){
7228367aedc0SMatthias Ringwald             connectionClearAuthenticationFlags(connection, AUTH_FLAG_SEND_USER_CONFIRM_NEGATIVE_REPLY);
7229367aedc0SMatthias Ringwald             hci_send_cmd(&hci_user_confirmation_request_negative_reply, &connection->address);
7230367aedc0SMatthias Ringwald             return true;
7231367aedc0SMatthias Ringwald         }
7232367aedc0SMatthias Ringwald 
72338daf94bcSMatthias Ringwald         if (connection->authentication_flags & AUTH_FLAG_SEND_USER_PASSKEY_REPLY){
72348daf94bcSMatthias Ringwald             connectionClearAuthenticationFlags(connection, AUTH_FLAG_SEND_USER_PASSKEY_REPLY);
723534d2123cS[email protected]             hci_send_cmd(&hci_user_passkey_request_reply, &connection->address, 000000);
7236f30077b7SMatthias Ringwald             return true;
7237dbe1a790S[email protected]         }
7238afd4e962S[email protected] 
7239ab0c69a9SMatthias Ringwald         if ((connection->bonding_flags & (BONDING_DISCONNECT_DEDICATED_DONE | BONDING_DEDICATED_DEFER_DISCONNECT)) == BONDING_DISCONNECT_DEDICATED_DONE){
7240ad83dc6aS[email protected]             connection->bonding_flags &= ~BONDING_DISCONNECT_DEDICATED_DONE;
72411bd5283dS[email protected]             connection->bonding_flags |= BONDING_EMIT_COMPLETE_ON_DISCONNECT;
72426ef3696aSMatthias Ringwald             connection->state = SENT_DISCONNECT;
72436ef3696aSMatthias Ringwald             hci_send_cmd(&hci_disconnect, connection->con_handle, ERROR_CODE_REMOTE_USER_TERMINATED_CONNECTION);
7244f30077b7SMatthias Ringwald             return true;
7245ad83dc6aS[email protected]         }
724676f27cffSMatthias Ringwald 
72472a75353aSMatthias Ringwald         if ((connection->bonding_flags & BONDING_SEND_AUTHENTICATE_REQUEST) && ((connection->bonding_flags & BONDING_RECEIVED_REMOTE_FEATURES) != 0)){
724834d2123cS[email protected]             connection->bonding_flags &= ~BONDING_SEND_AUTHENTICATE_REQUEST;
7249abdad579SMatthias Ringwald             connection->bonding_flags |= BONDING_SENT_AUTHENTICATE_REQUEST;
725034d2123cS[email protected]             hci_send_cmd(&hci_authentication_requested, connection->con_handle);
7251f30077b7SMatthias Ringwald             return true;
7252afd4e962S[email protected]         }
725376f27cffSMatthias Ringwald 
7254dce78009S[email protected]         if (connection->bonding_flags & BONDING_SEND_ENCRYPTION_REQUEST){
7255dce78009S[email protected]             connection->bonding_flags &= ~BONDING_SEND_ENCRYPTION_REQUEST;
7256dce78009S[email protected]             hci_send_cmd(&hci_set_connection_encryption, connection->con_handle, 1);
7257f30077b7SMatthias Ringwald             return true;
7258dce78009S[email protected]         }
7259447016ffSMatthias Ringwald 
7260573897a0SMatthias Ringwald         if (connection->bonding_flags & BONDING_SEND_READ_ENCRYPTION_KEY_SIZE){
7261573897a0SMatthias Ringwald             connection->bonding_flags &= ~BONDING_SEND_READ_ENCRYPTION_KEY_SIZE;
7262573897a0SMatthias Ringwald             hci_send_cmd(&hci_read_encryption_key_size, connection->con_handle, 1);
7263f30077b7SMatthias Ringwald             return true;
7264573897a0SMatthias Ringwald         }
7265447016ffSMatthias Ringwald 
7266447016ffSMatthias Ringwald         if (connection->bonding_flags & BONDING_REQUEST_REMOTE_FEATURES_PAGE_0){
7267447016ffSMatthias Ringwald             connection->bonding_flags &= ~BONDING_REQUEST_REMOTE_FEATURES_PAGE_0;
7268447016ffSMatthias Ringwald             hci_send_cmd(&hci_read_remote_supported_features_command, connection->con_handle);
7269447016ffSMatthias Ringwald             return true;
7270447016ffSMatthias Ringwald         }
7271447016ffSMatthias Ringwald 
7272447016ffSMatthias Ringwald         if (connection->bonding_flags & BONDING_REQUEST_REMOTE_FEATURES_PAGE_1){
7273447016ffSMatthias Ringwald             connection->bonding_flags &= ~BONDING_REQUEST_REMOTE_FEATURES_PAGE_1;
7274447016ffSMatthias Ringwald             hci_send_cmd(&hci_read_remote_extended_features_command, connection->con_handle, 1);
7275447016ffSMatthias Ringwald             return true;
7276447016ffSMatthias Ringwald         }
7277447016ffSMatthias Ringwald 
7278447016ffSMatthias Ringwald         if (connection->bonding_flags & BONDING_REQUEST_REMOTE_FEATURES_PAGE_2){
7279447016ffSMatthias Ringwald             connection->bonding_flags &= ~BONDING_REQUEST_REMOTE_FEATURES_PAGE_2;
7280447016ffSMatthias Ringwald             hci_send_cmd(&hci_read_remote_extended_features_command, connection->con_handle, 2);
7281447016ffSMatthias Ringwald             return true;
7282447016ffSMatthias Ringwald         }
728376f27cffSMatthias Ringwald #endif
728476f27cffSMatthias Ringwald 
728576f27cffSMatthias Ringwald         if (connection->bonding_flags & BONDING_DISCONNECT_SECURITY_BLOCK){
728676f27cffSMatthias Ringwald             connection->bonding_flags &= ~BONDING_DISCONNECT_SECURITY_BLOCK;
72871714cbbdSMatthias Ringwald #ifdef ENABLE_CLASSIC
72881714cbbdSMatthias Ringwald             hci_pairing_complete(connection, ERROR_CODE_CONNECTION_REJECTED_DUE_TO_SECURITY_REASONS);
72891714cbbdSMatthias Ringwald #endif
72906ef3696aSMatthias Ringwald             if (connection->state != SENT_DISCONNECT){
72916ef3696aSMatthias Ringwald                 connection->state = SENT_DISCONNECT;
72926ef3696aSMatthias Ringwald                 hci_send_cmd(&hci_disconnect, connection->con_handle, ERROR_CODE_AUTHENTICATION_FAILURE);
7293f30077b7SMatthias Ringwald                 return true;
729476f27cffSMatthias Ringwald             }
72956ef3696aSMatthias Ringwald         }
7296da886c03S[email protected] 
72976cdc2862SMatthias Ringwald #ifdef ENABLE_CLASSIC
7298f8ee3071SMatthias Ringwald         uint16_t sniff_min_interval;
7299f8ee3071SMatthias Ringwald         switch (connection->sniff_min_interval){
7300f8ee3071SMatthias Ringwald             case 0:
7301f8ee3071SMatthias Ringwald                 break;
7302f8ee3071SMatthias Ringwald             case 0xffff:
7303f8ee3071SMatthias Ringwald                 connection->sniff_min_interval = 0;
7304f8ee3071SMatthias Ringwald                 hci_send_cmd(&hci_exit_sniff_mode, connection->con_handle);
7305f30077b7SMatthias Ringwald                 return true;
7306f8ee3071SMatthias Ringwald             default:
7307f8ee3071SMatthias Ringwald                 sniff_min_interval = connection->sniff_min_interval;
7308f8ee3071SMatthias Ringwald                 connection->sniff_min_interval = 0;
7309f8ee3071SMatthias Ringwald                 hci_send_cmd(&hci_sniff_mode, connection->con_handle, connection->sniff_max_interval, sniff_min_interval, connection->sniff_attempt, connection->sniff_timeout);
7310f30077b7SMatthias Ringwald                 return true;
7311f8ee3071SMatthias Ringwald         }
731288a03c8dSMatthias Ringwald 
7313140c0557SMatthias Ringwald         if (connection->sniff_subrating_max_latency != 0xffff){
7314140c0557SMatthias Ringwald             uint16_t max_latency = connection->sniff_subrating_max_latency;
7315140c0557SMatthias Ringwald             connection->sniff_subrating_max_latency = 0;
7316140c0557SMatthias Ringwald             hci_send_cmd(&hci_sniff_subrating, connection->con_handle, max_latency, connection->sniff_subrating_min_remote_timeout, connection->sniff_subrating_min_local_timeout);
7317140c0557SMatthias Ringwald             return true;
7318140c0557SMatthias Ringwald         }
7319140c0557SMatthias Ringwald 
7320965a4ccfSMatthias Ringwald         if (connection->qos_service_type != HCI_SERVICE_TYPE_INVALID){
7321278ff8a9SMatthias Ringwald             uint8_t service_type = (uint8_t) connection->qos_service_type;
7322965a4ccfSMatthias Ringwald             connection->qos_service_type = HCI_SERVICE_TYPE_INVALID;
7323278ff8a9SMatthias 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);
7324278ff8a9SMatthias Ringwald             return true;
7325278ff8a9SMatthias Ringwald         }
7326278ff8a9SMatthias Ringwald 
732788a03c8dSMatthias Ringwald         if (connection->request_role != HCI_ROLE_INVALID){
732888a03c8dSMatthias Ringwald             hci_role_t role = connection->request_role;
732988a03c8dSMatthias Ringwald             connection->request_role = HCI_ROLE_INVALID;
733088a03c8dSMatthias Ringwald             hci_send_cmd(&hci_switch_role_command, connection->address, role);
733188a03c8dSMatthias Ringwald             return true;
733288a03c8dSMatthias Ringwald         }
733322df2fe2SMatthias Ringwald #endif
73349afaa4d4SMatthias Ringwald 
73359afaa4d4SMatthias Ringwald         if (connection->gap_connection_tasks != 0){
733622df2fe2SMatthias Ringwald #ifdef ENABLE_CLASSIC
73379afaa4d4SMatthias Ringwald             if ((connection->gap_connection_tasks & GAP_CONNECTION_TASK_WRITE_AUTOMATIC_FLUSH_TIMEOUT) != 0){
73389afaa4d4SMatthias Ringwald                 connection->gap_connection_tasks &= ~GAP_CONNECTION_TASK_WRITE_AUTOMATIC_FLUSH_TIMEOUT;
73399afaa4d4SMatthias Ringwald                 hci_send_cmd(&hci_write_automatic_flush_timeout, connection->con_handle, hci_stack->automatic_flush_timeout);
73409afaa4d4SMatthias Ringwald                 return true;
73419afaa4d4SMatthias Ringwald             }
734222df2fe2SMatthias Ringwald             if (connection->gap_connection_tasks & GAP_CONNECTION_TASK_WRITE_SUPERVISION_TIMEOUT){
734322df2fe2SMatthias Ringwald                 connection->gap_connection_tasks &= ~GAP_CONNECTION_TASK_WRITE_SUPERVISION_TIMEOUT;
734422df2fe2SMatthias Ringwald                 hci_send_cmd(&hci_write_link_supervision_timeout, connection->con_handle, hci_stack->link_supervision_timeout);
734522df2fe2SMatthias Ringwald                 return true;
73469afaa4d4SMatthias Ringwald             }
73476cdc2862SMatthias Ringwald #endif
734822df2fe2SMatthias Ringwald             if (connection->gap_connection_tasks & GAP_CONNECTION_TASK_READ_RSSI){
734922df2fe2SMatthias Ringwald                 connection->gap_connection_tasks &= ~GAP_CONNECTION_TASK_READ_RSSI;
735022df2fe2SMatthias Ringwald                 hci_send_cmd(&hci_read_rssi, connection->con_handle);
735122df2fe2SMatthias Ringwald                 return true;
735222df2fe2SMatthias Ringwald             }
7353ac0f6b83SMatthias Ringwald #ifdef ENABLE_BLE
7354ac0f6b83SMatthias Ringwald             if (connection->gap_connection_tasks & GAP_CONNECTION_TASK_LE_READ_REMOTE_FEATURES){
7355ac0f6b83SMatthias Ringwald                 connection->gap_connection_tasks &= ~GAP_CONNECTION_TASK_LE_READ_REMOTE_FEATURES;
7356ac0f6b83SMatthias Ringwald                 hci_send_cmd(&hci_le_read_remote_used_features, connection->con_handle);
7357ac0f6b83SMatthias Ringwald                 return true;
7358ac0f6b83SMatthias Ringwald             }
7359ac0f6b83SMatthias Ringwald #endif
736022df2fe2SMatthias Ringwald         }
7361f8ee3071SMatthias Ringwald 
7362a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE
736373cd8a2aSMatthias Ringwald         switch (connection->le_con_parameter_update_state){
736473cd8a2aSMatthias Ringwald             // response to L2CAP CON PARAMETER UPDATE REQUEST
736573cd8a2aSMatthias Ringwald             case CON_PARAMETER_UPDATE_CHANGE_HCI_CON_PARAMETERS:
7366da886c03S[email protected]                 connection->le_con_parameter_update_state = CON_PARAMETER_UPDATE_NONE;
736773cd8a2aSMatthias Ringwald                 hci_send_cmd(&hci_le_connection_update, connection->con_handle, connection->le_conn_interval_min,
7368c37a3166S[email protected]                              connection->le_conn_interval_max, connection->le_conn_latency, connection->le_supervision_timeout,
7369d4876126SMatthias Ringwald                              hci_stack->le_minimum_ce_length, hci_stack->le_maximum_ce_length);
7370f30077b7SMatthias Ringwald                 return true;
737173cd8a2aSMatthias Ringwald             case CON_PARAMETER_UPDATE_REPLY:
737273cd8a2aSMatthias Ringwald                 connection->le_con_parameter_update_state = CON_PARAMETER_UPDATE_NONE;
737373cd8a2aSMatthias Ringwald                 hci_send_cmd(&hci_le_remote_connection_parameter_request_reply, connection->con_handle, connection->le_conn_interval_min,
737473cd8a2aSMatthias Ringwald                              connection->le_conn_interval_max, connection->le_conn_latency, connection->le_supervision_timeout,
7375d4876126SMatthias Ringwald                              hci_stack->le_minimum_ce_length, hci_stack->le_maximum_ce_length);
7376f30077b7SMatthias Ringwald                 return true;
737773cd8a2aSMatthias Ringwald             case CON_PARAMETER_UPDATE_NEGATIVE_REPLY:
737873cd8a2aSMatthias Ringwald                 connection->le_con_parameter_update_state = CON_PARAMETER_UPDATE_NONE;
73791e0338ebSMatthias Ringwald                 hci_send_cmd(&hci_le_remote_connection_parameter_request_negative_reply, connection->con_handle,
73801e0338ebSMatthias Ringwald                              ERROR_CODE_UNACCEPTABLE_CONNECTION_PARAMETERS);
7381f30077b7SMatthias Ringwald                 return true;
738273cd8a2aSMatthias Ringwald             default:
738373cd8a2aSMatthias Ringwald                 break;
7384c37a3166S[email protected]         }
73854ea43905SMatthias Ringwald         if (connection->le_phy_update_all_phys != 0xffu){
7386b90f6e0aSMatthias Ringwald             uint8_t all_phys = connection->le_phy_update_all_phys;
7387b90f6e0aSMatthias Ringwald             connection->le_phy_update_all_phys = 0xff;
7388b90f6e0aSMatthias 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);
7389f30077b7SMatthias Ringwald             return true;
7390b90f6e0aSMatthias Ringwald         }
73913bd96807SMatthias Ringwald #ifdef ENABLE_LE_PERIODIC_ADVERTISING
73923bd96807SMatthias Ringwald         if (connection->le_past_sync_handle != HCI_CON_HANDLE_INVALID){
73933bd96807SMatthias Ringwald             hci_con_handle_t sync_handle = connection->le_past_sync_handle;
73943bd96807SMatthias Ringwald             connection->le_past_sync_handle = HCI_CON_HANDLE_INVALID;
73953bd96807SMatthias Ringwald             hci_send_cmd(&hci_le_periodic_advertising_sync_transfer, connection->con_handle, connection->le_past_service_data, sync_handle);
73963bd96807SMatthias Ringwald             return true;
73973bd96807SMatthias Ringwald         }
7398027f4677SMatthias Ringwald         if (connection->le_past_advertising_handle != 0xff){
7399027f4677SMatthias Ringwald             uint8_t advertising_handle = connection->le_past_advertising_handle;
7400027f4677SMatthias Ringwald             connection->le_past_advertising_handle = 0xff;
7401027f4677SMatthias Ringwald             hci_send_cmd(&hci_le_periodic_advertising_set_info_transfer, connection->con_handle, connection->le_past_service_data, advertising_handle);
7402027f4677SMatthias Ringwald             return true;
7403027f4677SMatthias Ringwald         }
74043bd96807SMatthias Ringwald #endif
7405c37a3166S[email protected] #endif
7406dbe1a790S[email protected]     }
7407f30077b7SMatthias Ringwald     return false;
7408f30077b7SMatthias Ringwald }
7409c7e0c5f6Smatthias.ringwald 
7410f30077b7SMatthias Ringwald static void hci_run(void){
7411f30077b7SMatthias Ringwald 
7412df9e2780SMatthias Ringwald     // stack state sub statemachines
7413df9e2780SMatthias Ringwald     switch (hci_stack->state) {
7414df9e2780SMatthias Ringwald         case HCI_STATE_INITIALIZING:
7415df9e2780SMatthias Ringwald             hci_initializing_run();
7416d0dea5fbSMatthias Ringwald             break;
7417df9e2780SMatthias Ringwald         case HCI_STATE_HALTING:
7418df9e2780SMatthias Ringwald             hci_halting_run();
7419d0dea5fbSMatthias Ringwald             break;
7420df9e2780SMatthias Ringwald         case HCI_STATE_FALLING_ASLEEP:
7421df9e2780SMatthias Ringwald             hci_falling_asleep_run();
7422d0dea5fbSMatthias Ringwald             break;
7423df9e2780SMatthias Ringwald         default:
7424df9e2780SMatthias Ringwald             break;
7425df9e2780SMatthias Ringwald     }
7426df9e2780SMatthias Ringwald 
7427d0dea5fbSMatthias Ringwald     // allow to run after initialization to working transition
7428d0dea5fbSMatthias Ringwald     if (hci_stack->state != HCI_STATE_WORKING){
7429d0dea5fbSMatthias Ringwald         return;
7430d0dea5fbSMatthias Ringwald     }
7431d0dea5fbSMatthias Ringwald 
7432f30077b7SMatthias Ringwald     bool done;
7433f30077b7SMatthias Ringwald 
7434f30077b7SMatthias Ringwald     // send continuation fragments first, as they block the prepared packet buffer
7435f30077b7SMatthias Ringwald     done = hci_run_acl_fragments();
7436f30077b7SMatthias Ringwald     if (done) return;
7437f30077b7SMatthias Ringwald 
743868ab6207SMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
743968ab6207SMatthias Ringwald     done = hci_run_iso_fragments();
744068ab6207SMatthias Ringwald     if (done) return;
744168ab6207SMatthias Ringwald #endif
744268ab6207SMatthias Ringwald 
7443f30077b7SMatthias Ringwald #ifdef ENABLE_HCI_CONTROLLER_TO_HOST_FLOW_CONTROL
7444f30077b7SMatthias Ringwald     // send host num completed packets next as they don't require num_cmd_packets > 0
7445f30077b7SMatthias Ringwald     if (!hci_can_send_comand_packet_transport()) return;
7446f30077b7SMatthias Ringwald     if (hci_stack->host_completed_packets){
7447f30077b7SMatthias Ringwald         hci_host_num_completed_packets();
7448f30077b7SMatthias Ringwald         return;
7449f30077b7SMatthias Ringwald     }
7450f30077b7SMatthias Ringwald #endif
7451f30077b7SMatthias Ringwald 
7452f30077b7SMatthias Ringwald     if (!hci_can_send_command_packet_now()) return;
7453f30077b7SMatthias Ringwald 
7454f30077b7SMatthias Ringwald     // global/non-connection oriented commands
7455f30077b7SMatthias Ringwald 
7456f30077b7SMatthias Ringwald 
7457f30077b7SMatthias Ringwald #ifdef ENABLE_CLASSIC
7458f30077b7SMatthias Ringwald     // general gap classic
7459f30077b7SMatthias Ringwald     done = hci_run_general_gap_classic();
7460f30077b7SMatthias Ringwald     if (done) return;
7461f30077b7SMatthias Ringwald #endif
7462f30077b7SMatthias Ringwald 
7463f30077b7SMatthias Ringwald #ifdef ENABLE_BLE
7464f30077b7SMatthias Ringwald     // general gap le
7465f30077b7SMatthias Ringwald     done = hci_run_general_gap_le();
7466f30077b7SMatthias Ringwald     if (done) return;
74677aa35f6aSMatthias Ringwald 
74687aa35f6aSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
74697aa35f6aSMatthias Ringwald     // ISO related tasks, e.g. BIG create/terminate/sync
74707aa35f6aSMatthias Ringwald     done = hci_run_iso_tasks();
74717aa35f6aSMatthias Ringwald     if (done) return;
74727aa35f6aSMatthias Ringwald #endif
7473f30077b7SMatthias Ringwald #endif
7474f30077b7SMatthias Ringwald 
7475f30077b7SMatthias Ringwald     // send pending HCI commands
7476df9e2780SMatthias Ringwald     hci_run_general_pending_commands();
74773429f56bSmatthias.ringwald }
747816833f0aSmatthias.ringwald 
74790f076adeSMatthias Ringwald #ifdef ENABLE_CLASSIC
7480d7891039SMatthias Ringwald static void hci_set_sco_payload_length_for_flipped_packet_types(hci_connection_t * hci_connection, uint16_t flipped_packet_types){
7481d7891039SMatthias Ringwald     // bits 6-9 are 'don't use'
7482d7891039SMatthias Ringwald     uint16_t packet_types = flipped_packet_types ^ 0x03c0;
7483d7891039SMatthias Ringwald 
7484d7891039SMatthias Ringwald     // restrict packet types to local and remote supported
7485d7891039SMatthias Ringwald     packet_types &= hci_connection->remote_supported_sco_packets & hci_stack->usable_packet_types_sco;
7486d7891039SMatthias Ringwald     hci_connection->sco_payload_length = hci_sco_payload_length_for_packet_types(packet_types);
7487d7891039SMatthias Ringwald     log_info("Possible SCO packet types 0x%04x => payload length %u", packet_types, hci_connection->sco_payload_length);
7488d7891039SMatthias Ringwald }
74890f076adeSMatthias Ringwald #endif
7490d7891039SMatthias Ringwald 
74913e2050f7SMatthias Ringwald uint8_t hci_send_cmd_packet(uint8_t *packet, int size){
749235454696SMatthias Ringwald     // house-keeping
749335454696SMatthias Ringwald 
749435454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
7495c8e4258aSmatthias.ringwald     bd_addr_t addr;
7496c8e4258aSmatthias.ringwald     hci_connection_t * conn;
7497c123d999SMatthias Ringwald #endif
7498c123d999SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
74996f35bb46SMatthias Ringwald     uint8_t initiator_filter_policy;
75009cbd2215SMatthias Ringwald #endif
7501c8e4258aSmatthias.ringwald 
75026f35bb46SMatthias Ringwald     uint16_t opcode = little_endian_read_16(packet, 0);
75036f35bb46SMatthias Ringwald     switch (opcode) {
75049cbd2215SMatthias Ringwald         case HCI_OPCODE_HCI_WRITE_LOOPBACK_MODE:
75059cbd2215SMatthias Ringwald             hci_stack->loopback_mode = packet[3];
75069cbd2215SMatthias Ringwald             break;
75079cbd2215SMatthias Ringwald 
75089cbd2215SMatthias Ringwald #ifdef ENABLE_CLASSIC
75096f35bb46SMatthias Ringwald         case HCI_OPCODE_HCI_CREATE_CONNECTION:
7510724d70a2SMatthias Ringwald             reverse_bd_addr(&packet[3], addr);
75119da54300S[email protected]             log_info("Create_connection to %s", bd_addr_to_str(addr));
7512c8e4258aSmatthias.ringwald 
751372cf8859SMatthias Ringwald             // CVE-2020-26555: reject outgoing connection to device with same BD ADDR
751472cf8859SMatthias Ringwald             if (memcmp(hci_stack->local_bd_addr, addr, 6) == 0) {
751579e0fa07SMatthias Ringwald                 hci_emit_connection_complete(addr, 0, ERROR_CODE_CONNECTION_REJECTED_DUE_TO_UNACCEPTABLE_BD_ADDR);
75163e2050f7SMatthias Ringwald                 return ERROR_CODE_CONNECTION_REJECTED_DUE_TO_UNACCEPTABLE_BD_ADDR;
751772cf8859SMatthias Ringwald             }
751872cf8859SMatthias Ringwald 
7519f16129ceSMatthias Ringwald             conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL);
7520ad83dc6aS[email protected]             if (!conn) {
752188f925b1SMatthias Ringwald                 conn = create_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL, HCI_ROLE_MASTER);
752217f1ba2aSmatthias.ringwald                 if (!conn) {
752317f1ba2aSmatthias.ringwald                     // notify client that alloc failed
75242deddeceSMatthias Ringwald                     hci_emit_connection_complete(addr, 0, BTSTACK_MEMORY_ALLOC_FAILED);
75253e2050f7SMatthias Ringwald                     return BTSTACK_MEMORY_ALLOC_FAILED; // packet not sent to controller
752617f1ba2aSmatthias.ringwald                 }
7527ad83dc6aS[email protected]                 conn->state = SEND_CREATE_CONNECTION;
7528ad83dc6aS[email protected]             }
7529aee5d5c1SMatthias Ringwald 
7530ad83dc6aS[email protected]             log_info("conn state %u", conn->state);
75313e2050f7SMatthias Ringwald             // TODO: L2CAP should not send create connection command, instead a (new) gap function should be used
7532ad83dc6aS[email protected]             switch (conn->state) {
7533ad83dc6aS[email protected]                 // if connection active exists
7534ad83dc6aS[email protected]                 case OPEN:
7535f5e5741dSMatthias Ringwald                     // and OPEN, emit connection complete command
753672cf8859SMatthias Ringwald                     hci_emit_connection_complete(addr, conn->con_handle, ERROR_CODE_SUCCESS);
75373e2050f7SMatthias Ringwald                     // packet not sent to controller
75383e2050f7SMatthias Ringwald                     return ERROR_CODE_ACL_CONNECTION_ALREADY_EXISTS;
7539672e36abSMatthias Ringwald                 case RECEIVED_DISCONNECTION_COMPLETE:
7540672e36abSMatthias Ringwald                     // create connection triggered in disconnect complete event, let's do it now
7541672e36abSMatthias Ringwald                     break;
7542ad83dc6aS[email protected]                 case SEND_CREATE_CONNECTION:
75436c0d5426SMatthias Ringwald #ifdef ENABLE_HCI_SERIALIZED_CONTROLLER_OPERATIONS
75446c0d5426SMatthias Ringwald                     if (hci_classic_operation_active()){
75456c0d5426SMatthias Ringwald                         return ERROR_CODE_SUCCESS;
75466c0d5426SMatthias Ringwald                     }
75476c0d5426SMatthias Ringwald #endif
7548532f91a5SMatthias Ringwald                     // connection created by hci, e.g. dedicated bonding, but not executed yet, let's do it now
7549532f91a5SMatthias Ringwald                     break;
7550ad83dc6aS[email protected]                 default:
7551ad83dc6aS[email protected]                     // otherwise, just ignore as it is already in the open process
75523e2050f7SMatthias Ringwald                     // packet not sent to controller
75533e2050f7SMatthias Ringwald                     return ERROR_CODE_ACL_CONNECTION_ALREADY_EXISTS;
7554ad83dc6aS[email protected]             }
7555c8e4258aSmatthias.ringwald             conn->state = SENT_CREATE_CONNECTION;
7556229331c6SMatthias Ringwald 
7557229331c6SMatthias Ringwald             // track outgoing connection
7558f16129ceSMatthias Ringwald             hci_stack->outgoing_addr_type = BD_ADDR_TYPE_ACL;
75596535961aSMatthias Ringwald             (void) memcpy(hci_stack->outgoing_addr, addr, 6);
75606f35bb46SMatthias Ringwald             break;
7561ee752bb8SMatthias Ringwald 
75626f35bb46SMatthias Ringwald         case HCI_OPCODE_HCI_SETUP_SYNCHRONOUS_CONNECTION:
75639071873aSMatthias Ringwald             conn = hci_connection_for_handle(little_endian_read_16(packet, 3));
75649071873aSMatthias Ringwald             if (conn == NULL) {
75659071873aSMatthias Ringwald                 // neither SCO nor ACL connection for con handle
75669071873aSMatthias Ringwald                 return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
75679071873aSMatthias Ringwald             } else {
7568d7891039SMatthias Ringwald                 uint16_t remote_supported_sco_packets;
75699071873aSMatthias Ringwald                 switch (conn->address_type){
75709071873aSMatthias Ringwald                     case BD_ADDR_TYPE_ACL:
75719071873aSMatthias Ringwald                         // assert SCO connection does not exit
7572d9290e95SMatthias Ringwald                         if (hci_connection_for_bd_addr_and_type(conn->address, BD_ADDR_TYPE_SCO) != NULL){
75739071873aSMatthias Ringwald                             return ERROR_CODE_COMMAND_DISALLOWED;
75749071873aSMatthias Ringwald                         }
7575d7891039SMatthias Ringwald                         // cache remote sco packet types
7576d7891039SMatthias Ringwald                         remote_supported_sco_packets = conn->remote_supported_sco_packets;
7577d7891039SMatthias Ringwald 
75789071873aSMatthias Ringwald                         // allocate connection struct
757988f925b1SMatthias Ringwald                         conn = create_connection_for_bd_addr_and_type(conn->address, BD_ADDR_TYPE_SCO,
758088f925b1SMatthias Ringwald                                                                       HCI_ROLE_MASTER);
75819071873aSMatthias Ringwald                         if (!conn) {
75829071873aSMatthias Ringwald                             return ERROR_CODE_MEMORY_CAPACITY_EXCEEDED;
75839071873aSMatthias Ringwald                         }
7584d7891039SMatthias Ringwald                         conn->remote_supported_sco_packets = remote_supported_sco_packets;
75859071873aSMatthias Ringwald                         break;
75869071873aSMatthias Ringwald                     case BD_ADDR_TYPE_SCO:
75879071873aSMatthias Ringwald                         // update of existing SCO connection
75889071873aSMatthias Ringwald                         break;
75899071873aSMatthias Ringwald                     default:
75909071873aSMatthias Ringwald                         return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS;
75919071873aSMatthias Ringwald                 }
75929071873aSMatthias Ringwald             }
7593d9290e95SMatthias Ringwald 
7594d9290e95SMatthias Ringwald             // conn refers to hci connection of type sco now
7595d9290e95SMatthias Ringwald 
75969071873aSMatthias Ringwald             conn->state = SENT_CREATE_CONNECTION;
75979071873aSMatthias Ringwald 
75989071873aSMatthias Ringwald             // track outgoing connection to handle command status with error
75999071873aSMatthias Ringwald             hci_stack->outgoing_addr_type = BD_ADDR_TYPE_SCO;
76009071873aSMatthias Ringwald             (void) memcpy(hci_stack->outgoing_addr, addr, 6);
76019071873aSMatthias Ringwald 
7602ee752bb8SMatthias Ringwald             // setup_synchronous_connection? Voice setting at offset 22
7603ee752bb8SMatthias Ringwald             // TODO: compare to current setting if sco connection already active
7604ee752bb8SMatthias Ringwald             hci_stack->sco_voice_setting_active = little_endian_read_16(packet, 15);
7605d7891039SMatthias Ringwald 
7606d7891039SMatthias Ringwald             // derive sco payload length from packet types
7607d7891039SMatthias Ringwald             hci_set_sco_payload_length_for_flipped_packet_types(conn, little_endian_read_16(packet, 18));
76086f35bb46SMatthias Ringwald             break;
76099071873aSMatthias Ringwald 
76106f35bb46SMatthias Ringwald         case HCI_OPCODE_HCI_ACCEPT_SYNCHRONOUS_CONNECTION:
76119071873aSMatthias Ringwald             // get SCO connection
76129071873aSMatthias Ringwald             reverse_bd_addr(&packet[3], addr);
76139071873aSMatthias Ringwald             conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_SCO);
76149071873aSMatthias Ringwald             if (conn == NULL){
76159071873aSMatthias Ringwald                 return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
76169071873aSMatthias Ringwald             }
76179071873aSMatthias Ringwald 
76189071873aSMatthias Ringwald             conn->state = ACCEPTED_CONNECTION_REQUEST;
76199071873aSMatthias Ringwald 
76209071873aSMatthias Ringwald             // track outgoing connection to handle command status with error
76219071873aSMatthias Ringwald             hci_stack->outgoing_addr_type = BD_ADDR_TYPE_SCO;
76229071873aSMatthias Ringwald             (void) memcpy(hci_stack->outgoing_addr, addr, 6);
76239071873aSMatthias Ringwald 
7624c91e6e4fSMatthias Ringwald             // accept_synchronous_connection? Voice setting at offset 18
7625ee752bb8SMatthias Ringwald             // TODO: compare to current setting if sco connection already active
7626ee752bb8SMatthias Ringwald             hci_stack->sco_voice_setting_active = little_endian_read_16(packet, 19);
7627d7891039SMatthias Ringwald 
7628d7891039SMatthias Ringwald             // derive sco payload length from packet types
7629d7891039SMatthias Ringwald             hci_set_sco_payload_length_for_flipped_packet_types(conn, little_endian_read_16(packet, 22));
76306f35bb46SMatthias Ringwald             break;
7631ee752bb8SMatthias Ringwald #endif
76324b3e1e19SMatthias Ringwald 
7633a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE
7634d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
76356f35bb46SMatthias Ringwald         case HCI_OPCODE_HCI_LE_CREATE_CONNECTION:
7636b04dfa37SMatthias Ringwald             // white list used?
76376f35bb46SMatthias Ringwald             initiator_filter_policy = packet[7];
7638b04dfa37SMatthias Ringwald             switch (initiator_filter_policy) {
7639b04dfa37SMatthias Ringwald                 case 0:
7640b04dfa37SMatthias Ringwald                     // whitelist not used
7641b04dfa37SMatthias Ringwald                     hci_stack->le_connecting_state = LE_CONNECTING_DIRECT;
7642b04dfa37SMatthias Ringwald                     break;
7643b04dfa37SMatthias Ringwald                 case 1:
7644b04dfa37SMatthias Ringwald                     hci_stack->le_connecting_state = LE_CONNECTING_WHITELIST;
7645b04dfa37SMatthias Ringwald                     break;
7646b04dfa37SMatthias Ringwald                 default:
7647b04dfa37SMatthias Ringwald                     log_error("Invalid initiator_filter_policy in LE Create Connection %u", initiator_filter_policy);
7648b04dfa37SMatthias Ringwald                     break;
7649b04dfa37SMatthias Ringwald             }
7650c163146eSMatthias Ringwald             // track outgoing connection
76518f7da641SMatthias Ringwald             hci_stack->outgoing_addr_type = (bd_addr_type_t) packet[8]; // peer address type
7652c163146eSMatthias Ringwald             reverse_bd_addr( &packet[9], hci_stack->outgoing_addr); // peer address
76536f35bb46SMatthias Ringwald             break;
76548f7da641SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
76558f7da641SMatthias Ringwald         case HCI_OPCODE_HCI_LE_EXTENDED_CREATE_CONNECTION:
76568f7da641SMatthias Ringwald             // white list used?
76578f7da641SMatthias Ringwald             initiator_filter_policy = packet[3];
76588f7da641SMatthias Ringwald             switch (initiator_filter_policy) {
76598f7da641SMatthias Ringwald                 case 0:
76608f7da641SMatthias Ringwald                     // whitelist not used
76618f7da641SMatthias Ringwald                     hci_stack->le_connecting_state = LE_CONNECTING_DIRECT;
76628f7da641SMatthias Ringwald                     break;
76638f7da641SMatthias Ringwald                 case 1:
76648f7da641SMatthias Ringwald                     hci_stack->le_connecting_state = LE_CONNECTING_WHITELIST;
76658f7da641SMatthias Ringwald                     break;
76668f7da641SMatthias Ringwald                 default:
76678f7da641SMatthias Ringwald                     log_error("Invalid initiator_filter_policy in LE Create Connection %u", initiator_filter_policy);
76688f7da641SMatthias Ringwald                     break;
76698f7da641SMatthias Ringwald             }
76708f7da641SMatthias Ringwald             // track outgoing connection
76718f7da641SMatthias Ringwald             hci_stack->outgoing_addr_type = (bd_addr_type_t) packet[5]; // peer address type
76728f7da641SMatthias Ringwald             reverse_bd_addr( &packet[6], hci_stack->outgoing_addr); // peer address
76738f7da641SMatthias Ringwald             break;
76748f7da641SMatthias Ringwald #endif
76756f35bb46SMatthias Ringwald         case HCI_OPCODE_HCI_LE_CREATE_CONNECTION_CANCEL:
76766ea9315cSMatthias Ringwald             hci_stack->le_connecting_state = LE_CONNECTING_CANCEL;
76776f35bb46SMatthias Ringwald             break;
76789cbd2215SMatthias Ringwald #endif
767991036612SMatthias Ringwald #ifdef ENABLE_HCI_COMMAND_STATUS_DISCARDED_FOR_FAILED_CONNECTIONS_WORKAROUND
7680f48a5586SMatthias Ringwald         case HCI_OPCODE_HCI_LE_CONNECTION_UPDATE:
7681f48a5586SMatthias Ringwald         case HCI_OPCODE_HCI_LE_READ_REMOTE_USED_FEATURES:
7682f48a5586SMatthias Ringwald         case HCI_OPCODE_HCI_LE_START_ENCRYPTION:
7683f48a5586SMatthias Ringwald         case HCI_OPCODE_HCI_LE_LONG_TERM_KEY_REQUEST_REPLY:
7684f48a5586SMatthias Ringwald         case HCI_OPCODE_HCI_LE_LONG_TERM_KEY_NEGATIVE_REPLY:
7685f48a5586SMatthias Ringwald         case HCI_OPCODE_HCI_LE_REMOTE_CONNECTION_PARAMETER_REQUEST_REPLY:
7686f48a5586SMatthias Ringwald         case HCI_OPCODE_HCI_LE_REMOTE_CONNECTION_PARAMETER_REQUEST_NEGATIVE_REPLY:
7687f48a5586SMatthias Ringwald         case HCI_OPCODE_HCI_LE_SET_DATA_LENGTH:
7688f48a5586SMatthias Ringwald         case HCI_OPCODE_HCI_LE_READ_PHY:
7689f48a5586SMatthias Ringwald         case HCI_OPCODE_HCI_LE_SET_PHY:
7690f48a5586SMatthias Ringwald             // conection handle is first command parameter
7691f48a5586SMatthias Ringwald             hci_stack->hci_command_con_handle = little_endian_read_16(packet, 3);
7692f48a5586SMatthias Ringwald             break;
7693f48a5586SMatthias Ringwald #endif
76944ae8623eSMatthias Ringwald #endif /* ENABLE_BLE */
76956f35bb46SMatthias Ringwald         default:
76966f35bb46SMatthias Ringwald             break;
7697b04dfa37SMatthias Ringwald     }
769869a97523S[email protected] 
76993a9fb326S[email protected]     hci_stack->num_cmd_packets--;
77005bb5bc3eS[email protected] 
77015bb5bc3eS[email protected]     hci_dump_packet(HCI_COMMAND_DATA_PACKET, 0, packet, size);
77023e2050f7SMatthias Ringwald     int err = hci_stack->hci_transport->send_packet(HCI_COMMAND_DATA_PACKET, packet, size);
77033e2050f7SMatthias Ringwald     if (err != 0){
77043e2050f7SMatthias Ringwald         return ERROR_CODE_HARDWARE_FAILURE;
77053e2050f7SMatthias Ringwald     }
77063e2050f7SMatthias Ringwald     return ERROR_CODE_SUCCESS;
770731452debSmatthias.ringwald }
77088adf0ddaSmatthias.ringwald 
77092bd8b7e7S[email protected] // disconnect because of security block
77102bd8b7e7S[email protected] void hci_disconnect_security_block(hci_con_handle_t con_handle){
77112bd8b7e7S[email protected]     hci_connection_t * connection = hci_connection_for_handle(con_handle);
77122bd8b7e7S[email protected]     if (!connection) return;
77132bd8b7e7S[email protected]     connection->bonding_flags |= BONDING_DISCONNECT_SECURITY_BLOCK;
77142bd8b7e7S[email protected] }
77152bd8b7e7S[email protected] 
77162bd8b7e7S[email protected] 
7717dbe1a790S[email protected] // Configure Secure Simple Pairing
7718dbe1a790S[email protected] 
771935454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
772035454696SMatthias Ringwald 
7721dbe1a790S[email protected] // enable will enable SSP during init
772215a95bd5SMatthias Ringwald void gap_ssp_set_enable(int enable){
77233a9fb326S[email protected]     hci_stack->ssp_enable = enable;
7724dbe1a790S[email protected] }
7725dbe1a790S[email protected] 
772695d71764SMatthias Ringwald static int hci_local_ssp_activated(void){
772715a95bd5SMatthias Ringwald     return gap_ssp_supported() && hci_stack->ssp_enable;
77282bd8b7e7S[email protected] }
77292bd8b7e7S[email protected] 
7730dbe1a790S[email protected] // if set, BTstack will respond to io capability request using authentication requirement
773115a95bd5SMatthias Ringwald void gap_ssp_set_io_capability(int io_capability){
77323a9fb326S[email protected]     hci_stack->ssp_io_capability = io_capability;
7733dbe1a790S[email protected] }
773415a95bd5SMatthias Ringwald void gap_ssp_set_authentication_requirement(int authentication_requirement){
77353a9fb326S[email protected]     hci_stack->ssp_authentication_requirement = authentication_requirement;
7736dbe1a790S[email protected] }
7737dbe1a790S[email protected] 
7738dbe1a790S[email protected] // if set, BTstack will confirm a numberic comparion and enter '000000' if requested
773915a95bd5SMatthias Ringwald void gap_ssp_set_auto_accept(int auto_accept){
77403a9fb326S[email protected]     hci_stack->ssp_auto_accept = auto_accept;
7741dbe1a790S[email protected] }
77425d23aae8SMatthias Ringwald 
77435d23aae8SMatthias Ringwald void gap_secure_connections_enable(bool enable){
77445d23aae8SMatthias Ringwald     hci_stack->secure_connections_enable = enable;
77455d23aae8SMatthias Ringwald }
774622d445d8SMatthias Ringwald bool gap_secure_connections_active(void){
7747eaf85bc8SMatthias Ringwald     return hci_stack->secure_connections_active;
774822d445d8SMatthias Ringwald }
77495d23aae8SMatthias Ringwald 
775035454696SMatthias Ringwald #endif
7751dbe1a790S[email protected] 
775294be1a66SMatthias Ringwald // va_list part of hci_send_cmd
77533e2050f7SMatthias Ringwald uint8_t hci_send_cmd_va_arg(const hci_cmd_t * cmd, va_list argptr){
7754d94d3cafS[email protected]     if (!hci_can_send_command_packet_now()){
77559d14b626S[email protected]         log_error("hci_send_cmd called but cannot send packet now");
77563e2050f7SMatthias Ringwald         return ERROR_CODE_COMMAND_DISALLOWED;
77579d14b626S[email protected]     }
77589d14b626S[email protected] 
77595127cc62S[email protected]     // for HCI INITIALIZATION
77609da54300S[email protected]     // log_info("hci_send_cmd: opcode %04x", cmd->opcode);
77615127cc62S[email protected]     hci_stack->last_cmd_opcode = cmd->opcode;
77625127cc62S[email protected] 
77639d14b626S[email protected]     hci_reserve_packet_buffer();
77649d14b626S[email protected]     uint8_t * packet = hci_stack->hci_packet_buffer;
776594be1a66SMatthias Ringwald     uint16_t size = hci_cmd_create_from_template(packet, cmd, argptr);
77663e2050f7SMatthias Ringwald     uint8_t status = hci_send_cmd_packet(packet, size);
7767bfea0222SMatthias Ringwald 
7768593702caSMatthias Ringwald     // release packet buffer on error or for synchronous transport implementations
77693e2050f7SMatthias Ringwald     if ((status != ERROR_CODE_SUCCESS) || hci_transport_synchronous()){
7770e2d22487SMatthias Ringwald         hci_release_packet_buffer();
7771068b8592SMatthias Ringwald         hci_emit_transport_packet_sent();
7772bfea0222SMatthias Ringwald     }
7773bfea0222SMatthias Ringwald 
77743e2050f7SMatthias Ringwald     return status;
777594be1a66SMatthias Ringwald }
77769d14b626S[email protected] 
777794be1a66SMatthias Ringwald /**
777894be1a66SMatthias Ringwald  * pre: numcmds >= 0 - it's allowed to send a command to the controller
777994be1a66SMatthias Ringwald  */
77803e2050f7SMatthias Ringwald uint8_t hci_send_cmd(const hci_cmd_t * cmd, ...){
77811cd208adSmatthias.ringwald     va_list argptr;
77821cd208adSmatthias.ringwald     va_start(argptr, cmd);
77833e2050f7SMatthias Ringwald     uint8_t status = hci_send_cmd_va_arg(cmd, argptr);
77841cd208adSmatthias.ringwald     va_end(argptr);
77853e2050f7SMatthias Ringwald     return status;
778693b8dc03Smatthias.ringwald }
7787c8e4258aSmatthias.ringwald 
7788ee091cf1Smatthias.ringwald // Create various non-HCI events.
7789ee091cf1Smatthias.ringwald // TODO: generalize, use table similar to hci_create_command
7790ee091cf1Smatthias.ringwald 
7791d6b06661SMatthias Ringwald static void hci_emit_event(uint8_t * event, uint16_t size, int dump){
7792fb37a842SMatthias Ringwald     // dump packet
7793d6b06661SMatthias Ringwald     if (dump) {
779492da54c4SMatthias Ringwald         hci_dump_packet( HCI_EVENT_PACKET, 1, event, size);
7795d6b06661SMatthias Ringwald     }
77961ef6bb52SMatthias Ringwald 
7797fb37a842SMatthias Ringwald     // dispatch to all event handlers
77981ef6bb52SMatthias Ringwald     btstack_linked_list_iterator_t it;
77991ef6bb52SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->event_handlers);
78001ef6bb52SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
78011ef6bb52SMatthias Ringwald         btstack_packet_callback_registration_t * entry = (btstack_packet_callback_registration_t*) btstack_linked_list_iterator_next(&it);
7802d9a7306aSMatthias Ringwald         entry->callback(HCI_EVENT_PACKET, 0, event, size);
78031ef6bb52SMatthias Ringwald     }
7804d6b06661SMatthias Ringwald }
7805d6b06661SMatthias Ringwald 
7806d6b06661SMatthias Ringwald static void hci_emit_acl_packet(uint8_t * packet, uint16_t size){
7807fb37a842SMatthias Ringwald     if (!hci_stack->acl_packet_handler) return;
78083d50b4baSMatthias Ringwald     hci_stack->acl_packet_handler(HCI_ACL_DATA_PACKET, 0, packet, size);
7809d6b06661SMatthias Ringwald }
7810d6b06661SMatthias Ringwald 
781135454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
7812701e3307SMatthias Ringwald static void hci_notify_if_sco_can_send_now(void){
78133bc639ceSMatthias Ringwald     // notify SCO sender if waiting
7814701e3307SMatthias Ringwald     if (!hci_stack->sco_waiting_for_can_send_now) return;
7815701e3307SMatthias Ringwald     if (hci_can_send_sco_packet_now()){
78163bc639ceSMatthias Ringwald         hci_stack->sco_waiting_for_can_send_now = 0;
7817701e3307SMatthias Ringwald         uint8_t event[2] = { HCI_EVENT_SCO_CAN_SEND_NOW, 0 };
7818701e3307SMatthias Ringwald         hci_dump_packet(HCI_EVENT_PACKET, 1, event, sizeof(event));
78193d50b4baSMatthias Ringwald         hci_stack->sco_packet_handler(HCI_EVENT_PACKET, 0, event, sizeof(event));
78203bc639ceSMatthias Ringwald     }
78213bc639ceSMatthias Ringwald }
78221cfb383eSMatthias Ringwald 
78231cfb383eSMatthias Ringwald // parsing end emitting has been merged to reduce code size
78249784dac1SMatthias Ringwald static void gap_inquiry_explode(uint8_t *packet, uint16_t size) {
7825ac9136ccSMatthias Ringwald     uint8_t event[28+GAP_INQUIRY_MAX_NAME_LEN];
78261cfb383eSMatthias Ringwald 
78271cfb383eSMatthias Ringwald     uint8_t * eir_data;
78281cfb383eSMatthias Ringwald     ad_context_t context;
78291cfb383eSMatthias Ringwald     const uint8_t * name;
78301cfb383eSMatthias Ringwald     uint8_t         name_len;
78311cfb383eSMatthias Ringwald 
78329784dac1SMatthias Ringwald     if (size < 3) return;
78339784dac1SMatthias Ringwald 
78341cfb383eSMatthias Ringwald     int event_type = hci_event_packet_get_type(packet);
7835a1df452eSMatthias Ringwald     int num_reserved_fields = (event_type == HCI_EVENT_INQUIRY_RESULT) ? 2 : 1;    // 2 for old event, 1 otherwise
78361cfb383eSMatthias Ringwald     int num_responses       = hci_event_inquiry_result_get_num_responses(packet);
78371cfb383eSMatthias Ringwald 
78389784dac1SMatthias Ringwald     switch (event_type){
78399784dac1SMatthias Ringwald         case HCI_EVENT_INQUIRY_RESULT:
78409784dac1SMatthias Ringwald         case HCI_EVENT_INQUIRY_RESULT_WITH_RSSI:
78419784dac1SMatthias Ringwald             if (size != (3 + (num_responses * 14))) return;
78429784dac1SMatthias Ringwald             break;
78439784dac1SMatthias Ringwald         case HCI_EVENT_EXTENDED_INQUIRY_RESPONSE:
78449784dac1SMatthias Ringwald             if (size != 257) return;
78459784dac1SMatthias Ringwald             if (num_responses != 1) return;
78469784dac1SMatthias Ringwald             break;
78479784dac1SMatthias Ringwald         default:
78489784dac1SMatthias Ringwald             return;
78499784dac1SMatthias Ringwald     }
78509784dac1SMatthias Ringwald 
78511cfb383eSMatthias Ringwald     // event[1] is set at the end
78521cfb383eSMatthias Ringwald     int i;
78531cfb383eSMatthias Ringwald     for (i=0; i<num_responses;i++){
78541cfb383eSMatthias Ringwald         memset(event, 0, sizeof(event));
78551cfb383eSMatthias Ringwald         event[0] = GAP_EVENT_INQUIRY_RESULT;
7856ac973fd6SMatthias Ringwald         uint8_t event_size = 27;    // if name is not set by EIR
78571cfb383eSMatthias Ringwald 
78586535961aSMatthias Ringwald         (void)memcpy(&event[2], &packet[3 + (i * 6)], 6); // bd_addr
78590e588213SMatthias Ringwald         event[8] =          packet[3 + (num_responses*(6))                         + (i*1)];     // page_scan_repetition_mode
78606535961aSMatthias Ringwald         (void)memcpy(&event[9],
78616535961aSMatthias Ringwald                      &packet[3 + (num_responses * (6 + 1 + num_reserved_fields)) + (i * 3)],
78626535961aSMatthias Ringwald                      3); // class of device
78636535961aSMatthias Ringwald         (void)memcpy(&event[12],
78646535961aSMatthias Ringwald                      &packet[3 + (num_responses * (6 + 1 + num_reserved_fields + 3)) + (i * 2)],
78656535961aSMatthias Ringwald                      2); // clock offset
78661cfb383eSMatthias Ringwald 
78671cfb383eSMatthias Ringwald         switch (event_type){
78681cfb383eSMatthias Ringwald             case HCI_EVENT_INQUIRY_RESULT:
78691cfb383eSMatthias Ringwald                 // 14,15,16,17 = 0, size 18
78701cfb383eSMatthias Ringwald                 break;
78711cfb383eSMatthias Ringwald             case HCI_EVENT_INQUIRY_RESULT_WITH_RSSI:
78721cfb383eSMatthias Ringwald                 event[14] = 1;
7873a1df452eSMatthias Ringwald                 event[15] = packet [3 + (num_responses*(6+1+num_reserved_fields+3+2)) + (i*1)]; // rssi
78741cfb383eSMatthias Ringwald                 // 16,17 = 0, size 18
78751cfb383eSMatthias Ringwald                 break;
78761cfb383eSMatthias Ringwald             case HCI_EVENT_EXTENDED_INQUIRY_RESPONSE:
78771cfb383eSMatthias Ringwald                 event[14] = 1;
7878a1df452eSMatthias Ringwald                 event[15] = packet [3 + (num_responses*(6+1+num_reserved_fields+3+2)) + (i*1)]; // rssi
787979186815SMatthias Ringwald                 // EIR packets only contain a single inquiry response
78801cfb383eSMatthias Ringwald                 eir_data = &packet[3 + (6+1+num_reserved_fields+3+2+1)];
78811cfb383eSMatthias Ringwald                 name = NULL;
7882a8c4e5adSMatthias Ringwald                 // Iterate over EIR data
7883a8c4e5adSMatthias Ringwald                 for (ad_iterator_init(&context, EXTENDED_INQUIRY_RESPONSE_DATA_LEN, eir_data) ; ad_iterator_has_more(&context) ; ad_iterator_next(&context)){
78841cfb383eSMatthias Ringwald                     uint8_t data_type    = ad_iterator_get_data_type(&context);
78851cfb383eSMatthias Ringwald                     uint8_t data_size    = ad_iterator_get_data_len(&context);
78861cfb383eSMatthias Ringwald                     const uint8_t * data = ad_iterator_get_data(&context);
7887ac9136ccSMatthias Ringwald                     // Prefer Complete Local Name over Shortened Local Name
78881cfb383eSMatthias Ringwald                     switch (data_type){
78891cfb383eSMatthias Ringwald                         case BLUETOOTH_DATA_TYPE_SHORTENED_LOCAL_NAME:
78901cfb383eSMatthias Ringwald                             if (name) continue;
7891cf373d3aSMatthias Ringwald                             /* fall through */
78921cfb383eSMatthias Ringwald                         case BLUETOOTH_DATA_TYPE_COMPLETE_LOCAL_NAME:
78931cfb383eSMatthias Ringwald                             name = data;
78941cfb383eSMatthias Ringwald                             name_len = data_size;
78951cfb383eSMatthias Ringwald                             break;
7896ac9136ccSMatthias Ringwald                         case BLUETOOTH_DATA_TYPE_DEVICE_ID:
7897ac9136ccSMatthias Ringwald                             if (data_size != 8) break;
7898ac9136ccSMatthias Ringwald                             event[16] = 1;
78993c0c7fefSMatthias Ringwald                             memcpy(&event[17], data, 8);
7900ac9136ccSMatthias Ringwald                             break;
79011cfb383eSMatthias Ringwald                         default:
79021cfb383eSMatthias Ringwald                             break;
79031cfb383eSMatthias Ringwald                     }
79041cfb383eSMatthias Ringwald                 }
79051cfb383eSMatthias Ringwald                 if (name){
7906ac9136ccSMatthias Ringwald                     event[25] = 1;
79071cfb383eSMatthias Ringwald                     // truncate name if needed
79081cfb383eSMatthias Ringwald                     int len = btstack_min(name_len, GAP_INQUIRY_MAX_NAME_LEN);
7909ac9136ccSMatthias Ringwald                     event[26] = len;
7910ac9136ccSMatthias Ringwald                     (void)memcpy(&event[27], name, len);
79111cfb383eSMatthias Ringwald                     event_size += len;
79121cfb383eSMatthias Ringwald                 }
79131cfb383eSMatthias Ringwald                 break;
79147bbeb3adSMilanka Ringwald             default:
79157bbeb3adSMilanka Ringwald                 return;
79161cfb383eSMatthias Ringwald         }
79171cfb383eSMatthias Ringwald         event[1] = event_size - 2;
79181cfb383eSMatthias Ringwald         hci_emit_event(event, event_size, 1);
79191cfb383eSMatthias Ringwald     }
79201cfb383eSMatthias Ringwald }
792135454696SMatthias Ringwald #endif
79223bc639ceSMatthias Ringwald 
792371de195eSMatthias Ringwald void hci_emit_state(void){
79243a9fb326S[email protected]     log_info("BTSTACK_EVENT_STATE %u", hci_stack->state);
7925425d1371Smatthias.ringwald     uint8_t event[3];
792680d52d6bSmatthias.ringwald     event[0] = BTSTACK_EVENT_STATE;
79274ea43905SMatthias Ringwald     event[1] = sizeof(event) - 2u;
79283a9fb326S[email protected]     event[2] = hci_stack->state;
7929d6b06661SMatthias Ringwald     hci_emit_event(event, sizeof(event), 1);
7930c8e4258aSmatthias.ringwald }
7931c8e4258aSmatthias.ringwald 
793235454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
79332deddeceSMatthias Ringwald static void hci_emit_connection_complete(bd_addr_t address, hci_con_handle_t con_handle, uint8_t status){
7934425d1371Smatthias.ringwald     uint8_t event[13];
7935c8e4258aSmatthias.ringwald     event[0] = HCI_EVENT_CONNECTION_COMPLETE;
7936425d1371Smatthias.ringwald     event[1] = sizeof(event) - 2;
793717f1ba2aSmatthias.ringwald     event[2] = status;
79382deddeceSMatthias Ringwald     little_endian_store_16(event, 3, con_handle);
79392deddeceSMatthias Ringwald     reverse_bd_addr(address, &event[5]);
7940c8e4258aSmatthias.ringwald     event[11] = 1; // ACL connection
7941c8e4258aSmatthias.ringwald     event[12] = 0; // encryption disabled
7942d6b06661SMatthias Ringwald     hci_emit_event(event, sizeof(event), 1);
7943c8e4258aSmatthias.ringwald }
794452db98b2SMatthias Ringwald static void hci_emit_l2cap_check_timeout(hci_connection_t *conn){
794552db98b2SMatthias Ringwald     if (disable_l2cap_timeouts) return;
794652db98b2SMatthias Ringwald     log_info("L2CAP_EVENT_TIMEOUT_CHECK");
794752db98b2SMatthias Ringwald     uint8_t event[4];
794852db98b2SMatthias Ringwald     event[0] = L2CAP_EVENT_TIMEOUT_CHECK;
794952db98b2SMatthias Ringwald     event[1] = sizeof(event) - 2;
795052db98b2SMatthias Ringwald     little_endian_store_16(event, 2, conn->con_handle);
795152db98b2SMatthias Ringwald     hci_emit_event(event, sizeof(event), 1);
795252db98b2SMatthias Ringwald }
795335454696SMatthias Ringwald #endif
7954c8e4258aSmatthias.ringwald 
795535454696SMatthias Ringwald #ifdef ENABLE_BLE
7956d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
7957667ba9d1SMatthias 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){
7958ebd1b979SMatthias Ringwald     uint8_t hci_event[21];
7959ebd1b979SMatthias Ringwald     hci_event[0] = HCI_EVENT_LE_META;
7960ebd1b979SMatthias Ringwald     hci_event[1] = sizeof(hci_event) - 2u;
7961ebd1b979SMatthias Ringwald     hci_event[2] = HCI_SUBEVENT_LE_CONNECTION_COMPLETE;
7962ebd1b979SMatthias Ringwald     hci_event[3] = status;
7963ebd1b979SMatthias Ringwald     little_endian_store_16(hci_event, 4, con_handle);
7964ebd1b979SMatthias Ringwald     hci_event[6] = 0; // TODO: role
7965ebd1b979SMatthias Ringwald     hci_event[7] = address_type;
7966ebd1b979SMatthias Ringwald     reverse_bd_addr(address, &hci_event[8]);
7967ebd1b979SMatthias Ringwald     little_endian_store_16(hci_event, 14, 0); // interval
7968ebd1b979SMatthias Ringwald     little_endian_store_16(hci_event, 16, 0); // latency
7969ebd1b979SMatthias Ringwald     little_endian_store_16(hci_event, 18, 0); // supervision timeout
7970ebd1b979SMatthias Ringwald     hci_event[20] = 0; // master clock accuracy
7971ebd1b979SMatthias Ringwald     hci_emit_event(hci_event, sizeof(hci_event), 1);
7972ebd1b979SMatthias Ringwald     // emit GAP event, too
7973ebd1b979SMatthias Ringwald     uint8_t gap_event[36];
7974ebd1b979SMatthias Ringwald     hci_create_gap_connection_complete_event(hci_event, gap_event);
7975ebd1b979SMatthias Ringwald     hci_emit_event(gap_event, sizeof(gap_event), 1);
79764f3229d8S[email protected] }
797735454696SMatthias Ringwald #endif
7978d70217a2SMatthias Ringwald #endif
79794f3229d8S[email protected] 
7980fd43c0e0SMatthias Ringwald static void hci_emit_transport_packet_sent(void){
7981fd43c0e0SMatthias Ringwald     // notify upper stack that it might be possible to send again
7982fd43c0e0SMatthias Ringwald     uint8_t event[] = { HCI_EVENT_TRANSPORT_PACKET_SENT, 0};
7983fd43c0e0SMatthias Ringwald     hci_emit_event(&event[0], sizeof(event), 0);  // don't dump
7984fd43c0e0SMatthias Ringwald }
7985fd43c0e0SMatthias Ringwald 
7986fc64f94aSMatthias Ringwald static void hci_emit_disconnection_complete(hci_con_handle_t con_handle, uint8_t reason){
7987425d1371Smatthias.ringwald     uint8_t event[6];
79883c4d4b90Smatthias.ringwald     event[0] = HCI_EVENT_DISCONNECTION_COMPLETE;
79894ea43905SMatthias Ringwald     event[1] = sizeof(event) - 2u;
79903c4d4b90Smatthias.ringwald     event[2] = 0; // status = OK
7991fc64f94aSMatthias Ringwald     little_endian_store_16(event, 3, con_handle);
79923c4d4b90Smatthias.ringwald     event[5] = reason;
7993d6b06661SMatthias Ringwald     hci_emit_event(event, sizeof(event), 1);
79943c4d4b90Smatthias.ringwald }
79953c4d4b90Smatthias.ringwald 
7996b83d5eabSMatthias Ringwald static void hci_emit_nr_connections_changed(void){
7997e0abb8e7S[email protected]     log_info("BTSTACK_EVENT_NR_CONNECTIONS_CHANGED %u", nr_hci_connections());
7998425d1371Smatthias.ringwald     uint8_t event[3];
799980d52d6bSmatthias.ringwald     event[0] = BTSTACK_EVENT_NR_CONNECTIONS_CHANGED;
80004ea43905SMatthias Ringwald     event[1] = sizeof(event) - 2u;
800143bfb1bdSmatthias.ringwald     event[2] = nr_hci_connections();
8002d6b06661SMatthias Ringwald     hci_emit_event(event, sizeof(event), 1);
800343bfb1bdSmatthias.ringwald }
8004038bc64cSmatthias.ringwald 
8005b83d5eabSMatthias Ringwald static void hci_emit_hci_open_failed(void){
8006e0abb8e7S[email protected]     log_info("BTSTACK_EVENT_POWERON_FAILED");
8007425d1371Smatthias.ringwald     uint8_t event[2];
800880d52d6bSmatthias.ringwald     event[0] = BTSTACK_EVENT_POWERON_FAILED;
80094ea43905SMatthias Ringwald     event[1] = sizeof(event) - 2u;
8010d6b06661SMatthias Ringwald     hci_emit_event(event, sizeof(event), 1);
8011038bc64cSmatthias.ringwald }
80121b0e3922Smatthias.ringwald 
801335454696SMatthias Ringwald static void hci_emit_dedicated_bonding_result(bd_addr_t address, uint8_t status){
801435454696SMatthias Ringwald     log_info("hci_emit_dedicated_bonding_result %u ", status);
801535454696SMatthias Ringwald     uint8_t event[9];
801635454696SMatthias Ringwald     int pos = 0;
801735454696SMatthias Ringwald     event[pos++] = GAP_EVENT_DEDICATED_BONDING_COMPLETED;
80184ea43905SMatthias Ringwald     event[pos++] = sizeof(event) - 2u;
801935454696SMatthias Ringwald     event[pos++] = status;
802035454696SMatthias Ringwald     reverse_bd_addr(address, &event[pos]);
8021d6b06661SMatthias Ringwald     hci_emit_event(event, sizeof(event), 1);
8022381fbed8Smatthias.ringwald }
8023458bf4e8S[email protected] 
802435454696SMatthias Ringwald 
802535454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
802635454696SMatthias Ringwald 
8027b83d5eabSMatthias Ringwald static void hci_emit_security_level(hci_con_handle_t con_handle, gap_security_level_t level){
8028df3354fcS[email protected]     log_info("hci_emit_security_level %u for handle %x", level, con_handle);
8029a00031e2S[email protected]     uint8_t event[5];
8030e00caf9cS[email protected]     int pos = 0;
80315611a760SMatthias Ringwald     event[pos++] = GAP_EVENT_SECURITY_LEVEL;
8032e00caf9cS[email protected]     event[pos++] = sizeof(event) - 2;
8033f8fbdce0SMatthias Ringwald     little_endian_store_16(event, 2, con_handle);
8034e00caf9cS[email protected]     pos += 2;
8035e00caf9cS[email protected]     event[pos++] = level;
8036d6b06661SMatthias Ringwald     hci_emit_event(event, sizeof(event), 1);
8037e00caf9cS[email protected] }
8038e00caf9cS[email protected] 
803935454696SMatthias Ringwald static gap_security_level_t gap_security_level_for_connection(hci_connection_t * connection){
804035454696SMatthias Ringwald     if (!connection) return LEVEL_0;
80418daf94bcSMatthias Ringwald     if ((connection->authentication_flags & AUTH_FLAG_CONNECTION_ENCRYPTED) == 0) return LEVEL_0;
8042fcaf38b9SMatthias Ringwald     // BIAS: we only consider Authenticated if the connection is already encrypted, which requires that both sides have link key
80438daf94bcSMatthias Ringwald     if ((connection->authentication_flags & AUTH_FLAG_CONNECTION_AUTHENTICATED) == 0) return LEVEL_0;
8044170fafaeSMatthias Ringwald     if (connection->encryption_key_size < hci_stack->gap_required_encyrption_key_size) return LEVEL_0;
80454051b7ffSMatthias Ringwald     gap_security_level_t security_level = gap_security_level_for_link_key_type(connection->link_key_type);
8046170fafaeSMatthias Ringwald     // LEVEL 4 always requires 128 bit encrytion key size
80470e588213SMatthias Ringwald     if ((security_level == LEVEL_4) && (connection->encryption_key_size < 16)){
8048170fafaeSMatthias Ringwald         security_level = LEVEL_3;
8049170fafaeSMatthias Ringwald     }
8050170fafaeSMatthias Ringwald     return security_level;
805135454696SMatthias Ringwald }
805235454696SMatthias Ringwald 
805371fd255dSMatthias Ringwald static void hci_emit_scan_mode_changed(uint8_t discoverable, uint8_t connectable){
805471fd255dSMatthias Ringwald     uint8_t event[4];
805571fd255dSMatthias Ringwald     event[0] = BTSTACK_EVENT_SCAN_MODE_CHANGED;
805635454696SMatthias Ringwald     event[1] = sizeof(event) - 2;
805771fd255dSMatthias Ringwald     event[2] = discoverable;
805871fd255dSMatthias Ringwald     event[3] = connectable;
8059d6b06661SMatthias Ringwald     hci_emit_event(event, sizeof(event), 1);
8060ad83dc6aS[email protected] }
8061ad83dc6aS[email protected] 
806298a2fd1cSMatthias Ringwald // query if remote side supports eSCO
806320dcdd22SMatthias Ringwald bool hci_remote_esco_supported(hci_con_handle_t con_handle){
806498a2fd1cSMatthias Ringwald     hci_connection_t * connection = hci_connection_for_handle(con_handle);
806520dcdd22SMatthias Ringwald     if (!connection) return false;
806676ccfb2aSMatthias Ringwald     return (connection->remote_supported_features[0] & 1) != 0;
806798a2fd1cSMatthias Ringwald }
806898a2fd1cSMatthias Ringwald 
80690b78a447SMatthias Ringwald uint16_t hci_remote_sco_packet_types(hci_con_handle_t con_handle){
80700b78a447SMatthias Ringwald     hci_connection_t * connection = hci_connection_for_handle(con_handle);
80710b78a447SMatthias Ringwald     if (!connection) return 0;
80720b78a447SMatthias Ringwald     return connection->remote_supported_sco_packets;
80730b78a447SMatthias Ringwald }
80740b78a447SMatthias Ringwald 
807567aae551SMatthias Ringwald static bool hci_ssp_supported(hci_connection_t * connection){
807667aae551SMatthias Ringwald     const uint8_t mask = BONDING_REMOTE_SUPPORTS_SSP_CONTROLLER | BONDING_REMOTE_SUPPORTS_SSP_HOST;
807767aae551SMatthias Ringwald     return (connection->bonding_flags & mask) == mask;
807867aae551SMatthias Ringwald }
807967aae551SMatthias Ringwald 
80802bd8b7e7S[email protected] // query if remote side supports SSP
808120dcdd22SMatthias Ringwald bool hci_remote_ssp_supported(hci_con_handle_t con_handle){
80822bd8b7e7S[email protected]     hci_connection_t * connection = hci_connection_for_handle(con_handle);
808320dcdd22SMatthias Ringwald     if (!connection) return false;
808467aae551SMatthias Ringwald     return hci_ssp_supported(connection) ? 1 : 0;
80852bd8b7e7S[email protected] }
80862bd8b7e7S[email protected] 
808720dcdd22SMatthias Ringwald bool gap_ssp_supported_on_both_sides(hci_con_handle_t handle){
8088df3354fcS[email protected]     return hci_local_ssp_activated() && hci_remote_ssp_supported(handle);
8089df3354fcS[email protected] }
8090df3354fcS[email protected] 
80916ffc78ceSMatthias Ringwald /**
80926ffc78ceSMatthias Ringwald  * Check if remote supported features query has completed
80936ffc78ceSMatthias Ringwald  */
80946ffc78ceSMatthias Ringwald bool hci_remote_features_available(hci_con_handle_t handle){
80956ffc78ceSMatthias Ringwald     hci_connection_t * connection = hci_connection_for_handle(handle);
80966ffc78ceSMatthias Ringwald     if (!connection) return false;
80976ffc78ceSMatthias Ringwald     return (connection->bonding_flags & BONDING_RECEIVED_REMOTE_FEATURES) != 0;
80986ffc78ceSMatthias Ringwald }
80996ffc78ceSMatthias Ringwald 
8100d6596031SMatthias Ringwald /**
8101d6596031SMatthias Ringwald  * Trigger remote supported features query
8102d6596031SMatthias Ringwald  */
8103c9742cd1SMatthias Ringwald 
8104c9742cd1SMatthias Ringwald static void hci_trigger_remote_features_for_connection(hci_connection_t * connection){
8105c9742cd1SMatthias Ringwald     if ((connection->bonding_flags & (BONDING_REMOTE_FEATURES_QUERY_ACTIVE | BONDING_RECEIVED_REMOTE_FEATURES)) == 0){
8106c9742cd1SMatthias Ringwald         connection->bonding_flags |= BONDING_REMOTE_FEATURES_QUERY_ACTIVE | BONDING_REQUEST_REMOTE_FEATURES_PAGE_0;
8107c9742cd1SMatthias Ringwald     }
8108c9742cd1SMatthias Ringwald }
8109c9742cd1SMatthias Ringwald 
8110d6596031SMatthias Ringwald void hci_remote_features_query(hci_con_handle_t con_handle){
8111d6596031SMatthias Ringwald     hci_connection_t * connection = hci_connection_for_handle(con_handle);
8112d6596031SMatthias Ringwald     if (!connection) return;
8113c9742cd1SMatthias Ringwald     hci_trigger_remote_features_for_connection(connection);
8114d6596031SMatthias Ringwald     hci_run();
8115d6596031SMatthias Ringwald }
8116d6596031SMatthias Ringwald 
8117458bf4e8S[email protected] // GAP API
8118458bf4e8S[email protected] /**
8119458bf4e8S[email protected]  * @bbrief enable/disable bonding. default is enabled
8120458bf4e8S[email protected]  * @praram enabled
8121458bf4e8S[email protected]  */
81224c57c146S[email protected] void gap_set_bondable_mode(int enable){
81233a9fb326S[email protected]     hci_stack->bondable = enable ? 1 : 0;
8124458bf4e8S[email protected] }
81254ef6443cSMatthias Ringwald /**
81264ef6443cSMatthias Ringwald  * @brief Get bondable mode.
81274ef6443cSMatthias Ringwald  * @return 1 if bondable
81284ef6443cSMatthias Ringwald  */
81294ef6443cSMatthias Ringwald int gap_get_bondable_mode(void){
81304ef6443cSMatthias Ringwald     return hci_stack->bondable;
81314ef6443cSMatthias Ringwald }
8132cb230b9dS[email protected] 
8133cb230b9dS[email protected] /**
813434d2123cS[email protected]  * @brief map link keys to security levels
8135cb230b9dS[email protected]  */
813634d2123cS[email protected] gap_security_level_t gap_security_level_for_link_key_type(link_key_type_t link_key_type){
813734d2123cS[email protected]     switch (link_key_type){
81383c68dfa9S[email protected]         case AUTHENTICATED_COMBINATION_KEY_GENERATED_FROM_P256:
81393c68dfa9S[email protected]             return LEVEL_4;
81403c68dfa9S[email protected]         case COMBINATION_KEY:
81413c68dfa9S[email protected]         case AUTHENTICATED_COMBINATION_KEY_GENERATED_FROM_P192:
81423c68dfa9S[email protected]             return LEVEL_3;
81433c68dfa9S[email protected]         default:
81443c68dfa9S[email protected]             return LEVEL_2;
81453c68dfa9S[email protected]     }
8146cb230b9dS[email protected] }
8147cb230b9dS[email protected] 
81488b35e16aSMatthias Ringwald /**
81498b35e16aSMatthias Ringwald  * @brief map link keys to secure connection yes/no
81508b35e16aSMatthias Ringwald  */
815136c3546bSMatthias Ringwald bool gap_secure_connection_for_link_key_type(link_key_type_t link_key_type){
81528b35e16aSMatthias Ringwald     switch (link_key_type){
81538b35e16aSMatthias Ringwald         case AUTHENTICATED_COMBINATION_KEY_GENERATED_FROM_P256:
81548b35e16aSMatthias Ringwald         case UNAUTHENTICATED_COMBINATION_KEY_GENERATED_FROM_P256:
815536c3546bSMatthias Ringwald             return true;
81568b35e16aSMatthias Ringwald         default:
815736c3546bSMatthias Ringwald             return false;
81588b35e16aSMatthias Ringwald     }
81598b35e16aSMatthias Ringwald }
81608b35e16aSMatthias Ringwald 
81618b35e16aSMatthias Ringwald /**
81628b35e16aSMatthias Ringwald  * @brief map link keys to authenticated
81638b35e16aSMatthias Ringwald  */
81647040ba26SMatthias Ringwald bool gap_authenticated_for_link_key_type(link_key_type_t link_key_type){
81658b35e16aSMatthias Ringwald     switch (link_key_type){
81668b35e16aSMatthias Ringwald         case AUTHENTICATED_COMBINATION_KEY_GENERATED_FROM_P256:
81678b35e16aSMatthias Ringwald         case AUTHENTICATED_COMBINATION_KEY_GENERATED_FROM_P192:
81687040ba26SMatthias Ringwald             return true;
81698b35e16aSMatthias Ringwald         default:
81707040ba26SMatthias Ringwald             return false;
81718b35e16aSMatthias Ringwald     }
81728b35e16aSMatthias Ringwald }
81738b35e16aSMatthias Ringwald 
8174552b9260SMatthias Ringwald bool gap_mitm_protection_required_for_security_level(gap_security_level_t level){
81755127cc62S[email protected]     log_info("gap_mitm_protection_required_for_security_level %u", level);
8176106d6d11S[email protected]     return level > LEVEL_2;
8177106d6d11S[email protected] }
8178106d6d11S[email protected] 
817934d2123cS[email protected] /**
818034d2123cS[email protected]  * @brief get current security level
818134d2123cS[email protected]  */
818234d2123cS[email protected] gap_security_level_t gap_security_level(hci_con_handle_t con_handle){
818334d2123cS[email protected]     hci_connection_t * connection = hci_connection_for_handle(con_handle);
818434d2123cS[email protected]     if (!connection) return LEVEL_0;
818534d2123cS[email protected]     return gap_security_level_for_connection(connection);
818634d2123cS[email protected] }
818734d2123cS[email protected] 
8188cb230b9dS[email protected] /**
8189cb230b9dS[email protected]  * @brief request connection to device to
8190cb230b9dS[email protected]  * @result GAP_AUTHENTICATION_RESULT
8191cb230b9dS[email protected]  */
819234d2123cS[email protected] void gap_request_security_level(hci_con_handle_t con_handle, gap_security_level_t requested_level){
819334d2123cS[email protected]     hci_connection_t * connection = hci_connection_for_handle(con_handle);
819434d2123cS[email protected]     if (!connection){
8195a00031e2S[email protected]         hci_emit_security_level(con_handle, LEVEL_0);
819634d2123cS[email protected]         return;
819734d2123cS[email protected]     }
8198defbf200SMatthias Ringwald 
8199defbf200SMatthias Ringwald     btstack_assert(hci_is_le_connection(connection) == false);
8200defbf200SMatthias Ringwald 
8201bc00e12cSMatthias 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)
8202bc00e12cSMatthias Ringwald     // available on the BR/EDR physical transport require Security Mode 4, Level 4 "
8203bc00e12cSMatthias Ringwald     if (hci_stack->gap_secure_connections_only_mode && (requested_level != LEVEL_0)){
8204bc00e12cSMatthias Ringwald         requested_level = LEVEL_4;
8205bc00e12cSMatthias Ringwald     }
8206bc00e12cSMatthias Ringwald 
820734d2123cS[email protected]     gap_security_level_t current_level = gap_security_level(con_handle);
820883d08d7cSMatthias Ringwald     log_info("gap_request_security_level requested level %u, planned level %u, current level %u",
820983d08d7cSMatthias Ringwald         requested_level, connection->requested_security_level, current_level);
821083d08d7cSMatthias Ringwald 
8211dbd5dcc3SMatthias Ringwald     // authentication active if authentication request was sent or planned level > 0
8212dbd5dcc3SMatthias Ringwald     bool authentication_active = ((connection->bonding_flags & BONDING_SENT_AUTHENTICATE_REQUEST) != 0) || (connection->requested_security_level > LEVEL_0);
8213dbd5dcc3SMatthias Ringwald     if (authentication_active){
82141cf0a6c8SMatthias Ringwald         // authentication already active
821583d08d7cSMatthias Ringwald         if (connection->requested_security_level < requested_level){
821683d08d7cSMatthias Ringwald             // increase requested level as new level is higher
821783d08d7cSMatthias Ringwald             // TODO: handle re-authentication when done
821883d08d7cSMatthias Ringwald             connection->requested_security_level = requested_level;
821983d08d7cSMatthias Ringwald         }
82201cf0a6c8SMatthias Ringwald     } else {
822183d08d7cSMatthias Ringwald         // no request active, notify if security sufficient
822283d08d7cSMatthias Ringwald         if (requested_level <= current_level){
8223a00031e2S[email protected]             hci_emit_security_level(con_handle, current_level);
822434d2123cS[email protected]             return;
822534d2123cS[email protected]         }
8226a00031e2S[email protected] 
8227e060c07dSMatthias Ringwald         // store request
822834d2123cS[email protected]         connection->requested_security_level = requested_level;
8229a00031e2S[email protected] 
82301cf0a6c8SMatthias Ringwald         // start to authenticate connection
82311eb2563eS[email protected]         connection->bonding_flags |= BONDING_SEND_AUTHENTICATE_REQUEST;
82327fdbaf79SMatthias Ringwald 
82337fdbaf79SMatthias Ringwald         // request remote features if not already active, also trigger hci_run
82347fdbaf79SMatthias Ringwald         hci_remote_features_query(con_handle);
8235e00caf9cS[email protected]     }
82361cf0a6c8SMatthias Ringwald }
8237ad83dc6aS[email protected] 
8238ad83dc6aS[email protected] /**
8239ad83dc6aS[email protected]  * @brief start dedicated bonding with device. disconnect after bonding
8240ad83dc6aS[email protected]  * @param device
8241ad83dc6aS[email protected]  * @param request MITM protection
8242ad83dc6aS[email protected]  * @result GAP_DEDICATED_BONDING_COMPLETE
8243ad83dc6aS[email protected]  */
8244ad83dc6aS[email protected] int gap_dedicated_bonding(bd_addr_t device, int mitm_protection_required){
8245ad83dc6aS[email protected] 
8246ad83dc6aS[email protected]     // create connection state machine
824788f925b1SMatthias Ringwald     hci_connection_t * connection = create_connection_for_bd_addr_and_type(device, BD_ADDR_TYPE_ACL, HCI_ROLE_MASTER);
8248ad83dc6aS[email protected] 
8249ad83dc6aS[email protected]     if (!connection){
8250ad83dc6aS[email protected]         return BTSTACK_MEMORY_ALLOC_FAILED;
8251ad83dc6aS[email protected]     }
8252ad83dc6aS[email protected] 
82534cd03f8aSMatthias Ringwald     // delete link key
825415a95bd5SMatthias Ringwald     gap_drop_link_key_for_bd_addr(device);
8255ad83dc6aS[email protected] 
8256ad83dc6aS[email protected]     // configure LEVEL_2/3, dedicated bonding
8257ad83dc6aS[email protected]     connection->state = SEND_CREATE_CONNECTION;
8258ad83dc6aS[email protected]     connection->requested_security_level = mitm_protection_required ? LEVEL_3 : LEVEL_2;
8259f04a0c31SMatthias Ringwald     log_info("gap_dedicated_bonding, mitm %d -> level %u", mitm_protection_required, connection->requested_security_level);
8260ad83dc6aS[email protected]     connection->bonding_flags = BONDING_DEDICATED;
8261ad83dc6aS[email protected] 
8262ad83dc6aS[email protected]     hci_run();
8263ad83dc6aS[email protected] 
8264ad83dc6aS[email protected]     return 0;
8265ad83dc6aS[email protected] }
82668e618f72S[email protected] 
8267f82b8f4bSMatthias Ringwald uint8_t hci_dedicated_bonding_defer_disconnect(hci_con_handle_t con_handle, bool defer){
8268ab0c69a9SMatthias Ringwald     hci_connection_t * connection = hci_connection_for_handle(con_handle);
8269ab0c69a9SMatthias Ringwald     if (connection == NULL){
8270ab0c69a9SMatthias Ringwald         return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
8271ab0c69a9SMatthias Ringwald     }
8272ab0c69a9SMatthias Ringwald     if (defer){
8273ab0c69a9SMatthias Ringwald         connection->bonding_flags |= BONDING_DEDICATED_DEFER_DISCONNECT;
8274ab0c69a9SMatthias Ringwald     } else {
8275ab0c69a9SMatthias Ringwald         connection->bonding_flags &= ~BONDING_DEDICATED_DEFER_DISCONNECT;
8276ab0c69a9SMatthias Ringwald         // trigger disconnect
8277ab0c69a9SMatthias Ringwald         hci_run();
8278ab0c69a9SMatthias Ringwald     }
8279ab0c69a9SMatthias Ringwald     return ERROR_CODE_SUCCESS;
8280ab0c69a9SMatthias Ringwald }
8281ab0c69a9SMatthias Ringwald 
82828e618f72S[email protected] void gap_set_local_name(const char * local_name){
82838e618f72S[email protected]     hci_stack->local_name = local_name;
8284baa4881eSMatthias Ringwald     hci_stack->gap_tasks_classic |= GAP_TASK_SET_LOCAL_NAME;
828559d59ecfSMatthias Ringwald     // also update EIR if not set by user
828659d59ecfSMatthias Ringwald     if (hci_stack->eir_data == NULL){
8287baa4881eSMatthias Ringwald         hci_stack->gap_tasks_classic |= GAP_TASK_SET_EIR_DATA;
828859d59ecfSMatthias Ringwald     }
828959d59ecfSMatthias Ringwald     hci_run();
82908e618f72S[email protected] }
82911aeec2ebSMatthias Ringwald #endif
82928e618f72S[email protected] 
829335454696SMatthias Ringwald 
829435454696SMatthias Ringwald #ifdef ENABLE_BLE
829535454696SMatthias Ringwald 
8296d70217a2SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
8297d8e8f12aSMatthias Ringwald void gap_start_scan(void){
8298fde725feSMatthias Ringwald     hci_stack->le_scanning_enabled = true;
82997bdc6798S[email protected]     hci_run();
83007bdc6798S[email protected] }
83018e618f72S[email protected] 
8302d8e8f12aSMatthias Ringwald void gap_stop_scan(void){
8303fde725feSMatthias Ringwald     hci_stack->le_scanning_enabled = false;
83047bdc6798S[email protected]     hci_run();
83057bdc6798S[email protected] }
83064f3229d8S[email protected] 
8307a7a719e9SMatthias Ringwald void gap_set_scan_params(uint8_t scan_type, uint16_t scan_interval, uint16_t scan_window, uint8_t scanning_filter_policy){
8308ef11999fSmatthias.ringwald     hci_stack->le_scan_type          = scan_type;
8309a7a719e9SMatthias Ringwald     hci_stack->le_scan_filter_policy = scanning_filter_policy;
8310ef11999fSmatthias.ringwald     hci_stack->le_scan_interval      = scan_interval;
8311ef11999fSmatthias.ringwald     hci_stack->le_scan_window        = scan_window;
83128b69e4c7SMatthias Ringwald     hci_stack->le_scanning_param_update = true;
8313ef11999fSmatthias.ringwald     hci_run();
8314ef11999fSmatthias.ringwald }
83154f3229d8S[email protected] 
8316a7a719e9SMatthias Ringwald void gap_set_scan_parameters(uint8_t scan_type, uint16_t scan_interval, uint16_t scan_window){
8317a7a719e9SMatthias Ringwald     gap_set_scan_params(scan_type, scan_interval, scan_window, 0);
8318a7a719e9SMatthias Ringwald }
8319a7a719e9SMatthias Ringwald 
83204856283bSMatthias Ringwald void gap_set_scan_duplicate_filter(bool enabled){
83214856283bSMatthias Ringwald     hci_stack->le_scan_filter_duplicates = enabled ? 1 : 0;
83224856283bSMatthias Ringwald }
83234856283bSMatthias Ringwald 
83247eb5b27eSMatthias Ringwald void gap_set_scan_phys(uint8_t phys){
83257eb5b27eSMatthias Ringwald     // LE Coded and LE 1M PHY
83267eb5b27eSMatthias Ringwald     hci_stack->le_scan_phys = phys & 0x05;
83277eb5b27eSMatthias Ringwald }
83287eb5b27eSMatthias Ringwald 
8329667ba9d1SMatthias Ringwald uint8_t gap_connect(const bd_addr_t addr, bd_addr_type_t addr_type) {
83309cb52963SMatthias Ringwald     // disallow le connection if outgoing already active
8331d32b3f05SMatthias Ringwald     if (hci_is_le_connection_type(addr_type) && hci_stack->le_connecting_request != LE_CONNECTING_IDLE){
83329cb52963SMatthias Ringwald         log_error("le connect already active");
8333d32b3f05SMatthias Ringwald         return ERROR_CODE_COMMAND_DISALLOWED;
8334d32b3f05SMatthias Ringwald     }
8335d32b3f05SMatthias Ringwald 
83369cb52963SMatthias Ringwald     hci_connection_t * conn = hci_connection_for_bd_addr_and_type(addr, addr_type);
83379cb52963SMatthias Ringwald     if (conn == NULL) {
833888f925b1SMatthias Ringwald         conn = create_connection_for_bd_addr_and_type(addr, addr_type, HCI_ROLE_MASTER);
83399cb52963SMatthias Ringwald         if (conn == false){
83409cb52963SMatthias Ringwald             // alloc failed
8341d8e8f12aSMatthias Ringwald             log_info("gap_connect: failed to alloc hci_connection_t");
83429cb52963SMatthias Ringwald             return BTSTACK_MEMORY_ALLOC_FAILED;
83439cb52963SMatthias Ringwald         }
83449cb52963SMatthias Ringwald     } else {
83459cb52963SMatthias Ringwald         switch (conn->state) {
83469cb52963SMatthias Ringwald             case RECEIVED_DISCONNECTION_COMPLETE:
83479cb52963SMatthias Ringwald                 // connection was just disconnected, reset state and allow re-connect
83489cb52963SMatthias Ringwald                 conn->role = HCI_ROLE_MASTER;
83499cb52963SMatthias Ringwald                 break;
83509cb52963SMatthias Ringwald             default:
83519cb52963SMatthias Ringwald                 return ERROR_CODE_COMMAND_DISALLOWED;
83529cb52963SMatthias Ringwald         }
83534f3229d8S[email protected]     }
8354d5b1a89eSMatthias Ringwald 
8355d5b1a89eSMatthias Ringwald     // set le connecting state
8356d5b1a89eSMatthias Ringwald     if (hci_is_le_connection_type(addr_type)){
8357d5b1a89eSMatthias Ringwald         hci_stack->le_connecting_request = LE_CONNECTING_DIRECT;
8358d5b1a89eSMatthias Ringwald     }
8359d5b1a89eSMatthias Ringwald 
83609cb52963SMatthias Ringwald     // trigger connect
8361d8e8f12aSMatthias Ringwald     log_info("gap_connect: send create connection next");
8362b0136355SMatthias Ringwald     conn->state = SEND_CREATE_CONNECTION;
8363b0136355SMatthias Ringwald     hci_run();
8364b0136355SMatthias Ringwald     return ERROR_CODE_SUCCESS;
8365b0136355SMatthias Ringwald }
8366b0136355SMatthias Ringwald 
83677851196eSmatthias.ringwald // @assumption: only a single outgoing LE Connection exists
8368d8e8f12aSMatthias Ringwald static hci_connection_t * gap_get_outgoing_connection(void){
8369665d90f2SMatthias Ringwald     btstack_linked_item_t *it;
8370a0da043fSMatthias Ringwald     for (it = (btstack_linked_item_t *) hci_stack->connections; it != NULL; it = it->next){
83710bf6344aS[email protected]         hci_connection_t * conn = (hci_connection_t *) it;
83720bf6344aS[email protected]         if (!hci_is_le_connection(conn)) continue;
83730bf6344aS[email protected]         switch (conn->state){
8374a6725849S[email protected]             case SEND_CREATE_CONNECTION:
83757851196eSmatthias.ringwald             case SENT_CREATE_CONNECTION:
83767851196eSmatthias.ringwald                 return conn;
83777851196eSmatthias.ringwald             default:
83787851196eSmatthias.ringwald                 break;
83797851196eSmatthias.ringwald         };
83807851196eSmatthias.ringwald     }
83817851196eSmatthias.ringwald     return NULL;
83827851196eSmatthias.ringwald }
83837851196eSmatthias.ringwald 
8384d8e8f12aSMatthias Ringwald uint8_t gap_connect_cancel(void){
838514f2d8f0SMatthias Ringwald     hci_connection_t * conn;
838614f2d8f0SMatthias Ringwald     switch (hci_stack->le_connecting_request){
838714f2d8f0SMatthias Ringwald         case LE_CONNECTING_IDLE:
838814f2d8f0SMatthias Ringwald             break;
838914f2d8f0SMatthias Ringwald         case LE_CONNECTING_WHITELIST:
839014f2d8f0SMatthias Ringwald             hci_stack->le_connecting_request = LE_CONNECTING_IDLE;
839114f2d8f0SMatthias Ringwald             hci_run();
839214f2d8f0SMatthias Ringwald             break;
839314f2d8f0SMatthias Ringwald         case LE_CONNECTING_DIRECT:
839414f2d8f0SMatthias Ringwald             hci_stack->le_connecting_request = LE_CONNECTING_IDLE;
839514f2d8f0SMatthias Ringwald             conn = gap_get_outgoing_connection();
839614f2d8f0SMatthias Ringwald             if (conn == NULL){
839714f2d8f0SMatthias Ringwald                 hci_run();
839814f2d8f0SMatthias Ringwald             } else {
83997851196eSmatthias.ringwald                 switch (conn->state){
84007851196eSmatthias.ringwald                     case SEND_CREATE_CONNECTION:
84017851196eSmatthias.ringwald                         // skip sending create connection and emit event instead
84022e77e513S[email protected]                         hci_emit_le_connection_complete(conn->address_type, conn->address, 0, ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER);
8403665d90f2SMatthias Ringwald                         btstack_linked_list_remove(&hci_stack->connections, (btstack_linked_item_t *) conn);
84047851196eSmatthias.ringwald                         btstack_memory_hci_connection_free( conn );
84050bf6344aS[email protected]                         break;
8406a6725849S[email protected]                     case SENT_CREATE_CONNECTION:
8407ea04fbd8SMatthias Ringwald                         // let hci_run_general_gap_le cancel outgoing connection
84080bf6344aS[email protected]                         hci_run();
84090bf6344aS[email protected]                         break;
84100bf6344aS[email protected]                     default:
84110bf6344aS[email protected]                         break;
84120bf6344aS[email protected]                 }
841314f2d8f0SMatthias Ringwald             }
841414f2d8f0SMatthias Ringwald             break;
841543dfd98aSMatthias Ringwald         default:
841614f2d8f0SMatthias Ringwald             btstack_unreachable();
841714f2d8f0SMatthias Ringwald             break;
841814f2d8f0SMatthias Ringwald     }
841914f2d8f0SMatthias Ringwald     return ERROR_CODE_SUCCESS;
8420e31f89a7S[email protected] }
84214f3229d8S[email protected] 
8422c37a3166S[email protected] /**
84236012052bSMatthias Ringwald  * @brief Set connection parameters for outgoing connections
8424cbe54ab2SJakob Krantz  * @param conn_scan_interval (unit: 0.625 msec), default: 60 ms
8425cbe54ab2SJakob Krantz  * @param conn_scan_window (unit: 0.625 msec), default: 30 ms
84266012052bSMatthias Ringwald  * @param conn_interval_min (unit: 1.25ms), default: 10 ms
84276012052bSMatthias Ringwald  * @param conn_interval_max (unit: 1.25ms), default: 30 ms
84286012052bSMatthias Ringwald  * @param conn_latency, default: 4
84296012052bSMatthias Ringwald  * @param supervision_timeout (unit: 10ms), default: 720 ms
84306012052bSMatthias Ringwald  * @param min_ce_length (unit: 0.625ms), default: 10 ms
84316012052bSMatthias Ringwald  * @param max_ce_length (unit: 0.625ms), default: 30 ms
84326012052bSMatthias Ringwald  */
84336012052bSMatthias Ringwald 
84340c2c5f79SMatthias Ringwald void gap_set_connection_phys(uint8_t phys){
84350c2c5f79SMatthias Ringwald     // LE Coded, LE 1M, LE 2M PHY
84360c2c5f79SMatthias Ringwald     hci_stack->le_connection_phys = phys & 7;
84370c2c5f79SMatthias Ringwald }
84380c2c5f79SMatthias Ringwald 
84390c2c5f79SMatthias Ringwald #endif
84400c2c5f79SMatthias Ringwald 
8441cbe54ab2SJakob Krantz void gap_set_connection_parameters(uint16_t conn_scan_interval, uint16_t conn_scan_window,
8442cbe54ab2SJakob Krantz                                    uint16_t conn_interval_min, uint16_t conn_interval_max, uint16_t conn_latency,
8443cbe54ab2SJakob Krantz                                    uint16_t supervision_timeout, uint16_t min_ce_length, uint16_t max_ce_length){
8444cbe54ab2SJakob Krantz     hci_stack->le_connection_scan_interval = conn_scan_interval;
8445cbe54ab2SJakob Krantz     hci_stack->le_connection_scan_window = conn_scan_window;
84466012052bSMatthias Ringwald     hci_stack->le_connection_interval_min = conn_interval_min;
84476012052bSMatthias Ringwald     hci_stack->le_connection_interval_max = conn_interval_max;
84486012052bSMatthias Ringwald     hci_stack->le_connection_latency = conn_latency;
84496012052bSMatthias Ringwald     hci_stack->le_supervision_timeout = supervision_timeout;
84506012052bSMatthias Ringwald     hci_stack->le_minimum_ce_length = min_ce_length;
84516012052bSMatthias Ringwald     hci_stack->le_maximum_ce_length = max_ce_length;
84526012052bSMatthias Ringwald }
84537eb5b27eSMatthias Ringwald 
84546012052bSMatthias Ringwald /**
8455c37a3166S[email protected]  * @brief Updates the connection parameters for a given LE connection
8456c37a3166S[email protected]  * @param handle
8457c37a3166S[email protected]  * @param conn_interval_min (unit: 1.25ms)
8458c37a3166S[email protected]  * @param conn_interval_max (unit: 1.25ms)
8459c37a3166S[email protected]  * @param conn_latency
8460c37a3166S[email protected]  * @param supervision_timeout (unit: 10ms)
84616b65794dSMilanka Ringwald  * @return 0 if ok
8462c37a3166S[email protected]  */
8463c37a3166S[email protected] int gap_update_connection_parameters(hci_con_handle_t con_handle, uint16_t conn_interval_min,
8464c37a3166S[email protected]     uint16_t conn_interval_max, uint16_t conn_latency, uint16_t supervision_timeout){
8465c37a3166S[email protected]     hci_connection_t * connection = hci_connection_for_handle(con_handle);
8466c37a3166S[email protected]     if (!connection) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
8467c37a3166S[email protected]     connection->le_conn_interval_min = conn_interval_min;
8468c37a3166S[email protected]     connection->le_conn_interval_max = conn_interval_max;
8469c37a3166S[email protected]     connection->le_conn_latency = conn_latency;
8470c37a3166S[email protected]     connection->le_supervision_timeout = supervision_timeout;
847184cf6d83SMatthias Ringwald     connection->le_con_parameter_update_state = CON_PARAMETER_UPDATE_CHANGE_HCI_CON_PARAMETERS;
8472cfc59f1bSMatthias Ringwald     hci_run();
8473c37a3166S[email protected]     return 0;
8474c37a3166S[email protected] }
8475c37a3166S[email protected] 
847645c102fdSMatthias Ringwald /**
8477b68d7bc3SMatthias Ringwald  * @brief Request an update of the connection parameter for a given LE connection
8478b68d7bc3SMatthias Ringwald  * @param handle
8479b68d7bc3SMatthias Ringwald  * @param conn_interval_min (unit: 1.25ms)
8480b68d7bc3SMatthias Ringwald  * @param conn_interval_max (unit: 1.25ms)
8481b68d7bc3SMatthias Ringwald  * @param conn_latency
8482b68d7bc3SMatthias Ringwald  * @param supervision_timeout (unit: 10ms)
84836b65794dSMilanka Ringwald  * @return 0 if ok
8484b68d7bc3SMatthias Ringwald  */
8485b68d7bc3SMatthias Ringwald int gap_request_connection_parameter_update(hci_con_handle_t con_handle, uint16_t conn_interval_min,
8486b68d7bc3SMatthias Ringwald     uint16_t conn_interval_max, uint16_t conn_latency, uint16_t supervision_timeout){
8487b68d7bc3SMatthias Ringwald     hci_connection_t * connection = hci_connection_for_handle(con_handle);
8488b68d7bc3SMatthias Ringwald     if (!connection) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
8489b68d7bc3SMatthias Ringwald     connection->le_conn_interval_min = conn_interval_min;
8490b68d7bc3SMatthias Ringwald     connection->le_conn_interval_max = conn_interval_max;
8491b68d7bc3SMatthias Ringwald     connection->le_conn_latency = conn_latency;
8492b68d7bc3SMatthias Ringwald     connection->le_supervision_timeout = supervision_timeout;
8493b68d7bc3SMatthias Ringwald     connection->le_con_parameter_update_state = CON_PARAMETER_UPDATE_SEND_REQUEST;
849409c9c963SMatthias Ringwald     uint8_t l2cap_trigger_run_event[2] = { L2CAP_EVENT_TRIGGER_RUN, 0};
849509c9c963SMatthias Ringwald     hci_emit_event(l2cap_trigger_run_event, sizeof(l2cap_trigger_run_event), 0);
8496b68d7bc3SMatthias Ringwald     return 0;
8497b68d7bc3SMatthias Ringwald }
8498b68d7bc3SMatthias Ringwald 
8499d70217a2SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
8500d70217a2SMatthias Ringwald 
85015e05c0afSMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
85025e05c0afSMatthias Ringwald static void hci_assert_advertisement_set_0_ready(void){
85035e05c0afSMatthias Ringwald     // force advertising set creation for legacy LE Advertising
85045e05c0afSMatthias Ringwald     if ((hci_stack->le_advertisements_state & LE_ADVERTISEMENT_STATE_PARAMS_SET) == 0){
85055e05c0afSMatthias Ringwald         hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_SET_PARAMS;
85065e05c0afSMatthias Ringwald     }
85075e05c0afSMatthias Ringwald }
85085e05c0afSMatthias Ringwald #endif
85095e05c0afSMatthias Ringwald 
8510b68d7bc3SMatthias Ringwald /**
851145c102fdSMatthias Ringwald  * @brief Set Advertisement Data
851245c102fdSMatthias Ringwald  * @param advertising_data_length
851345c102fdSMatthias Ringwald  * @param advertising_data (max 31 octets)
851445c102fdSMatthias Ringwald  * @note data is not copied, pointer has to stay valid
851545c102fdSMatthias Ringwald  */
851645c102fdSMatthias Ringwald void gap_advertisements_set_data(uint8_t advertising_data_length, uint8_t * advertising_data){
851745c102fdSMatthias Ringwald     hci_stack->le_advertisements_data_len = advertising_data_length;
851845c102fdSMatthias Ringwald     hci_stack->le_advertisements_data = advertising_data;
8519501f56b3SMatthias Ringwald     hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_SET_ADV_DATA;
85205e05c0afSMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
85215e05c0afSMatthias Ringwald     hci_assert_advertisement_set_0_ready();
85225e05c0afSMatthias Ringwald #endif
8523bbc366e6SMatthias Ringwald     hci_run();
852445c102fdSMatthias Ringwald }
8525501f56b3SMatthias Ringwald 
8526501f56b3SMatthias Ringwald /**
8527501f56b3SMatthias Ringwald  * @brief Set Scan Response Data
8528501f56b3SMatthias Ringwald  * @param advertising_data_length
8529501f56b3SMatthias Ringwald  * @param advertising_data (max 31 octets)
8530501f56b3SMatthias Ringwald  * @note data is not copied, pointer has to stay valid
8531501f56b3SMatthias Ringwald  */
8532501f56b3SMatthias Ringwald void gap_scan_response_set_data(uint8_t scan_response_data_length, uint8_t * scan_response_data){
8533501f56b3SMatthias Ringwald     hci_stack->le_scan_response_data_len = scan_response_data_length;
8534501f56b3SMatthias Ringwald     hci_stack->le_scan_response_data = scan_response_data;
8535501f56b3SMatthias Ringwald     hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_SET_SCAN_DATA;
85365e05c0afSMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
85375e05c0afSMatthias Ringwald     hci_assert_advertisement_set_0_ready();
85385e05c0afSMatthias Ringwald #endif
8539bbc366e6SMatthias Ringwald     hci_run();
854045c102fdSMatthias Ringwald }
854145c102fdSMatthias Ringwald 
854245c102fdSMatthias Ringwald /**
854345c102fdSMatthias Ringwald  * @brief Set Advertisement Parameters
854445c102fdSMatthias Ringwald  * @param adv_int_min
854545c102fdSMatthias Ringwald  * @param adv_int_max
854645c102fdSMatthias Ringwald  * @param adv_type
854745c102fdSMatthias Ringwald  * @param direct_address_type
854845c102fdSMatthias Ringwald  * @param direct_address
854945c102fdSMatthias Ringwald  * @param channel_map
855045c102fdSMatthias Ringwald  * @param filter_policy
855145c102fdSMatthias Ringwald  *
855245c102fdSMatthias Ringwald  * @note internal use. use gap_advertisements_set_params from gap_le.h instead.
855345c102fdSMatthias Ringwald  */
855445c102fdSMatthias Ringwald  void hci_le_advertisements_set_params(uint16_t adv_int_min, uint16_t adv_int_max, uint8_t adv_type,
8555b95a5a35SMatthias Ringwald     uint8_t direct_address_typ, bd_addr_t direct_address,
855645c102fdSMatthias Ringwald     uint8_t channel_map, uint8_t filter_policy) {
855745c102fdSMatthias Ringwald 
855845c102fdSMatthias Ringwald     hci_stack->le_advertisements_interval_min = adv_int_min;
855945c102fdSMatthias Ringwald     hci_stack->le_advertisements_interval_max = adv_int_max;
856045c102fdSMatthias Ringwald     hci_stack->le_advertisements_type = adv_type;
856145c102fdSMatthias Ringwald     hci_stack->le_advertisements_direct_address_type = direct_address_typ;
856245c102fdSMatthias Ringwald     hci_stack->le_advertisements_channel_map = channel_map;
856345c102fdSMatthias Ringwald     hci_stack->le_advertisements_filter_policy = filter_policy;
85646535961aSMatthias Ringwald     (void)memcpy(hci_stack->le_advertisements_direct_address, direct_address,
85656535961aSMatthias Ringwald                  6);
856645c102fdSMatthias Ringwald 
85676bf435a6SMatthias Ringwald     hci_stack->le_advertisements_todo  |= LE_ADVERTISEMENT_TASKS_SET_PARAMS;
85686bf435a6SMatthias Ringwald     hci_stack->le_advertisements_state |= LE_ADVERTISEMENT_STATE_PARAMS_SET;
8569bbc366e6SMatthias Ringwald     hci_run();
857045c102fdSMatthias Ringwald  }
857145c102fdSMatthias Ringwald 
857245c102fdSMatthias Ringwald /**
857345c102fdSMatthias Ringwald  * @brief Enable/Disable Advertisements
857445c102fdSMatthias Ringwald  * @param enabled
857545c102fdSMatthias Ringwald  */
857645c102fdSMatthias Ringwald void gap_advertisements_enable(int enabled){
8577a408e724SMatthias Ringwald     if (enabled == 0){
8578a408e724SMatthias Ringwald         hci_stack->le_advertisements_state &= ~LE_ADVERTISEMENT_STATE_ENABLED;
8579a408e724SMatthias Ringwald     } else {
8580a408e724SMatthias Ringwald         hci_stack->le_advertisements_state |= LE_ADVERTISEMENT_STATE_ENABLED;
8581a408e724SMatthias Ringwald     }
8582bbc366e6SMatthias Ringwald     hci_update_advertisements_enabled_for_current_roles();
8583cfc59f1bSMatthias Ringwald     hci_run();
858445c102fdSMatthias Ringwald }
858545c102fdSMatthias Ringwald 
8586a5770ecbSMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
8587a5770ecbSMatthias Ringwald static le_advertising_set_t * hci_advertising_set_for_handle(uint8_t advertising_handle){
8588a5770ecbSMatthias Ringwald     btstack_linked_list_iterator_t it;
8589a5770ecbSMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->le_advertising_sets);
8590a5770ecbSMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
8591a5770ecbSMatthias Ringwald         le_advertising_set_t * item = (le_advertising_set_t *) btstack_linked_list_iterator_next(&it);
8592a5770ecbSMatthias Ringwald         if ( item->advertising_handle == advertising_handle ) {
8593a5770ecbSMatthias Ringwald             return item;
8594a5770ecbSMatthias Ringwald         }
8595a5770ecbSMatthias Ringwald     }
8596a5770ecbSMatthias Ringwald     return NULL;
8597a5770ecbSMatthias Ringwald }
8598a5770ecbSMatthias Ringwald 
85992052d96cSMatthias Ringwald uint8_t gap_extended_advertising_set_resolvable_private_address_update(uint16_t update_s){
86002052d96cSMatthias Ringwald     hci_stack->le_resolvable_private_address_update_s = update_s;
86012052d96cSMatthias Ringwald     hci_run();
86022052d96cSMatthias Ringwald     return ERROR_CODE_SUCCESS;
86032052d96cSMatthias Ringwald }
86042052d96cSMatthias Ringwald 
8605a5770ecbSMatthias 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){
8606a5770ecbSMatthias Ringwald     // find free advertisement handle
8607a5770ecbSMatthias Ringwald     uint8_t advertisement_handle;
8608a5770ecbSMatthias Ringwald     for (advertisement_handle = 1; advertisement_handle <= LE_EXTENDED_ADVERTISING_MAX_HANDLE; advertisement_handle++){
8609a5770ecbSMatthias Ringwald         if (hci_advertising_set_for_handle(advertisement_handle) == NULL) break;
8610a5770ecbSMatthias Ringwald     }
8611a5770ecbSMatthias Ringwald     if (advertisement_handle > LE_EXTENDED_ADVERTISING_MAX_HANDLE) return ERROR_CODE_MEMORY_CAPACITY_EXCEEDED;
8612a5770ecbSMatthias Ringwald     // clear
8613a5770ecbSMatthias Ringwald     memset(storage, 0, sizeof(le_advertising_set_t));
8614a5770ecbSMatthias Ringwald     // copy params
86150cbe4690SMatthias Ringwald     storage->advertising_handle = advertisement_handle;
861657a04237SMatthias Ringwald     memcpy(&storage->extended_params, advertising_parameters, sizeof(le_extended_advertising_parameters_t));
8617a5770ecbSMatthias Ringwald     // add to list
8618a5770ecbSMatthias Ringwald     bool add_ok = btstack_linked_list_add(&hci_stack->le_advertising_sets, (btstack_linked_item_t *) storage);
8619a5770ecbSMatthias Ringwald     if (!add_ok) return ERROR_CODE_ACL_CONNECTION_ALREADY_EXISTS;
86200cbe4690SMatthias Ringwald     *out_advertising_handle = advertisement_handle;
8621a5770ecbSMatthias Ringwald     // set tasks and start
8622a5770ecbSMatthias Ringwald     storage->tasks = LE_ADVERTISEMENT_TASKS_SET_PARAMS;
8623a5770ecbSMatthias Ringwald     hci_run();
8624a5770ecbSMatthias Ringwald     return ERROR_CODE_SUCCESS;
8625a5770ecbSMatthias Ringwald }
8626a5770ecbSMatthias Ringwald 
8627a5770ecbSMatthias Ringwald uint8_t gap_extended_advertising_set_params(uint8_t advertising_handle, const le_extended_advertising_parameters_t * advertising_parameters){
8628a5770ecbSMatthias Ringwald     le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(advertising_handle);
8629a5770ecbSMatthias Ringwald     if (advertising_set == NULL) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
863057a04237SMatthias Ringwald     memcpy(&advertising_set->extended_params, advertising_parameters, sizeof(le_extended_advertising_parameters_t));
8631a5770ecbSMatthias Ringwald     // set tasks and start
8632a5770ecbSMatthias Ringwald     advertising_set->tasks |= LE_ADVERTISEMENT_TASKS_SET_PARAMS;
8633a5770ecbSMatthias Ringwald     hci_run();
8634a5770ecbSMatthias Ringwald     return ERROR_CODE_SUCCESS;
8635a5770ecbSMatthias Ringwald }
8636a5770ecbSMatthias Ringwald 
8637a5770ecbSMatthias Ringwald uint8_t gap_extended_advertising_get_params(uint8_t advertising_handle, le_extended_advertising_parameters_t * advertising_parameters){
8638a5770ecbSMatthias Ringwald     le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(advertising_handle);
8639a5770ecbSMatthias Ringwald     if (advertising_set == NULL) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
864057a04237SMatthias Ringwald     memcpy(advertising_parameters, &advertising_set->extended_params, sizeof(le_extended_advertising_parameters_t));
8641a5770ecbSMatthias Ringwald     return ERROR_CODE_SUCCESS;
8642a5770ecbSMatthias Ringwald }
8643a5770ecbSMatthias Ringwald 
8644a5770ecbSMatthias Ringwald uint8_t gap_extended_advertising_set_random_address(uint8_t advertising_handle, bd_addr_t random_address){
8645a5770ecbSMatthias Ringwald     le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(advertising_handle);
8646a5770ecbSMatthias Ringwald     if (advertising_set == NULL) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
8647a5770ecbSMatthias Ringwald     memcpy(advertising_set->random_address, random_address, 6);
8648a5770ecbSMatthias Ringwald     // set tasks and start
8649a5770ecbSMatthias Ringwald     advertising_set->tasks |= LE_ADVERTISEMENT_TASKS_SET_ADDRESS;
8650a5770ecbSMatthias Ringwald     hci_run();
8651a5770ecbSMatthias Ringwald     return ERROR_CODE_SUCCESS;
8652a5770ecbSMatthias Ringwald }
8653a5770ecbSMatthias Ringwald 
86542e4aaf70SMatthias Ringwald uint8_t gap_extended_advertising_set_adv_data(uint8_t advertising_handle, uint16_t advertising_data_length, const uint8_t * advertising_data){
8655a5770ecbSMatthias Ringwald     le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(advertising_handle);
8656a5770ecbSMatthias Ringwald     if (advertising_set == NULL) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
8657a5770ecbSMatthias Ringwald     advertising_set->adv_data = advertising_data;
8658a5770ecbSMatthias Ringwald     advertising_set->adv_data_len = advertising_data_length;
8659a5770ecbSMatthias Ringwald     // set tasks and start
8660a5770ecbSMatthias Ringwald     advertising_set->tasks |= LE_ADVERTISEMENT_TASKS_SET_ADV_DATA;
8661a5770ecbSMatthias Ringwald     hci_run();
8662a5770ecbSMatthias Ringwald     return ERROR_CODE_SUCCESS;
8663a5770ecbSMatthias Ringwald }
8664a5770ecbSMatthias Ringwald 
86652e4aaf70SMatthias 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){
8666a5770ecbSMatthias Ringwald     le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(advertising_handle);
8667a5770ecbSMatthias Ringwald     if (advertising_set == NULL) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
8668a5770ecbSMatthias Ringwald     advertising_set->scan_data = scan_response_data;
8669a5770ecbSMatthias Ringwald     advertising_set->scan_data_len = scan_response_data_length;
8670a5770ecbSMatthias Ringwald     // set tasks and start
8671a5770ecbSMatthias Ringwald     advertising_set->tasks |= LE_ADVERTISEMENT_TASKS_SET_SCAN_DATA;
8672a5770ecbSMatthias Ringwald     hci_run();
8673a5770ecbSMatthias Ringwald     return ERROR_CODE_SUCCESS;
8674a5770ecbSMatthias Ringwald }
8675a5770ecbSMatthias Ringwald 
8676a5770ecbSMatthias Ringwald uint8_t gap_extended_advertising_start(uint8_t advertising_handle, uint16_t timeout, uint8_t num_extended_advertising_events){
8677a5770ecbSMatthias Ringwald     le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(advertising_handle);
8678a5770ecbSMatthias Ringwald     if (advertising_set == NULL) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
8679a5770ecbSMatthias Ringwald     advertising_set->enable_timeout = timeout;
8680a5770ecbSMatthias Ringwald     advertising_set->enable_max_scan_events = num_extended_advertising_events;
8681a5770ecbSMatthias Ringwald     // set tasks and start
8682a5770ecbSMatthias Ringwald     advertising_set->state |= LE_ADVERTISEMENT_STATE_ENABLED;
8683a5770ecbSMatthias Ringwald     hci_run();
8684a5770ecbSMatthias Ringwald     return ERROR_CODE_SUCCESS;
8685a5770ecbSMatthias Ringwald }
8686a5770ecbSMatthias Ringwald 
8687a5770ecbSMatthias Ringwald uint8_t gap_extended_advertising_stop(uint8_t advertising_handle){
8688a5770ecbSMatthias Ringwald     le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(advertising_handle);
8689a5770ecbSMatthias Ringwald     if (advertising_set == NULL) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
8690a5770ecbSMatthias Ringwald     // set tasks and start
8691a5770ecbSMatthias Ringwald     advertising_set->state &= ~LE_ADVERTISEMENT_STATE_ENABLED;
8692a5770ecbSMatthias Ringwald     hci_run();
8693a5770ecbSMatthias Ringwald     return ERROR_CODE_SUCCESS;
8694a5770ecbSMatthias Ringwald }
8695a5770ecbSMatthias Ringwald 
8696c814a904SMatthias Ringwald uint8_t gap_extended_advertising_remove(uint8_t advertising_handle){
8697c814a904SMatthias Ringwald     le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(advertising_handle);
8698c814a904SMatthias Ringwald     if (advertising_set == NULL) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
8699c814a904SMatthias Ringwald     // set tasks and start
8700c814a904SMatthias Ringwald     advertising_set->tasks |= LE_ADVERTISEMENT_TASKS_REMOVE_SET;
8701c814a904SMatthias Ringwald     hci_run();
8702c814a904SMatthias Ringwald     return ERROR_CODE_SUCCESS;
8703c814a904SMatthias Ringwald }
8704c814a904SMatthias Ringwald 
8705c814a904SMatthias Ringwald #ifdef ENABLE_LE_PERIODIC_ADVERTISING
8706c814a904SMatthias Ringwald uint8_t gap_periodic_advertising_set_params(uint8_t advertising_handle, const le_periodic_advertising_parameters_t * advertising_parameters){
8707c814a904SMatthias Ringwald     le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(advertising_handle);
8708c814a904SMatthias Ringwald     if (advertising_set == NULL) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
8709c814a904SMatthias Ringwald     // periodic advertising requires neither connectable, scannable, legacy or anonymous
8710c814a904SMatthias Ringwald     if ((advertising_set->extended_params.advertising_event_properties & 0x1f) != 0) return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS;
8711c814a904SMatthias Ringwald     memcpy(&advertising_set->periodic_params, advertising_parameters, sizeof(le_periodic_advertising_parameters_t));
8712c814a904SMatthias Ringwald     // set tasks and start
8713c814a904SMatthias Ringwald     advertising_set->tasks |= LE_ADVERTISEMENT_TASKS_SET_PERIODIC_PARAMS;
8714c814a904SMatthias Ringwald     hci_run();
8715c814a904SMatthias Ringwald     return ERROR_CODE_SUCCESS;
8716c814a904SMatthias Ringwald }
8717c814a904SMatthias Ringwald 
8718c814a904SMatthias Ringwald uint8_t gap_periodic_advertising_get_params(uint8_t advertising_handle, le_periodic_advertising_parameters_t * advertising_parameters){
8719c814a904SMatthias Ringwald     le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(advertising_handle);
8720c814a904SMatthias Ringwald     if (advertising_set == NULL) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
8721c814a904SMatthias Ringwald     memcpy(advertising_parameters, &advertising_set->extended_params, sizeof(le_periodic_advertising_parameters_t));
8722c814a904SMatthias Ringwald     return ERROR_CODE_SUCCESS;
8723c814a904SMatthias Ringwald }
8724c814a904SMatthias Ringwald 
8725c814a904SMatthias Ringwald uint8_t gap_periodic_advertising_set_data(uint8_t advertising_handle, uint16_t periodic_data_length, const uint8_t * periodic_data){
8726c814a904SMatthias Ringwald     le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(advertising_handle);
8727c814a904SMatthias Ringwald     if (advertising_set == NULL) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
8728c814a904SMatthias Ringwald     advertising_set->periodic_data = periodic_data;
8729c814a904SMatthias Ringwald     advertising_set->periodic_data_len = periodic_data_length;
8730c814a904SMatthias Ringwald     // set tasks and start
8731c814a904SMatthias Ringwald     advertising_set->tasks |= LE_ADVERTISEMENT_TASKS_SET_PERIODIC_DATA;
8732c814a904SMatthias Ringwald     hci_run();
8733c814a904SMatthias Ringwald     return ERROR_CODE_SUCCESS;
8734c814a904SMatthias Ringwald }
8735c814a904SMatthias Ringwald 
873653f240c0SMatthias Ringwald uint8_t gap_periodic_advertising_start(uint8_t advertising_handle, bool include_adi){
873753f240c0SMatthias Ringwald     le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(advertising_handle);
873853f240c0SMatthias Ringwald     if (advertising_set == NULL) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
873953f240c0SMatthias Ringwald     // set tasks and start
874053f240c0SMatthias Ringwald     advertising_set->periodic_include_adi = include_adi;
874153f240c0SMatthias Ringwald     advertising_set->state |= LE_ADVERTISEMENT_STATE_PERIODIC_ENABLED;
874253f240c0SMatthias Ringwald     hci_run();
874353f240c0SMatthias Ringwald     return ERROR_CODE_SUCCESS;
874453f240c0SMatthias Ringwald }
874553f240c0SMatthias Ringwald 
874653f240c0SMatthias Ringwald uint8_t gap_periodic_advertising_stop(uint8_t advertising_handle){
874753f240c0SMatthias Ringwald     le_advertising_set_t * advertising_set = hci_advertising_set_for_handle(advertising_handle);
874853f240c0SMatthias Ringwald     if (advertising_set == NULL) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
874953f240c0SMatthias Ringwald     // set tasks and start
875053f240c0SMatthias Ringwald     advertising_set->state &= ~LE_ADVERTISEMENT_STATE_PERIODIC_ENABLED;
875153f240c0SMatthias Ringwald     hci_run();
875253f240c0SMatthias Ringwald     return ERROR_CODE_SUCCESS;
875353f240c0SMatthias Ringwald }
875498aa715fSMatthias Ringwald 
875598aa715fSMatthias 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){
875698aa715fSMatthias Ringwald     hci_stack->le_past_mode = mode;
875798aa715fSMatthias Ringwald     hci_stack->le_past_skip = skip;
875898aa715fSMatthias Ringwald     hci_stack->le_past_sync_timeout = sync_timeout;
875998aa715fSMatthias Ringwald     hci_stack->le_past_cte_type = cte_type;
876098aa715fSMatthias Ringwald     hci_stack->le_past_set_default_params = true;
876198aa715fSMatthias Ringwald     hci_run();
876298aa715fSMatthias Ringwald     return ERROR_CODE_SUCCESS;
876398aa715fSMatthias Ringwald }
876498aa715fSMatthias Ringwald 
87653bd96807SMatthias 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){
87663bd96807SMatthias Ringwald     hci_connection_t * hci_connection = hci_connection_for_handle(con_handle);
87673bd96807SMatthias Ringwald     if (hci_connection == NULL){
87683bd96807SMatthias Ringwald         return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
87693bd96807SMatthias Ringwald     }
87703bd96807SMatthias Ringwald     hci_connection->le_past_sync_handle = sync_handle;
87713bd96807SMatthias Ringwald     hci_connection->le_past_service_data = service_data;
87723bd96807SMatthias Ringwald     hci_run();
87733bd96807SMatthias Ringwald     return ERROR_CODE_SUCCESS;
87743bd96807SMatthias Ringwald }
87753bd96807SMatthias Ringwald 
8776027f4677SMatthias Ringwald uint8_t gap_periodic_advertising_set_info_transfer_send(hci_con_handle_t con_handle, uint16_t service_data, uint8_t advertising_handle){
8777027f4677SMatthias Ringwald     hci_connection_t * hci_connection = hci_connection_for_handle(con_handle);
8778027f4677SMatthias Ringwald     if (hci_connection == NULL){
8779027f4677SMatthias Ringwald         return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
8780027f4677SMatthias Ringwald     }
8781027f4677SMatthias Ringwald     hci_connection->le_past_advertising_handle = advertising_handle;
8782027f4677SMatthias Ringwald     hci_connection->le_past_service_data = service_data;
8783027f4677SMatthias Ringwald     hci_run();
8784027f4677SMatthias Ringwald     return ERROR_CODE_SUCCESS;
8785027f4677SMatthias Ringwald }
8786027f4677SMatthias Ringwald 
8787c814a904SMatthias Ringwald #endif /* ENABLE_LE_PERIODIC_ADVERTISING */
878853f240c0SMatthias Ringwald 
8789a5770ecbSMatthias Ringwald #endif
8790a5770ecbSMatthias Ringwald 
879135454696SMatthias Ringwald #endif
879206e5cf96SMatthias Ringwald 
879306e5cf96SMatthias Ringwald void hci_le_set_own_address_type(uint8_t own_address_type){
879406e5cf96SMatthias Ringwald     log_info("hci_le_set_own_address_type: old %u, new %u", hci_stack->le_own_addr_type, own_address_type);
879506e5cf96SMatthias Ringwald     if (own_address_type == hci_stack->le_own_addr_type) return;
879606e5cf96SMatthias Ringwald     hci_stack->le_own_addr_type = own_address_type;
879706e5cf96SMatthias Ringwald 
879864068776SMatthias Ringwald #ifdef ENABLE_LE_PERIPHERAL
879906e5cf96SMatthias Ringwald     // update advertisement parameters, too
880006e5cf96SMatthias Ringwald     hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_SET_PARAMS;
8801bbc366e6SMatthias Ringwald     hci_run();
880264068776SMatthias Ringwald #endif
880364068776SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
880406e5cf96SMatthias Ringwald     // note: we don't update scan parameters or modify ongoing connection attempts
880564068776SMatthias Ringwald #endif
880606e5cf96SMatthias Ringwald }
880706e5cf96SMatthias Ringwald 
88089136bde8SMatthias Ringwald void hci_le_random_address_set(const bd_addr_t random_address){
88099136bde8SMatthias Ringwald     memcpy(hci_stack->le_random_address, random_address, 6);
88109136bde8SMatthias Ringwald     hci_stack->le_random_address_set = true;
88119136bde8SMatthias Ringwald     hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_SET_ADDRESS;
88129ce6dfa1SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
88139ce6dfa1SMatthias Ringwald     if (hci_extended_advertising_supported()){
88145e05c0afSMatthias Ringwald         hci_assert_advertisement_set_0_ready();
88159ce6dfa1SMatthias Ringwald         hci_stack->le_advertisements_todo |= LE_ADVERTISEMENT_TASKS_SET_ADDRESS_SET_0;
88169ce6dfa1SMatthias Ringwald     }
88179ce6dfa1SMatthias Ringwald #endif
88189136bde8SMatthias Ringwald     hci_run();
88199136bde8SMatthias Ringwald }
88209136bde8SMatthias Ringwald 
8821d70217a2SMatthias Ringwald #endif
882245c102fdSMatthias Ringwald 
8823616edd56SMatthias Ringwald uint8_t gap_disconnect(hci_con_handle_t handle){
88245917a5c5S[email protected]     hci_connection_t * conn = hci_connection_for_handle(handle);
88255917a5c5S[email protected]     if (!conn){
88267851196eSmatthias.ringwald         hci_emit_disconnection_complete(handle, 0);
8827616edd56SMatthias Ringwald         return 0;
88285917a5c5S[email protected]     }
88297fd7aa6fSMatthias Ringwald     // ignore if already disconnected
88307fd7aa6fSMatthias Ringwald     if (conn->state == RECEIVED_DISCONNECTION_COMPLETE){
88317fd7aa6fSMatthias Ringwald         return 0;
88327fd7aa6fSMatthias Ringwald     }
88335917a5c5S[email protected]     conn->state = SEND_DISCONNECT;
88345917a5c5S[email protected]     hci_run();
8835616edd56SMatthias Ringwald     return 0;
88364f3229d8S[email protected] }
883704a6ef8cSmatthias.ringwald 
8838228e430cSMatthias Ringwald int gap_read_rssi(hci_con_handle_t con_handle){
8839228e430cSMatthias Ringwald     hci_connection_t * hci_connection = hci_connection_for_handle(con_handle);
8840228e430cSMatthias Ringwald     if (hci_connection == NULL) return 0;
884122df2fe2SMatthias Ringwald     hci_connection->gap_connection_tasks |= GAP_CONNECTION_TASK_READ_RSSI;
8842228e430cSMatthias Ringwald     hci_run();
8843228e430cSMatthias Ringwald     return 1;
8844228e430cSMatthias Ringwald }
8845228e430cSMatthias Ringwald 
8846a1bf5ae7SMatthias Ringwald /**
8847a1bf5ae7SMatthias Ringwald  * @brief Get connection type
8848a1bf5ae7SMatthias Ringwald  * @param con_handle
8849a1bf5ae7SMatthias Ringwald  * @result connection_type
8850a1bf5ae7SMatthias Ringwald  */
8851a1bf5ae7SMatthias Ringwald gap_connection_type_t gap_get_connection_type(hci_con_handle_t connection_handle){
8852a1bf5ae7SMatthias Ringwald     hci_connection_t * conn = hci_connection_for_handle(connection_handle);
8853a1bf5ae7SMatthias Ringwald     if (!conn) return GAP_CONNECTION_INVALID;
8854a1bf5ae7SMatthias Ringwald     switch (conn->address_type){
8855a1bf5ae7SMatthias Ringwald         case BD_ADDR_TYPE_LE_PUBLIC:
8856a1bf5ae7SMatthias Ringwald         case BD_ADDR_TYPE_LE_RANDOM:
8857ad9f3530SMatthias Ringwald         case BD_ADDR_TYPE_LE_PUBLIC_IDENTITY:
8858ad9f3530SMatthias Ringwald         case BD_ADDR_TYPE_LE_RANDOM_IDENTITY:
8859a1bf5ae7SMatthias Ringwald             return GAP_CONNECTION_LE;
8860a1bf5ae7SMatthias Ringwald         case BD_ADDR_TYPE_SCO:
8861a1bf5ae7SMatthias Ringwald             return GAP_CONNECTION_SCO;
8862f16129ceSMatthias Ringwald         case BD_ADDR_TYPE_ACL:
8863a1bf5ae7SMatthias Ringwald             return GAP_CONNECTION_ACL;
8864a1bf5ae7SMatthias Ringwald         default:
8865a1bf5ae7SMatthias Ringwald             return GAP_CONNECTION_INVALID;
8866a1bf5ae7SMatthias Ringwald     }
8867a1bf5ae7SMatthias Ringwald }
8868a1bf5ae7SMatthias Ringwald 
88692dceb1d6SMatthias Ringwald hci_role_t gap_get_role(hci_con_handle_t connection_handle){
88702dceb1d6SMatthias Ringwald     hci_connection_t * conn = hci_connection_for_handle(connection_handle);
88712dceb1d6SMatthias Ringwald     if (!conn) return HCI_ROLE_INVALID;
88722dceb1d6SMatthias Ringwald     return (hci_role_t) conn->role;
88732dceb1d6SMatthias Ringwald }
88742dceb1d6SMatthias Ringwald 
88752dceb1d6SMatthias Ringwald 
887644f858f3SMatthias Ringwald #ifdef ENABLE_CLASSIC
8877667ba9d1SMatthias Ringwald uint8_t gap_request_role(const bd_addr_t addr, hci_role_t role){
887888a03c8dSMatthias Ringwald     hci_connection_t * conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL);
887988a03c8dSMatthias Ringwald     if (!conn) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
888088a03c8dSMatthias Ringwald     conn->request_role = role;
888188a03c8dSMatthias Ringwald     hci_run();
8882d04a455eSMatthias Ringwald     return ERROR_CODE_SUCCESS;
888388a03c8dSMatthias Ringwald }
888444f858f3SMatthias Ringwald #endif
888588a03c8dSMatthias Ringwald 
8886a9a4c409SMatthias Ringwald #ifdef ENABLE_BLE
88874f551432SMatthias Ringwald 
88889d8be771SMatthias 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){
8889b45b7749SMilanka Ringwald     hci_connection_t * conn = hci_connection_for_handle(con_handle);
8890b90f6e0aSMatthias Ringwald     if (!conn) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
8891b90f6e0aSMatthias Ringwald 
8892b90f6e0aSMatthias Ringwald     conn->le_phy_update_all_phys    = all_phys;
8893b90f6e0aSMatthias Ringwald     conn->le_phy_update_tx_phys     = tx_phys;
8894b90f6e0aSMatthias Ringwald     conn->le_phy_update_rx_phys     = rx_phys;
88959d8be771SMatthias Ringwald     conn->le_phy_update_phy_options = (uint8_t) phy_options;
8896b90f6e0aSMatthias Ringwald 
8897b90f6e0aSMatthias Ringwald     hci_run();
8898b90f6e0aSMatthias Ringwald 
8899b90f6e0aSMatthias Ringwald     return 0;
8900b90f6e0aSMatthias Ringwald }
8901b90f6e0aSMatthias Ringwald 
8902667ba9d1SMatthias Ringwald static uint8_t hci_whitelist_add(bd_addr_type_t address_type, const bd_addr_t address){
8903100da355SMatthias Ringwald 
8904100da355SMatthias Ringwald #if !defined(HAVE_MALLOC) && (!defined(MAX_NR_WHITELIST_ENTRIES) || (MAX_NR_WHITELIST_ENTRIES == 0))
8905100da355SMatthias Ringwald     // incorrect configuration:
8906100da355SMatthias Ringwald     // - as MAX_NR_WHITELIST_ENTRIES is not defined or zero this function always fails
8907100da355SMatthias Ringwald     // - please set MAX_NR_WHITELIST_ENTRIES in btstack_config.h
8908100da355SMatthias Ringwald     btstack_assert(false);
8909100da355SMatthias Ringwald #endif
8910100da355SMatthias Ringwald 
89117a92a9dbSMatthias Ringwald     // check if already in list
89127a92a9dbSMatthias Ringwald     btstack_linked_list_iterator_t it;
89137a92a9dbSMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->le_whitelist);
89147a92a9dbSMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)) {
89157a92a9dbSMatthias Ringwald         whitelist_entry_t *entry = (whitelist_entry_t *) btstack_linked_list_iterator_next(&it);
89167a92a9dbSMatthias Ringwald         if (entry->address_type != address_type) {
89177a92a9dbSMatthias Ringwald             continue;
89187a92a9dbSMatthias Ringwald         }
89197a92a9dbSMatthias Ringwald         if (memcmp(entry->address, address, 6) != 0) {
89207a92a9dbSMatthias Ringwald             continue;
89217a92a9dbSMatthias Ringwald         }
8922caaf5151SMilanka Ringwald 
8923caaf5151SMilanka Ringwald         // if already on controller:
8924caaf5151SMilanka Ringwald         if ((entry->state & LE_WHITELIST_ON_CONTROLLER) != 0){
8925caaf5151SMilanka Ringwald             if ((entry->state & LE_WHITELIST_REMOVE_FROM_CONTROLLER) != 0){
8926caaf5151SMilanka Ringwald                 // drop remove request
8927caaf5151SMilanka Ringwald                 entry->state = LE_WHITELIST_ON_CONTROLLER;
8928caaf5151SMilanka Ringwald                 return ERROR_CODE_SUCCESS;
8929caaf5151SMilanka Ringwald             } else {
8930caaf5151SMilanka Ringwald                 // disallow as already on controller
89317a92a9dbSMatthias Ringwald                 return ERROR_CODE_COMMAND_DISALLOWED;
89327a92a9dbSMatthias Ringwald             }
8933287379ccSMatthias Ringwald         }
8934caaf5151SMilanka Ringwald 
8935caaf5151SMilanka Ringwald         // assume scheduled to add
8936caaf5151SMilanka Ringwald 		return ERROR_CODE_COMMAND_DISALLOWED;
8937caaf5151SMilanka Ringwald     }
8938caaf5151SMilanka Ringwald 
89397a92a9dbSMatthias Ringwald     // alloc and add to list
8940e83201bcSMatthias Ringwald     whitelist_entry_t * entry = btstack_memory_whitelist_entry_get();
8941e83201bcSMatthias Ringwald     if (!entry) return BTSTACK_MEMORY_ALLOC_FAILED;
8942e83201bcSMatthias Ringwald     entry->address_type = address_type;
89436535961aSMatthias Ringwald     (void)memcpy(entry->address, address, 6);
8944e83201bcSMatthias Ringwald     entry->state = LE_WHITELIST_ADD_TO_CONTROLLER;
8945665d90f2SMatthias Ringwald     btstack_linked_list_add(&hci_stack->le_whitelist, (btstack_linked_item_t*) entry);
8946226db5efSMatthias Ringwald     return ERROR_CODE_SUCCESS;
8947ac9c45e0SMatthias Ringwald }
8948ac9c45e0SMatthias Ringwald 
8949667ba9d1SMatthias Ringwald static uint8_t hci_whitelist_remove(bd_addr_type_t address_type, const bd_addr_t address){
8950665d90f2SMatthias Ringwald     btstack_linked_list_iterator_t it;
8951665d90f2SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->le_whitelist);
8952665d90f2SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
8953665d90f2SMatthias Ringwald         whitelist_entry_t * entry = (whitelist_entry_t*) btstack_linked_list_iterator_next(&it);
89547a92a9dbSMatthias Ringwald         if (entry->address_type != address_type) {
89557a92a9dbSMatthias Ringwald             continue;
89567a92a9dbSMatthias Ringwald         }
89577a92a9dbSMatthias Ringwald         if (memcmp(entry->address, address, 6) != 0) {
89587a92a9dbSMatthias Ringwald             continue;
89597a92a9dbSMatthias Ringwald         }
8960e83201bcSMatthias Ringwald         if (entry->state & LE_WHITELIST_ON_CONTROLLER){
8961e83201bcSMatthias Ringwald             // remove from controller if already present
8962e83201bcSMatthias Ringwald             entry->state |= LE_WHITELIST_REMOVE_FROM_CONTROLLER;
8963a3b69fdeSMatthias Ringwald         }  else {
8964226db5efSMatthias Ringwald             // directly remove entry from whitelist
8965665d90f2SMatthias Ringwald             btstack_linked_list_iterator_remove(&it);
8966e83201bcSMatthias Ringwald             btstack_memory_whitelist_entry_free(entry);
8967e83201bcSMatthias Ringwald         }
8968a3b69fdeSMatthias Ringwald         return ERROR_CODE_SUCCESS;
8969a3b69fdeSMatthias Ringwald     }
8970a3b69fdeSMatthias Ringwald     return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
897142ff5ba1SMatthias Ringwald }
897242ff5ba1SMatthias Ringwald 
8973226db5efSMatthias Ringwald static void hci_whitelist_clear(void){
8974665d90f2SMatthias Ringwald     btstack_linked_list_iterator_t it;
8975665d90f2SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->le_whitelist);
8976665d90f2SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
8977665d90f2SMatthias Ringwald         whitelist_entry_t * entry = (whitelist_entry_t*) btstack_linked_list_iterator_next(&it);
8978e83201bcSMatthias Ringwald         if (entry->state & LE_WHITELIST_ON_CONTROLLER){
8979e83201bcSMatthias Ringwald             // remove from controller if already present
8980e83201bcSMatthias Ringwald             entry->state |= LE_WHITELIST_REMOVE_FROM_CONTROLLER;
8981e83201bcSMatthias Ringwald             continue;
8982e83201bcSMatthias Ringwald         }
898391915b0bSMatthias Ringwald         // directly remove entry from whitelist
8984665d90f2SMatthias Ringwald         btstack_linked_list_iterator_remove(&it);
8985e83201bcSMatthias Ringwald         btstack_memory_whitelist_entry_free(entry);
8986e83201bcSMatthias Ringwald     }
8987226db5efSMatthias Ringwald }
8988226db5efSMatthias Ringwald 
8989a3b69fdeSMatthias Ringwald /**
8990a3b69fdeSMatthias Ringwald  * @brief Clear Whitelist
89916b65794dSMilanka Ringwald  * @return 0 if ok
8992a3b69fdeSMatthias Ringwald  */
8993a3b69fdeSMatthias Ringwald uint8_t gap_whitelist_clear(void){
8994a3b69fdeSMatthias Ringwald     hci_whitelist_clear();
8995a3b69fdeSMatthias Ringwald     hci_run();
8996a3b69fdeSMatthias Ringwald     return ERROR_CODE_SUCCESS;
8997a3b69fdeSMatthias Ringwald }
8998a3b69fdeSMatthias Ringwald 
8999a3b69fdeSMatthias Ringwald /**
9000a3b69fdeSMatthias Ringwald  * @brief Add Device to Whitelist
9001a3b69fdeSMatthias Ringwald  * @param address_typ
9002a3b69fdeSMatthias Ringwald  * @param address
90036b65794dSMilanka Ringwald  * @return 0 if ok
9004a3b69fdeSMatthias Ringwald  */
9005667ba9d1SMatthias Ringwald uint8_t gap_whitelist_add(bd_addr_type_t address_type, const bd_addr_t address){
9006a3b69fdeSMatthias Ringwald     uint8_t status = hci_whitelist_add(address_type, address);
9007a3b69fdeSMatthias Ringwald     if (status){
9008a3b69fdeSMatthias Ringwald         return status;
9009a3b69fdeSMatthias Ringwald     }
9010a3b69fdeSMatthias Ringwald     hci_run();
9011a3b69fdeSMatthias Ringwald     return ERROR_CODE_SUCCESS;
9012a3b69fdeSMatthias Ringwald }
9013a3b69fdeSMatthias Ringwald 
9014a3b69fdeSMatthias Ringwald /**
9015a3b69fdeSMatthias Ringwald  * @brief Remove Device from Whitelist
9016a3b69fdeSMatthias Ringwald  * @param address_typ
9017a3b69fdeSMatthias Ringwald  * @param address
90186b65794dSMilanka Ringwald  * @return 0 if ok
9019a3b69fdeSMatthias Ringwald  */
9020667ba9d1SMatthias Ringwald uint8_t gap_whitelist_remove(bd_addr_type_t address_type, const bd_addr_t address){
9021a3b69fdeSMatthias Ringwald     uint8_t status = hci_whitelist_remove(address_type, address);
9022a3b69fdeSMatthias Ringwald     if (status){
9023a3b69fdeSMatthias Ringwald         return status;
9024a3b69fdeSMatthias Ringwald     }
9025a3b69fdeSMatthias Ringwald     hci_run();
9026a3b69fdeSMatthias Ringwald     return ERROR_CODE_SUCCESS;
9027a3b69fdeSMatthias Ringwald }
9028a3b69fdeSMatthias Ringwald 
9029226db5efSMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
9030226db5efSMatthias Ringwald /**
903195e257d9SMatthias Ringwald  * @brief Connect with Whitelist
903295e257d9SMatthias Ringwald  * @note Explicit whitelist management and this connect with whitelist replace deprecated gap_auto_connection_* functions
90336b65794dSMilanka Ringwald  * @return - if ok
903495e257d9SMatthias Ringwald  */
903595e257d9SMatthias Ringwald uint8_t gap_connect_with_whitelist(void){
903695e257d9SMatthias Ringwald     if (hci_stack->le_connecting_request != LE_CONNECTING_IDLE){
903795e257d9SMatthias Ringwald         return ERROR_CODE_COMMAND_DISALLOWED;
903895e257d9SMatthias Ringwald     }
903995e257d9SMatthias Ringwald     hci_stack->le_connecting_request = LE_CONNECTING_WHITELIST;
904095e257d9SMatthias Ringwald     hci_run();
904195e257d9SMatthias Ringwald     return ERROR_CODE_SUCCESS;
904295e257d9SMatthias Ringwald }
904395e257d9SMatthias Ringwald 
904495e257d9SMatthias Ringwald /**
9045226db5efSMatthias Ringwald  * @brief Auto Connection Establishment - Start Connecting to device
9046226db5efSMatthias Ringwald  * @param address_typ
9047226db5efSMatthias Ringwald  * @param address
90486b65794dSMilanka Ringwald  * @return 0 if ok
9049226db5efSMatthias Ringwald  */
9050667ba9d1SMatthias Ringwald uint8_t gap_auto_connection_start(bd_addr_type_t address_type, const bd_addr_t address){
905195e257d9SMatthias Ringwald     if (hci_stack->le_connecting_request == LE_CONNECTING_DIRECT){
9052226db5efSMatthias Ringwald         return ERROR_CODE_COMMAND_DISALLOWED;
9053226db5efSMatthias Ringwald     }
9054226db5efSMatthias Ringwald 
9055226db5efSMatthias Ringwald     uint8_t status = hci_whitelist_add(address_type, address);
905663f2efc9SMatthias Ringwald     if (status == BTSTACK_MEMORY_ALLOC_FAILED) {
9057226db5efSMatthias Ringwald         return status;
9058226db5efSMatthias Ringwald     }
9059226db5efSMatthias Ringwald 
9060226db5efSMatthias Ringwald     hci_stack->le_connecting_request = LE_CONNECTING_WHITELIST;
9061226db5efSMatthias Ringwald 
9062226db5efSMatthias Ringwald     hci_run();
906395e257d9SMatthias Ringwald     return ERROR_CODE_SUCCESS;
9064226db5efSMatthias Ringwald }
9065226db5efSMatthias Ringwald 
9066226db5efSMatthias Ringwald /**
9067226db5efSMatthias Ringwald  * @brief Auto Connection Establishment - Stop Connecting to device
9068226db5efSMatthias Ringwald  * @param address_typ
9069226db5efSMatthias Ringwald  * @param address
90706b65794dSMilanka Ringwald  * @return 0 if ok
9071226db5efSMatthias Ringwald  */
9072667ba9d1SMatthias Ringwald uint8_t gap_auto_connection_stop(bd_addr_type_t address_type, const bd_addr_t address){
907395e257d9SMatthias Ringwald     if (hci_stack->le_connecting_request == LE_CONNECTING_DIRECT){
907495e257d9SMatthias Ringwald         return ERROR_CODE_COMMAND_DISALLOWED;
907595e257d9SMatthias Ringwald     }
907695e257d9SMatthias Ringwald 
9077226db5efSMatthias Ringwald     hci_whitelist_remove(address_type, address);
907895e257d9SMatthias Ringwald     if (btstack_linked_list_empty(&hci_stack->le_whitelist)){
907995e257d9SMatthias Ringwald         hci_stack->le_connecting_request = LE_CONNECTING_IDLE;
908095e257d9SMatthias Ringwald     }
9081226db5efSMatthias Ringwald     hci_run();
9082226db5efSMatthias Ringwald     return 0;
9083226db5efSMatthias Ringwald }
9084226db5efSMatthias Ringwald 
9085226db5efSMatthias Ringwald /**
9086226db5efSMatthias Ringwald  * @brief Auto Connection Establishment - Stop everything
9087226db5efSMatthias Ringwald  * @note  Convenience function to stop all active auto connection attempts
9088226db5efSMatthias Ringwald  */
908995e257d9SMatthias Ringwald uint8_t gap_auto_connection_stop_all(void){
909095e257d9SMatthias Ringwald     if (hci_stack->le_connecting_request == LE_CONNECTING_DIRECT) {
909195e257d9SMatthias Ringwald         return ERROR_CODE_COMMAND_DISALLOWED;
909295e257d9SMatthias Ringwald     }
9093226db5efSMatthias Ringwald     hci_whitelist_clear();
9094226db5efSMatthias Ringwald     hci_stack->le_connecting_request = LE_CONNECTING_IDLE;
9095e83201bcSMatthias Ringwald     hci_run();
909695e257d9SMatthias Ringwald     return ERROR_CODE_SUCCESS;
9097ac9c45e0SMatthias Ringwald }
9098c9db5c21SMilanka Ringwald 
9099b45b7749SMilanka Ringwald uint16_t gap_le_connection_interval(hci_con_handle_t con_handle){
9100b45b7749SMilanka Ringwald     hci_connection_t * conn = hci_connection_for_handle(con_handle);
9101c9db5c21SMilanka Ringwald     if (!conn) return 0;
9102c9db5c21SMilanka Ringwald     return conn->le_connection_interval;
9103c9db5c21SMilanka Ringwald }
9104d70217a2SMatthias Ringwald #endif
91054f551432SMatthias Ringwald #endif
91064f551432SMatthias Ringwald 
910735454696SMatthias Ringwald #ifdef ENABLE_CLASSIC
9108ac9c45e0SMatthias Ringwald /**
9109ff00ed1cSMatthias Ringwald  * @brief Set Extended Inquiry Response data
9110a8c4e5adSMatthias Ringwald  * @param eir_data size HCI_EXTENDED_INQUIRY_RESPONSE_DATA_LEN (240) bytes, is not copied make sure memory is accessible during stack startup
9111ff00ed1cSMatthias Ringwald  * @note has to be done before stack starts up
9112ff00ed1cSMatthias Ringwald  */
9113ff00ed1cSMatthias Ringwald void gap_set_extended_inquiry_response(const uint8_t * data){
9114ff00ed1cSMatthias Ringwald     hci_stack->eir_data = data;
9115baa4881eSMatthias Ringwald     hci_stack->gap_tasks_classic |= GAP_TASK_SET_EIR_DATA;
911659d59ecfSMatthias Ringwald     hci_run();
9117ff00ed1cSMatthias Ringwald }
9118ff00ed1cSMatthias Ringwald 
9119ff00ed1cSMatthias Ringwald /**
9120f5875de5SMatthias Ringwald  * @brief Start GAP Classic Inquiry
9121f5875de5SMatthias Ringwald  * @param duration in 1.28s units
9122f5875de5SMatthias Ringwald  * @return 0 if ok
9123f5875de5SMatthias Ringwald  * @events: GAP_EVENT_INQUIRY_RESULT, GAP_EVENT_INQUIRY_COMPLETE
9124f5875de5SMatthias Ringwald  */
9125f5875de5SMatthias Ringwald int gap_inquiry_start(uint8_t duration_in_1280ms_units){
912699449554SMatthias Ringwald     if (hci_stack->state != HCI_STATE_WORKING) return ERROR_CODE_COMMAND_DISALLOWED;
9127f5875de5SMatthias Ringwald     if (hci_stack->inquiry_state != GAP_INQUIRY_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED;
9128a1df452eSMatthias Ringwald     if ((duration_in_1280ms_units < GAP_INQUIRY_DURATION_MIN) || (duration_in_1280ms_units > GAP_INQUIRY_DURATION_MAX)){
9129f5875de5SMatthias Ringwald         return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS;
9130f5875de5SMatthias Ringwald     }
9131f5875de5SMatthias Ringwald     hci_stack->inquiry_state = duration_in_1280ms_units;
913230199e24SMatthias Ringwald     hci_stack->inquiry_max_period_length = 0;
913330199e24SMatthias Ringwald     hci_stack->inquiry_min_period_length = 0;
913430199e24SMatthias Ringwald     hci_run();
913530199e24SMatthias Ringwald     return 0;
913630199e24SMatthias Ringwald }
913730199e24SMatthias Ringwald 
913830199e24SMatthias Ringwald uint8_t gap_inquiry_periodic_start(uint8_t duration, uint16_t max_period_length, uint16_t min_period_length){
913930199e24SMatthias Ringwald     if (hci_stack->state != HCI_STATE_WORKING)                return ERROR_CODE_COMMAND_DISALLOWED;
914030199e24SMatthias Ringwald     if (hci_stack->inquiry_state != GAP_INQUIRY_STATE_IDLE)   return ERROR_CODE_COMMAND_DISALLOWED;
914130199e24SMatthias Ringwald     if (duration < GAP_INQUIRY_DURATION_MIN)                  return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS;
914230199e24SMatthias Ringwald     if (duration > GAP_INQUIRY_DURATION_MAX)                  return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS;
914330199e24SMatthias Ringwald     if (max_period_length < GAP_INQUIRY_MAX_PERIODIC_LEN_MIN) return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS;;
914430199e24SMatthias Ringwald     if (min_period_length < GAP_INQUIRY_MIN_PERIODIC_LEN_MIN) return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS;;
914530199e24SMatthias Ringwald 
914630199e24SMatthias Ringwald     hci_stack->inquiry_state = duration;
914730199e24SMatthias Ringwald     hci_stack->inquiry_max_period_length = max_period_length;
914830199e24SMatthias Ringwald     hci_stack->inquiry_min_period_length = min_period_length;
9149f5875de5SMatthias Ringwald     hci_run();
9150f5875de5SMatthias Ringwald     return 0;
9151f5875de5SMatthias Ringwald }
9152f5875de5SMatthias Ringwald 
9153f5875de5SMatthias Ringwald /**
9154f5875de5SMatthias Ringwald  * @brief Stop GAP Classic Inquiry
91556b65794dSMilanka Ringwald  * @return 0 if ok
9156f5875de5SMatthias Ringwald  */
9157f5875de5SMatthias Ringwald int gap_inquiry_stop(void){
9158a1df452eSMatthias Ringwald     if ((hci_stack->inquiry_state >= GAP_INQUIRY_DURATION_MIN) && (hci_stack->inquiry_state <= GAP_INQUIRY_DURATION_MAX)) {
9159f5875de5SMatthias Ringwald         // emit inquiry complete event, before it even started
9160f5875de5SMatthias Ringwald         uint8_t event[] = { GAP_EVENT_INQUIRY_COMPLETE, 1, 0};
9161f5875de5SMatthias Ringwald         hci_emit_event(event, sizeof(event), 1);
9162f5875de5SMatthias Ringwald         return 0;
9163f5875de5SMatthias Ringwald     }
916430199e24SMatthias Ringwald     switch (hci_stack->inquiry_state){
916530199e24SMatthias Ringwald         case GAP_INQUIRY_STATE_ACTIVE:
9166f5875de5SMatthias Ringwald             hci_stack->inquiry_state = GAP_INQUIRY_STATE_W2_CANCEL;
9167f5875de5SMatthias Ringwald             hci_run();
916830199e24SMatthias Ringwald             return ERROR_CODE_SUCCESS;
916930199e24SMatthias Ringwald         case GAP_INQUIRY_STATE_PERIODIC:
917030199e24SMatthias Ringwald             hci_stack->inquiry_state = GAP_INQUIRY_STATE_W2_EXIT_PERIODIC;
917130199e24SMatthias Ringwald             hci_run();
917230199e24SMatthias Ringwald             return ERROR_CODE_SUCCESS;
917330199e24SMatthias Ringwald         default:
917430199e24SMatthias Ringwald             return ERROR_CODE_COMMAND_DISALLOWED;
917530199e24SMatthias Ringwald     }
9176f5875de5SMatthias Ringwald }
9177f5875de5SMatthias Ringwald 
9178496bb884SMatthias Ringwald void gap_inquiry_set_lap(uint32_t lap){
9179496bb884SMatthias Ringwald     hci_stack->inquiry_lap = lap;
9180496bb884SMatthias Ringwald }
9181496bb884SMatthias Ringwald 
91821dc973e7SMatthias Ringwald void gap_inquiry_set_scan_activity(uint16_t inquiry_scan_interval, uint16_t inquiry_scan_window){
9183c0c8a829SMatthias Ringwald     hci_stack->inquiry_scan_interval = inquiry_scan_interval;
9184c0c8a829SMatthias Ringwald     hci_stack->inquiry_scan_window   = inquiry_scan_window;
9185baa4881eSMatthias Ringwald     hci_stack->gap_tasks_classic |= GAP_TASK_WRITE_INQUIRY_SCAN_ACTIVITY;
9186c0c8a829SMatthias Ringwald     hci_run();
9187c0c8a829SMatthias Ringwald }
9188c0c8a829SMatthias Ringwald 
9189f50ed5acSAndrey Fominykh void gap_inquiry_set_transmit_power_level(int8_t tx_power)
9190f50ed5acSAndrey Fominykh {
9191f50ed5acSAndrey Fominykh     hci_stack->inquiry_tx_power_level = tx_power;
9192f50ed5acSAndrey Fominykh     hci_stack->gap_tasks_classic |= GAP_TASK_WRITE_INQUIRY_TX_POWER_LEVEL;
9193f50ed5acSAndrey Fominykh     hci_run();
9194f50ed5acSAndrey Fominykh }
9195f50ed5acSAndrey Fominykh 
9196b7f1ee76SMatthias Ringwald 
9197b7f1ee76SMatthias Ringwald /**
9198b7f1ee76SMatthias Ringwald  * @brief Remote Name Request
9199b7f1ee76SMatthias Ringwald  * @param addr
9200b7f1ee76SMatthias Ringwald  * @param page_scan_repetition_mode
9201b7f1ee76SMatthias Ringwald  * @param clock_offset only used when bit 15 is set
9202b7f1ee76SMatthias Ringwald  * @events: HCI_EVENT_REMOTE_NAME_REQUEST_COMPLETE
9203b7f1ee76SMatthias Ringwald  */
9204667ba9d1SMatthias Ringwald int gap_remote_name_request(const bd_addr_t addr, uint8_t page_scan_repetition_mode, uint16_t clock_offset){
9205b7f1ee76SMatthias Ringwald     if (hci_stack->remote_name_state != GAP_REMOTE_NAME_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED;
92066535961aSMatthias Ringwald     (void)memcpy(hci_stack->remote_name_addr, addr, 6);
9207b7f1ee76SMatthias Ringwald     hci_stack->remote_name_page_scan_repetition_mode = page_scan_repetition_mode;
9208b7f1ee76SMatthias Ringwald     hci_stack->remote_name_clock_offset = clock_offset;
9209b7f1ee76SMatthias Ringwald     hci_stack->remote_name_state = GAP_REMOTE_NAME_STATE_W2_SEND;
9210b7f1ee76SMatthias Ringwald     hci_run();
9211b7f1ee76SMatthias Ringwald     return 0;
9212b7f1ee76SMatthias Ringwald }
9213b7f1ee76SMatthias Ringwald 
9214667ba9d1SMatthias Ringwald static int gap_pairing_set_state_and_run(const bd_addr_t addr, uint8_t state){
92150a51f88bSMatthias Ringwald     hci_stack->gap_pairing_state = state;
92166535961aSMatthias Ringwald     (void)memcpy(hci_stack->gap_pairing_addr, addr, 6);
92170a51f88bSMatthias Ringwald     hci_run();
92180a51f88bSMatthias Ringwald     return 0;
92190a51f88bSMatthias Ringwald }
92200a51f88bSMatthias Ringwald 
92210a51f88bSMatthias Ringwald /**
9222aad97216SMatthias Ringwald  * @brief Legacy Pairing Pin Code Response for binary data / non-strings
9223aad97216SMatthias Ringwald  * @param addr
9224aad97216SMatthias Ringwald  * @param pin_data
9225aad97216SMatthias Ringwald  * @param pin_len
9226aad97216SMatthias Ringwald  * @return 0 if ok
9227aad97216SMatthias Ringwald  */
9228667ba9d1SMatthias Ringwald int gap_pin_code_response_binary(const bd_addr_t addr, const uint8_t * pin_data, uint8_t pin_len){
9229aad97216SMatthias Ringwald     if (hci_stack->gap_pairing_state != GAP_PAIRING_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED;
9230c26f2c7bSMatthias Ringwald     if (pin_len > PIN_CODE_LEN) return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS;
9231aad97216SMatthias Ringwald     hci_stack->gap_pairing_input.gap_pairing_pin = pin_data;
9232aad97216SMatthias Ringwald     hci_stack->gap_pairing_pin_len = pin_len;
9233aad97216SMatthias Ringwald     return gap_pairing_set_state_and_run(addr, GAP_PAIRING_STATE_SEND_PIN);
9234aad97216SMatthias Ringwald }
9235aad97216SMatthias Ringwald 
9236aad97216SMatthias Ringwald /**
92370a51f88bSMatthias Ringwald  * @brief Legacy Pairing Pin Code Response
92380a51f88bSMatthias Ringwald  * @param addr
92390a51f88bSMatthias Ringwald  * @param pin
92400a51f88bSMatthias Ringwald  * @return 0 if ok
92410a51f88bSMatthias Ringwald  */
9242667ba9d1SMatthias Ringwald int gap_pin_code_response(const bd_addr_t addr, const char * pin){
92439d78a7ecSMatthias Ringwald     return gap_pin_code_response_binary(addr, (const uint8_t*) pin, (uint8_t) strlen(pin));
92440a51f88bSMatthias Ringwald }
92450a51f88bSMatthias Ringwald 
92460a51f88bSMatthias Ringwald /**
92470a51f88bSMatthias Ringwald  * @brief Abort Legacy Pairing
92480a51f88bSMatthias Ringwald  * @param addr
92490a51f88bSMatthias Ringwald  * @param pin
92500a51f88bSMatthias Ringwald  * @return 0 if ok
92510a51f88bSMatthias Ringwald  */
92520a51f88bSMatthias Ringwald int gap_pin_code_negative(bd_addr_t addr){
9253cd74063aSMatthias Ringwald     if (hci_stack->gap_pairing_state != GAP_PAIRING_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED;
92540a51f88bSMatthias Ringwald     return gap_pairing_set_state_and_run(addr, GAP_PAIRING_STATE_SEND_PIN_NEGATIVE);
92550a51f88bSMatthias Ringwald }
92560a51f88bSMatthias Ringwald 
92570a51f88bSMatthias Ringwald /**
92580a51f88bSMatthias Ringwald  * @brief SSP Passkey Response
92590a51f88bSMatthias Ringwald  * @param addr
92600a51f88bSMatthias Ringwald  * @param passkey
92610a51f88bSMatthias Ringwald  * @return 0 if ok
92620a51f88bSMatthias Ringwald  */
9263667ba9d1SMatthias Ringwald int gap_ssp_passkey_response(const bd_addr_t addr, uint32_t passkey){
9264cd74063aSMatthias Ringwald     if (hci_stack->gap_pairing_state != GAP_PAIRING_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED;
9265d504181aSMatthias Ringwald     hci_stack->gap_pairing_input.gap_pairing_passkey = passkey;
92660a51f88bSMatthias Ringwald     return gap_pairing_set_state_and_run(addr, GAP_PAIRING_STATE_SEND_PASSKEY);
92670a51f88bSMatthias Ringwald }
92680a51f88bSMatthias Ringwald 
92690a51f88bSMatthias Ringwald /**
92700a51f88bSMatthias Ringwald  * @brief Abort SSP Passkey Entry/Pairing
92710a51f88bSMatthias Ringwald  * @param addr
92720a51f88bSMatthias Ringwald  * @param pin
92730a51f88bSMatthias Ringwald  * @return 0 if ok
92740a51f88bSMatthias Ringwald  */
9275667ba9d1SMatthias Ringwald int gap_ssp_passkey_negative(const bd_addr_t addr){
9276cd74063aSMatthias Ringwald     if (hci_stack->gap_pairing_state != GAP_PAIRING_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED;
92770a51f88bSMatthias Ringwald     return gap_pairing_set_state_and_run(addr, GAP_PAIRING_STATE_SEND_PASSKEY_NEGATIVE);
92780a51f88bSMatthias Ringwald }
92790a51f88bSMatthias Ringwald 
92800a51f88bSMatthias Ringwald /**
92810a51f88bSMatthias Ringwald  * @brief Accept SSP Numeric Comparison
92820a51f88bSMatthias Ringwald  * @param addr
92830a51f88bSMatthias Ringwald  * @param passkey
92840a51f88bSMatthias Ringwald  * @return 0 if ok
92850a51f88bSMatthias Ringwald  */
9286667ba9d1SMatthias Ringwald int gap_ssp_confirmation_response(const bd_addr_t addr){
9287cd74063aSMatthias Ringwald     if (hci_stack->gap_pairing_state != GAP_PAIRING_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED;
92880a51f88bSMatthias Ringwald     return gap_pairing_set_state_and_run(addr, GAP_PAIRING_STATE_SEND_CONFIRMATION);
92890a51f88bSMatthias Ringwald }
92900a51f88bSMatthias Ringwald 
92910a51f88bSMatthias Ringwald /**
92920a51f88bSMatthias Ringwald  * @brief Abort SSP Numeric Comparison/Pairing
92930a51f88bSMatthias Ringwald  * @param addr
92940a51f88bSMatthias Ringwald  * @param pin
92950a51f88bSMatthias Ringwald  * @return 0 if ok
92960a51f88bSMatthias Ringwald  */
9297667ba9d1SMatthias Ringwald int gap_ssp_confirmation_negative(const bd_addr_t addr){
9298cd74063aSMatthias Ringwald     if (hci_stack->gap_pairing_state != GAP_PAIRING_STATE_IDLE) return ERROR_CODE_COMMAND_DISALLOWED;
92990a51f88bSMatthias Ringwald     return gap_pairing_set_state_and_run(addr, GAP_PAIRING_STATE_SEND_CONFIRMATION_NEGATIVE);
93000a51f88bSMatthias Ringwald }
93010a51f88bSMatthias Ringwald 
9302308eeaffSMatthias Ringwald #if defined(ENABLE_EXPLICIT_IO_CAPABILITIES_REPLY) || defined(ENABLE_EXPLICIT_LINK_KEY_REPLY)
930344565b0cSMatthias Ringwald static uint8_t gap_set_auth_flag_and_run(const bd_addr_t addr, hci_authentication_flags_t flag){
930444565b0cSMatthias Ringwald     hci_connection_t * conn = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL);
930544565b0cSMatthias Ringwald     if (!conn) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
930644565b0cSMatthias Ringwald     connectionSetAuthenticationFlags(conn, flag);
930744565b0cSMatthias Ringwald     hci_run();
930844565b0cSMatthias Ringwald     return ERROR_CODE_SUCCESS;
930944565b0cSMatthias Ringwald }
9310308eeaffSMatthias Ringwald #endif
931144565b0cSMatthias Ringwald 
9312308eeaffSMatthias Ringwald #ifdef ENABLE_EXPLICIT_IO_CAPABILITIES_REPLY
931344565b0cSMatthias Ringwald uint8_t gap_ssp_io_capabilities_response(const bd_addr_t addr){
93147ca4a7edSMatthias Ringwald     return gap_set_auth_flag_and_run(addr, AUTH_FLAG_SEND_IO_CAPABILITIES_REPLY);
931544565b0cSMatthias Ringwald }
931644565b0cSMatthias Ringwald 
931744565b0cSMatthias Ringwald uint8_t gap_ssp_io_capabilities_negative(const bd_addr_t addr){
93187ca4a7edSMatthias Ringwald     return gap_set_auth_flag_and_run(addr, AUTH_FLAG_SEND_IO_CAPABILITIES_NEGATIVE_REPLY);
931944565b0cSMatthias Ringwald }
932044565b0cSMatthias Ringwald #endif
932144565b0cSMatthias Ringwald 
93221849becdSMatthias Ringwald #ifdef ENABLE_CLASSIC_PAIRING_OOB
93231849becdSMatthias Ringwald /**
93241849becdSMatthias Ringwald  * @brief Report Remote OOB Data
93251849becdSMatthias Ringwald  * @param bd_addr
93261849becdSMatthias Ringwald  * @param c_192 Simple Pairing Hash C derived from P-192 public key
93271849becdSMatthias Ringwald  * @param r_192 Simple Pairing Randomizer derived from P-192 public key
93281849becdSMatthias Ringwald  * @param c_256 Simple Pairing Hash C derived from P-256 public key
93291849becdSMatthias Ringwald  * @param r_256 Simple Pairing Randomizer derived from P-256 public key
93301849becdSMatthias Ringwald  */
93311849becdSMatthias 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){
93321849becdSMatthias Ringwald     hci_connection_t * connection = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL);
93331849becdSMatthias Ringwald     if (connection == NULL) {
93341849becdSMatthias Ringwald         return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
93351849becdSMatthias Ringwald     }
93361849becdSMatthias Ringwald     connection->classic_oob_c_192 = c_192;
93371849becdSMatthias Ringwald     connection->classic_oob_r_192 = r_192;
9338204e8f1dSMatthias Ringwald 
9339204e8f1dSMatthias Ringwald     // ignore P-256 if not supported by us
9340204e8f1dSMatthias Ringwald     if (hci_stack->secure_connections_active){
93411849becdSMatthias Ringwald         connection->classic_oob_c_256 = c_256;
93421849becdSMatthias Ringwald         connection->classic_oob_r_256 = r_256;
9343204e8f1dSMatthias Ringwald     }
9344204e8f1dSMatthias Ringwald 
93451849becdSMatthias Ringwald     return ERROR_CODE_SUCCESS;
93461849becdSMatthias Ringwald }
9347cf01e888SMatthias Ringwald /**
9348cf01e888SMatthias Ringwald  * @brief Generate new OOB data
9349cf01e888SMatthias Ringwald  * @note OOB data will be provided in GAP_EVENT_LOCAL_OOB_DATA and be used in future pairing procedures
9350cf01e888SMatthias Ringwald  */
9351cf01e888SMatthias Ringwald void gap_ssp_generate_oob_data(void){
9352cf01e888SMatthias Ringwald     hci_stack->classic_read_local_oob_data = true;
9353cf01e888SMatthias Ringwald     hci_run();
9354cf01e888SMatthias Ringwald }
9355cf01e888SMatthias Ringwald 
93561849becdSMatthias Ringwald #endif
93571849becdSMatthias Ringwald 
9358308eeaffSMatthias Ringwald #ifdef ENABLE_EXPLICIT_LINK_KEY_REPLY
9359308eeaffSMatthias Ringwald uint8_t gap_send_link_key_response(const bd_addr_t addr, link_key_t link_key, link_key_type_t type){
9360308eeaffSMatthias Ringwald     hci_connection_t * connection = hci_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL);
9361308eeaffSMatthias Ringwald     if (connection == NULL) {
9362308eeaffSMatthias Ringwald         return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
9363308eeaffSMatthias Ringwald     }
9364308eeaffSMatthias Ringwald 
9365308eeaffSMatthias Ringwald     memcpy(connection->link_key, link_key, sizeof(link_key_t));
9366308eeaffSMatthias Ringwald     connection->link_key_type = type;
9367308eeaffSMatthias Ringwald 
9368308eeaffSMatthias Ringwald     return gap_set_auth_flag_and_run(addr, AUTH_FLAG_HANDLE_LINK_KEY_REQUEST);
9369308eeaffSMatthias Ringwald }
9370308eeaffSMatthias Ringwald 
9371308eeaffSMatthias Ringwald #endif // ENABLE_EXPLICIT_LINK_KEY_REPLY
9372f5875de5SMatthias Ringwald /**
9373f6858d14SMatthias Ringwald  * @brief Set inquiry mode: standard, with RSSI, with RSSI + Extended Inquiry Results. Has to be called before power on.
9374f5875de5SMatthias Ringwald  * @param inquiry_mode see bluetooth_defines.h
9375f6858d14SMatthias Ringwald  */
9376b45b7749SMilanka Ringwald void hci_set_inquiry_mode(inquiry_mode_t inquiry_mode){
9377b45b7749SMilanka Ringwald     hci_stack->inquiry_mode = inquiry_mode;
9378f6858d14SMatthias Ringwald }
9379f6858d14SMatthias Ringwald 
9380f6858d14SMatthias Ringwald /**
9381d950d659SMatthias Ringwald  * @brief Configure Voice Setting for use with SCO data in HSP/HFP
9382d950d659SMatthias Ringwald  */
9383d950d659SMatthias Ringwald void hci_set_sco_voice_setting(uint16_t voice_setting){
9384d950d659SMatthias Ringwald     hci_stack->sco_voice_setting = voice_setting;
9385d950d659SMatthias Ringwald }
9386d950d659SMatthias Ringwald 
9387d950d659SMatthias Ringwald /**
9388d950d659SMatthias Ringwald  * @brief Get SCO Voice Setting
9389d950d659SMatthias Ringwald  * @return current voice setting
9390d950d659SMatthias Ringwald  */
93910cb5b971SMatthias Ringwald uint16_t hci_get_sco_voice_setting(void){
9392d950d659SMatthias Ringwald     return hci_stack->sco_voice_setting;
9393d950d659SMatthias Ringwald }
9394d950d659SMatthias Ringwald 
9395400ff5abSMatthias Ringwald static int hci_have_usb_transport(void){
9396400ff5abSMatthias Ringwald     if (!hci_stack->hci_transport) return 0;
9397400ff5abSMatthias Ringwald     const char * transport_name = hci_stack->hci_transport->name;
9398400ff5abSMatthias Ringwald     if (!transport_name) return 0;
9399400ff5abSMatthias Ringwald     return (transport_name[0] == 'H') && (transport_name[1] == '2');
9400400ff5abSMatthias Ringwald }
9401400ff5abSMatthias Ringwald 
94029427aeb5SMatthias Ringwald static uint16_t hci_sco_packet_length_for_payload_length(uint16_t payload_size){
940320dcdd22SMatthias Ringwald     uint16_t sco_packet_length = 0;
9404cf119f3bSMatthias Ringwald 
940591dfed7eSMatthias Ringwald #if defined(ENABLE_SCO_OVER_HCI) || defined (HAVE_SCO_TRANSPORT)
94066f28d2eeSMatthias Ringwald     // Transparent = mSBC => 1, CVSD with 16-bit samples requires twice as much bytes
940773f498e7SMatthias Ringwald     int multiplier;
940873f498e7SMatthias Ringwald     if (((hci_stack->sco_voice_setting_active & 0x03) != 0x03) &&
940973f498e7SMatthias Ringwald         ((hci_stack->sco_voice_setting_active & 0x20) == 0x20)) {
941073f498e7SMatthias Ringwald         multiplier = 2;
941173f498e7SMatthias Ringwald     } else {
941273f498e7SMatthias Ringwald         multiplier = 1;
941373f498e7SMatthias Ringwald     }
941491dfed7eSMatthias Ringwald #endif
941591dfed7eSMatthias Ringwald 
94169427aeb5SMatthias Ringwald #ifdef ENABLE_SCO_OVER_HCI
9417400ff5abSMatthias Ringwald     if (hci_have_usb_transport()){
9418400ff5abSMatthias Ringwald         // see Core Spec for H2 USB Transfer.
9419cf119f3bSMatthias Ringwald         // 3 byte SCO header + 24 bytes per connection
94209427aeb5SMatthias Ringwald         // @note multiple sco connections not supported currently
94219427aeb5SMatthias Ringwald         sco_packet_length = 3 + 24 * multiplier;
9422400ff5abSMatthias Ringwald     } else {
94239427aeb5SMatthias Ringwald         // 3 byte SCO header + SCO packet length over the air
94249427aeb5SMatthias Ringwald         sco_packet_length = 3 + payload_size * multiplier;
9425d966a453SMatthias Ringwald         // assert that it still fits inside an SCO buffer
9426ad915196SMatthias Ringwald         if (sco_packet_length > (hci_stack->sco_data_packet_length + 3)){
94279427aeb5SMatthias Ringwald             sco_packet_length = 3 + hci_stack->sco_data_packet_length;
9428d966a453SMatthias Ringwald         }
9429400ff5abSMatthias Ringwald     }
9430a3069afeSMatthias Ringwald #endif
94315b7087c7SMatthias Ringwald #ifdef HAVE_SCO_TRANSPORT
94329427aeb5SMatthias Ringwald     // 3 byte SCO header + SCO packet length over the air
94339427aeb5SMatthias Ringwald     sco_packet_length = 3 + payload_size * multiplier;
94349427aeb5SMatthias Ringwald     // assert that it still fits inside an SCO buffer
94359427aeb5SMatthias Ringwald     if (sco_packet_length > (hci_stack->sco_data_packet_length + 3)){
94369427aeb5SMatthias Ringwald         sco_packet_length = 3 + hci_stack->sco_data_packet_length;
94379427aeb5SMatthias Ringwald     }
94385b7087c7SMatthias Ringwald #endif
9439a3069afeSMatthias Ringwald     return sco_packet_length;
9440b3aad8daSMatthias Ringwald }
9441b3aad8daSMatthias Ringwald 
94429427aeb5SMatthias Ringwald uint16_t hci_get_sco_packet_length_for_connection(hci_con_handle_t sco_con_handle){
94439427aeb5SMatthias Ringwald     hci_connection_t * connection = hci_connection_for_handle(sco_con_handle);
94449427aeb5SMatthias Ringwald     if (connection != NULL){
94459427aeb5SMatthias Ringwald         return hci_sco_packet_length_for_payload_length(connection->sco_payload_length);
94469427aeb5SMatthias Ringwald     }
94479427aeb5SMatthias Ringwald     return 0;
94489427aeb5SMatthias Ringwald }
94499427aeb5SMatthias Ringwald 
94509427aeb5SMatthias Ringwald uint16_t hci_get_sco_packet_length(void){
94519427aeb5SMatthias Ringwald     btstack_linked_list_iterator_t it;
94529427aeb5SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->connections);
94539427aeb5SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
94549427aeb5SMatthias Ringwald         hci_connection_t * connection = (hci_connection_t *) btstack_linked_list_iterator_next(&it);
94559427aeb5SMatthias Ringwald         if ( connection->address_type == BD_ADDR_TYPE_SCO ) {
94569427aeb5SMatthias Ringwald             return hci_sco_packet_length_for_payload_length(connection->sco_payload_length);;
94579427aeb5SMatthias Ringwald         }
94589427aeb5SMatthias Ringwald     }
94599427aeb5SMatthias Ringwald     return 0;
94609427aeb5SMatthias Ringwald }
94619427aeb5SMatthias Ringwald 
9462c4c88f1bSJakob Krantz /**
9463c4c88f1bSJakob Krantz * @brief Sets the master/slave policy
9464c4c88f1bSJakob Krantz * @param policy (0: attempt to become master, 1: let connecting device decide)
9465c4c88f1bSJakob Krantz */
9466c4c88f1bSJakob Krantz void hci_set_master_slave_policy(uint8_t policy){
9467c4c88f1bSJakob Krantz     hci_stack->master_slave_policy = policy;
9468c4c88f1bSJakob Krantz }
9469c4c88f1bSJakob Krantz 
9470c4c88f1bSJakob Krantz #endif
9471ec111c8bSMatthias Ringwald 
9472ec111c8bSMatthias Ringwald HCI_STATE hci_get_state(void){
9473ec111c8bSMatthias Ringwald     return hci_stack->state;
9474ec111c8bSMatthias Ringwald }
9475ec111c8bSMatthias Ringwald 
947607e010b6SMilanka Ringwald #ifdef ENABLE_CLASSIC
94775e91d96cSMatthias Ringwald void gap_register_classic_connection_filter(int (*accept_callback)(bd_addr_t addr, hci_link_type_t link_type)){
947807e010b6SMilanka Ringwald     hci_stack->gap_classic_accept_callback = accept_callback;
947907e010b6SMilanka Ringwald }
948007e010b6SMilanka Ringwald #endif
9481ec111c8bSMatthias Ringwald 
9482d950d659SMatthias Ringwald /**
9483d23838ecSMatthias Ringwald  * @brief Set callback for Bluetooth Hardware Error
9484d23838ecSMatthias Ringwald  */
9485c2e1fa60SMatthias Ringwald void hci_set_hardware_error_callback(void (*fn)(uint8_t error)){
9486d23838ecSMatthias Ringwald     hci_stack->hardware_error_callback = fn;
9487d23838ecSMatthias Ringwald }
9488d23838ecSMatthias Ringwald 
948971de195eSMatthias Ringwald void hci_disconnect_all(void){
9490665d90f2SMatthias Ringwald     btstack_linked_list_iterator_t it;
9491665d90f2SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->connections);
9492665d90f2SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
9493665d90f2SMatthias Ringwald         hci_connection_t * con = (hci_connection_t*) btstack_linked_list_iterator_next(&it);
949404a6ef8cSmatthias.ringwald         if (con->state == SENT_DISCONNECT) continue;
949504a6ef8cSmatthias.ringwald         con->state = SEND_DISCONNECT;
949604a6ef8cSmatthias.ringwald     }
9497d31fba26S[email protected]     hci_run();
949804a6ef8cSmatthias.ringwald }
949933373e40SMatthias Ringwald 
950033373e40SMatthias Ringwald uint16_t hci_get_manufacturer(void){
950133373e40SMatthias Ringwald     return hci_stack->manufacturer;
950233373e40SMatthias Ringwald }
95039c6e867eSMatthias Ringwald 
95043e329ddfSandryblack #ifdef ENABLE_BLE
95059c6e867eSMatthias Ringwald static sm_connection_t * sm_get_connection_for_handle(hci_con_handle_t con_handle){
95069c6e867eSMatthias Ringwald     hci_connection_t * hci_con = hci_connection_for_handle(con_handle);
95079c6e867eSMatthias Ringwald     if (!hci_con) return NULL;
95089c6e867eSMatthias Ringwald     return &hci_con->sm_connection;
95099c6e867eSMatthias Ringwald }
95109c6e867eSMatthias Ringwald 
95119c6e867eSMatthias Ringwald // extracted from sm.c to allow enabling of l2cap le data channels without adding sm.c to the build
95129c6e867eSMatthias Ringwald // without sm.c default values from create_connection_for_bd_addr_and_type() resulg in non-encrypted, not-authenticated
95136a79f6baSMatthias Ringwald #endif
95149c6e867eSMatthias Ringwald 
95156d105c71SMatthias Ringwald uint8_t gap_encryption_key_size(hci_con_handle_t con_handle){
9516c5fb5ca4SMatthias Ringwald     hci_connection_t * hci_connection = hci_connection_for_handle(con_handle);
9517c5fb5ca4SMatthias Ringwald     if (hci_connection == NULL) return 0;
9518c5fb5ca4SMatthias Ringwald     if (hci_is_le_connection(hci_connection)){
95196a79f6baSMatthias Ringwald #ifdef ENABLE_BLE
9520c5fb5ca4SMatthias Ringwald         sm_connection_t * sm_conn = &hci_connection->sm_connection;
9521c7bead46SMatthias Ringwald         if (sm_conn->sm_connection_encrypted != 0u) {
95229c6e867eSMatthias Ringwald             return sm_conn->sm_actual_encryption_key_size;
95239c6e867eSMatthias Ringwald         }
95246a79f6baSMatthias Ringwald #endif
95256a79f6baSMatthias Ringwald     } else {
9526c5fb5ca4SMatthias Ringwald #ifdef ENABLE_CLASSIC
95278daf94bcSMatthias Ringwald         if ((hci_connection->authentication_flags & AUTH_FLAG_CONNECTION_ENCRYPTED)){
9528c5fb5ca4SMatthias Ringwald             return hci_connection->encryption_key_size;
9529c5fb5ca4SMatthias Ringwald         }
9530c5fb5ca4SMatthias Ringwald #endif
95316a79f6baSMatthias Ringwald     }
9532c5fb5ca4SMatthias Ringwald     return 0;
9533c5fb5ca4SMatthias Ringwald }
95349c6e867eSMatthias Ringwald 
9535ff3f1026SMatthias Ringwald bool gap_authenticated(hci_con_handle_t con_handle){
9536c5fb5ca4SMatthias Ringwald     hci_connection_t * hci_connection = hci_connection_for_handle(con_handle);
9537ff3f1026SMatthias Ringwald     if (hci_connection == NULL) return false;
95385f3981bfSMatthias Ringwald 
9539c5fb5ca4SMatthias Ringwald     switch (hci_connection->address_type){
95406a79f6baSMatthias Ringwald #ifdef ENABLE_BLE
95415f3981bfSMatthias Ringwald         case BD_ADDR_TYPE_LE_PUBLIC:
95425f3981bfSMatthias Ringwald         case BD_ADDR_TYPE_LE_RANDOM:
9543d9e1bf33SMatthias Ringwald         case BD_ADDR_TYPE_LE_PUBLIC_IDENTITY:
9544d9e1bf33SMatthias Ringwald         case BD_ADDR_TYPE_LE_RANDOM_IDENTITY:
9545c5fb5ca4SMatthias Ringwald             if (hci_connection->sm_connection.sm_connection_encrypted == 0) return 0; // unencrypted connection cannot be authenticated
9546ff3f1026SMatthias Ringwald             return hci_connection->sm_connection.sm_connection_authenticated != 0;
95476a79f6baSMatthias Ringwald #endif
954859a1a47aSMatthias Ringwald #ifdef ENABLE_CLASSIC
95495f3981bfSMatthias Ringwald         case BD_ADDR_TYPE_SCO:
9550f16129ceSMatthias Ringwald         case BD_ADDR_TYPE_ACL:
9551ff3f1026SMatthias Ringwald             return gap_authenticated_for_link_key_type(hci_connection->link_key_type);
955259a1a47aSMatthias Ringwald #endif
95535f3981bfSMatthias Ringwald         default:
9554ff3f1026SMatthias Ringwald             return false;
95555f3981bfSMatthias Ringwald     }
95569c6e867eSMatthias Ringwald }
95579c6e867eSMatthias Ringwald 
9558f461b3dfSMatthias Ringwald bool gap_secure_connection(hci_con_handle_t con_handle){
9559c5fb5ca4SMatthias Ringwald     hci_connection_t * hci_connection = hci_connection_for_handle(con_handle);
9560c5fb5ca4SMatthias Ringwald     if (hci_connection == NULL) return 0;
95618b35e16aSMatthias Ringwald 
9562c5fb5ca4SMatthias Ringwald     switch (hci_connection->address_type){
95636a79f6baSMatthias Ringwald #ifdef ENABLE_BLE
95648b35e16aSMatthias Ringwald         case BD_ADDR_TYPE_LE_PUBLIC:
95658b35e16aSMatthias Ringwald         case BD_ADDR_TYPE_LE_RANDOM:
9566d9e1bf33SMatthias Ringwald         case BD_ADDR_TYPE_LE_PUBLIC_IDENTITY:
9567d9e1bf33SMatthias Ringwald         case BD_ADDR_TYPE_LE_RANDOM_IDENTITY:
9568f461b3dfSMatthias Ringwald             if (hci_connection->sm_connection.sm_connection_encrypted == 0) return false; // unencrypted connection cannot be authenticated
9569d7dbf891SMatthias Ringwald             return hci_connection->sm_connection.sm_connection_sc;
95706a79f6baSMatthias Ringwald #endif
957159a1a47aSMatthias Ringwald #ifdef ENABLE_CLASSIC
95728b35e16aSMatthias Ringwald         case BD_ADDR_TYPE_SCO:
9573f16129ceSMatthias Ringwald         case BD_ADDR_TYPE_ACL:
9574f461b3dfSMatthias Ringwald             return gap_secure_connection_for_link_key_type(hci_connection->link_key_type);
957559a1a47aSMatthias Ringwald #endif
95768b35e16aSMatthias Ringwald         default:
9577f461b3dfSMatthias Ringwald             return false;
95788b35e16aSMatthias Ringwald     }
9579f1dfbe18SMatthias Ringwald }
9580f1dfbe18SMatthias Ringwald 
95811e122704SMatthias Ringwald bool gap_bonded(hci_con_handle_t con_handle){
95821e122704SMatthias Ringwald 	hci_connection_t * hci_connection = hci_connection_for_handle(con_handle);
95831e122704SMatthias Ringwald 	if (hci_connection == NULL) return 0;
95841e122704SMatthias Ringwald 
958548f33f37SMatthias Ringwald #ifdef ENABLE_CLASSIC
95861e122704SMatthias Ringwald 	link_key_t link_key;
95871e122704SMatthias Ringwald 	link_key_type_t link_key_type;
958848f33f37SMatthias Ringwald #endif
95891e122704SMatthias Ringwald 	switch (hci_connection->address_type){
95906a79f6baSMatthias Ringwald #ifdef ENABLE_BLE
95911e122704SMatthias Ringwald 		case BD_ADDR_TYPE_LE_PUBLIC:
95921e122704SMatthias Ringwald 		case BD_ADDR_TYPE_LE_RANDOM:
9593d9e1bf33SMatthias Ringwald 	    case BD_ADDR_TYPE_LE_PUBLIC_IDENTITY:
9594d9e1bf33SMatthias Ringwald         case BD_ADDR_TYPE_LE_RANDOM_IDENTITY:
95951e122704SMatthias Ringwald             return hci_connection->sm_connection.sm_le_db_index >= 0;
95966a79f6baSMatthias Ringwald #endif
95971e122704SMatthias Ringwald #ifdef ENABLE_CLASSIC
95981e122704SMatthias Ringwald 		case BD_ADDR_TYPE_SCO:
95991e122704SMatthias Ringwald 		case BD_ADDR_TYPE_ACL:
96001e122704SMatthias Ringwald 			return hci_stack->link_key_db && hci_stack->link_key_db->get_link_key(hci_connection->address, link_key, &link_key_type);
96011e122704SMatthias Ringwald #endif
96021e122704SMatthias Ringwald 		default:
96031e122704SMatthias Ringwald 			return false;
96041e122704SMatthias Ringwald 	}
96051e122704SMatthias Ringwald }
96061e122704SMatthias Ringwald 
96076a79f6baSMatthias Ringwald #ifdef ENABLE_BLE
96089c6e867eSMatthias Ringwald authorization_state_t gap_authorization_state(hci_con_handle_t con_handle){
96099c6e867eSMatthias Ringwald     sm_connection_t * sm_conn = sm_get_connection_for_handle(con_handle);
9610c7bead46SMatthias Ringwald     if (sm_conn == NULL)                             return AUTHORIZATION_UNKNOWN; // wrong connection
9611c7bead46SMatthias Ringwald     if (sm_conn->sm_connection_encrypted == 0u)      return AUTHORIZATION_UNKNOWN; // unencrypted connection cannot be authorized
9612c7bead46SMatthias Ringwald     if (sm_conn->sm_connection_authenticated == 0u)  return AUTHORIZATION_UNKNOWN; // unauthenticatd connection cannot be authorized
96139c6e867eSMatthias Ringwald     return sm_conn->sm_connection_authorization_state;
96149c6e867eSMatthias Ringwald }
96159c6e867eSMatthias Ringwald #endif
9616f8ee3071SMatthias Ringwald 
9617f8ee3071SMatthias Ringwald #ifdef ENABLE_CLASSIC
9618f8ee3071SMatthias 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){
9619f8ee3071SMatthias Ringwald     hci_connection_t * conn = hci_connection_for_handle(con_handle);
96207f839e2cSMatthias Ringwald     if (!conn) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
9621f8ee3071SMatthias Ringwald     conn->sniff_min_interval = sniff_min_interval;
9622f8ee3071SMatthias Ringwald     conn->sniff_max_interval = sniff_max_interval;
9623f8ee3071SMatthias Ringwald     conn->sniff_attempt = sniff_attempt;
9624f8ee3071SMatthias Ringwald     conn->sniff_timeout = sniff_timeout;
9625f8ee3071SMatthias Ringwald     hci_run();
9626f8ee3071SMatthias Ringwald     return 0;
9627f8ee3071SMatthias Ringwald }
9628f8ee3071SMatthias Ringwald 
9629f8ee3071SMatthias Ringwald /**
9630f8ee3071SMatthias Ringwald  * @brief Exit Sniff mode
9631f8ee3071SMatthias Ringwald  * @param con_handle
9632f8ee3071SMatthias Ringwald  @ @return 0 if ok
9633f8ee3071SMatthias Ringwald  */
9634f8ee3071SMatthias Ringwald uint8_t gap_sniff_mode_exit(hci_con_handle_t con_handle){
9635f8ee3071SMatthias Ringwald     hci_connection_t * conn = hci_connection_for_handle(con_handle);
96367f839e2cSMatthias Ringwald     if (!conn) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
9637f8ee3071SMatthias Ringwald     conn->sniff_min_interval = 0xffff;
9638f8ee3071SMatthias Ringwald     hci_run();
9639f8ee3071SMatthias Ringwald     return 0;
9640f8ee3071SMatthias Ringwald }
9641bea424a5SMatthias Ringwald 
9642140c0557SMatthias 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){
9643140c0557SMatthias Ringwald     hci_connection_t * conn = hci_connection_for_handle(con_handle);
96447f839e2cSMatthias Ringwald     if (!conn) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
9645140c0557SMatthias Ringwald     conn->sniff_subrating_max_latency = max_latency;
9646140c0557SMatthias Ringwald     conn->sniff_subrating_min_remote_timeout = min_remote_timeout;
9647140c0557SMatthias Ringwald     conn->sniff_subrating_min_local_timeout = min_local_timeout;
9648140c0557SMatthias Ringwald     hci_run();
9649dc8d5bd3SMatthias Ringwald     return ERROR_CODE_SUCCESS;
9650140c0557SMatthias Ringwald }
9651140c0557SMatthias Ringwald 
9652278ff8a9SMatthias 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){
9653278ff8a9SMatthias Ringwald     hci_connection_t * conn = hci_connection_for_handle(con_handle);
96547f839e2cSMatthias Ringwald     if (!conn) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
9655278ff8a9SMatthias Ringwald     conn->qos_service_type = service_type;
9656278ff8a9SMatthias Ringwald     conn->qos_token_rate = token_rate;
9657278ff8a9SMatthias Ringwald     conn->qos_peak_bandwidth = peak_bandwidth;
9658278ff8a9SMatthias Ringwald     conn->qos_latency = latency;
9659278ff8a9SMatthias Ringwald     conn->qos_delay_variation = delay_variation;
9660278ff8a9SMatthias Ringwald     hci_run();
9661278ff8a9SMatthias Ringwald     return ERROR_CODE_SUCCESS;
9662278ff8a9SMatthias Ringwald }
9663278ff8a9SMatthias Ringwald 
9664bea424a5SMatthias Ringwald void gap_set_page_scan_activity(uint16_t page_scan_interval, uint16_t page_scan_window){
9665bea424a5SMatthias Ringwald     hci_stack->new_page_scan_interval = page_scan_interval;
9666bea424a5SMatthias Ringwald     hci_stack->new_page_scan_window = page_scan_window;
9667baa4881eSMatthias Ringwald     hci_stack->gap_tasks_classic |= GAP_TASK_WRITE_PAGE_SCAN_ACTIVITY;
9668bea424a5SMatthias Ringwald     hci_run();
9669bea424a5SMatthias Ringwald }
9670bea424a5SMatthias Ringwald 
9671bea424a5SMatthias Ringwald void gap_set_page_scan_type(page_scan_type_t page_scan_type){
9672bea424a5SMatthias Ringwald     hci_stack->new_page_scan_type = (uint8_t) page_scan_type;
9673baa4881eSMatthias Ringwald     hci_stack->gap_tasks_classic |= GAP_TASK_WRITE_PAGE_SCAN_TYPE;
9674bea424a5SMatthias Ringwald     hci_run();
9675bea424a5SMatthias Ringwald }
9676bea424a5SMatthias Ringwald 
967732a12730SMatthias Ringwald void gap_set_page_timeout(uint16_t page_timeout){
967832a12730SMatthias Ringwald     hci_stack->page_timeout = page_timeout;
9679baa4881eSMatthias Ringwald     hci_stack->gap_tasks_classic |= GAP_TASK_WRITE_PAGE_TIMEOUT;
968032a12730SMatthias Ringwald     hci_run();
968132a12730SMatthias Ringwald }
968232a12730SMatthias Ringwald 
9683f8ee3071SMatthias Ringwald #endif
9684beceeddeSMatthias Ringwald 
968521debf25SMatthias Ringwald #ifdef ENABLE_LE_PRIVACY_ADDRESS_RESOLUTION
968621debf25SMatthias Ringwald void hci_load_le_device_db_entry_into_resolving_list(uint16_t le_device_db_index){
968721debf25SMatthias Ringwald     if (le_device_db_index >= MAX_NUM_RESOLVING_LIST_ENTRIES) return;
968821debf25SMatthias Ringwald     if (le_device_db_index >= le_device_db_max_count()) return;
968921debf25SMatthias Ringwald     uint8_t offset = le_device_db_index >> 3;
969021debf25SMatthias Ringwald     uint8_t mask = 1 << (le_device_db_index & 7);
969102b02cffSMatthias Ringwald     hci_stack->le_resolving_list_add_entries[offset] |= mask;
9692e8ca66c6SMatthias Ringwald     hci_stack->le_resolving_list_set_privacy_mode[offset] |= mask;
969321debf25SMatthias Ringwald     if (hci_stack->le_resolving_list_state == LE_RESOLVING_LIST_DONE){
969402b02cffSMatthias Ringwald     	// note: go back to remove entries, otherwise, a remove + add will skip the add
96955f3ccd83SMatthias Ringwald         hci_stack->le_resolving_list_state = LE_RESOLVING_LIST_UPDATES_ENTRIES;
969602b02cffSMatthias Ringwald     }
969702b02cffSMatthias Ringwald }
969802b02cffSMatthias Ringwald 
969902b02cffSMatthias Ringwald void hci_remove_le_device_db_entry_from_resolving_list(uint16_t le_device_db_index){
970002b02cffSMatthias Ringwald 	if (le_device_db_index >= MAX_NUM_RESOLVING_LIST_ENTRIES) return;
970102b02cffSMatthias Ringwald 	if (le_device_db_index >= le_device_db_max_count()) return;
970202b02cffSMatthias Ringwald 	uint8_t offset = le_device_db_index >> 3;
970302b02cffSMatthias Ringwald 	uint8_t mask = 1 << (le_device_db_index & 7);
970402b02cffSMatthias Ringwald 	hci_stack->le_resolving_list_remove_entries[offset] |= mask;
970502b02cffSMatthias Ringwald 	if (hci_stack->le_resolving_list_state == LE_RESOLVING_LIST_DONE){
97065f3ccd83SMatthias Ringwald 		hci_stack->le_resolving_list_state = LE_RESOLVING_LIST_UPDATES_ENTRIES;
970721debf25SMatthias Ringwald 	}
970821debf25SMatthias Ringwald }
9709cf38a091SMatthias Ringwald 
9710cf38a091SMatthias Ringwald uint8_t gap_load_resolving_list_from_le_device_db(void){
97111ffa425cSMatthias Ringwald     if (hci_command_supported(SUPPORTED_HCI_COMMAND_LE_SET_ADDRESS_RESOLUTION_ENABLE) == false){
9712cf38a091SMatthias Ringwald 		return ERROR_CODE_UNSUPPORTED_FEATURE_OR_PARAMETER_VALUE;
9713cf38a091SMatthias Ringwald 	}
9714cf38a091SMatthias Ringwald 	if (hci_stack->le_resolving_list_state != LE_RESOLVING_LIST_SEND_ENABLE_ADDRESS_RESOLUTION){
9715cf38a091SMatthias Ringwald 		// restart le resolving list update
9716cf38a091SMatthias Ringwald 		hci_stack->le_resolving_list_state = LE_RESOLVING_LIST_READ_SIZE;
9717cf38a091SMatthias Ringwald 	}
9718cf38a091SMatthias Ringwald 	return ERROR_CODE_SUCCESS;
9719cf38a091SMatthias Ringwald }
9720c3d19a30SMatthias Ringwald 
9721c3d19a30SMatthias Ringwald void gap_set_peer_privacy_mode(le_privacy_mode_t privacy_mode ){
9722c3d19a30SMatthias Ringwald     hci_stack->le_privacy_mode = privacy_mode;
9723c3d19a30SMatthias Ringwald }
972421debf25SMatthias Ringwald #endif
972521debf25SMatthias Ringwald 
9726f40c73b4SMatthias Ringwald #ifdef ENABLE_BLE
9727f40c73b4SMatthias Ringwald #ifdef ENABLE_LE_CENTRAL
9728f40c73b4SMatthias Ringwald #ifdef ENABLE_LE_EXTENDED_ADVERTISING
9729f40c73b4SMatthias Ringwald 
9730f40c73b4SMatthias Ringwald static uint8_t hci_periodic_advertiser_list_add(bd_addr_type_t address_type, const bd_addr_t address, uint8_t advertising_sid){
9731100da355SMatthias Ringwald 
9732100da355SMatthias Ringwald #if !defined(HAVE_MALLOC) && (!defined(MAX_NR_PERIODIC_ADVERTISER_LIST_ENTRIES) || (MAX_NR_PERIODIC_ADVERTISER_LIST_ENTRIES == 0))
9733100da355SMatthias Ringwald     // incorrect configuration:
9734100da355SMatthias Ringwald     // - as MAX_NR_PERIODIC_ADVERTISER_LIST_ENTRIES is not defined or zero this function always fails
9735100da355SMatthias Ringwald     // - please set MAX_NR_PERIODIC_ADVERTISER_LIST_ENTRIES in btstack_config.h
9736100da355SMatthias Ringwald     btstack_assert(false);
9737100da355SMatthias Ringwald #endif
9738100da355SMatthias Ringwald 
9739f40c73b4SMatthias Ringwald     // check if already in list
9740f40c73b4SMatthias Ringwald     btstack_linked_list_iterator_t it;
9741f40c73b4SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->le_periodic_advertiser_list);
9742f40c73b4SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)) {
9743f40c73b4SMatthias Ringwald         periodic_advertiser_list_entry_t *entry = (periodic_advertiser_list_entry_t *) btstack_linked_list_iterator_next(&it);
9744f40c73b4SMatthias Ringwald         if (entry->sid != advertising_sid) {
9745f40c73b4SMatthias Ringwald             continue;
9746f40c73b4SMatthias Ringwald         }
9747f40c73b4SMatthias Ringwald         if (entry->address_type != address_type) {
9748f40c73b4SMatthias Ringwald             continue;
9749f40c73b4SMatthias Ringwald         }
9750f40c73b4SMatthias Ringwald         if (memcmp(entry->address, address, 6) != 0) {
9751f40c73b4SMatthias Ringwald             continue;
9752f40c73b4SMatthias Ringwald         }
9753f40c73b4SMatthias Ringwald         // disallow if already scheduled to add
9754f40c73b4SMatthias Ringwald         if ((entry->state & LE_PERIODIC_ADVERTISER_LIST_ENTRY_ADD_TO_CONTROLLER) != 0){
9755f40c73b4SMatthias Ringwald             return ERROR_CODE_COMMAND_DISALLOWED;
9756f40c73b4SMatthias Ringwald         }
9757f40c73b4SMatthias Ringwald         // still on controller, but scheduled to remove -> re-add
9758f40c73b4SMatthias Ringwald         entry->state |= LE_PERIODIC_ADVERTISER_LIST_ENTRY_ADD_TO_CONTROLLER;
9759f40c73b4SMatthias Ringwald         return ERROR_CODE_SUCCESS;
9760f40c73b4SMatthias Ringwald     }
9761f40c73b4SMatthias Ringwald     // alloc and add to list
9762f40c73b4SMatthias Ringwald     periodic_advertiser_list_entry_t * entry = btstack_memory_periodic_advertiser_list_entry_get();
9763f40c73b4SMatthias Ringwald     if (!entry) return BTSTACK_MEMORY_ALLOC_FAILED;
9764f40c73b4SMatthias Ringwald     entry->sid = advertising_sid;
9765f40c73b4SMatthias Ringwald     entry->address_type = address_type;
9766f40c73b4SMatthias Ringwald     (void)memcpy(entry->address, address, 6);
9767f40c73b4SMatthias Ringwald     entry->state = LE_PERIODIC_ADVERTISER_LIST_ENTRY_ADD_TO_CONTROLLER;
9768f40c73b4SMatthias Ringwald     btstack_linked_list_add(&hci_stack->le_periodic_advertiser_list, (btstack_linked_item_t*) entry);
9769f40c73b4SMatthias Ringwald     return ERROR_CODE_SUCCESS;
9770f40c73b4SMatthias Ringwald }
9771f40c73b4SMatthias Ringwald 
9772f40c73b4SMatthias Ringwald static uint8_t hci_periodic_advertiser_list_remove(bd_addr_type_t address_type, const bd_addr_t address, uint8_t advertising_sid){
9773f40c73b4SMatthias Ringwald     btstack_linked_list_iterator_t it;
9774f40c73b4SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->le_periodic_advertiser_list);
9775f40c73b4SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
9776f40c73b4SMatthias Ringwald         periodic_advertiser_list_entry_t * entry = (periodic_advertiser_list_entry_t*) btstack_linked_list_iterator_next(&it);
9777f40c73b4SMatthias Ringwald         if (entry->sid != advertising_sid) {
9778f40c73b4SMatthias Ringwald             continue;
9779f40c73b4SMatthias Ringwald         }
9780f40c73b4SMatthias Ringwald         if (entry->address_type != address_type) {
9781f40c73b4SMatthias Ringwald             continue;
9782f40c73b4SMatthias Ringwald         }
9783f40c73b4SMatthias Ringwald         if (memcmp(entry->address, address, 6) != 0) {
9784f40c73b4SMatthias Ringwald             continue;
9785f40c73b4SMatthias Ringwald         }
9786f40c73b4SMatthias Ringwald         if (entry->state & LE_PERIODIC_ADVERTISER_LIST_ENTRY_ON_CONTROLLER){
9787f40c73b4SMatthias Ringwald             // remove from controller if already present
9788f40c73b4SMatthias Ringwald             entry->state |= LE_PERIODIC_ADVERTISER_LIST_ENTRY_REMOVE_FROM_CONTROLLER;
9789f40c73b4SMatthias Ringwald         }  else {
9790f40c73b4SMatthias Ringwald             // directly remove entry from whitelist
9791f40c73b4SMatthias Ringwald             btstack_linked_list_iterator_remove(&it);
9792f40c73b4SMatthias Ringwald             btstack_memory_periodic_advertiser_list_entry_free(entry);
9793f40c73b4SMatthias Ringwald         }
9794f40c73b4SMatthias Ringwald         return ERROR_CODE_SUCCESS;
9795f40c73b4SMatthias Ringwald     }
9796f40c73b4SMatthias Ringwald     return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
9797f40c73b4SMatthias Ringwald }
9798f40c73b4SMatthias Ringwald 
9799f40c73b4SMatthias Ringwald static void hci_periodic_advertiser_list_clear(void){
9800f40c73b4SMatthias Ringwald     btstack_linked_list_iterator_t it;
9801f40c73b4SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->le_periodic_advertiser_list);
9802f40c73b4SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
9803f40c73b4SMatthias Ringwald         periodic_advertiser_list_entry_t * entry = (periodic_advertiser_list_entry_t*) btstack_linked_list_iterator_next(&it);
9804f40c73b4SMatthias Ringwald         if (entry->state & LE_PERIODIC_ADVERTISER_LIST_ENTRY_ON_CONTROLLER){
9805f40c73b4SMatthias Ringwald             // remove from controller if already present
9806f40c73b4SMatthias Ringwald             entry->state |= LE_PERIODIC_ADVERTISER_LIST_ENTRY_REMOVE_FROM_CONTROLLER;
9807f40c73b4SMatthias Ringwald             continue;
9808f40c73b4SMatthias Ringwald         }
9809f40c73b4SMatthias Ringwald         // directly remove entry from whitelist
9810f40c73b4SMatthias Ringwald         btstack_linked_list_iterator_remove(&it);
9811f40c73b4SMatthias Ringwald         btstack_memory_periodic_advertiser_list_entry_free(entry);
9812f40c73b4SMatthias Ringwald     }
9813f40c73b4SMatthias Ringwald }
9814f40c73b4SMatthias Ringwald 
9815f40c73b4SMatthias Ringwald uint8_t gap_periodic_advertiser_list_clear(void){
9816f40c73b4SMatthias Ringwald     hci_periodic_advertiser_list_clear();
9817f40c73b4SMatthias Ringwald     hci_run();
9818f40c73b4SMatthias Ringwald     return ERROR_CODE_SUCCESS;
9819f40c73b4SMatthias Ringwald }
9820f40c73b4SMatthias Ringwald 
9821f40c73b4SMatthias Ringwald uint8_t gap_periodic_advertiser_list_add(bd_addr_type_t address_type, const bd_addr_t address, uint8_t advertising_sid){
9822f40c73b4SMatthias Ringwald     uint8_t status = hci_periodic_advertiser_list_add(address_type, address, advertising_sid);
9823f40c73b4SMatthias Ringwald     if (status){
9824f40c73b4SMatthias Ringwald         return status;
9825f40c73b4SMatthias Ringwald     }
9826f40c73b4SMatthias Ringwald     hci_run();
9827f40c73b4SMatthias Ringwald     return ERROR_CODE_SUCCESS;
9828f40c73b4SMatthias Ringwald }
9829f40c73b4SMatthias Ringwald 
9830f40c73b4SMatthias Ringwald uint8_t gap_periodic_advertiser_list_remove(bd_addr_type_t address_type, const bd_addr_t address, uint8_t advertising_sid){
9831f40c73b4SMatthias Ringwald     uint8_t status = hci_periodic_advertiser_list_remove(address_type, address, advertising_sid);
9832f40c73b4SMatthias Ringwald     if (status){
9833f40c73b4SMatthias Ringwald         return status;
9834f40c73b4SMatthias Ringwald     }
9835f40c73b4SMatthias Ringwald     hci_run();
9836f40c73b4SMatthias Ringwald     return ERROR_CODE_SUCCESS;
9837f40c73b4SMatthias Ringwald }
98384bafedd5SMatthias Ringwald 
98394bafedd5SMatthias Ringwald uint8_t gap_periodic_advertising_create_sync(uint8_t options, uint8_t advertising_sid, bd_addr_type_t advertiser_address_type,
98404bafedd5SMatthias Ringwald                                              bd_addr_t advertiser_address, uint16_t skip, uint16_t sync_timeout, uint8_t sync_cte_type){
98414bafedd5SMatthias Ringwald     // abort if already active
98424bafedd5SMatthias Ringwald     if (hci_stack->le_periodic_sync_request != LE_CONNECTING_IDLE) {
98434bafedd5SMatthias Ringwald         return ERROR_CODE_COMMAND_DISALLOWED;
98444bafedd5SMatthias Ringwald     }
98454bafedd5SMatthias Ringwald     // store request
98464bafedd5SMatthias Ringwald     hci_stack->le_periodic_sync_request = ((options & 0) != 0) ? LE_CONNECTING_WHITELIST : LE_CONNECTING_DIRECT;
98474bafedd5SMatthias Ringwald     hci_stack->le_periodic_sync_options = options;
98484bafedd5SMatthias Ringwald     hci_stack->le_periodic_sync_advertising_sid = advertising_sid;
98494bafedd5SMatthias Ringwald     hci_stack->le_periodic_sync_advertiser_address_type = advertiser_address_type;
98504bafedd5SMatthias Ringwald     memcpy(hci_stack->le_periodic_sync_advertiser_address, advertiser_address, 6);
98514bafedd5SMatthias Ringwald     hci_stack->le_periodic_sync_skip = skip;
98524bafedd5SMatthias Ringwald     hci_stack->le_periodic_sync_timeout = sync_timeout;
98534bafedd5SMatthias Ringwald     hci_stack->le_periodic_sync_cte_type = sync_cte_type;
98544bafedd5SMatthias Ringwald 
98554bafedd5SMatthias Ringwald     hci_run();
98564bafedd5SMatthias Ringwald     return ERROR_CODE_SUCCESS;
98574bafedd5SMatthias Ringwald }
98584bafedd5SMatthias Ringwald 
98594bafedd5SMatthias Ringwald uint8_t gap_periodic_advertising_create_sync_cancel(void){
98604bafedd5SMatthias Ringwald     // abort if not requested
98614bafedd5SMatthias Ringwald     if (hci_stack->le_periodic_sync_request == LE_CONNECTING_IDLE) {
98624bafedd5SMatthias Ringwald         return ERROR_CODE_COMMAND_DISALLOWED;
98634bafedd5SMatthias Ringwald     }
98644bafedd5SMatthias Ringwald     hci_stack->le_periodic_sync_request = LE_CONNECTING_IDLE;
98654bafedd5SMatthias Ringwald     hci_run();
98664bafedd5SMatthias Ringwald     return ERROR_CODE_SUCCESS;
98674bafedd5SMatthias Ringwald }
98684bafedd5SMatthias Ringwald 
98694bafedd5SMatthias Ringwald uint8_t gap_periodic_advertising_terminate_sync(uint16_t sync_handle){
987049a6c69cSMatthias Ringwald     if (hci_stack->le_periodic_terminate_sync_handle != HCI_CON_HANDLE_INVALID){
987149a6c69cSMatthias Ringwald         return ERROR_CODE_COMMAND_DISALLOWED;
987249a6c69cSMatthias Ringwald     }
987349a6c69cSMatthias Ringwald     hci_stack->le_periodic_terminate_sync_handle = sync_handle;
987449a6c69cSMatthias Ringwald     hci_run();
987549a6c69cSMatthias Ringwald     return ERROR_CODE_SUCCESS;
98764bafedd5SMatthias Ringwald }
98774bafedd5SMatthias Ringwald 
9878f40c73b4SMatthias Ringwald #endif
9879f40c73b4SMatthias Ringwald #endif
98804ae8623eSMatthias Ringwald #ifdef ENABLE_LE_ISOCHRONOUS_STREAMS
9881969d876aSMatthias Ringwald static hci_iso_stream_t *
9882969d876aSMatthias 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) {
98834ae8623eSMatthias Ringwald     hci_iso_stream_t * iso_stream = btstack_memory_hci_iso_stream_get();
9884969d876aSMatthias Ringwald     if (iso_stream != NULL){
98858d72db10SMatthias Ringwald         iso_stream->iso_type = iso_type;
988626b93350SMatthias Ringwald         iso_stream->state = state;
98878d72db10SMatthias Ringwald         iso_stream->group_id = group_id;
9888969d876aSMatthias Ringwald         iso_stream->stream_id = stream_id;
9889969d876aSMatthias Ringwald         iso_stream->cis_handle = HCI_CON_HANDLE_INVALID;
9890969d876aSMatthias Ringwald         iso_stream->acl_handle = HCI_CON_HANDLE_INVALID;
98914ae8623eSMatthias Ringwald         btstack_linked_list_add(&hci_stack->iso_streams, (btstack_linked_item_t*) iso_stream);
98924ae8623eSMatthias Ringwald     }
9893969d876aSMatthias Ringwald     return iso_stream;
98944ae8623eSMatthias Ringwald }
98954ae8623eSMatthias Ringwald 
989615a15be3SMatthias Ringwald static hci_iso_stream_t * hci_iso_stream_for_con_handle(hci_con_handle_t con_handle){
98974ae8623eSMatthias Ringwald     btstack_linked_list_iterator_t it;
98984ae8623eSMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->iso_streams);
98994ae8623eSMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
99004ae8623eSMatthias Ringwald         hci_iso_stream_t * iso_stream = (hci_iso_stream_t *) btstack_linked_list_iterator_next(&it);
9901969d876aSMatthias Ringwald         if (iso_stream->cis_handle == con_handle ) {
99024ae8623eSMatthias Ringwald             return iso_stream;
99034ae8623eSMatthias Ringwald         }
99044ae8623eSMatthias Ringwald     }
99054ae8623eSMatthias Ringwald     return NULL;
99064ae8623eSMatthias Ringwald }
99074ae8623eSMatthias Ringwald 
99084ae8623eSMatthias Ringwald static void hci_iso_stream_finalize(hci_iso_stream_t * iso_stream){
9909969d876aSMatthias Ringwald     log_info("hci_iso_stream_finalize con_handle 0x%04x, group_id 0x%02x", iso_stream->cis_handle, iso_stream->group_id);
99104ae8623eSMatthias Ringwald     btstack_linked_list_remove(&hci_stack->iso_streams, (btstack_linked_item_t*) iso_stream);
99114ae8623eSMatthias Ringwald     btstack_memory_hci_iso_stream_free(iso_stream);
99124ae8623eSMatthias Ringwald }
99134ae8623eSMatthias Ringwald 
9914778463d0SMatthias Ringwald static void hci_iso_stream_finalize_by_type_and_group_id(hci_iso_type_t iso_type, uint8_t group_id) {
9915778463d0SMatthias Ringwald     btstack_linked_list_iterator_t it;
9916778463d0SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->iso_streams);
9917778463d0SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
9918778463d0SMatthias Ringwald         hci_iso_stream_t * iso_stream = (hci_iso_stream_t *) btstack_linked_list_iterator_next(&it);
9919778463d0SMatthias Ringwald         if ((iso_stream->group_id == group_id) &&
9920778463d0SMatthias Ringwald             (iso_stream->iso_type == iso_type)){
9921778463d0SMatthias Ringwald             btstack_linked_list_iterator_remove(&it);
9922778463d0SMatthias Ringwald             btstack_memory_hci_iso_stream_free(iso_stream);
9923778463d0SMatthias Ringwald         }
9924778463d0SMatthias Ringwald     }
9925778463d0SMatthias Ringwald }
9926778463d0SMatthias Ringwald 
99278d72db10SMatthias Ringwald static void hci_iso_stream_requested_finalize(uint8_t group_id) {
99284ae8623eSMatthias Ringwald     btstack_linked_list_iterator_t it;
99294ae8623eSMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->iso_streams);
99304ae8623eSMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
99314ae8623eSMatthias Ringwald         hci_iso_stream_t * iso_stream = (hci_iso_stream_t *) btstack_linked_list_iterator_next(&it);
9932a90016deSMatthias Ringwald         if ((iso_stream->state == HCI_ISO_STREAM_STATE_REQUESTED ) &&
99338d72db10SMatthias Ringwald             (iso_stream->group_id == group_id)){
99344ae8623eSMatthias Ringwald             btstack_linked_list_iterator_remove(&it);
99354ae8623eSMatthias Ringwald             btstack_memory_hci_iso_stream_free(iso_stream);
99364ae8623eSMatthias Ringwald         }
99374ae8623eSMatthias Ringwald     }
99384ae8623eSMatthias Ringwald }
9939a90016deSMatthias Ringwald static void hci_iso_stream_requested_confirm(uint8_t big_handle){
99404ae8623eSMatthias Ringwald     btstack_linked_list_iterator_t it;
99414ae8623eSMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->iso_streams);
99424ae8623eSMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
99434ae8623eSMatthias Ringwald         hci_iso_stream_t * iso_stream = (hci_iso_stream_t *) btstack_linked_list_iterator_next(&it);
99444ae8623eSMatthias Ringwald         if ( iso_stream->state == HCI_ISO_STREAM_STATE_REQUESTED ) {
99454ae8623eSMatthias Ringwald             iso_stream->state = HCI_ISO_STREAM_STATE_W4_ESTABLISHED;
99464ae8623eSMatthias Ringwald         }
99474ae8623eSMatthias Ringwald     }
99484ae8623eSMatthias Ringwald }
9949d39e4f95SMatthias Ringwald 
9950d39e4f95SMatthias Ringwald static bool hci_iso_sdu_complete(uint8_t * packet, uint16_t size){
9951d39e4f95SMatthias Ringwald     uint8_t  sdu_ts_flag = (packet[1] >> 6) & 1;
9952d39e4f95SMatthias Ringwald     uint16_t sdu_len_offset = 6 + (sdu_ts_flag * 4);
9953d39e4f95SMatthias Ringwald     uint16_t sdu_len = little_endian_read_16(packet, sdu_len_offset) & 0x0fff;
9954d39e4f95SMatthias Ringwald     return (sdu_len_offset + 2 + sdu_len) == size;
9955d39e4f95SMatthias Ringwald }
9956d39e4f95SMatthias Ringwald 
9957750818acSMatthias Ringwald static void hci_iso_packet_handler(hci_iso_stream_t *iso_stream, uint8_t *packet, uint16_t size) {
9958750818acSMatthias Ringwald     if (iso_stream == NULL){
9959750818acSMatthias Ringwald         log_error("acl_handler called with non-registered handle %u!" , READ_ISO_CONNECTION_HANDLE(packet));
9960d39e4f95SMatthias Ringwald         return;
9961d39e4f95SMatthias Ringwald     }
9962750818acSMatthias Ringwald 
9963750818acSMatthias Ringwald     if (hci_stack->iso_packet_handler == NULL) {
9964d39e4f95SMatthias Ringwald         return;
9965d39e4f95SMatthias Ringwald     }
9966d39e4f95SMatthias Ringwald 
9967d39e4f95SMatthias Ringwald     // parse header
9968a14c18deSMatthias Ringwald     uint16_t con_handle_and_flags = little_endian_read_16(packet, 0);
9969a14c18deSMatthias Ringwald     uint16_t data_total_length = little_endian_read_16(packet, 2);
9970a14c18deSMatthias Ringwald     uint8_t  pb_flag = (con_handle_and_flags >> 12) & 3;
9971d39e4f95SMatthias Ringwald 
9972d39e4f95SMatthias Ringwald     // assert packet is complete
9973a14c18deSMatthias Ringwald     if ((data_total_length + 4u) != size){
9974d39e4f95SMatthias Ringwald         return;
9975d39e4f95SMatthias Ringwald     }
9976d39e4f95SMatthias Ringwald 
9977d39e4f95SMatthias Ringwald     if ((pb_flag & 0x01) == 0){
9978d39e4f95SMatthias Ringwald         if (pb_flag == 0x02){
9979a14c18deSMatthias Ringwald             // The ISO_SDU_Fragment field contains a header and a complete SDU.
9980d39e4f95SMatthias Ringwald             if (hci_iso_sdu_complete(packet, size)) {
9981d39e4f95SMatthias Ringwald                 (hci_stack->iso_packet_handler)(HCI_ISO_DATA_PACKET, 0, packet, size);
9982d39e4f95SMatthias Ringwald             }
9983d39e4f95SMatthias Ringwald         } else {
9984d39e4f95SMatthias Ringwald             // The ISO_Data_Load field contains a header and the first fragment of a fragmented SDU.
998560468fb4SMatthias Ringwald             if (size > sizeof(iso_stream->reassembly_buffer)){
9986d39e4f95SMatthias Ringwald                 return;
9987d39e4f95SMatthias Ringwald             }
9988d39e4f95SMatthias Ringwald             memcpy(iso_stream->reassembly_buffer, packet, size);
9989d39e4f95SMatthias Ringwald             // fix pb_flag
9990d39e4f95SMatthias Ringwald             iso_stream->reassembly_buffer[1] = (iso_stream->reassembly_buffer[1] & 0xcf) | 0x20;
9991d39e4f95SMatthias Ringwald             iso_stream->reassembly_pos = size;
9992d39e4f95SMatthias Ringwald         }
9993d39e4f95SMatthias Ringwald     } else {
9994a14c18deSMatthias Ringwald         // ISO_SDU_Fragment contains continuation or last fragment of an SDU
9995a14c18deSMatthias Ringwald         uint8_t ts_flag = (con_handle_and_flags >> 14) & 1;
9996d39e4f95SMatthias Ringwald         if (ts_flag != 0){
9997d39e4f95SMatthias Ringwald            return;
9998d39e4f95SMatthias Ringwald         }
9999d39e4f95SMatthias Ringwald         // append fragment
10000d39e4f95SMatthias Ringwald         if (iso_stream->reassembly_pos == 0){
10001d39e4f95SMatthias Ringwald             return;
10002d39e4f95SMatthias Ringwald         }
1000360468fb4SMatthias Ringwald 
10004a14c18deSMatthias Ringwald         if ((iso_stream->reassembly_pos + data_total_length) > sizeof(iso_stream->reassembly_buffer)){
10005d39e4f95SMatthias Ringwald             // reset reassembly buffer
10006d39e4f95SMatthias Ringwald             iso_stream->reassembly_pos = 0;
10007d39e4f95SMatthias Ringwald             return;
10008d39e4f95SMatthias Ringwald         }
10009a14c18deSMatthias Ringwald         memcpy(&iso_stream->reassembly_buffer[iso_stream->reassembly_pos], &packet[4], data_total_length);
10010a14c18deSMatthias Ringwald         iso_stream->reassembly_pos += data_total_length;
10011d39e4f95SMatthias Ringwald 
10012d39e4f95SMatthias Ringwald         // deliver if last fragment and SDU complete
10013d39e4f95SMatthias Ringwald         if (pb_flag == 0x03){
10014d39e4f95SMatthias Ringwald             if (hci_iso_sdu_complete(iso_stream->reassembly_buffer, iso_stream->reassembly_pos)){
10015a14c18deSMatthias Ringwald                 // fix data_total_length
1001660468fb4SMatthias Ringwald                 little_endian_store_16(iso_stream->reassembly_buffer, 2, iso_stream->reassembly_pos - HCI_ISO_HEADER_SIZE);
10017d39e4f95SMatthias Ringwald                 (hci_stack->iso_packet_handler)(HCI_ISO_DATA_PACKET, 0, iso_stream->reassembly_buffer, iso_stream->reassembly_pos);
10018d39e4f95SMatthias Ringwald             }
10019a14c18deSMatthias Ringwald             // reset reassembly buffer
10020d39e4f95SMatthias Ringwald             iso_stream->reassembly_pos = 0;
10021d39e4f95SMatthias Ringwald         }
10022d39e4f95SMatthias Ringwald     }
10023d39e4f95SMatthias Ringwald }
10024d39e4f95SMatthias Ringwald 
100257aa35f6aSMatthias Ringwald static void hci_emit_big_created(const le_audio_big_t * big, uint8_t status){
100267aa35f6aSMatthias Ringwald     uint8_t event [6 + (MAX_NR_BIS * 2)];
100277aa35f6aSMatthias Ringwald     uint16_t pos = 0;
100287aa35f6aSMatthias Ringwald     event[pos++] = HCI_EVENT_META_GAP;
100297aa35f6aSMatthias Ringwald     event[pos++] = 4 + (2 * big->num_bis);
100307aa35f6aSMatthias Ringwald     event[pos++] = GAP_SUBEVENT_BIG_CREATED;
100317aa35f6aSMatthias Ringwald     event[pos++] = status;
100327aa35f6aSMatthias Ringwald     event[pos++] = big->big_handle;
100337aa35f6aSMatthias Ringwald     event[pos++] = big->num_bis;
100347aa35f6aSMatthias Ringwald     uint8_t i;
100357aa35f6aSMatthias Ringwald     for (i=0;i<big->num_bis;i++){
100367aa35f6aSMatthias Ringwald         little_endian_store_16(event, pos, big->bis_con_handles[i]);
100377aa35f6aSMatthias Ringwald         pos += 2;
100387aa35f6aSMatthias Ringwald     }
100397aa35f6aSMatthias Ringwald     hci_emit_event(event, pos, 0);
100407aa35f6aSMatthias Ringwald }
100417aa35f6aSMatthias Ringwald 
10042d3a89d91SMatthias Ringwald static void hci_emit_cig_created(const le_audio_cig_t * cig, uint8_t status){
10043d3a89d91SMatthias Ringwald     uint8_t event [6 + (MAX_NR_CIS * 2)];
10044d3a89d91SMatthias Ringwald     uint16_t pos = 0;
10045d3a89d91SMatthias Ringwald     event[pos++] = HCI_EVENT_META_GAP;
10046d3a89d91SMatthias Ringwald     event[pos++] = 4 + (2 * cig->num_cis);
10047d3a89d91SMatthias Ringwald     event[pos++] = GAP_SUBEVENT_CIG_CREATED;
10048d3a89d91SMatthias Ringwald     event[pos++] = status;
10049d3a89d91SMatthias Ringwald     event[pos++] = cig->cig_id;
10050d3a89d91SMatthias Ringwald     event[pos++] = cig->num_cis;
10051d3a89d91SMatthias Ringwald     uint8_t i;
10052d3a89d91SMatthias Ringwald     for (i=0;i<cig->num_cis;i++){
10053d3a89d91SMatthias Ringwald         little_endian_store_16(event, pos, cig->cis_con_handles[i]);
10054d3a89d91SMatthias Ringwald         pos += 2;
10055d3a89d91SMatthias Ringwald     }
10056d3a89d91SMatthias Ringwald     hci_emit_event(event, pos, 0);
10057d3a89d91SMatthias Ringwald }
10058f06bb90fSMatthias Ringwald 
10059620553bdSMatthias Ringwald static uint16_t hci_setup_cis_created(uint8_t * event, hci_iso_stream_t * iso_stream, uint8_t status) {
10060f06bb90fSMatthias Ringwald     uint16_t pos = 0;
10061f06bb90fSMatthias Ringwald     event[pos++] = HCI_EVENT_META_GAP;
10062cf439c63SMatthias Ringwald     event[pos++] = 8;
10063f06bb90fSMatthias Ringwald     event[pos++] = GAP_SUBEVENT_CIS_CREATED;
10064f06bb90fSMatthias Ringwald     event[pos++] = status;
10065620553bdSMatthias Ringwald     event[pos++] = iso_stream->group_id;
10066620553bdSMatthias Ringwald     event[pos++] = iso_stream->stream_id;
10067620553bdSMatthias Ringwald     little_endian_store_16(event, pos, iso_stream->cis_handle);
10068f06bb90fSMatthias Ringwald     pos += 2;
10069620553bdSMatthias Ringwald     little_endian_store_16(event, pos, iso_stream->acl_handle);
10070cf439c63SMatthias Ringwald     pos += 2;
100717dd97f73SMatthias Ringwald     little_endian_store_16(event, pos, iso_stream->iso_interval_1250us);
100727dd97f73SMatthias Ringwald     pos += 2;
100737dd97f73SMatthias Ringwald     event[pos++] = iso_stream->number_of_subevents;
100747dd97f73SMatthias Ringwald     event[pos++] = iso_stream->burst_number_c_to_p;
100757dd97f73SMatthias Ringwald     event[pos++] = iso_stream->burst_number_p_to_c;
100767dd97f73SMatthias Ringwald     event[pos++] = iso_stream->flush_timeout_c_to_p;
100777dd97f73SMatthias Ringwald     event[pos++] = iso_stream->flush_timeout_p_to_c;
10078620553bdSMatthias Ringwald     return pos;
10079f06bb90fSMatthias Ringwald }
10080f06bb90fSMatthias Ringwald 
1008114045fdbSMatthias Ringwald // emits GAP_SUBEVENT_CIS_CREATED after calling hci_iso_finalize
1008214045fdbSMatthias Ringwald static void hci_cis_handle_created(hci_iso_stream_t * iso_stream, uint8_t status){
1008314045fdbSMatthias Ringwald     // cache data before finalizing struct
100847dd97f73SMatthias Ringwald     uint8_t event [17];
10085620553bdSMatthias Ringwald     uint16_t pos = hci_setup_cis_created(event, iso_stream, status);
10086620553bdSMatthias Ringwald     btstack_assert(pos <= sizeof(event));
1008714045fdbSMatthias Ringwald     if (status != ERROR_CODE_SUCCESS){
1008814045fdbSMatthias Ringwald         hci_iso_stream_finalize(iso_stream);
1008914045fdbSMatthias Ringwald     }
10090620553bdSMatthias Ringwald     hci_emit_event(event, pos, 0);
1009114045fdbSMatthias Ringwald }
1009214045fdbSMatthias Ringwald 
100937aa35f6aSMatthias Ringwald static void hci_emit_big_terminated(const le_audio_big_t * big){
100947aa35f6aSMatthias Ringwald     uint8_t event [4];
100957aa35f6aSMatthias Ringwald     uint16_t pos = 0;
100967aa35f6aSMatthias Ringwald     event[pos++] = HCI_EVENT_META_GAP;
100977aa35f6aSMatthias Ringwald     event[pos++] = 2;
100987aa35f6aSMatthias Ringwald     event[pos++] = GAP_SUBEVENT_BIG_TERMINATED;
100997aa35f6aSMatthias Ringwald     event[pos++] = big->big_handle;
101007aa35f6aSMatthias Ringwald     hci_emit_event(event, pos, 0);
101017aa35f6aSMatthias Ringwald }
101027aa35f6aSMatthias Ringwald 
101032a6c0f82SMatthias Ringwald static void hci_emit_big_sync_created(const le_audio_big_sync_t * big_sync, uint8_t status){
101042a6c0f82SMatthias Ringwald     uint8_t event [6 + (MAX_NR_BIS * 2)];
101052a6c0f82SMatthias Ringwald     uint16_t pos = 0;
101062a6c0f82SMatthias Ringwald     event[pos++] = HCI_EVENT_META_GAP;
101072a6c0f82SMatthias Ringwald     event[pos++] = 4;
101082a6c0f82SMatthias Ringwald     event[pos++] = GAP_SUBEVENT_BIG_SYNC_CREATED;
101092a6c0f82SMatthias Ringwald     event[pos++] = status;
101102a6c0f82SMatthias Ringwald     event[pos++] = big_sync->big_handle;
101112a6c0f82SMatthias Ringwald     event[pos++] = big_sync->num_bis;
101122a6c0f82SMatthias Ringwald     uint8_t i;
101132a6c0f82SMatthias Ringwald     for (i=0;i<big_sync->num_bis;i++){
101142a6c0f82SMatthias Ringwald         little_endian_store_16(event, pos, big_sync->bis_con_handles[i]);
101152a6c0f82SMatthias Ringwald         pos += 2;
101162a6c0f82SMatthias Ringwald     }
101172a6c0f82SMatthias Ringwald     hci_emit_event(event, pos, 0);
101182a6c0f82SMatthias Ringwald }
101192a6c0f82SMatthias Ringwald 
10120d04a9afcSMatthias Ringwald static void hci_emit_big_sync_stopped(uint8_t big_handle){
101212a6c0f82SMatthias Ringwald     uint8_t event [4];
101222a6c0f82SMatthias Ringwald     uint16_t pos = 0;
101232a6c0f82SMatthias Ringwald     event[pos++] = HCI_EVENT_META_GAP;
101242a6c0f82SMatthias Ringwald     event[pos++] = 2;
101252a6c0f82SMatthias Ringwald     event[pos++] = GAP_SUBEVENT_BIG_SYNC_STOPPED;
10126d04a9afcSMatthias Ringwald     event[pos++] = big_handle;
101272a6c0f82SMatthias Ringwald     hci_emit_event(event, pos, 0);
101282a6c0f82SMatthias Ringwald }
101292a6c0f82SMatthias Ringwald 
101305ade6657SMatthias Ringwald static void hci_emit_bis_can_send_now(const le_audio_big_t *big, uint8_t bis_index) {
101315ade6657SMatthias Ringwald     uint8_t event[6];
101325ade6657SMatthias Ringwald     uint16_t pos = 0;
101335ade6657SMatthias Ringwald     event[pos++] = HCI_EVENT_BIS_CAN_SEND_NOW;
101345ade6657SMatthias Ringwald     event[pos++] = sizeof(event) - 2;
101355ade6657SMatthias Ringwald     event[pos++] = big->big_handle;
101365ade6657SMatthias Ringwald     event[pos++] = bis_index;
101375ade6657SMatthias Ringwald     little_endian_store_16(event, pos, big->bis_con_handles[bis_index]);
101385ade6657SMatthias Ringwald     hci_emit_event(&event[0], sizeof(event), 0);  // don't dump
101395ade6657SMatthias Ringwald }
101405ade6657SMatthias Ringwald 
101412c077771SMatthias Ringwald static void hci_emit_cis_can_send_now(hci_con_handle_t cis_con_handle) {
101422c077771SMatthias Ringwald     uint8_t event[4];
101432c077771SMatthias Ringwald     uint16_t pos = 0;
101442c077771SMatthias Ringwald     event[pos++] = HCI_EVENT_CIS_CAN_SEND_NOW;
101452c077771SMatthias Ringwald     event[pos++] = sizeof(event) - 2;
101462c077771SMatthias Ringwald     little_endian_store_16(event, pos, cis_con_handle);
101472c077771SMatthias Ringwald     hci_emit_event(&event[0], sizeof(event), 0);  // don't dump
101482c077771SMatthias Ringwald }
101492c077771SMatthias Ringwald 
101507aa35f6aSMatthias Ringwald static le_audio_big_t * hci_big_for_handle(uint8_t big_handle){
101517aa35f6aSMatthias Ringwald     btstack_linked_list_iterator_t it;
101527aa35f6aSMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->le_audio_bigs);
101537aa35f6aSMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
101547aa35f6aSMatthias Ringwald         le_audio_big_t * big = (le_audio_big_t *) btstack_linked_list_iterator_next(&it);
101557aa35f6aSMatthias Ringwald         if ( big->big_handle == big_handle ) {
101567aa35f6aSMatthias Ringwald             return big;
101577aa35f6aSMatthias Ringwald         }
101587aa35f6aSMatthias Ringwald     }
101597aa35f6aSMatthias Ringwald     return NULL;
101607aa35f6aSMatthias Ringwald }
101617aa35f6aSMatthias Ringwald 
101622a6c0f82SMatthias Ringwald static le_audio_big_sync_t * hci_big_sync_for_handle(uint8_t big_handle){
101632a6c0f82SMatthias Ringwald     btstack_linked_list_iterator_t it;
101642a6c0f82SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->le_audio_big_syncs);
101652a6c0f82SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
101662a6c0f82SMatthias Ringwald         le_audio_big_sync_t * big_sync = (le_audio_big_sync_t *) btstack_linked_list_iterator_next(&it);
101672a6c0f82SMatthias Ringwald         if ( big_sync->big_handle == big_handle ) {
101682a6c0f82SMatthias Ringwald             return big_sync;
101692a6c0f82SMatthias Ringwald         }
101702a6c0f82SMatthias Ringwald     }
101712a6c0f82SMatthias Ringwald     return NULL;
101722a6c0f82SMatthias Ringwald }
101732a6c0f82SMatthias Ringwald 
1017401d4f05fSMatthias Ringwald void hci_set_num_iso_packets_to_queue(uint8_t num_packets){
1017501d4f05fSMatthias Ringwald     hci_stack->iso_packets_to_queue = num_packets;
1017601d4f05fSMatthias Ringwald }
1017701d4f05fSMatthias Ringwald 
10178d3a89d91SMatthias Ringwald static le_audio_cig_t * hci_cig_for_id(uint8_t cig_id){
10179d3a89d91SMatthias Ringwald     btstack_linked_list_iterator_t it;
10180d3a89d91SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->le_audio_cigs);
10181d3a89d91SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
10182d3a89d91SMatthias Ringwald         le_audio_cig_t * cig = (le_audio_cig_t *) btstack_linked_list_iterator_next(&it);
10183d3a89d91SMatthias Ringwald         if ( cig->cig_id == cig_id ) {
10184d3a89d91SMatthias Ringwald             return cig;
10185d3a89d91SMatthias Ringwald         }
10186d3a89d91SMatthias Ringwald     }
10187d3a89d91SMatthias Ringwald     return NULL;
10188d3a89d91SMatthias Ringwald }
10189d3a89d91SMatthias Ringwald 
101905ade6657SMatthias Ringwald static void hci_iso_notify_can_send_now(void){
101912c077771SMatthias Ringwald 
101922c077771SMatthias Ringwald     // BIG
101932c077771SMatthias Ringwald 
101945ade6657SMatthias Ringwald     btstack_linked_list_iterator_t it;
101955ade6657SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->le_audio_bigs);
101965ade6657SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
101975ade6657SMatthias Ringwald         le_audio_big_t * big = (le_audio_big_t *) btstack_linked_list_iterator_next(&it);
10198aacb1081SMatthias Ringwald         // track number completed packet timestamps
10199aacb1081SMatthias Ringwald         if (big->num_completed_timestamp_current_valid){
10200aacb1081SMatthias Ringwald             big->num_completed_timestamp_current_valid = false;
10201aacb1081SMatthias Ringwald             if (big->num_completed_timestamp_previous_valid){
10202aacb1081SMatthias Ringwald                 // detect delayed sending of all BIS: tolerate up to 50% delayed event handling
10203aacb1081SMatthias Ringwald                 uint32_t iso_interval_missed_threshold_ms = big->params->sdu_interval_us * 3 / 2000;
10204aacb1081SMatthias Ringwald                 int32_t  num_completed_timestamp_delta_ms = btstack_time_delta(big->num_completed_timestamp_current_ms,
10205aacb1081SMatthias Ringwald                                                                                big->num_completed_timestamp_previous_ms);
10206aacb1081SMatthias Ringwald                 if (num_completed_timestamp_delta_ms > iso_interval_missed_threshold_ms){
10207aacb1081SMatthias Ringwald                     // to catch up, skip packet on all BIS
10208aacb1081SMatthias Ringwald                     uint8_t i;
10209aacb1081SMatthias Ringwald                     for (i=0;i<big->num_bis;i++){
10210aacb1081SMatthias Ringwald                         hci_iso_stream_t * iso_stream = hci_iso_stream_for_con_handle(big->bis_con_handles[i]);
10211aacb1081SMatthias Ringwald                         if (iso_stream){
10212aacb1081SMatthias Ringwald                             iso_stream->num_packets_to_skip++;
10213aacb1081SMatthias Ringwald                         }
10214aacb1081SMatthias Ringwald                     }
10215aacb1081SMatthias Ringwald                 }
10216aacb1081SMatthias Ringwald             }
10217aacb1081SMatthias Ringwald             big->num_completed_timestamp_previous_valid = true;
10218aacb1081SMatthias Ringwald             big->num_completed_timestamp_previous_ms = big->num_completed_timestamp_current_ms;
10219aacb1081SMatthias Ringwald         }
10220aacb1081SMatthias Ringwald 
102215ade6657SMatthias Ringwald         if (big->can_send_now_requested){
10222d4e5d4faSMatthias Ringwald             // check if no outgoing iso packets pending and no can send now have to be emitted
102235ade6657SMatthias Ringwald             uint8_t i;
102245ade6657SMatthias Ringwald             bool can_send = true;
10225aacb1081SMatthias Ringwald             uint8_t num_iso_queued_minimum = 0;
102265ade6657SMatthias Ringwald             for (i=0;i<big->num_bis;i++){
102275ade6657SMatthias Ringwald                 hci_iso_stream_t * iso_stream = hci_iso_stream_for_con_handle(big->bis_con_handles[i]);
10228aacb1081SMatthias Ringwald                 if (iso_stream == NULL) continue;
10229aacb1081SMatthias Ringwald                 // handle case where individual ISO packet was sent too late:
10230aacb1081SMatthias Ringwald                 // for each additionally queued packet, a new one needs to get skipped
10231aacb1081SMatthias Ringwald                 if (i==0){
10232aacb1081SMatthias Ringwald                     num_iso_queued_minimum = iso_stream->num_packets_sent;
10233aacb1081SMatthias Ringwald                 } else if (iso_stream->num_packets_sent > num_iso_queued_minimum){
10234aacb1081SMatthias Ringwald                     uint8_t num_packets_to_skip = iso_stream->num_packets_sent - num_iso_queued_minimum;
10235aacb1081SMatthias Ringwald                     iso_stream->num_packets_to_skip += num_packets_to_skip;
10236aacb1081SMatthias Ringwald                     iso_stream->num_packets_sent    -= num_packets_to_skip;
10237aacb1081SMatthias Ringwald                 }
10238aacb1081SMatthias Ringwald                 // check if we can send now
10239aacb1081SMatthias Ringwald                 if  ((iso_stream->num_packets_sent >= hci_stack->iso_packets_to_queue) || (iso_stream->emit_ready_to_send)){
102405ade6657SMatthias Ringwald                     can_send = false;
102415ade6657SMatthias Ringwald                     break;
102425ade6657SMatthias Ringwald                 }
102435ade6657SMatthias Ringwald             }
102445ade6657SMatthias Ringwald             if (can_send){
102455ade6657SMatthias Ringwald                 // propagate can send now to individual streams
102465ade6657SMatthias Ringwald                 big->can_send_now_requested = false;
102475ade6657SMatthias Ringwald                 for (i=0;i<big->num_bis;i++){
102485ade6657SMatthias Ringwald                     hci_iso_stream_t * iso_stream = hci_iso_stream_for_con_handle(big->bis_con_handles[i]);
102495ade6657SMatthias Ringwald                     iso_stream->emit_ready_to_send = true;
102505ade6657SMatthias Ringwald                 }
102515ade6657SMatthias Ringwald             }
102525ade6657SMatthias Ringwald         }
102535ade6657SMatthias Ringwald     }
102545ade6657SMatthias Ringwald 
102555ade6657SMatthias Ringwald     if (hci_stack->hci_packet_buffer_reserved) return;
102565ade6657SMatthias Ringwald 
102575ade6657SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->le_audio_bigs);
102585ade6657SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
102595ade6657SMatthias Ringwald         le_audio_big_t * big = (le_audio_big_t *) btstack_linked_list_iterator_next(&it);
102605ade6657SMatthias Ringwald         // report bis ready
102615ade6657SMatthias Ringwald         uint8_t i;
102625ade6657SMatthias Ringwald         for (i=0;i<big->num_bis;i++){
102635ade6657SMatthias Ringwald             hci_iso_stream_t * iso_stream = hci_iso_stream_for_con_handle(big->bis_con_handles[i]);
102645ade6657SMatthias Ringwald             if ((iso_stream != NULL) && iso_stream->emit_ready_to_send){
102655ade6657SMatthias Ringwald                 iso_stream->emit_ready_to_send = false;
102665ade6657SMatthias Ringwald                 hci_emit_bis_can_send_now(big, i);
102675ade6657SMatthias Ringwald                 break;
102685ade6657SMatthias Ringwald             }
102695ade6657SMatthias Ringwald         }
102705ade6657SMatthias Ringwald     }
102712c077771SMatthias Ringwald 
102722c077771SMatthias Ringwald     // CIS
102732c077771SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->iso_streams);
102742c077771SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)) {
102752c077771SMatthias Ringwald         hci_iso_stream_t *iso_stream = (hci_iso_stream_t *) btstack_linked_list_iterator_next(&it);
102762c077771SMatthias Ringwald         if ((iso_stream->can_send_now_requested) &&
102772c077771SMatthias Ringwald             (iso_stream->num_packets_sent < hci_stack->iso_packets_to_queue)){
102782c077771SMatthias Ringwald             iso_stream->can_send_now_requested = false;
10279969d876aSMatthias Ringwald             hci_emit_cis_can_send_now(iso_stream->cis_handle);
102802c077771SMatthias Ringwald         }
102812c077771SMatthias Ringwald     }
102825ade6657SMatthias Ringwald }
102835ade6657SMatthias Ringwald 
10284c7308688SMatthias Ringwald static uint8_t gap_big_setup_iso_streams(uint8_t num_bis, uint8_t big_handle){
10285d034696aSMatthias Ringwald     // make big handle unique and usuable for big and big sync
10286c7308688SMatthias Ringwald     if (hci_big_for_handle(big_handle) != NULL){
102877aa35f6aSMatthias Ringwald         return ERROR_CODE_ACL_CONNECTION_ALREADY_EXISTS;
102887aa35f6aSMatthias Ringwald     }
10289c7308688SMatthias Ringwald     if (hci_big_sync_for_handle(big_handle) != NULL){
10290d034696aSMatthias Ringwald         return ERROR_CODE_ACL_CONNECTION_ALREADY_EXISTS;
10291d034696aSMatthias Ringwald     }
10292c7308688SMatthias Ringwald     if (num_bis == 0){
102937aa35f6aSMatthias Ringwald         return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS;
102947aa35f6aSMatthias Ringwald     }
10295c7308688SMatthias Ringwald     if (num_bis > MAX_NR_BIS){
102967aa35f6aSMatthias Ringwald         return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS;
102977aa35f6aSMatthias Ringwald     }
102987aa35f6aSMatthias Ringwald 
10299fb16346aSMatthias Ringwald     // reserve ISO Streams
10300fb16346aSMatthias Ringwald     uint8_t i;
10301fb16346aSMatthias Ringwald     uint8_t status = ERROR_CODE_SUCCESS;
10302c7308688SMatthias Ringwald     for (i=0;i<num_bis;i++){
10303c7308688SMatthias Ringwald         hci_iso_stream_t * iso_stream = hci_iso_stream_create(HCI_ISO_TYPE_BIS, HCI_ISO_STREAM_STATE_REQUESTED, big_handle, i);
10304969d876aSMatthias Ringwald         if (iso_stream == NULL) {
10305969d876aSMatthias Ringwald             status = ERROR_CODE_MEMORY_CAPACITY_EXCEEDED;
10306fb16346aSMatthias Ringwald             break;
10307fb16346aSMatthias Ringwald         }
10308fb16346aSMatthias Ringwald     }
10309fb16346aSMatthias Ringwald 
10310fb16346aSMatthias Ringwald     // free structs on error
10311fb16346aSMatthias Ringwald     if (status != ERROR_CODE_SUCCESS){
10312c7308688SMatthias Ringwald         hci_iso_stream_finalize_by_type_and_group_id(HCI_ISO_TYPE_BIS, big_handle);
10313c7308688SMatthias Ringwald     }
10314c7308688SMatthias Ringwald 
10315c7308688SMatthias Ringwald     return status;
10316c7308688SMatthias Ringwald }
10317c7308688SMatthias Ringwald 
10318c7308688SMatthias Ringwald uint8_t gap_big_create(le_audio_big_t * storage, le_audio_big_params_t * big_params){
10319c7308688SMatthias Ringwald     uint8_t status = gap_big_setup_iso_streams(big_params->num_bis, big_params->big_handle);
10320c7308688SMatthias Ringwald     if (status != ERROR_CODE_SUCCESS){
10321fb16346aSMatthias Ringwald         return status;
10322fb16346aSMatthias Ringwald     }
10323fb16346aSMatthias Ringwald 
103247aa35f6aSMatthias Ringwald     le_audio_big_t * big = storage;
103257aa35f6aSMatthias Ringwald     big->big_handle = big_params->big_handle;
103267aa35f6aSMatthias Ringwald     big->params = big_params;
103277aa35f6aSMatthias Ringwald     big->state = LE_AUDIO_BIG_STATE_CREATE;
103287aa35f6aSMatthias Ringwald     big->num_bis = big_params->num_bis;
103297aa35f6aSMatthias Ringwald     btstack_linked_list_add(&hci_stack->le_audio_bigs, (btstack_linked_item_t *) big);
103307aa35f6aSMatthias Ringwald 
103317aa35f6aSMatthias Ringwald     hci_run();
103327aa35f6aSMatthias Ringwald 
103337aa35f6aSMatthias Ringwald     return ERROR_CODE_SUCCESS;
103347aa35f6aSMatthias Ringwald }
103357aa35f6aSMatthias Ringwald 
103362a6c0f82SMatthias Ringwald uint8_t gap_big_sync_create(le_audio_big_sync_t * storage, le_audio_big_sync_params_t * big_sync_params){
10337c7308688SMatthias Ringwald     uint8_t status = gap_big_setup_iso_streams(big_sync_params->num_bis, big_sync_params->big_handle);
1033802e19895SMatthias Ringwald     if (status != ERROR_CODE_SUCCESS){
1033902e19895SMatthias Ringwald         return status;
1034002e19895SMatthias Ringwald     }
1034102e19895SMatthias Ringwald 
103422a6c0f82SMatthias Ringwald     le_audio_big_sync_t * big_sync = storage;
103432a6c0f82SMatthias Ringwald     big_sync->big_handle = big_sync_params->big_handle;
103442a6c0f82SMatthias Ringwald     big_sync->params = big_sync_params;
103452a6c0f82SMatthias Ringwald     big_sync->state = LE_AUDIO_BIG_STATE_CREATE;
103462a6c0f82SMatthias Ringwald     big_sync->num_bis = big_sync_params->num_bis;
103472a6c0f82SMatthias Ringwald     btstack_linked_list_add(&hci_stack->le_audio_big_syncs, (btstack_linked_item_t *) big_sync);
103482a6c0f82SMatthias Ringwald 
103492a6c0f82SMatthias Ringwald     hci_run();
103502a6c0f82SMatthias Ringwald 
103512a6c0f82SMatthias Ringwald     return ERROR_CODE_SUCCESS;
103522a6c0f82SMatthias Ringwald }
103532a6c0f82SMatthias Ringwald 
103547aa35f6aSMatthias Ringwald uint8_t gap_big_terminate(uint8_t big_handle){
103557aa35f6aSMatthias Ringwald     le_audio_big_t * big = hci_big_for_handle(big_handle);
103567aa35f6aSMatthias Ringwald     if (big == NULL){
103577aa35f6aSMatthias Ringwald         return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
103587aa35f6aSMatthias Ringwald     }
103597aa35f6aSMatthias Ringwald     switch (big->state){
103607aa35f6aSMatthias Ringwald         case LE_AUDIO_BIG_STATE_CREATE:
103617aa35f6aSMatthias Ringwald             btstack_linked_list_remove(&hci_stack->le_audio_bigs, (btstack_linked_item_t *) big);
103622a6c0f82SMatthias Ringwald             hci_emit_big_terminated(big);
103632a6c0f82SMatthias Ringwald             break;
103642a6c0f82SMatthias Ringwald         case LE_AUDIO_BIG_STATE_W4_SETUP_ISO_PATH:
103652a6c0f82SMatthias Ringwald             big->state = LE_AUDIO_BIG_STATE_W4_SETUP_ISO_PATH_THEN_TERMINATE;
103667aa35f6aSMatthias Ringwald             break;
103677aa35f6aSMatthias Ringwald         case LE_AUDIO_BIG_STATE_W4_ESTABLISHED:
103687aa35f6aSMatthias Ringwald         case LE_AUDIO_BIG_STATE_SETUP_ISO_PATH:
103697aa35f6aSMatthias Ringwald         case LE_AUDIO_BIG_STATE_ACTIVE:
103707aa35f6aSMatthias Ringwald             big->state = LE_AUDIO_BIG_STATE_TERMINATE;
103717aa35f6aSMatthias Ringwald             hci_run();
103727aa35f6aSMatthias Ringwald             break;
103732a6c0f82SMatthias Ringwald         default:
103742a6c0f82SMatthias Ringwald             return ERROR_CODE_COMMAND_DISALLOWED;
103752a6c0f82SMatthias Ringwald     }
103762a6c0f82SMatthias Ringwald     return ERROR_CODE_SUCCESS;
103772a6c0f82SMatthias Ringwald }
103782a6c0f82SMatthias Ringwald 
103792a6c0f82SMatthias Ringwald uint8_t gap_big_sync_terminate(uint8_t big_handle){
103802a6c0f82SMatthias Ringwald     le_audio_big_sync_t * big_sync = hci_big_sync_for_handle(big_handle);
103812a6c0f82SMatthias Ringwald     if (big_sync == NULL){
103822a6c0f82SMatthias Ringwald         return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
103832a6c0f82SMatthias Ringwald     }
103842a6c0f82SMatthias Ringwald     switch (big_sync->state){
103852a6c0f82SMatthias Ringwald         case LE_AUDIO_BIG_STATE_CREATE:
103862a6c0f82SMatthias Ringwald             btstack_linked_list_remove(&hci_stack->le_audio_big_syncs, (btstack_linked_item_t *) big_sync);
10387d04a9afcSMatthias Ringwald             hci_emit_big_sync_stopped(big_handle);
103882a6c0f82SMatthias Ringwald             break;
103897aa35f6aSMatthias Ringwald         case LE_AUDIO_BIG_STATE_W4_SETUP_ISO_PATH:
103902a6c0f82SMatthias Ringwald             big_sync->state = LE_AUDIO_BIG_STATE_W4_SETUP_ISO_PATH_THEN_TERMINATE;
103912a6c0f82SMatthias Ringwald             break;
103922a6c0f82SMatthias Ringwald         case LE_AUDIO_BIG_STATE_W4_ESTABLISHED:
103932a6c0f82SMatthias Ringwald         case LE_AUDIO_BIG_STATE_SETUP_ISO_PATH:
103942a6c0f82SMatthias Ringwald         case LE_AUDIO_BIG_STATE_ACTIVE:
103952a6c0f82SMatthias Ringwald             big_sync->state = LE_AUDIO_BIG_STATE_TERMINATE;
103962a6c0f82SMatthias Ringwald             hci_run();
103977aa35f6aSMatthias Ringwald             break;
103987aa35f6aSMatthias Ringwald         default:
103997aa35f6aSMatthias Ringwald             return ERROR_CODE_COMMAND_DISALLOWED;
104007aa35f6aSMatthias Ringwald     }
104017aa35f6aSMatthias Ringwald     return ERROR_CODE_SUCCESS;
104027aa35f6aSMatthias Ringwald }
10403d39e4f95SMatthias Ringwald 
104045ade6657SMatthias Ringwald uint8_t hci_request_bis_can_send_now_events(uint8_t big_handle){
104055ade6657SMatthias Ringwald     le_audio_big_t * big = hci_big_for_handle(big_handle);
104065ade6657SMatthias Ringwald     if (big == NULL){
104075ade6657SMatthias Ringwald         return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
104085ade6657SMatthias Ringwald     }
104095ade6657SMatthias Ringwald     if (big->state != LE_AUDIO_BIG_STATE_ACTIVE){
104105ade6657SMatthias Ringwald         return ERROR_CODE_COMMAND_DISALLOWED;
104115ade6657SMatthias Ringwald     }
104125ade6657SMatthias Ringwald     big->can_send_now_requested = true;
104135ade6657SMatthias Ringwald     hci_iso_notify_can_send_now();
104145ade6657SMatthias Ringwald     return ERROR_CODE_SUCCESS;
104155ade6657SMatthias Ringwald }
10416d3a89d91SMatthias Ringwald 
104172c077771SMatthias Ringwald uint8_t hci_request_cis_can_send_now_events(hci_con_handle_t cis_con_handle){
104182c077771SMatthias Ringwald     hci_iso_stream_t * iso_stream = hci_iso_stream_for_con_handle(cis_con_handle);
104192c077771SMatthias Ringwald     if (iso_stream == NULL){
104202c077771SMatthias Ringwald         return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
104212c077771SMatthias Ringwald     }
104222c077771SMatthias Ringwald     if ((iso_stream->iso_type != HCI_ISO_TYPE_CIS) && (iso_stream->state != HCI_ISO_STREAM_STATE_ESTABLISHED)) {
104232c077771SMatthias Ringwald         return ERROR_CODE_COMMAND_DISALLOWED;
104242c077771SMatthias Ringwald     }
104252c077771SMatthias Ringwald     iso_stream->can_send_now_requested = true;
104262c077771SMatthias Ringwald     hci_iso_notify_can_send_now();
104272c077771SMatthias Ringwald     return ERROR_CODE_SUCCESS;
104282c077771SMatthias Ringwald }
104292c077771SMatthias Ringwald 
10430d3a89d91SMatthias Ringwald uint8_t gap_cig_create(le_audio_cig_t * storage, le_audio_cig_params_t * cig_params){
10431d3a89d91SMatthias Ringwald     if (hci_cig_for_id(cig_params->cig_id) != NULL){
10432d3a89d91SMatthias Ringwald         return ERROR_CODE_ACL_CONNECTION_ALREADY_EXISTS;
10433d3a89d91SMatthias Ringwald     }
10434d3a89d91SMatthias Ringwald     if (cig_params->num_cis == 0){
10435d3a89d91SMatthias Ringwald         return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS;
10436d3a89d91SMatthias Ringwald     }
104373e377057SMatthias Ringwald     if (cig_params->num_cis > MAX_NR_CIS){
10438d3a89d91SMatthias Ringwald         return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS;
10439d3a89d91SMatthias Ringwald     }
10440d3a89d91SMatthias Ringwald 
10441d3a89d91SMatthias Ringwald     // reserve ISO Streams
10442d3a89d91SMatthias Ringwald     uint8_t i;
10443d3a89d91SMatthias Ringwald     uint8_t status = ERROR_CODE_SUCCESS;
10444d3a89d91SMatthias Ringwald     for (i=0;i<cig_params->num_cis;i++){
10445969d876aSMatthias 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);
1044636468e6fSMatthias Ringwald         if (iso_stream == NULL) {
10447969d876aSMatthias Ringwald             status = ERROR_CODE_MEMORY_CAPACITY_EXCEEDED;
10448d3a89d91SMatthias Ringwald             break;
10449d3a89d91SMatthias Ringwald         }
10450d3a89d91SMatthias Ringwald     }
10451d3a89d91SMatthias Ringwald 
10452d3a89d91SMatthias Ringwald     // free structs on error
10453d3a89d91SMatthias Ringwald     if (status != ERROR_CODE_SUCCESS){
10454d3a89d91SMatthias Ringwald         hci_iso_stream_finalize_by_type_and_group_id(HCI_ISO_TYPE_CIS, cig_params->cig_id);
10455d3a89d91SMatthias Ringwald         return status;
10456d3a89d91SMatthias Ringwald     }
10457d3a89d91SMatthias Ringwald 
10458d3a89d91SMatthias Ringwald     le_audio_cig_t * cig = storage;
10459d3a89d91SMatthias Ringwald     cig->cig_id = cig_params->cig_id;
10460d3a89d91SMatthias Ringwald     cig->num_cis = cig_params->num_cis;
10461d3a89d91SMatthias Ringwald     cig->params = cig_params;
10462d3a89d91SMatthias Ringwald     cig->state = LE_AUDIO_CIG_STATE_CREATE;
10463444e371eSMatthias Ringwald     for (i=0;i<cig->num_cis;i++){
10464444e371eSMatthias Ringwald         cig->cis_con_handles[i] = HCI_CON_HANDLE_INVALID;
10465444e371eSMatthias Ringwald         cig->acl_con_handles[i] = HCI_CON_HANDLE_INVALID;
104660f0ba168SMatthias Ringwald         cig->cis_setup_active[i] = false;
104670f0ba168SMatthias Ringwald         cig->cis_established[i] = false;
10468444e371eSMatthias Ringwald     }
10469d3a89d91SMatthias Ringwald     btstack_linked_list_add(&hci_stack->le_audio_cigs, (btstack_linked_item_t *) cig);
10470d3a89d91SMatthias Ringwald 
10471d3a89d91SMatthias Ringwald     hci_run();
10472d3a89d91SMatthias Ringwald 
10473d3a89d91SMatthias Ringwald     return ERROR_CODE_SUCCESS;
10474d3a89d91SMatthias Ringwald }
10475d3a89d91SMatthias Ringwald 
10476444e371eSMatthias Ringwald uint8_t gap_cis_create(uint8_t cig_handle, hci_con_handle_t cis_con_handles [], hci_con_handle_t acl_con_handles []){
10477444e371eSMatthias Ringwald     le_audio_cig_t * cig = hci_cig_for_id(cig_handle);
10478444e371eSMatthias Ringwald     if (cig == NULL){
10479444e371eSMatthias Ringwald         return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
10480444e371eSMatthias Ringwald     }
10481444e371eSMatthias Ringwald 
10482444e371eSMatthias Ringwald     if (cig->state != LE_AUDIO_CIG_STATE_W4_CIS_REQUEST){
10483444e371eSMatthias Ringwald         return ERROR_CODE_COMMAND_DISALLOWED;
10484444e371eSMatthias Ringwald     }
10485444e371eSMatthias Ringwald 
10486444e371eSMatthias Ringwald     // store ACL Connection Handles
10487444e371eSMatthias Ringwald     uint8_t i;
10488444e371eSMatthias Ringwald     for (i=0;i<cig->num_cis;i++){
1048956bd2ec0SMatthias Ringwald         // check that all con handles exist and store
10490444e371eSMatthias Ringwald         hci_con_handle_t cis_handle = cis_con_handles[i];
1049136468e6fSMatthias Ringwald         if (cis_handle == HCI_CON_HANDLE_INVALID){
1049236468e6fSMatthias Ringwald             return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
1049336468e6fSMatthias Ringwald         }
10494444e371eSMatthias Ringwald         uint8_t j;
10495444e371eSMatthias Ringwald         bool found = false;
10496444e371eSMatthias Ringwald         for (j=0;j<cig->num_cis;j++){
10497444e371eSMatthias Ringwald             if (cig->cis_con_handles[j] == cis_handle){
10498444e371eSMatthias Ringwald                 cig->acl_con_handles[j] = acl_con_handles[j];
1049956bd2ec0SMatthias Ringwald                 hci_iso_stream_t * iso_stream = hci_iso_stream_for_con_handle(cis_handle);
1050056bd2ec0SMatthias Ringwald                 btstack_assert(iso_stream != NULL);
1050156bd2ec0SMatthias Ringwald                 iso_stream->acl_handle = acl_con_handles[j];
1050236468e6fSMatthias Ringwald                 found = true;
10503444e371eSMatthias Ringwald                 break;
10504444e371eSMatthias Ringwald             }
10505444e371eSMatthias Ringwald         }
10506444e371eSMatthias Ringwald         if (!found){
10507444e371eSMatthias Ringwald             return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
10508444e371eSMatthias Ringwald         }
10509444e371eSMatthias Ringwald     }
10510444e371eSMatthias Ringwald 
10511444e371eSMatthias Ringwald     cig->state = LE_AUDIO_CIG_STATE_CREATE_CIS;
10512444e371eSMatthias Ringwald     hci_run();
10513444e371eSMatthias Ringwald 
10514444e371eSMatthias Ringwald     return ERROR_CODE_SUCCESS;
10515444e371eSMatthias Ringwald }
10516444e371eSMatthias Ringwald 
10517969d876aSMatthias Ringwald static uint8_t hci_cis_accept_or_reject(hci_con_handle_t cis_handle, hci_iso_stream_state_t state){
10518969d876aSMatthias Ringwald     hci_iso_stream_t * iso_stream = hci_iso_stream_for_con_handle(cis_handle);
105196fd1d2c8SMatthias Ringwald     if (iso_stream == NULL){
105206fd1d2c8SMatthias Ringwald         // if we got a CIS Request but fail to allocate a hci_iso_stream_t object, we won't find it here
10521969d876aSMatthias Ringwald         return ERROR_CODE_MEMORY_CAPACITY_EXCEEDED;
1052226b93350SMatthias Ringwald     }
1052326b93350SMatthias Ringwald 
105246fd1d2c8SMatthias Ringwald     // set next state and continue
105256fd1d2c8SMatthias Ringwald     iso_stream->state = state;
1052626b93350SMatthias Ringwald     hci_run();
1052726b93350SMatthias Ringwald     return ERROR_CODE_SUCCESS;
1052826b93350SMatthias Ringwald }
1052926b93350SMatthias Ringwald 
1053026b93350SMatthias Ringwald uint8_t gap_cis_accept(hci_con_handle_t cis_con_handle){
1053126b93350SMatthias Ringwald     return hci_cis_accept_or_reject(cis_con_handle, HCI_ISO_STREAM_W2_ACCEPT);
1053226b93350SMatthias Ringwald }
1053326b93350SMatthias Ringwald 
1053426b93350SMatthias Ringwald uint8_t gap_cis_reject(hci_con_handle_t cis_con_handle){
1053526b93350SMatthias Ringwald     return hci_cis_accept_or_reject(cis_con_handle, HCI_ISO_STREAM_W2_REJECT);
1053626b93350SMatthias Ringwald }
1053726b93350SMatthias Ringwald 
1053826b93350SMatthias Ringwald 
10539f40c73b4SMatthias Ringwald #endif
105404ae8623eSMatthias Ringwald #endif /* ENABLE_BLE */
10541f40c73b4SMatthias Ringwald 
10542eddac615SMatthias Ringwald #ifdef FUZZING_BUILD_MODE_UNSAFE_FOR_PRODUCTION
1054318976c74SMatthias Ringwald void hci_setup_test_connections_fuzz(void){
1054418976c74SMatthias Ringwald     hci_connection_t * conn;
1054518976c74SMatthias Ringwald 
1054618976c74SMatthias Ringwald     // default address: 66:55:44:33:00:01
1054718976c74SMatthias Ringwald     bd_addr_t addr = { 0x66, 0x55, 0x44, 0x33, 0x00, 0x00};
1054818976c74SMatthias Ringwald 
105497d33cb26SMilanka Ringwald     // setup Controller info
105507d33cb26SMilanka Ringwald     hci_stack->num_cmd_packets = 255;
105517d33cb26SMilanka Ringwald     hci_stack->acl_packets_total_num = 255;
105527d33cb26SMilanka Ringwald 
1055318976c74SMatthias Ringwald     // setup incoming Classic ACL connection with con handle 0x0001, 66:55:44:33:22:01
1055418976c74SMatthias Ringwald     addr[5] = 0x01;
1055517ab8643SMatthias Ringwald     conn = create_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL, HCI_ROLE_SLAVE);
1055618976c74SMatthias Ringwald     conn->con_handle = addr[5];
1055718976c74SMatthias Ringwald     conn->state = RECEIVED_CONNECTION_REQUEST;
105587d33cb26SMilanka Ringwald     conn->sm_connection.sm_role = HCI_ROLE_SLAVE;
1055918976c74SMatthias Ringwald 
1056018976c74SMatthias Ringwald     // setup incoming Classic SCO connection with con handle 0x0002
1056118976c74SMatthias Ringwald     addr[5] = 0x02;
1056217ab8643SMatthias Ringwald     conn = create_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_SCO, HCI_ROLE_SLAVE);
1056318976c74SMatthias Ringwald     conn->con_handle = addr[5];
1056418976c74SMatthias Ringwald     conn->state = RECEIVED_CONNECTION_REQUEST;
105657d33cb26SMilanka Ringwald     conn->sm_connection.sm_role = HCI_ROLE_SLAVE;
1056618976c74SMatthias Ringwald 
1056718976c74SMatthias Ringwald     // setup ready Classic ACL connection with con handle 0x0003
1056818976c74SMatthias Ringwald     addr[5] = 0x03;
1056917ab8643SMatthias Ringwald     conn = create_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_ACL, HCI_ROLE_SLAVE);
1057018976c74SMatthias Ringwald     conn->con_handle = addr[5];
1057118976c74SMatthias Ringwald     conn->state = OPEN;
105727d33cb26SMilanka Ringwald     conn->sm_connection.sm_role = HCI_ROLE_SLAVE;
1057318976c74SMatthias Ringwald 
1057418976c74SMatthias Ringwald     // setup ready Classic SCO connection with con handle 0x0004
1057518976c74SMatthias Ringwald     addr[5] = 0x04;
1057617ab8643SMatthias Ringwald     conn = create_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_SCO, HCI_ROLE_SLAVE);
1057718976c74SMatthias Ringwald     conn->con_handle = addr[5];
1057818976c74SMatthias Ringwald     conn->state = OPEN;
105797d33cb26SMilanka Ringwald     conn->sm_connection.sm_role = HCI_ROLE_SLAVE;
1058018976c74SMatthias Ringwald 
1058118976c74SMatthias Ringwald     // setup ready LE ACL connection with con handle 0x005 and public address
1058218976c74SMatthias Ringwald     addr[5] = 0x05;
1058317ab8643SMatthias Ringwald     conn = create_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_LE_PUBLIC, HCI_ROLE_SLAVE);
1058418976c74SMatthias Ringwald     conn->con_handle = addr[5];
1058518976c74SMatthias Ringwald     conn->state = OPEN;
105867d33cb26SMilanka Ringwald     conn->sm_connection.sm_role = HCI_ROLE_SLAVE;
105878046a24aSMatthias Ringwald     conn->sm_connection.sm_connection_encrypted = 1;
1058818976c74SMatthias Ringwald }
1058918976c74SMatthias Ringwald 
10590eddac615SMatthias Ringwald void hci_free_connections_fuzz(void){
10591eddac615SMatthias Ringwald     btstack_linked_list_iterator_t it;
10592eddac615SMatthias Ringwald     btstack_linked_list_iterator_init(&it, &hci_stack->connections);
10593eddac615SMatthias Ringwald     while (btstack_linked_list_iterator_has_next(&it)){
10594eddac615SMatthias Ringwald         hci_connection_t * con = (hci_connection_t*) btstack_linked_list_iterator_next(&it);
10595eddac615SMatthias Ringwald         btstack_linked_list_iterator_remove(&it);
10596eddac615SMatthias Ringwald         btstack_memory_hci_connection_free(con);
10597eddac615SMatthias Ringwald     }
10598eddac615SMatthias Ringwald }
105991470db0cSMatthias Ringwald void hci_simulate_working_fuzz(void){
10600b6ffb67fSMatthias Ringwald     hci_stack->le_scanning_param_update = false;
106011470db0cSMatthias Ringwald     hci_init_done();
106021470db0cSMatthias Ringwald     hci_stack->num_cmd_packets = 255;
106031470db0cSMatthias Ringwald }
10604eddac615SMatthias Ringwald #endif
10605