Commit 56d31b97 authored by wangdawei's avatar wangdawei

test

parent 557a8871
Pipeline #1524 canceled with stages
......@@ -266,6 +266,9 @@ bool AdjustPPK::LocateCloud(const CloudInfoForMatch &cloudInfo)
guessPose.precision_type = MATCH_PRECISION_FULL;
GnssPoint finalGnssPose;
if(!currMatcher_->IsMapLoaded(mapPose.translation().cast<double>())){
currMatcher_->loadArea(mapPose.translation().cast<double>());
}
success = currMatcher_->MatchPointCloud(cloudInfo.frame, guessPose, finalGnssPose, mapPose);
std::ofstream ofs(ieBaseDir_ + "/CloudPredictPose.txt", ios::app);
ofs << setprecision(16) << cloudInfo.timestamp << ", " << mapPose.translation().x()
......
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