ekf2: always publish global position when origin has been set

This commit is contained in:
Marco Hauswirth 2024-10-04 17:41:20 +02:00 committed by GitHub
parent ad28c5893b
commit 7d0e93b779
No known key found for this signature in database
GPG Key ID: B5690EEEBB952194

View File

@ -1164,7 +1164,7 @@ void EKF2::PublishEventFlags(const hrt_abstime &timestamp)
void EKF2::PublishGlobalPosition(const hrt_abstime &timestamp)
{
if (_ekf.global_position_is_valid()) {
if (_ekf.global_origin_valid() && _ekf.control_status().flags.yaw_align) {
const Vector3f position{_ekf.getPosition()};
// generate and publish global position data