Skip to content
Snippets Groups Projects
Commit f7749697 authored by Joan Vallvé Navarro's avatar Joan Vallvé Navarro
Browse files

fixed evaluation in assertion

parent 57d5fe8d
No related branches found
No related tags found
1 merge request!243Constraint prior sensor params
......@@ -79,7 +79,7 @@ TEST(ConstraintBlockAbs, ctr_block_abs_p_tail2)
std::string brief_report = ceres_mgr.solve(wolf::SolverManager::ReportVerbosity::BRIEF);
//only orientation is constrained
ASSERT_MATRIX_APPROX(frm0->getPPtr()->getState().tail<2>(), pose10.tail<2>(), 1e-6);
ASSERT_MATRIX_APPROX(frm0->getPPtr()->getState().tail<2>(), pose10.segment<2>(1), 1e-6);
}
TEST(ConstraintBlockAbs, ctr_block_abs_v)
......
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