From 47dc2ae5a561b2bc69ea1b1144085a0f4b398438 Mon Sep 17 00:00:00 2001 From: =?UTF-8?q?Igor=20Mi=C5=A1i=C4=87?= Date: Thu, 7 Oct 2021 09:02:41 +0200 Subject: [PATCH] Revert "protocol_splitter: delete non rtps or mavlink data from buffer" This reverts commit 0cae3c129dd751e92ef5785ad7ba2b86ce14e4f3. --- src/drivers/protocol_splitter/protocol_splitter.cpp | 4 ++-- 1 file changed, 2 insertions(+), 2 deletions(-) diff --git a/src/drivers/protocol_splitter/protocol_splitter.cpp b/src/drivers/protocol_splitter/protocol_splitter.cpp index 4b141d5a4e..017cf0cb16 100644 --- a/src/drivers/protocol_splitter/protocol_splitter.cpp +++ b/src/drivers/protocol_splitter/protocol_splitter.cpp @@ -568,8 +568,8 @@ void DevCommon::cleanup() size_t garbage_end = 0; - if (!mavlink_available && !rtps_available && (_read_buffer->buf_size > 0)) { - garbage_end = _read_buffer->buf_size - 1; + if (!mavlink_available && !rtps_available) { + garbage_end = math::max(_read_buffer->start_mavlink, _read_buffer->start_rtps); } else { garbage_end = math::min(_read_buffer->start_mavlink, _read_buffer->start_rtps);