mirror/btstack
1
0
Fork 0
mirror of https://github.com/bluekitchen/btstack.git synced 2025-03-23 19:20:51 +00:00
Code Issues Packages Projects Releases Wiki Activity

h5: use new btstack_slip implementation

Browse Source
This commit is contained in:
Matthias Ringwald 2016-03-08 13:03:20 +01:00
parent b5550b84bf
commit 645e25ac83
1 changed files with 72 additions and 148 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

214
platform/posix/hci_transport_h5_posix.c
View File

@ -50,6 +50,7 @@
#include <string.h> #include <string.h>
#include "hci.h" #include "hci.h"
#include "btstack_slip.h"
#include "btstack_debug.h" #include "btstack_debug.h"
#include "hci_transport.h" #include "hci_transport.h"
@ -59,14 +60,6 @@
/// newer /// newer
// h5 slip state machine
typedef enum {
SLIP_UNKNOWN = 1,
SLIP_DECODING,
SLIP_X_C0,
SLIP_X_DB
} hci_transport_slip_state_t;
typedef enum { typedef enum {
LINK_UNINITIALIZED, LINK_UNINITIALIZED,
LINK_INITIALIZED, LINK_INITIALIZED,
@ -90,9 +83,6 @@ typedef enum {
#define LINK_ACKNOWLEDGEMENT_TYPE 0x00 #define LINK_ACKNOWLEDGEMENT_TYPE 0x00
#define LINK_CONTROL_PACKET_TYPE 0x0f #define LINK_CONTROL_PACKET_TYPE 0x0f
static const uint8_t slip_c0_encoded[] = { 0xdb, 0xdc };
static const uint8_t slip_db_encoded[] = { 0xdb, 0xdd };
static const uint8_t link_control_sync[] = { 0x01, 0x7e}; static const uint8_t link_control_sync[] = { 0x01, 0x7e};
static const uint8_t link_control_sync_response[] = { 0x02, 0x7d}; static const uint8_t link_control_sync_response[] = { 0x02, 0x7d};
static const uint8_t link_control_config[] = { 0x03, 0xfc, LINK_CONFIG_FIELD}; static const uint8_t link_control_config[] = { 0x03, 0xfc, LINK_CONFIG_FIELD};
@ -102,14 +92,11 @@ static const uint8_t link_control_wakeup[] = { 0x05, 0xfa};
static const uint8_t link_control_woken[] = { 0x06, 0xf9}; static const uint8_t link_control_woken[] = { 0x06, 0xf9};
static const uint8_t link_control_sleep[] = { 0x07, 0x78}; static const uint8_t link_control_sleep[] = { 0x07, 0x78};
static uint8_t hci_packet_with_pre_buffer[HCI_INCOMING_PRE_BUFFER_SIZE + 1 + HCI_PACKET_BUFFER_SIZE]; // packet type + max(acl header + acl payload, event header + event data) // incoming pre-bufffer + 4 bytes H5 header + max(acl header + acl payload, event header + event data) + 2 bytes opt CRC
static uint8_t hci_packet_with_pre_buffer[HCI_INCOMING_PRE_BUFFER_SIZE + 6 + HCI_PACKET_BUFFER_SIZE];
// SLIP state // Non-optimized outgoing buffer (EOF, 4 bytes header, payload, EOF)
static hci_transport_slip_state_t slip_state; static uint8_t slip_outgoing_buffer[2 + 2 * (HCI_PACKET_BUFFER_SIZE + 4)];
static uint8_t * slip_payload = &hci_packet_with_pre_buffer[HCI_INCOMING_PRE_BUFFER_SIZE];
static int slip_payload_pos;
static uint8_t slip_header[4];
static int slip_header_pos;
// H5 Link State // H5 Link State
static hci_transport_link_state_t link_state; static hci_transport_link_state_t link_state;
@ -139,7 +126,6 @@ static void (*packet_handler)(uint8_t packet_type, uint8_t *packet, uint16_t si
// Prototypes // Prototypes
static int hci_transport_h5_process(struct btstack_data_source *ds); static int hci_transport_h5_process(struct btstack_data_source *ds);
static void hci_transport_h5_process_frame(void);
static void hci_transport_link_set_timer(uint16_t timeout_ms); static void hci_transport_link_set_timer(uint16_t timeout_ms);
static void hci_transport_link_timeout_handler(btstack_timer_source_t * timer); static void hci_transport_link_timeout_handler(btstack_timer_source_t * timer);
static int hci_transport_h5_outgoing_packet(void); static int hci_transport_h5_outgoing_packet(void);
@ -160,130 +146,39 @@ static void hci_transport_h5_send_really(const uint8_t * data, int size){
} }
} }
// SLIP // SLIP Outgoing
static void hci_transport_slip_reset(void){
slip_header_pos = 0;
slip_payload_pos = 0;
}
static void hci_transport_slip_init(void){
slip_state = SLIP_UNKNOWN;
hci_transport_slip_reset();
}
static inline void hci_transport_slip_send_eof(void){
uint8_t data = 0xc0;
// log_info("SLIP: 0xc0");
hci_transport_h5_send_really(&data, 1);
}
static inline void hci_transport_slip_send_byte(uint8_t data){
switch (data){
case 0xc0:
// log_info("SLIP: 0xdb 0xdc");
hci_transport_h5_send_really(slip_c0_encoded, sizeof(slip_c0_encoded));
break;
case 0xdb:
// log_info("SLIP: 0xdb 0xdd");
hci_transport_h5_send_really(slip_db_encoded, sizeof(slip_db_encoded));
break;
default:
// log_info("SLIP: 0x%02x", data);
hci_transport_h5_send_really(&data, 1);
break;
}
}
static inline void hci_transport_slip_send_block(const uint8_t * data, uint16_t size){
uint16_t i;
for (i=0;i<size;i++){
hci_transport_slip_send_byte(*data++);
}
}
// format: 0xc0 HEADER PACKER 0xc0 // format: 0xc0 HEADER PACKER 0xc0
// @param uint8_t header[4] // @param uint8_t header[4]
static void hci_transport_slip_send_frame(const uint8_t * header, const uint8_t * packet, uint16_t packet_size){ static void hci_transport_slip_send_frame(const uint8_t * header, const uint8_t * packet, uint16_t packet_size){
int pos = 0;
// Start of Frame // Start of Frame
hci_transport_slip_send_eof(); slip_outgoing_buffer[pos++] = BTSTACK_SLIP_SOF;
// Header // Header
hci_transport_slip_send_block(header, 4); btstack_slip_encoder_start(header, 4);
while (btstack_slip_encoder_has_data()){
slip_outgoing_buffer[pos++] = btstack_slip_encoder_get_byte();
}
// Packet // Packet
hci_transport_slip_send_block(packet, packet_size); btstack_slip_encoder_start(packet, packet_size);
while (btstack_slip_encoder_has_data()){
slip_outgoing_buffer[pos++] = btstack_slip_encoder_get_byte();
}
// Endo of frame // Start of Frame
hci_transport_slip_send_eof(); slip_outgoing_buffer[pos++] = BTSTACK_SLIP_SOF;
hci_transport_h5_send_really(slip_outgoing_buffer, pos);
} }
static void hci_transport_slip_store_byte(uint8_t input){ // SLIP Incoming
if (slip_header_pos < 4){
slip_header[slip_header_pos++] = input;
return;
}
if (slip_payload_pos < HCI_PACKET_BUFFER_SIZE){
slip_payload[slip_payload_pos++] = input;
return;
}
log_error("hci_transport_slip_store_byte: packet to long");
hci_transport_slip_init();
}
static void hci_transport_slip_process(uint8_t input){ static void hci_transport_slip_init(void){
switch(slip_state){ btstack_slip_decoder_init(&hci_packet_with_pre_buffer[HCI_INCOMING_PRE_BUFFER_SIZE], 6 + HCI_PACKET_BUFFER_SIZE);
case SLIP_UNKNOWN:
if (input != 0xc0) break;
hci_transport_slip_reset();
slip_state = SLIP_X_C0;
break;
case SLIP_X_C0:
switch(input){
case 0xc0:
break;
case 0xdb:
slip_state = SLIP_X_DB;
break;
default:
hci_transport_slip_store_byte(input);
slip_state = SLIP_DECODING;
break;
}
break;
case SLIP_X_DB:
switch(input){
case 0xdc:
hci_transport_slip_store_byte(0xc0);
slip_state = SLIP_DECODING;
break;
case 0xdd:
hci_transport_slip_store_byte(0xdb);
slip_state = SLIP_DECODING;
break;
default:
hci_transport_slip_init();
break;
}
break;
case SLIP_DECODING:
switch(input){
case 0xc0:
if (slip_payload_pos){
hci_transport_h5_process_frame();
}
hci_transport_slip_init();
break;
case 0xdb:
slip_state = SLIP_X_DB;
break;
default:
hci_transport_slip_store_byte(input);
break;
}
break;
}
} }
// H5 Three-Wire Implementation // H5 Three-Wire Implementation
@ -428,17 +323,24 @@ static int hci_transport_h5_can_send_packet_now(uint8_t packet_type){
return link_state == LINK_ACTIVE; return link_state == LINK_ACTIVE;
} }
static void hci_transport_h5_process_frame(void){ static void hci_transport_h5_process_frame(uint16_t frame_size){
int seq_nr = slip_header[0] & 0x07; if (frame_size < 4) return;
int ack_nr = (slip_header[0] >> 3) & 0x07;
int data_integrity_check_present = (slip_header[0] & 0x40) != 0; uint8_t * slip_header = &hci_packet_with_pre_buffer[HCI_INCOMING_PRE_BUFFER_SIZE];
int reliable_packet = (slip_header[0] & 0x80) != 0; uint8_t * slip_payload = &hci_packet_with_pre_buffer[HCI_INCOMING_PRE_BUFFER_SIZE + 4];
int frame_size_without_header = frame_size - 4;
int seq_nr = slip_header[0] & 0x07;
int ack_nr = (slip_header[0] >> 3) & 0x07;
int data_integrity_check_present = (slip_header[0] & 0x40) != 0;
int reliable_packet = (slip_header[0] & 0x80) != 0;
uint8_t link_packet_type = slip_header[1] & 0x0f; uint8_t link_packet_type = slip_header[1] & 0x0f;
uint16_t link_payload_len = (slip_header[1] >> 4) | (slip_header[2] << 4); uint16_t link_payload_len = (slip_header[1] >> 4) | (slip_header[2] << 4);
log_info("hci_transport_h5_process_frame, reliable %u, packet type %u, seq_nr %u, ack_nr %u", reliable_packet, link_packet_type, seq_nr, ack_nr); log_info("hci_transport_h5_process_frame, reliable %u, packet type %u, seq_nr %u, ack_nr %u", reliable_packet, link_packet_type, seq_nr, ack_nr);
log_info_hexdump(slip_header, 4); log_info_hexdump(slip_header, 4);
log_info_hexdump(slip_payload, slip_payload_pos); log_info_hexdump(slip_payload, frame_size_without_header);
// validate header checksum // validate header checksum
uint8_t header_checksum = slip_header[0] + slip_header[1] + slip_header[2] + slip_header[3]; uint8_t header_checksum = slip_header[0] + slip_header[1] + slip_header[2] + slip_header[3];
@ -449,9 +351,9 @@ static void hci_transport_h5_process_frame(void){
// validate payload length // validate payload length
int data_integrity_len = data_integrity_check_present ? 2 : 0; int data_integrity_len = data_integrity_check_present ? 2 : 0;
uint16_t expected_payload_len = link_payload_len + data_integrity_len; uint16_t received_payload_len = frame_size_without_header - data_integrity_len;
if (expected_payload_len != slip_payload_pos){ if (link_payload_len != received_payload_len){
log_info("h5: expected payload len %u but got %u", expected_payload_len, slip_payload_pos); log_info("h5: expected payload len %u but got %u", link_payload_len, received_payload_len);
return; return;
} }
@ -497,9 +399,9 @@ static void hci_transport_h5_process_frame(void){
packet_handler(HCI_EVENT_PACKET, &event[0], sizeof(event)); packet_handler(HCI_EVENT_PACKET, &event[0], sizeof(event));
} }
break; break;
case LINK_ACTIVE: case LINK_ACTIVE:
// validate packet sequence nr for reliable packets (out of sequence error)
// validate packet sequence nr in reliable packets (check for out of sequence error)
if (reliable_packet){ if (reliable_packet){
if (seq_nr != link_ack_nr){ if (seq_nr != link_ack_nr){
log_info("expected seq nr %u, but received %u", link_ack_nr, seq_nr); log_info("expected seq nr %u, but received %u", link_ack_nr, seq_nr);
@ -511,7 +413,7 @@ static void hci_transport_h5_process_frame(void){
hci_transport_link_send_ack_packet(); hci_transport_link_send_ack_packet();
} }
// Process ACKs in reliable and explicit ack packets // Process ACKs in reliable packet and explicit ack packets
if (reliable_packet || link_packet_type == LINK_ACKNOWLEDGEMENT_TYPE){ if (reliable_packet || link_packet_type == LINK_ACKNOWLEDGEMENT_TYPE){
// our packet is good if the remote expects our seq nr + 1 // our packet is good if the remote expects our seq nr + 1
int next_seq_nr = hci_transport_h5_inc_seq_nr(link_seq_nr); int next_seq_nr = hci_transport_h5_inc_seq_nr(link_seq_nr);
@ -526,7 +428,6 @@ static void hci_transport_h5_process_frame(void){
} }
} }
// handle actual packet
switch (link_packet_type){ switch (link_packet_type){
case LINK_CONTROL_PACKET_TYPE: case LINK_CONTROL_PACKET_TYPE:
if (memcmp(slip_payload, link_control_config, sizeof(link_control_config)) == 0){ if (memcmp(slip_payload, link_control_config, sizeof(link_control_config)) == 0){
@ -560,9 +461,10 @@ static void hci_transport_h5_process_frame(void){
case HCI_EVENT_PACKET: case HCI_EVENT_PACKET:
case HCI_ACL_DATA_PACKET: case HCI_ACL_DATA_PACKET:
case HCI_SCO_DATA_PACKET: case HCI_SCO_DATA_PACKET:
packet_handler(link_packet_type, slip_payload, slip_payload_pos); packet_handler(link_packet_type, slip_payload, link_payload_len);
break; break;
} }
break; break;
default: default:
break; break;
@ -693,6 +595,9 @@ static int hci_transport_h5_open(void){
} }
toptions.c_cflag |= CREAD | CLOCAL; // turn on READ & ignore ctrl lines toptions.c_cflag |= CREAD | CLOCAL; // turn on READ & ignore ctrl lines
//
// toptions.c_cflag |= PARENB; // enable even parity
//
toptions.c_iflag &= ~(IXON | IXOFF | IXANY); // turn off s/w flow ctrl toptions.c_iflag &= ~(IXON | IXOFF | IXANY); // turn off s/w flow ctrl
// see: http://unixwiz.net/techtips/termios-vmin-vtime.html // see: http://unixwiz.net/techtips/termios-vmin-vtime.html
@ -723,6 +628,20 @@ static int hci_transport_h5_open(void){
return 0; return 0;
} }
void hci_transport_h5_reset_link(void){
log_info("hci_transport_h5_reset_link");
// clear outgoing queue
hci_transport_h5_clear_queue();
// init slip parser state machine
hci_transport_slip_init();
// init link management - already starts syncing
hci_transport_link_init();
}
static int hci_transport_h5_close(void){ static int hci_transport_h5_close(void){
// first remove run loop handler // first remove run loop handler
btstack_run_loop_remove_data_source(&hci_transport_h5_data_source); btstack_run_loop_remove_data_source(&hci_transport_h5_data_source);
@ -736,13 +655,18 @@ static int hci_transport_h5_close(void){
static int hci_transport_h5_process(struct btstack_data_source *ds) { static int hci_transport_h5_process(struct btstack_data_source *ds) {
if (hci_transport_h5_data_source.fd < 0) return -1; if (hci_transport_h5_data_source.fd < 0) return -1;
// read up to bytes_to_read data in // process data byte by byte
uint8_t data; uint8_t data;
while (1) { while (1) {
int bytes_read = read(hci_transport_h5_data_source.fd, &data, 1); int bytes_read = read(hci_transport_h5_data_source.fd, &data, 1);
if (bytes_read < 1) break; if (bytes_read < 1) break;
// log_info("slip: process 0x%02x", data); // log_info("slip: process 0x%02x", data);
hci_transport_slip_process(data); btstack_slip_decoder_process(data);
uint16_t frame_size = btstack_slip_decoder_frame_size();
if (frame_size) {
hci_transport_h5_process_frame(frame_size);
hci_transport_slip_init();
}
}; };
return 0; return 0;
} }