mirror/btstack
1
0
Fork 0
mirror of https://github.com/bluekitchen/btstack.git synced 2025-04-18 14:42:33 +00:00
Code Issues Packages Projects Releases Wiki Activity

h5: enable even parity on posix if incorrect frame received

Browse Source
This commit is contained in:
Matthias Ringwald 2016-04-13 16:50:36 +02:00
parent c7525ffc25
commit a6da1bb0db
3 changed files with 45 additions and 6 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

32
platform/posix/btstack_uart_posix.c
View File

@ -58,13 +58,13 @@ int btstack_uart_posix_open(const char * device_name, int flowcontrol, uint32_t
int flags = O_RDWR | O_NOCTTY | O_NONBLOCK; int flags = O_RDWR | O_NOCTTY | O_NONBLOCK;
int fd = open(device_name, flags); int fd = open(device_name, flags);
if (fd == -1) { if (fd == -1) {
perror("init_serialport: Unable to open port "); perror("posix_open: Unable to open port ");
perror(device_name); perror(device_name);
return -1; return -1;
} }
if (tcgetattr(fd, &toptions) < 0) { if (tcgetattr(fd, &toptions) < 0) {
perror("init_serialport: Couldn't get term attributes"); perror("posix_open: Couldn't get term attributes");
return -1; return -1;
} }
@ -74,6 +74,10 @@ int btstack_uart_posix_open(const char * device_name, int flowcontrol, uint32_t
toptions.c_cflag &= ~CSTOPB; toptions.c_cflag &= ~CSTOPB;
toptions.c_cflag |= CS8; toptions.c_cflag |= CS8;
// 8E1
// toptions.c_cflag |= PARENB; // enable even parity
//
if (flowcontrol) { if (flowcontrol) {
// with flow control // with flow control
toptions.c_cflag |= CRTSCTS; toptions.c_cflag |= CRTSCTS;
@ -90,7 +94,7 @@ int btstack_uart_posix_open(const char * device_name, int flowcontrol, uint32_t
toptions.c_cc[VTIME] = 0; toptions.c_cc[VTIME] = 0;
if(tcsetattr(fd, TCSANOW, &toptions) < 0) { if(tcsetattr(fd, TCSANOW, &toptions) < 0) {
perror("init_serialport: Couldn't set term attributes"); perror("posix_open: Couldn't set term attributes");
return -1; return -1;
} }
@ -108,7 +112,7 @@ int btstack_uart_posix_set_baudrate(int fd, uint32_t baudrate){
struct termios toptions; struct termios toptions;
if (tcgetattr(fd, &toptions) < 0) { if (tcgetattr(fd, &toptions) < 0) {
perror("init_serialport: Couldn't get term attributes"); perror("posix_open: Couldn't get term attributes");
return -1; return -1;
} }
@ -153,9 +157,27 @@ int btstack_uart_posix_set_baudrate(int fd, uint32_t baudrate){
cfsetispeed(&toptions, brate); cfsetispeed(&toptions, brate);
if( tcsetattr(fd, TCSANOW, &toptions) < 0) { if( tcsetattr(fd, TCSANOW, &toptions) < 0) {
perror("init_serialport: Couldn't set term attributes"); perror("posix_set_baudrate: Couldn't set term attributes");
return -1; return -1;
} }
return 0; return 0;
} }
int btstack_uart_posix_set_parity(int fd, int parity){
struct termios toptions;
if (tcgetattr(fd, &toptions) < 0) {
perror("posix_set_parity: Couldn't get term attributes");
return -1;
}
if (parity){
toptions.c_cflag |= PARENB; // enable even parity
} else {
toptions.c_cflag &= ~PARENB; // enable even parity
}
if(tcsetattr(fd, TCSANOW, &toptions) < 0) {
perror("posix_set_parity: Couldn't set term attributes");
return -1;
}
return 0;
}

10
platform/posix/btstack_uart_posix.h
View File

@ -58,11 +58,19 @@
int btstack_uart_posix_open(const char * device_name, int flowcontrol, uint32_t baudrate); int btstack_uart_posix_open(const char * device_name, int flowcontrol, uint32_t baudrate);
/** /**
* @brief Set baudrate * @brief Set Baudrate
* @param fd * @param fd
* @param baudrate * @param baudrate
* @returns 0 if successful * @returns 0 if successful
*/ */
int btstack_uart_posix_set_baudrate(int fd, uint32_t baudrate); int btstack_uart_posix_set_baudrate(int fd, uint32_t baudrate);
/**
* @brief Set Parity
* @param fd
* @param parity
* @returns 0 if successful
*/
int btstack_uart_posix_set_parity(int fd, int parity);
#endif #endif

9
platform/posix/hci_transport_h5_posix.c
View File

@ -344,6 +344,15 @@ static void hci_transport_h5_process_frame(uint16_t frame_size){
log_info_hexdump(slip_header, 4); log_info_hexdump(slip_header, 4);
log_info_hexdump(slip_payload, frame_size_without_header); log_info_hexdump(slip_payload, frame_size_without_header);
// CSR 8811 does not seem to auto-detect H5 mode and sends data with even parity.
// if this byte sequence is detected, just enable even parity
const uint8_t sync_response_bcsp[] = {0x01, 0x7a, 0x06, 0x10};
if (memcmp(sync_response_bcsp, slip_header, 4) == 0){
log_info("h5: detected BSCP SYNC sent with Even Parity -> discard frame and enable Even Parity");
btstack_uart_posix_set_parity(hci_transport_h5_data_source.fd, 1);
return;
}
// 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];
if (header_checksum != 0xff){ if (header_checksum != 0xff){