Refactor position resets (#822)

This commit is contained in:
kritz
2020-05-19 21:53:46 +02:00
committed by GitHub
parent 37d9cef262
commit 716caa5168
4 changed files with 38 additions and 33 deletions
+8 -6
View File
@@ -588,8 +588,16 @@ private:
inline void resetVerticalVelocityTo(float new_vert_vel);
bool resetHorizontalPosition();
inline void resetHorizontalPositionToGps();
inline void resetHorizontalPositionToVision();
inline void resetHorizontalPositionTo(const Vector2f &new_horz_pos);
void resetHeight();
// fuse optical flow line of sight rate measurements
void fuseOptFlow();
@@ -633,12 +641,6 @@ private:
// Return the magnetic declination in radians to be used by the alignment and fusion processing
float getMagDeclination();
// reset position states of the ekf (only horizontal position)
bool resetPosition();
// reset height state of the ekf
void resetHeight();
// modify output filter to match the the EKF state at the fusion time horizon
void alignOutputFilter();