diff --git a/src/modules/mavlink/mavlink_stream.cpp b/src/modules/mavlink/mavlink_stream.cpp index ab964915de..55bf145964 100644 --- a/src/modules/mavlink/mavlink_stream.cpp +++ b/src/modules/mavlink/mavlink_stream.cpp @@ -83,6 +83,12 @@ MavlinkStream::update(const hrt_abstime t) return 0; } + // One of the previous iterations sent the update + // already before the deadline + if (_last_sent > t) { + return -1; + } + int64_t dt = t - _last_sent; int interval = _interval;