dark0707
/
px4-firmware
forked from Archive/PX4-Autopilot
1
0
Fork 0
Code Pull Requests Activity

EKF: Don't report local position as valid when in a non-position mode

This commit is contained in:
Paul Riseborough 2020-12-02 20:54:43 +11:00 committed by Daniel Agar
parent da7d41e78a
commit 44ebfb8c43
2 changed files with 8 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

8
EKF/ekf.h
View File

@ -196,7 +196,13 @@ public:
// and have not started using synthetic position observations to constrain drift
bool global_position_is_valid() const
{
return (_NED_origin_initialised && !_deadreckon_time_exceeded && !_using_synthetic_position);
return (_NED_origin_initialised && local_position_is_valid());
}
// return true if the local position estimate is valid
bool local_position_is_valid() const
{
return (!_deadreckon_time_exceeded && !_using_synthetic_position);
}
bool isTerrainEstimateValid() const { return _hagl_valid; };

2
EKF/estimator_interface.h
View File

@ -159,7 +159,7 @@ public:
int getNumberOfActiveHorizontalAidingSources() const;
// return true if the local position estimate is valid
bool local_position_is_valid() const { return !_deadreckon_time_exceeded; }
bool local_position_is_valid() const { return local_position_is_valid(); }
// return true if the EKF is dead reckoning the position using inertial data only
bool inertial_dead_reckoning() const { return _is_dead_reckoning; }