diff --git a/test/gtest_feature_imu.cpp b/test/gtest_feature_imu.cpp index 916dc5c53d7064d1f4ca26bf941bb206fccd3c7a..ef63025f2b0db475bae9ceba850f960755570e08 100644 --- a/test/gtest_feature_imu.cpp +++ b/test/gtest_feature_imu.cpp @@ -84,20 +84,19 @@ class FeatureImu_test : public testing::Test //emplace Frame ts = problem->getTimeStamp(); state_vec = problem->getState().vector(problem->getFrameStructure()); - last_frame = problem->emplaceKeyFrame(ts, state_vec); + last_frame = problem->emplaceFrame(ts, state_vec); //emplace a feature delta_preint = processor_motion_ptr_->getMotion().delta_integr_; delta_preint_cov = processor_motion_ptr_->getMotion().delta_integr_cov_ + MatrixXd::Identity(9,9)*1e-08; VectorXd calib_preint = processor_motion_ptr_->getLast()->getCalibrationPreint(); dD_db_jacobians = processor_motion_ptr_->getMotion().jacobian_calib_; - feat_imu = std::static_pointer_cast<FeatureImu>( - FeatureBase::emplace<FeatureImu>(imu_ptr, - delta_preint, - delta_preint_cov, - calib_preint, - dD_db_jacobians, - imu_ptr) ); + feat_imu = FeatureBase::emplace<FeatureImu>(imu_ptr, + delta_preint, + delta_preint_cov, + calib_preint, + dD_db_jacobians, + imu_ptr) ; } void TearDown() override @@ -125,9 +124,6 @@ TEST_F(FeatureImu_test, check_frame) origin_frame->getTimeStamp(ts); ASSERT_NEAR(t.get(), ts.get(), wolf::Constants::EPS_SMALL) << "t != ts \t t=" << t << "\t ts=" << ts << std::endl; - ASSERT_TRUE(origin_frame->isKey()); - ASSERT_TRUE(last_frame->isKey()); - ASSERT_TRUE(left_frame->isKey()); wolf::StateBlockPtr origin_pptr, origin_optr, origin_vptr, left_pptr, left_optr, left_vptr; origin_pptr = origin_frame->getP(); diff --git a/test/gtest_imu.cpp b/test/gtest_imu.cpp index 6d51a5619ce1ff0615639be6d75ad3d7caf3089c..161157b8e079a5dd5f3dd4c873e754e021003c6f 100644 --- a/test/gtest_imu.cpp +++ b/test/gtest_imu.cpp @@ -502,7 +502,7 @@ class Process_Factor_Imu : public testing::Test virtual void buildProblem() { // ===================================== SET KF in Wolf tree - FrameBasePtr KF = problem->emplaceKeyFrame(t, x1_exact); + FrameBasePtr KF = problem->emplaceFrame(t, x1_exact); // ===================================== Imu CALLBACK problem->keyFrameCallback(KF, nullptr, dt/2);