Mirrors_Framework/PX4-Autopilot
1
0
Fork 0
mirror of https://github.com/PX4/PX4-Autopilot.git synced 2026-05-28 10:46:33 +08:00
Code Issues Actions 28 Packages Projects Releases Wiki Activity

microRTPS: transport: do not discard message from rx_buffer if a CRC error occurs

Browse Source
This commit is contained in:
TSC21
2020-07-29 14:42:02 +01:00
committed by Nuno Marques
parent 1ab193f548
commit 398f104918
1 changed files with 4 additions and 3 deletions
Download Patch File Download Diff File Expand all files Collapse all files
msg/templates/urtps/microRTPS_transport.cpp
+4 -3
View File
@@ -211,11 +211,12 @@ ssize_t Transport_node::read(uint8_t *topic_ID, char out_buffer[], size_t buffer
memmove(out_buffer, rx_buffer + msg_start_pos + header_size, payload_len);
*topic_ID = header->topic_ID;
len = payload_len + header_size;
// discard message from rx_buffer
rx_buff_pos -= msg_start_pos + header_size + payload_len;
memmove(rx_buffer, rx_buffer + msg_start_pos + header_size + payload_len, rx_buff_pos);
}
// discard message from rx_buffer
rx_buff_pos -= msg_start_pos + header_size + payload_len;
memmove(rx_buffer, rx_buffer + msg_start_pos + header_size + payload_len, rx_buff_pos);
return len;
}