Commit 03b9b75f authored by wangdawei's avatar wangdawei

test

parent 868a7556
...@@ -116,18 +116,11 @@ void AdjustPPK::OnReceivedCloud(const PPointCloud &cloud) ...@@ -116,18 +116,11 @@ void AdjustPPK::OnReceivedCloud(const PPointCloud &cloud)
pcl_conversions::fromPCL(cloud.header.stamp, rosTime); pcl_conversions::fromPCL(cloud.header.stamp, rosTime);
cloudPacket.timestamp = rosTime.toSec(); cloudPacket.timestamp = rosTime.toSec();
cloudPacket.cloud.reserve(cloud.size()); cloudPacket.cloud.reserve(cloud.size());
LOG_EVERY_N(INFO, 100) << setprecision(15) << "OnReceivedCloud: " << cloudPacket.timestamp // LOG_EVERY_N(INFO, 100) << setprecision(15) << "OnReceivedCloud: " << cloudPacket.timestamp
<< " cloud.size(): " << cloud.size() // << " cloud.size(): " << cloud.size()
<< " frontPTime: " << cloud.front().timestamp // << " frontPTime: " << cloud.front().timestamp
<< " backPTime: " << cloud.back().timestamp; // << " backPTime: " << cloud.back().timestamp;
// if(cloudPacket.timestamp < 1683806268.156870){
// return;
// }
// if(cloudPacket.timestamp > 1683806268.956870){
// exit(0);
// }
// pcl::io::savePCDFileBinary(ieBaseDir_ + "/" + to_string(cloudPacket.timestamp) + "_raw.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;
......
...@@ -92,7 +92,7 @@ public: ...@@ -92,7 +92,7 @@ public:
return currMesh_->IsAreaLoaded(pose); return currMesh_->IsAreaLoaded(pose);
} }
inline bool AreaAvgGridCnt(const Vector3d& pose){ inline double AreaAvgGridCnt(const Vector3d& pose){
return currMesh_->AreaAvgGridCnt(pose); return currMesh_->AreaAvgGridCnt(pose);
} }
......
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