From 2132127f5df43e2c5185c48b12891876b18e5cf2 Mon Sep 17 00:00:00 2001 From: jcasals <jcasals@iri.upc.edu> Date: Fri, 5 Jun 2020 15:20:26 +0200 Subject: [PATCH] Fix find correct feature {Prior O/ Prior P} in gtest_problem --- test/gtest_problem.cpp | 10 ++++++---- 1 file changed, 6 insertions(+), 4 deletions(-) diff --git a/test/gtest_problem.cpp b/test/gtest_problem.cpp index 3790e5ba3..8ec6ebcae 100644 --- a/test/gtest_problem.cpp +++ b/test/gtest_problem.cpp @@ -125,8 +125,8 @@ TEST(Problem, SetOrigin_PO_2d) TrajectoryBasePtr T = P->getTrajectory(); FrameBasePtr F = P->getLastFrame(); CaptureBasePtr C = F->getCaptureList().front(); - FeatureBasePtr fo = C->getFeatureList().front(); - FeatureBasePtr fp = C->getFeatureList().back(); + FeatureBasePtr fo = (*std::find_if(C->getFeatureList().begin(), C->getFeatureList().end(), [](FeatureBasePtr ftr){ return ftr->getType() == "Prior O";})); + FeatureBasePtr fp = (*std::find_if(C->getFeatureList().begin(), C->getFeatureList().end(), [](FeatureBasePtr ftr){ return ftr->getType() == "Prior P";})); FactorBasePtrList fac_list; F->getFactorList(fac_list); @@ -182,8 +182,10 @@ TEST(Problem, SetOrigin_PO_3d) TrajectoryBasePtr T = P->getTrajectory(); FrameBasePtr F = P->getLastFrame(); CaptureBasePtr C = F->getCaptureList().front(); - FeatureBasePtr fo = C->getFeatureList().front(); - FeatureBasePtr fp = C->getFeatureList().back(); + // FeatureBasePtr fo = C->getFeatureList().front(); + // FeatureBasePtr fp = C->getFeatureList().back(); + FeatureBasePtr fo = (*std::find_if(C->getFeatureList().begin(), C->getFeatureList().end(), [](FeatureBasePtr ftr){ return ftr->getType() == "Prior O";})); + FeatureBasePtr fp = (*std::find_if(C->getFeatureList().begin(), C->getFeatureList().end(), [](FeatureBasePtr ftr){ return ftr->getType() == "Prior P";})); FactorBasePtrList fac_list; F->getFactorList(fac_list); -- GitLab