diff --git a/gtsam/navigation/BarometricFactor.cpp b/gtsam/navigation/BarometricFactor.cpp index 3246bed68..2f0ff7436 100644 --- a/gtsam/navigation/BarometricFactor.cpp +++ b/gtsam/navigation/BarometricFactor.cpp @@ -46,8 +46,8 @@ Vector BarometricFactor::evaluateError(const Pose3& p, const double& bias, boost::optional H, boost::optional H2) const { Matrix tH; - Vector ret =(Vector(1) << (p.translation(tH).z() + bias - nT_)).finished(); - if (H) (*H) = tH.block<1,6>(2,0); + Vector ret = (Vector(1) << (p.translation(tH).z() + bias - nT_)).finished(); + if (H) (*H) = tH.block<1, 6>(2, 0); if (H2) (*H2) = (Matrix(1, 1) << 1.0).finished(); return ret; }