grid voxels using pcl::PointCloud and sensor_msgs::PointCloud2