diff --git a/gtsam/slam/SmartProjectionFactor.h b/gtsam/slam/SmartProjectionFactor.h index 535dab7f6..138a29f0a 100644 --- a/gtsam/slam/SmartProjectionFactor.h +++ b/gtsam/slam/SmartProjectionFactor.h @@ -208,11 +208,10 @@ public: Matrix E; Vector b; computeJacobiansWithTriangulatedPoint(Fblocks, E, b, cameras); - Matrix P = Base::PointCov(E, lambda, diagonalDamping); // build augmented hessian - SymmetricBlockMatrix augmentedHessian = CameraSet::SchurComplement( - Fblocks, E, P, b); + SymmetricBlockMatrix augmentedHessian = // + Cameras::SchurComplement(Fblocks, E, b, lambda, diagonalDamping); return boost::make_shared >(this->keys_, augmentedHessian);