EKF: remove virtual getters from estimator_interface

This commit is contained in:
Daniel Agar
2020-11-02 09:35:47 -05:00
parent 48a8992caf
commit a21092804a
9 changed files with 195 additions and 402 deletions
-30
View File
@@ -138,11 +138,6 @@ void Ekf::checkHaglYawResetReq()
}
}
float Ekf::getTerrainVPos() const
{
return isTerrainEstimateValid() ? _terrain_vpos : _last_on_ground_posD;
}
void Ekf::runOnGroundYawReset()
{
if (_mag_yaw_reset_req && isYawResetAuthorized()) {
@@ -154,11 +149,6 @@ void Ekf::runOnGroundYawReset()
}
}
bool Ekf::isYawResetAuthorized() const
{
return !_is_yaw_fusion_inhibited;
}
bool Ekf::canResetMagHeading() const
{
return !isStrongMagneticDisturbance() && (_params.mag_fusion_type != MAG_FUSE_TYPE_NONE);
@@ -177,11 +167,6 @@ void Ekf::runInAirYawReset()
}
}
bool Ekf::canRealignYawUsingGps() const
{
return _control_status.flags.fixed_wing;
}
void Ekf::runVelPosReset()
{
if (_velpos_reset_request) {
@@ -237,16 +222,6 @@ void Ekf::checkMagBiasObservability()
_time_yaw_started = _imu_sample_delayed.time_us;
}
bool Ekf::isYawAngleObservable() const
{
return _yaw_angle_observable;
}
bool Ekf::isMagBiasObservable() const
{
return _mag_bias_observable;
}
bool Ekf::canUse3DMagFusion() const
{
// Use of 3D fusion requires an in-air heading alignment but it should not
@@ -308,11 +283,6 @@ void Ekf::checkMagFieldStrength()
}
}
bool Ekf::isStrongMagneticDisturbance() const
{
return _control_status.flags.mag_field_disturbed;
}
bool Ekf::isMeasuredMatchingGpsMagStrength() const
{
constexpr float wmm_gate_size = 0.2f; // +/- Gauss