CN112348864B - 一种融合线激光轮廓特征的三维点云自动配准方法 - Google Patents
一种融合线激光轮廓特征的三维点云自动配准方法 Download PDFInfo
- Publication number
- CN112348864B CN112348864B CN202011253420.2A CN202011253420A CN112348864B CN 112348864 B CN112348864 B CN 112348864B CN 202011253420 A CN202011253420 A CN 202011253420A CN 112348864 B CN112348864 B CN 112348864B
- Authority
- CN
- China
- Prior art keywords
- point cloud
- point
- key
- points
- source
- 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 description 36
- 230000004927 fusion Effects 0.000 title abstract description 4
- 238000012545 processing Methods 0.000 claims abstract description 10
- 239000011159 matrix material Substances 0.000 claims description 37
- 230000009466 transformation Effects 0.000 claims description 29
- 239000013598 vector Substances 0.000 claims description 16
- 238000013519 translation Methods 0.000 claims description 11
- 238000004364 calculation method Methods 0.000 claims description 10
- 238000001914 filtration Methods 0.000 claims description 10
- 238000004422 calculation algorithm Methods 0.000 abstract description 38
- 238000004519 manufacturing process Methods 0.000 abstract description 6
- 238000005259 measurement Methods 0.000 abstract description 4
- 238000011160 research Methods 0.000 abstract description 2
- 238000010586 diagram Methods 0.000 description 7
- 238000005516 engineering process Methods 0.000 description 5
- 238000011161 development Methods 0.000 description 4
- 238000002474 experimental method Methods 0.000 description 4
- 238000009776 industrial production Methods 0.000 description 3
- 238000013473 artificial intelligence Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 2
- 238000013461 design Methods 0.000 description 2
- 238000009826 distribution Methods 0.000 description 2
- 238000013507 mapping Methods 0.000 description 2
- 230000008569 process Effects 0.000 description 2
- 239000004065 semiconductor Substances 0.000 description 2
- 238000004026 adhesive bonding Methods 0.000 description 1
- 230000003190 augmentative effect Effects 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000002349 favourable effect Effects 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 238000012804 iterative process Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000003909 pattern recognition Methods 0.000 description 1
- 239000011541 reaction mixture Substances 0.000 description 1
- 238000004904 shortening Methods 0.000 description 1
- 238000012360 testing method Methods 0.000 description 1
- 238000000844 transformation Methods 0.000 description 1
- 230000000007 visual effect Effects 0.000 description 1
- 238000003466 welding Methods 0.000 description 1
Images
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
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T5/00—Image enhancement or restoration
- G06T5/70—Denoising; Smoothing
-
- 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/35—Determination of transform parameters for the alignment of images, i.e. image registration using statistical methods
-
- 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
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02A—TECHNOLOGIES FOR ADAPTATION TO CLIMATE CHANGE
- Y02A90/00—Technologies having an indirect contribution to adaptation to climate change
- Y02A90/10—Information and communication technologies [ICT] supporting adaptation to climate change, e.g. for weather forecasting or climate simulation
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Theoretical Computer Science (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Life Sciences & Earth Sciences (AREA)
- Bioinformatics & Cheminformatics (AREA)
- Bioinformatics & Computational Biology (AREA)
- Evolutionary Biology (AREA)
- Probability & Statistics with Applications (AREA)
- Length Measuring Devices By Optical Means (AREA)
Abstract
目前,点云配准目前已经广泛应用于传统制造业和新兴高科技产业。在无人驾驶、建筑行业等领域,点云配准为后续点云融合、点云表面重建等点云处理相关工作打下基础,点云配准的精度也直接影响了诸多点云高层应用的精度。关于点云配准算法的研究,主要集中在提高点云配准精度和减少点云配准算法的运算时间。激光轮廓传感器近些年在工业上得到了广泛的应用,它的测量精度可以达到微米级,很小的扫描范围就可以获取几十万的点云数据量,若使用传统的点云配准算法,配准时间较长,针对激光轮廓传感器获取的点云数据,本发明提出了一种结合轮廓特征的激光点云快速配准算法,可以在数毫秒内完成线激光点云的配准。
Description
技术领域
本发明属于计算机视觉领域,具体涉及一种融合线激光轮廓特征的三维点云自动配准方法。
背景技术
随着传感器技术的飞快发展,三位传感器在各行业中也得到了广泛的应用。二十世纪八十年代后期到二十一世纪初期半导体传感器技术和计算机设备的迅速的发展,尤其是计算机的计算能力得到了质的提升,随之点云处理技术也随之得到了快速的发展,从之前的个别领域扩展到了众多的领域,如工业制造上的逆向工程、医学上的医学影像建模、考古中的文物修复、游戏和动漫中的人物建模、地质上的地形勘探与建模等等。虽然在这些领域中已经得到了很好的应用,但部分点云获取设备依然无法避免笨重的体型和昂贵的造价。近年来,随着第三代半导体的发展和人工智能与物联网的崛起,使得点云处理技术从工业生产或者其他专有领域直接走向我们的生活应用,如虚拟现实(Virtual Reality,VR)和增强现实(Augmented Reality,AR)的场景制作、移动机器人的实时定位与建图(Simultaneous Localization And Mapping,SLAM)、城乡规划和商业房的快速建模等。在各种点云获取设备不断更新的今天,顺着人工智能和万物互联的浪潮,点云处理技术已进入我们生活的方方面面。
在工业领域中,激光轮廓传感器被广泛用于焊接、涂胶、分拣等场景,激光轮廓传感器是一种非接触式,高精度的激光传感器,它具有结构坚固、设计紧凑、分辨率高、测量精度高等特点、是小型化尺寸和小重量的产品设计。通常一个激光轮廓传感器扫描得到的点云数据规模较大,就以加拿大LMI公司生产的Gocator 2430为例,在该传感器的扫描范围内,可以获取高达上百万的点云数目,传感器精度的提高又为点云处理算法带来了诸多挑战。点云配准是机器视觉中重要的研究方向,它为三维重建、快速原型等高层应用打下基础,在计算机视觉、模式识别和机器人技术中,点云配准是寻找使两个点云对齐的空间变换(例如缩放、旋转和平移)的过程。寻找这种转换的目的包括将多个数据集合并为一个全局一致的模型(或坐标系),并将一个新的测量映射到一个已知的数据集,以识别特征或估计其姿态。现存的点云配准算法为迭代最近点(Iterative Closest Point,ICP),了减少计算时间Luh和Milios提出了两种算法。第一个称为IMRP(迭代匹配范围点),提供了更好的点选择来匹配两个激光扫描。第二个IDC(迭代对应性)结合了ICP和IMRP,其中ICP用于计算平移,IMRP用于计算旋转。Y.J.Lee等人开发了另一种极坐标扫描匹配(PSM)方法。该方法通过简单地匹配具有相同方位的点来避免搜索关联点。其他研究的灵感来自于视觉中使用的方法,如SIFT(比例不变特征变换)和SURF(加速鲁棒特征)。其目标是通过选择图像处理中最相关的点来优化扫描的选择。ICP算法虽拥有较高的精度但是收敛速度较慢,它的时间复杂度O(N^2),这意味着配准处理时间较长,尤其是在使用高分辨率(点云数据大于200000)数据时,而对于线激光点云,激光轮廓传感器往往有较高的精度,这意味着点云数据的量也非常庞大,如果仅用传统的ICP算法进行配准,将会耗费巨大的计算时间,这在工业生产中是不可以被接受的,并且对于很多生产场景中,点云配准精度要求也很高,如果不对ICP算法进行改进,该配准算法无法用于工业激光点云的配准中。
综上所述,现有的点云配准算法用于线激光点云配准中有以下不足之处:点云配准的精度有待提高且配准时间太长需要缩短点云数据的配准时间。如何在保证配准精度的同时减少点云配准运算所需的时间成为了本领域的科研人员急需解决的问题。
发明内容
本发明的目的在于克服现有的点云配准算法用于线激光点云配准时精度达不到要求、且算法运行时间过长的问题,提供了一种行之有效、科学合理的基于线激光点云轮廓特征的点云快速配准方法。
为了实现上述目的,本发明所提供的技术方案为以下步骤:一种线激光点云快速配准方法,该方法包含以下步骤:
S1、用激光轮廓传感器扫描工件获取原始工件轮廓线数据,并将轮廓线上源点云P的坐标转换为目标点云Q的坐标;
S2、对每条轮廓线上的源点云P和目标点云Q数据进行关键点搜索;
S3、对步骤S2获取的源点云P的关键点和目标点云的关键点进行滤波操作;
S4、对滤波后的源关键点云集Pkey和目标关键点云集Qkey进行迭代处理求解旋转矩阵Rf和平移向量Tf;
S5、将源点云P根据Rf和Tf转换到目标点云Q下进行配准。
进一步的,将轮廓线上源点云P的坐标转换为目标点云Q的坐标,方法如下:对源点云中的每个点云数据做下列运算,即对源点云中的每个点云数据做下列运算,经下式刚性变换的所有点qi形成的点云集为Q:
进一步的,步骤(2)中,关键点搜索方法如下:
(a)计算轮廓线中相邻两点之间的距离di,激光轮廓传感器每条轮廓线上的点有两个值(x,z),x表示在传感器坐标系下x的值,z表示在传感器坐标系下的z值,相邻两点(xi+1,zi+1)和(xi,zi)之间的距离di可以用下式计算:
(b)判断di和阈值eps的关系,若di>eps,则认为点(xi,zi)是一个区域分割点,利用di和eps的距离关系将每条轮廓线分为若干段;
(c)判断每个分段的数据点数是否大于期望值n,若该分段的数据点数小于期望值n,则认为该段数据为噪声点并舍弃该分段的所有数据;
(d)通过上述方法将一条轮廓线基于相邻点的距离分为了若干段,设每个分段中的数据点个数为k,则根据该段中的第1个点和该分段中的第k个点,构建一条直线,直线的方程如下:
Ax+By+C=0
其中,A,B,C为系数; (4)
并根据下式计算出轮廓线上的每个点(xi,zi)到该直线的距离:
(e)判断Dis的最大值是否大于阈值Δe,若Dis>Δe,则认为Dis取得最大值的点是一个角点,否则判定该段为直线,无关键点;若该点为角点,则以该点为分界点继续搜索该分段中剩下的关键点,直至所有关键点搜索完毕;通过上述方法,搜索所有轮廓线上的关键点;
(f)对源点云和目标点云中的所有轮廓线进行关键点提取,并根据下式将二维轮廓关键点转化为三维点云:
形成关键点云集Pkey和目标关键点云集Qkey,上式中,为机器人基坐标系到传感器坐标系的齐次变换矩阵,其次变换矩阵是描述坐标系变换的一个4×4的方阵,每一个齐次变换矩阵可以写成下式所示的形式,其中,R3*3为旋转矩阵,t3*1为平移向量:
进一步的,步骤S3中,滤波操作方法如下:对每一个点,计算它到所有邻近点平均距离,邻近点是指点云数据中分布在某个点云周围最近的k个点,如果平均距离在标准范围之外的点,可以被定义为离群点并从数据中去除。
进一步的,步骤S4的具体方法如下:
(a)对于Pkey中的每一点pi,i=1,2,3,...,np和Qkey中的点qj,j=1,2,3,...,nq,利用下式计算出pi和qj的最小欧式距离dm:
dm=min||pi-qj|| (7)
(b)求解旋转矩阵Rtemp和平移向量ttemp,利用步骤a中获取的多组匹配点对下式目标函数进行优化:
当该目标函数fm最小的Rtemp和ttemp即为所求的旋转矩阵和平移向量,分别为3*3和3*1矩阵;
(c)更新点云,根据步骤b计算的Rtemp和ttemp通过下式将源关键点云集Pkey和转换到目标关键点云集Qkey下:
P′key=Rtemp*Pkey+ttemp (10)
得到新的源关键点云P′key;
(d)重复迭代步骤a~步骤d直到点云中的目标函数小于预设值或迭代次数达到上限,迭代结束后计算所得的最终结果Rf和Tf。
进一步的,步骤S5的具体方法如下:将计算结果作用于源点云P,对于P中的每个点云pi按照下式对源点云数据集的进行计算:
p′i=Rf*pi+Tf (11)。
有益技术效果:与现有技术相比,本发明的技术方案具有以下优点与有益效果:
传统的点云配准算法ICP在选取迭代配准的点集过程中没有针对性,这对于高分辨率的点云而言计算时间过于冗长,本发明通过搜索线激光点云轮廓特征点,并通过统计滤波的方式滤除离群点和噪声点,让减少了点云数据的规模并,在保证配准精度的同时,显著加快了配准的速度。这有利于工业生产中的实时性,提高生产加工、质量检测等应用的效率,此外,该本发明方法精度较高,在线激光点云配准应用中具有很大的应用前景。
附图说明
图1是本实施例的圆弧工件点云图;
图2是本实施例的L形工件点云图;
图3是本实施例的点云放大图;
图4是本实施例中激光轮廓传感器采集的某一轮廓数据示例图;
图5是本实施例圆弧形工件刚体变换后对比图;
图6是本实施例L形工件点云刚体变换对比图;
图7是本实施例关键点搜索结果示意图;
图8是本实施例L形工件点云关键点变换后图;
图9是本实施例圆弧形工件关键点变换实验结果图;
图10是本实施例关键点点云滤波前后对比图;
图11是本实施例L形工件点云和圆弧形工件点云配准对比图;
图12是本发明算法流程图。
具体实施方式
下面结合具体实施例对本发明作进一步说明,本实施例通过激光轮廓传感器采集了两个场景下的线激光点云数据,激光轮廓传感器固定在法兰盘上并且已经标定完毕,需要说明的是该场景仅作为具体实施方式的说明,不是本发明的限制。
实施例:
本实施例用的激光轮廓传感器固定在一个六轴机械臂末端的法兰盘上并进行了准确的手眼校准,分别对圆弧形工件和L形工件进行扫描,扫描的圆弧形工件点云图1所示,L型工件的点云如图2所示,将点云图放大可以看出,点云图是由若干条轮廓线组成,如图3所示,点云中的每一条线都是由一个二维的轮廓线拼接而成,其中一条轮廓线如图4所示。
S1、本实施例采集的点云数据如图1和图2所示,进行两次实验对本发明提出的算法进行测试,其中圆弧形工件点云数据的点云数量为2464674,L型工件点云数据的点云个数为1900915,把采集L形工件和圆弧形工件的点云数据作为源点云P,对它们通过刚性变换得到目标点云,即对源点云中的每个点云数据做下列运算,即对源点云中的每个点云数据做下列运算,经下式刚性变换的所有点qi形成的点云集为Q:
其中,pi为源点云中的一点的坐标,x,y,z是点云的三维坐标,T为齐次变换矩阵,在本实施例中,该矩阵为用户事先设定的,目的是通过配准算法计算结果和已知结果进行比对,易于计算和评估本发明算法的配准精度,在本实施例中,该矩阵的具体数值如下所示:
圆弧工件和L形工件点云经刚体变换后显示分别如图5和图6所示。
S2、对源点云P和目标点云Q数据的每条轮廓线进行关键点搜索,此处的关键点是指角点,角点的搜索方法如下:
(a)计算轮廓线中相邻两点之间的距离di,激光轮廓传感器每条轮廓线上的点有两个值(x,z),x表示在传感器坐标系下x的值,z表示在传感器坐标系下的z值,相邻两点(xi+1,zi+1)和(xi,zi)之间的距离di可以用下式计算:
(b)判断di和阈值eps的关系,若di>eps,则认为点(xi,zi)是一个区域分割点,利用di和eps的距离关系将每条轮廓线分为若干段,eps的大小由用户设定;
(c)判断每个分段的数据点数是否大于用户期望值n,若该分段的数据点数小于期望值n则认为该段数据为噪声点并舍弃该分段的所有数据;
(d)此时已经将一条轮廓线基于相邻点的距离分为了若干段,设每个分段中的数据点个数为k,则根据该段中的第1个点和该分段中的第k个点,计算一条直线,直线的方程如下:
Ax+By+C=0,其中,A,B,C为系数 (4)
并根据下式计算出轮廓线上的每个点(xi,zi)到该直线的距离:
(e)判断Dis的最大值是否大于用户设定的阈值Δe,若Dis>Δe,则认为Dis取得最大值的点是一个角点,否则判定该段为直线,无关键点;若该点为角点,则以该点为分界点继续搜索该分段中剩下的关键点,直至所有关键点搜索完毕;通过上述方法,搜索所有轮廓线上的关键点;该实施例中对轮廓线用此方法进行关键点搜索,得到的结果如图7所示,图7中的方形点即搜索到的关键点,由图可以看出,关键点都被准确的搜索到了。
(f)对源点云和目标点云中的所有轮廓进行关键点提取,并根据下式将二维轮廓关键点转化为三维点云:
形成关键点云集Pkey和目标关键点云集Qkey,将关键点转化后点云图如图8和图9所示,上式中,xs和zs是传感器坐标系下轮廓上点的坐标,为机器人基坐标系到传感器坐标系的齐次变换矩阵,其次变换矩阵是描述坐标系变换的一个4×4的方阵,每一个齐次变换矩阵可以写成下式所示的形式,其中,R3*3为旋转矩阵,t3*1为平移向量:
S3、根据S2执行后的结果,获取了源点云和目标点云的关键点集,此时关键点中还存在着错误或噪声点,需要对离群的噪声点剔除,具体方法为利用统计滤波器对源点云的关键点和目标点云的关键点进行滤波操作,统计滤波对每个点的邻域进行一个统计分析,并修剪掉一些不符合标准的点。
具体方法为在输入数据中对点到临近点的距离分布的计算,对每一个点,计算它到所有邻近点平均距离(假设得到的结果是一个高斯分布,其形状是由均值和标准差决定),邻近点是指点云数据中分布在某个点云周围最近的k个点,那么平均距离在标准范围之外的点,可以被定义为离群点并从数据中去除,统计滤波结果如图10所示,可以看出,统计滤波在保留原有点云形状的同时有效的滤除了噪声点。
S4、对滤波后源关键点云集Pkey和目标关键点云集Qkey进行下述迭代过程:
(a)对于Pkey中的每一点pi,i=1,2,3,...,np和Qkey中的点qj,j=1,2,3,...,nq,利用下式计算出pi和qj的最小欧式距离dm:
dm=min||pi-qj|| (7)
(b)求解旋转矩阵Rtemp和平移向量ttemp,利用步骤a中获取的匹配点对下式目标函数进行优化:
(c)更新点云,根据步骤b计算的Rtemp和ttemp通过下式将源关键点云集Pkey和转换到目标关键点云集Qkey下:
P′key=Rtemp*Pkey+ttemp (10)
(d)重复迭代步骤a~步骤d直到点云中的目标函数小于预设值或迭代次数达到上限,迭代结束后计算所得的最终结果Rf和Tf;
S5、将计算结果作用于源点云P,对于P中的每个点云pi按照下式对源点云数据集的进行计算:
p′i=Rf*pi+Tf (11)
将计算结果和用户设定的计算结果做差,就可以的到配准的精度,在本实施例中,本发明的配准结果和传统的ICP配准结果可视化对比图如图11所示,从图中可以看出,L形工件点云数据传统的ICP在面对200万的点云数目时,其中L形工件配准失败,而本实施例利用本发明提出的算法成功配准,L形工件配准得到的其次变换矩阵Tl如下所示:
由该计算结果可以看出,本发明所述的配准算法准确的计算出源点云和目标点云的齐次变换矩阵非常接近用户的设定值,完全满足生产的精度要求。圆弧形工件传统ICP配准算法结果Ticp和本发明的配准结果Tcir如下所示:
从计算结果可以明显看出,本文的算法精度高于传统的ICP算法,此外对算法的时间进行评估,对比传统的ICP算法和本发明算法的计算用时,实验条件如下表1所示:
表1实验条件
进行10次实验,计算10次实验的平均耗时,统计结果如下表2所示:
表2算法时间统计
上表可以看出,对比传统的ICP算法,本发明的算法显著提高了算法速度,这对提高生产效率具有重大的意义。
综上所述,本发明融合轮廓特征的线激光点云配准算法在准确度和速度方面有了显著的提升,在传感器高速发展的今天,传感器的分辨率和测量精度也越来越高,这对点云的算法性能要求也带来了挑战,本发明针对线激光点云的特点,提出一个高性能的算法,具有广阔的应用前景。
以上所述实施例仅为本发明的一个应用场景,并非以此限制本发明的实施范围,故凡依本发明的原理所作的变换,均在本发明的保护范围内。
Claims (4)
1.一种线激光点云快速配准方法,其特征在于,该方法包含以下步骤:
S1、用激光轮廓传感器扫描工件获取原始工件轮廓线数据,并将轮廓线上源点云P的坐标转换为目标点云Q的坐标;
S2、对每条轮廓线上的源点云P和目标点云Q数据进行关键点搜索;
S3、对步骤S2获取的源点云P的关键点和目标点云的关键点进行滤波操作;
S4、对滤波后的源关键点云集Pkey和目标关键点云集Qkey进行迭代处理求解旋转矩阵Rf和平移向量Tf;
S5、将源点云P根据Rf和Tf转换到目标点云Q下进行配准;
将轮廓线上源点云P的坐标转换为目标点云Q的坐标,方法如下:对源点云中的每个点云数据做下列运算,即对源点云中的每个点云数据做下列运算,经下式刚性变换的所有点qi形成的点云集为Q:
步骤(2)中,关键点搜索方法如下:
(a)计算轮廓线中相邻两点之间的距离di,激光轮廓传感器每条轮廓线上的点有两个值(x,z),x表示在传感器坐标系下x的值,z表示在传感器坐标系下的z值,相邻两点(xi+1,zi+1)和(xi,zi)之间的距离di可以用下式计算:
(b)判断di和阈值eps的关系,若di>eps,则认为点(xi,zi)是一个区域分割点,利用di和eps的距离关系将每条轮廓线分为若干段;
(c)判断每个分段的数据点数是否大于期望值n,若该分段的数据点数小于期望值n,则认为该段数据为噪声点并舍弃该分段的所有数据;
(d)通过上述方法将一条轮廓线基于相邻点的距离分为了若干段,设每个分段中的数据点个数为k,则根据该段中的第1个点和该分段中的第k个点,构建一条直线,直线的方程如下:
Ax+By+C=0
其中,A,B,C为系数;(4)
并根据下式计算出轮廓线上的每个点(xi,zi)到该直线的距离:
(e)判断Dis的最大值是否大于阈值Δe,若Dis>Δe,则认为Dis取得最大值的点是一个角点,否则判定该段为直线,无关键点;若该点为角点,则以该点为分界点继续搜索该分段中剩下的关键点,直至所有关键点搜索完毕;通过上述方法,搜索所有轮廓线上的关键点;
(f)对源点云和目标点云中的所有轮廓线进行关键点提取,并根据下式将二维轮廓关键点转化为三维点云:
形成关键点云集Pkey和目标关键点云集Qkey,上式中,为机器人基坐标系到传感器坐标系的齐次变换矩阵,齐 次变换矩阵是描述坐标系变换的一个4×4的方阵,每一个齐次变换矩阵可以写成下式所示的形式,其中,R3*为旋转矩阵,t3*1为平移向量:
2.根据权利要求1所述的一种线激光点云快速配准方法,其特征在于,步骤S3中,滤波操作方法如下:对每一个点,计算它到所有邻近点平均距离,邻近点是指点云数据中分布在某个点云周围最近的k个点,如果平均距离在标准范围之外的点,可以被定义为离群点并从数据中去除。
3.根据权利要求2所述的一种线激光点云快速配准方法,其特征在于,步骤S4的具体方法如下:
(a)对于Pkey中的每一点pi,i=1,2,3,…,np和Qkey中的点qj,j=1,2,3,…,nq,利用下式计算出pi和qj的最小欧式距离sm:
sm=min||pi-qj|| (7)
(b)求解旋转矩阵Rtemp和平移向量ttemp,利用步骤a中获取的多组匹配点对下式目标函数进行优化:
当该目标函数fm最小的Rtemp和ttemp即为所求的旋转矩阵和平移向量,分别为3*3和3*1矩阵;
(c)更新点云,根据步骤b计算的Rtemp和ttemp通过下式将源关键点云集Pkey和转换到目标关键点云集Qkey下:
P′key=Rtenp*Pkey+ttemp (10)
得到新的源关键点云P′key;
(d)重复迭代步骤a~步骤d直到点云中的目标函数小于预设值或迭代次数达到上限,迭代结束后计算所得的最终结果Rf和Tf。
4.根据权利要求2或3所述的一种线激光点云快速配准方法,其特征在于,步骤S5的具体方法如下:将计算结果作用于源点云P,对于P中的每个点云pi按照下式对源点云数据集的进行计算:
p′i=Rf*pi+Tf (11)。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011253420.2A CN112348864B (zh) | 2020-11-11 | 2020-11-11 | 一种融合线激光轮廓特征的三维点云自动配准方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011253420.2A CN112348864B (zh) | 2020-11-11 | 2020-11-11 | 一种融合线激光轮廓特征的三维点云自动配准方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112348864A CN112348864A (zh) | 2021-02-09 |
CN112348864B true CN112348864B (zh) | 2022-10-11 |
Family
ID=74363241
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011253420.2A Active CN112348864B (zh) | 2020-11-11 | 2020-11-11 | 一种融合线激光轮廓特征的三维点云自动配准方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112348864B (zh) |
Families Citing this family (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112949557A (zh) * | 2021-03-24 | 2021-06-11 | 上海慧姿化妆品有限公司 | 指甲轮廓的提取方法及*** |
CN113237434B (zh) * | 2021-04-25 | 2022-04-01 | 湖南大学 | 一种基于阶梯形标定物的激光轮廓传感器eye-in-hand标定方法 |
CN113516695B (zh) * | 2021-05-25 | 2023-08-08 | 中国计量大学 | 激光轮廓仪平面度测量中的点云配准策略 |
CN113777616B (zh) * | 2021-07-27 | 2024-06-18 | 武汉市异方体科技有限公司 | 一种运动车辆测距方法 |
CN113936045B (zh) * | 2021-10-15 | 2024-07-09 | 山东大学 | 路侧激光雷达点云配准方法及装置 |
CN113948173B (zh) * | 2021-10-22 | 2024-03-22 | 昆明理工大学 | 基于增强现实、有限元分析的医疗辅助***及使用方法 |
CN113917934B (zh) * | 2021-11-22 | 2024-05-28 | 江苏科技大学 | 一种基于激光雷达的无人机精准降落方法 |
CN114612452B (zh) * | 2022-03-18 | 2024-06-25 | 中冶赛迪信息技术(重庆)有限公司 | 用于棒材的识别方法、***、电子设备及可读存储介质 |
CN116758006B (zh) * | 2023-05-18 | 2024-02-06 | 广州广检建设工程检测中心有限公司 | 脚手架质量检测方法及装置 |
CN117741662A (zh) * | 2023-12-20 | 2024-03-22 | 中国科学院空天信息创新研究院 | 基于双观测视角的阵列干涉sar点云融合方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2011043969A (ja) * | 2009-08-20 | 2011-03-03 | Juki Corp | 画像特徴点抽出方法 |
CN106340010A (zh) * | 2016-08-22 | 2017-01-18 | 电子科技大学 | 一种基于二阶轮廓差分的角点检测方法 |
CN108022288A (zh) * | 2017-11-30 | 2018-05-11 | 西安理工大学 | 一种面向点云物体的三维素描画模拟方法 |
CN108898148A (zh) * | 2018-06-27 | 2018-11-27 | 清华大学 | 一种数字图像角点检测方法、***及计算机可读存储介质 |
CN109767463A (zh) * | 2019-01-09 | 2019-05-17 | 重庆理工大学 | 一种三维点云自动配准方法 |
-
2020
- 2020-11-11 CN CN202011253420.2A patent/CN112348864B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2011043969A (ja) * | 2009-08-20 | 2011-03-03 | Juki Corp | 画像特徴点抽出方法 |
CN106340010A (zh) * | 2016-08-22 | 2017-01-18 | 电子科技大学 | 一种基于二阶轮廓差分的角点检测方法 |
CN108022288A (zh) * | 2017-11-30 | 2018-05-11 | 西安理工大学 | 一种面向点云物体的三维素描画模拟方法 |
CN108898148A (zh) * | 2018-06-27 | 2018-11-27 | 清华大学 | 一种数字图像角点检测方法、***及计算机可读存储介质 |
CN109767463A (zh) * | 2019-01-09 | 2019-05-17 | 重庆理工大学 | 一种三维点云自动配准方法 |
Non-Patent Citations (3)
Title |
---|
图像配准技术及其应用的研究;宋智礼;《中国博士学位论文全文数据库 (基础科学辑)》;20101115(第11期);全文 * |
基于外部基准框架的SPECT与MRI/CT的刚性配准及融合;李世星;《中国医疗器械杂志》;20010430;第25卷(第4期);第1-2页 * |
基于结构特征的异源图像配准技术研究;朱宪伟;《中国博士学位论文全文数据库 (信息科技辑)》;20110415(第4期);全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN112348864A (zh) | 2021-02-09 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN112348864B (zh) | 一种融合线激光轮廓特征的三维点云自动配准方法 | |
CN109410321B (zh) | 基于卷积神经网络的三维重建方法 | |
JP4785880B2 (ja) | 三次元オブジェクト認識のためのシステムおよび方法 | |
CN111179321B (zh) | 一种基于模板匹配的点云配准方法 | |
CN110497373B (zh) | 一种移动作业机器人的三维激光雷达与机械臂间的联合标定方法 | |
CN108665491B (zh) | 一种基于局部参考点的快速点云配准方法 | |
CN112907735B (zh) | 一种基于点云的柔性电缆识别与三维重建方法 | |
CN105740899A (zh) | 一种机器视觉图像特征点检测与匹配复合的优化方法 | |
CN115147437B (zh) | 机器人智能引导加工方法与*** | |
CN102074015A (zh) | 一种基于二维图像序列的目标对象的三维重建方法 | |
CN105046694A (zh) | 一种基于曲面拟合系数特征的点云快速配准方法 | |
CN108171102A (zh) | 一种基于视觉的零件快速识别方法 | |
CN113628263A (zh) | 一种基于局部曲率及其近邻特征的点云配准方法 | |
CN112669385A (zh) | 基于三维点云特征的工业机器人工件识别与位姿估计方法 | |
WO2022237225A1 (zh) | 针对具有平面基准但不完整的三维扫描点云的在线实时配准方法 | |
Guan et al. | Point cloud registration based on improved ICP algorithm | |
Gu et al. | A review of research on point cloud registration methods | |
CN114202566A (zh) | 基于形状粗配准和icp点云精配准的胶路引导定位方法 | |
CN113989547A (zh) | 基于图卷积深度神经网络的三维点云数据分类结构及方法 | |
CN109920050A (zh) | 一种基于深度学习和薄板样条的单视图三维火焰重建方法 | |
CN117132630A (zh) | 一种基于二阶空间兼容性度量的点云配准方法 | |
CN113963118A (zh) | 一种基于特征简化和神经网络的三维模型识别方法 | |
Wang et al. | Multi-view point clouds registration method based on overlap-area features and local distance constraints for the optical measurement of blade profiles | |
Xue et al. | Point cloud registration method for pipeline workpieces based on PCA and improved ICP algorithms | |
CN115056213A (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 |