diff --git a/src/lib/stick_yaw/StickYaw.cpp b/src/lib/stick_yaw/StickYaw.cpp index 2978d8e37be1..c45cdee823b2 100644 --- a/src/lib/stick_yaw/StickYaw.cpp +++ b/src/lib/stick_yaw/StickYaw.cpp @@ -73,7 +73,8 @@ void StickYaw::generateYawSetpoint(float &yawspeed_setpoint, float &yaw_setpoint bool StickYaw::updateYawCorrection(const float yaw, const float unaided_yaw, const float deltatime) { if (!PX4_ISFINITE(unaided_yaw)) { - _yaw_correction = 0.f; + // If unaided yaw is not available we leave yaw_correction_ unchanged + // Meaning yaw_setpoint - yaw_correction_prev + _yaw_correction = yaw_setpoint return false; }