mirror of
https://github.com/PX4/PX4-Autopilot.git
synced 2026-05-23 14:47:44 +08:00
fix(ekf2): set cs.heading_observable to true prior to manual reset
This commit is contained in:
committed by
Marco Hauswirth
parent
6464c1cf1d
commit
72f1c1f6f9
@@ -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) {
|
||||
|
||||
Reference in New Issue
Block a user