基于激光跟踪仪的移动检测机器人大型构件外形重构方法技术

本发明专利技术涉及一种基于激光跟踪仪的移动检测机器人大型构件外形重构方法，包括如下步骤：(1)基于激光跟踪仪构建不同坐标系；在激光跟踪仪坐标系下，通过采用激光跟踪仪进行测量，从而构建全向移动平台坐标系、基准坐标系以及视觉测量系统坐标系；(2)进行模型的空间点可测性检查；(3)进行基于模型的空间点自动测量；(4)获取测量点云数据；(5)进行外形匹配评价，从而完成外形重构。本发明专利技术减少了测量反复、大量人工参与测量过程，提高了测量与评价的效率，保证了人员安全性。同时，本发明专利技术实现了在虚拟环境下控制物理的移动检测机器人系统，并通过激光跟踪仪现有功能消失位置偏差，达到以虚控实的过程。

Shape reconstruction of large components of mobile inspection robot based on laser tracker

【技术实现步骤摘要】
基于激光跟踪仪的移动检测机器人大型构件外形重构方法
本专利技术涉及一种基于激光跟踪仪的移动检测机器人大型构件外形重构方法，属于移动检测机器人高精度测量领域。
技术介绍
大型复杂构件，如大型航天器舱体构件、风电叶片、高铁车体结构件等，具有尺寸大、形面复杂、刚性弱等特点，其外形设计精度要求越来越高，对大型复杂构件的检测装备和工艺方法均提出了挑战。当前，外形检测系统多采用固定方式进行测量，以保证外形的测量精度。但是随着大型复杂构件尺寸不断增加，精度不断提升，大型固定式检测装备无论在形成、功能上都难以满足检测需求。因此，需要以移动检测机器人为基础，提出基于激光跟踪仪的移动检测机器人大型构件外形重构方法。移动检测机器人继承了关节型机器人作业空间大、可重构性强的优点，辅以全向移动平台及视觉测量技术，形成了移动式机器人集成检测系统，构建一种新的检测模式，成为解决上述大型复杂构件现场高效、高精度、高柔性检测难题的有效手段。基于此，移动检测机器人技术得到了快速发展。例如，《一种可移动式三维检测机器人系统》，专利号CN201711482288.0，只描述了移动检测机器人系统所包括得路径规划子系统、可移动三维检测机器人子系统、检测数据采集与分析子系统，并未给出面向外形检测的应用方式。
技术实现思路
本专利技术的技术解决问题是：克服现有技术的不足，提供一种基于激光跟踪仪的移动检测机器人大型构件外形重构方法。该方法基于移动式检测机器人，采用激光跟踪仪对全向移动平台与视觉测量系统进行跟踪测量，实现精确坐标系关系建立，并与大型构件三维模型对比，给出外形评价结果。本专利技术的技术解决方案是：基于激光跟踪仪的移动检测机器人大型构件外形重构方法，步骤如下：(1)基于激光跟踪仪构建不同坐标系；在激光跟踪仪坐标系下，通过采用激光跟踪仪进行测量，从而构建全向移动平台坐标系、基准坐标系以及视觉测量系统坐标系；(2)进行模型的空间点可测性检查；(3)进行基于模型的空间点自动测量；(4)获取测量点云数据；(5)进行外形匹配评价，从而完成外形重构。进一步的，激光跟踪仪坐标系即为激光跟踪仪的设计坐标系x1y1z1o1；基准坐标系的定义如下：通过激光跟踪仪测量构件支撑工装侧面4个点，拟合一个平面x2y2o2，其法线为坐标系z2轴，方向为垂直平面x2y2o2向外，o2为侧面中心，测量工装上表面上4个点，拟合一个平面y2z2o2，其法线为坐标系x2轴，方向为垂直平面向上，y2通过右手定确定；全向移动平台坐标系x3y3z3o3：通过激光跟踪仪测量x3y3z3o3下全向移动平台的4个公共点，即关键测量靶标点，对于4个公共点的任意一点Pi，i＝1,2,3,4，其在x1y1z1o1坐标系下的位置用向量表示为：PiGO＝[PiGO,1]T，其中PiGO＝(xiGO,yiGO,ziGO)为点Pi在x1y1z1o1坐标系下的坐标；在x3y3z3o3坐标系下的位置用向量表示为：PiLO＝[PiLO,1]T，其中PiLO＝(xiLO,yiLO,ziLO)为点Pi在x3y3z3o3坐标系下的坐标。进一步的，全向移动平台坐标系x3y3z3o3和激光跟踪仪坐标系之间的变换矩阵为T3-1，且有T3-1·PiLO＝PiGO；其中，T3-1为4×4的方阵；其中3-1R3×3表示旋转矩阵，3-1M3×1表示平移向量，然后基于4个公共点，采用奇异值分解法即可求出T3-1。进一步的，视觉测量系统坐标系x4y4z4o4：通过激光跟踪仪测量视觉测量系统坐标系x4y4z4o4下的4个公共点，即关键测量靶标点，对于4个公共点的任意一点Pi，i＝1,2,3,4，其在x1y1z1o1坐标系下的位置用向量表示为：PiGV＝[PiGV,1]T，其中PiGV＝(xiGV,yiGV,ziGV)为点Pi在x1y1z1o1坐标系下的坐标；在x4y4z4o4坐标系下的位置用向量表示为：PiLV＝[PiLV,1]T，其中PiL＝(xiLV,yiLV,ziLV)为点Pi在x4y4z4o4坐标系下的坐标。进一步的，视觉测量系统坐标系x4y4z4o4和激光跟踪仪坐标系之间的变换矩阵为T4-1，使得T4-1·PiLV＝PiGV；其中，T4-1为4×4的方阵；其中4-1R3×3表示旋转矩阵，4-1M3×1表示平移向量，然后基于4个公点，采用奇异值分解法即可求出T4-1。进一步的，步骤(2)进行模型的空间点可测性检查具体为：根据移动检测机器人系统实际布局状态，结合系统三维模型，实现虚拟环境下的模型布局，并确定关键测量靶标点理论位置；在虚拟环境下激光跟踪仪测量简化为点到点的直线，通过当前布局状态，结合关键测量靶标点理论位置，获得多条直线；将上述直线与三维模型进行布尔运算，若干涉则剔除靶标点，变换布局状态，再进行干涉检查，最终实现基于模型的空间点可测性检查。进一步的，步骤(3)进行基于模型的空间点自动测量，具体为：移动检测机器人平移运动到指定位置，调整视觉测量系统位姿，对构件的特征进行测量，当全向移动平台移动后，在虚拟环境下，全向移动平台坐标系x3y3z3o3在激光跟踪仪坐标系下变为x31y31z31o31，而x31y31z31o31坐标系相对于全向移动平台坐标系x3y3z3o3位姿T31-3可通过全向移动平台车的移动指令{x,y,z,α,β,γ}获得；基于T3-1，则：T31-1＝T31-3·T3-1T31-1表示移动后的全向移动平台坐标系x31y31z31o31相对于激光跟踪仪坐标系x1y1z1o1的位姿；视觉测量系统上关键测量靶标点坐标向量PiLV，通过机器人面板的理论位姿信息T4-3，则将转换到全向移动平台坐标系下获得PiLOPiLO＝(T4-3)-1PiLV则视觉测量系统上关键测量靶标点在激光跟踪仪坐标系x1y1z1o1下坐标向量为PiGO，满足T31-1·PiLO＝PiGO。进一步的，虚拟环境下获得理论关键测量靶标点在激光跟踪仪坐标下的理论坐标，采用激光跟踪仪的二次开发函数GoAndMeasure，对理论坐标进行直接测量，并基于自动寻点功能，实现坐标线偏差的补偿，进而实现基于模型的空间点自动测量。进一步的，步骤(4)测量点云数据获取具体为：视觉测量系统对构件特征进行测量，获得视场内的点云数据，并将点云数据经过坐标转换至激光跟踪仪坐标系下，进而转换至基准坐标系下。进一步的，步骤(5)外形匹配评价具体为：通过全向移动平台多次移动，配合机器人位姿调整，对构件的多个特征进行测量，经过坐标转换至基准坐标系下；在虚拟环境下与构件三维模型进匹配，基于点云数据进行特征的拟合，并将量化误差进行可视化显示，实现对构件外形的评价。本专利技术与现有技术相比的有益效果是：(1)本专利技术减少了测量反复、大量人工参与测量过程，提高了测量与评价的效率，保证了人员安全性。(2)本专利技术实现了本文档来自技高网...

