xref: /btstack/src/hci_transport_h5.c (revision 79b61987dfd3a492105f7909da8f3f093a28002c)
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 
72*79b61987SMatthias 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
75*79b61987SMatthias 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;
117bd021c4eSMatthias Ringwald 
11894764e99SMatthias Ringwald // auto sleep-mode
11994764e99SMatthias Ringwald static btstack_timer_source_t inactivity_timer;
12094764e99SMatthias Ringwald static uint16_t link_inactivity_timeout_ms; // auto-sleep if set
12194764e99SMatthias Ringwald 
122bd021c4eSMatthias Ringwald // Outgoing packet
123bd021c4eSMatthias Ringwald static uint8_t   hci_packet_type;
124bd021c4eSMatthias Ringwald static uint16_t  hci_packet_size;
125bd021c4eSMatthias Ringwald static uint8_t * hci_packet;
126bd021c4eSMatthias Ringwald 
127bd021c4eSMatthias Ringwald // hci packet handler
128bd021c4eSMatthias Ringwald static  void (*packet_handler)(uint8_t packet_type, uint8_t *packet, uint16_t size);
129bd021c4eSMatthias Ringwald 
130bd021c4eSMatthias Ringwald static int hci_transport_link_actions;
131bd021c4eSMatthias Ringwald 
132bd021c4eSMatthias Ringwald // UART Driver + Config
133bd021c4eSMatthias Ringwald static const btstack_uart_block_t * btstack_uart;
134bd021c4eSMatthias Ringwald static btstack_uart_config_t uart_config;
135d8e28fa3SMatthias Ringwald static btstack_uart_sleep_mode_t btstack_uart_sleep_mode;
136bd021c4eSMatthias Ringwald 
137bd021c4eSMatthias Ringwald // Prototypes
138bd021c4eSMatthias Ringwald static void hci_transport_h5_process_frame(uint16_t frame_size);
139bd021c4eSMatthias Ringwald static int  hci_transport_link_have_outgoing_packet(void);
140bd021c4eSMatthias Ringwald static void hci_transport_link_send_queued_packet(void);
141bd021c4eSMatthias Ringwald static void hci_transport_link_set_timer(uint16_t timeout_ms);
142bd021c4eSMatthias Ringwald static void hci_transport_link_timeout_handler(btstack_timer_source_t * timer);
143bd021c4eSMatthias Ringwald static void hci_transport_link_run(void);
144bd021c4eSMatthias Ringwald static void hci_transport_slip_init(void);
145bd021c4eSMatthias Ringwald 
146*79b61987SMatthias Ringwald // CRC16-CCITT Calculation - compromise: use 32 byte table - 512 byte table would be faster, but that's too large
147*79b61987SMatthias Ringwald 
148*79b61987SMatthias Ringwald static const uint16_t crc16_ccitt_table[] ={
149*79b61987SMatthias Ringwald     0x0000, 0x1081, 0x2102, 0x3183,
150*79b61987SMatthias Ringwald     0x4204, 0x5285, 0x6306, 0x7387,
151*79b61987SMatthias Ringwald     0x8408, 0x9489, 0xa50a, 0xb58b,
152*79b61987SMatthias Ringwald     0xc60c, 0xd68d, 0xe70e, 0xf78f
153*79b61987SMatthias Ringwald };
154*79b61987SMatthias Ringwald 
155*79b61987SMatthias Ringwald static uint16_t crc16_ccitt_update (uint16_t crc, uint8_t ch){
156*79b61987SMatthias Ringwald     crc = (crc >> 4) ^ crc16_ccitt_table[(crc ^ ch) & 0x000f];
157*79b61987SMatthias Ringwald     crc = (crc >> 4) ^ crc16_ccitt_table[(crc ^ (ch >> 4)) & 0x000f];
158*79b61987SMatthias Ringwald     return crc;
159*79b61987SMatthias Ringwald }
160*79b61987SMatthias Ringwald 
161*79b61987SMatthias Ringwald static uint16_t btstack_reverse_bits_16(uint16_t value){
162*79b61987SMatthias Ringwald     int reverse = 0;
163*79b61987SMatthias Ringwald     int i;
164*79b61987SMatthias Ringwald     for (i = 0; i < 16; i++) {
165*79b61987SMatthias Ringwald         reverse = reverse << 1;
166*79b61987SMatthias Ringwald         reverse |= value & 1;
167*79b61987SMatthias Ringwald         value = value >> 1;
168*79b61987SMatthias Ringwald     }
169*79b61987SMatthias Ringwald     return reverse;
170*79b61987SMatthias Ringwald }
171*79b61987SMatthias Ringwald 
172*79b61987SMatthias Ringwald static uint16_t crc16_calc_for_slip_frame(uint8_t * header, uint8_t * payload, uint16_t len){
173*79b61987SMatthias Ringwald     int i;
174*79b61987SMatthias Ringwald     uint16_t crc = 0xffff;
175*79b61987SMatthias Ringwald     for (i=0 ; i < 4 ; i++){
176*79b61987SMatthias Ringwald         crc = crc16_ccitt_update(crc, header[i]);
177*79b61987SMatthias Ringwald     }
178*79b61987SMatthias Ringwald     for (i=0 ; i < len ; i++){
179*79b61987SMatthias Ringwald         crc = crc16_ccitt_update(crc, payload[i]);
180*79b61987SMatthias Ringwald     }
181*79b61987SMatthias Ringwald     return btstack_reverse_bits_16(crc);
182*79b61987SMatthias Ringwald }
183*79b61987SMatthias Ringwald 
184bd021c4eSMatthias Ringwald // -----------------------------
18594764e99SMatthias Ringwald static void hci_transport_inactivity_timeout_handler(btstack_timer_source_t * ts){
186f04a0c31SMatthias Ringwald     log_info("h5: inactivity timeout. link state %d, peer asleep %u, actions 0x%02x, outgoing packet %u",
18794764e99SMatthias Ringwald         link_state, link_peer_asleep, hci_transport_link_actions, hci_transport_link_have_outgoing_packet());
18894764e99SMatthias Ringwald     if (hci_transport_link_have_outgoing_packet()) return;
18994764e99SMatthias Ringwald     if (link_state != LINK_ACTIVE) return;
19094764e99SMatthias Ringwald     if (hci_transport_link_actions) return;
19194764e99SMatthias Ringwald     if (link_peer_asleep) return;
19294764e99SMatthias Ringwald     hci_transport_link_actions |= HCI_TRANSPORT_LINK_SEND_SLEEP;
19394764e99SMatthias Ringwald     hci_transport_link_run();
19494764e99SMatthias Ringwald }
195bd021c4eSMatthias Ringwald 
19694764e99SMatthias Ringwald static void hci_transport_inactivity_timer_set(void){
19794764e99SMatthias Ringwald     if (!link_inactivity_timeout_ms) return;
19894764e99SMatthias Ringwald     btstack_run_loop_set_timer_handler(&inactivity_timer, &hci_transport_inactivity_timeout_handler);
19994764e99SMatthias Ringwald     btstack_run_loop_set_timer(&inactivity_timer, link_inactivity_timeout_ms);
20094764e99SMatthias Ringwald     btstack_run_loop_remove_timer(&inactivity_timer);
20194764e99SMatthias Ringwald     btstack_run_loop_add_timer(&inactivity_timer);
20294764e99SMatthias Ringwald }
203bd021c4eSMatthias Ringwald 
20494764e99SMatthias Ringwald // -----------------------------
205bd021c4eSMatthias Ringwald // SLIP Outgoing
206bd021c4eSMatthias Ringwald 
2076ae10533SMatthias Ringwald // Fill chunk and write
2086ae10533SMatthias Ringwald static void hci_transport_slip_encode_chunk_and_send(int pos){
2096ae10533SMatthias Ringwald     while (btstack_slip_encoder_has_data() & (pos < LINK_SLIP_TX_CHUNK_LEN)) {
2106ae10533SMatthias Ringwald         slip_outgoing_buffer[pos++] = btstack_slip_encoder_get_byte();
2116ae10533SMatthias Ringwald     }
2126ae10533SMatthias Ringwald     if (!btstack_slip_encoder_has_data()){
2136ae10533SMatthias Ringwald         // Start of Frame
2146ae10533SMatthias Ringwald         slip_outgoing_buffer[pos++] = BTSTACK_SLIP_SOF;
2156ae10533SMatthias Ringwald     }
2166ae10533SMatthias Ringwald     slip_write_active = 1;
217f04a0c31SMatthias Ringwald     log_info("hci_transport_slip: send %d bytes", pos);
2186ae10533SMatthias Ringwald     btstack_uart->send_block(slip_outgoing_buffer, pos);
2196ae10533SMatthias Ringwald }
2206ae10533SMatthias Ringwald 
2216ae10533SMatthias Ringwald static inline void hci_transport_slip_send_next_chunk(void){
2226ae10533SMatthias Ringwald     hci_transport_slip_encode_chunk_and_send(0);
2236ae10533SMatthias Ringwald }
2246ae10533SMatthias Ringwald 
225bd021c4eSMatthias Ringwald // format: 0xc0 HEADER PACKER 0xc0
226bd021c4eSMatthias Ringwald // @param uint8_t header[4]
227bd021c4eSMatthias Ringwald static void hci_transport_slip_send_frame(const uint8_t * header, const uint8_t * packet, uint16_t packet_size){
228bd021c4eSMatthias Ringwald 
229bd021c4eSMatthias Ringwald     int pos = 0;
230bd021c4eSMatthias Ringwald 
231bd021c4eSMatthias Ringwald     // Start of Frame
232bd021c4eSMatthias Ringwald     slip_outgoing_buffer[pos++] = BTSTACK_SLIP_SOF;
233bd021c4eSMatthias Ringwald 
234bd021c4eSMatthias Ringwald     // Header
235bd021c4eSMatthias Ringwald     btstack_slip_encoder_start(header, 4);
236bd021c4eSMatthias Ringwald     while (btstack_slip_encoder_has_data()){
237bd021c4eSMatthias Ringwald         slip_outgoing_buffer[pos++] = btstack_slip_encoder_get_byte();
238bd021c4eSMatthias Ringwald     }
239bd021c4eSMatthias Ringwald 
240bd021c4eSMatthias Ringwald     // Packet
241bd021c4eSMatthias Ringwald     btstack_slip_encoder_start(packet, packet_size);
242bd021c4eSMatthias Ringwald 
2436ae10533SMatthias Ringwald     // Fill rest of chunk from packet and send
2446ae10533SMatthias Ringwald     hci_transport_slip_encode_chunk_and_send(pos);
245bd021c4eSMatthias Ringwald }
246bd021c4eSMatthias Ringwald 
247bd021c4eSMatthias Ringwald // SLIP Incoming
248bd021c4eSMatthias Ringwald 
249bd021c4eSMatthias Ringwald static void hci_transport_slip_init(void){
250bd021c4eSMatthias Ringwald     btstack_slip_decoder_init(&hci_packet_with_pre_buffer[HCI_INCOMING_PRE_BUFFER_SIZE], 6 + HCI_PACKET_BUFFER_SIZE);
251bd021c4eSMatthias Ringwald }
252bd021c4eSMatthias Ringwald 
253bd021c4eSMatthias Ringwald // H5 Three-Wire Implementation
254bd021c4eSMatthias Ringwald 
255bd021c4eSMatthias Ringwald static void hci_transport_link_calc_header(uint8_t * header,
256bd021c4eSMatthias Ringwald     uint8_t  sequence_nr,
257bd021c4eSMatthias Ringwald     uint8_t  acknowledgement_nr,
258bd021c4eSMatthias Ringwald     uint8_t  data_integrity_check_present,
259bd021c4eSMatthias Ringwald     uint8_t  reliable_packet,
260bd021c4eSMatthias Ringwald     uint8_t  packet_type,
261bd021c4eSMatthias Ringwald     uint16_t payload_length){
262bd021c4eSMatthias Ringwald 
263bd021c4eSMatthias Ringwald     // reset data integrity flag
264bd021c4eSMatthias Ringwald     if (data_integrity_check_present){
265bd021c4eSMatthias Ringwald         log_error("hci_transport_link_calc_header: data integrity not supported, dropping flag");
266bd021c4eSMatthias Ringwald         data_integrity_check_present = 0;
267bd021c4eSMatthias Ringwald     }
268bd021c4eSMatthias Ringwald 
269bd021c4eSMatthias Ringwald     header[0] = sequence_nr | (acknowledgement_nr << 3) | (data_integrity_check_present << 6) | (reliable_packet << 7);
270bd021c4eSMatthias Ringwald     header[1] = packet_type | ((payload_length & 0x0f) << 4);
271bd021c4eSMatthias Ringwald     header[2] = payload_length >> 4;
272bd021c4eSMatthias Ringwald     header[3] = 0xff - (header[0] + header[1] + header[2]);
273bd021c4eSMatthias Ringwald }
274bd021c4eSMatthias Ringwald 
275bd021c4eSMatthias Ringwald static void hci_transport_link_send_control(const uint8_t * message, int message_len){
276bd021c4eSMatthias Ringwald     uint8_t header[4];
277bd021c4eSMatthias Ringwald     hci_transport_link_calc_header(header, 0, 0, 0, 0, LINK_CONTROL_PACKET_TYPE, message_len);
278bd021c4eSMatthias Ringwald     hci_transport_slip_send_frame(header, message, message_len);
279bd021c4eSMatthias Ringwald }
280bd021c4eSMatthias Ringwald 
281bd021c4eSMatthias Ringwald static void hci_transport_link_send_sync(void){
282bd021c4eSMatthias Ringwald     log_info("link: send sync");
283bd021c4eSMatthias Ringwald     hci_transport_link_send_control(link_control_sync, sizeof(link_control_sync));
284bd021c4eSMatthias Ringwald }
285bd021c4eSMatthias Ringwald 
286bd021c4eSMatthias Ringwald static void hci_transport_link_send_sync_response(void){
287bd021c4eSMatthias Ringwald     log_info("link: send sync response");
288bd021c4eSMatthias Ringwald     hci_transport_link_send_control(link_control_sync_response, sizeof(link_control_sync_response));
289bd021c4eSMatthias Ringwald }
290bd021c4eSMatthias Ringwald 
291bd021c4eSMatthias Ringwald static void hci_transport_link_send_config(void){
292bd021c4eSMatthias Ringwald     log_info("link: send config");
293bd021c4eSMatthias Ringwald     hci_transport_link_send_control(link_control_config, sizeof(link_control_config));
294bd021c4eSMatthias Ringwald }
295bd021c4eSMatthias Ringwald 
296bd021c4eSMatthias Ringwald static void hci_transport_link_send_config_response(void){
297bd021c4eSMatthias Ringwald     log_info("link: send config response");
298bd021c4eSMatthias Ringwald     hci_transport_link_send_control(link_control_config_response, sizeof(link_control_config_response));
299bd021c4eSMatthias Ringwald }
300bd021c4eSMatthias Ringwald 
301bd021c4eSMatthias Ringwald static void hci_transport_link_send_woken(void){
302bd021c4eSMatthias Ringwald     log_info("link: send woken");
303bd021c4eSMatthias Ringwald     hci_transport_link_send_control(link_control_woken, sizeof(link_control_woken));
304bd021c4eSMatthias Ringwald }
305bd021c4eSMatthias Ringwald 
306bd021c4eSMatthias Ringwald static void hci_transport_link_send_wakeup(void){
307bd021c4eSMatthias Ringwald     log_info("link: send wakeup");
308bd021c4eSMatthias Ringwald     hci_transport_link_send_control(link_control_wakeup, sizeof(link_control_wakeup));
309bd021c4eSMatthias Ringwald }
310bd021c4eSMatthias Ringwald 
31194764e99SMatthias Ringwald static void hci_transport_link_send_sleep(void){
31294764e99SMatthias Ringwald     log_info("link: send sleep");
31394764e99SMatthias Ringwald     hci_transport_link_send_control(link_control_sleep, sizeof(link_control_sleep));
31494764e99SMatthias Ringwald }
31594764e99SMatthias Ringwald 
316bd021c4eSMatthias Ringwald static void hci_transport_link_send_queued_packet(void){
317bd021c4eSMatthias Ringwald     log_info("hci_transport_link_send_queued_packet: seq %u, ack %u, size %u", link_seq_nr, link_ack_nr, hci_packet_size);
318bd021c4eSMatthias Ringwald     log_info_hexdump(hci_packet, hci_packet_size);
319bd021c4eSMatthias Ringwald 
320bd021c4eSMatthias Ringwald     uint8_t header[4];
321bd021c4eSMatthias Ringwald     hci_transport_link_calc_header(header, link_seq_nr, link_ack_nr, 0, 1, hci_packet_type, hci_packet_size);
322bd021c4eSMatthias Ringwald     hci_transport_slip_send_frame(header, hci_packet, hci_packet_size);
32394764e99SMatthias Ringwald 
32494764e99SMatthias Ringwald     // reset inactvitiy timer
32594764e99SMatthias Ringwald     hci_transport_inactivity_timer_set();
326bd021c4eSMatthias Ringwald }
327bd021c4eSMatthias Ringwald 
328bd021c4eSMatthias Ringwald static void hci_transport_link_send_ack_packet(void){
329bd021c4eSMatthias Ringwald     log_info("link: send ack %u", link_ack_nr);
330bd021c4eSMatthias Ringwald     uint8_t header[4];
331bd021c4eSMatthias Ringwald     hci_transport_link_calc_header(header, 0, link_ack_nr, 0, 0, LINK_ACKNOWLEDGEMENT_TYPE, 0);
332bd021c4eSMatthias Ringwald     hci_transport_slip_send_frame(header, NULL, 0);
333bd021c4eSMatthias Ringwald }
334bd021c4eSMatthias Ringwald 
335bd021c4eSMatthias Ringwald static void hci_transport_link_run(void){
336bd021c4eSMatthias Ringwald     // exit if outgoing active
3376ae10533SMatthias Ringwald     if (slip_write_active) return;
338bd021c4eSMatthias Ringwald 
339bd021c4eSMatthias Ringwald     // process queued requests
340bd021c4eSMatthias Ringwald     if (hci_transport_link_actions & HCI_TRANSPORT_LINK_SEND_SYNC){
341bd021c4eSMatthias Ringwald         hci_transport_link_actions &= ~HCI_TRANSPORT_LINK_SEND_SYNC;
342bd021c4eSMatthias Ringwald         hci_transport_link_send_sync();
343bd021c4eSMatthias Ringwald         return;
344bd021c4eSMatthias Ringwald     }
345bd021c4eSMatthias Ringwald     if (hci_transport_link_actions & HCI_TRANSPORT_LINK_SEND_SYNC_RESPONSE){
346bd021c4eSMatthias Ringwald         hci_transport_link_actions &= ~HCI_TRANSPORT_LINK_SEND_SYNC_RESPONSE;
347bd021c4eSMatthias Ringwald         hci_transport_link_send_sync_response();
348bd021c4eSMatthias Ringwald         return;
349bd021c4eSMatthias Ringwald     }
350bd021c4eSMatthias Ringwald     if (hci_transport_link_actions & HCI_TRANSPORT_LINK_SEND_CONFIG){
351bd021c4eSMatthias Ringwald         hci_transport_link_actions &= ~HCI_TRANSPORT_LINK_SEND_CONFIG;
352bd021c4eSMatthias Ringwald         hci_transport_link_send_config();
353bd021c4eSMatthias Ringwald         return;
354bd021c4eSMatthias Ringwald     }
355bd021c4eSMatthias Ringwald     if (hci_transport_link_actions & HCI_TRANSPORT_LINK_SEND_CONFIG_RESPONSE){
356bd021c4eSMatthias Ringwald         hci_transport_link_actions &= ~HCI_TRANSPORT_LINK_SEND_CONFIG_RESPONSE;
357bd021c4eSMatthias Ringwald         hci_transport_link_send_config_response();
358bd021c4eSMatthias Ringwald         return;
359bd021c4eSMatthias Ringwald     }
360bd021c4eSMatthias Ringwald     if (hci_transport_link_actions & HCI_TRANSPORT_LINK_SEND_WOKEN){
361bd021c4eSMatthias Ringwald         hci_transport_link_actions &= ~HCI_TRANSPORT_LINK_SEND_WOKEN;
362bd021c4eSMatthias Ringwald         hci_transport_link_send_woken();
363bd021c4eSMatthias Ringwald         return;
364bd021c4eSMatthias Ringwald     }
365bd021c4eSMatthias Ringwald     if (hci_transport_link_actions & HCI_TRANSPORT_LINK_SEND_WAKEUP){
366bd021c4eSMatthias Ringwald         hci_transport_link_actions &= ~HCI_TRANSPORT_LINK_SEND_WAKEUP;
367bd021c4eSMatthias Ringwald         hci_transport_link_send_wakeup();
368bd021c4eSMatthias Ringwald         return;
369bd021c4eSMatthias Ringwald     }
370bd021c4eSMatthias Ringwald     if (hci_transport_link_actions & HCI_TRANSPORT_LINK_SEND_QUEUED_PACKET){
371bd021c4eSMatthias Ringwald         hci_transport_link_actions &= ~HCI_TRANSPORT_LINK_SEND_QUEUED_PACKET;
372bd021c4eSMatthias Ringwald         // packet already contains ack, no need to send addtitional one
373bd021c4eSMatthias Ringwald         hci_transport_link_actions &= ~HCI_TRANSPORT_LINK_SEND_ACK_PACKET;
374bd021c4eSMatthias Ringwald         hci_transport_link_send_queued_packet();
375bd021c4eSMatthias Ringwald         return;
376bd021c4eSMatthias Ringwald     }
377bd021c4eSMatthias Ringwald     if (hci_transport_link_actions & HCI_TRANSPORT_LINK_SEND_ACK_PACKET){
378bd021c4eSMatthias Ringwald         hci_transport_link_actions &= ~HCI_TRANSPORT_LINK_SEND_ACK_PACKET;
379bd021c4eSMatthias Ringwald         hci_transport_link_send_ack_packet();
380bd021c4eSMatthias Ringwald         return;
381bd021c4eSMatthias Ringwald     }
38294764e99SMatthias Ringwald     if (hci_transport_link_actions & HCI_TRANSPORT_LINK_SEND_SLEEP){
38394764e99SMatthias Ringwald         hci_transport_link_actions &= ~HCI_TRANSPORT_LINK_SEND_SLEEP;
38494764e99SMatthias Ringwald         hci_transport_link_actions |=  HCI_TRANSPORT_LINK_ENTER_SLEEP;
38594764e99SMatthias Ringwald         link_peer_asleep = 1;
38694764e99SMatthias Ringwald         hci_transport_link_send_sleep();
38794764e99SMatthias Ringwald         return;
38894764e99SMatthias Ringwald     }
389bd021c4eSMatthias Ringwald }
390bd021c4eSMatthias Ringwald 
391bd021c4eSMatthias Ringwald static void hci_transport_link_set_timer(uint16_t timeout_ms){
392bd021c4eSMatthias Ringwald     btstack_run_loop_set_timer_handler(&link_timer, &hci_transport_link_timeout_handler);
393bd021c4eSMatthias Ringwald     btstack_run_loop_set_timer(&link_timer, timeout_ms);
394bd021c4eSMatthias Ringwald     btstack_run_loop_add_timer(&link_timer);
395bd021c4eSMatthias Ringwald }
396bd021c4eSMatthias Ringwald 
397bd021c4eSMatthias Ringwald static void hci_transport_link_timeout_handler(btstack_timer_source_t * timer){
398bd021c4eSMatthias Ringwald     switch (link_state){
399bd021c4eSMatthias Ringwald         case LINK_UNINITIALIZED:
400bd021c4eSMatthias Ringwald             hci_transport_link_actions |= HCI_TRANSPORT_LINK_SEND_SYNC;
401bd021c4eSMatthias Ringwald             hci_transport_link_set_timer(LINK_PERIOD_MS);
402bd021c4eSMatthias Ringwald             break;
403bd021c4eSMatthias Ringwald         case LINK_INITIALIZED:
404bd021c4eSMatthias Ringwald             hci_transport_link_actions |= HCI_TRANSPORT_LINK_SEND_CONFIG;
405bd021c4eSMatthias Ringwald             hci_transport_link_set_timer(LINK_PERIOD_MS);
406bd021c4eSMatthias Ringwald             break;
407bd021c4eSMatthias Ringwald         case LINK_ACTIVE:
408bd021c4eSMatthias Ringwald             if (!hci_transport_link_have_outgoing_packet()){
409bd021c4eSMatthias Ringwald                 log_info("h5 timeout while active, but no outgoing packet");
410bd021c4eSMatthias Ringwald                 return;
411bd021c4eSMatthias Ringwald             }
412bd021c4eSMatthias Ringwald             if (link_peer_asleep){
413bd021c4eSMatthias Ringwald                 hci_transport_link_actions |= HCI_TRANSPORT_LINK_SEND_WAKEUP;
414bd021c4eSMatthias Ringwald                 hci_transport_link_set_timer(LINK_WAKEUP_MS);
415bd021c4eSMatthias Ringwald                 return;
416bd021c4eSMatthias Ringwald             }
417bd021c4eSMatthias Ringwald             // resend packet
418bd021c4eSMatthias Ringwald             hci_transport_link_actions |= HCI_TRANSPORT_LINK_SEND_QUEUED_PACKET;
419bd021c4eSMatthias Ringwald             hci_transport_link_set_timer(link_resend_timeout_ms);
420bd021c4eSMatthias Ringwald             break;
421bd021c4eSMatthias Ringwald         default:
422bd021c4eSMatthias Ringwald             break;
423bd021c4eSMatthias Ringwald     }
424bd021c4eSMatthias Ringwald 
425bd021c4eSMatthias Ringwald     hci_transport_link_run();
426bd021c4eSMatthias Ringwald }
427bd021c4eSMatthias Ringwald 
428bd021c4eSMatthias Ringwald static void hci_transport_link_init(void){
429bd021c4eSMatthias Ringwald     link_state = LINK_UNINITIALIZED;
430bd021c4eSMatthias Ringwald     link_peer_asleep = 0;
431bd021c4eSMatthias Ringwald 
432bd021c4eSMatthias Ringwald     // get started
433bd021c4eSMatthias Ringwald     hci_transport_link_actions |= HCI_TRANSPORT_LINK_SEND_SYNC;
434bd021c4eSMatthias Ringwald     hci_transport_link_set_timer(LINK_PERIOD_MS);
435bd021c4eSMatthias Ringwald     hci_transport_link_run();
436bd021c4eSMatthias Ringwald }
437bd021c4eSMatthias Ringwald 
438bd021c4eSMatthias Ringwald static int hci_transport_link_inc_seq_nr(int seq_nr){
439bd021c4eSMatthias Ringwald     return (seq_nr + 1) & 0x07;
440bd021c4eSMatthias Ringwald }
441bd021c4eSMatthias Ringwald 
442bd021c4eSMatthias Ringwald static int hci_transport_link_have_outgoing_packet(void){
443bd021c4eSMatthias Ringwald     return hci_packet != 0;
444bd021c4eSMatthias Ringwald }
445bd021c4eSMatthias Ringwald 
446bd021c4eSMatthias Ringwald static void hci_transport_link_clear_queue(void){
447bd021c4eSMatthias Ringwald     btstack_run_loop_remove_timer(&link_timer);
448bd021c4eSMatthias Ringwald     hci_packet = NULL;
449bd021c4eSMatthias Ringwald }
450bd021c4eSMatthias Ringwald 
451bd021c4eSMatthias Ringwald static void hci_transport_h5_queue_packet(uint8_t packet_type, uint8_t *packet, int size){
452bd021c4eSMatthias Ringwald     hci_packet = packet;
453bd021c4eSMatthias Ringwald     hci_packet_type = packet_type;
454bd021c4eSMatthias Ringwald     hci_packet_size = size;
455bd021c4eSMatthias Ringwald }
456bd021c4eSMatthias Ringwald 
457bd021c4eSMatthias Ringwald static void hci_transport_h5_process_frame(uint16_t frame_size){
458bd021c4eSMatthias Ringwald 
459bd021c4eSMatthias Ringwald     if (frame_size < 4) return;
460bd021c4eSMatthias Ringwald 
461bd021c4eSMatthias Ringwald     uint8_t * slip_header  = &hci_packet_with_pre_buffer[HCI_INCOMING_PRE_BUFFER_SIZE];
462bd021c4eSMatthias Ringwald     uint8_t * slip_payload = &hci_packet_with_pre_buffer[HCI_INCOMING_PRE_BUFFER_SIZE + 4];
463bd021c4eSMatthias Ringwald     int       frame_size_without_header = frame_size - 4;
464bd021c4eSMatthias Ringwald 
465f04a0c31SMatthias Ringwald     uint8_t  seq_nr =  slip_header[0] & 0x07;
466f04a0c31SMatthias Ringwald     uint8_t  ack_nr = (slip_header[0] >> 3)    & 0x07;
467f04a0c31SMatthias Ringwald     uint8_t  data_integrity_check_present = (slip_header[0] & 0x40) != 0;
468f04a0c31SMatthias Ringwald     uint8_t  reliable_packet  = (slip_header[0] & 0x80) != 0;
469bd021c4eSMatthias Ringwald     uint8_t  link_packet_type = slip_header[1] & 0x0f;
470bd021c4eSMatthias Ringwald     uint16_t link_payload_len = (slip_header[1] >> 4) | (slip_header[2] << 4);
471bd021c4eSMatthias Ringwald 
472*79b61987SMatthias 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);
473bd021c4eSMatthias Ringwald     log_info_hexdump(slip_header, 4);
474bd021c4eSMatthias Ringwald     log_info_hexdump(slip_payload, frame_size_without_header);
475bd021c4eSMatthias Ringwald 
476bd021c4eSMatthias Ringwald     // CSR 8811 does not seem to auto-detect H5 mode and sends data with even parity.
477bd021c4eSMatthias Ringwald     // if this byte sequence is detected, just enable even parity
478bd021c4eSMatthias Ringwald     const uint8_t sync_response_bcsp[] = {0x01, 0x7a, 0x06, 0x10};
479bd021c4eSMatthias Ringwald     if (memcmp(sync_response_bcsp, slip_header, 4) == 0){
480bd021c4eSMatthias Ringwald         log_info("h5: detected BSCP SYNC sent with Even Parity -> discard frame and enable Even Parity");
481bd021c4eSMatthias Ringwald         btstack_uart->set_parity(1);
482bd021c4eSMatthias Ringwald         return;
483bd021c4eSMatthias Ringwald     }
484bd021c4eSMatthias Ringwald 
485bd021c4eSMatthias Ringwald     // validate header checksum
486bd021c4eSMatthias Ringwald     uint8_t header_checksum = slip_header[0] + slip_header[1] + slip_header[2] + slip_header[3];
487bd021c4eSMatthias Ringwald     if (header_checksum != 0xff){
488bd021c4eSMatthias Ringwald         log_info("h5: header checksum 0x%02x (instead of 0xff)", header_checksum);
489bd021c4eSMatthias Ringwald         return;
490bd021c4eSMatthias Ringwald     }
491bd021c4eSMatthias Ringwald 
492bd021c4eSMatthias Ringwald     // validate payload length
493bd021c4eSMatthias Ringwald     int data_integrity_len = data_integrity_check_present ? 2 : 0;
494bd021c4eSMatthias Ringwald     uint16_t received_payload_len = frame_size_without_header - data_integrity_len;
495bd021c4eSMatthias Ringwald     if (link_payload_len != received_payload_len){
496bd021c4eSMatthias Ringwald         log_info("h5: expected payload len %u but got %u", link_payload_len, received_payload_len);
497bd021c4eSMatthias Ringwald         return;
498bd021c4eSMatthias Ringwald     }
499bd021c4eSMatthias Ringwald 
500*79b61987SMatthias Ringwald     // validate data integrity check
501*79b61987SMatthias Ringwald     if (data_integrity_check_present){
502*79b61987SMatthias Ringwald         uint16_t dic_packet = big_endian_read_16(slip_payload, received_payload_len);
503*79b61987SMatthias Ringwald         uint16_t dic_calculate = crc16_calc_for_slip_frame(slip_header, slip_payload, received_payload_len);
504*79b61987SMatthias Ringwald         if (dic_packet != dic_calculate){
505*79b61987SMatthias Ringwald             log_info("h5: expected dic value 0x%04x but got 0x%04x", dic_calculate, dic_packet);
506*79b61987SMatthias Ringwald             return;
507*79b61987SMatthias Ringwald         }
508*79b61987SMatthias Ringwald     }
509bd021c4eSMatthias Ringwald 
510bd021c4eSMatthias Ringwald     switch (link_state){
511bd021c4eSMatthias Ringwald         case LINK_UNINITIALIZED:
512bd021c4eSMatthias Ringwald             if (link_packet_type != LINK_CONTROL_PACKET_TYPE) break;
513bd021c4eSMatthias Ringwald             if (memcmp(slip_payload, link_control_sync, sizeof(link_control_sync)) == 0){
514bd021c4eSMatthias Ringwald                 log_info("link: received sync");
515bd021c4eSMatthias Ringwald                 hci_transport_link_actions |= HCI_TRANSPORT_LINK_SEND_SYNC_RESPONSE;
516bd021c4eSMatthias Ringwald             }
517bd021c4eSMatthias Ringwald             if (memcmp(slip_payload, link_control_sync_response, sizeof(link_control_sync_response)) == 0){
518bd021c4eSMatthias Ringwald                 log_info("link: received sync response");
519bd021c4eSMatthias Ringwald                 link_state = LINK_INITIALIZED;
520bd021c4eSMatthias Ringwald                 btstack_run_loop_remove_timer(&link_timer);
521bd021c4eSMatthias Ringwald                 log_info("link initialized");
522bd021c4eSMatthias Ringwald                 //
523bd021c4eSMatthias Ringwald                 hci_transport_link_actions |= HCI_TRANSPORT_LINK_SEND_CONFIG;
524bd021c4eSMatthias Ringwald                 hci_transport_link_set_timer(LINK_PERIOD_MS);
525bd021c4eSMatthias Ringwald             }
526bd021c4eSMatthias Ringwald             break;
527bd021c4eSMatthias Ringwald         case LINK_INITIALIZED:
528bd021c4eSMatthias Ringwald             if (link_packet_type != LINK_CONTROL_PACKET_TYPE) break;
529bd021c4eSMatthias Ringwald             if (memcmp(slip_payload, link_control_sync, sizeof(link_control_sync)) == 0){
530bd021c4eSMatthias Ringwald                 log_info("link: received sync");
531bd021c4eSMatthias Ringwald                 hci_transport_link_actions |= HCI_TRANSPORT_LINK_SEND_SYNC_RESPONSE;
532bd021c4eSMatthias Ringwald             }
533cbc04f48SMatthias Ringwald             if (memcmp(slip_payload, link_control_config, link_control_config_prefix_len) == 0){
534*79b61987SMatthias Ringwald                 log_info("link: received config, 0x%02x", slip_payload[2]);
535bd021c4eSMatthias Ringwald                 hci_transport_link_actions |= HCI_TRANSPORT_LINK_SEND_CONFIG_RESPONSE;
536bd021c4eSMatthias Ringwald             }
537bd021c4eSMatthias Ringwald             if (memcmp(slip_payload, link_control_config_response, link_control_config_response_prefix_len) == 0){
538*79b61987SMatthias Ringwald                 log_info("link: received config response 0x%02x", slip_payload[2]);
539bd021c4eSMatthias Ringwald                 link_state = LINK_ACTIVE;
540bd021c4eSMatthias Ringwald                 btstack_run_loop_remove_timer(&link_timer);
541bd021c4eSMatthias Ringwald                 log_info("link activated");
542bd021c4eSMatthias Ringwald                 //
543bd021c4eSMatthias Ringwald                 link_seq_nr = 0;
544bd021c4eSMatthias Ringwald                 link_ack_nr = 0;
545bd021c4eSMatthias Ringwald                 // notify upper stack that it can start
546bd021c4eSMatthias Ringwald                 uint8_t event[] = { HCI_EVENT_TRANSPORT_PACKET_SENT, 0};
547bd021c4eSMatthias Ringwald                 packet_handler(HCI_EVENT_PACKET, &event[0], sizeof(event));
548bd021c4eSMatthias Ringwald             }
549bd021c4eSMatthias Ringwald             break;
550bd021c4eSMatthias Ringwald         case LINK_ACTIVE:
551bd021c4eSMatthias Ringwald 
552bd021c4eSMatthias Ringwald             // validate packet sequence nr in reliable packets (check for out of sequence error)
553bd021c4eSMatthias Ringwald             if (reliable_packet){
554bd021c4eSMatthias Ringwald                 if (seq_nr != link_ack_nr){
555bd021c4eSMatthias Ringwald                     log_info("expected seq nr %u, but received %u", link_ack_nr, seq_nr);
556bd021c4eSMatthias Ringwald                     hci_transport_link_actions |= HCI_TRANSPORT_LINK_SEND_ACK_PACKET;
557bd021c4eSMatthias Ringwald                     break;
558bd021c4eSMatthias Ringwald                 }
559bd021c4eSMatthias Ringwald                 // ack packet right away
560bd021c4eSMatthias Ringwald                 link_ack_nr = hci_transport_link_inc_seq_nr(link_ack_nr);
561bd021c4eSMatthias Ringwald                 hci_transport_link_actions |= HCI_TRANSPORT_LINK_SEND_ACK_PACKET;
562bd021c4eSMatthias Ringwald             }
563bd021c4eSMatthias Ringwald 
564bd021c4eSMatthias Ringwald             // Process ACKs in reliable packet and explicit ack packets
565bd021c4eSMatthias Ringwald             if (reliable_packet || link_packet_type == LINK_ACKNOWLEDGEMENT_TYPE){
566bd021c4eSMatthias Ringwald                 // our packet is good if the remote expects our seq nr + 1
567bd021c4eSMatthias Ringwald                 int next_seq_nr = hci_transport_link_inc_seq_nr(link_seq_nr);
568bd021c4eSMatthias Ringwald                 if (hci_transport_link_have_outgoing_packet() && next_seq_nr == ack_nr){
569bd021c4eSMatthias Ringwald                     log_info("h5: outoing packet with seq %u ack'ed", link_seq_nr);
570bd021c4eSMatthias Ringwald                     link_seq_nr = next_seq_nr;
571bd021c4eSMatthias Ringwald                     hci_transport_link_clear_queue();
572bd021c4eSMatthias Ringwald 
573bd021c4eSMatthias Ringwald                     // notify upper stack that it can send again
574bd021c4eSMatthias Ringwald                     uint8_t event[] = { HCI_EVENT_TRANSPORT_PACKET_SENT, 0};
575bd021c4eSMatthias Ringwald                     packet_handler(HCI_EVENT_PACKET, &event[0], sizeof(event));
576bd021c4eSMatthias Ringwald                 }
577bd021c4eSMatthias Ringwald             }
578bd021c4eSMatthias Ringwald 
579bd021c4eSMatthias Ringwald             switch (link_packet_type){
580bd021c4eSMatthias Ringwald                 case LINK_CONTROL_PACKET_TYPE:
581bd021c4eSMatthias Ringwald                     if (memcmp(slip_payload, link_control_config, sizeof(link_control_config)) == 0){
582bd021c4eSMatthias Ringwald                         log_info("link: received config");
583bd021c4eSMatthias Ringwald                         hci_transport_link_actions |= HCI_TRANSPORT_LINK_SEND_CONFIG_RESPONSE;
584bd021c4eSMatthias Ringwald                         break;
585bd021c4eSMatthias Ringwald                     }
586bd021c4eSMatthias Ringwald                     if (memcmp(slip_payload, link_control_sync, sizeof(link_control_sync)) == 0){
587bd021c4eSMatthias Ringwald                         log_info("link: received sync in ACTIVE STATE!");
588bd021c4eSMatthias Ringwald                         // TODO sync during active indicates peer reset -> full upper layer reset necessary
589bd021c4eSMatthias Ringwald                         break;
590bd021c4eSMatthias Ringwald                     }
591bd021c4eSMatthias Ringwald                     if (memcmp(slip_payload, link_control_sleep, sizeof(link_control_sleep)) == 0){
592d8e28fa3SMatthias Ringwald                         if (btstack_uart_sleep_mode){
593d8e28fa3SMatthias Ringwald                             log_info("link: received sleep message. Enabling UART Sleep.");
594d8e28fa3SMatthias Ringwald                             btstack_uart->set_sleep(btstack_uart_sleep_mode);
595d8e28fa3SMatthias Ringwald                         } else {
596d8e28fa3SMatthias Ringwald                             log_info("link: received sleep message. UART Sleep not supported");
597d8e28fa3SMatthias Ringwald                         }
598bd021c4eSMatthias Ringwald                         link_peer_asleep = 1;
599bd021c4eSMatthias Ringwald                         break;
600bd021c4eSMatthias Ringwald                     }
601bd021c4eSMatthias Ringwald                     if (memcmp(slip_payload, link_control_wakeup, sizeof(link_control_wakeup)) == 0){
602bd021c4eSMatthias Ringwald                         log_info("link: received wakupe message -> send woken");
603bd021c4eSMatthias Ringwald                         link_peer_asleep = 0;
604bd021c4eSMatthias Ringwald                         hci_transport_link_actions |= HCI_TRANSPORT_LINK_SEND_WOKEN;
605bd021c4eSMatthias Ringwald                         break;
606bd021c4eSMatthias Ringwald                     }
607bd021c4eSMatthias Ringwald                     if (memcmp(slip_payload, link_control_woken, sizeof(link_control_woken)) == 0){
608bd021c4eSMatthias Ringwald                         log_info("link: received woken message");
609bd021c4eSMatthias Ringwald                         link_peer_asleep = 0;
61094764e99SMatthias Ringwald                         // queued packet will be sent in hci_transport_link_run if needed
611bd021c4eSMatthias Ringwald                         break;
612bd021c4eSMatthias Ringwald                     }
613bd021c4eSMatthias Ringwald                     break;
614bd021c4eSMatthias Ringwald                 case HCI_EVENT_PACKET:
615bd021c4eSMatthias Ringwald                 case HCI_ACL_DATA_PACKET:
616bd021c4eSMatthias Ringwald                 case HCI_SCO_DATA_PACKET:
61794764e99SMatthias Ringwald                     // seems like peer is awake
61894764e99SMatthias Ringwald                     link_peer_asleep = 0;
61994764e99SMatthias Ringwald                     // forward packet to stack
620bd021c4eSMatthias Ringwald                     packet_handler(link_packet_type, slip_payload, link_payload_len);
62194764e99SMatthias Ringwald                     // reset inactvitiy timer
62294764e99SMatthias Ringwald                     hci_transport_inactivity_timer_set();
623bd021c4eSMatthias Ringwald                     break;
624bd021c4eSMatthias Ringwald             }
625bd021c4eSMatthias Ringwald 
626bd021c4eSMatthias Ringwald             break;
627bd021c4eSMatthias Ringwald         default:
628bd021c4eSMatthias Ringwald             break;
629bd021c4eSMatthias Ringwald     }
630bd021c4eSMatthias Ringwald 
631bd021c4eSMatthias Ringwald     hci_transport_link_run();
632bd021c4eSMatthias Ringwald }
633bd021c4eSMatthias Ringwald 
634bd021c4eSMatthias Ringwald // recommendet time until resend: 3 * time of largest packet
635bd021c4eSMatthias Ringwald static uint16_t hci_transport_link_calc_resend_timeout(uint32_t baudrate){
636bd021c4eSMatthias Ringwald     uint32_t max_packet_size_in_bit = (HCI_PACKET_BUFFER_SIZE + 6) << 3;
637bd021c4eSMatthias Ringwald     uint32_t t_max_x3_ms = max_packet_size_in_bit * 3000 / baudrate;
638bd021c4eSMatthias Ringwald     log_info("resend timeout for %u baud: %u ms", baudrate, t_max_x3_ms);
639bd021c4eSMatthias Ringwald     return t_max_x3_ms;
640bd021c4eSMatthias Ringwald }
641bd021c4eSMatthias Ringwald 
642bd021c4eSMatthias Ringwald static void hci_transport_link_update_resend_timeout(uint32_t baudrate){
643bd021c4eSMatthias Ringwald     link_resend_timeout_ms = hci_transport_link_calc_resend_timeout(baudrate);
644bd021c4eSMatthias Ringwald }
645bd021c4eSMatthias Ringwald 
646bd021c4eSMatthias Ringwald /// H5 Interface
647bd021c4eSMatthias Ringwald 
648bd021c4eSMatthias Ringwald static uint8_t hci_transport_link_read_byte;
649bd021c4eSMatthias Ringwald 
650bd021c4eSMatthias Ringwald static void hci_transport_h5_read_next_byte(void){
651cbc04f48SMatthias Ringwald     log_debug("h5: rx nxt");
652bd021c4eSMatthias Ringwald     btstack_uart->receive_block(&hci_transport_link_read_byte, 1);
653bd021c4eSMatthias Ringwald }
654bd021c4eSMatthias Ringwald 
655bd021c4eSMatthias Ringwald static void hci_transport_h5_block_received(){
656cbc04f48SMatthias Ringwald     log_debug("slip: process 0x%02x", hci_transport_link_read_byte);
657bd021c4eSMatthias Ringwald     btstack_slip_decoder_process(hci_transport_link_read_byte);
658bd021c4eSMatthias Ringwald     uint16_t frame_size = btstack_slip_decoder_frame_size();
659bd021c4eSMatthias Ringwald     if (frame_size) {
660bd021c4eSMatthias Ringwald         hci_transport_h5_process_frame(frame_size);
661bd021c4eSMatthias Ringwald         hci_transport_slip_init();
662bd021c4eSMatthias Ringwald     }
663bd021c4eSMatthias Ringwald     hci_transport_h5_read_next_byte();
664bd021c4eSMatthias Ringwald }
665bd021c4eSMatthias Ringwald 
666bd021c4eSMatthias Ringwald static void hci_transport_h5_block_sent(void){
6676ae10533SMatthias Ringwald 
6686ae10533SMatthias Ringwald     // check if more data to send
6696ae10533SMatthias Ringwald     if (btstack_slip_encoder_has_data()){
6706ae10533SMatthias Ringwald         hci_transport_slip_send_next_chunk();
6716ae10533SMatthias Ringwald         return;
6726ae10533SMatthias Ringwald     }
6736ae10533SMatthias Ringwald 
6746ae10533SMatthias Ringwald     // done
6756ae10533SMatthias Ringwald     slip_write_active = 0;
67694764e99SMatthias Ringwald 
67794764e99SMatthias Ringwald     // enter sleep mode after sending sleep message
67894764e99SMatthias Ringwald     if (hci_transport_link_actions & HCI_TRANSPORT_LINK_ENTER_SLEEP){
67994764e99SMatthias Ringwald         hci_transport_link_actions &= ~HCI_TRANSPORT_LINK_ENTER_SLEEP;
68094764e99SMatthias Ringwald         if (btstack_uart_sleep_mode){
68194764e99SMatthias Ringwald             log_info("link: sent sleep message. Enabling UART Sleep.");
68294764e99SMatthias Ringwald             btstack_uart->set_sleep(btstack_uart_sleep_mode);
68394764e99SMatthias Ringwald         } else {
68494764e99SMatthias Ringwald             log_info("link: sent sleep message. UART Sleep not supported");
68594764e99SMatthias Ringwald         }
68694764e99SMatthias Ringwald     }
68794764e99SMatthias Ringwald 
688bd021c4eSMatthias Ringwald     hci_transport_link_run();
689bd021c4eSMatthias Ringwald }
690bd021c4eSMatthias Ringwald 
691bd021c4eSMatthias Ringwald static void hci_transport_h5_init(const void * transport_config){
692bd021c4eSMatthias Ringwald     // check for hci_transport_config_uart_t
693bd021c4eSMatthias Ringwald     if (!transport_config) {
694bd021c4eSMatthias Ringwald         log_error("hci_transport_h5: no config!");
695bd021c4eSMatthias Ringwald         return;
696bd021c4eSMatthias Ringwald     }
697bd021c4eSMatthias Ringwald     if (((hci_transport_config_t*)transport_config)->type != HCI_TRANSPORT_CONFIG_UART) {
698bd021c4eSMatthias Ringwald         log_error("hci_transport_h5: config not of type != HCI_TRANSPORT_CONFIG_UART!");
699bd021c4eSMatthias Ringwald         return;
700bd021c4eSMatthias Ringwald     }
701bd021c4eSMatthias Ringwald 
702bd021c4eSMatthias Ringwald     // extract UART config from transport config
703bd021c4eSMatthias Ringwald     hci_transport_config_uart_t * hci_transport_config_uart = (hci_transport_config_uart_t*) transport_config;
704bd021c4eSMatthias Ringwald     uart_config.baudrate    = hci_transport_config_uart->baudrate_init;
705bd021c4eSMatthias Ringwald     uart_config.flowcontrol = hci_transport_config_uart->flowcontrol;
706bd021c4eSMatthias Ringwald     uart_config.device_name = hci_transport_config_uart->device_name;
707bd021c4eSMatthias Ringwald 
708bd021c4eSMatthias Ringwald     // setup UART driver
709bd021c4eSMatthias Ringwald     btstack_uart->init(&uart_config);
710bd021c4eSMatthias Ringwald     btstack_uart->set_block_received(&hci_transport_h5_block_received);
711bd021c4eSMatthias Ringwald     btstack_uart->set_block_sent(&hci_transport_h5_block_sent);
712bd021c4eSMatthias Ringwald }
713bd021c4eSMatthias Ringwald 
714bd021c4eSMatthias Ringwald static int hci_transport_h5_open(void){
715bd021c4eSMatthias Ringwald     int res = btstack_uart->open();
716bd021c4eSMatthias Ringwald     if (res){
717bd021c4eSMatthias Ringwald         return res;
718bd021c4eSMatthias Ringwald     }
719bd021c4eSMatthias Ringwald 
720d8e28fa3SMatthias Ringwald     // check if wake on RX can be used
721d8e28fa3SMatthias Ringwald     btstack_uart_sleep_mode = BTSTACK_UART_SLEEP_OFF;
722d8e28fa3SMatthias Ringwald     int supported_sleep_modes = 0;
723d8e28fa3SMatthias Ringwald     if (btstack_uart->get_supported_sleep_modes){
724d8e28fa3SMatthias Ringwald         supported_sleep_modes = btstack_uart->get_supported_sleep_modes();
725d8e28fa3SMatthias Ringwald     }
726d8e28fa3SMatthias Ringwald     if (supported_sleep_modes & BTSTACK_UART_SLEEP_MASK_RTS_LOW_WAKE_ON_RX_EDGE){
727d8e28fa3SMatthias Ringwald         log_info("H5: using wake on RX");
728d8e28fa3SMatthias Ringwald         btstack_uart_sleep_mode = BTSTACK_UART_SLEEP_RTS_LOW_WAKE_ON_RX_EDGE;
729d8e28fa3SMatthias Ringwald     } else {
730d8e28fa3SMatthias Ringwald         log_info("H5: UART driver does not provide compatible sleep mode");
731d8e28fa3SMatthias Ringwald     }
732d8e28fa3SMatthias Ringwald 
733bd021c4eSMatthias Ringwald     // setup resend timeout
734bd021c4eSMatthias Ringwald     hci_transport_link_update_resend_timeout(uart_config.baudrate);
735bd021c4eSMatthias Ringwald 
736bd021c4eSMatthias Ringwald     // init slip parser state machine
737bd021c4eSMatthias Ringwald     hci_transport_slip_init();
738bd021c4eSMatthias Ringwald 
739bd021c4eSMatthias Ringwald     // init link management - already starts syncing
740bd021c4eSMatthias Ringwald     hci_transport_link_init();
741bd021c4eSMatthias Ringwald 
742bd021c4eSMatthias Ringwald     // start receiving
743bd021c4eSMatthias Ringwald     hci_transport_h5_read_next_byte();
744bd021c4eSMatthias Ringwald 
745bd021c4eSMatthias Ringwald     return 0;
746bd021c4eSMatthias Ringwald }
747bd021c4eSMatthias Ringwald 
748bd021c4eSMatthias Ringwald static int hci_transport_h5_close(void){
749bd021c4eSMatthias Ringwald     return btstack_uart->close();
750bd021c4eSMatthias Ringwald     return 0;
751bd021c4eSMatthias Ringwald }
752bd021c4eSMatthias Ringwald 
753bd021c4eSMatthias Ringwald static void hci_transport_h5_register_packet_handler(void (*handler)(uint8_t packet_type, uint8_t *packet, uint16_t size)){
754bd021c4eSMatthias Ringwald     packet_handler = handler;
755bd021c4eSMatthias Ringwald }
756bd021c4eSMatthias Ringwald 
757bd021c4eSMatthias Ringwald static int hci_transport_h5_can_send_packet_now(uint8_t packet_type){
75894764e99SMatthias Ringwald     int res = !hci_transport_link_have_outgoing_packet() && link_state == LINK_ACTIVE;
7596ae10533SMatthias Ringwald     // log_info("hci_transport_h5_can_send_packet_now: %u", res);
76094764e99SMatthias Ringwald     return res;
761bd021c4eSMatthias Ringwald }
762bd021c4eSMatthias Ringwald 
763bd021c4eSMatthias Ringwald static int hci_transport_h5_send_packet(uint8_t packet_type, uint8_t *packet, int size){
764bd021c4eSMatthias Ringwald     if (!hci_transport_h5_can_send_packet_now(packet_type)){
765f04a0c31SMatthias Ringwald         log_error("hci_transport_h5_send_packet called but in state %d", link_state);
766bd021c4eSMatthias Ringwald         return -1;
767bd021c4eSMatthias Ringwald     }
768bd021c4eSMatthias Ringwald 
769bd021c4eSMatthias Ringwald     // store request
770bd021c4eSMatthias Ringwald     hci_transport_h5_queue_packet(packet_type, packet, size);
771bd021c4eSMatthias Ringwald 
772bd021c4eSMatthias Ringwald     // send wakeup first
773bd021c4eSMatthias Ringwald     if (link_peer_asleep){
774d8e28fa3SMatthias Ringwald         if (btstack_uart_sleep_mode){
775d8e28fa3SMatthias Ringwald             log_info("h5: disable UART sleep");
776d8e28fa3SMatthias Ringwald             btstack_uart->set_sleep(BTSTACK_UART_SLEEP_OFF);
777d8e28fa3SMatthias Ringwald         }
778bd021c4eSMatthias Ringwald         hci_transport_link_actions |= HCI_TRANSPORT_LINK_SEND_WAKEUP;
779bd021c4eSMatthias Ringwald         hci_transport_link_set_timer(LINK_WAKEUP_MS);
780bd021c4eSMatthias Ringwald     } else {
781bd021c4eSMatthias Ringwald         hci_transport_link_actions |= HCI_TRANSPORT_LINK_SEND_QUEUED_PACKET;
782bd021c4eSMatthias Ringwald         hci_transport_link_set_timer(link_resend_timeout_ms);
783bd021c4eSMatthias Ringwald     }
784bd021c4eSMatthias Ringwald     hci_transport_link_run();
785bd021c4eSMatthias Ringwald     return 0;
786bd021c4eSMatthias Ringwald }
787bd021c4eSMatthias Ringwald 
788bd021c4eSMatthias Ringwald static int hci_transport_h5_set_baudrate(uint32_t baudrate){
789bd021c4eSMatthias Ringwald 
790bd021c4eSMatthias Ringwald     log_info("hci_transport_h5_set_baudrate %u", baudrate);
791bd021c4eSMatthias Ringwald     int res = btstack_uart->set_baudrate(baudrate);
792bd021c4eSMatthias Ringwald 
793bd021c4eSMatthias Ringwald     if (res) return res;
794bd021c4eSMatthias Ringwald     hci_transport_link_update_resend_timeout(baudrate);
795bd021c4eSMatthias Ringwald     return 0;
796bd021c4eSMatthias Ringwald }
797bd021c4eSMatthias Ringwald 
798bd021c4eSMatthias Ringwald static void hci_transport_h5_reset_link(void){
799bd021c4eSMatthias Ringwald 
800bd021c4eSMatthias Ringwald     log_info("hci_transport_h5_reset_link");
801bd021c4eSMatthias Ringwald 
802bd021c4eSMatthias Ringwald     // clear outgoing queue
803bd021c4eSMatthias Ringwald     hci_transport_link_clear_queue();
804bd021c4eSMatthias Ringwald 
805bd021c4eSMatthias Ringwald     // init slip parser state machine
806bd021c4eSMatthias Ringwald     hci_transport_slip_init();
807bd021c4eSMatthias Ringwald 
808bd021c4eSMatthias Ringwald     // init link management - already starts syncing
809bd021c4eSMatthias Ringwald     hci_transport_link_init();
810bd021c4eSMatthias Ringwald }
811bd021c4eSMatthias Ringwald 
812bd021c4eSMatthias Ringwald static const hci_transport_t hci_transport_h5 = {
813bd021c4eSMatthias Ringwald     /* const char * name; */                                        "H5",
814bd021c4eSMatthias Ringwald     /* void   (*init) (const void *transport_config); */            &hci_transport_h5_init,
815bd021c4eSMatthias Ringwald     /* int    (*open)(void); */                                     &hci_transport_h5_open,
816bd021c4eSMatthias Ringwald     /* int    (*close)(void); */                                    &hci_transport_h5_close,
817bd021c4eSMatthias Ringwald     /* void   (*register_packet_handler)(void (*handler)(...); */   &hci_transport_h5_register_packet_handler,
818bd021c4eSMatthias Ringwald     /* int    (*can_send_packet_now)(uint8_t packet_type); */       &hci_transport_h5_can_send_packet_now,
819bd021c4eSMatthias Ringwald     /* int    (*send_packet)(...); */                               &hci_transport_h5_send_packet,
820bd021c4eSMatthias Ringwald     /* int    (*set_baudrate)(uint32_t baudrate); */                &hci_transport_h5_set_baudrate,
821bd021c4eSMatthias Ringwald     /* void   (*reset_link)(void); */                               &hci_transport_h5_reset_link,
822ee752bb8SMatthias Ringwald     /* void   (*set_sco_config)(uint16_t voice_setting, int num_connections); */ NULL,
823bd021c4eSMatthias Ringwald };
824bd021c4eSMatthias Ringwald 
825bd021c4eSMatthias Ringwald // configure and return h5 singleton
826bd021c4eSMatthias Ringwald const hci_transport_t * hci_transport_h5_instance(const btstack_uart_block_t * uart_driver) {
827bd021c4eSMatthias Ringwald     btstack_uart = uart_driver;
828bd021c4eSMatthias Ringwald     return &hci_transport_h5;
829bd021c4eSMatthias Ringwald }
83094764e99SMatthias Ringwald 
83194764e99SMatthias Ringwald void hci_transport_h5_set_auto_sleep(uint16_t inactivity_timeout_ms){
83294764e99SMatthias Ringwald     link_inactivity_timeout_ms = inactivity_timeout_ms;
83394764e99SMatthias Ringwald }
834