diff --git a/src/modules/mavlink/streams/HIGH_LATENCY2.hpp b/src/modules/mavlink/streams/HIGH_LATENCY2.hpp index 6eb56abbad..6ce85a2e75 100644 --- a/src/modules/mavlink/streams/HIGH_LATENCY2.hpp +++ b/src/modules/mavlink/streams/HIGH_LATENCY2.hpp @@ -385,7 +385,7 @@ private: { vehicle_attitude_s attitude; - if (_attitude_sub.update(&attitude) && _attitude_sub.copy(&attitude)) { + if (_attitude_sub.update(&attitude)) { const matrix::Eulerf euler = matrix::Quatf(attitude.q); msg->heading = static_cast(math::degrees(matrix::wrap_2pi(euler.psi())) * 0.5f);