Check augmented information matrices

release/4.3a0
dellaert 2015-02-22 17:30:08 +01:00
parent ad6293848e
commit 241366a6e6
1 changed files with 3 additions and 1 deletions

View File

@ -502,7 +502,7 @@ TEST( SmartProjectionPoseFactor, Factors ){
boost::shared_ptr<RegularHessianFactor<6> > actual =
smartFactor1->createHessianFactor(cameras, 0.0);
CHECK(assert_equal(expected.information(), actual->information(), 1e-8));
CHECK(assert_equal(expected.augmentedInformation(), actual->augmentedInformation(), 1e-8));
CHECK(assert_equal(expected, *actual, 1e-8));
}
@ -529,6 +529,7 @@ TEST( SmartProjectionPoseFactor, Factors ){
boost::shared_ptr<JacobianFactorQ<6, 2> > actualQ =
smartFactor1->createJacobianQFactor(cameras, 0.0);
CHECK(actual);
CHECK(assert_equal(expectedQ.augmentedInformation(), actualQ->augmentedInformation(), 1e-8));
CHECK(assert_equal(expectedQ, *actualQ));
}
@ -541,6 +542,7 @@ TEST( SmartProjectionPoseFactor, Factors ){
boost::shared_ptr<JacobianFactor> actual =
smartFactor1->createJacobianSVDFactor(cameras, 0.0);
CHECK(actual);
CHECK(assert_equal(expected.augmentedInformation(), actual->augmentedInformation(), 1e-8));
CHECK(assert_equal(expected, *actual));
}
}