12345qiupeng
/
cartographer
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

Also log the IMU correction as a quaternion. (#463)

master
Damon Kohler 2017-08-21 17:26:48 +02:00 committed by Wolfgang Hess
parent 0ef372d584
commit edfd6ac8d7
1 changed files with 6 additions and 5 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

11
cartographer/mapping_3d/sparse_pose_graph/optimization_problem.cc
View File

@ -290,12 +290,13 @@ void OptimizationProblem::Solve(const std::vector<Constraint>& constraints,
}
LOG(INFO) << "Gravity was: "
<< trajectory_data_[trajectory_id].gravity_constant;
const auto& imu_calibration =
trajectory_data_[trajectory_id].imu_calibration;
LOG(INFO) << "IMU correction was: "
<< common::RadToDeg(
2. *
std::acos(
trajectory_data_[trajectory_id].imu_calibration[0]))
<< " deg";
<< common::RadToDeg(2. * std::acos(imu_calibration[0]))
<< " deg (" << imu_calibration[0] << ", " << imu_calibration[1]
<< ", " << imu_calibration[2] << ", " << imu_calibration[3]
<< ")";
}
}