1bd021c4eSMatthias Ringwald /* 2bd021c4eSMatthias Ringwald * Copyright (C) 2016 BlueKitchen GmbH 3bd021c4eSMatthias Ringwald * 4bd021c4eSMatthias Ringwald * Redistribution and use in source and binary forms, with or without 5bd021c4eSMatthias Ringwald * modification, are permitted provided that the following conditions 6bd021c4eSMatthias Ringwald * are met: 7bd021c4eSMatthias Ringwald * 8bd021c4eSMatthias Ringwald * 1. Redistributions of source code must retain the above copyright 9bd021c4eSMatthias Ringwald * notice, this list of conditions and the following disclaimer. 10bd021c4eSMatthias Ringwald * 2. Redistributions in binary form must reproduce the above copyright 11bd021c4eSMatthias Ringwald * notice, this list of conditions and the following disclaimer in the 12bd021c4eSMatthias Ringwald * documentation and/or other materials provided with the distribution. 13bd021c4eSMatthias Ringwald * 3. Neither the name of the copyright holders nor the names of 14bd021c4eSMatthias Ringwald * contributors may be used to endorse or promote products derived 15bd021c4eSMatthias Ringwald * from this software without specific prior written permission. 16bd021c4eSMatthias Ringwald * 4. Any redistribution, use, or modification is done solely for 17bd021c4eSMatthias Ringwald * personal benefit and not for any commercial purpose or for 18bd021c4eSMatthias Ringwald * monetary gain. 19bd021c4eSMatthias Ringwald * 20bd021c4eSMatthias Ringwald * THIS SOFTWARE IS PROVIDED BY BLUEKITCHEN GMBH AND CONTRIBUTORS 21bd021c4eSMatthias Ringwald * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 22bd021c4eSMatthias Ringwald * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS 23bd021c4eSMatthias Ringwald * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL MATTHIAS 24bd021c4eSMatthias Ringwald * RINGWALD OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, 25bd021c4eSMatthias Ringwald * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, 26bd021c4eSMatthias Ringwald * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS 27bd021c4eSMatthias Ringwald * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED 28bd021c4eSMatthias Ringwald * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, 29bd021c4eSMatthias Ringwald * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF 30bd021c4eSMatthias Ringwald * THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 31bd021c4eSMatthias Ringwald * SUCH DAMAGE. 32bd021c4eSMatthias Ringwald * 33bd021c4eSMatthias Ringwald * Please inquire about commercial licensing options at 34bd021c4eSMatthias Ringwald * [email protected] 35bd021c4eSMatthias Ringwald * 36bd021c4eSMatthias Ringwald */ 37bd021c4eSMatthias Ringwald 38bd021c4eSMatthias Ringwald /* 39bd021c4eSMatthias Ringwald * hci_transport_h5.c 40bd021c4eSMatthias Ringwald * 41bd021c4eSMatthias Ringwald * HCI Transport API implementation for basic H5 protocol 42bd021c4eSMatthias Ringwald * 43bd021c4eSMatthias Ringwald * Created by Matthias Ringwald on 4/29/09. 44bd021c4eSMatthias Ringwald */ 45bd021c4eSMatthias Ringwald 46bd021c4eSMatthias Ringwald #include "hci.h" 47bd021c4eSMatthias Ringwald #include "btstack_slip.h" 48bd021c4eSMatthias Ringwald #include "btstack_debug.h" 49bd021c4eSMatthias Ringwald #include "hci_transport.h" 50bd021c4eSMatthias Ringwald #include "btstack_uart_block.h" 51bd021c4eSMatthias Ringwald 52bd021c4eSMatthias Ringwald typedef enum { 53bd021c4eSMatthias Ringwald LINK_UNINITIALIZED, 54bd021c4eSMatthias Ringwald LINK_INITIALIZED, 55bd021c4eSMatthias Ringwald LINK_ACTIVE 56bd021c4eSMatthias Ringwald } hci_transport_link_state_t; 57bd021c4eSMatthias Ringwald 58bd021c4eSMatthias Ringwald typedef enum { 59bd021c4eSMatthias Ringwald HCI_TRANSPORT_LINK_SEND_SYNC = 1 << 0, 60bd021c4eSMatthias Ringwald HCI_TRANSPORT_LINK_SEND_SYNC_RESPONSE = 1 << 1, 61bd021c4eSMatthias Ringwald HCI_TRANSPORT_LINK_SEND_CONFIG = 1 << 2, 62bd021c4eSMatthias Ringwald HCI_TRANSPORT_LINK_SEND_CONFIG_RESPONSE = 1 << 3, 6394764e99SMatthias Ringwald HCI_TRANSPORT_LINK_SEND_SLEEP = 1 << 4, 6494764e99SMatthias Ringwald HCI_TRANSPORT_LINK_SEND_WOKEN = 1 << 5, 6594764e99SMatthias Ringwald HCI_TRANSPORT_LINK_SEND_WAKEUP = 1 << 6, 6694764e99SMatthias Ringwald HCI_TRANSPORT_LINK_SEND_QUEUED_PACKET = 1 << 7, 6794764e99SMatthias Ringwald HCI_TRANSPORT_LINK_SEND_ACK_PACKET = 1 << 8, 6894764e99SMatthias Ringwald HCI_TRANSPORT_LINK_ENTER_SLEEP = 1 << 9, 6994764e99SMatthias Ringwald 70bd021c4eSMatthias Ringwald } hci_transport_link_actions_t; 71bd021c4eSMatthias Ringwald 7279b61987SMatthias Ringwald // Configuration Field. No packet buffers -> sliding window = 1, no OOF flow control, support data integrity check 73bd021c4eSMatthias Ringwald #define LINK_CONFIG_SLIDING_WINDOW_SIZE 1 74bd021c4eSMatthias Ringwald #define LINK_CONFIG_OOF_FLOW_CONTROL 0 7579b61987SMatthias Ringwald #define LINK_CONFIG_DATA_INTEGRITY_CHECK 1 76bd021c4eSMatthias Ringwald #define LINK_CONFIG_VERSION_NR 0 77bd021c4eSMatthias Ringwald #define LINK_CONFIG_FIELD (LINK_CONFIG_SLIDING_WINDOW_SIZE | (LINK_CONFIG_OOF_FLOW_CONTROL << 3) | (LINK_CONFIG_DATA_INTEGRITY_CHECK << 4) | (LINK_CONFIG_VERSION_NR << 5)) 78bd021c4eSMatthias Ringwald 79bd021c4eSMatthias Ringwald // periodic sending during link establishment 80bd021c4eSMatthias Ringwald #define LINK_PERIOD_MS 250 81bd021c4eSMatthias Ringwald 82bd021c4eSMatthias Ringwald // resend wakeup 83bd021c4eSMatthias Ringwald #define LINK_WAKEUP_MS 50 84bd021c4eSMatthias Ringwald 85bd021c4eSMatthias Ringwald // additional packet types 86bd021c4eSMatthias Ringwald #define LINK_ACKNOWLEDGEMENT_TYPE 0x00 87bd021c4eSMatthias Ringwald #define LINK_CONTROL_PACKET_TYPE 0x0f 88bd021c4eSMatthias Ringwald 896ae10533SMatthias Ringwald // max size of write requests 906ae10533SMatthias Ringwald #define LINK_SLIP_TX_CHUNK_LEN 64 916ae10533SMatthias Ringwald 92bd021c4eSMatthias Ringwald // --- 93bd021c4eSMatthias Ringwald static const uint8_t link_control_sync[] = { 0x01, 0x7e}; 94bd021c4eSMatthias Ringwald static const uint8_t link_control_sync_response[] = { 0x02, 0x7d}; 95bd021c4eSMatthias Ringwald static const uint8_t link_control_config[] = { 0x03, 0xfc, LINK_CONFIG_FIELD}; 96cbc04f48SMatthias Ringwald static const uint8_t link_control_config_prefix_len = 2; 97bd021c4eSMatthias Ringwald static const uint8_t link_control_config_response[] = { 0x04, 0x7b, LINK_CONFIG_FIELD}; 98bd021c4eSMatthias Ringwald static const uint8_t link_control_config_response_prefix_len = 2; 99bd021c4eSMatthias Ringwald static const uint8_t link_control_wakeup[] = { 0x05, 0xfa}; 100bd021c4eSMatthias Ringwald static const uint8_t link_control_woken[] = { 0x06, 0xf9}; 101bd021c4eSMatthias Ringwald static const uint8_t link_control_sleep[] = { 0x07, 0x78}; 102bd021c4eSMatthias Ringwald 103bd021c4eSMatthias Ringwald // incoming pre-bufffer + 4 bytes H5 header + max(acl header + acl payload, event header + event data) + 2 bytes opt CRC 104bd021c4eSMatthias Ringwald static uint8_t hci_packet_with_pre_buffer[HCI_INCOMING_PRE_BUFFER_SIZE + 6 + HCI_PACKET_BUFFER_SIZE]; 105bd021c4eSMatthias Ringwald 1066ae10533SMatthias Ringwald // outgoing slip encoded buffer. +1 to assert that last SOF fits in buffer 1076ae10533SMatthias Ringwald static uint8_t slip_outgoing_buffer[LINK_SLIP_TX_CHUNK_LEN+1]; 1086ae10533SMatthias Ringwald static int slip_write_active; 109bd021c4eSMatthias Ringwald 110bd021c4eSMatthias Ringwald // H5 Link State 111bd021c4eSMatthias Ringwald static hci_transport_link_state_t link_state; 112bd021c4eSMatthias Ringwald static btstack_timer_source_t link_timer; 113bd021c4eSMatthias Ringwald static uint8_t link_seq_nr; 114bd021c4eSMatthias Ringwald static uint8_t link_ack_nr; 115bd021c4eSMatthias Ringwald static uint16_t link_resend_timeout_ms; 116bd021c4eSMatthias Ringwald static uint8_t link_peer_asleep; 117*7c2aa31eSMatthias Ringwald static uint8_t link_peer_supports_data_integrity_check; 118bd021c4eSMatthias Ringwald 11994764e99SMatthias Ringwald // auto sleep-mode 12094764e99SMatthias Ringwald static btstack_timer_source_t inactivity_timer; 12194764e99SMatthias Ringwald static uint16_t link_inactivity_timeout_ms; // auto-sleep if set 12294764e99SMatthias Ringwald 123bd021c4eSMatthias Ringwald // Outgoing packet 124bd021c4eSMatthias Ringwald static uint8_t hci_packet_type; 125bd021c4eSMatthias Ringwald static uint16_t hci_packet_size; 126bd021c4eSMatthias Ringwald static uint8_t * hci_packet; 127bd021c4eSMatthias Ringwald 128bd021c4eSMatthias Ringwald // hci packet handler 129bd021c4eSMatthias Ringwald static void (*packet_handler)(uint8_t packet_type, uint8_t *packet, uint16_t size); 130bd021c4eSMatthias Ringwald 131bd021c4eSMatthias Ringwald static int hci_transport_link_actions; 132bd021c4eSMatthias Ringwald 133bd021c4eSMatthias Ringwald // UART Driver + Config 134bd021c4eSMatthias Ringwald static const btstack_uart_block_t * btstack_uart; 135bd021c4eSMatthias Ringwald static btstack_uart_config_t uart_config; 136d8e28fa3SMatthias Ringwald static btstack_uart_sleep_mode_t btstack_uart_sleep_mode; 137bd021c4eSMatthias Ringwald 138bd021c4eSMatthias Ringwald // Prototypes 139bd021c4eSMatthias Ringwald static void hci_transport_h5_process_frame(uint16_t frame_size); 140bd021c4eSMatthias Ringwald static int hci_transport_link_have_outgoing_packet(void); 141bd021c4eSMatthias Ringwald static void hci_transport_link_send_queued_packet(void); 142bd021c4eSMatthias Ringwald static void hci_transport_link_set_timer(uint16_t timeout_ms); 143bd021c4eSMatthias Ringwald static void hci_transport_link_timeout_handler(btstack_timer_source_t * timer); 144bd021c4eSMatthias Ringwald static void hci_transport_link_run(void); 145bd021c4eSMatthias Ringwald static void hci_transport_slip_init(void); 146bd021c4eSMatthias Ringwald 147*7c2aa31eSMatthias Ringwald // ----------------------------- 14879b61987SMatthias Ringwald // CRC16-CCITT Calculation - compromise: use 32 byte table - 512 byte table would be faster, but that's too large 14979b61987SMatthias Ringwald 15079b61987SMatthias Ringwald static const uint16_t crc16_ccitt_table[] ={ 15179b61987SMatthias Ringwald 0x0000, 0x1081, 0x2102, 0x3183, 15279b61987SMatthias Ringwald 0x4204, 0x5285, 0x6306, 0x7387, 15379b61987SMatthias Ringwald 0x8408, 0x9489, 0xa50a, 0xb58b, 15479b61987SMatthias Ringwald 0xc60c, 0xd68d, 0xe70e, 0xf78f 15579b61987SMatthias Ringwald }; 15679b61987SMatthias Ringwald 15779b61987SMatthias Ringwald static uint16_t crc16_ccitt_update (uint16_t crc, uint8_t ch){ 15879b61987SMatthias Ringwald crc = (crc >> 4) ^ crc16_ccitt_table[(crc ^ ch) & 0x000f]; 15979b61987SMatthias Ringwald crc = (crc >> 4) ^ crc16_ccitt_table[(crc ^ (ch >> 4)) & 0x000f]; 16079b61987SMatthias Ringwald return crc; 16179b61987SMatthias Ringwald } 16279b61987SMatthias Ringwald 16379b61987SMatthias Ringwald static uint16_t btstack_reverse_bits_16(uint16_t value){ 16479b61987SMatthias Ringwald int reverse = 0; 16579b61987SMatthias Ringwald int i; 16679b61987SMatthias Ringwald for (i = 0; i < 16; i++) { 16779b61987SMatthias Ringwald reverse = reverse << 1; 16879b61987SMatthias Ringwald reverse |= value & 1; 16979b61987SMatthias Ringwald value = value >> 1; 17079b61987SMatthias Ringwald } 17179b61987SMatthias Ringwald return reverse; 17279b61987SMatthias Ringwald } 17379b61987SMatthias Ringwald 17479b61987SMatthias Ringwald static uint16_t crc16_calc_for_slip_frame(uint8_t * header, uint8_t * payload, uint16_t len){ 17579b61987SMatthias Ringwald int i; 17679b61987SMatthias Ringwald uint16_t crc = 0xffff; 17779b61987SMatthias Ringwald for (i=0 ; i < 4 ; i++){ 17879b61987SMatthias Ringwald crc = crc16_ccitt_update(crc, header[i]); 17979b61987SMatthias Ringwald } 18079b61987SMatthias Ringwald for (i=0 ; i < len ; i++){ 18179b61987SMatthias Ringwald crc = crc16_ccitt_update(crc, payload[i]); 18279b61987SMatthias Ringwald } 18379b61987SMatthias Ringwald return btstack_reverse_bits_16(crc); 18479b61987SMatthias Ringwald } 18579b61987SMatthias Ringwald 186bd021c4eSMatthias Ringwald // ----------------------------- 18794764e99SMatthias Ringwald static void hci_transport_inactivity_timeout_handler(btstack_timer_source_t * ts){ 188f04a0c31SMatthias Ringwald log_info("h5: inactivity timeout. link state %d, peer asleep %u, actions 0x%02x, outgoing packet %u", 18994764e99SMatthias Ringwald link_state, link_peer_asleep, hci_transport_link_actions, hci_transport_link_have_outgoing_packet()); 19094764e99SMatthias Ringwald if (hci_transport_link_have_outgoing_packet()) return; 19194764e99SMatthias Ringwald if (link_state != LINK_ACTIVE) return; 19294764e99SMatthias Ringwald if (hci_transport_link_actions) return; 19394764e99SMatthias Ringwald if (link_peer_asleep) return; 19494764e99SMatthias Ringwald hci_transport_link_actions |= HCI_TRANSPORT_LINK_SEND_SLEEP; 19594764e99SMatthias Ringwald hci_transport_link_run(); 19694764e99SMatthias Ringwald } 197bd021c4eSMatthias Ringwald 19894764e99SMatthias Ringwald static void hci_transport_inactivity_timer_set(void){ 19994764e99SMatthias Ringwald if (!link_inactivity_timeout_ms) return; 20094764e99SMatthias Ringwald btstack_run_loop_set_timer_handler(&inactivity_timer, &hci_transport_inactivity_timeout_handler); 20194764e99SMatthias Ringwald btstack_run_loop_set_timer(&inactivity_timer, link_inactivity_timeout_ms); 20294764e99SMatthias Ringwald btstack_run_loop_remove_timer(&inactivity_timer); 20394764e99SMatthias Ringwald btstack_run_loop_add_timer(&inactivity_timer); 20494764e99SMatthias Ringwald } 205bd021c4eSMatthias Ringwald 20694764e99SMatthias Ringwald // ----------------------------- 207bd021c4eSMatthias Ringwald // SLIP Outgoing 208bd021c4eSMatthias Ringwald 2096ae10533SMatthias Ringwald // Fill chunk and write 2106ae10533SMatthias Ringwald static void hci_transport_slip_encode_chunk_and_send(int pos){ 2116ae10533SMatthias Ringwald while (btstack_slip_encoder_has_data() & (pos < LINK_SLIP_TX_CHUNK_LEN)) { 2126ae10533SMatthias Ringwald slip_outgoing_buffer[pos++] = btstack_slip_encoder_get_byte(); 2136ae10533SMatthias Ringwald } 2146ae10533SMatthias Ringwald if (!btstack_slip_encoder_has_data()){ 2156ae10533SMatthias Ringwald // Start of Frame 2166ae10533SMatthias Ringwald slip_outgoing_buffer[pos++] = BTSTACK_SLIP_SOF; 2176ae10533SMatthias Ringwald } 2186ae10533SMatthias Ringwald slip_write_active = 1; 219f04a0c31SMatthias Ringwald log_info("hci_transport_slip: send %d bytes", pos); 2206ae10533SMatthias Ringwald btstack_uart->send_block(slip_outgoing_buffer, pos); 2216ae10533SMatthias Ringwald } 2226ae10533SMatthias Ringwald 2236ae10533SMatthias Ringwald static inline void hci_transport_slip_send_next_chunk(void){ 2246ae10533SMatthias Ringwald hci_transport_slip_encode_chunk_and_send(0); 2256ae10533SMatthias Ringwald } 2266ae10533SMatthias Ringwald 227*7c2aa31eSMatthias Ringwald // format: 0xc0 HEADER PACKET 0xc0 228bd021c4eSMatthias Ringwald // @param uint8_t header[4] 229bd021c4eSMatthias Ringwald static void hci_transport_slip_send_frame(const uint8_t * header, const uint8_t * packet, uint16_t packet_size){ 230bd021c4eSMatthias Ringwald 231bd021c4eSMatthias Ringwald int pos = 0; 232bd021c4eSMatthias Ringwald 233bd021c4eSMatthias Ringwald // Start of Frame 234bd021c4eSMatthias Ringwald slip_outgoing_buffer[pos++] = BTSTACK_SLIP_SOF; 235bd021c4eSMatthias Ringwald 236bd021c4eSMatthias Ringwald // Header 237bd021c4eSMatthias Ringwald btstack_slip_encoder_start(header, 4); 238bd021c4eSMatthias Ringwald while (btstack_slip_encoder_has_data()){ 239bd021c4eSMatthias Ringwald slip_outgoing_buffer[pos++] = btstack_slip_encoder_get_byte(); 240bd021c4eSMatthias Ringwald } 241bd021c4eSMatthias Ringwald 242bd021c4eSMatthias Ringwald // Packet 243bd021c4eSMatthias Ringwald btstack_slip_encoder_start(packet, packet_size); 244bd021c4eSMatthias Ringwald 2456ae10533SMatthias Ringwald // Fill rest of chunk from packet and send 2466ae10533SMatthias Ringwald hci_transport_slip_encode_chunk_and_send(pos); 247bd021c4eSMatthias Ringwald } 248bd021c4eSMatthias Ringwald 249bd021c4eSMatthias Ringwald // SLIP Incoming 250bd021c4eSMatthias Ringwald 251bd021c4eSMatthias Ringwald static void hci_transport_slip_init(void){ 252bd021c4eSMatthias Ringwald btstack_slip_decoder_init(&hci_packet_with_pre_buffer[HCI_INCOMING_PRE_BUFFER_SIZE], 6 + HCI_PACKET_BUFFER_SIZE); 253bd021c4eSMatthias Ringwald } 254bd021c4eSMatthias Ringwald 255bd021c4eSMatthias Ringwald // H5 Three-Wire Implementation 256bd021c4eSMatthias Ringwald 257bd021c4eSMatthias Ringwald static void hci_transport_link_calc_header(uint8_t * header, 258bd021c4eSMatthias Ringwald uint8_t sequence_nr, 259bd021c4eSMatthias Ringwald uint8_t acknowledgement_nr, 260bd021c4eSMatthias Ringwald uint8_t data_integrity_check_present, 261bd021c4eSMatthias Ringwald uint8_t reliable_packet, 262bd021c4eSMatthias Ringwald uint8_t packet_type, 263bd021c4eSMatthias Ringwald uint16_t payload_length){ 264bd021c4eSMatthias Ringwald 265bd021c4eSMatthias Ringwald // reset data integrity flag 266bd021c4eSMatthias Ringwald if (data_integrity_check_present){ 267bd021c4eSMatthias Ringwald log_error("hci_transport_link_calc_header: data integrity not supported, dropping flag"); 268bd021c4eSMatthias Ringwald data_integrity_check_present = 0; 269bd021c4eSMatthias Ringwald } 270bd021c4eSMatthias Ringwald 271bd021c4eSMatthias Ringwald header[0] = sequence_nr | (acknowledgement_nr << 3) | (data_integrity_check_present << 6) | (reliable_packet << 7); 272bd021c4eSMatthias Ringwald header[1] = packet_type | ((payload_length & 0x0f) << 4); 273bd021c4eSMatthias Ringwald header[2] = payload_length >> 4; 274bd021c4eSMatthias Ringwald header[3] = 0xff - (header[0] + header[1] + header[2]); 275bd021c4eSMatthias Ringwald } 276bd021c4eSMatthias Ringwald 277bd021c4eSMatthias Ringwald static void hci_transport_link_send_control(const uint8_t * message, int message_len){ 278bd021c4eSMatthias Ringwald uint8_t header[4]; 279bd021c4eSMatthias Ringwald hci_transport_link_calc_header(header, 0, 0, 0, 0, LINK_CONTROL_PACKET_TYPE, message_len); 280bd021c4eSMatthias Ringwald hci_transport_slip_send_frame(header, message, message_len); 281bd021c4eSMatthias Ringwald } 282bd021c4eSMatthias Ringwald 283bd021c4eSMatthias Ringwald static void hci_transport_link_send_sync(void){ 284bd021c4eSMatthias Ringwald log_info("link: send sync"); 285bd021c4eSMatthias Ringwald hci_transport_link_send_control(link_control_sync, sizeof(link_control_sync)); 286bd021c4eSMatthias Ringwald } 287bd021c4eSMatthias Ringwald 288bd021c4eSMatthias Ringwald static void hci_transport_link_send_sync_response(void){ 289bd021c4eSMatthias Ringwald log_info("link: send sync response"); 290bd021c4eSMatthias Ringwald hci_transport_link_send_control(link_control_sync_response, sizeof(link_control_sync_response)); 291bd021c4eSMatthias Ringwald } 292bd021c4eSMatthias Ringwald 293bd021c4eSMatthias Ringwald static void hci_transport_link_send_config(void){ 294bd021c4eSMatthias Ringwald log_info("link: send config"); 295bd021c4eSMatthias Ringwald hci_transport_link_send_control(link_control_config, sizeof(link_control_config)); 296bd021c4eSMatthias Ringwald } 297bd021c4eSMatthias Ringwald 298bd021c4eSMatthias Ringwald static void hci_transport_link_send_config_response(void){ 299bd021c4eSMatthias Ringwald log_info("link: send config response"); 300bd021c4eSMatthias Ringwald hci_transport_link_send_control(link_control_config_response, sizeof(link_control_config_response)); 301bd021c4eSMatthias Ringwald } 302bd021c4eSMatthias Ringwald 303bd021c4eSMatthias Ringwald static void hci_transport_link_send_woken(void){ 304bd021c4eSMatthias Ringwald log_info("link: send woken"); 305bd021c4eSMatthias Ringwald hci_transport_link_send_control(link_control_woken, sizeof(link_control_woken)); 306bd021c4eSMatthias Ringwald } 307bd021c4eSMatthias Ringwald 308bd021c4eSMatthias Ringwald static void hci_transport_link_send_wakeup(void){ 309bd021c4eSMatthias Ringwald log_info("link: send wakeup"); 310bd021c4eSMatthias Ringwald hci_transport_link_send_control(link_control_wakeup, sizeof(link_control_wakeup)); 311bd021c4eSMatthias Ringwald } 312bd021c4eSMatthias Ringwald 31394764e99SMatthias Ringwald static void hci_transport_link_send_sleep(void){ 31494764e99SMatthias Ringwald log_info("link: send sleep"); 31594764e99SMatthias Ringwald hci_transport_link_send_control(link_control_sleep, sizeof(link_control_sleep)); 31694764e99SMatthias Ringwald } 31794764e99SMatthias Ringwald 318bd021c4eSMatthias Ringwald static void hci_transport_link_send_queued_packet(void){ 319bd021c4eSMatthias Ringwald log_info("hci_transport_link_send_queued_packet: seq %u, ack %u, size %u", link_seq_nr, link_ack_nr, hci_packet_size); 320bd021c4eSMatthias Ringwald log_info_hexdump(hci_packet, hci_packet_size); 321bd021c4eSMatthias Ringwald 322bd021c4eSMatthias Ringwald uint8_t header[4]; 323bd021c4eSMatthias Ringwald hci_transport_link_calc_header(header, link_seq_nr, link_ack_nr, 0, 1, hci_packet_type, hci_packet_size); 324bd021c4eSMatthias Ringwald hci_transport_slip_send_frame(header, hci_packet, hci_packet_size); 32594764e99SMatthias Ringwald 32694764e99SMatthias Ringwald // reset inactvitiy timer 32794764e99SMatthias Ringwald hci_transport_inactivity_timer_set(); 328bd021c4eSMatthias Ringwald } 329bd021c4eSMatthias Ringwald 330bd021c4eSMatthias Ringwald static void hci_transport_link_send_ack_packet(void){ 331bd021c4eSMatthias Ringwald log_info("link: send ack %u", link_ack_nr); 332bd021c4eSMatthias Ringwald uint8_t header[4]; 333bd021c4eSMatthias Ringwald hci_transport_link_calc_header(header, 0, link_ack_nr, 0, 0, LINK_ACKNOWLEDGEMENT_TYPE, 0); 334bd021c4eSMatthias Ringwald hci_transport_slip_send_frame(header, NULL, 0); 335bd021c4eSMatthias Ringwald } 336bd021c4eSMatthias Ringwald 337bd021c4eSMatthias Ringwald static void hci_transport_link_run(void){ 338bd021c4eSMatthias Ringwald // exit if outgoing active 3396ae10533SMatthias Ringwald if (slip_write_active) return; 340bd021c4eSMatthias Ringwald 341bd021c4eSMatthias Ringwald // process queued requests 342bd021c4eSMatthias Ringwald if (hci_transport_link_actions & HCI_TRANSPORT_LINK_SEND_SYNC){ 343bd021c4eSMatthias Ringwald hci_transport_link_actions &= ~HCI_TRANSPORT_LINK_SEND_SYNC; 344bd021c4eSMatthias Ringwald hci_transport_link_send_sync(); 345bd021c4eSMatthias Ringwald return; 346bd021c4eSMatthias Ringwald } 347bd021c4eSMatthias Ringwald if (hci_transport_link_actions & HCI_TRANSPORT_LINK_SEND_SYNC_RESPONSE){ 348bd021c4eSMatthias Ringwald hci_transport_link_actions &= ~HCI_TRANSPORT_LINK_SEND_SYNC_RESPONSE; 349bd021c4eSMatthias Ringwald hci_transport_link_send_sync_response(); 350bd021c4eSMatthias Ringwald return; 351bd021c4eSMatthias Ringwald } 352bd021c4eSMatthias Ringwald if (hci_transport_link_actions & HCI_TRANSPORT_LINK_SEND_CONFIG){ 353bd021c4eSMatthias Ringwald hci_transport_link_actions &= ~HCI_TRANSPORT_LINK_SEND_CONFIG; 354bd021c4eSMatthias Ringwald hci_transport_link_send_config(); 355bd021c4eSMatthias Ringwald return; 356bd021c4eSMatthias Ringwald } 357bd021c4eSMatthias Ringwald if (hci_transport_link_actions & HCI_TRANSPORT_LINK_SEND_CONFIG_RESPONSE){ 358bd021c4eSMatthias Ringwald hci_transport_link_actions &= ~HCI_TRANSPORT_LINK_SEND_CONFIG_RESPONSE; 359bd021c4eSMatthias Ringwald hci_transport_link_send_config_response(); 360bd021c4eSMatthias Ringwald return; 361bd021c4eSMatthias Ringwald } 362bd021c4eSMatthias Ringwald if (hci_transport_link_actions & HCI_TRANSPORT_LINK_SEND_WOKEN){ 363bd021c4eSMatthias Ringwald hci_transport_link_actions &= ~HCI_TRANSPORT_LINK_SEND_WOKEN; 364bd021c4eSMatthias Ringwald hci_transport_link_send_woken(); 365bd021c4eSMatthias Ringwald return; 366bd021c4eSMatthias Ringwald } 367bd021c4eSMatthias Ringwald if (hci_transport_link_actions & HCI_TRANSPORT_LINK_SEND_WAKEUP){ 368bd021c4eSMatthias Ringwald hci_transport_link_actions &= ~HCI_TRANSPORT_LINK_SEND_WAKEUP; 369bd021c4eSMatthias Ringwald hci_transport_link_send_wakeup(); 370bd021c4eSMatthias Ringwald return; 371bd021c4eSMatthias Ringwald } 372bd021c4eSMatthias Ringwald if (hci_transport_link_actions & HCI_TRANSPORT_LINK_SEND_QUEUED_PACKET){ 373bd021c4eSMatthias Ringwald hci_transport_link_actions &= ~HCI_TRANSPORT_LINK_SEND_QUEUED_PACKET; 374bd021c4eSMatthias Ringwald // packet already contains ack, no need to send addtitional one 375bd021c4eSMatthias Ringwald hci_transport_link_actions &= ~HCI_TRANSPORT_LINK_SEND_ACK_PACKET; 376bd021c4eSMatthias Ringwald hci_transport_link_send_queued_packet(); 377bd021c4eSMatthias Ringwald return; 378bd021c4eSMatthias Ringwald } 379bd021c4eSMatthias Ringwald if (hci_transport_link_actions & HCI_TRANSPORT_LINK_SEND_ACK_PACKET){ 380bd021c4eSMatthias Ringwald hci_transport_link_actions &= ~HCI_TRANSPORT_LINK_SEND_ACK_PACKET; 381bd021c4eSMatthias Ringwald hci_transport_link_send_ack_packet(); 382bd021c4eSMatthias Ringwald return; 383bd021c4eSMatthias Ringwald } 38494764e99SMatthias Ringwald if (hci_transport_link_actions & HCI_TRANSPORT_LINK_SEND_SLEEP){ 38594764e99SMatthias Ringwald hci_transport_link_actions &= ~HCI_TRANSPORT_LINK_SEND_SLEEP; 38694764e99SMatthias Ringwald hci_transport_link_actions |= HCI_TRANSPORT_LINK_ENTER_SLEEP; 38794764e99SMatthias Ringwald link_peer_asleep = 1; 38894764e99SMatthias Ringwald hci_transport_link_send_sleep(); 38994764e99SMatthias Ringwald return; 39094764e99SMatthias Ringwald } 391bd021c4eSMatthias Ringwald } 392bd021c4eSMatthias Ringwald 393bd021c4eSMatthias Ringwald static void hci_transport_link_set_timer(uint16_t timeout_ms){ 394bd021c4eSMatthias Ringwald btstack_run_loop_set_timer_handler(&link_timer, &hci_transport_link_timeout_handler); 395bd021c4eSMatthias Ringwald btstack_run_loop_set_timer(&link_timer, timeout_ms); 396bd021c4eSMatthias Ringwald btstack_run_loop_add_timer(&link_timer); 397bd021c4eSMatthias Ringwald } 398bd021c4eSMatthias Ringwald 399bd021c4eSMatthias Ringwald static void hci_transport_link_timeout_handler(btstack_timer_source_t * timer){ 400bd021c4eSMatthias Ringwald switch (link_state){ 401bd021c4eSMatthias Ringwald case LINK_UNINITIALIZED: 402bd021c4eSMatthias Ringwald hci_transport_link_actions |= HCI_TRANSPORT_LINK_SEND_SYNC; 403bd021c4eSMatthias Ringwald hci_transport_link_set_timer(LINK_PERIOD_MS); 404bd021c4eSMatthias Ringwald break; 405bd021c4eSMatthias Ringwald case LINK_INITIALIZED: 406bd021c4eSMatthias Ringwald hci_transport_link_actions |= HCI_TRANSPORT_LINK_SEND_CONFIG; 407bd021c4eSMatthias Ringwald hci_transport_link_set_timer(LINK_PERIOD_MS); 408bd021c4eSMatthias Ringwald break; 409bd021c4eSMatthias Ringwald case LINK_ACTIVE: 410bd021c4eSMatthias Ringwald if (!hci_transport_link_have_outgoing_packet()){ 411bd021c4eSMatthias Ringwald log_info("h5 timeout while active, but no outgoing packet"); 412bd021c4eSMatthias Ringwald return; 413bd021c4eSMatthias Ringwald } 414bd021c4eSMatthias Ringwald if (link_peer_asleep){ 415bd021c4eSMatthias Ringwald hci_transport_link_actions |= HCI_TRANSPORT_LINK_SEND_WAKEUP; 416bd021c4eSMatthias Ringwald hci_transport_link_set_timer(LINK_WAKEUP_MS); 417bd021c4eSMatthias Ringwald return; 418bd021c4eSMatthias Ringwald } 419bd021c4eSMatthias Ringwald // resend packet 420bd021c4eSMatthias Ringwald hci_transport_link_actions |= HCI_TRANSPORT_LINK_SEND_QUEUED_PACKET; 421bd021c4eSMatthias Ringwald hci_transport_link_set_timer(link_resend_timeout_ms); 422bd021c4eSMatthias Ringwald break; 423bd021c4eSMatthias Ringwald default: 424bd021c4eSMatthias Ringwald break; 425bd021c4eSMatthias Ringwald } 426bd021c4eSMatthias Ringwald 427bd021c4eSMatthias Ringwald hci_transport_link_run(); 428bd021c4eSMatthias Ringwald } 429bd021c4eSMatthias Ringwald 430bd021c4eSMatthias Ringwald static void hci_transport_link_init(void){ 431bd021c4eSMatthias Ringwald link_state = LINK_UNINITIALIZED; 432bd021c4eSMatthias Ringwald link_peer_asleep = 0; 433*7c2aa31eSMatthias Ringwald link_peer_supports_data_integrity_check = 0; 434bd021c4eSMatthias Ringwald 435bd021c4eSMatthias Ringwald // get started 436bd021c4eSMatthias Ringwald hci_transport_link_actions |= HCI_TRANSPORT_LINK_SEND_SYNC; 437bd021c4eSMatthias Ringwald hci_transport_link_set_timer(LINK_PERIOD_MS); 438bd021c4eSMatthias Ringwald hci_transport_link_run(); 439bd021c4eSMatthias Ringwald } 440bd021c4eSMatthias Ringwald 441bd021c4eSMatthias Ringwald static int hci_transport_link_inc_seq_nr(int seq_nr){ 442bd021c4eSMatthias Ringwald return (seq_nr + 1) & 0x07; 443bd021c4eSMatthias Ringwald } 444bd021c4eSMatthias Ringwald 445bd021c4eSMatthias Ringwald static int hci_transport_link_have_outgoing_packet(void){ 446bd021c4eSMatthias Ringwald return hci_packet != 0; 447bd021c4eSMatthias Ringwald } 448bd021c4eSMatthias Ringwald 449bd021c4eSMatthias Ringwald static void hci_transport_link_clear_queue(void){ 450bd021c4eSMatthias Ringwald btstack_run_loop_remove_timer(&link_timer); 451bd021c4eSMatthias Ringwald hci_packet = NULL; 452bd021c4eSMatthias Ringwald } 453bd021c4eSMatthias Ringwald 454bd021c4eSMatthias Ringwald static void hci_transport_h5_queue_packet(uint8_t packet_type, uint8_t *packet, int size){ 455bd021c4eSMatthias Ringwald hci_packet = packet; 456bd021c4eSMatthias Ringwald hci_packet_type = packet_type; 457bd021c4eSMatthias Ringwald hci_packet_size = size; 458bd021c4eSMatthias Ringwald } 459bd021c4eSMatthias Ringwald 460bd021c4eSMatthias Ringwald static void hci_transport_h5_process_frame(uint16_t frame_size){ 461bd021c4eSMatthias Ringwald 462bd021c4eSMatthias Ringwald if (frame_size < 4) return; 463bd021c4eSMatthias Ringwald 464bd021c4eSMatthias Ringwald uint8_t * slip_header = &hci_packet_with_pre_buffer[HCI_INCOMING_PRE_BUFFER_SIZE]; 465bd021c4eSMatthias Ringwald uint8_t * slip_payload = &hci_packet_with_pre_buffer[HCI_INCOMING_PRE_BUFFER_SIZE + 4]; 466bd021c4eSMatthias Ringwald int frame_size_without_header = frame_size - 4; 467bd021c4eSMatthias Ringwald 468f04a0c31SMatthias Ringwald uint8_t seq_nr = slip_header[0] & 0x07; 469f04a0c31SMatthias Ringwald uint8_t ack_nr = (slip_header[0] >> 3) & 0x07; 470f04a0c31SMatthias Ringwald uint8_t data_integrity_check_present = (slip_header[0] & 0x40) != 0; 471f04a0c31SMatthias Ringwald uint8_t reliable_packet = (slip_header[0] & 0x80) != 0; 472bd021c4eSMatthias Ringwald uint8_t link_packet_type = slip_header[1] & 0x0f; 473bd021c4eSMatthias Ringwald uint16_t link_payload_len = (slip_header[1] >> 4) | (slip_header[2] << 4); 474bd021c4eSMatthias Ringwald 47579b61987SMatthias Ringwald log_info("hci_transport_h5_process_frame, reliable %u, packet type %u, seq_nr %u, ack_nr %u , dic %u", reliable_packet, link_packet_type, seq_nr, ack_nr, data_integrity_check_present); 476bd021c4eSMatthias Ringwald log_info_hexdump(slip_header, 4); 477bd021c4eSMatthias Ringwald log_info_hexdump(slip_payload, frame_size_without_header); 478bd021c4eSMatthias Ringwald 479bd021c4eSMatthias Ringwald // CSR 8811 does not seem to auto-detect H5 mode and sends data with even parity. 480bd021c4eSMatthias Ringwald // if this byte sequence is detected, just enable even parity 481bd021c4eSMatthias Ringwald const uint8_t sync_response_bcsp[] = {0x01, 0x7a, 0x06, 0x10}; 482bd021c4eSMatthias Ringwald if (memcmp(sync_response_bcsp, slip_header, 4) == 0){ 483bd021c4eSMatthias Ringwald log_info("h5: detected BSCP SYNC sent with Even Parity -> discard frame and enable Even Parity"); 484bd021c4eSMatthias Ringwald btstack_uart->set_parity(1); 485bd021c4eSMatthias Ringwald return; 486bd021c4eSMatthias Ringwald } 487bd021c4eSMatthias Ringwald 488bd021c4eSMatthias Ringwald // validate header checksum 489bd021c4eSMatthias Ringwald uint8_t header_checksum = slip_header[0] + slip_header[1] + slip_header[2] + slip_header[3]; 490bd021c4eSMatthias Ringwald if (header_checksum != 0xff){ 491bd021c4eSMatthias Ringwald log_info("h5: header checksum 0x%02x (instead of 0xff)", header_checksum); 492bd021c4eSMatthias Ringwald return; 493bd021c4eSMatthias Ringwald } 494bd021c4eSMatthias Ringwald 495bd021c4eSMatthias Ringwald // validate payload length 496bd021c4eSMatthias Ringwald int data_integrity_len = data_integrity_check_present ? 2 : 0; 497bd021c4eSMatthias Ringwald uint16_t received_payload_len = frame_size_without_header - data_integrity_len; 498bd021c4eSMatthias Ringwald if (link_payload_len != received_payload_len){ 499bd021c4eSMatthias Ringwald log_info("h5: expected payload len %u but got %u", link_payload_len, received_payload_len); 500bd021c4eSMatthias Ringwald return; 501bd021c4eSMatthias Ringwald } 502bd021c4eSMatthias Ringwald 50379b61987SMatthias Ringwald // validate data integrity check 50479b61987SMatthias Ringwald if (data_integrity_check_present){ 50579b61987SMatthias Ringwald uint16_t dic_packet = big_endian_read_16(slip_payload, received_payload_len); 50679b61987SMatthias Ringwald uint16_t dic_calculate = crc16_calc_for_slip_frame(slip_header, slip_payload, received_payload_len); 50779b61987SMatthias Ringwald if (dic_packet != dic_calculate){ 50879b61987SMatthias Ringwald log_info("h5: expected dic value 0x%04x but got 0x%04x", dic_calculate, dic_packet); 50979b61987SMatthias Ringwald return; 51079b61987SMatthias Ringwald } 51179b61987SMatthias Ringwald } 512bd021c4eSMatthias Ringwald 513bd021c4eSMatthias Ringwald switch (link_state){ 514bd021c4eSMatthias Ringwald case LINK_UNINITIALIZED: 515bd021c4eSMatthias Ringwald if (link_packet_type != LINK_CONTROL_PACKET_TYPE) break; 516bd021c4eSMatthias Ringwald if (memcmp(slip_payload, link_control_sync, sizeof(link_control_sync)) == 0){ 517bd021c4eSMatthias Ringwald log_info("link: received sync"); 518bd021c4eSMatthias Ringwald hci_transport_link_actions |= HCI_TRANSPORT_LINK_SEND_SYNC_RESPONSE; 519bd021c4eSMatthias Ringwald } 520bd021c4eSMatthias Ringwald if (memcmp(slip_payload, link_control_sync_response, sizeof(link_control_sync_response)) == 0){ 521bd021c4eSMatthias Ringwald log_info("link: received sync response"); 522bd021c4eSMatthias Ringwald link_state = LINK_INITIALIZED; 523bd021c4eSMatthias Ringwald btstack_run_loop_remove_timer(&link_timer); 524bd021c4eSMatthias Ringwald log_info("link initialized"); 525bd021c4eSMatthias Ringwald // 526bd021c4eSMatthias Ringwald hci_transport_link_actions |= HCI_TRANSPORT_LINK_SEND_CONFIG; 527bd021c4eSMatthias Ringwald hci_transport_link_set_timer(LINK_PERIOD_MS); 528bd021c4eSMatthias Ringwald } 529bd021c4eSMatthias Ringwald break; 530bd021c4eSMatthias Ringwald case LINK_INITIALIZED: 531bd021c4eSMatthias Ringwald if (link_packet_type != LINK_CONTROL_PACKET_TYPE) break; 532bd021c4eSMatthias Ringwald if (memcmp(slip_payload, link_control_sync, sizeof(link_control_sync)) == 0){ 533bd021c4eSMatthias Ringwald log_info("link: received sync"); 534bd021c4eSMatthias Ringwald hci_transport_link_actions |= HCI_TRANSPORT_LINK_SEND_SYNC_RESPONSE; 535bd021c4eSMatthias Ringwald } 536cbc04f48SMatthias Ringwald if (memcmp(slip_payload, link_control_config, link_control_config_prefix_len) == 0){ 53779b61987SMatthias Ringwald log_info("link: received config, 0x%02x", slip_payload[2]); 538bd021c4eSMatthias Ringwald hci_transport_link_actions |= HCI_TRANSPORT_LINK_SEND_CONFIG_RESPONSE; 539bd021c4eSMatthias Ringwald } 540bd021c4eSMatthias Ringwald if (memcmp(slip_payload, link_control_config_response, link_control_config_response_prefix_len) == 0){ 541*7c2aa31eSMatthias Ringwald uint8_t config = slip_payload[2]; 542*7c2aa31eSMatthias Ringwald link_peer_supports_data_integrity_check = (config & 0x10) != 0; 543*7c2aa31eSMatthias Ringwald log_info("link: received config response 0x%02x, data integrity check supported %u", config, link_peer_supports_data_integrity_check); 544bd021c4eSMatthias Ringwald link_state = LINK_ACTIVE; 545bd021c4eSMatthias Ringwald btstack_run_loop_remove_timer(&link_timer); 546bd021c4eSMatthias Ringwald log_info("link activated"); 547bd021c4eSMatthias Ringwald // 548bd021c4eSMatthias Ringwald link_seq_nr = 0; 549bd021c4eSMatthias Ringwald link_ack_nr = 0; 550bd021c4eSMatthias Ringwald // notify upper stack that it can start 551bd021c4eSMatthias Ringwald uint8_t event[] = { HCI_EVENT_TRANSPORT_PACKET_SENT, 0}; 552bd021c4eSMatthias Ringwald packet_handler(HCI_EVENT_PACKET, &event[0], sizeof(event)); 553bd021c4eSMatthias Ringwald } 554bd021c4eSMatthias Ringwald break; 555bd021c4eSMatthias Ringwald case LINK_ACTIVE: 556bd021c4eSMatthias Ringwald 557bd021c4eSMatthias Ringwald // validate packet sequence nr in reliable packets (check for out of sequence error) 558bd021c4eSMatthias Ringwald if (reliable_packet){ 559bd021c4eSMatthias Ringwald if (seq_nr != link_ack_nr){ 560bd021c4eSMatthias Ringwald log_info("expected seq nr %u, but received %u", link_ack_nr, seq_nr); 561bd021c4eSMatthias Ringwald hci_transport_link_actions |= HCI_TRANSPORT_LINK_SEND_ACK_PACKET; 562bd021c4eSMatthias Ringwald break; 563bd021c4eSMatthias Ringwald } 564bd021c4eSMatthias Ringwald // ack packet right away 565bd021c4eSMatthias Ringwald link_ack_nr = hci_transport_link_inc_seq_nr(link_ack_nr); 566bd021c4eSMatthias Ringwald hci_transport_link_actions |= HCI_TRANSPORT_LINK_SEND_ACK_PACKET; 567bd021c4eSMatthias Ringwald } 568bd021c4eSMatthias Ringwald 569bd021c4eSMatthias Ringwald // Process ACKs in reliable packet and explicit ack packets 570bd021c4eSMatthias Ringwald if (reliable_packet || link_packet_type == LINK_ACKNOWLEDGEMENT_TYPE){ 571bd021c4eSMatthias Ringwald // our packet is good if the remote expects our seq nr + 1 572bd021c4eSMatthias Ringwald int next_seq_nr = hci_transport_link_inc_seq_nr(link_seq_nr); 573bd021c4eSMatthias Ringwald if (hci_transport_link_have_outgoing_packet() && next_seq_nr == ack_nr){ 574bd021c4eSMatthias Ringwald log_info("h5: outoing packet with seq %u ack'ed", link_seq_nr); 575bd021c4eSMatthias Ringwald link_seq_nr = next_seq_nr; 576bd021c4eSMatthias Ringwald hci_transport_link_clear_queue(); 577bd021c4eSMatthias Ringwald 578bd021c4eSMatthias Ringwald // notify upper stack that it can send again 579bd021c4eSMatthias Ringwald uint8_t event[] = { HCI_EVENT_TRANSPORT_PACKET_SENT, 0}; 580bd021c4eSMatthias Ringwald packet_handler(HCI_EVENT_PACKET, &event[0], sizeof(event)); 581bd021c4eSMatthias Ringwald } 582bd021c4eSMatthias Ringwald } 583bd021c4eSMatthias Ringwald 584bd021c4eSMatthias Ringwald switch (link_packet_type){ 585bd021c4eSMatthias Ringwald case LINK_CONTROL_PACKET_TYPE: 586bd021c4eSMatthias Ringwald if (memcmp(slip_payload, link_control_config, sizeof(link_control_config)) == 0){ 587bd021c4eSMatthias Ringwald log_info("link: received config"); 588bd021c4eSMatthias Ringwald hci_transport_link_actions |= HCI_TRANSPORT_LINK_SEND_CONFIG_RESPONSE; 589bd021c4eSMatthias Ringwald break; 590bd021c4eSMatthias Ringwald } 591bd021c4eSMatthias Ringwald if (memcmp(slip_payload, link_control_sync, sizeof(link_control_sync)) == 0){ 592bd021c4eSMatthias Ringwald log_info("link: received sync in ACTIVE STATE!"); 593bd021c4eSMatthias Ringwald // TODO sync during active indicates peer reset -> full upper layer reset necessary 594bd021c4eSMatthias Ringwald break; 595bd021c4eSMatthias Ringwald } 596bd021c4eSMatthias Ringwald if (memcmp(slip_payload, link_control_sleep, sizeof(link_control_sleep)) == 0){ 597d8e28fa3SMatthias Ringwald if (btstack_uart_sleep_mode){ 598d8e28fa3SMatthias Ringwald log_info("link: received sleep message. Enabling UART Sleep."); 599d8e28fa3SMatthias Ringwald btstack_uart->set_sleep(btstack_uart_sleep_mode); 600d8e28fa3SMatthias Ringwald } else { 601d8e28fa3SMatthias Ringwald log_info("link: received sleep message. UART Sleep not supported"); 602d8e28fa3SMatthias Ringwald } 603bd021c4eSMatthias Ringwald link_peer_asleep = 1; 604bd021c4eSMatthias Ringwald break; 605bd021c4eSMatthias Ringwald } 606bd021c4eSMatthias Ringwald if (memcmp(slip_payload, link_control_wakeup, sizeof(link_control_wakeup)) == 0){ 607bd021c4eSMatthias Ringwald log_info("link: received wakupe message -> send woken"); 608bd021c4eSMatthias Ringwald link_peer_asleep = 0; 609bd021c4eSMatthias Ringwald hci_transport_link_actions |= HCI_TRANSPORT_LINK_SEND_WOKEN; 610bd021c4eSMatthias Ringwald break; 611bd021c4eSMatthias Ringwald } 612bd021c4eSMatthias Ringwald if (memcmp(slip_payload, link_control_woken, sizeof(link_control_woken)) == 0){ 613bd021c4eSMatthias Ringwald log_info("link: received woken message"); 614bd021c4eSMatthias Ringwald link_peer_asleep = 0; 61594764e99SMatthias Ringwald // queued packet will be sent in hci_transport_link_run if needed 616bd021c4eSMatthias Ringwald break; 617bd021c4eSMatthias Ringwald } 618bd021c4eSMatthias Ringwald break; 619bd021c4eSMatthias Ringwald case HCI_EVENT_PACKET: 620bd021c4eSMatthias Ringwald case HCI_ACL_DATA_PACKET: 621bd021c4eSMatthias Ringwald case HCI_SCO_DATA_PACKET: 62294764e99SMatthias Ringwald // seems like peer is awake 62394764e99SMatthias Ringwald link_peer_asleep = 0; 62494764e99SMatthias Ringwald // forward packet to stack 625bd021c4eSMatthias Ringwald packet_handler(link_packet_type, slip_payload, link_payload_len); 62694764e99SMatthias Ringwald // reset inactvitiy timer 62794764e99SMatthias Ringwald hci_transport_inactivity_timer_set(); 628bd021c4eSMatthias Ringwald break; 629bd021c4eSMatthias Ringwald } 630bd021c4eSMatthias Ringwald 631bd021c4eSMatthias Ringwald break; 632bd021c4eSMatthias Ringwald default: 633bd021c4eSMatthias Ringwald break; 634bd021c4eSMatthias Ringwald } 635bd021c4eSMatthias Ringwald 636bd021c4eSMatthias Ringwald hci_transport_link_run(); 637bd021c4eSMatthias Ringwald } 638bd021c4eSMatthias Ringwald 639bd021c4eSMatthias Ringwald // recommendet time until resend: 3 * time of largest packet 640bd021c4eSMatthias Ringwald static uint16_t hci_transport_link_calc_resend_timeout(uint32_t baudrate){ 641bd021c4eSMatthias Ringwald uint32_t max_packet_size_in_bit = (HCI_PACKET_BUFFER_SIZE + 6) << 3; 642bd021c4eSMatthias Ringwald uint32_t t_max_x3_ms = max_packet_size_in_bit * 3000 / baudrate; 643bd021c4eSMatthias Ringwald log_info("resend timeout for %u baud: %u ms", baudrate, t_max_x3_ms); 644bd021c4eSMatthias Ringwald return t_max_x3_ms; 645bd021c4eSMatthias Ringwald } 646bd021c4eSMatthias Ringwald 647bd021c4eSMatthias Ringwald static void hci_transport_link_update_resend_timeout(uint32_t baudrate){ 648bd021c4eSMatthias Ringwald link_resend_timeout_ms = hci_transport_link_calc_resend_timeout(baudrate); 649bd021c4eSMatthias Ringwald } 650bd021c4eSMatthias Ringwald 651bd021c4eSMatthias Ringwald /// H5 Interface 652bd021c4eSMatthias Ringwald 653bd021c4eSMatthias Ringwald static uint8_t hci_transport_link_read_byte; 654bd021c4eSMatthias Ringwald 655bd021c4eSMatthias Ringwald static void hci_transport_h5_read_next_byte(void){ 656cbc04f48SMatthias Ringwald log_debug("h5: rx nxt"); 657bd021c4eSMatthias Ringwald btstack_uart->receive_block(&hci_transport_link_read_byte, 1); 658bd021c4eSMatthias Ringwald } 659bd021c4eSMatthias Ringwald 660bd021c4eSMatthias Ringwald static void hci_transport_h5_block_received(){ 661cbc04f48SMatthias Ringwald log_debug("slip: process 0x%02x", hci_transport_link_read_byte); 662bd021c4eSMatthias Ringwald btstack_slip_decoder_process(hci_transport_link_read_byte); 663bd021c4eSMatthias Ringwald uint16_t frame_size = btstack_slip_decoder_frame_size(); 664bd021c4eSMatthias Ringwald if (frame_size) { 665bd021c4eSMatthias Ringwald hci_transport_h5_process_frame(frame_size); 666bd021c4eSMatthias Ringwald hci_transport_slip_init(); 667bd021c4eSMatthias Ringwald } 668bd021c4eSMatthias Ringwald hci_transport_h5_read_next_byte(); 669bd021c4eSMatthias Ringwald } 670bd021c4eSMatthias Ringwald 671bd021c4eSMatthias Ringwald static void hci_transport_h5_block_sent(void){ 6726ae10533SMatthias Ringwald 6736ae10533SMatthias Ringwald // check if more data to send 6746ae10533SMatthias Ringwald if (btstack_slip_encoder_has_data()){ 6756ae10533SMatthias Ringwald hci_transport_slip_send_next_chunk(); 6766ae10533SMatthias Ringwald return; 6776ae10533SMatthias Ringwald } 6786ae10533SMatthias Ringwald 6796ae10533SMatthias Ringwald // done 6806ae10533SMatthias Ringwald slip_write_active = 0; 68194764e99SMatthias Ringwald 68294764e99SMatthias Ringwald // enter sleep mode after sending sleep message 68394764e99SMatthias Ringwald if (hci_transport_link_actions & HCI_TRANSPORT_LINK_ENTER_SLEEP){ 68494764e99SMatthias Ringwald hci_transport_link_actions &= ~HCI_TRANSPORT_LINK_ENTER_SLEEP; 68594764e99SMatthias Ringwald if (btstack_uart_sleep_mode){ 68694764e99SMatthias Ringwald log_info("link: sent sleep message. Enabling UART Sleep."); 68794764e99SMatthias Ringwald btstack_uart->set_sleep(btstack_uart_sleep_mode); 68894764e99SMatthias Ringwald } else { 68994764e99SMatthias Ringwald log_info("link: sent sleep message. UART Sleep not supported"); 69094764e99SMatthias Ringwald } 69194764e99SMatthias Ringwald } 69294764e99SMatthias Ringwald 693bd021c4eSMatthias Ringwald hci_transport_link_run(); 694bd021c4eSMatthias Ringwald } 695bd021c4eSMatthias Ringwald 696bd021c4eSMatthias Ringwald static void hci_transport_h5_init(const void * transport_config){ 697bd021c4eSMatthias Ringwald // check for hci_transport_config_uart_t 698bd021c4eSMatthias Ringwald if (!transport_config) { 699bd021c4eSMatthias Ringwald log_error("hci_transport_h5: no config!"); 700bd021c4eSMatthias Ringwald return; 701bd021c4eSMatthias Ringwald } 702bd021c4eSMatthias Ringwald if (((hci_transport_config_t*)transport_config)->type != HCI_TRANSPORT_CONFIG_UART) { 703bd021c4eSMatthias Ringwald log_error("hci_transport_h5: config not of type != HCI_TRANSPORT_CONFIG_UART!"); 704bd021c4eSMatthias Ringwald return; 705bd021c4eSMatthias Ringwald } 706bd021c4eSMatthias Ringwald 707bd021c4eSMatthias Ringwald // extract UART config from transport config 708bd021c4eSMatthias Ringwald hci_transport_config_uart_t * hci_transport_config_uart = (hci_transport_config_uart_t*) transport_config; 709bd021c4eSMatthias Ringwald uart_config.baudrate = hci_transport_config_uart->baudrate_init; 710bd021c4eSMatthias Ringwald uart_config.flowcontrol = hci_transport_config_uart->flowcontrol; 711bd021c4eSMatthias Ringwald uart_config.device_name = hci_transport_config_uart->device_name; 712bd021c4eSMatthias Ringwald 713bd021c4eSMatthias Ringwald // setup UART driver 714bd021c4eSMatthias Ringwald btstack_uart->init(&uart_config); 715bd021c4eSMatthias Ringwald btstack_uart->set_block_received(&hci_transport_h5_block_received); 716bd021c4eSMatthias Ringwald btstack_uart->set_block_sent(&hci_transport_h5_block_sent); 717bd021c4eSMatthias Ringwald } 718bd021c4eSMatthias Ringwald 719bd021c4eSMatthias Ringwald static int hci_transport_h5_open(void){ 720bd021c4eSMatthias Ringwald int res = btstack_uart->open(); 721bd021c4eSMatthias Ringwald if (res){ 722bd021c4eSMatthias Ringwald return res; 723bd021c4eSMatthias Ringwald } 724bd021c4eSMatthias Ringwald 725d8e28fa3SMatthias Ringwald // check if wake on RX can be used 726d8e28fa3SMatthias Ringwald btstack_uart_sleep_mode = BTSTACK_UART_SLEEP_OFF; 727d8e28fa3SMatthias Ringwald int supported_sleep_modes = 0; 728d8e28fa3SMatthias Ringwald if (btstack_uart->get_supported_sleep_modes){ 729d8e28fa3SMatthias Ringwald supported_sleep_modes = btstack_uart->get_supported_sleep_modes(); 730d8e28fa3SMatthias Ringwald } 731d8e28fa3SMatthias Ringwald if (supported_sleep_modes & BTSTACK_UART_SLEEP_MASK_RTS_LOW_WAKE_ON_RX_EDGE){ 732d8e28fa3SMatthias Ringwald log_info("H5: using wake on RX"); 733d8e28fa3SMatthias Ringwald btstack_uart_sleep_mode = BTSTACK_UART_SLEEP_RTS_LOW_WAKE_ON_RX_EDGE; 734d8e28fa3SMatthias Ringwald } else { 735d8e28fa3SMatthias Ringwald log_info("H5: UART driver does not provide compatible sleep mode"); 736d8e28fa3SMatthias Ringwald } 737d8e28fa3SMatthias Ringwald 738bd021c4eSMatthias Ringwald // setup resend timeout 739bd021c4eSMatthias Ringwald hci_transport_link_update_resend_timeout(uart_config.baudrate); 740bd021c4eSMatthias Ringwald 741bd021c4eSMatthias Ringwald // init slip parser state machine 742bd021c4eSMatthias Ringwald hci_transport_slip_init(); 743bd021c4eSMatthias Ringwald 744bd021c4eSMatthias Ringwald // init link management - already starts syncing 745bd021c4eSMatthias Ringwald hci_transport_link_init(); 746bd021c4eSMatthias Ringwald 747bd021c4eSMatthias Ringwald // start receiving 748bd021c4eSMatthias Ringwald hci_transport_h5_read_next_byte(); 749bd021c4eSMatthias Ringwald 750bd021c4eSMatthias Ringwald return 0; 751bd021c4eSMatthias Ringwald } 752bd021c4eSMatthias Ringwald 753bd021c4eSMatthias Ringwald static int hci_transport_h5_close(void){ 754bd021c4eSMatthias Ringwald return btstack_uart->close(); 755bd021c4eSMatthias Ringwald return 0; 756bd021c4eSMatthias Ringwald } 757bd021c4eSMatthias Ringwald 758bd021c4eSMatthias Ringwald static void hci_transport_h5_register_packet_handler(void (*handler)(uint8_t packet_type, uint8_t *packet, uint16_t size)){ 759bd021c4eSMatthias Ringwald packet_handler = handler; 760bd021c4eSMatthias Ringwald } 761bd021c4eSMatthias Ringwald 762bd021c4eSMatthias Ringwald static int hci_transport_h5_can_send_packet_now(uint8_t packet_type){ 76394764e99SMatthias Ringwald int res = !hci_transport_link_have_outgoing_packet() && link_state == LINK_ACTIVE; 7646ae10533SMatthias Ringwald // log_info("hci_transport_h5_can_send_packet_now: %u", res); 76594764e99SMatthias Ringwald return res; 766bd021c4eSMatthias Ringwald } 767bd021c4eSMatthias Ringwald 768bd021c4eSMatthias Ringwald static int hci_transport_h5_send_packet(uint8_t packet_type, uint8_t *packet, int size){ 769bd021c4eSMatthias Ringwald if (!hci_transport_h5_can_send_packet_now(packet_type)){ 770f04a0c31SMatthias Ringwald log_error("hci_transport_h5_send_packet called but in state %d", link_state); 771bd021c4eSMatthias Ringwald return -1; 772bd021c4eSMatthias Ringwald } 773bd021c4eSMatthias Ringwald 774bd021c4eSMatthias Ringwald // store request 775bd021c4eSMatthias Ringwald hci_transport_h5_queue_packet(packet_type, packet, size); 776bd021c4eSMatthias Ringwald 777bd021c4eSMatthias Ringwald // send wakeup first 778bd021c4eSMatthias Ringwald if (link_peer_asleep){ 779d8e28fa3SMatthias Ringwald if (btstack_uart_sleep_mode){ 780d8e28fa3SMatthias Ringwald log_info("h5: disable UART sleep"); 781d8e28fa3SMatthias Ringwald btstack_uart->set_sleep(BTSTACK_UART_SLEEP_OFF); 782d8e28fa3SMatthias Ringwald } 783bd021c4eSMatthias Ringwald hci_transport_link_actions |= HCI_TRANSPORT_LINK_SEND_WAKEUP; 784bd021c4eSMatthias Ringwald hci_transport_link_set_timer(LINK_WAKEUP_MS); 785bd021c4eSMatthias Ringwald } else { 786bd021c4eSMatthias Ringwald hci_transport_link_actions |= HCI_TRANSPORT_LINK_SEND_QUEUED_PACKET; 787bd021c4eSMatthias Ringwald hci_transport_link_set_timer(link_resend_timeout_ms); 788bd021c4eSMatthias Ringwald } 789bd021c4eSMatthias Ringwald hci_transport_link_run(); 790bd021c4eSMatthias Ringwald return 0; 791bd021c4eSMatthias Ringwald } 792bd021c4eSMatthias Ringwald 793bd021c4eSMatthias Ringwald static int hci_transport_h5_set_baudrate(uint32_t baudrate){ 794bd021c4eSMatthias Ringwald 795bd021c4eSMatthias Ringwald log_info("hci_transport_h5_set_baudrate %u", baudrate); 796bd021c4eSMatthias Ringwald int res = btstack_uart->set_baudrate(baudrate); 797bd021c4eSMatthias Ringwald 798bd021c4eSMatthias Ringwald if (res) return res; 799bd021c4eSMatthias Ringwald hci_transport_link_update_resend_timeout(baudrate); 800bd021c4eSMatthias Ringwald return 0; 801bd021c4eSMatthias Ringwald } 802bd021c4eSMatthias Ringwald 803bd021c4eSMatthias Ringwald static void hci_transport_h5_reset_link(void){ 804bd021c4eSMatthias Ringwald 805bd021c4eSMatthias Ringwald log_info("hci_transport_h5_reset_link"); 806bd021c4eSMatthias Ringwald 807bd021c4eSMatthias Ringwald // clear outgoing queue 808bd021c4eSMatthias Ringwald hci_transport_link_clear_queue(); 809bd021c4eSMatthias Ringwald 810bd021c4eSMatthias Ringwald // init slip parser state machine 811bd021c4eSMatthias Ringwald hci_transport_slip_init(); 812bd021c4eSMatthias Ringwald 813bd021c4eSMatthias Ringwald // init link management - already starts syncing 814bd021c4eSMatthias Ringwald hci_transport_link_init(); 815bd021c4eSMatthias Ringwald } 816bd021c4eSMatthias Ringwald 817bd021c4eSMatthias Ringwald static const hci_transport_t hci_transport_h5 = { 818bd021c4eSMatthias Ringwald /* const char * name; */ "H5", 819bd021c4eSMatthias Ringwald /* void (*init) (const void *transport_config); */ &hci_transport_h5_init, 820bd021c4eSMatthias Ringwald /* int (*open)(void); */ &hci_transport_h5_open, 821bd021c4eSMatthias Ringwald /* int (*close)(void); */ &hci_transport_h5_close, 822bd021c4eSMatthias Ringwald /* void (*register_packet_handler)(void (*handler)(...); */ &hci_transport_h5_register_packet_handler, 823bd021c4eSMatthias Ringwald /* int (*can_send_packet_now)(uint8_t packet_type); */ &hci_transport_h5_can_send_packet_now, 824bd021c4eSMatthias Ringwald /* int (*send_packet)(...); */ &hci_transport_h5_send_packet, 825bd021c4eSMatthias Ringwald /* int (*set_baudrate)(uint32_t baudrate); */ &hci_transport_h5_set_baudrate, 826bd021c4eSMatthias Ringwald /* void (*reset_link)(void); */ &hci_transport_h5_reset_link, 827ee752bb8SMatthias Ringwald /* void (*set_sco_config)(uint16_t voice_setting, int num_connections); */ NULL, 828bd021c4eSMatthias Ringwald }; 829bd021c4eSMatthias Ringwald 830bd021c4eSMatthias Ringwald // configure and return h5 singleton 831bd021c4eSMatthias Ringwald const hci_transport_t * hci_transport_h5_instance(const btstack_uart_block_t * uart_driver) { 832bd021c4eSMatthias Ringwald btstack_uart = uart_driver; 833bd021c4eSMatthias Ringwald return &hci_transport_h5; 834bd021c4eSMatthias Ringwald } 83594764e99SMatthias Ringwald 83694764e99SMatthias Ringwald void hci_transport_h5_set_auto_sleep(uint16_t inactivity_timeout_ms){ 83794764e99SMatthias Ringwald link_inactivity_timeout_ms = inactivity_timeout_ms; 83894764e99SMatthias Ringwald } 839