test

95dcbfc3 · wangdawei · 8a44737b · 95dcbfc3
Commit 95dcbfc3 authored May 31, 2023 by wangdawei
Hide whitespace changes
Inline Side-by-side

Showing with 1 addition and 0 deletions

fast_voxel_matcher.cc libs/localize/voxel_map/fast_voxel_matcher.cc +1 -0

No files found.
--- a/libs/localize/voxel_map/fast_voxel_matcher.cc
+++ b/libs/localize/voxel_map/fast_voxel_matcher.cc
@@ -39,6 +39,7 @@ struct Candidate {
    bool operator>(const Candidate& other) const { return score > other.score; }

    Rigid3f GetPose(float resolution) const {
+        LOG(INFO) << "scan->pose.translation(): " << scan->pose.translation().transpose();
        return Rigid3f(scan->pose.translation() + resolution * offset.matrix().cast<float>(),
                       scan->pose.rotation());
    }