Skip to content

Commit

Permalink
Revert "Actually, lets deskew at the end of the scan as it should be"
Browse files Browse the repository at this point in the history
This reverts commit c450246.
  • Loading branch information
tizianoGuadagnino committed Dec 5, 2024
1 parent c450246 commit 2953d9f
Showing 1 changed file with 2 additions and 2 deletions.
4 changes: 2 additions & 2 deletions cpp/kiss_icp/core/Preprocessing.cpp
Original file line number Diff line number Diff line change
Expand Up @@ -37,7 +37,7 @@
#include <vector>

namespace {
constexpr double final_pose_stamp{1.0};
constexpr double mid_pose_timestamp{0.5};
struct StubDeskewer {
StubDeskewer(const std::vector<double> &timestamps, const Sophus::SE3d &relative_motion)
: stamps_(timestamps), motion_(relative_motion) {}
Expand All @@ -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;
}
};
Expand Down

0 comments on commit 2953d9f

Please sign in to comment.