fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-11-01 00:41:35 +08:00
Code Issues Packages Projects Releases Wiki Activity

microRTPS: transport: hotfix to skip data packets that that don't fit the buffer and continue the readings

Browse Source
This commit is contained in:
TSC21
2020-07-31 14:13:10 +01:00
committed by Nuno Marques
parent 25d2236cce
commit 407bd8860f
1 changed files with 4 additions and 0 deletions
Download Patch File Download Diff File Expand all files Collapse all files
msg/templates/urtps/microRTPS_transport.cpp
+4
View File
@@ -167,6 +167,10 @@ ssize_t Transport_node::read(uint8_t *topic_ID, char out_buffer[], size_t buffer
// The message won't fit the buffer. // The message won't fit the buffer.
if (buffer_len < header_size + payload_len) { if (buffer_len < header_size + payload_len) {
// drop the message an continue the readings
// @note: this is just a work around to avoid the link to be closed
memmove(rx_buffer, rx_buffer + msg_start_pos + 1, rx_buff_pos - (msg_start_pos + 1));
rx_buff_pos = rx_buff_pos - (msg_start_pos + 1);
return -EMSGSIZE; return -EMSGSIZE;
} }