ROS_Robot/wpb_home
1
0
Fork 0
mirror of https://github.com/6-robot/wpb_home.git synced 2025-09-15 12:58:59 +08:00
Code Issues Actions Packages Projects Releases Wiki Activity

pointcloud demo

Browse Source
This commit is contained in:
ZhangWanjie 2019-07-26 11:48:23 +08:00
parent f6ec90651d
commit 32cd8f1817
1 changed files with 8 additions and 6 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

14
wpb_home_tutorials/src/wpb_home_pointcloud_node.cpp
View File

@ -45,12 +45,14 @@ void callbackPC(const sensor_msgs::PointCloud2ConstPtr& msg)
pcl::fromROSMsg(*msg , pointCloudIn); pcl::fromROSMsg(*msg , pointCloudIn);
int cloudSize = pointCloudIn.points.size(); int cloudSize = pointCloudIn.points.size();
int pcIndex = cloudSize/2; for(int i=0;i<cloudSize;i++)
ROS_INFO("[pcIndex= %d] ( %.2f , %.2f , %.2f)", {
pcIndex , ROS_INFO("[i= %d] ( %.2f , %.2f , %.2f)",
pointCloudIn.points[pcIndex].x, i ,
pointCloudIn.points[pcIndex].y, pointCloudIn.points[i].x,
pointCloudIn.points[pcIndex].z); pointCloudIn.points[i].y,
pointCloudIn.points[i].z);
}
} }
int main(int argc, char **argv) int main(int argc, char **argv)