From ae706537b8f00be5fa66c7d7046fb4ae207c903a Mon Sep 17 00:00:00 2001 From: Daniel Agar Date: Sun, 27 Dec 2020 19:16:38 -0500 Subject: [PATCH] mavlink: CAMERA_IMAGE_CAPTURED stream check free tx buf before send --- src/modules/mavlink/mavlink_messages.cpp | 3 +-- 1 file changed, 1 insertion(+), 2 deletions(-) diff --git a/src/modules/mavlink/mavlink_messages.cpp b/src/modules/mavlink/mavlink_messages.cpp index 5cee18c8ab..9942c48d5e 100644 --- a/src/modules/mavlink/mavlink_messages.cpp +++ b/src/modules/mavlink/mavlink_messages.cpp @@ -2254,8 +2254,7 @@ protected: { camera_capture_s capture; - if (_capture_sub.update(&capture)) { - + if ((_mavlink->get_free_tx_buf() >= get_size()) && _capture_sub.update(&capture)) { mavlink_camera_image_captured_t msg{}; msg.time_boot_ms = capture.timestamp / 1000;