mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-21 17:33:33 +08:00
EKF: remove virtual getters from estimator_interface
This commit is contained in:
@@ -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
|
||||
|
||||
Reference in New Issue
Block a user