vtol: always check for EKF2 resets, not just when QC is checked

Signed-off-by: Silvan Fuhrer <silvan@auterion.com>
This commit is contained in:
Silvan Fuhrer
2023-11-23 13:54:07 +01:00
parent eae939d86c
commit a99a7d2abd
3 changed files with 17 additions and 6 deletions
@@ -373,6 +373,8 @@ VtolAttitudeControl::Run()
_air_density = air_data.rho;
}
_vtol_type->handleEkfResets();
// check if mc and fw sp were updated
const bool mc_att_sp_updated = _mc_virtual_att_sp_sub.update(&_mc_virtual_att_sp);
const bool fw_att_sp_updated = _fw_virtual_att_sp_sub.update(&_fw_virtual_att_sp);