diff --git a/test/gtest_problem.cpp b/test/gtest_problem.cpp index 14b925af6fd32af5a95420a74822399a57d10e4b..3790e5ba3936dfbc1f3dde58ff4e2240a513742a 100644 --- a/test/gtest_problem.cpp +++ b/test/gtest_problem.cpp @@ -151,17 +151,6 @@ TEST(Problem, SetOrigin_PO_2d) auto s0_vector = s0.vector("PO"); MatrixXd P0_matrix = (s0_vector.array() * s0_vector.array()).matrix().asDiagonal(); - WOLF_DEBUG("x0 ", x0); - WOLF_DEBUG("x0_vector ", x0_vector.transpose()); - WOLF_DEBUG("s0 ", s0); - WOLF_DEBUG("s0_vector ", s0_vector.transpose()); - WOLF_DEBUG("P0_matrix ", P0_matrix); - WOLF_DEBUG("fp meas ", fp->getMeasurement().transpose()); - WOLF_DEBUG("fp cova ", fp->getMeasurementCovariance()); - WOLF_DEBUG("fo meas ", fo->getMeasurement().transpose()); - WOLF_DEBUG("fo cova ", fo->getMeasurementCovariance()); - - // check that the Feature measurement and covariance are the ones provided ASSERT_MATRIX_APPROX(x0_vector.head<2>(), fp->getMeasurement(), Constants::EPS_SMALL ); ASSERT_MATRIX_APPROX(x0_vector.tail<1>(), fo->getMeasurement(), Constants::EPS_SMALL );