MACourtney7

pcl voxelgrid filter

Feb 2nd, 2017
232
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
C++ 0.81 KB | None | 0 0
  1. #include <iostream>
  2. #include <pcl/io/pcd_io.h>
  3. #include <pcl/point_types.h>
  4. #include <pcl/filters/voxel_grid.h>
  5.  
  6. using pcl::PointXYZ;
  7. typedef pcl::PointCloud<PointXYZ> PointCloud;
  8.  
  9. static PointCloud::Ptr voxel_grid ( const PointCloud::Ptr input_cloud ) {
  10.     PointCloud::Ptr cloud_filtered(new PointCloud);
  11.    
  12.     pcl::VoxelGrid<PointCloud> filter;
  13.     filter.setInputCloud(input_cloud);
  14.     filter.setLeafSize(0.01f, 0.01f, 0.01f);
  15.     filter.filter(*cloud_filtered);
  16.    
  17.     return cloud_filtered;
  18. }
  19.  
  20. void filter ( const PointCloud::Ptr input_cloud ) {
  21.     const PointCloud::Ptr cloud_filtered(voxel_grid(input_cloud));
  22.    
  23.     std::cout << "input_points:" << input_cloud->width * input_cloud->height
  24.               << ", output_points:" << cloud_filtered->width * cloud_filtered->height << std::endl;
  25. }
Advertisement
Add Comment
Please, Sign In to add comment