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

assertions for strange bug

parent 3914fcc8
No related branches found
No related tags found
1 merge request!234WIP: Gnss
Pipeline #2521 failed
...@@ -149,8 +149,12 @@ TEST_F(ConstraintGnssFix2DTest, gnss_1_map_base_position) ...@@ -149,8 +149,12 @@ TEST_F(ConstraintGnssFix2DTest, gnss_1_map_base_position)
cap_gnss_ptr->getFramePtr()->setState(frm_dist); cap_gnss_ptr->getFramePtr()->setState(frm_dist);
// solve for frm // solve for frm
std::string report = ceres_mgr_ptr->solve(SolverManager::ReportVerbosity::QUIET); std::string report = ceres_mgr_ptr->solve(SolverManager::ReportVerbosity::FULL);
std::cout << report << std::endl;
ASSERT_TRUE(ceres_mgr_ptr->getSummary().num_parameter_blocks_reduced == 1);
ASSERT_TRUE(ceres_mgr_ptr->getSummary().num_parameters == 2);
ASSERT_TRUE(cap_gnss_ptr->getFramePtr()->isKey()); ASSERT_TRUE(cap_gnss_ptr->getFramePtr()->isKey());
ASSERT_MATRIX_APPROX(cap_gnss_ptr->getFramePtr()->getState().head(2), t_map_base.head(2), 1e-6); ASSERT_MATRIX_APPROX(cap_gnss_ptr->getFramePtr()->getState().head(2), t_map_base.head(2), 1e-6);
} }
......
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