From 4a6c90b8ea071e4fa74786ea7d2d26b58fab07e7 Mon Sep 17 00:00:00 2001 From: Daniel Agar Date: Fri, 13 Nov 2020 09:52:05 -0500 Subject: [PATCH] mavlink: STATUSTEXT check TX buffer before sending - Note the TX buffer size check is lazily ignoring the possibility of messages that span multiple Mavlink STATUSTEXT. This at least accommodates the calibration use case and it's no worse than before for longer messages. --- src/modules/mavlink/mavlink_messages.cpp | 4 ++-- 1 file changed, 2 insertions(+), 2 deletions(-) diff --git a/src/modules/mavlink/mavlink_messages.cpp b/src/modules/mavlink/mavlink_messages.cpp index 6913ec794a..5b9fe678bb 100644 --- a/src/modules/mavlink/mavlink_messages.cpp +++ b/src/modules/mavlink/mavlink_messages.cpp @@ -508,9 +508,9 @@ protected: bool send() override { - if (!_mavlink->get_logbuffer()->empty() && _mavlink->is_connected()) { + if (!_mavlink->get_logbuffer()->empty() && _mavlink->is_connected() && _mavlink->get_free_tx_buf() >= get_size()) { - mavlink_log_s mavlink_log{}; + mavlink_log_s mavlink_log; if (_mavlink->get_logbuffer()->get(&mavlink_log)) {