mirror/btstack
1
0
Fork 0
mirror of https://github.com/bluekitchen/btstack.git synced 2025-02-26 18:41:12 +00:00
Code Issues Packages Projects Releases Wiki Activity

fix UIH Test CMD detection

Browse Source
This commit is contained in:
matthias.ringwald@gmail.com 2014-01-11 17:59:29 +00:00
parent d17bd5fe3e
commit 8712d7baf6
1 changed files with 22 additions and 8 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

30
src/rfcomm.c
View File

@ -924,6 +924,27 @@ static int rfcomm_multiplexer_l2cap_packet_handler(uint16_t channel, uint8_t *pa
rfcomm_multiplexer_finalize(multiplexer); rfcomm_multiplexer_finalize(multiplexer);
return 1; return 1;
} }
switch (packet[payload_offset]){
case BT_RFCOMM_CLD_CMD:
// Multiplexer close down (CLD) -> close mutliplexer
log_info("Received Multiplexer close down command\n");
log_info("-> Closing down multiplexer\n");
rfcomm_multiplexer_finalize(multiplexer);
return 1;
case BT_RFCOMM_TEST_CMD: {
log_info("Received test command");
int len = packet[payload_offset+1] >> 1; // length < 125
if (len > RFCOMM_TEST_DATA_MAX_LEN){
len = RFCOMM_TEST_DATA_MAX_LEN;
}
multiplexer->test_data_len = len;
memcpy(multiplexer->test_data, &packet[payload_offset + 3], len);
return 1;
}
default:
break;
}
break; break;
default: default:
@ -1303,16 +1324,9 @@ void rfcomm_channel_packet_handler(rfcomm_multiplexer_t * multiplexer, uint8_t
} }
break; break;
case BT_RFCOMM_TEST_CMD: { case BT_RFCOMM_RLS_CMD:
log_info("Received test command"); log_info("Received test command");
int len = packet[length_offset]; // length < 125
if (len > RFCOMM_TEST_DATA_MAX_LEN){
len = RFCOMM_TEST_DATA_MAX_LEN;
}
multiplexer->test_data_len = len;
memcpy(multiplexer->test_data, &packet[payload_offset], len);
break; break;
}
default: default:
log_error("Received unknown UIH packet - 0x%02x\n", packet[payload_offset]); log_error("Received unknown UIH packet - 0x%02x\n", packet[payload_offset]);