Commit c8184429 authored by wangdawei's avatar wangdawei

revert to before test

parent 12cd7175
...@@ -83,10 +83,10 @@ void AdjustPPK::ReadBag(const string &bagPath) ...@@ -83,10 +83,10 @@ void AdjustPPK::ReadBag(const string &bagPath)
continue; continue;
} }
PPointCloud cloud; PPointCloud cloud;
// if(cloudCnt_ % 20 != 0){ if(cloudCnt_ % 20 != 0){
// cloudCnt_++; cloudCnt_++;
// continue; continue;
// } }
if(convert_->processScan(m.instantiate<pandar_msgs::PandarScan>(), cloud)){ if(convert_->processScan(m.instantiate<pandar_msgs::PandarScan>(), cloud)){
OnReceivedCloud(cloud); OnReceivedCloud(cloud);
} }
...@@ -126,12 +126,12 @@ void AdjustPPK::OnReceivedCloud(const PPointCloud &cloud) ...@@ -126,12 +126,12 @@ void AdjustPPK::OnReceivedCloud(const PPointCloud &cloud)
// } // }
double backPTime = cloud.back().timestamp; double backPTime = cloud.back().timestamp;
double frontPTime = cloud.front().timestamp; double frontPTime = cloud.front().timestamp;
// if(frontPTime < localPoseVec_.front().timestamp){ if(frontPTime < localPoseVec_.front().timestamp){
// return; return;
// } }
// if(backPTime > localPoseVec_.back().timestamp){ if(backPTime > localPoseVec_.back().timestamp){
// return; return;
// } }
vector<IsometryData> periodPose = HandleLocalPPK(backPTime, frontPTime); vector<IsometryData> periodPose = HandleLocalPPK(backPTime, frontPTime);
CloudPacket cloudPacket; CloudPacket cloudPacket;
ros::Time rosTime; ros::Time rosTime;
...@@ -143,8 +143,7 @@ void AdjustPPK::OnReceivedCloud(const PPointCloud &cloud) ...@@ -143,8 +143,7 @@ void AdjustPPK::OnReceivedCloud(const PPointCloud &cloud)
// << " frontPTime: " << cloud.front().timestamp // << " frontPTime: " << cloud.front().timestamp
// << " backPTime: " << cloud.back().timestamp; // << " backPTime: " << cloud.back().timestamp;
pcl::io::savePCDFileBinary(ieBaseDir_ + "/baseCloud/" + to_string(cloudPacket.timestamp) + "_ori.pcd", cloud);
exit(0);
for(size_t i = 0; i < cloud.size(); i++){ for(size_t i = 0; i < cloud.size(); i++){
if(i % 5 != 0){ if(i % 5 != 0){
continue; continue;
......
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