【技术保护点】
1.基于激光跟踪仪的移动检测机器人大型构件外形重构方法，其特征在于步骤如下：/n(1)基于激光跟踪仪构建不同坐标系；/n在激光跟踪仪坐标系下，通过采用激光跟踪仪进行测量，从而构建全向移动平台坐标系、基准坐标系以及视觉测量系统坐标系；/n(2)进行模型的空间点可测性检查；/n(3)进行基于模型的空间点自动测量；/n(4)获取测量点云数据；/n(5)进行外形匹配评价，从而完成外形重构。/n

【技术特征摘要】
1.基于激光跟踪仪的移动检测机器人大型构件外形重构方法，其特征在于步骤如下：
(1)基于激光跟踪仪构建不同坐标系；
在激光跟踪仪坐标系下，通过采用激光跟踪仪进行测量，从而构建全向移动平台坐标系、基准坐标系以及视觉测量系统坐标系；
(2)进行模型的空间点可测性检查；
(3)进行基于模型的空间点自动测量；
(4)获取测量点云数据；
(5)进行外形匹配评价，从而完成外形重构。


2.根据权利要求1所述的基于激光跟踪仪的移动检测机器人大型构件外形重构方法，其特征在于：激光跟踪仪坐标系即为激光跟踪仪的设计坐标系x1y1z1o1；
基准坐标系的定义如下：通过激光跟踪仪测量构件支撑工装侧面4个点，拟合一个平面x2y2o2，其法线为坐标系z2轴，方向为垂直平面x2y2o2向外，o2为侧面中心，测量工装上表面上4个点，拟合一个平面y2z2o2，其法线为坐标系x2轴，方向为垂直平面向上，y2通过右手定确定；
全向移动平台坐标系x3y3z3o3：通过激光跟踪仪测量x3y3z3o3下全向移动平台的4个公共点，即关键测量靶标点，对于4个公共点的任意一点Pi，i＝1,2,3,4，其在x1y1z1o1坐标系下的位置用向量表示为：PiGO＝[PiGO,1]T，其中PiGO＝(xiGO,yiGO,ziGO)为点Pi在x1y1z1o1坐标系下的坐标；在x3y3z3o3坐标系下的位置用向量表示为：PiLO＝[PiLO,1]T，其中PiLO＝(xiLO,yiLO,ziLO)为点Pi在x3y3z3o3坐标系下的坐标。


