fix(ekf2): set cs.heading_observable to true prior to manual reset

This commit is contained in:
Marco Hauswirth
2026-04-28 14:38:11 +02:00
committed by Marco Hauswirth
parent 6464c1cf1d
commit 72f1c1f6f9
+3
View File
@@ -429,6 +429,9 @@ public:
void resetHeadingToExternalObservation(float heading, float heading_accuracy)
{
// External heading is an observation of yaw. Setting heading_observable = true
// prevents clearInhibitedStateKalmanGains() from inhibiting the update
_control_status.flags.heading_observable = true;
const float heading_variance = sq(heading_accuracy);
if (_control_status.flags.yaw_align) {