diff --git a/test/gtest_problem.cpp b/test/gtest_problem.cpp index f1c7424d93ade98b8f836d23262aad75474d9ad6..f397abfa4ab44b038018f8b58a96fb34d6f11c66 100644 --- a/test/gtest_problem.cpp +++ b/test/gtest_problem.cpp @@ -338,19 +338,18 @@ TEST(Problem, perturb) Vector3d pose; pose << 0,0,0; + int i = 0; for (TimeStamp t = 0.0; t < 2.0; t += 1.0) { - for ( int i = 0; i < 2; i++) + auto F = problem->emplaceFrame(KEY, pose, t); + if (i==0) F->fix(); + + for (int j = 0; j< 2 ; j++) { - auto F = problem->emplaceFrame(KEY, pose, t); - if (i==0) F->fix(); - - for (int j = 0; j< 2 ; j++) - { - auto sb = std::make_shared<StateBlock>(Vector3d(1,1,1)); - auto cap = CaptureBase::emplace<CaptureBase>(F, "CaptureBase", t, sensor, nullptr, nullptr, sb); - } + auto sb = std::make_shared<StateBlock>(Vector3d(1,1,1)); + auto cap = CaptureBase::emplace<CaptureBase>(F, "CaptureBase", t, sensor, nullptr, nullptr, sb); } + i++; } for (int l = 0; l < 2; l++)