3.根据权利要求2所述的基于激光跟踪仪的移动检测机器人大型构件外形重构方法，其特征在于：全向移动平台坐标系x3y3z3o3和激光跟踪仪坐标系之间的变换矩阵为T3-1，且有T3-1·PiLO＝PiGO；
其中，T3-1为4×4的方阵；



其中3-1R3×3表示旋转矩阵，3-1M3×1表示平移向量，然后基于4个公共点，采用奇异值分解法即可求出T3-1。


4.根据权利要求2所述的基于激光跟踪仪的移动检测机器人大型构件外形重构方法，其特征在于：视觉测量系统坐标系x4y4z4o4：通过激光跟踪仪测量视觉测量系统坐标系x4y4z4o4下的4个公共点，即关键测量靶标点，对于4个公共点的任意一点Pi，i＝1,2,3,4，其在x1y1z1o1坐标系下的位置用向量表示为：PiGV＝[PiGV,1]T，其中PiGV＝(xiGV,yiGV,ziGV)为点Pi在x1y1z1o1坐标系下的坐标；在x4y4z4o4坐标系下的位置用向量表示为：PiLV＝[PiLV,1]T，其中PiL＝(xiLV,yiLV,ziLV)为点Pi在x4y4z4o4坐标系下的坐标。


5.根据权利要求4所述的基于激光跟踪仪的移动检测机器人大型构件外形重构方法，其特征在于：视觉测量系统坐标系x4y4z4o4和激光跟踪仪坐标系之间的变换矩阵为T4-1，使得T4-1·PiLV＝PiGV；
其中，T4-1为...

【专利技术属性】
技术研发人员：韩建超，张加波，文科，刘辛军，谢福贵，王海元，徐建萍，
申请(专利权)人：北京卫星制造厂有限公司，
类型：发明
国别省市：北京;11