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

auto-pts: fix btp command receive

Browse Source
This commit is contained in:
Matthias Ringwald 2019-11-04 14:31:14 +01:00
parent e0b77f1e04
commit 70bbc02dd5
1 changed files with 16 additions and 13 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

29
test/auto-pts/btp_socket.c
View File

@ -78,10 +78,12 @@ typedef enum {
} SOCKET_STATE; } SOCKET_STATE;
static btstack_data_source_t socket_ds; static btstack_data_source_t socket_ds;
static uint8_t buffer[6+BTP_PAYLOAD_LEN_MAX]; static uint8_t buffer[6+BTP_PAYLOAD_LEN_MAX];
static SOCKET_STATE state; static SOCKET_STATE state;
static uint16_t bytes_read; static uint16_t packet_bytes_read;
static uint16_t bytes_to_read; static uint16_t packet_bytes_to_read;
/** client packet handler */ /** client packet handler */
@ -96,8 +98,8 @@ static void btp_socket_free_connection(){
static void btp_socket_init_statemachine(void){ static void btp_socket_init_statemachine(void){
// wait for next packet // wait for next packet
state = SOCKET_W4_HEADER; state = SOCKET_W4_HEADER;
bytes_read = 0; packet_bytes_read = 0;
bytes_to_read = BTP_HEADER_LEN; packet_bytes_to_read = BTP_HEADER_LEN;
} }
static void btp_socket_emit_connection_closed(void){ static void btp_socket_emit_connection_closed(void){
@ -105,13 +107,12 @@ static void btp_socket_emit_connection_closed(void){
(*btp_socket_packet_callback)(BTP_SERVICE_ID_CORE, BTP_OP_ERROR, BTP_INDEX_NON_CONTROLLER, 1, &status); (*btp_socket_packet_callback)(BTP_SERVICE_ID_CORE, BTP_OP_ERROR, BTP_INDEX_NON_CONTROLLER, 1, &status);
} }
void btp_socket_hci_process(btstack_data_source_t *socket_ds, btstack_data_source_callback_type_t callback_type) { void btp_socket_process(btstack_data_source_t *socket_ds, btstack_data_source_callback_type_t callback_type) {
// get socket_fd // get socket_fd
int socket_fd = socket_ds->source.fd; int socket_fd = socket_ds->source.fd;
// read from socket // read from socket
int bytes_read = read(socket_fd, &buffer[bytes_read], bytes_to_read); int bytes_read = read(socket_fd, &buffer[packet_bytes_read], packet_bytes_to_read);
if (bytes_read <= 0){ if (bytes_read <= 0){
// free connection // free connection
btp_socket_free_connection(); btp_socket_free_connection();
@ -121,16 +122,16 @@ void btp_socket_hci_process(btstack_data_source_t *socket_ds, btstack_data_sourc
return; return;
} }
bytes_read += bytes_read; packet_bytes_read += bytes_read;
bytes_to_read -= bytes_read; packet_bytes_to_read -= bytes_read;
if (bytes_to_read > 0) return; if (packet_bytes_to_read > 0) return;
bool dispatch = false; bool dispatch = false;
switch (state){ switch (state){
case SOCKET_W4_HEADER: case SOCKET_W4_HEADER:
state = SOCKET_W4_DATA; state = SOCKET_W4_DATA;
bytes_to_read = little_endian_read_16( buffer, 3); packet_bytes_to_read = little_endian_read_16( buffer, 3);
if (bytes_to_read == 0){ if (packet_bytes_to_read == 0){
dispatch = true; dispatch = true;
} }
break; break;
@ -185,7 +186,7 @@ bool btp_socket_open_unix(const char * socket_name){
return false; return false;
}; };
btstack_run_loop_set_data_source_handler(&socket_ds, &btp_socket_hci_process); btstack_run_loop_set_data_source_handler(&socket_ds, &btp_socket_process);
btstack_run_loop_set_data_source_fd(&socket_ds, btp_socket); btstack_run_loop_set_data_source_fd(&socket_ds, btp_socket);
btstack_run_loop_enable_data_source_callbacks(&socket_ds, DATA_SOURCE_CALLBACK_READ); btstack_run_loop_enable_data_source_callbacks(&socket_ds, DATA_SOURCE_CALLBACK_READ);
@ -213,11 +214,13 @@ bool btp_socket_close_unix(void){
* Init socket connection module * Init socket connection module
*/ */
void btp_socket_init(void){ void btp_socket_init(void){
#if 0
// just ignore broken sockets - NO_SO_SIGPIPE // just ignore broken sockets - NO_SO_SIGPIPE
sig_t result = signal(SIGPIPE, SIG_IGN); sig_t result = signal(SIGPIPE, SIG_IGN);
if (result){ if (result){
log_error("btp_socket_init: failed to ignore SIGPIPE, error: %s", strerror(errno)); log_error("btp_socket_init: failed to ignore SIGPIPE, error: %s", strerror(errno));
} }
#endif
} }
/** /**