diff --git a/src/test/gtest_IMU.cpp b/src/test/gtest_IMU.cpp index ab6d914c16446930506b626480dbafaa6531e7dc..d717135617eb64a0a07f019b54a26ed97f481152 100644 --- a/src/test/gtest_IMU.cpp +++ b/src/test/gtest_IMU.cpp @@ -376,6 +376,13 @@ class Process_Constraint_IMU : public testing::Test // ===================================== IMU CALLBACK processor_imu->keyFrameCallback(KF, 0.01); + + + + data = Vector6s::Zero(); + capture_imu = make_shared<CaptureIMU>(t+dt, sensor_imu, data, sensor_imu->getNoiseCov()); + processor_imu->process(capture_imu); + KF_1 = problem->getLastKeyFramePtr(); C_1 = KF_1->getCaptureList().front(); // front is IMU CM_1 = static_pointer_cast<CaptureMotion>(C_1);