diff --git a/fuse_constraints/src/fixed_3d_landmark_constraint.cpp b/fuse_constraints/src/fixed_3d_landmark_constraint.cpp index 7a865c2a..eae3d06d 100644 --- a/fuse_constraints/src/fixed_3d_landmark_constraint.cpp +++ b/fuse_constraints/src/fixed_3d_landmark_constraint.cpp @@ -109,7 +109,7 @@ ceres::CostFunction* Fixed3DLandmarkConstraint::costFunction() const { // 2 Residuals Per 3D point return new ceres::AutoDiffCostFunction( - new Fixed3DLandmarkCostFunctor(sqrt_information_, mean_, observations_, pts3d_), 2*pts3d_.rows()); + new Fixed3DLandmarkCostFunctor(sqrt_information_, mean_, observations_, pts3d_), 2 * pts3d_.rows()); } } // namespace fuse_constraints diff --git a/fuse_constraints/src/fixed_3d_landmark_simple_covariance_constraint.cpp b/fuse_constraints/src/fixed_3d_landmark_simple_covariance_constraint.cpp index dae45b58..e60e6bcc 100644 --- a/fuse_constraints/src/fixed_3d_landmark_simple_covariance_constraint.cpp +++ b/fuse_constraints/src/fixed_3d_landmark_simple_covariance_constraint.cpp @@ -107,7 +107,7 @@ void Fixed3DLandmarkSimpleCovarianceConstraint::print(std::ostream& stream) cons ceres::CostFunction* Fixed3DLandmarkSimpleCovarianceConstraint::costFunction() const { return new ceres::AutoDiffCostFunction( - new Fixed3DLandmarkSimpleCovarianceCostFunctor(sqrt_information_, mean_, observations_, pts3d_), pts3d_.rows()); + new Fixed3DLandmarkSimpleCovarianceCostFunctor(sqrt_information_, mean_, observations_, pts3d_), 2 * pts3d_.rows()); } } // namespace fuse_constraints