remove biasAccOmegaInit default reset

release/4.3a0
Varun Agrawal 2023-01-13 10:15:40 -05:00
parent 3006a76444
commit 2fb93dbdfb
1 changed files with 0 additions and 3 deletions

View File

@ -74,9 +74,6 @@ bool PreintegratedCombinedMeasurements::equals(
void PreintegratedCombinedMeasurements::resetIntegration() {
// Base class method to reset the preintegrated measurements
PreintegrationType::resetIntegration();
// Set the initial bias covariance to
// the estimated covariance from the last step.
p().biasAccOmegaInt = preintMeasCov_.block<6, 6>(9, 9);
preintMeasCov_.setZero();
}