PFH: point feature histogram 点特征直方图
FPFH: fast point feature histograms 快速点特征直方图
1.PFH由来
点特征的描述子一般是基于点坐标、法向量、曲率来描述某个点周围的几何特征。用点特征描述子不能提供点之间的特征关系,减少了全局特征信息。因此诞生了一直基于直方图的特征描述子:PFH–point feature histogram(点特征直方图)。
2.PFH的原理
PFH通过参数化查询点和紧邻点之间的空间差异,形成了一个多维直方图对点的近邻进行几何描述,直方图提供的信息对于点云具有平移旋转不变性,对采样密度和噪声点具有稳健性。PFH是基于点与其邻近之间的关系以及它们的 estimated normals (估计法线) 之间的相互关系,来描述几何特征。
前提知识:计算两个点的法线之间的偏差
- 首先在其中一个点上定义一个固定坐标系, u轴沿着其法线 n s n_s ns方向, p t − p s ∣ ∣ p t − p s ∣ ∣ 2 \frac{p_t-p_s}{||p_t-p_s||_2} ∣∣pt−ps∣∣2pt−ps 是两个点连线的单位向量,v轴垂直于 u轴和两点连线向量的平面, w轴垂直于u轴和v轴所在的平面
使用下图的uvw坐标系,法线ns,nt之间的偏差可以用一组角度表示
d是两点之间的欧氏距离, d = ∣ ∣ p t − p s ∣ ∣ 2 d=||p_t-p_s||_2 d=∣∣pt−ps∣∣2 ,利用α,φ,θ,d,四个元素可以构成PFH描述子
PFH翻译成点特征直方图,四个元素和直方图有什么关系?
首先计算查询点Pq近邻内的对应的所有四个元素,
如图所示,表示的是一个查询点(Pq) 的PFH计算的影响区域,Pq 用红色标注并放在圆球的中间位置,半径为r, (Pq)的所有k邻元素(即与点Pq的距离小于半径r的所有点)全部互相连接在一个网络中。最终的PFH描述子通过计算邻域内所有两点之间关系而得到的直方图,因此存在一个O(k) 的计算复杂性。
为了创建最终的直方图,将所有四元素组以统计的方式放入一个直方图中,这个过程首先把每个特征值范围划分为b个子区间,并统计落在每个子区间的点数量,前三个元素均是角度,都和法向量有关系,可以将三个元素标准化并放到同一个区间内。
前三个特征的直方图举例如下:
横坐标表示角度,纵坐标表示区间内点云的数量
3.FPFH的由来
具有n个点的点云p的点特征直方图的理论计算复杂度为 O ( n k 2 ) O(nk^2) O(nk2),其中k是点云p中每个点p的邻近数。在密集点邻域中计算点特征柱状图可以表示映射框架中的主要瓶颈之一。本节提出了PFH公式的简单化,称为快速点特征直方图(FPFH:fast point feature histograms),它将算法的计算复杂度降低到 O ( n k ) O(nk) O(nk),同时仍然保留了PFH的大部分判别能力。
4.FPFH的原理
注意:FPFH 是由 SPFH 计算得出, SPFH后面有介绍,计算公式也在后面介绍。
Step 1:
- 只计算每个查询点Pq和它邻域点之间的三个特征元素(参考PFH, 舍弃d)
- PFH是计算邻域点所有组合的特征元素,而这一步只计算查询点和近邻点之间的特征元素。如下图,
- 第一个图是PFH计算特征过程,即邻域点所有组合的特征值(图中所有连线,包括Pq和Pk之间, 及Pk和Pk 之间的连线)
- 第二个图是FPFH中计算内容,只需要计算Pq(查询点)和紧邻点Pk(图2中红线部分)之间的特征元素。可以看出降低了复杂度我们称之为SPFH(simple point feature histograms)。
Step 2:
重新确定k近邻域,为了确定查询点Pq的近邻点Pk的SPFH值、查询点Pq和近邻的距离以及k的数值(一般使用半径kdtree搜索,只能确定某半径范围内的近邻点,不能确定具体的查询点与近邻的距离、k数值----PS:应该是这样,不过重新确定k近邻主要还为了计算查询点Pq的近邻点Pk的SPFH值)
Wk权重,一般为距离
5.二者区别和联系
(1)FPFH没有对近邻点所有组合进行计算可能漏掉一些重要点对
(2)PFH特征模型是对查询点周围精确的邻域半径内,而FPFH还包括半径r范围以外的额外点对(不过在2r内,这是由于计算SPFH(Pk)导致的)
(3)FPFH降低了复杂度,可以在实时场景中使用
(4)因为重新计算权重,所以FPFH结合SPFH值,重新获取重要的紧邻点对几何信息
(5)在FPFH中,通过分解三元组(三个角特征)简化了合成的直方图,即简单地创建b个相关的特征直方图,每个特征维数(dimension)对应一个直方图(bin),并将它们连接在一起。
- pcl默认,in PFH assume the number of quantum bins (i.e. subdivision intervals in a feature’s value range), bins=5即子区间数量,三个角特征元素,3^5=125,也就是一个查询点就有125个子区间,PFHSignature125的由来。这样有一个问题:对于点云特别是稀疏点云来说,很多区间存在0值,即直方图上存在冗余空间。
- 在FPFH中,通过分解三元组(三个角特征)简化了合成的直方图,即简单地创建b个不相关的特征直方图,每个特征维数(dimension)对应一个直方图(bin),并将它们连接在一起。pcl默认FPFH的b=11,3*11=33,也就是FPFHSignature33的由来。