CN117984074A - 一种用于大型三维立体装配无固定测量点调姿定位方法 - Google Patents
一种用于大型三维立体装配无固定测量点调姿定位方法 Download PDFInfo
- Publication number
- CN117984074A CN117984074A CN202410374736.9A CN202410374736A CN117984074A CN 117984074 A CN117984074 A CN 117984074A CN 202410374736 A CN202410374736 A CN 202410374736A CN 117984074 A CN117984074 A CN 117984074A
- Authority
- CN
- China
- Prior art keywords
- plane
- theoretical
- matrix
- dimensional
- points
- 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.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 42
- 238000005259 measurement Methods 0.000 claims abstract description 16
- 239000011159 matrix material Substances 0.000 claims description 106
- 239000013598 vector Substances 0.000 claims description 64
- 238000013519 translation Methods 0.000 claims description 25
- 238000000354 decomposition reaction Methods 0.000 claims description 8
- 238000012545 processing Methods 0.000 abstract description 5
- 238000011156 evaluation Methods 0.000 description 4
- 238000010586 diagram Methods 0.000 description 2
- PCTMTFRHKVHKIS-BMFZQQSSSA-N (1s,3r,4e,6e,8e,10e,12e,14e,16e,18s,19r,20r,21s,25r,27r,30r,31r,33s,35r,37s,38r)-3-[(2r,3s,4s,5s,6r)-4-amino-3,5-dihydroxy-6-methyloxan-2-yl]oxy-19,25,27,30,31,33,35,37-octahydroxy-18,20,21-trimethyl-23-oxo-22,39-dioxabicyclo[33.3.1]nonatriaconta-4,6,8,10 Chemical compound C1C=C2C[C@@H](OS(O)(=O)=O)CC[C@]2(C)[C@@H]2[C@@H]1[C@@H]1CC[C@H]([C@H](C)CCCC(C)C)[C@@]1(C)CC2.O[C@H]1[C@@H](N)[C@H](O)[C@@H](C)O[C@H]1O[C@H]1/C=C/C=C/C=C/C=C/C=C/C=C/C=C/[C@H](C)[C@@H](O)[C@@H](C)[C@H](C)OC(=O)C[C@H](O)C[C@H](O)CC[C@@H](O)[C@H](O)C[C@H](O)C[C@](O)(C[C@H](O)[C@H]2C(O)=O)O[C@H]2C1 PCTMTFRHKVHKIS-BMFZQQSSSA-N 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 239000007787 solid Substances 0.000 description 1
Landscapes
- Length Measuring Devices With Unspecified Measuring Means (AREA)
- Length Measuring Devices By Optical Means (AREA)
Abstract
本发明涉及大型三维立体数字化加工装配技术领域,具体地说,涉及一种用于大型三维立体装配无固定测量点调姿定位方法;该方法通过采用无固定测量点的方式,减少了三维立体大部件前期在各个平面布置测量点的步骤,提高了对三维部件的测量效率,同时降低了点位过约束影响,提供了无固定测量点的调姿定位方式,保证了三维立体部件全过程装配效率;并通过激光跟踪仪建立全局坐标系,提到了测量精度保证了测量的准确性。
Description
技术领域
本发明涉及大型三维立体数字化加工装配技术领域,具体地说,涉及一种用于大型三维立体装配无固定测量点调姿定位方法。
背景技术
在大型三维立体数字化加工/装配领域,一般采用数控***机组对三维立体部件进行支撑,并在三维立体部件上布置上测量点并给出理论点位坐标,通过激光跟踪仪测量部件当前状态下布置测量点的位置坐标,根据当前状态与理论状态的位置偏差控制数控***往理论姿态运动,最后使三维立体部件调整到理论姿态。在整个过程中,前期需要布置大量的测量点,且花费大量的时间,同时每个点均需要进行相应的约束,很大程度上可能造成点位过约束,并且在测量期间需要每个点以此测量,严重影响测量的效率甚至整个三维立体部件装配全过程的效率。
发明内容
本发明针对现有的调姿定位方法前期需要布置大量的测量点,严重影响测量的效率甚至整个三维立体部件装配全过程的效率的问题,提出一种用于大型三维立体装配无固定测量点调姿定位方法;通过采用无固定测量点的方式,减少了三维立体大部件前期在各个平面布置测量点的步骤,提高了对三维立体部件的测量效率,同时降低了点位过约束影响,提供了无固定测量点的调姿定位方式,保证了三维立体部件全过程装配效率;并通过激光跟踪仪建立全局坐标系,提到了测量精度保证了测量的准确性。
本发明具体实现内容如下:
一种用于大型三维立体装配无固定测量点调姿定位方法,具体包括以下步骤:
步骤S1:利用激光跟踪仪在三维立体部件的平面构建全局坐标系,确定三维立体部件的理论状态,并构建理论平面法向量矩阵;
步骤S2:在所述三维立体部件底部安装数控***,在三维立体部件的平面上任意选择n个点,测量n个点在当前状态下的位置坐标,得到当前状态下的平面法向量矩阵;
步骤S3:根据所述理论平面法向量矩阵和所述当前状态下的平面法向量矩阵,调用奇异值分解法得到三维立体部件从当前状态到理论状态的姿态旋转矩阵,并根据所述姿态旋转矩阵驱动数控***旋转三维立体部件;
步骤S4:在旋转后的三维立体部件的平面上任意选择n个点,测量n个点在当前状态下的位置坐标,得到旋转后的平面法向量矩阵,计算理论平面与旋转后平面的向量夹角;
步骤S5:根据所述向量夹角计算角度误差,并根据设定的容差值判断所述角度误差是否符合误差容差,若不符合则返回步骤S2,若符合则执行步骤S6;
步骤S6:求解旋转后的三维立体部件的平面与全局坐标系坐标轴的交点,计算沿方向轴的平移量,调用数控***平移三维立体部件,计算平移后的平面与坐标轴的交点与理论平面与坐标轴交点的误差交点矩阵,调姿定位三维立体部件。
为了更好地实现本发明,进一步地,所述步骤S1具体包括以下步骤:
步骤S11:利用激光跟踪仪在三维立体部件的平面构建全局坐标系,根据所述全局坐标系确定三维立体部件的理论状态;
步骤S12:根据所述三维立体部件的理论状态,构建三维立体部件理论平面方程;
步骤S13:求解所述三维立体部件理论平面方程,得到平面在理论状态下的法向量,构建理论平面法向量矩阵Vt;
步骤S14:根据所述理论平面法向量矩阵Vt,计算理论平面与全局坐标系的坐标轴的交点坐标,并根据所述交点坐标得到理论平面与坐标轴的交点理论矩阵Qt。
为了更好地实现本发明,进一步地,所述步骤S2具体包括以下步骤:
步骤S21:在所述三维立体部件底部安装数控***,根据所述激光跟踪仪在三维立体部件的平面j上任意选择n个点;
步骤S22:测量n个点在当前状态下的位置坐标,得到坐标矩阵PCj;
步骤S23:根据所述坐标矩阵PCj,得到平面j的平面拟合方程;
步骤S24:根据所述平面拟合方程,计算平面法向量矩阵Vp。
为了更好地实现本发明,进一步地,所述步骤S3具体包括以下步骤:
步骤S31:根据所述理论平面法向量矩阵Vt和所述平面法向量矩阵Vp,计算绕全局坐标系三个坐标轴的旋转量;
步骤S32:调用奇异值分解法得到三维立体部件从当前状态到理论状态的姿态旋转矩阵Rpt;步骤S33:根据所述姿态旋转矩阵Rpt驱动数控***旋转三维立体部件。
为了更好地实现本发明,进一步地,所述步骤S4具体包括以下步骤:
步骤S41:在旋转后的三维立体部件的平面上任意选择n个点,测量n个点在当前状态下的位置坐标,得到坐标矩阵PCj ’;
步骤S42:根据所述坐标矩阵PCj ’,得到旋转后的平面j的平面拟合方程;
步骤S43:根据旋转后的平面拟合方程,得到旋转后的平面法向量矩阵Vp ’,计算理论平面与旋转后平面的向量夹角。
为了更好地实现本发明,进一步地,所述步骤S6具体包括以下步骤:
步骤S61:求解符合误差容差的旋转后的三维立体部件的平面与全局坐标系坐标轴的交点,得到理论平面与坐标轴的交点理论矩阵QN;
步骤S62:根据所述交点理论矩阵QN,计算沿方向轴的平移量;
步骤S63:根据所述平移量调用数控***平移三维立体部件,在平移后的三维立体部件的平面上任意选择n个点,测量n个点在当前状态下的位置坐标,得到坐标矩阵PCj ’’;
步骤S64:根据所述坐标矩阵PCj ’’,得到平移后的平面j的平面拟合方程;
步骤S65:根据平移后的平面拟合方程,求解平移后的平面j与全局坐标系的交点,得到交点矩阵QF;
步骤S66:根据所述交点矩阵QF,计算平移后的平面j与坐标轴的交点和理论平面与坐标轴交点的误差交点矩阵ef,得到位置误差容差;
步骤S67:若所述位置误差容差符合误差容差要求,则完成三维立体部件的调姿定位;若不符合误差容差要求,则返回步骤S21。
本发明具有以下有益效果:
(1)本发明通过采用无固定测量点调姿定位方法,减少了三维立体大部件前期在各个平面布置测量点的步骤,提高了对部件的测量效率,同时降低了点位过约束影响,提供了无固定测量点的调姿定位方式,保证了三维立体部件全过程装配效率。
(2)本发明采用激光跟踪仪进行测量,测量精度高、性能稳定,可适应复杂加工环境,保证了测量值的准确性;适用于任意平面拟合适用范围广。
附图说明
图1是本发明提供的数控***支撑的三维立体部件在全局坐标下的姿态示意图。
图2是本发明提供的三维立体部件当前姿态下的第j个平面示意图。
图3是本发明提供的三维立体部件旋转后的第j个平面示意图。
图4是本发明提供的三维立体部件平移后的第j个平面示意图。
图5是本发明提供的三维立体部件的理论状态和实际支撑状态示意图。
1、激光跟踪仪,2、数控***,3、三维立体部件。
具体实施方式
为了更清楚地说明本发明实施例的技术方案,下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,应当理解,所描述的实施例仅仅是本发明的一部分实施例,而不是全部的实施例,因此不应被看作是对保护范围的限定。基于本发明中的实施例,本领域普通技术工作人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
在本发明的描述中,需要说明的是,除非另有明确的规定和限定,术语“设置”、“相连”、“连接”应做广义理解,例如,可以是固定连接,也可以是可拆卸连接,或一体地连接;可以是机械连接,也可以是电连接;也可以是直接相连,也可以是通过中间媒介间接相连,可以是两个元件内部的连通。对于本领域的普通技术人员而言,可以具体情况理解上述术语在本发明中的具体含义。
实施例1:
本实施例提出一种用于大型三维立体装配无固定测量点调姿定位方法,具体包括以下步骤:
步骤S1:利用激光跟踪仪1在三维立体部件3的平面构建全局坐标系,确定三维立体部件3的理论状态,并构建理论平面法向量矩阵。
所述步骤S1具体包括以下步骤:
步骤S11:利用激光跟踪仪1在三维立体部件3的平面构建全局坐标系,根据所述全局坐标系确定三维立体部件3的理论状态;
步骤S12:根据所述三维立体部件3的理论状态,构建三维立体部件理论平面方程;
步骤S13:求解所述三维立体部件理论平面方程,得到平面在理论状态下的法向量,构建理论平面法向量矩阵Vt;
步骤S14:根据所述理论平面法向量矩阵Vt,计算理论平面与全局坐标系的坐标轴的交点坐标,并根据所述交点坐标得到理论平面与坐标轴的交点理论矩阵Qt。
步骤S2:在所述三维立体部件3底部安装数控***2,在三维立体部件3的平面上任意选择n个点,测量n个点在当前状态下的位置坐标,得到当前状态下的平面法向量矩阵。
所述步骤S2具体包括以下步骤:
步骤S21:在所述三维立体部件3底部安装数控***2,根据所述激光跟踪仪1在三维立体部件3的平面j上任意选择n个点;
步骤S22:测量n个点在当前状态下的位置坐标,得到坐标矩阵PCj;
步骤S23:根据所述坐标矩阵PCj,得到平面j的平面拟合方程;
步骤S24:根据所述平面拟合方程,计算平面法向量矩阵Vp。
步骤S3:根据所述理论平面法向量矩阵和所述当前状态下的平面法向量矩阵,调用奇异值分解法得到三维立体部件3从当前状态到理论状态的姿态旋转矩阵,并根据所述姿态旋转矩阵驱动数控***2旋转三维立体部件3。
进一步地,所述步骤S3具体包括以下步骤:
步骤S31:根据所述理论平面法向量矩阵Vt和所述平面法向量矩阵Vp,计算绕全局坐标系三个坐标轴的旋转量;
步骤S32:调用奇异值分解法得到三维立体部件3从当前状态到理论状态的姿态旋转矩阵Rpt;步骤S33:根据所述姿态旋转矩阵Rpt驱动数控***2旋转三维立体部件3。
步骤S4:在旋转后的三维立体部件3的平面上任意选择n个点,测量n个点在当前状态下的位置坐标,得到旋转后的平面法向量矩阵,计算理论平面与旋转后平面的向量夹角。
所述步骤S4具体包括以下步骤:
步骤S41:在旋转后的三维立体部件3的平面上任意选择n个点,测量n个点在当前状态下的位置坐标,得到坐标矩阵PCj ’;
步骤S42:根据所述坐标矩阵PCj ’,得到旋转后的平面j的平面拟合方程;
步骤S43:根据旋转后的平面拟合方程,得到旋转后的平面法向量矩阵Vp ’,计算理论平面与旋转后平面的向量夹角。
步骤S5:根据所述向量夹角计算角度误差,并根据设定的容差值判断所述角度误差是否符合误差容差,若不符合则返回步骤S2,若符合则执行步骤S6。
步骤S6:求解旋转后的三维立体部件3的平面与全局坐标系坐标轴的交点,计算沿方向轴的平移量,调用数控***2平移三维立体部件3,计算平移后的平面与坐标轴的交点与理论平面与坐标轴交点的误差交点矩阵,调姿定位三维立体部件3。
进一步地,所述步骤S6具体包括以下步骤:
步骤S61:求解符合误差容差的旋转后的三维立体部件3的平面与全局坐标系坐标轴的交点,得到理论平面与坐标轴的交点理论矩阵QN;
步骤S62:根据所述交点理论矩阵QN,计算沿方向轴的平移量;
步骤S63:根据所述平移量调用数控***2平移三维立体部件3,在平移后的三维立体部件3的平面上任意选择n个点,测量n个点在当前状态下的位置坐标,得到坐标矩阵PCj ’’;
步骤S64:根据所述坐标矩阵PCj ’’,得到平移后的平面j的平面拟合方程;
步骤S65:根据平移后的平面拟合方程,求解平移后的平面j与全局坐标系的交点,得到交点矩阵QF;
步骤S66:根据所述交点矩阵QF,计算平移后的平面j与坐标轴的交点和理论平面与坐标轴交点的误差交点矩阵ef,得到位置误差容差;
步骤S67:若所述位置误差容差符合误差容差要求,则完成三维立体部件3的调姿定位;若不符合误差容差要求,则返回步骤S21。
工作原理:本实施例首先利用激光跟踪仪1在三维立体部件3的平面构建全局坐标系,确定三维立体部件3的理论状态,并构建理论平面法向量矩阵;其次在所述三维立体部件3底部安装数控***2,在三维立体部件3的平面上任意选择n个点,测量n个点在当前状态下的位置坐标,得到当前状态下的平面法向量矩阵;然后根据所述理论平面法向量矩阵和所述当前状态下的平面法向量矩阵,调用奇异值分解法得到三维立体部件3从当前状态到理论状态的姿态旋转矩阵,并根据所述姿态旋转矩阵驱动数控***2旋转三维立体部件3;并在旋转后的三维立体部件3的平面上任意选择n个点,测量n个点在当前状态下的位置坐标,得到旋转后的平面法向量矩阵,计算理论平面与旋转后平面的向量夹角;然后根据所述向量夹角计算角度误差,并根据设定的容差值判断所述角度误差是否符合误差容差,若不符合则返回步骤S2,若符合则执行步骤S6;最后求解旋转后的三维立体部件3的平面与全局坐标系坐标轴的交点,计算沿方向轴的平移量,调用数控***2平移三维立体部件3,计算平移后的平面与坐标轴的交点与理论平面与坐标轴交点的误差交点矩阵,调姿定位三维立体部件3;通过采用无固定测量点的方式,减少了前期部件平面布置测量点的工作,无需寻找固定的测量点,可快速实现测量,提高了作业效率,利用激光跟踪仪1进行测量,其测量精度高、性能稳定,可适应复杂加工环境,保证测量值的准确性。
实施例2:
本实施例在上述实施例1的基础上,如图1、图2、图3、图4、图5所示,以一个具体的实施例进行详细说明。
具体实施步骤如下:
步骤1、如图1所示,在三维立体部件3的各个平面不布置固定测量点,并利用激光跟踪仪1建立全局坐标系,基于全局坐标系确定三维立体部件3的理论状态。
本实施例采用的激光跟踪仪1性能稳定,可适应恶劣环境。
步骤2、通过步骤1所述的三维立体部件3的理论状态,由于平面BCGH在三维立体部件3底部,测量困难,可通过图1分析,固通过其他平面对三维立体部件3进行描述,如图2所示确定部件其余各个平面的理论平面方程并进行以下相关描述;
理论平面1:;
理论平面2:;
理论平面3:;
理论平面4:;
理论平面5:;
以上Wti、Sti、Tti、Uti均不为0,其中i=1,2,3,4,5;理论平面1表示平面ABCD,理论平面2表示平面EFAD,理论平面3表示平面EFGH,理论平面4表示平面AEHB,理论平面5表示平面DFGC。
步骤3、通过三维立体部件理论平面方程,求解出各个平面在理论状态下的法向量,用相关矩阵描述,并计算出各个理论平面与全局坐标系各个坐标轴的交点坐标,并用相关矩阵进行表示;
理论平面法向量矩阵:
理论平面与全局坐标系坐标轴X轴的理论交点为:;
理论平面与全局坐标系坐标轴Y轴的理论交点为:;
理论平面与全局坐标系坐标轴Z轴的理论交点为:;
其中i=1,2,3,4,5;
理论平面与坐标轴的交点理论矩阵:
步骤4、利用一组数控***2将三维立体部件3进行支撑,立体部件在当前状态下,利用激光跟踪仪1对部件各个平面上的任意寻找n个点,进行测量,测出当前n个点在当前状态下的位置坐标,并用相关矩阵进行记录。
本实施例中一组数控***2为4个;本实施例中n≥3,不能在一条直线上,如图2所示,尽量布局到可以准确描述整个平面的地方。本实施例中设置的三维立体部件3每个面均为平面,且需要评估的平面至少3个,同时三个平面必须异面。
本实施例中设置的数控***2满足各项精度指标,包括空间定位精度、重复定位精度以及几何精度等。
每个平面有i个测量点,i=3,4,5,6…,n;
其中,PCj表示第j个平面的n个点组成矩阵,j=1,2,3,4,5。
步骤5、利用步骤4中三维立体部件3各个平面上n个测量点的当前坐标,拟合各个平面的当前平面方程;
第j个平面拟合方程,j=1,2,3,4,5;
其中:
,
步骤6、通过步骤5中的三维立体部件3当前状态下的平面方程和基于法向量的象限判断规则,计算出每个平面的法向量,并用矩阵进行描述;
步骤7、通过步骤3三维立体部件3各个平面在理论状态下的法向量和步骤6所计算出实际状态下各个平面的法向量,利用传统奇异值分解法,求解出三维立体部件3从当前状态到理论状态的旋转矩阵,同时姿态旋转矩阵Rpt表示如下;
其中αpt,βpt,γpt分别为绕全局坐标系的三个坐标轴的旋转量。
步骤8、通过利用步骤7所计算出的姿态旋转矩阵,驱动当前数控***2使三维立体部件3进行旋转运动;
步骤9、如图3所示,通过激光跟踪仪1测量经旋转运动后三维立体部件3各个平面上任意寻找的n个点,再如步骤5进行平面拟合,并利用步骤6的方法计算出各个平面的法向量;利用步骤3计算出的三维立体部件3各个平面的理论法向量,与旋转后测量计算所得平面法向量采用角度分析,进行向量与向量之间的夹角误差评价;本实施例中n≥3,不能在一条直线上,尽量布局到可以准确描述整个平面的地方。
拟合的第j个平面方程,j=1,2,3,4,5:
;
姿态调姿后三维立体部件3各个平面的法向量矩阵:
理论平面和实测平面的向量夹角,j=1,2,3,4,5:
步骤10、通过步骤9中的角度误差评估,若符合误差容差要求,则进行下一步;如容差不符合要求,则再进行步骤4到步骤9的方法;
其中,是角度评价的容差值。
步骤11、根据步骤10所计算得到经旋转后的三维立体部件3的各个平面的拟合平面,求解各个平面与坐标系坐标轴的交点;
理论平面与全局坐标系坐标轴X轴的理论交点为:;
理论平面与全局坐标系坐标轴Y轴的理论交点为:;
理论平面与全局坐标系坐标轴Z轴的理论交点为:;
其中j=1,2,3,4,5;
理论平面与坐标轴的交点理论矩阵:
沿X平移量:;
沿Y平移量:;
沿Z平移量:;
步骤12、通过利用数控***2,结合步骤11计算出的沿各个坐标轴平移量,将三维立体部件3进行相应的平移运动,运动完成后采用激光跟踪仪1对三维立体部件3各个平面上任意寻找的n个点进行测量,如图4所示,利用测出的坐标拟合当前状态下各个平面,同时求解出各个平面与坐标系坐标轴的交点,最后进行位置的误差分析评价;本实施例中n≥3,不能在一条直线上,尽量布局到可以准确描述整个平面的地方。
按照以上方法步骤9和步骤11得到平面与坐标系坐标轴的交点,并得到交点矩阵:
理论平面与坐标轴交点和拟合平面与坐标轴交点的误差交点矩阵:
其中:
;
;
;
i=1,2,3,4,5。
步骤13、通过步骤12中的位置误差评估,若符合误差容差要求,则完成三维立体部件3调姿定位;如容差不符合要求,则再进行步骤10到步骤12的方法;
其中,/>,/>为给定的容差,j=1,2,3,4,5。
工作原理:本实施例提出的用于大型三维立体装配无固定测量点调姿定位方法,减少了三维立体大部件前期在各个平面布置测量点的步骤,提高了对部件的测量效率,同时降低了点位过约束影响,提供了无固定测量点的调姿定位方式,保证了三维立体部件3全过程装配效率。
本实施例的其他部分与上述实施例1相同,故不再赘述。
以上所述,仅是本发明的较佳实施例,并非对本发明做任何形式上的限制,凡是依据本发明的技术实质对以上实施例所作的任何简单修改、等同变化,均落入本发明的保护范围之内。
Claims (6)
1.一种用于大型三维立体装配无固定测量点调姿定位方法,其特征在于,具体包括以下步骤:
步骤S1:利用激光跟踪仪(1)在三维立体部件(3)的平面构建全局坐标系,确定三维立体部件(3)的理论状态,并构建理论平面法向量矩阵;
步骤S2:在所述三维立体部件(3)底部安装数控***(2),在三维立体部件(3)的平面上任意选择n个点,测量n个点在当前状态下的位置坐标,得到当前状态下的平面法向量矩阵;
步骤S3:根据所述理论平面法向量矩阵和所述当前状态下的平面法向量矩阵,调用奇异值分解法得到三维立体部件(3)从当前状态到理论状态的姿态旋转矩阵,并根据所述姿态旋转矩阵驱动数控***(2)旋转三维立体部件(3);
步骤S4:在旋转后的三维立体部件(3)的平面上任意选择n个点,测量n个点在当前状态下的位置坐标,得到旋转后的平面法向量矩阵,计算理论平面与旋转后平面的向量夹角;
步骤S5:根据所述向量夹角计算角度误差,并根据设定的容差值判断所述角度误差是否符合误差容差,若不符合则返回步骤S2,若符合则执行步骤S6;
步骤S6:求解旋转后的三维立体部件(3)的平面与全局坐标系坐标轴的交点,计算沿方向轴的平移量,调用数控***(2)平移三维立体部件(3),计算平移后的平面与坐标轴的交点与理论平面与坐标轴交点的误差交点矩阵,调姿定位三维立体部件(3)。
2.根据权利要求1所述的一种用于大型三维立体装配无固定测量点调姿定位方法,其特征在于,所述步骤S1具体包括以下步骤:
步骤S11:利用激光跟踪仪(1)在三维立体部件(3)的平面构建全局坐标系,根据所述全局坐标系确定三维立体部件(3)的理论状态;
步骤S12:根据所述三维立体部件(3)的理论状态,构建三维立体部件理论平面方程;
步骤S13:求解所述三维立体部件理论平面方程,得到平面在理论状态下的法向量,构建理论平面法向量矩阵Vt;
步骤S14:根据所述理论平面法向量矩阵Vt,计算理论平面与全局坐标系的坐标轴的交点坐标,并根据所述交点坐标得到理论平面与坐标轴的交点理论矩阵Qt。
3.根据权利要求2所述的一种用于大型三维立体装配无固定测量点调姿定位方法,其特征在于,所述步骤S2具体包括以下步骤:
步骤S21:在所述三维立体部件(3)底部安装数控***(2),根据所述激光跟踪仪(1)在三维立体部件(3)的平面j上任意选择n个点;
步骤S22:测量n个点在当前状态下的位置坐标,得到坐标矩阵PCj;
步骤S23:根据所述坐标矩阵PCj,得到平面j的平面拟合方程;
步骤S24:根据所述平面拟合方程,计算平面法向量矩阵Vp。
4.根据权利要求3所述的一种用于大型三维立体装配无固定测量点调姿定位方法,其特征在于,所述步骤S3具体包括以下步骤:
步骤S31:根据所述理论平面法向量矩阵Vt和所述平面法向量矩阵Vp,计算绕全局坐标系三个坐标轴的旋转量;
步骤S32:调用奇异值分解法得到三维立体部件(3)从当前状态到理论状态的姿态旋转矩阵Rpt;步骤S33:根据所述姿态旋转矩阵Rpt驱动数控***(2)旋转三维立体部件(3)。
5.根据权利要求4所述的一种用于大型三维立体装配无固定测量点调姿定位方法,其特征在于,所述步骤S4具体包括以下步骤:
步骤S41:在旋转后的三维立体部件(3)的平面上任意选择n个点,测量n个点在当前状态下的位置坐标,得到坐标矩阵PCj ’;
步骤S42:根据所述坐标矩阵PCj ’,得到旋转后的平面j的平面拟合方程;
步骤S43:根据旋转后的平面拟合方程,得到旋转后的平面法向量矩阵Vp ’,计算理论平面与旋转后平面的向量夹角。
6.根据权利要求5所述的一种用于大型三维立体装配无固定测量点调姿定位方法,其特征在于,所述步骤S6具体包括以下步骤:
步骤S61:求解符合误差容差的旋转后的三维立体部件(3)的平面与全局坐标系坐标轴的交点,得到理论平面与坐标轴的交点理论矩阵QN;
步骤S62:根据所述交点理论矩阵QN,计算沿方向轴的平移量;
步骤S63:根据所述平移量调用数控***(2)平移三维立体部件(3),在平移后的三维立体部件(3)的平面上任意选择n个点,测量n个点在当前状态下的位置坐标,得到坐标矩阵PCj ’’;
步骤S64:根据所述坐标矩阵PCj ’’,得到平移后的平面j的平面拟合方程;
步骤S65:根据平移后的平面拟合方程,求解平移后的平面j与全局坐标系的交点,得到交点矩阵QF;
步骤S66:根据所述交点矩阵QF,计算平移后的平面j与坐标轴的交点和理论平面与坐标轴交点的误差交点矩阵ef,得到位置误差容差;
步骤S67:若所述位置误差容差符合误差容差要求,则完成三维立体部件(3)的调姿定位;若不符合误差容差要求,则返回步骤S21。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202410374736.9A CN117984074B (zh) | 2024-03-29 | 一种用于大型三维立体装配无固定测量点调姿定位方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202410374736.9A CN117984074B (zh) | 2024-03-29 | 一种用于大型三维立体装配无固定测量点调姿定位方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN117984074A true CN117984074A (zh) | 2024-05-07 |
CN117984074B CN117984074B (zh) | 2024-07-12 |
Family
ID=
Citations (18)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2003323603A (ja) * | 2002-04-26 | 2003-11-14 | Asia Air Survey Co Ltd | ステレオマッチング方法、3次元計測方法及び3次元計測装置並びにステレオマッチング方法のプログラム及び3次元計測のプログラム |
CN101363714A (zh) * | 2008-09-26 | 2009-02-11 | 浙江大学 | 一种机翼水平位姿测量与评估方法 |
CN101362512A (zh) * | 2008-09-19 | 2009-02-11 | 浙江大学 | 一种基于四个***的飞机部件位姿调整***及方法 |
CN102001451A (zh) * | 2010-11-12 | 2011-04-06 | 浙江大学 | 基于四个数控***、调姿平台和移动托架的飞机部件调姿、对接***及方法 |
CN102183205A (zh) * | 2011-01-19 | 2011-09-14 | 北京航空航天大学 | 一种大型零部件最佳装配位姿匹配的方法 |
US20140003705A1 (en) * | 2012-06-29 | 2014-01-02 | Yuichi Taguchi | Method for Registering Points and Planes of 3D Data in Multiple Coordinate Systems |
CN103983224A (zh) * | 2014-05-29 | 2014-08-13 | 上海飞机制造有限公司 | 一种大尺度部件实测位姿拟合方法 |
US20160265903A1 (en) * | 2013-11-20 | 2016-09-15 | Tianjiin University | Accuracy traceability method based on precision coordinate control network for workshop measurement positioning system |
CN107570983A (zh) * | 2017-09-05 | 2018-01-12 | 西北工业大学 | 一种曲面零件自动装配的方法及*** |
CN108507502A (zh) * | 2017-12-04 | 2018-09-07 | 中国科学院近代物理研究所 | 一种加速器工程准直参数的测量方法 |
CN109794938A (zh) * | 2019-02-01 | 2019-05-24 | 南京航空航天大学 | 一种适用于曲面结构的机器人制孔误差补偿装置及其方法 |
CN110434671A (zh) * | 2019-07-25 | 2019-11-12 | 王东 | 一种基于特征测量的铸造件表面机加工轨迹校准方法 |
CN111687631A (zh) * | 2020-06-23 | 2020-09-22 | 南京航空航天大学 | 一种基于室内gps和激光测距的飞机结构件位姿自动预对齐方法 |
CN111907729A (zh) * | 2020-06-30 | 2020-11-10 | 成都飞机工业(集团)有限责任公司 | 一种针对飞机大部件调姿的最佳位姿拟合方法 |
CN113029000A (zh) * | 2021-03-15 | 2021-06-25 | 浙江大学 | 一种移动平台位姿状态监测装置及方法 |
US20210403147A1 (en) * | 2020-06-29 | 2021-12-30 | Bell Textron Inc. | Blade flap measurement process |
CN115741073A (zh) * | 2022-10-11 | 2023-03-07 | 北京动力机械研究所 | 一种基于***的大型结构部件位姿调整方法 |
CN117508631A (zh) * | 2023-10-13 | 2024-02-06 | 成都飞机工业(集团)有限责任公司 | 一种吸附于数控***的大部件位姿变化检测方法 |
Patent Citations (18)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2003323603A (ja) * | 2002-04-26 | 2003-11-14 | Asia Air Survey Co Ltd | ステレオマッチング方法、3次元計測方法及び3次元計測装置並びにステレオマッチング方法のプログラム及び3次元計測のプログラム |
CN101362512A (zh) * | 2008-09-19 | 2009-02-11 | 浙江大学 | 一种基于四个***的飞机部件位姿调整***及方法 |
CN101363714A (zh) * | 2008-09-26 | 2009-02-11 | 浙江大学 | 一种机翼水平位姿测量与评估方法 |
CN102001451A (zh) * | 2010-11-12 | 2011-04-06 | 浙江大学 | 基于四个数控***、调姿平台和移动托架的飞机部件调姿、对接***及方法 |
CN102183205A (zh) * | 2011-01-19 | 2011-09-14 | 北京航空航天大学 | 一种大型零部件最佳装配位姿匹配的方法 |
US20140003705A1 (en) * | 2012-06-29 | 2014-01-02 | Yuichi Taguchi | Method for Registering Points and Planes of 3D Data in Multiple Coordinate Systems |
US20160265903A1 (en) * | 2013-11-20 | 2016-09-15 | Tianjiin University | Accuracy traceability method based on precision coordinate control network for workshop measurement positioning system |
CN103983224A (zh) * | 2014-05-29 | 2014-08-13 | 上海飞机制造有限公司 | 一种大尺度部件实测位姿拟合方法 |
CN107570983A (zh) * | 2017-09-05 | 2018-01-12 | 西北工业大学 | 一种曲面零件自动装配的方法及*** |
CN108507502A (zh) * | 2017-12-04 | 2018-09-07 | 中国科学院近代物理研究所 | 一种加速器工程准直参数的测量方法 |
CN109794938A (zh) * | 2019-02-01 | 2019-05-24 | 南京航空航天大学 | 一种适用于曲面结构的机器人制孔误差补偿装置及其方法 |
CN110434671A (zh) * | 2019-07-25 | 2019-11-12 | 王东 | 一种基于特征测量的铸造件表面机加工轨迹校准方法 |
CN111687631A (zh) * | 2020-06-23 | 2020-09-22 | 南京航空航天大学 | 一种基于室内gps和激光测距的飞机结构件位姿自动预对齐方法 |
US20210403147A1 (en) * | 2020-06-29 | 2021-12-30 | Bell Textron Inc. | Blade flap measurement process |
CN111907729A (zh) * | 2020-06-30 | 2020-11-10 | 成都飞机工业(集团)有限责任公司 | 一种针对飞机大部件调姿的最佳位姿拟合方法 |
CN113029000A (zh) * | 2021-03-15 | 2021-06-25 | 浙江大学 | 一种移动平台位姿状态监测装置及方法 |
CN115741073A (zh) * | 2022-10-11 | 2023-03-07 | 北京动力机械研究所 | 一种基于***的大型结构部件位姿调整方法 |
CN117508631A (zh) * | 2023-10-13 | 2024-02-06 | 成都飞机工业(集团)有限责任公司 | 一种吸附于数控***的大部件位姿变化检测方法 |
Non-Patent Citations (2)
Title |
---|
刘继红等: "《基于关键特征的飞机大部件对接位姿调整技术》", 《计算机集成制造***》, vol. 19, no. 5, 31 May 2013 (2013-05-31), pages 1009 - 1014 * |
李新友等: "基于奇异值分解的刚***姿误差检测方法", 《计算机集成制造***》, vol. 17, no. 9, 30 September 2011 (2011-09-30), pages 1981 - 1987 * |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US8577499B2 (en) | Method and a device for optimizing a programmed movement path for an industrial robot | |
Tsai et al. | Real time versatile robotics hand/eye calibration using 3D machine vision | |
Wang et al. | Real-time error compensation of a three-axis machine tool using a laser tracker | |
CN110640747B (zh) | 机器人的手眼标定方法、***、电子设备和存储介质 | |
CN109483322B (zh) | 一种五轴数控机床的零点校准方法 | |
Wang et al. | Nonparametric statistical learning control of robot manipulators for trajectory or contour tracking | |
CN113211445A (zh) | 一种机器人参数标定方法、装置、设备及存储介质 | |
JPH0445841B2 (zh) | ||
Liegeois et al. | Learning and control for a compliant computer-controlled manipulator | |
CN114611362A (zh) | 一种大型器械工作面的安装调试方法、电子装置及介质 | |
CN113950650A (zh) | 调整量推定装置、调整量推定方法及调整量推定程序 | |
CN117984074B (zh) | 一种用于大型三维立体装配无固定测量点调姿定位方法 | |
JPH0445842B2 (zh) | ||
Williams et al. | Kinematic error calibration of the gantry-tau parallel manipulator | |
CN117984074A (zh) | 一种用于大型三维立体装配无固定测量点调姿定位方法 | |
Liu et al. | Real-time error compensation of a 5-axis machining robot using externally mounted encoder systems | |
CN111399210B (zh) | 大口径大视场望远镜粗对准方法、装置、设备及存储介质 | |
CN112378332A (zh) | 一种工业机器人与激光跟踪仪坐标系对齐方法 | |
CN113325430A (zh) | 末端执行器安装精度测量方法、装置、设备及存储介质 | |
Li et al. | Trajectory planning method for docking of large aircraft components | |
CN115979231B (zh) | 一种基于虚拟点位的无量纲运动学标定方法及其相关装置 | |
Jian et al. | Enhancing Kinematic Calibration Accuracy for Parallel Manipulators Based on Truncated Total Least-Square Regularization | |
CN114905521B (zh) | 机器人原点位置校准方法、装置、电子设备和存储介质 | |
Wu et al. | A Parallel Ranging‐Based Relative Position and Orientation Measurement Method for Large‐Volume Components | |
CN117921685B (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 |