在做三维点云匹配(Point cloud registration)的时候,通用的做法是先做基于特征及RANSAC的粗匹配,然后再做一轮精匹配。粗匹配常使用的一种特征是FPFH特征,而精匹配一般使用的是ICP(Iterative closest point)的方法。本文主要是记录FPFH特征。
PFH (Point Feature Histogram)
我们先介绍一下PFH特征。对于点云中的任意一点,我们定义一个半径,对于在定义的球形邻域内,任意两个点,PFH的定义过程如下:
- 计算之间的特征描述
定义一个局部坐标系
特征可计算为
- 计算histogram:将每个feature按预设的大小设置个bin,然后查看对应的特征描述落在哪个区间,对于的领域内所有的点对,可以得到对应的feature histogram.
在PCL的实现中,是不考虑的,而对于角度分量,每个分量被分成了11个bin,由于角度是在中的,所以上述公式中对应的.
SPFH (Simplified Point Feature Histogram)
SPF是PFH的一种简化版,区别在于计算histogram的时候,只使用点与其他点构成的点对。
FPFH
FPFH的计算可以按如下定义