Commit b074e021 authored by wangdawei's avatar wangdawei

parse test

parent ee196d8f
...@@ -124,12 +124,12 @@ void AdjustPPK::OnReceivedCloud(const PPointCloud &cloud) ...@@ -124,12 +124,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;
......
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