CN113592926B - 一种3d激光雷达点云数据预测点的快速选取配准方法 - Google Patents
一种3d激光雷达点云数据预测点的快速选取配准方法 Download PDFInfo
- Publication number
- CN113592926B CN113592926B CN202110836883.XA CN202110836883A CN113592926B CN 113592926 B CN113592926 B CN 113592926B CN 202110836883 A CN202110836883 A CN 202110836883A CN 113592926 B CN113592926 B CN 113592926B
- Authority
- CN
- China
- Prior art keywords
- point
- data
- points
- sub
- dimension
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 24
- 238000012360 testing method Methods 0.000 claims abstract description 21
- 238000012549 training Methods 0.000 claims description 24
- 238000012216 screening Methods 0.000 claims description 3
- 230000010354 integration Effects 0.000 claims 1
- 238000012545 processing Methods 0.000 abstract description 11
- 238000010276 construction Methods 0.000 abstract description 4
- 238000013507 mapping Methods 0.000 description 8
- 238000004364 calculation method Methods 0.000 description 4
- 239000011159 matrix material Substances 0.000 description 4
- 239000013598 vector Substances 0.000 description 3
- 230000009286 beneficial effect Effects 0.000 description 2
- 230000007547 defect Effects 0.000 description 2
- 238000003672 processing method Methods 0.000 description 2
- 238000004220 aggregation Methods 0.000 description 1
- 230000002776 aggregation Effects 0.000 description 1
- 238000013459 approach Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000004807 localization Effects 0.000 description 1
- 238000010801 machine learning Methods 0.000 description 1
- 230000014759 maintenance of location Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 238000012795 verification Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T7/00—Image analysis
- G06T7/30—Determination of transform parameters for the alignment of images, i.e. image registration
- G06T7/33—Determination of transform parameters for the alignment of images, i.e. image registration using feature-based methods
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/88—Lidar systems specially adapted for specific applications
- G01S17/89—Lidar systems specially adapted for specific applications for mapping or imaging
- G01S17/894—3D imaging with simultaneous measurement of time-of-flight at a 2D array of receiver pixels, e.g. time-of-flight cameras or flash lidar
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T2207/00—Indexing scheme for image analysis or image enhancement
- G06T2207/10—Image acquisition modality
- G06T2207/10028—Range image; Depth image; 3D point clouds
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T2207/00—Indexing scheme for image analysis or image enhancement
- G06T2207/10—Image acquisition modality
- G06T2207/10032—Satellite or aerial image; Remote sensing
- G06T2207/10044—Radar image
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T2207/00—Indexing scheme for image analysis or image enhancement
- G06T2207/20—Special algorithmic details
- G06T2207/20081—Training; Learning
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Theoretical Computer Science (AREA)
- Computer Networks & Wireless Communication (AREA)
- Electromagnetism (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Length Measuring Devices By Optical Means (AREA)
- Optical Radar Systems And Details Thereof (AREA)
Abstract
一种3D激光雷达点云数据预测点的快速选取配准方法,通过将激光雷达扫描的整个点云数据集等分割成一些子数据集,对子数据集中的各数据点进行规则划分处理后,再基于子数据集划分数据点的规则,分别为各个子数据集中的测试点进行快速配准处理,验证选取预测点。本发明提升三维点云数据集中预测点集的整体配准速率。所提出的三维激光雷达点云数据预测点的快速选取配准方法对于激光SLAM建图中点云数据的点集配准处理具有很大的参考价值。
Description
技术领域
本发明涉及三维激光雷达的即时定位与建图技术领域,具体涉及到一种3D 激光雷达点云数据预测点的快速选取配准方法。
技术背景
在地图构建步骤中,除了要为SLAM(Simultaneous Localization And Mapping)确定地图表示形式外,还有一个重要目标:将新构造的地图元素控制在理想的位置上,以便于建立两帧地图间地图元素的对应关系,这也是为位姿估计步骤做准备。然而,3D环境要比2D环境更复杂,3D点集的数量也远远大于2D点集,进行直接的拓展会带来很大问题。因为地图重构方法中“预测”这一步骤的算法复杂度是O(n3),计算量随点集的数量成三次方增长,数据量的急剧增加,为这一步的计算带来了繁重的负担。
为了克服现有技术的缺陷,本发明提供一种预测点快速选取配准方法,所研究的方法具有2D和3D之间的通用性。以解决现有SLAM技术背景中点集数据量大、数据处理慢且预测点集识别效率较低的问题。可通过分割多维数据空间的数据点集对比选取预测点集,通过计算测试点集与筛选的训练点集之间的相对距离,并进行预测点相对距离权重验证,实现快速精确选取预测点集位置,从而有助于高精度的快速定位建图。
现有技术中有关三维地图构建点集配准的方法在基于激光雷达的环境建模中得到了广泛的应用。专利CN202110066231.2公开了一种基于高斯距离的点云数据的处理方法。根据原始点云数据集的特征信息计算点云数据集中所有的点到关键点的高斯距离,再基于高斯距离确定关键点的相邻点集;对相邻点集进行特征聚合,生成关键点对应的特征点集来建图。专利CN202011328046.8公开了一种基于多点云数据矩阵的点云数据处理方法,通过预先训练得到的点云重构模型中的序列化网络层对所述点云矩阵进行序列化处理,来获得多个子特征矩阵,再基于多子特征矩阵进行拼接处理,得到第一特征矩阵,基于所述点云重构模型中的重构网络层对所述第一特征矩阵进行重构。专利CN201910438575.4公开了一种基于坐标积分图像局部法向量聚类的点云数据处理方法。通过确定点云数据的坐标积分图像和深度积分图像,根据所述坐标积分图像和所述深度积分图像,确定所述点云数据中的每个点分别对应的局部法向量,再根据各所述局部法向量对所述点云数据中的点进行聚类得到不同类别的点集,来确定各类别点集对应的物体信息。然而此类方法存在以下几个问题:第一,此类发明通常利用传统机器学习算法对预测点进行识别,由于预测点排列的不规则性此类方法效率较低;第二,在这些研究中,它们都将应用场景的结构当作单一曲面来进行建模,当建图区域过大时,误差会被放大,不同的训练点之间在选取预测点时会受到影响;并且第三,当建图区域过大时,面对巨大的数据量,其算法计算速度慢,进而建图速度就变得相对缓慢。
发明内容
为了克服现有技术的不足,本发明提供一种3D激光雷达点云数据预测点的快速选取配准方法,面对一些复杂场景的三维点云地图构建,这些场景中通常都含有多曲面、多层面的结构(例如,两堵相互垂直的墙),复杂的3D环境下,地图重构方法中“预测”这一步骤的算法复杂度是O(n3),计算量随点集的数量成三次方增长,数据量的急剧增加,为这一步的计算带来了繁重的负担,进行直接的拓展会带来很大计算难度;本发明通过将激光雷达扫描的整个点云数据集分割成一些子数据集,分别为各个子数据集中的预测点进行快速配准处理,进一步提升三维点云数据集中预测点集的整体配准速率。
为解决上述技术问题本发明的技术方案为,
一种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中最终选取的用以建图的预测点集。
进一步,所述步骤3包括以下步骤:
步骤3.1:要处理的对象集合是一个三维空间中的数据集,首先需要将三维数据进行划分,以维度d作为标准来对数据进行划分,d∈{X,Y,Z};
步骤3.2:首先对子点集Φj每个维度上各数据点假设点集Φj上有q个数据点,l=1,2,3…q)进行整合处理,找出各维度数据点的中值/>每维度各数据点分别对该维度中值求差:
其中:表示m维度的差值和;
通过比较每个维度的差值和大小来确定所选取的维度,差值和最大的维度即为参考维度d;
步骤3.3:在确定参考维度d后,基于该维度中值维度中值为d维度上的数据点中值,对三维数据点进行一次划分,以/>平面为分界,使得各数据点在d维度上,一侧的数据点值小于平面另一侧的所有数据点的值,对于划分产生的两个新子点集Φj1、Φj2的数据点以同样的方法再划分直到每个新产生的子点集不能再划分为止。
再进一步,所述步骤4包括以下步骤:
步骤4.1:基于步骤3所述,在完成子点集数据点划分后,对于某一测试点 P,就可以按照对应子点集的划分规则很快的进行定位,初步寻找出距其最近的预测点;
步骤4.2:计算测试点P与其初步判断得到的预测点的相对距离dis,以测试点P为圆心,相对距离dis为半径作球C′,进一步判断,距测试点P是否还有更近的训练样点,当球C′内存在其他训练样点时,可确定存在更优预测点,可通过距离权重值大小比较选取最优预测点并更新相对距离为dis′,同理,再以测试点P为圆心,相对距离dis′为半径作球,至预测球内不含有其他训练样点,结束搜索,可以将该思想扩充到全部的子点集Φj中,以提升预测点选取的效率。
本发明的有益表现是:本发明提出了一种三维激光雷达点云数据中预测点的快速选取配准方法,通过将激光雷达扫描的整个点云数据集等分割成一些子数据集,对子数据集中的各数据点进行规则划分处理后,再基于子数据集划分数据点的规则,分别为各个子数据集中的测试点进行快速配准处理,验证选取预测点,进一步提升三维点云数据集中预测点集的整体配准速率。所提出的三维激光雷达点云数据预测点的快速选取配准方法对于激光SLAM建图中点云数据的点集配准处理具有很大的参考价值。
附图说明:
图1为本发明方法流程图;
图2为本发明子点集中的预测点快速选取案例示意图。
具体实施方式
下面结合附图和实施例,对本发明的具体实施方式进一步详细叙述(以A区域场景3D建图为例)。
参照图1~图2,一种3D激光雷达点云数据预测点的快速选取配准方法,包括以下步骤:
步骤1:首先用三维激光雷达对区域A进行扫描,获得区域A的点云数据点集Φ,把点云数据集Φ作为输入项;
步骤2:将点云数据集Φ等分为100个子数据点集Φi(i=1,…,100),筛选保留符合条件(子数据点集中数据点数>3)的子点集Φj(j=1,…,95)用以参与点集配准;
其中:S(Φ′)表示参与点集配准的所有点集和;
步骤3:分析子点集Φj中各数据点集分布情况,对点集Φj中的各个数据点进行规则划分,构建子点集序列结构,以某一子数据点集Φκ(1≤κ≤95)的二维(XY)平面为例,下面将具体说明如何进行预测点的点集配准,假设子数据点集Φκ中,包括以下训练样点(数据点):(3,4.2)、(4,8)、(5,7)、(6,4)、(7,5)、(8,2)、(9,1)、(10,6)。
①第一步:经计算参考中值X=7可将数据点集分为子数据点集Φκ1:(3,4.2)、(4,8)、(5,7)、(6,4)和子数据点集Φκ2:(8,2)、 (9,1)、(10,6)两个子数据点集;
②第二步:子数据点集Φκ1经计算参考中值Y=7又可划分为子数据点集Φκ11:(3,4.2)、(6,4)和子数据点集Φκ12:(4,8);子数据点集Φκ2经计算/>参考中值Y=2又可划分为子数据点集Φκ21:(9, 1)和子数据点集Φκ22:(10,6);
③第三步:子数据点集Φκ11再划分为子数据点集Φκ111:(3,4.2)和子数据点集Φκ112:(6,4);
最终,可将各训练样点按照图2所示进行规则划分。
步骤4:测试点定位和预测点选取,步骤如下:
步骤4.1:假设点(3,6.5)为本案例的一测试点,第一步通过数据比较可确定测试点/>(3,6.5),介于训练样点(3,4.2)和(6,4)之间;
步骤4.2:第二步通过相对距离的权重值比较,初步确定训练样点(3,4.2) 距测试点(3,6.5)最近,距离为dis=2.3,可初步确定点(3,4.2)为预测训练点;
步骤4.3:第三步以测试点(3,6.5)为圆心,dis=2.3为半径作圆,进一步判断,是否还有距测试点/>(3,6.5)距离更近的训练样点,当圆内存在其他训练样点时,可确定存在更优预测点,通过距离权重值大小选取最优预测点;正如图2中所示,训练样点(4,8)和(5,7)在圆内,计算得训练样点(4,8) 距离测试点/>(3,6.5)更近,dis′=1.8。更新训练样点(4,8)为预测训练样点,再以测试点/>(3,6.5)为圆心,dis′=1.8为半径再作圆进行验证,圆内无训练样点,结束搜索;进一步将该思想扩充到全部的子点集Φj中,以提升预测点集配准效率;
步骤5:输出预测点为(4,8),进一步对于每个子数据点集,不需要使用点集内的所有训练点,只需使用训练位置在测试位置附近且点集间相关性高的那些训练点,就可以得到足够准确的预测值,最终输出三维激光雷达扫描的区域A 中最终选取的用以建图的预测点集。
本说明书的实施例所述的内容仅仅是对发明构思的实现形式的列举,仅作说明用途。本发明的保护范围不应当被视为仅限于本实施例所陈述的具体形式,本发明的保护范围也及于本领域的普通技术人员根据本发明构思所能想到的等同技术手段。
Claims (2)
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中最终选取的用以建图的预测点集;
所述步骤3包括以下步骤:
步骤3.1:要处理的对象集合是一个三维空间中的数据集,首先需要将三维数据进行划分,以维度d作为标准来对数据进行划分,d∈{X,Y,Z};
步骤3.2:首先对子点集Φj每个维度上各数据点 假设点集Φj上有q个数据点,l=1,2,3…q,进行整合处理,找出各维度数据点的中值/>每维度各数据点分别对该维度中值求差:
其中:表示m维度的差值和;
通过比较每个维度的差值和大小来确定所选取的维度,差值和最大的维度即为参考维度d;
步骤3.3:在确定参考维度d后,基于该维度的中值维度中值为d维度上的数据点中值,对三维数据点进行一次划分,以/>平面为分界,使得各数据点在d维度上,一侧的数据点值小于平面另一侧的所有数据点的值,对于划分产生的两个新子点集Φj1、Φj2的数据点以同样的方法再划分直到每个新产生的子点集不能再划分为止。
2.如权利要求1所述的一种3D激光雷达点云数据预测点的快速选取配准方法,其特征在于,所述步骤4包括以下步骤:
步骤4.1:基于步骤3所述,在完成子点集数据点划分后,对于某一测试点P,就可以按照对应子点集的划分规则很快的进行定位,初步寻找出距其最近的预测点;
步骤4.2:计算测试点P与其初步判断得到的预测点的相对距离dis,以测试点P为圆心,相对距离dis为半径作球C′,进一步判断,距测试点P是否还有更近的训练样点,当球C′内存在其他训练样点时,可确定存在更优预测点,通过距离权重值大小比较选取最优预测点并更新相对距离为dis′,同理,再以测试点P为圆心,相对距离dis′为半径作球,至预测球内不含有其他训练样点,结束搜索。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110836883.XA CN113592926B (zh) | 2021-07-23 | 2021-07-23 | 一种3d激光雷达点云数据预测点的快速选取配准方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110836883.XA CN113592926B (zh) | 2021-07-23 | 2021-07-23 | 一种3d激光雷达点云数据预测点的快速选取配准方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113592926A CN113592926A (zh) | 2021-11-02 |
CN113592926B true CN113592926B (zh) | 2024-02-02 |
Family
ID=78249637
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110836883.XA Active CN113592926B (zh) | 2021-07-23 | 2021-07-23 | 一种3d激光雷达点云数据预测点的快速选取配准方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113592926B (zh) |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107038717A (zh) * | 2017-04-14 | 2017-08-11 | 东南大学 | 一种基于立体栅格自动分析3d点云配准误差的方法 |
CN110473239A (zh) * | 2019-08-08 | 2019-11-19 | 刘秀萍 | 一种三维激光扫描的高精度点云配准方法 |
WO2019242174A1 (zh) * | 2018-06-21 | 2019-12-26 | 华南理工大学 | 基于激光雷达的建筑结构自动测量及3d模型生成方法 |
CN111861933A (zh) * | 2020-07-29 | 2020-10-30 | 北方工业大学 | 基于空间划分的点云去噪方法及装置 |
-
2021
- 2021-07-23 CN CN202110836883.XA patent/CN113592926B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107038717A (zh) * | 2017-04-14 | 2017-08-11 | 东南大学 | 一种基于立体栅格自动分析3d点云配准误差的方法 |
WO2019242174A1 (zh) * | 2018-06-21 | 2019-12-26 | 华南理工大学 | 基于激光雷达的建筑结构自动测量及3d模型生成方法 |
CN110473239A (zh) * | 2019-08-08 | 2019-11-19 | 刘秀萍 | 一种三维激光扫描的高精度点云配准方法 |
CN111861933A (zh) * | 2020-07-29 | 2020-10-30 | 北方工业大学 | 基于空间划分的点云去噪方法及装置 |
Also Published As
Publication number | Publication date |
---|---|
CN113592926A (zh) | 2021-11-02 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111299815B (zh) | 一种用于低灰度橡胶垫视觉检测与激光切割轨迹规划方法 | |
CN110188228B (zh) | 基于草图检索三维模型的跨模态检索方法 | |
CN106373118A (zh) | 可有效保留边界和局部特征的复杂曲面零件点云精简方法 | |
Ji et al. | A novel simplification method for 3D geometric point cloud based on the importance of point | |
CN100485662C (zh) | 基于数据动态存取模型的产品点云型面特征分析方法 | |
CN112347550B (zh) | 耦合式室内三维语义建图及建模方法 | |
CN112085072B (zh) | 基于时空特征信息的草图检索三维模型的跨模态检索方法 | |
CN110222642A (zh) | 一种基于全局图聚类的平面建筑构件点云轮廓提取方法 | |
CN105654483A (zh) | 三维点云全自动配准方法 | |
CN111027140B (zh) | 基于多视角点云数据的飞机标准件模型快速重构方法 | |
CN112396641B (zh) | 一种基于全等二基线匹配的点云全局配准方法 | |
El‐Sayed et al. | Plane detection in 3D point cloud using octree‐balanced density down‐sampling and iterative adaptive plane extraction | |
CN107945189A (zh) | 一种基于正态分布变换单元的点云平面分割方法 | |
CN111311702B (zh) | 一种基于BlockGAN的图像生成和识别模块及方法 | |
WO2024060395A1 (zh) | 一种基于深度学习的高精度点云补全方法及装置 | |
CN112365511B (zh) | 基于重叠区域检索与对齐的点云分割方法 | |
CN103700135B (zh) | 一种三维模型局部球面调和特征提取方法 | |
CN114120067A (zh) | 一种物体识别方法、装置、设备及介质 | |
Wu et al. | Evolutionary multitasking with solution space cutting for point cloud registration | |
Tian et al. | Lidar super-resolution based on segmentation and geometric analysis | |
CN106503245A (zh) | 一种支撑点集合的选择方法及装置 | |
Sun et al. | Decoupled feature pyramid learning for multi-scale object detection in low-altitude remote sensing images | |
CN112270762A (zh) | 一种基于多模态融合的三维模型检索方法 | |
CN113592926B (zh) | 一种3d激光雷达点云数据预测点的快速选取配准方法 | |
CN109345571B (zh) | 一种基于扩展高斯图像的点云配准方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |