Test dynamic pressure compensation

(cherry picked from commit b3d9334b5abe02f1d123519cfc74a875225eb0bd)
This commit is contained in:
kamilritz
2020-01-21 10:09:48 +03:00
committed by Roman Bapst
parent 83b2abe434
commit b51ea4fe39
3 changed files with 44 additions and 19 deletions
+7
View File
@@ -105,6 +105,13 @@ void EkfWrapper::disableExternalVisionAlignment()
_ekf_params->fusion_mode &= ~MASK_ROTATE_EV;
}
bool EkfWrapper::isWindVelocityEstimated() const
{
filter_control_status_u control_status;
_ekf->get_control_mode(&control_status.value);
return control_status.flags.wind;
}
Vector3f EkfWrapper::getPosition() const
{
float temp[3];
+2
View File
@@ -70,6 +70,8 @@ public:
void enableExternalVisionAlignment();
void disableExternalVisionAlignment();
bool isWindVelocityEstimated() const;
Vector3f getPosition() const;
Vector3f getVelocity() const;
Vector3f getAccelBias() const;