CN113376618B - 一种多路侧激光雷达点云配准装置及使用方法 - Google Patents
一种多路侧激光雷达点云配准装置及使用方法 Download PDFInfo
- Publication number
- CN113376618B CN113376618B CN202110694324.XA CN202110694324A CN113376618B CN 113376618 B CN113376618 B CN 113376618B CN 202110694324 A CN202110694324 A CN 202110694324A CN 113376618 B CN113376618 B CN 113376618B
- Authority
- CN
- China
- Prior art keywords
- point cloud
- support arm
- telescopic rod
- workbench
- vector
- 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 16
- 239000011159 matrix material Substances 0.000 claims description 13
- 238000012545 processing Methods 0.000 claims description 12
- 238000013519 translation Methods 0.000 claims description 10
- 230000005484 gravity Effects 0.000 claims description 9
- 238000001514 detection method Methods 0.000 claims description 6
- 230000002159 abnormal effect Effects 0.000 claims description 3
- 230000001174 ascending effect Effects 0.000 claims description 3
- 238000010276 construction Methods 0.000 claims description 3
- 230000010365 information processing Effects 0.000 claims description 3
- 238000010586 diagram Methods 0.000 description 3
- 238000005516 engineering process Methods 0.000 description 3
- 239000000463 material Substances 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000013480 data collection Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000009659 non-destructive testing Methods 0.000 description 1
Classifications
-
- 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
- G01S7/00—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
- G01S7/48—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S17/00
- G01S7/497—Means for monitoring or calibrating
-
- 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
Abstract
本发明公开了一种多路侧激光雷达点云配准装置及点云配准方法,该装置通过机械臂由远程遥控操纵,机械臂可全角度,全方位的对目标物进行扫描,无需人为手动调整激光雷达位置,完整记录采集数据;本发明提供的点云配准方法能实现无任何先验信息和部分点缺失点集的自动配准,在配准效率和精度上都具有实用性和可行性。
Description
技术领域
本发明属于三维激光扫描,点云配准技术领域的应用,具体涉及一种多路侧激光雷达点云配准装置及使用方法。
背景技术
点云数据配准技术在无损检测、人脸识别和三维重建等行业得到广泛的应用,特别是在三维激光扫描技术应用中,点云数据的配准是其重要步骤;目前的三维激光扫描设备和三维激光扫描技术只能采集目标物体表面离散的点云数据,在实际数据采集过程中通常会受到目标对象所处位置、大小和扫描仪器等外在因素的影响,为了获得目标物体完整的点云数据,必须从多个视角对目标进行测量,但这些视角下的数据通常是以测站为原点计算的结果,因此需要确定一个恰当的旋转矩阵和平移向量,以便将多个视角采集到的数据统一转换到同一个坐标系中,这便是点云数据的配准;
但是目前使用的激光扫描装置无法自动实现多角度的对目标物进行扫描,需要人为的调整激光扫描装置位置,在人为调整过程中会导致最终采集的数据不完整。
发明内容
为了解决上述技术问题,本发明设计了一种多路侧激光雷达点云配准装置,该多路侧三维激光扫描装置通过远程遥控操纵,可以多方位多角度的对目标物进行扫描,实现目标物的多点数据采集,保证数据的完整性;
为了达到上述技术效果,本发明是通过以下技术方案实现的:一种多路侧激光雷达点云配准装置,其特征在于,包括:底座、工作台、转盘、副工作台、伸缩柱、第一支臂、第二支臂、第一伸缩杆、第二伸缩杆、第三伸缩杆、第四伸缩杆、激光雷达;
所述底座上表面一体成型连接工作台,工作台上可转动连接着转盘,转盘上固定安装副工作台;副工作台上固定连接伸缩柱,在伸缩柱的上端铰连接第一支臂的后端,第一支臂的前端铰连接第二支臂的后端,第二支臂的前端铰连接着激光雷达;所述底座内部安装自动控制部,自动控制部包括红外接收器、继电器、红外信号处理模块;所述激光雷达内部安装探测组件,探测组件包括发射模块、接收模块、信息处理模块;
优选的,所述底座上安装控制按钮;工作台内中部嵌入安装一台转动电机,转盘下底面嵌入安装在转动电机的转动轴上;转盘与工作台通过转动电机实现可转动连接;
优选的,所述第一支臂与副工作台之间铰连接第一伸缩杆;第一支臂与第二支臂之间铰连接第二伸缩杆;
优选的,所述激光雷达与第二支臂的前端通过第四伸缩杆铰连接;
优选的,所述第四伸缩杆上连接附杆,附杆与第二支臂之间连接第三伸缩杆;且第三伸缩杆的头端与附杆铰连接;
优选的,所述红外接收器与红外信号处理模块连接,红外信号处理模块与继电器连接,继电器有五台,分别控制各伸缩杆;
本发明的另一目的在于提供一种多路侧激光雷达点云配准装置的点云配准方法,主要分为两大部分,分别为点云初始配准和ICP算法的点云精确配准,所述多路侧激光雷达点云配准装置的点云配准方法,其特征在于,包括以下步骤:
S1:将点云到其重心的距离进行升序排序,分别计算排序后最近和最远m个点的均值,作为距离其重心最近和最远的两个极点;
S2:构建以重心为起点,指向其两个极点的向量作为第一和第二特征向量,第一和第二特征向量的和向量的共线负向量作为第三特征向量;
S3:根据矩阵正交和旋转不改变其特征值,利用步骤S2构建的特征向量集计算旋转矩阵R0和平移向量t0;
S4:利用R0和t0对待配准点云进行转换,至此已完成点云的粗配准;
S5:精配准中,选择点对时,计算距离最近的4个点,通过z-score剔除距离异常点,剩余点的均值形成最近点,完成点对的构建;
S6:对初步构建完的点对,通过刚性变化欧式距离和向量夹角的不变性,更新点对;
S7:通过SVD法求解点对的旋转矩阵Rk+1和平移向量tk+1,设定迭代误差
S8:利用旋转矩阵Rk+1和平移向量tk+1对待配准点云进行转换,得到
S9:判断两次迭代误差与给定阈值ε的大小,若dk-dk+1<ε或迭代次数大于给定值,迭代完成否则继续进行上述迭代。
本发明的有益效果是:本发明设计的一种多路侧激光雷达点云配准装置,该装置通过机械臂由远程遥控操纵,机械臂可全角度,全方位的对目标物进行扫描,无需人为手动调整激光雷达位置,完整记录采集数据;本发明提供的点云配准方法能实现无任何先验信息和部分点缺失点集的自动配准,在配准效率和精度上都具有实用性和可行性。
附图说明
为了更清楚地说明本发明实施例的技术方案,下面将对实施例描述所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1是一种多路侧激光雷达点云配准装置的整体结构示意图;
图2是一种多路侧激光雷达点云配准装置的底座及内部元器件结构示意图;
图3是一种多路侧激光雷达点云配准装置的激光雷达及内部元器件结构示意图;
图4是一种多路侧激光雷达点云配准装置的局部放大示意图A;
附图中,各标号所代表的部件列表如下:
1-底座,101-红外接收器,102-继电器,103-红外信号处理模块,2-工作台,201-转动电机,3-转盘,4-副工作台,5-伸缩柱,6-第一支臂,7-第二支臂,8-第一伸缩杆,9-第二伸缩杆,10-第三伸缩杆,11-第四伸缩杆,1101-附杆,12-激光雷达,1201-发射模块,1202-接收模块,1203-信息处理模块。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其它实施例,都属于本发明保护的范围。
实施例1
参阅图1至图4所示,一种多路侧激光雷达点云配准装置,其特征在于,包括:底座1、工作台2、转盘3、副工作台4、伸缩柱5、第一支臂6、第二支臂7、第一伸缩杆8、第二伸缩杆9、第三伸缩杆10、第四伸缩杆11、激光雷达12;
所述底座1上表面一体成型连接工作台2,工作台2上可转动连接着转盘3,转盘3上固定安装副工作台4;副工作台4上固定连接伸缩柱5,在伸缩柱5的上端铰连接第一支臂6的后端,第一支臂6的前端铰连接第二支臂7的后端,第二支臂7的前端铰连接着激光雷达12;所述底座1内部安装自动控制部,自动控制部包括红外接收器101、继电器102、红外信号处理模块103;所述激光雷达12内部安装探测组件,探测组件包括发射模块1201、接收模块1202、信息处理模块1203;
优选的,所述底座1上安装控制按钮;工作台2内中部嵌入安装一台转动电机201,转盘3下底面嵌入安装在转动电机201的转动轴上;转盘3与工作台2通过转动电机201实现可转动连接;
优选的,所述第一支臂6与副工作台4之间铰连接第一伸缩杆8;第一支臂6与第二支臂7之间铰连接第二伸缩杆9;第一伸缩杆8调节第一支臂6的伸展角度,第二伸缩杆9调节第一支臂6和第二支臂7间的伸展角度;
优选的,所述激光雷达12与第二支臂7的前端通过第四伸缩杆11铰连接;第四伸缩杆11调节激光雷达12的升降;
优选的,所述第四伸缩杆11上连接附杆1101,附杆1101与第二支臂7之间连接第三伸缩杆10;且第三伸缩杆10的头端与附杆1101铰连接;第三伸缩杆10调节激光雷达12的方位角度;
优选的,所述红外接收器101与红外信号处理模块103连接,红外信号处理模块103与继电器102连接,继电器102有五台,分别控制各伸缩杆;遥控发射控制红外信号,被红外接收器101接收后,再经红外信号处理模块103处理,最后通过继电器102控制相应的部件实现相关控制操作。
实施例2
一种多路侧激光雷达点云配准装置的点云配准方法,包括以下步骤:
S1:将点云到其重心的距离进行升序排序,分别计算排序后最近和最远m个点的均值,作为距离其重心最近和最远的两个极点;
S2:构建以重心为起点,指向其两个极点的向量作为第一和第二特征向量,第一和第二特征向量的和向量的共线负向量作为第三特征向量;
S3:根据矩阵正交和旋转不改变其特征值,利用步骤S2构建的特征向量集计算旋转矩阵R0和平移向量t0;
S4:利用R0和t0对待配准点云进行转换,至此已完成点云的粗配准;
S5:精配准中,选择点对时,计算距离最近的4个点,通过z-score剔除距离异常点,剩余点的均值形成最近点,完成点对的构建;
S6:对初步构建完的点对,通过刚性变化欧式距离和向量夹角的不变性,更新点对;
S7:通过SVD法求解点对的旋转矩阵Rk+1和平移向量tk+1,设定迭代误差
S8:利用旋转矩阵Rk+1和平移向量tk+1对待配准点云进行转换,得到
S9:判断两次迭代误差与给定阈值ε的大小,若dk-dk+1<ε或迭代次数大于给定值,迭代完成否则继续进行上述迭代。
在本说明书的描述中,参考术语“一个实施例”、“示例”、“具体示例”等的描述意指结合该实施例或示例描述的具体特征、结构、材料或者特点包含于本发明的至少一个实施例或示例中。在本说明书中,对上述术语的示意性表述不一定指的是相同的实施例或示例。而且,描述的具体特征、结构、材料或者特点可以在任何的一个或多个实施例或示例中以合适的方式结合。
以上公开的本发明优选实施例只是用于帮助阐述本发明。优选实施例并没有详尽叙述所有的细节,也不限制该发明仅为所述的具体实施方式。显然,根据本说明书的内容,可作很多的修改和变化。本说明书选取并具体描述这些实施例,是为了更好地解释本发明的原理和实际应用,从而使所属技术领域技术人员能很好地理解和利用本发明。本发明仅受权利要求书及其全部范围和等效物的限制。
Claims (1)
1.一种多路侧激光雷达点云配准的方法,其特征在于,所述方法应用了多路侧激光雷达点云配准装置,所述配准装置包括:底座、工作台、转盘、副工作台、伸缩柱、第一支臂、第二支臂、第一伸缩杆、第二伸缩杆、第三伸缩杆、第四伸缩杆、激光雷达;所述底座上表面一体成型连接工作台,工作台上可转动连接着转盘,转盘上固定安装副工作台;副工作台上固定连接伸缩柱,在伸缩柱的上端铰连接第一支臂的后端,第一支臂的前端铰连接第二支臂的后端,第二支臂的前端铰连接着激光雷达;所述底座内部安装自动控制部,自动控制部包括红外接收器、继电器、红外信号处理模块;所述激光雷达内部安装探测组件,探测组件包括发射模块、接收模块、信息处理模块;所述底座上安装控制按钮,工作台内中部嵌入安装一台转动电机,转盘下底面嵌入安装在转动电机的转动轴上;转盘与工作台通过转动电机实现可转动连接;所述第一支臂与副工作台之间铰连接第一伸缩杆;第一支臂与第二支臂之间铰连接第二伸缩杆;所述激光雷达与第二支臂的前端通过第四伸缩杆铰连接,所述第四伸缩杆上连接附杆,附杆与第二支臂之间连接第三伸缩杆;且第三伸缩杆的头端与附杆铰连接;所述红外接收器与红外信号处理模块连接,红外信号处理模块与继电器连接,继电器有五台,分别控制各伸缩杆;
所述方法包括以下步骤:
S1:将点云到其重心的距离进行升序排序,分别计算排序后最近和最远m个点的均值,作为距离其重心最近和最远的两个极点;
S2:构建以重心为起点,指向其两个极点的向量作为第一和第二特征向量,第一和第二特征向量的和向量的共线负向量作为第三特征向量;
S3:根据矩阵正交和旋转不改变其特征值,利用步骤S2构建的特征向量集计算旋转矩阵R0和平移向量t0;
S4:利用R0和t0对待配准点云进行转换,至此已完成点云的粗配准;
S5:精配准中,选择点对时,计算距离最近的4个点,通过z-score剔除距离异常点,剩余点的均值形成最近点,完成点对的构建;
S6:对初步构建完的点对,通过刚性变化欧式距离和向量夹角的不变性,更新点对;
S7:通过SVD法求解点对的旋转矩阵Rk+1和平移向量tk+1,设定迭代误差
S8:利用旋转矩阵Rk+1和平移向量tk+1对待配准点云进行转换,得到Pi k+1;
S9:判断两次迭代误差与给定阈值ε的大小,若dk-dk+1<ε或迭代次数大于给定值,迭代完成否则继续进行上述迭代。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110694324.XA CN113376618B (zh) | 2021-06-22 | 2021-06-22 | 一种多路侧激光雷达点云配准装置及使用方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110694324.XA CN113376618B (zh) | 2021-06-22 | 2021-06-22 | 一种多路侧激光雷达点云配准装置及使用方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113376618A CN113376618A (zh) | 2021-09-10 |
CN113376618B true CN113376618B (zh) | 2024-03-01 |
Family
ID=77578502
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110694324.XA Active CN113376618B (zh) | 2021-06-22 | 2021-06-22 | 一种多路侧激光雷达点云配准装置及使用方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113376618B (zh) |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108022262A (zh) * | 2017-11-16 | 2018-05-11 | 天津大学 | 一种基于点的邻域重心向量特征的点云配准方法 |
CN110262504A (zh) * | 2019-07-02 | 2019-09-20 | 吉林大学 | 一种结构可调的多激光雷达耦合系统及其控制方法 |
CN111398936A (zh) * | 2020-03-11 | 2020-07-10 | 山东大学 | 一种多路侧激光雷达点云配准装置及其使用方法 |
CN111735479A (zh) * | 2020-08-28 | 2020-10-02 | 中国计量大学 | 一种多传感器联合标定装置及方法 |
CN111913184A (zh) * | 2020-09-01 | 2020-11-10 | 江苏普达迪泰科技有限公司 | 一种具有高密度点云的数据采集功能的激光雷达 |
US10891744B1 (en) * | 2019-03-13 | 2021-01-12 | Argo AI, LLC | Determining the kinetic state of a body using LiDAR point cloud registration with importance sampling |
CN213220639U (zh) * | 2020-09-11 | 2021-05-18 | 四川千页科技股份有限公司 | 一种搭载在机械臂上的高压细水雾的变电站消防机器人 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US9796089B2 (en) * | 2013-03-15 | 2017-10-24 | Carnegie Mellon University | Supervised autonomous robotic system for complex surface inspection and processing |
-
2021
- 2021-06-22 CN CN202110694324.XA patent/CN113376618B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108022262A (zh) * | 2017-11-16 | 2018-05-11 | 天津大学 | 一种基于点的邻域重心向量特征的点云配准方法 |
US10891744B1 (en) * | 2019-03-13 | 2021-01-12 | Argo AI, LLC | Determining the kinetic state of a body using LiDAR point cloud registration with importance sampling |
CN110262504A (zh) * | 2019-07-02 | 2019-09-20 | 吉林大学 | 一种结构可调的多激光雷达耦合系统及其控制方法 |
CN111398936A (zh) * | 2020-03-11 | 2020-07-10 | 山东大学 | 一种多路侧激光雷达点云配准装置及其使用方法 |
CN111735479A (zh) * | 2020-08-28 | 2020-10-02 | 中国计量大学 | 一种多传感器联合标定装置及方法 |
CN111913184A (zh) * | 2020-09-01 | 2020-11-10 | 江苏普达迪泰科技有限公司 | 一种具有高密度点云的数据采集功能的激光雷达 |
CN213220639U (zh) * | 2020-09-11 | 2021-05-18 | 四川千页科技股份有限公司 | 一种搭载在机械臂上的高压细水雾的变电站消防机器人 |
Non-Patent Citations (2)
Title |
---|
李绕波 等.利用重心特征变换处理的点云配准方法研究.《光子学报》.2021,第50卷(第11期),145-155. * |
王宾 等.应用改进迭代最近点方法的三维心脏点云配准.《光学精密工程》.2020,第28卷(第2期),474-484. * |
Also Published As
Publication number | Publication date |
---|---|
CN113376618A (zh) | 2021-09-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108161936B (zh) | 优化的机器人标定方法及装置 | |
JP2022039906A (ja) | マルチセンサによる複合キャリブレーション装置及び方法 | |
CN108151668B (zh) | 一种叶片型面全数据测量拼接方法及装置 | |
WO2016101643A1 (zh) | 一种仪表数据读取方法及系统 | |
WO2012053521A1 (ja) | 光学情報処理装置、光学情報処理方法、光学情報処理システム、光学情報処理プログラム | |
CN111627072A (zh) | 一种对多传感器进行标定的方法、装置和存储介质 | |
CN112781496B (zh) | 一种非接触测量系统的测头位姿标定方法 | |
CN112785655A (zh) | 一种基于车道线检测的环视相机外参自动标定方法、装置、设备及计算机存储介质 | |
CN111702054A (zh) | 一种曲板渐进成形在位调形检测系统及方法 | |
CN112258583B (zh) | 基于等畸变量分区的近景图像畸变标定方法 | |
CN109472778B (zh) | 一种基于无人机的高耸结构外观检测方法 | |
CN111366908A (zh) | 一种激光雷达转台及其测量装置和测量方法 | |
CN109737871B (zh) | 一种三维传感器与机械手臂的相对位置的标定方法 | |
CN113376618B (zh) | 一种多路侧激光雷达点云配准装置及使用方法 | |
CN111583342A (zh) | 一种基于双目视觉的目标快速定位方法及装置 | |
CN208478309U (zh) | 一种用于晶圆对准的光学成像装置和晶圆对准系统 | |
CN114463425A (zh) | 一种基于概率Hough直线检测的工件表面无特征点定位方法 | |
CN113628210A (zh) | 基于线激光的复杂异构产品装配参数检测方法及系统 | |
CN113781558A (zh) | 一种姿态与位置解耦的机器人视觉寻位方法 | |
CN114152937B (zh) | 一种旋转激光雷达的外参标定方法 | |
CN115908294A (zh) | 一种基于3d激光雷达的高压隔离开关分合闸状态判别方法 | |
CN111854678B (zh) | 一种单目视觉下基于语义分割和卡尔曼滤波的位姿测量方法 | |
CN102183305A (zh) | 光学微扫描显微热成像系统的微扫描定标方法 | |
CN111397514A (zh) | 一种倾角误差控制方法 | |
CN114640781B (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 |