Skip to content

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

save frame

parent 63796d75
Hide 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 @ b4b256d7
......@@ -168,9 +168,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()
......@@ -404,7 +404,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