diff --git a/cpp/kiss_icp/core/Preprocessing.cpp b/cpp/kiss_icp/core/Preprocessing.cpp index 63ff0b3c..186ee174 100644 --- a/cpp/kiss_icp/core/Preprocessing.cpp +++ b/cpp/kiss_icp/core/Preprocessing.cpp @@ -37,7 +37,7 @@ #include namespace { -constexpr double final_pose_stamp{1.0}; +constexpr double mid_pose_timestamp{0.5}; struct StubDeskewer { StubDeskewer(const std::vector ×tamps, const Sophus::SE3d &relative_motion) : stamps_(timestamps), motion_(relative_motion) {} @@ -54,7 +54,7 @@ struct MotionDeskewer : public StubDeskewer { Eigen::Vector3d operator()(const Eigen::Vector3d &point, const size_t &idx) { const auto delta_pose = motion_.log(); - const auto motion = Sophus::SE3d::exp((stamps_.at(idx) - final_pose_stamp) * delta_pose); + const auto motion = Sophus::SE3d::exp((stamps_.at(idx) - mid_pose_timestamp) * delta_pose); return motion * point; } };