Skip to content
Snippets Groups Projects
Commit 450038d0 authored by Joan Solà Ortega's avatar Joan Solà Ortega
Browse files

remove debug code

parent 1627472d
No related branches found
No related tags found
1 merge request!366Resolve "Complete state vector new data structure?"
Pipeline #5556 failed
......@@ -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 );
......
0% Loading or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment