test

b6f59af5 · wangdawei · 37e247f7 · b6f59af5
Commit b6f59af5 authored May 25, 2023 by wangdawei
Show whitespace changes
Inline Side-by-side

Showing with 3 additions and 0 deletions

adjust_ppk.cpp libs/locate_system/adjust_ppk_by_locate/adjust_ppk.cpp +3 -0

No files found.
--- a/libs/locate_system/adjust_ppk_by_locate/adjust_ppk.cpp
+++ b/libs/locate_system/adjust_ppk_by_locate/adjust_ppk.cpp
@@ -251,6 +251,9 @@ bool AdjustPPK::Undisort(
    for(; ppkIndex_ < localPoseVec_.size(); ppkIndex_++){
        const auto &pose = localPoseVec_.at(ppkIndex_);
        if(pose.timestamp > backPTime){
+            LOG_EVERY_N(INFO, 1) << setprecision(15) << "pose.timestamp " << pose.timestamp
+                      << " frontPTime " << frontPTime
+                      << " backPTime " << backPTime;
            break;
        }
        if(pose.timestamp <= frontPTime){