4.PCL点云的数据结构

文章目录

Kd-Tree
- K临近搜索（KNN）
- R临近搜索（RNN）
Octree
- K临近搜索（KNN）
- R临近搜索（RNN）
总结

Kd-Tree

Kd-Tree 是一种用于多维空间的关键字搜索树，广泛应用于点云的邻近点搜索和最近邻搜索。它通过递归地将k维数据空间分割成多个子空间来构造一棵二叉树。每个节点代表一个超平面，该超平面垂直于当前选择维度的坐标轴，并通过数据点在该维度上的中位数来划分空间。

复制代码

特点：
    对于低维度（通常是2D或3D）的数据集，Kd-Tree 的构建和查询效率非常高。
    在构建树时，通常会选择方差最大的维度作为分裂维度以达到更好的平衡性。
    最近邻搜索的时间复杂度大约为 O(log n)，但在最坏情况下可能退化为 O(n)。

应用场景：
    快速查找最近邻点。
    范围查询：找出给定距离内的所有点。
    配准算法中的特征匹配步骤。

K临近搜索（KNN）

在Kd-Tree中执行K临近搜索时，算法会从根节点开始递归地遍历树，优先访问那些与查询点距离最近的子节点。一旦找到了K个邻居后，它会继续检查剩余部分是否有可能包含更接近的点。这个过程利用了树结构来减少不必要的距离计算，从而提高效率。

c 复制代码

pcl::KdTreeFLANN<pcl::PointXYZ> kdtree;
kdtree.setInputCloud(cloud); // 设置输入点云
std::vector<int> pointIdxNKNSearch(K);
std::vector<float> pointNKNSquaredDistance(K);
int result = kdtree.nearestKSearch(searchPoint, K, pointIdxNKNSearch, pointNKNSquaredDistance);

R临近搜索（RNN）

R临近搜索则是在给定半径范围内找到所有邻近点。这同样利用了Kd-Tree的结构，但是这次不是寻找固定的K个最接近的邻居，而是查找所有位于指定半径内的点。

c 复制代码

std::vector<int> pointIdxRadiusSearch;
std::vector<float> pointRadiusSquaredDistance;
float radius = 0.03; // 设定搜索半径
int result = kdtree.radiusSearch(searchPoint, radius, pointIdxRadiusSearch, pointRadiusSquaredDistance);

Octree

Octree 是一种层次数据结构，特别适用于三维空间的表示。它通过对空间进行递归的八分法分割来组织数据。每个内部节点有八个子节点，对应于父节点所表示的空间区域被均匀分成的八个子区域。

复制代码

特点：
    对于大规模点云数据，尤其是那些分布在三维空间中的数据，Octree 提供了一种有效的压缩和索引机制。
    它可以很好地适应不规则分布的数据，因为只有包含点的空间块才会进一步细分。
    支持动态更新，即可以在不影响其他部分的情况下添加或删除特定区域内的点。

应用场景：
    点云压缩与简化：通过减少空或稀疏区域的细节级别来降低数据量。
    可视化：快速渲染大规模点云或场景。
    撞击检测：在游戏中或者机器人路径规划中判断物体是否相撞。
    地形建模：对地理信息系统(GIS)中的地形数据进行管理和查询。

K临近搜索（KNN）

对于Octree，由于其特殊的八叉分层结构，K临近搜索可能不像Kd-Tree那样直接，但也可以通过遍历相关体素以及周边体素来实现。不过，在实际应用中，Octree更多用于范围查询或体素内搜索，而不是严格的K临近搜索。

c 复制代码

pcl::octree::OctreePointCloudSearch<pcl::PointXYZ> octree(resolution);
octree.setInputCloud(cloud);
octree.addPointsFromInputCloud();
std::vector<int> pointIdxNKNSearch;
// 注意这里没有直接的KNN函数，需要自己实现或者使用其他方法。

R临近搜索（RNN）

在Octree中，R临近搜索可以非常高效地执行，因为只需要检查与查询点相关的体素及其相邻体素即可。这样就可以避免对整个点集进行距离计算。

c 复制代码

std::vector<int> pointIdxRadiusSearch;
std::vector<float> pointRadiusSquaredDistance;
float radius = 0.03; // 设定搜索半径
octree.radiusSearch(searchPoint, radius, pointIdxRadiusSearch, pointRadiusSquaredDistance);

在PCL库中，radiusSearch 方法既可以用于Kd-Tree也可以用于Octree来进行R临近搜索。然而，Kd-Tree有内置的方法支持K临近搜索，而Octree一般不直接提供K临近搜索的功能，如果需要的话，开发者可能需要自己实现逻辑来完成这一任务。在某些情况下，可以通过结合Octree和其他搜索策略（如线性扫描）来实现K临近搜索

总结

如果你需要在一个相对较低维度的空间内执行高效的最近邻搜索，那么 Kd-Tree 可能是更好的选择。
若你的应用涉及三维空间的大规模点云管理，包括但不限于压缩、可视化、碰撞检测等，Octree 则显得更加合适