PCL利用kdtree搜寻邻域点代码

最新推荐文章于 2024-09-04 16:19:04 发布

原创

最新推荐文章于 2024-09-04 16:19:04 发布 · 2.2k 阅读

15 ·

CC 4.0 BY-SA版权

文章标签：

#pcl #c++ #邻域点 #kdtree

PCL利用kdtree搜寻邻域点代码

代码功能：用两种方式搜索并且显示某点的邻域点的坐标和距离信息（半径限制和个数限制）
代码缺陷：没有添加可视化过程

#include <pcl/point_cloud.h>
#include <pcl/kdtree/kdtree_flann.h>
#include <iostream>
#include <vector>
#include <ctime>
#include <pcl/io/io.h>  
#include <pcl/io/pcd_io.h>  
#include <pcl/point_types.h>  
#include <pcl/visualization/cloud_viewer.h>  
using namespace std;
using namespace pcl;
using namespace pcl::io;
using namespace pcl::console;

int main(int argc, char** argv)
{
   
   
	std::string filename("C:\\Users\\426-4\\Desktop\\2_gt.pcd");
	//visualizer
	pcl::PointCloud<pcl