Skip to content

L
localize_for_ppk
Commit 133a399f authored by wangdawei's avatar wangdawei
Browse files
Options

save frame

parent 983c4d96
Show whitespace changes
Inline Side-by-side
Showing with 4 additions and 4 deletions
libs/locate_system/adjust_ppk_by_locate/adjust_ppk.cpp
View file @ 133a399f
......@@ -177,9 +177,9 @@ void AdjustPPK::OnReceivedCloud(const PPointCloud &cloud)
LocateCloud(cloudInfo);
// PointCloudJ mathedCloud;
// pcl::transformPointCloud(*cloudInfo.frame, mathedCloud, mapPose_.cast<float>());
// pcl::io::savePCDFileBinary(ieBaseDir_ + "/baseCloud/" + to_string(cloudInfo.timestamp) + "_matched.pcd", mathedCloud);
PointCloudJ mathedCloud;
pcl::transformPointCloud(*cloudInfo.frame, mathedCloud, mapPose_.cast<float>());
pcl::io::savePCDFileBinary(ieBaseDir_ + "/baseCloud/" + to_string(cloudInfo.timestamp) + "_matched.pcd", mathedCloud);
}
void AdjustPPK::LoadPPK()
......@@ -427,7 +427,7 @@ bool AdjustPPK::Undisort(
PointCloudJ mappedFrame;
CloudPreprocess::Instance()->Undisort(
frame, undisortedFrame, &mappedFrame, periodPose.back().timestamp, &periodPose, framePose, increasePose);
// pcl::io::savePCDFileBinary(ieBaseDir_ + "/baseCloud/" + to_string(rawFrame.timestamp) + "_mapped.pcd", mappedFrame);
pcl::io::savePCDFileBinary(ieBaseDir_ + "/baseCloud/" + to_string(rawFrame.timestamp) + "_mapped.pcd", mappedFrame);
cloudInfo.frame = undisortedFrame;
cloudInfo.filterPoseInfo.increasePose = increasePose;
cloudInfo.timestamp = rawFrame.timestamp;
......
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