[发明专利]一种基于Loam曲率加权的点集刚体配准方法

摘要

本发明公开一种基于Loam曲率加权的点集刚体配准方法，首先获取待配准点集的坐标信息；然后基于各点的位置信息以及各点的邻域点集提取各点的Loam曲率特征值；然后根据对应点间的曲率关系对各点对分配配准权重建立加权目标函数；最后将点集配准加权目标函数引入迭代最近点算法的迭代框架，实现点集间的精确配准；本发明能够有效地降低部分点集缺失和大量噪声点对配准结果产生的“负面影响”，提高了点集配准的鲁棒性和精确性。

主权项

1.一种基于Loam曲率加权的点集刚体配准方法，其特征在于：该点集刚体配准方法包括以下步骤：1)首先获取待配准点集的坐标信息；然后基于各点的位置信息以及各点的邻域点集提取各点的Loam曲率特征值；首先获取待配准点集的形状点集和模型点集中各点的二维空间中的坐标信息，其中为形状点集X中的第i个点，N_x为形状点集中点的个数，为模型点集Y中第i个点，N_y为模型点集中点的个数；而后提取形状点集X和模型点集Y中各点的Loam曲率特征：对于形状点集X中的点寻找形状点集中距离该点小于γ的点并将其组织为的点的邻域点集S，基于如下的公式计算点的Loam曲率特征值：其中：γ为点到其邻域点集中其他点的最长距离，c(x_i)为点的Loam曲率特征值，|S|为邻域点集中点的个数，为形状点集X中的第i点的坐标向量的模长；同理，模型点集Y中的每一个点的Loam曲率特征采用同样的方法取得；2)根据对应点间的曲率关系对各点对分配配准权重建立加权目标函数；根据点集的二维空间坐标信息与步骤1)所得到的各点的Loam曲率特征信息，建立基于Loam曲率的权重系数的点集配准加权目标函数；点集配准加权目标函数如下：s.t.R^TR＝I₂,det(R)＝1其中，为形状点集X中第i个点，为模型点集Y中与点对应的点，R为旋转变换矩阵，为平移变换向量，R^T为旋转变换矩阵的转置矩阵，I₂为二维单位向量，det(R)为旋转变换矩阵的行列式，为点处的Loam曲率特征值，为点处的Loam曲率特征值，σ为核参数，N_x为形状点集中包含的点的个数，N_y为模型点集中包含的点的个数；3)将步骤2)中的点集配准加权目标函数引入迭代最近点算法的迭代框架，实现点集间的精确配准。