Skip to content
Snippets Groups Projects
Commit 5ae9ba29 authored by Joan Vallvé Navarro's avatar Joan Vallvé Navarro
Browse files

hotfix: gtest fixed!

parent 3c0243ec
No related branches found
No related tags found
2 merge requests!39release after RAL,!38After 2nd RAL submission
...@@ -50,21 +50,15 @@ class FeatureImu_test : public testing::Test ...@@ -50,21 +50,15 @@ class FeatureImu_test : public testing::Test
// Time and data variables // Time and data variables
TimeStamp t; TimeStamp t;
Eigen::Vector6d data_; Eigen::Vector6d data_=Eigen::Vector6d::Zero();
t.set(0); t.set(0);
// Set the origin // Set the origin
VectorComposite x0("POV", {Vector3d::Zero(), Quaterniond::Identity().coeffs(), Vector3d::Zero()}); VectorComposite x0("POV", {Vector3d::Zero(), Quaterniond::Identity().coeffs(), Vector3d::Zero()});
VectorComposite s0("POV", {Vector3d(1,1,1), Vector3d(1,1,1), Vector3d(1,1,1)}); VectorComposite s0("POV", {Vector3d(1,1,1), Vector3d(1,1,1), Vector3d(1,1,1)});
problem->setPriorOptions("factor", 0.01, x0, s0); origin_frame = problem->setPriorFactor(x0, s0, t, 0.01);
// initial dummy capture process for seting prior at t=0 processor_motion_ptr_->setOrigin(origin_frame);
std::make_shared<CaptureImu>(t,
sensor_ptr,
data_,
Eigen::Matrix6d::Identity()*0.01,
Eigen::Vector6d::Zero())->process();
origin_frame = problem->getTrajectory()->getFrameList().front();
// Emplace one capture to store the Imu data arriving from (sensor / callback / file / etc.) // Emplace one capture to store the Imu data arriving from (sensor / callback / file / etc.)
// give the capture a big covariance, otherwise it will be so small that it won't pass following assertions // give the capture a big covariance, otherwise it will be so small that it won't pass following assertions
......
0% Loading or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment