Call dispatched SchurComplement, now in CameraSet

release/4.3a0
dellaert 2015-03-10 22:10:08 -07:00
parent 421ad49048
commit d924c11d41
1 changed files with 2 additions and 3 deletions

View File

@ -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<CAMERA>::SchurComplement(
Fblocks, E, P, b);
SymmetricBlockMatrix augmentedHessian = //
Cameras::SchurComplement(Fblocks, E, b, lambda, diagonalDamping);
return boost::make_shared<RegularHessianFactor<Base::Dim> >(this->keys_,
augmentedHessian);