一种3D激光雷达点云数据预测点的快速选取配准方法技术

一种3D激光雷达点云数据预测点的快速选取配准方法，通过将激光雷达扫描的整个点云数据集等分割成一些子数据集，对子数据集中的各数据点进行规则划分处理后，再基于子数据集划分数据点的规则，分别为各个子数据集中的测试点进行快速配准处理，验证选取预测点。本发明专利技术提升三维点云数据集中预测点集的整体配准速率。所提出的三维激光雷达点云数据预测点的快速选取配准方法对于激光SLAM建图中点云数据的点集配准处理具有很大的参考价值。的点集配准处理具有很大的参考价值。的点集配准处理具有很大的参考价值。

【技术实现步骤摘要】
一种3D激光雷达点云数据预测点的快速选取配准方法


[0001]本专利技术涉及三维激光雷达的即时定位与建图
，具体涉及到一种3D 激光雷达点云数据预测点的快速选取配准方法。
技术背景
[0002]在地图构建步骤中，除了要为SLAM(Simultaneous Localization And Mapping) 确定地图表示形式外，还有一个重要目标：将新构造的地图元素控制在理想的位置上，以便于建立两帧地图间地图元素的对应关系，这也是为位姿估计步骤做准备。然而，3D环境要比2D环境更复杂，3D点集的数量也远远大于2D点集，进行直接的拓展会带来很大问题。因为地图重构方法中“预测”这一步骤的算法复杂度是O(n3)，计算量随点集的数量成三次方增长，数据量的急剧增加，为这一步的计算带来了繁重的负担。
[0003]为了克服现有技术的缺陷，本专利技术提供一种预测点快速选取配准方法，所研究的方法具有2D和3D之间的通用性。以解决现有SLAM技术背景中点集数据量大、数据处理慢且预测点集识别效率较低的问题。可通过分割多维数据空间的数据点集对比选取预测点集，通过计算测试点集与筛选的训练点集之间的相对距离，并进行预测点相对距离权重验证，实现快速精确选取预测点集位置，从而有助于高精度的快速定位建图。
[0004]现有技术中有关三维地图构建点集配准的方法在基于激光雷达的环境建模中得到了广泛的应用。专利CN202110066231.2公开了一种基于高斯距离的点云数据的处理方法。根据原始点云数据集的特征信息计算点云数据集中所有的点到关键点的高斯距离，再基于高斯距离确定关键点的相邻点集；对相邻点集进行特征聚合，生成关键点对应的特征点集来建图。专利CN202011328046.8公开了一种基于多点云数据矩阵的点云数据处理方法，通过预先训练得到的点云重构模型中的序列化网络层对所述点云矩阵进行序列化处理,来获得多个子特征矩阵,再基于多子特征矩阵进行拼接处理,得到第一特征矩阵,基于所述点云重构模型中的重构网络层对所述第一特征矩阵进行重构。专利CN201910438575.4公开了一种基于坐标积分图像局部法向量聚类的点云数据处理方法。通过确定点云数据的坐标积分图像和深度积分图像，根据所述坐标积分图像和所述深度积分图像,确定所述点云数据中的每个点分别对应的局部法向量，再根据各所述局部法向量对所述点云数据中的点进行聚类得到不同类别的点集,来确定各类别点集对应的物体信息。然而此类方法存在以下几个问题：第一，此类专利技术通常利用传统机器学习算法对预测点进行识别，由于预测点排列的不规则性此类方法效率较低；第二，在这些研究中，它们都将应用场景的结构当作单一曲面来进行建模，当建图区域过大时，误差会被放大，不同的训练点之间在选取预测点时会受到影响；并且第三，当建图区域过大时，面对巨大的数据量，其算法计算速度慢，进而建图速度就变得相对缓慢。

技术实现思路

