1.一种附加多重约束的2-pointRANSAC方法,用于点云配准,在获取初始配对集后,通过转换参数,将原点云转换到目标点云,实现点云自动配准,其特征在于,包括以下步骤:步骤S1、从初始配对集中,通过局部形状描述获取初始配对集,随机选取两个配对;
步骤S2、若选取的两个配对满足多重约束条件,则计算转换参数;
多重约束条件包括:
a.几何距离约束
给出两个配对(pi,qi)和(pj,qj),pi和pj是原点云的两个关键点,qi和qj是目标点云的两个关键点;若两个配对满足多重约束条件,则pi和pj之间的距离等于qi和qj之间的距离,因此几何距离约束定义为|d(pi,pj)-d(qi,qj)|<δ1 (1)上式中,|·|表示取绝对值,d表示两个关键点之间的距离,δ1表示阈值,设为2pr,pr表示点云分辨率;
b.局部参考轴角度约束
给出两个配对(pi,qi)和(pj,qj),pi和pj是原点云的两个关键点,qi和qj是目标点云的两个关键点;若两个配对满足多重约束条件,则pi和pj之间的法向夹角等于qi和qj之间的法向夹角,因此局部参考框架角度约束定义为上式中,arccos(·)表示反余弦函数,LRA表示关键点的局部参考轴,δ2表示阈值,设为10度;
c.局部参考框架角度约束
给出两个配对(pi,qi)和(pj,qj),pi和pj是原点云的两个关键点,qi和qj是目标点云的两个关键点;若两个配对满足多重约束条件,则pi和pj之间的局部参考框架夹角等于qi和qj之间的局部参考框架夹角,局部参考框架角度约束定义为上式中,trace(·)表示求矩阵的迹,V表示关键点的局部参考框架,δ3是一个阈值,设为10度;
d.法向投影距离约束
给出两个配对(pi,qi)和(pj,qj),pi和pj是原点云的两个关键点,qi和qj是目标点云的两个关键点;若两个配对满足多重约束条件,则由一个关键点到另一个关键点的法向量上的投影距离是固定不变的,因此对于给出的两个配对(pi,qi)和(pj,qj),计算其四个投影距离上式中,n表示关键点的法向量;
由此法向投影距离约束定义为
|d1-d3|<δ4,|d2-d4|<δ4 (5)式中,δ4是一个阈值,设为2pr;
步骤S3、根据步骤S2计算出的转换参数,将原点云转换到目标点云,计算两个点云重叠区域的点数,作为内点数;
步骤S4、重复步骤S1~S3,直到达到设置的最大迭代次数,将最大内点数所对应的转换参数作为最佳转换进行输出。
2.根据权利要求1所述的一种附加多重约束的2-pointRANSAC方法,其特征在于,步骤S1中通过局部形状描述获取初始配对集,具体过程如下:首先从两个待配准点云中提取关键点,采用ISS关键点探测器、3D Harris关键点探测器,然后计算关键点的局部形状描述符,最后采用最近邻相似比率NNSR比较描述符的相似性,建立两个点云之间的配对,得到初始配对集。
3.根据权利要求1所述的一种附加多重约束的2-pointRANSAC方法,其特征在于,步骤S2中所述转换参数包括旋转矩阵和平移向量的计算过程如下:给出两个配对(pi,qi)和(pj,qj),pi和pj是原点云的两个关键点,qi和qj是目标点云的两个关键点;若两个配对满足多重约束条件,根据关键点和它们的法向量,计算四个点如下由点构建如下矩阵
计算协方差矩阵Σ
上式中,是A的平均,是Y的平均,ones(4,1)表示元素值全为1的4行1列的向量;对协方差矩阵实施奇异值分解,得到USVT=svd(Σ) (9)
则旋转矩阵计算为
R=VDUT (10)
上式中,D=diag(1,1,det(UVT)),diag(·)表示对角矩阵,det(·)表示取矩阵的行列式;
平移向量计算为
上式中,是qi和qj的平均,是pi和pj的平均。
4.根据权利要求1所述的一种附加多重约束的2-point RANSAC方法,其特征在于,步骤S3所述根据步骤S2计算出的转换参数,将原点云转换到目标点云,计算两个点云重叠区域的点数,作为内点数,具体计算过程如下:步骤S31、根据计算的转换参数,将原点云转换到目标点云,对于每个转换的点,找到它在目标点云中的最近点,如果这个点到它最近点的距离小于3pr,则认为这个点是内点,统计全部的内点数。