PCL KdTree 求最邻近的点和点间距

最新推荐文章于 2023-09-25 22:43:45 发布

原创

最新推荐文章于 2023-09-25 22:43:45 发布 · 684 阅读

1 ·

CC 4.0 BY-SA版权

本文详细介绍了如何使用Point Cloud Library（PCL）中的KdTree结构来实现三维点云中寻找最邻近点的过程，并探讨了计算两点间距离的方法，为3D点云处理提供关键技术支持。

#include <pcl/point_types.h>
#include <pcl/kdtree/kdtree_flann.h>
#include <iostream>
#include <vector>
#include <ctime>
#include <math.h>

int
main(int argc, char** argv)
{
   
   
	pcl::PointCloud<pcl::PointXYZ>::Ptr cloud(new pcl::PointCloud<pcl::PointXYZ>());


	cloud->width = 100;
	cloud->height = 1;

	cloud->resize(cloud->width * cloud->height);

	for (std::size_t i = 0; i < cloud->size(); i++)
	{
   
   
		(*cloud)