add curly braces to make code more readable
parent
e331a47b6f
commit
1db3cdc780
|
@ -67,9 +67,11 @@ void ManifoldPreintegration::update(const Vector3& measuredAcc,
|
|||
|
||||
// Possibly correct for sensor pose
|
||||
Matrix3 D_correctedAcc_acc, D_correctedAcc_omega, D_correctedOmega_omega;
|
||||
if (p().body_P_sensor)
|
||||
std::tie(acc, omega) = correctMeasurementsBySensorPose(acc, omega,
|
||||
D_correctedAcc_acc, D_correctedAcc_omega, D_correctedOmega_omega);
|
||||
if (p().body_P_sensor) {
|
||||
std::tie(acc, omega) = correctMeasurementsBySensorPose(
|
||||
acc, omega, D_correctedAcc_acc, D_correctedAcc_omega,
|
||||
D_correctedOmega_omega);
|
||||
}
|
||||
|
||||
// Save current rotation for updating Jacobians
|
||||
const Rot3 oldRij = deltaXij_.attitude();
|
||||
|
|
|
@ -111,9 +111,11 @@ void TangentPreintegration::update(const Vector3& measuredAcc,
|
|||
|
||||
// Possibly correct for sensor pose by converting to body frame
|
||||
Matrix3 D_correctedAcc_acc, D_correctedAcc_omega, D_correctedOmega_omega;
|
||||
if (p().body_P_sensor)
|
||||
std::tie(acc, omega) = correctMeasurementsBySensorPose(acc, omega,
|
||||
D_correctedAcc_acc, D_correctedAcc_omega, D_correctedOmega_omega);
|
||||
if (p().body_P_sensor) {
|
||||
std::tie(acc, omega) = correctMeasurementsBySensorPose(
|
||||
acc, omega, D_correctedAcc_acc, D_correctedAcc_omega,
|
||||
D_correctedOmega_omega);
|
||||
}
|
||||
|
||||
// Do update
|
||||
deltaTij_ += dt;
|
||||
|
|
Loading…
Reference in New Issue