Skip to content

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

no save frame

parent c8184429
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 @ 727c5b2b
...@@ -171,9 +171,9 @@ void AdjustPPK::OnReceivedCloud(const PPointCloud &cloud) ...@@ -171,9 +171,9 @@ void AdjustPPK::OnReceivedCloud(const PPointCloud &cloud)
LocateCloud(cloudInfo); LocateCloud(cloudInfo);
PointCloudJ mathedCloud; // PointCloudJ mathedCloud;
pcl::transformPointCloud(*cloudInfo.frame, mathedCloud, mapPose_.cast<float>()); // pcl::transformPointCloud(*cloudInfo.frame, mathedCloud, mapPose_.cast<float>());
pcl::io::savePCDFileBinary(ieBaseDir_ + "/baseCloud/" + to_string(cloudInfo.timestamp) + "_matched.pcd", mathedCloud); // pcl::io::savePCDFileBinary(ieBaseDir_ + "/baseCloud/" + to_string(cloudInfo.timestamp) + "_matched.pcd", mathedCloud);
} }
void AdjustPPK::LoadPPK() void AdjustPPK::LoadPPK()
...@@ -407,7 +407,7 @@ bool AdjustPPK::Undisort( ...@@ -407,7 +407,7 @@ bool AdjustPPK::Undisort(
PointCloudJ mappedFrame; PointCloudJ mappedFrame;
CloudPreprocess::Instance()->Undisort( CloudPreprocess::Instance()->Undisort(
frame, undisortedFrame, &mappedFrame, periodPose.back().timestamp, &periodPose, framePose, increasePose); 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.frame = undisortedFrame;
cloudInfo.filterPoseInfo.increasePose = increasePose; cloudInfo.filterPoseInfo.increasePose = increasePose;
cloudInfo.timestamp = rawFrame.timestamp; 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