From 3b936b4c1c4bb5ea60cd9c6c8721e5e0fa06e697 Mon Sep 17 00:00:00 2001
From: dirksavage88 <dirksavage88@gmail.com>
Date: Wed, 30 Oct 2024 17:34:47 -0400
Subject: [PATCH] fix to gps ecef conditional

Signed-off-by: dirksavage88 <dirksavage88@gmail.com>
---
 src/drivers/uavcan/sensors/gnss.cpp | 4 ++--
 1 file changed, 2 insertions(+), 2 deletions(-)

diff --git a/src/drivers/uavcan/sensors/gnss.cpp b/src/drivers/uavcan/sensors/gnss.cpp
index 5d6fe896cc85..8284c42b59c7 100644
--- a/src/drivers/uavcan/sensors/gnss.cpp
+++ b/src/drivers/uavcan/sensors/gnss.cpp
@@ -309,7 +309,7 @@ UavcanGnssBridge::gnss_fix2_sub_cb(const uavcan::ReceivedDataStructure<uavcan::e
 		}
 	}
 
-	// Invalidate the heading fields FIXME:(PX4 CANNODE)
+	// Invalidate the heading fields
 	float heading = NAN;
 	float heading_offset = NAN;
 	float heading_accuracy = NAN;
@@ -320,7 +320,7 @@ UavcanGnssBridge::gnss_fix2_sub_cb(const uavcan::ReceivedDataStructure<uavcan::e
 	uint8_t spoofing_state = 0;
 
 	// Use ecef_position_velocity for CANNODE until FIXME above resolved
-	if (!msg.ecef_position_velocity.empty()) {
+	if (!msg.ecef_position_velocity.empty() && !_rel_heading_valid) {
 		if (!std::isnan(msg.ecef_position_velocity[0].velocity_xyz[0])) {
 			heading = msg.ecef_position_velocity[0].velocity_xyz[0];
 		}