Test dynamic pressure compensation

(cherry picked from commit b3d9334b5abe02f1d123519cfc74a875225eb0bd)
This commit is contained in:
kamilritz
2020-01-10 12:51:01 +01: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];