本文由CSDN点云侠原创,原文链接,首发于:2021年3月7日。抄袭狗把自己当个狗!!!。
博客长期更新,本文最新更新时间为:2024年10月18日。代码在PCL1.14.1中测试通过
ICP基础理论参考:PCL ICP算法实现点云精配准
一、 KD-ICP配准
1、KD-tree优化的ICP
通过构建的KD-tree实现最近邻算法,对粗配准后的点进行近邻搜索。以欧氏距离为判断标准,剔除欧氏距离大于阈值的配准关键点,保存配准精度高的点,具体步骤如下:
- 寻找目标点的叶节点:从根节点递归向下搜索KD-t