ekf2: move aux vel helpers to auxvel_fusion.cpp

This commit is contained in:
Daniel Agar
2023-02-22 09:08:33 -05:00
parent a199df78cc
commit 98263de17b
2 changed files with 7 additions and 7 deletions
+7
View File
@@ -51,3 +51,10 @@ void Ekf::controlAuxVelFusion()
}
}
}
void Ekf::stopAuxVelFusion()
{
ECL_INFO("stopping aux vel fusion");
//_control_status.flags.aux_vel = false;
resetEstimatorAidStatus(_aid_src_aux_vel);
}
-7
View File
@@ -1051,13 +1051,6 @@ void Ekf::loadMagCovData()
P(18, 18) = _saved_mag_ef_d_variance;
}
void Ekf::stopAuxVelFusion()
{
ECL_INFO("stopping aux vel fusion");
//_control_status.flags.aux_vel = false;
resetEstimatorAidStatus(_aid_src_aux_vel);
}
void Ekf::resetQuatStateYaw(float yaw, float yaw_variance)
{
// save a copy of the quaternion state for later use in calculating the amount of reset change