[0005]为了克服现有技术的不足，本专利技术提供一种3D激光雷达点云数据预测点的快速选
取配准方法，面对一些复杂场景的三维点云地图构建，这些场景中通常都含有多曲面、多层面的结构(例如，两堵相互垂直的墙)，复杂的3D环境下，地图重构方法中“预测”这一步骤的算法复杂度是O(n3)，计算量随点集的数量成三次方增长，数据量的急剧增加，为这一步的计算带来了繁重的负担，进行直接的拓展会带来很大计算难度；本专利技术通过将激光雷达扫描的整个点云数据集分割成一些子数据集，分别为各个子数据集中的预测点进行快速配准处理，进一步提升三维点云数据集中预测点集的整体配准速率。
[0006]为解决上述技术问题本专利技术的技术方案为，
[0007]一种3D激光雷达点云数据预测点的快速选取配准方法，包括以下步骤：
[0008]步骤1：首先用三维激光雷达对区域A进行扫描，获得区域A的点云数据点集Φ，将数据集Φ作为输入项；
[0009]步骤2：将点云数据集Φ等分为n个子数据点集Φ
i
(i＝1,
…
,n)，筛选保留符合条件的子点集Φ
j
(j＝1,
…
,k,k<n)用以参与点集配准，所述条件为子数据点集中数据点数>W,W为自行指定数值；
[0010][0011]其中：S
(Φ
′
)
表示参与点集配准的所有点集和；
[0012]步骤3：分析子点集Φ
j
中各数据点集分布情况，对点集Φ
j
中的各个数据点进行规则划分，构建子点集序列结构；
[0013]步骤4：根据子数据点集Φ
j
的划分规则对测试点进行定位，预测点进行选取，并进行最优预测点验证；
[0014]步骤5：输出三维激光雷达扫描的区域A中最终选取的用以建图的预测点集。
[0015]进一步，所述步骤3包括以下步骤：
[0016]步骤3.1：要处理的对象集合是一个三维空间中的数据集，首先需要将三维数据进行划分，以维度d作为标准来对数据进行划分，d∈{X，Y，Z}；
[0017]步骤3.2：首先对子点集Φ
j
每个维度上各数据点假设点集Φ
j
上有q个数据点，l＝1,2,3
…
q)进行整合处理，找出各维度数据点的中值每维度各数据点分别对该维度中值求差：
[0018][0019]其中：表示m维度的差值和；
[0020]通过比较每个维度的差值和大小来确定所选取的维度，差值和最大的维度即为参考维度d；
[0021]步骤3.3：在确定参考维度d后，基于该维度中值维度中值为d维度上的数据点中值，对三维数据点进行一次划分，以平面为分界，使得各数据点在d维度上，一侧的数据点值小于平面另一侧的所有数据点的值，对于划分产生的两个新子点集Φ
j1
、Φ
j2
的数据点以同样的方法再划分直到每个新产生的子点集不能再划分为止。
[0022]再进一步，所述步骤4包括以下步骤：
[0023]步骤4.1：基于步骤3所述，在完成子点集数据点划分后，对于某一测试点 P，就可以按照对应子点集的划分规则很快的进行定位，初步寻找出距其最近的预测点；
[0024]步骤4.2：计算测试点P与其初步判断得到的预测点的相对距离dis，以测试点P为圆心，相对距离dis为半径作球C
′
，进一步判断，距测试点P是否还有更近的训练样点，当球C
′
内存在其他训练样点时，可确定存在更优预测点，可通过距离权重值大小比较选取最优预测点并更新相对距离为dis
′
，同理，再以测试点P为圆心，相对距离dis
′
为半径作球，至预测球内不含有其他训练样点，结束搜索，可以将该思想扩充到全部的子点集Φ
j
中，以提升预测点选取的效率。
[0025]本专利技术的有益表现是：本专利技术提出了一种三维激光雷达点云数据中预测点的快速选取配本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种3D激光雷达点云数据预测点的快速选取配准方法，其特征在于，所述方法包括以下步骤：步骤1：首先用三维激光雷达对区域A进行扫描，获得区域A的点云数据点集Φ，将数据集Φ作为输入项；步骤2：将点云数据集Φ等分为n个子数据点集Φ
i
(i＝1,
…
,n)，筛选保留符合条件的子点集Φ
j
(j＝1，
…
，k，k<n)用以参与点集配准，所述条件为子数据点集中数据点数>W,W为自行指定数值；其中：S
(Φ
′
)
表示参与点集配准的所有点集和；步骤3：分析子点集Φ
j
中各数据点集分布情况，对点集Φ
j
中的各个数据点进行规则划分，构建子点集序列结构；步骤4：根据子数据点集Φ
j
的划分规则对测试点进行定位，预测点进行选取，并进行最优预测点验证；步骤5：输出三维激光雷达扫描的区域A中最终选取的用以建图的预测点集。2.如权利要求1所述的一种3D激光雷达点云数据预测点的快速选取配准方法，其特征在于，所述步骤3包括以下步骤：步骤3.1：要处理的对象集合是一个三维空间中的数据集，首先需要将三维数据进行划分，以维度d作为标准来对数据进行划分，d∈{X，Y，Z}；步骤3.2：首先对子点集Φ
j
每个维度上各数据点假设点集Φ
j
上有q个数据点，l...

【专利技术属性】
技术研发人员：付明磊，林洋，刘锦元，
申请(专利权)人：浙江工业大学，
类型：发明
国别省市：