diff --git a/test/gtest_processor_and_factor_pose_3d_with_extrinsics.cpp b/test/gtest_processor_and_factor_pose_3d_with_extrinsics.cpp index a9146cc7e3f49d70a208439c83b709646828d924..a81b36918ce96fa8d47d6387cdae5a24a6a95800 100644 --- a/test/gtest_processor_and_factor_pose_3d_with_extrinsics.cpp +++ b/test/gtest_processor_and_factor_pose_3d_with_extrinsics.cpp @@ -117,6 +117,8 @@ class FactorPose3dWithExtrinsicsBase_Test : public testing::Test sensor_pose_ = problem_->installSensor("SensorPose", "pose", extr, intr_sp); auto params_proc = std::make_shared<ParamsProcessorPose>(); auto proc_pose = problem_->installProcessor("ProcessorPose", "pose", sensor_pose_, params_proc); + // somehow by default the sensor extrinsics is fixed + sensor_pose_->unfixExtrinsics(); } void TearDown() override{}; @@ -258,15 +260,9 @@ TEST_F(FactorPose3dWithExtrinsicsMANUAL_Test, check_tree) TEST_F(FactorPose3dWithExtrinsicsMANUAL_Test, solve) { - // somehow by default the sensor extrinsics is fixed - // sensor_pose_->unfixExtrinsics(); - problem_->perturb(); - std::string report = solver_->solve(SolverManager::ReportVerbosity::FULL); - problem_->print(4,1,1,1); - SensorPosePtr sp = std::static_pointer_cast<SensorPose>(sensor_pose_); ASSERT_MATRIX_APPROX(KF1_->getStateVector(), pose1_, 1e-6); ASSERT_MATRIX_APPROX(KF2_->getStateVector(), pose2_, 1e-6); @@ -283,11 +279,7 @@ TEST_F(FactorPose3dWithExtrinsics_ProcessorWithKeyFrameCallbackFirst_Test, check TEST_F(FactorPose3dWithExtrinsics_ProcessorWithKeyFrameCallbackFirst_Test, solve) { - // somehow by default the sensor extrinsics is fixed - sensor_pose_->unfixExtrinsics(); - problem_->perturb(); - std::string report = solver_->solve(SolverManager::ReportVerbosity::FULL); SensorPosePtr sp = std::static_pointer_cast<SensorPose>(sensor_pose_); @@ -306,11 +298,7 @@ TEST_F(FactorPose3dWithExtrinsics_ProcessorWithProcessFirst_Test, check_tree) TEST_F(FactorPose3dWithExtrinsics_ProcessorWithProcessFirst_Test, solve) { - // somehow by default the sensor extrinsics is fixed - sensor_pose_->unfixExtrinsics(); - problem_->perturb(); - std::string report = solver_->solve(SolverManager::ReportVerbosity::FULL); SensorPosePtr sp = std::static_pointer_cast<SensorPose>(sensor_pose_);