Skip to content

L
localize_for_ppk
Commit 2adc0e75 authored by wangdawei's avatar wangdawei
Browse files
Options

test

parent bbd2c023
Show whitespace changes
Inline Side-by-side
Showing with 4 additions and 0 deletions
libs/locate_system/adjust_ppk_by_locate/adjust_ppk.cpp
View file @ 2adc0e75
...@@ -537,7 +537,11 @@ bool AdjustPPK::LocateCloud(const CloudInfoForMatch &cloudInfo) ...@@ -537,7 +537,11 @@ bool AdjustPPK::LocateCloud(const CloudInfoForMatch &cloudInfo)
guessPose.rotation = 0.01; guessPose.rotation = 0.01;
guessPose.use_gnss = false; guessPose.use_gnss = false;
if(!currMatcher_->IsMapLoaded(guess.translation())){ if(!currMatcher_->IsMapLoaded(guess.translation())){
auto start = std::chrono::high_resolution_clock::now();
currMatcher_->loadArea(guess.translation()); currMatcher_->loadArea(guess.translation());
auto end = std::chrono::high_resolution_clock::now();
auto time_used = std::chrono::duration_cast<std::chrono::duration<double>>(end - start).count();
LOG(INFO) << "loadArea time_used " << time_used;
} }
double avgGridCnt = currMatcher_->AreaAvgGridCnt(guess.translation()); double avgGridCnt = currMatcher_->AreaAvgGridCnt(guess.translation());
if(avgGridCnt < 20000){ if(avgGridCnt < 20000){
......
Markdown is supported
0% or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment