CN112184562B - 一种基于近似矩阵的火箭级段位姿纠偏方法及装置 - Google Patents

一种基于近似矩阵的火箭级段位姿纠偏方法及装置 Download PDF

Info

Publication number
CN112184562B
CN112184562B CN202011023706.1A CN202011023706A CN112184562B CN 112184562 B CN112184562 B CN 112184562B CN 202011023706 A CN202011023706 A CN 202011023706A CN 112184562 B CN112184562 B CN 112184562B
Authority
CN
China
Prior art keywords
matrix
rotation
rocket stage
formula
correction
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
Application number
CN202011023706.1A
Other languages
English (en)
Other versions
CN112184562A (zh
Inventor
周丽华
方素平
吴帆
丁康康
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Hefei University of Technology
Original Assignee
Hefei University of Technology
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Hefei University of Technology filed Critical Hefei University of Technology
Priority to CN202011023706.1A priority Critical patent/CN112184562B/zh
Publication of CN112184562A publication Critical patent/CN112184562A/zh
Application granted granted Critical
Publication of CN112184562B publication Critical patent/CN112184562B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06TIMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T3/00Geometric image transformations in the plane of the image
    • G06T3/60Rotation of whole images or parts thereof
    • G06T3/604Rotation of whole images or parts thereof using coordinate rotation digital computer [CORDIC] devices
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01BMEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
    • G01B21/00Measuring arrangements or details thereof, where the measuring technique is not covered by the other groups of this subclass, unspecified or not relevant
    • G01B21/02Measuring arrangements or details thereof, where the measuring technique is not covered by the other groups of this subclass, unspecified or not relevant for measuring length, width, or thickness
    • G01B21/04Measuring arrangements or details thereof, where the measuring technique is not covered by the other groups of this subclass, unspecified or not relevant for measuring length, width, or thickness by measuring coordinates of points
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06TIMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T7/00Image analysis
    • G06T7/70Determining position or orientation of objects or cameras

Landscapes

  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Engineering & Computer Science (AREA)
  • Theoretical Computer Science (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Complex Calculations (AREA)
  • Testing Of Engines (AREA)

Abstract

本发明公开了一种基于近似矩阵的火箭级段位姿纠偏方法及装置。该方法包括:将火箭级段在空间坐标系的旋转矩阵和平移矩阵叠加以获得空间坐标转换矩阵;通过测试矩阵计算出火箭级段的测试数据;利用近似矩阵纠偏方法进行测试数据与理论数据的纠偏,并计算纠偏误差,使得纠偏误差在设定阈值以内,验证所提出纠偏方法的准确性;然后根据火箭级段实际测量数据和理论数据,利用所提出纠偏方法进行纠偏并获得纠偏后点坐标。本发明通过实测火箭级段测量值与其理论值的精确纠偏,完成实测级段位姿的纠偏,进而实现火箭级段的自动对接,将有效提高火箭级段装配的精度、稳定性和自动化水平。

Description

一种基于近似矩阵的火箭级段位姿纠偏方法及装置
技术领域
本发明涉及火箭装配技术领域的一种位姿纠偏方法,尤其涉及一种基于近似矩阵的火箭级段位姿纠偏方法,还涉及一种基于近似矩阵的火箭级段位姿纠偏装置。
背景技术
在航天航空制造业中,飞机和火箭等物体由于尺寸非常大,通常采用分段制造,整体装配的制造方法。相对于飞机装配来说,火箭的特征比较明显,其主体主要是由一些圆柱形的部段(通常称之为“级段”)组成。
大型运载火箭属于空间大尺寸物件,其加工制造精度很大程度影响火箭的最终装配精度,但是实践证明,火箭等这类物体的最终质量,很难或者不可能通过提高制造准确度来提高装配精度,有效可行的方法是通过改善和优化装配方法。但由于其直径往往比较大,如我国新一代运载火箭长征-5(CZ-5)的芯级直径约为5m,因此火箭级段对接和装配是很复杂的。现阶段总装过程中,人工对接装配精度不高而且效率低下,实现起来也很困难,很难保证装配的效率和质量。
发明内容
为解决现有的火箭级段位姿纠偏方法存在测量精度低的技术问题,本发明提供一种基于近似矩阵的火箭级段位姿纠偏方法及装置。
本发明采用以下技术方案实现:一种基于近似矩阵的火箭级段位姿纠偏方法,其包括以下步骤:
(1)将火箭级段在空间坐标系的旋转矩阵和平移矩阵叠加以获得空间坐标转换矩阵;
(2)先输入所述空间坐标系中三维坐标轴的旋转参数和平移参数至所述空间坐标转换矩阵中以得到不同的多个旋转矩阵以分别作为多个测试矩阵,再利用所述火箭级段的理论数据,通过所述测试矩阵计算出所述火箭级段的测试数据,所述测试数据包括多个纠偏前测量点坐标;
(3)将所述理论数据与所述测试数据进行纠偏,且近似矩阵纠偏方法包括以下步骤:
(3.1)根据所述火箭级段在三维坐标轴的旋转误差近似为零所存在的近似等式,将所述空间坐标转换矩阵转换为近似矩阵;
(3.2)先确定所述近似矩阵的贴合精度表示公式,再对所述贴合精度表示公式进行矩阵变换处理以确定迭代变量,最后将所述迭代变量代入贴合精度表示公式的展开式以计算出目标函数;
(3.3)判断所述目标函数是否小于所述贴合精度;
在所述目标函数不小于所述贴合精度时,判断迭代次数是否大于一个预设的最大迭代次数;
在所述目标函数小于所述贴合精度或所述迭代次数大于所述最大迭代次数时,输出所述贴合精度以及相应的纠偏变量;
在所述不小于所述贴合精度且所述迭代次数不大于所述最大迭代次数时,返回执行步骤(3.2)并增加所述迭代次数的次数;
(4)先根据所述纠偏变量计算所述空间坐标转换矩阵以获得纠偏矩阵,再根据待纠偏点坐标以及所述纠偏矩阵,计算出纠偏后的点坐标。
本发明先通过旋转矩阵和平移矩阵叠加获得空间坐标转换矩阵,进而给出空间坐标变换矩阵与坐标旋转参数和平移参数变量之间的对应关系,再利用已知火箭级段理论数据通过测试矩阵计算出的测试数据,然后通过近似矩阵进行测试数据与理论数据的纠偏,并计算纠偏误差,使得纠偏误差在设定阈值以内,从而验证纠偏方法的有效性,最后根据火箭级段实际测量数据和理论数据,利用所提出纠偏方法计算出纠偏矩阵,并将纠偏前测量点坐标通过纠偏矩阵纠偏以补偿实测数据,实现对火箭级段测量偏斜误差补偿全过程,解决了现有的火箭级段位姿纠偏方法存在测量精度低的技术问题,得到了有效提高测量精度、稳定性和可重复性的技术效果。
作为上述方案的进一步改进,对所述贴合精度表示公式的变换处理方法包括以下步骤:
对所述贴合精度表示公式按照测量点坐标和理论点坐标进行展开以获得展开式;
对所述展开式中的三轴的旋转量和平移量进行求偏导数,以获得三轴旋转量的偏导数公式以及三轴平移量的偏导数公式;
对所有偏导数归零以获得三轴旋转量的函数公式和三轴平移量的函数公式,并将所有偏导数公式改写成包含第一矩阵、第二矩阵以及所述迭代变量的矩阵形式一;
先计算点集中心坐标,再对所述三轴平移量的函数公式进行求解,并将求解结果代入至所述三轴旋转量的函数公式,以获得只包含旋转变量的方程组,最后改成成包含第三矩阵、第四矩阵以及各个旋转变量的矩阵形式二;
将所述矩阵形式二代入所述三轴平移量的求解公式中以求解出各个平移量,并获得所述迭代变量。
进一步地,所述空间坐标转换矩阵的计算公式为:
T=Tr+Ts
式中,T表示所述空间坐标转换矩阵;Ts表示所述平移矩阵,Ts=(m,n,k)T,m、n、k分别表示所述三维坐标轴的三轴各自的平移量;Tr表示所述旋转矩阵,Tr=ΓZΓYΓX,ΓZ、ΓY、ΓX分别表示所述三维坐标轴的三个单轴旋转矩阵;
其中,
式中,α,β,γ分别为x,y,z轴的旋转量。
作为上述方案的进一步改进,所述空间坐标转换矩阵的计算公式为:
式中,T表示所述空间坐标转换矩阵,α、β、γ分别表示所述三维坐标轴的三轴各自的旋转量;m、n、k分别表示所述三维坐标轴的三轴各自的平移量。
进一步地,定义所述三维坐标轴的旋转误差分别为δα、δβ、δγ,所述近似等式为:
sinδi≈δi,cosδi≈1,i=α,β,γ所述近似矩阵为:
所述贴合精度表示公式为:
F(δ)=∑Δ2α,δβ,δγ,δm,δn,δk)
所述展开式为:
F(δ)=∑[(xi-yi*γ+zi*β+m-Xi)2+(xi*γ+yi-zi*α+n-Yi)2+(-xi*β+yi*α+zi+k-Zi)2]
其中,(xi,yi,zi)为测量点坐标,(Xi,Yi,Zi)为理论点坐标。
作为上述方案的进一步改进,所述三轴旋转量的偏导数公式以及所述三轴平移量的偏导数公式分别为:
所述三轴旋转量的函数公式和三轴平移量的函数公式分别为:
所述第一矩阵A为:
所述第二矩阵B为:
所述矩阵形式一为:
Aδ=B
其中,δ=[α β γ m n k]T=A-1*B;
所述点集中心坐标的计算公式为:
式中,表示测量点集的中心点坐标,/>表示理论点集的中心点坐标;
所述三轴平移量的求解公式为:
所述矩阵形式二为:
式中,C为所述第三矩阵,D为所述第三矩阵,且分别为:
所述迭代变量为δ=[α β γ m n k]T,所述纠偏变量为δK=[αK βK γK mK nK kK]T
作为上述方案的进一步改进,将理论点集合记作Qth={Pthi,i=1,2,3,...N},测量点集合记作Qme={Pmei,i=1,2,3,...N},测量点Pmei对应理论点P′thi,纠偏点集合记作Qma={Pmai,i=1,2,3,...N},N为离散点个数;所述贴合精度的计算公式为:
F(δ)=∑(Pmaij-P′thij)2 i=1,2,3,...N,j=x,y,z
式中,F(δ)为所述贴合精度。
进一步地,所述纠偏方法具体包括以下步骤:
步骤1:读取理论点坐标集Qth,并计算测试点坐标集执行步骤2;
步骤2:设定最大迭代次数N,贴合精度F,设定迭代次数K为0,执行步骤3;
步骤3:迭代次数K增加一次,执行步骤4;
步骤4:求解测试点集对应的理论匹配点集:Q’th;根据所述第三矩阵、所述第四矩阵,先计算出旋转变量:[α β γ]T=C-1*D,再计算出各个平移变量,最后得到迭代变量δK=[αβK γK mK nK kK]T;计算迭代矩阵TK,执行步骤5;
步骤5:计算测试变换点集:执行步骤6;
步骤6:计算变换后贴合精度F(δK)=∑Δ2K,βK,γK,mK,nK,kK),执行步骤7;
步骤7:判断F(δK)是否小于F,是则执行步骤8,否则执行步骤9;
步骤8:输出所述当前贴合精度和所述当前位姿偏差,并终止纠偏;
步骤9:判断K是否大于N,是则执行步骤8,否则执行步骤3。
作为上述方案的进一步改进,还计算纠偏补偿后的试验误差,并将所述试验误差与现有误差比对;在所述试验误差小于所述现有误差时,判定补偿有效,否则判定补偿无效。
本发明还提供一种基于近似矩阵的火箭级段位姿纠偏装置,其应用于上述任意所述的基于近似矩阵的火箭级段位姿纠偏方法中,其包括:
转换矩阵获取模块,其用于将火箭级段在空间坐标系的旋转矩阵和平移矩阵叠加以获得空间坐标转换矩阵;
测试数据获取模块,其用于先输入所述空间坐标系中三维坐标轴的旋转参数和平移参数至所述空间坐标转换矩阵中以得到不同的多个旋转矩阵以分别作为多个测试矩阵,再利用所述火箭级段的理论数据,通过所述测试矩阵计算出所述火箭级段的测试数据,所述测试数据包括多个纠偏前测量点坐标;
近似矩阵纠偏模块,其用于将所述理论数据与所述测试数据进行纠偏;所述近似矩阵纠偏模块包括转换单元、目标函数计算单元以及判断单元;所述转换单元用于根据所述火箭级段在三维坐标轴的旋转误差近似为零所存在的近似等式,将所述空间坐标转换矩阵转换为近似矩阵;所述目标函数计算单元用于先确定所述近似矩阵的贴合精度表示公式,再对所述贴合精度表示公式进行矩阵变换处理以确定迭代变量,最后将所述迭代变量代入贴合精度表示公式的展开式以计算出目标函数;所述判断单元用于判断所述目标函数是否小于所述贴合精度;在所述目标函数不小于所述贴合精度时,所述判断单元判断迭代次数是否大于一个预设的最大迭代次数;在所述目标函数小于所述贴合精度或所述迭代次数大于所述最大迭代次数时,所述判断单元输出所述贴合精度以及相应的纠偏变量;在所述不小于所述贴合精度且所述迭代次数不大于所述最大迭代次数时,所述判断单元启动所述目标函数计算单元并增加所述迭代次数的次数;
纠偏模块,其用于先所述纠偏变量计算所述空间坐标转换矩阵以获得纠偏矩阵,再根据待纠偏点坐标以及所述纠偏矩阵,计算出纠偏后的点坐标。
相较于现有的火箭级段位姿纠偏方法,本发明的基于近似矩阵的火箭级段位姿纠偏方法及装置具有以下有益效果:
1、该基于近似矩阵的火箭级段位姿纠偏方法,其先旋转矩阵和平移矩阵叠加获得空间坐标转换矩阵,进而给出空间坐标变换矩阵与坐标旋转参数和平移参数变量之间的对应关系,再利用已知火箭级段理论数据通过测试矩阵计算出的测试数据,然后通过近似矩阵纠偏方法进行测试数据与理论数据的匹配,并计算纠偏误差,使得纠偏误差在设定阈值以内,从而验证纠偏方法的有效性。最后,根据火箭级段实际测量数据和理论数据,利用所提出纠偏方法计算出纠偏矩阵,并将纠偏前测量点坐标通过纠偏矩阵纠偏以补偿实测数据,实现对火箭级段测量偏斜误差补偿全过程,完成实测级段位姿的纠偏,进而实现火箭级段的自动对接,将有效提高火箭级段装配的精度、稳定性和自动化水平。
2、该基于近似矩阵的火箭级段位姿纠偏方法,其在纠偏测试数据与理论数据时,通过近似矩阵方法对矩阵进行变换以确定贴合精度,通过迭代方式不停对贴合精度进行判断,贴合精度用所有匹配点与纠偏点的距离的平方和进行表示,而该精度反映了纠偏后的离散点与原始点的贴合程度,使数据更加贴近实际,提高测量的准确性。该方法逐步迭代进行,直至贴合精度满足要求或者迭代参数小于设定阈值,结束本次纠偏,并输出本次迭代结果。如此,这样的纠偏迭代会大大提升贴合精度,进而能够进一步提高测量数据的准确度,实现高精度补偿。
3、该基于近似矩阵的火箭级段位姿纠偏装置,其有益效果与上述基于近似矩阵的火箭级段位姿纠偏方法的有益效果相同,在此不再做赘述。
附图说明
图1为本发明实施例1的基于近似矩阵的火箭级段位姿纠偏方法的流程图。
图2为本发明实施例1的基于近似矩阵的火箭级段位姿纠偏方法所对应的运载火箭级段模型图。
图3为本发明实施例1的基于近似矩阵的火箭级段位姿纠偏方法所对应的级段自动对接模型。
图4为本发明实施例2的基于近似矩阵的火箭级段位姿纠偏方法中的搜索流程图。
图5为本发明实施例2的基于近似矩阵的火箭级段位姿纠偏方法中纠偏前后测量点的对比示意图。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合附图及实施例,对本发明进行进一步详细说明。应当理解,此处所描述的具体实施例仅用以解释本发明,并不用于限定本发明。
实施例1
请参阅图1、图2以及图3,本实施例提供了一种基于近似矩阵的火箭级段位姿纠偏方法。在大型运载火箭级段在进行对接装配时,可以看成是两个相同直径的圆柱筒进行自动对接,一般先固定一个级段,然后移动另外一个级段,通过不断旋转和移动来实现级段之间的对接。这里不妨把固定的级段称为固定件,需要移动和调整的级段称为移动件。可通过级段的一些特征点来确定级段的空间位姿。可以看出,级段在对接过程中会产生位姿偏差,记为其中δα,δβ,δγ分别表示坐标轴方向的旋转偏差,δm,δn,δk表示坐标轴方向的平移偏差。级段位姿偏差不仅会影响火箭级段之间装配精度,还会对火箭整体质量产生重要影响,因此需要对级段位姿偏差进行实时调整。基于此,本实施例的火箭级段位姿纠偏方法针对上述火箭级段自动对接过程中,存在级段位姿偏离理论位置的问题,而且包括以下这些步骤。
(1)将火箭级段在空间坐标系的旋转矩阵和平移矩阵叠加以获得空间坐标转换矩阵。在本实施例中,利用空间几何解析法,给出空间坐标变换矩阵与坐标旋转参数和平移参数变量之间的对应关系。空间坐标转换矩阵T由旋转矩阵Tr和平移矩阵Ts组成,空间坐标转换矩阵T的计算公式为:
T=Tr+Ts
式中,T表示空间坐标转换矩阵,Ts表示平移矩阵,而且Ts=(m,n,k)T,m、n、k分别表示三维坐标轴的三轴各自的平移量。Tr表示旋转矩阵,多轴旋转可以看作单轴旋转的叠加,且旋转叠加结果与旋转轴顺序相关,以依次旋转x、y、z轴为例,空间坐标系旋转矩阵Tr=ΓZΓYΓX,ΓZ、ΓY、ΓX分别表示三维坐标轴的三个单轴旋转矩阵,可分别表示如下:
式中,α、β、γ分别表示三维坐标轴的三轴各自的旋转量。
因此,空间坐标转换矩阵的计算公式为:
(2)先输入空间坐标系中三维坐标轴的旋转参数和平移参数至空间坐标转换矩阵中以得到不同的多个旋转矩阵以分别作为多个测试矩阵,再利用火箭级段的理论数据,通过测试矩阵计算出火箭级段的测试数据,测试数据包括多个纠偏前测量点坐标。在本实施例中,利用已知火箭级段理论数据(包括理论点坐标和理论点法向量),通过测试矩阵计算出测试数据。火箭级段理论数据,就是火箭级段上的一些点的坐标和单位法向量,这些数据可通过文献进行查阅,本实施例中部分点坐标信息举例如表1所示。
表1 移动级段部分理论点坐标表
x(mm) y(mm) z(mm)
0 0 0
5000 0 0
0 5000 0
-5000 0 0
0 -5000 0
5000 0 5000
0 5000 5000
-5000 0 5000
0 -5000 5000
5000 0 10000
0 5000 10000
-5000 0 10000
0 -5000 10000
0 0 10000
输入坐标轴x、y、z旋转和平移参数(0.03,0.06,0.1,1,10,50),根据空间坐标转换矩阵的计算公式可计算坐标变换矩阵,如下:
可通过改变旋转参数和平移参数,进而计算不同旋转矩阵,该旋转矩阵都被视为测试矩阵。测试矩阵的变量是人为设定且已知,其用于验证后续纠偏算法的正确性。
点坐标变换计算举例:
实际就是矩阵乘法,假设点P0(x0,y0,z0),则其经过变换矩阵后,得到点P1(x1,y1,z1),计算如下:
即:T(x0,y0,z0,1)T=(x1,y1,z1,1)T
以上述测试矩阵Ttest为例,点坐标经过矩阵变换后,得到待纠偏的测试点坐标,如表2所示。
表2 待纠偏的测试点坐标表
(3)将理论数据与测试数据进行近似矩阵位姿纠偏,且近似矩阵纠偏方法包括以下这些步骤,即步骤(3.1)-(3.3)。
(3.1)根据火箭级段在三维坐标轴的旋转误差近似为零所存在的近似等式,将空间坐标转换矩阵转换为近似矩阵。在本实施例中,定义三维坐标轴的旋转误差分别为δα、δβ、δγ,由于在接近完成对接的情况下,坐标轴偏差近似为零,也就是δα、δβ、δγ近似为零,因此存在如下近似等式:
sinδi≈δi,cosδi≈1,i=α,β,γ
因此空间坐标转换矩阵写成近似矩阵为:
(3.2)先确定近似矩阵的贴合精度表示公式,再对贴合精度表示公式进行矩阵变换处理以确定迭代变量,最后将迭代变量代入贴合精度表示公式的展开式以计算出目标函数。其中,贴合精度用所有纠偏点与匹配点的距离的平方和进行表示,如下:
F(δ)=∑Δ2α,δβ,δγ,δm,δn,δk)
该贴合精度反映了纠偏后的离散点与原始点的贴合程度,符合贴合定义。在本实施例中,对贴合精度表示公式的变换处理方法包括以下步骤:
(3.2.1)对贴合精度表示公式按照测量点坐标和理论点坐标进行展开以获得展开式。在本实施例中,展开式为:
F(δ)=∑[(xi-yi*γ+zi*β+m-Xi)2+(xi*γ+yi-zi*α+n-Yi)2+(-xi*β+yi*α+zi+k-Zi)2]
其中,(xi,yi,zi)为测量点坐标,(Xi,Yi,Zi)为理论点坐标。
(3.2.2)对展开式中的三轴的旋转量和平移量进行求偏导数,以获得三轴旋转量的偏导数公式以及三轴平移量的偏导数公式。在本实施例中,三轴旋转量的偏导数公式以及三轴平移量的偏导数公式分别为:
(3.2.3)对所有偏导数归零以获得三轴旋转量的函数公式和三轴平移量的函数公式,并将所有偏导数公式改写成包含第一矩阵、第二矩阵以及迭代变量的矩阵形式一。在本实施例中,三轴旋转量的函数公式和三轴平移量的函数公式分别为:
第一矩阵A为:
第二矩阵B为:
矩阵形式一为:
Aδ=B
其中,δ=[α β γ m n k]T=A-1*B。
可以看出A是6阶矩阵,因此直接求逆矩阵比较复杂,求解精度也难以保证,因此采用接下来的简化过程。
(3.2.4)先计算点集中心坐标,再对三轴平移量的函数公式进行求解,并将求解结果代入至三轴旋转量的函数公式,以获得只包含旋转变量的方程组,最后改成成包含第三矩阵、第四矩阵以及各个旋转变量的矩阵形式二。在本实施例中,点集中心坐标的计算公式为:
式中,表示测量点集的中心点坐标,/>表示理论点集的中心点坐标;
三轴平移量的求解公式为:
矩阵形式二为:
式中,C为第三矩阵,D为第三矩阵,且分别为:
即:[α β γ]T=C-1*D
(3.2.5)将矩阵形式二代入三轴平移量的求解公式中以求解出各个平移量,并获得迭代变量。其中,迭代变量为δ=[α β γ m n k]T,纠偏变量为δK=[αK βK γK mK nK kK]T
(3.3)判断目标函数是否小于贴合精度。
在目标函数不小于贴合精度时,判断迭代次数是否大于一个预设的最大迭代次数。在目标函数小于贴合精度或迭代次数大于最大迭代次数时,输出贴合精度以及相应的纠偏变量。在不小于贴合精度且迭代次数不大于最大迭代次数时,返回执行步骤(3.2)并增加迭代次数的次数。
在本实施例中,实际测量点对应的理论点确定方法:
由于实际测量存在误差,导致实际测量点与原理论点并非一一对应关系,但又由于测量误差一般不会太大,因此每一实际测量点对应的匹配点与初始对应的理论点偏差不会太大,应还在理论点附近,因此采用窗口平均的方法获得测量点对应的理论点。设定窗口大小N(N为正整数,可根据迭代次数和贴合精度进行调整,当迭代次数越高,贴合精度越高,N偏向于取小一点),然后选取该理论点前N个理论点和后N个理论点,再进行加权平均,得到该理论点的坐标,以N=2为例,计算公式如下:
其中,Pni表示点Pn在各个轴的分量,wn表示点Pn的加权系数,与采样点序列变化趋势相关。
(4)先根据贴合精度和纠偏变量计算空间坐标转换矩阵以获得纠偏矩阵,再根据待纠偏点坐标以及纠偏矩阵,计算出纠偏后的点坐标。在本实施例中,纠偏矩阵Tm与待纠偏点坐标计算得到纠偏后的点坐标,如表3所示:
表3 纠偏后的测试点坐标
在本实施例中,还计算纠偏补偿后的试验误差,并将试验误差与现有误差比对;在试验误差小于现有误差时,判定补偿有效,否则判定补偿无效。将理论点集合记作Qth={Pthi,i=1,2,3,...N},测量点集合记作Qme={Pmei,i=1,2,3,...N},测量点Pmei对应理论点P′thi,纠偏点集合记作Qma={Pmai,i=1,2,3,...N},N为离散点个数。测量时,测量点按照理论点序号进行测量。
理论上来讲,测量点按照既定序号进行测量,测量点集与理论点集中的点按照序号一一对应,但是由于测量存在误差,导致测量点集合与理论点集合一一对应存在偏差,因此为了克服这种不对应造成的误差,采用窗口平均的方法,获得测量点Pmei对应的理论点P′thi,然后可计算纠偏距离平方和如下:
F(δ)=∑(Pmaij-P′thij)2 i=1,2,3,...N,j=x,y,z
式中,F(δ)为贴合精度。
综上所述,本实施例的基于近似矩阵的火箭级段位姿纠偏方法具有以下优点:
1、该基于近似矩阵的火箭级段位姿纠偏方法,其先旋转矩阵和平移矩阵叠加获得空间坐标转换矩阵,进而给出空间坐标变换矩阵与坐标旋转参数和平移参数变量之间的对应关系,再利用已知火箭级段理论数据通过测试矩阵计算出的测试数据,然后通过近似矩阵纠偏方法进行测试数据与理论数据的匹配,并计算纠偏误差,使得纠偏误差在设定阈值以内,从而验证纠偏方法的有效性。最后,根据火箭级段实际测量数据和理论数据,利用所提出纠偏方法计算出纠偏矩阵,并将纠偏前测量点坐标通过纠偏矩阵纠偏以补偿实测数据,实现对火箭级段测量偏斜误差补偿全过程,完成实测级段位姿的纠偏,进而实现火箭级段的自动对接,将有效提高火箭级段装配的精度、稳定性和自动化水平。
2、该基于近似矩阵的火箭级段位姿纠偏方法,其在纠偏测试数据与理论数据时,通过近似矩阵方法对矩阵进行变换以确定贴合精度,通过迭代方式不停多贴合精度进行判断,贴合精度用所有搜索点与纠偏点的距离的平方和进行表示,而该精度反映了纠偏后的离散点与原始点的贴合程度,使数据更加贴近实际,提高测量的准确性。该方法逐步迭代进行,直至贴合精度满足要求或者迭代参数小于设定阈值,结束本次搜索,并输出本次迭代结果。如此,这样的纠偏搜索会大大提升贴合精度,进而能够进一步提高测量数据的准确度,实现高精度补偿。
实施例2
请参阅图4,本实施例提供了一种基于近似矩阵的火箭级段位姿纠偏方法,该方法在实施例1的基础上进一步细化。其中,纠偏方法具体包括以下这些步骤,即步骤1-12。
步骤1:读取理论点坐标集Qth,并计算测试点坐标集执行步骤2;
步骤2:设定最大迭代次数N,贴合精度F,设定迭代次数K为0,执行步骤3;
步骤3:迭代次数K增加一次,执行步骤4;
步骤4:求解测试点集对应的理论匹配点集:Q′th;根据第三矩阵、第四矩阵,先计算出旋转变量:[α β γ]T=C-1*D,再计算出各个平移变量,最后得到迭代变量δK=[αK βK γKmK nK kK]T;计算迭代矩阵TK,执行步骤5;
步骤5:计算测试变换点集:执行步骤6;
步骤6:计算变换后贴合精度F(δK)=∑Δ2K,βK,γK,mK,nK,kK),执行步骤7;
步骤7:判断F(δK)是否小于F,是则执行步骤8,否则执行步骤9;
步骤8:输出当前贴合精度和当前位姿偏差,并终止纠偏;
步骤9:判断K是否大于N,是则执行步骤8,否则执行步骤3。
请参阅图5,该火箭级段位姿纠偏方法中的纠偏方法和补偿效果分别用VisualStudio和Matlab编写程序进行了验证。可以从图中看出,该方法可以完成实测级段位姿的纠偏,进而实现火箭级段的自动对接,将有效提高火箭级段装配的精度、稳定性和自动化水平。
实施例3
本实施例提供了一种基于近似矩阵的火箭级段位姿纠偏装置,该装置应用于实施例1或2中的基于近似矩阵的火箭级段位姿纠偏方法中。其中,该装置包括转换矩阵获取模块、测试数据获取模块、近似矩阵纠偏模块以及纠偏模块。
转换矩阵获取模块用于将火箭级段在空间坐标系的旋转矩阵和平移矩阵叠加以获得空间坐标转换矩阵。转换矩阵获取模块主要是利用空间几何解析法,给出空间坐标变换矩阵与坐标旋转参数和平移参数变量之间的对应关系。测试数据获取模块用于先输入空间坐标系中三维坐标轴的旋转参数和平移参数至空间坐标转换矩阵中以得到不同的多个旋转矩阵以分别作为多个测试矩阵,再利用火箭级段的理论数据,通过测试矩阵计算出火箭级段的测试数据,测试数据包括多个纠偏前测量点坐标。测试数据获取模块则是利用已知火箭级段的理论数据,通过测试矩阵计算出测试数据
近似矩阵纠偏模块用于将理论数据与测试数据进行纠偏;近似矩阵纠偏模块包括转换单元、目标函数计算单元以及判断单元;转换单元用于根据火箭级段在三维坐标轴的旋转误差近似为零所存在的近似等式,将空间坐标转换矩阵转换为近似矩阵;目标函数计算单元用于先确定近似矩阵的贴合精度表示公式,再对贴合精度表示公式进行矩阵变换处理以确定迭代变量,最后将迭代变量代入贴合精度表示公式的展开式以计算出目标函数;判断单元用于判断目标函数是否小于贴合精度;在目标函数不小于贴合精度时,判断单元判断迭代次数是否大于一个预设的最大迭代次数;在目标函数小于贴合精度或迭代次数大于最大迭代次数时,判断单元输出贴合精度以及相应的纠偏变量;在不小于贴合精度且迭代次数不大于最大迭代次数时,判断单元启动目标函数计算单元并增加迭代次数的次数;其中,当前迭代结果包括当前贴合精度和当前搜索变量,近似矩阵纠偏模块所应用的纠偏方法可以采用实施例1或实施例2中所提及的近似矩阵纠偏方法。纠偏模块用于先根据贴合精度和纠偏变量计算空间坐标转换矩阵以获得纠偏矩阵,再根据待纠偏点坐标以及纠偏矩阵,计算出纠偏后的点坐标。纠偏模块利用实施例1或2中步骤(3)用的纠偏方法进行实测数据的补偿,并计算补偿后的误差,然后与现有误差比对,验证补偿方法的有效性。
实施例4
本实施例提供了一种计算机终端,其包括存储器、处理器以及存储在存储器上并可在处理器上运行的计算机程序。处理器执行程序时实现实施例1或2的基于近似矩阵的火箭级段位姿纠偏方法的步骤。
实施例1或2的基于近似矩阵的火箭级段位姿纠偏方法在应用时,可以软件的形式进行应用,如设计成独立运行的程序,安装在计算机终端上,计算机终端可以是电脑、智能手机、控制系统以及其他物联网设备等。实施例1或2的基于近似矩阵的火箭级段位姿纠偏方法也可以设计成嵌入式运行的程序,安装在计算机终端上,如安装在单片机上。
实施例5
本实施例提供了一种计算机可读存储介质,其上存储有计算机程序。程序被处理器执行时,实现实施例1或2的基于近似矩阵的火箭级段位姿纠偏方法的步骤。
实施例1或2的基于近似矩阵的火箭级段位姿纠偏方法在应用时,可以软件的形式进行应用,如设计成计算机可读存储介质可独立运行的程序,计算机可读存储介质可以是U盘,设计成U盾,通过U盘设计成通过外在触发启动整个方法的程序。
以上所述仅为本发明的较佳实施例而已,并不用以限制本发明,凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等,均应包含在本发明的保护范围之内。

Claims (10)

1.一种基于近似矩阵的火箭级段位姿纠偏方法,其特征在于,其包括以下步骤:
(1)将火箭级段在空间坐标系的旋转矩阵和平移矩阵叠加以获得空间坐标转换矩阵;
(2)先输入所述空间坐标系中三维坐标轴的旋转参数和平移参数至所述空间坐标转换矩阵中以得到不同的多个旋转矩阵以分别作为多个测试矩阵,再利用所述火箭级段的理论数据,通过所述测试矩阵计算出所述火箭级段的测试数据,所述测试数据包括多个纠偏前测量点坐标;
(3)将所述理论数据与所述测试数据进行近似矩阵位姿纠偏,且近似矩阵纠偏方法包括以下步骤:
(3.1)根据所述火箭级段在三维坐标轴的旋转误差近似为零所存在的近似等式,将所述空间坐标转换矩阵转换为近似矩阵;
(3.2)先确定所述近似矩阵的贴合精度表示公式,再对所述贴合精度表示公式进行矩阵变换处理以确定迭代变量,最后将所述迭代变量代入贴合精度表示公式的展开式以计算出目标函数;
(3.3)判断所述目标函数是否小于所述贴合精度;
在所述目标函数不小于所述贴合精度时,判断迭代次数是否大于一个预设的最大迭代次数;
在所述目标函数小于所述贴合精度或所述迭代次数大于所述最大迭代次数时,输出所述贴合精度以及相应的纠偏变量;
在所述不小于所述贴合精度且所述迭代次数不大于所述最大迭代次数时,返回执行步骤(3.2)并增加所述迭代次数的次数;
(4)先根据所述纠偏变量计算所述空间坐标转换矩阵以获得纠偏矩阵,再根据待纠偏点坐标以及所述纠偏矩阵,计算出纠偏后的点坐标。
2.如权利要求1所述的基于近似矩阵的火箭级段位姿纠偏方法,其特征在于,对所述贴合精度表示公式的变换处理方法包括以下步骤:
对所述贴合精度表示公式按照测量点坐标和理论点坐标进行展开以获得展开式;
对所述展开式中的三轴的旋转量和平移量进行求偏导数,以获得三轴旋转量的偏导数公式以及三轴平移量的偏导数公式;
对所有偏导数归零以获得三轴旋转量的函数公式和三轴平移量的函数公式,并将所有偏导数公式改写成包含第一矩阵、第二矩阵以及所述迭代变量的矩阵形式一;
先计算点集中心坐标,再对所述三轴平移量的函数公式进行求解,并将求解结果代入至所述三轴旋转量的函数公式,以获得只包含旋转变量的方程组,最后改成包含第三矩阵、第四矩阵以及各个旋转变量的矩阵形式二;
将所述矩阵形式二代入所述三轴平移量的求解公式中以求解出各个平移量,并获得所述迭代变量。
3.如权利要求2所述的基于近似矩阵的火箭级段位姿纠偏方法,其特征在于,所述空间坐标转换矩阵的计算公式为:
T=Tr+Ts
式中,T表示所述空间坐标转换矩阵;Ts表示所述平移矩阵,Ts=(m,n,k)T,m、n、k分别表示所述三维坐标轴的三轴各自的平移量;Tr表示所述旋转矩阵,Tr=ΓZΓYΓX,ΓZ、ΓY、ΓX分别表示所述三维坐标轴的三个单轴旋转矩阵;
其中,
式中,α,β,γ分别为x,y,z轴的旋转量。
4.如权利要求2所述的基于近似矩阵的火箭级段位姿纠偏方法,其特征在于,所述空间坐标转换矩阵的计算公式为:
式中,T表示所述空间坐标转换矩阵,α、β、γ分别表示所述三维坐标轴的三轴各自的旋转量;m、n、k分别表示所述三维坐标轴的三轴各自的平移量。
5.如权利要求4所述的基于近似矩阵的火箭级段位姿纠偏方法,其特征在于,定义所述三维坐标轴的旋转误差分别为δα、δβ、δγ,所述近似等式为:
sinδi≈δi,cosδi≈1,i=α,β,γ
所述近似矩阵为:
所述贴合精度表示公式为:
F(δ)=∑Δ2α,δβ,δγ,δm,δn,δk)
所述展开式为:
F(δ)=Σ[(xi-yi*γ+zi*β+m-Xi)2+(xi*γ+yi-zi*α+n-Yi)2+(-xi*β+yi*α+zi+k-zi)2]
其中,(xi,yi,zi)为测量点坐标,(Xi,Yi,Zi)为理论点坐标。
6.如权利要求5所述的基于近似矩阵的火箭级段位姿纠偏方法,其特征在于,所述三轴旋转量的偏导数公式以及所述三轴平移量的偏导数公式分别为:
所述三轴旋转量的函数公式和三轴平移量的函数公式分别为:
所述第一矩阵A为:
所述第二矩阵B为:
所述矩阵形式一为:
Aδ=B
其中,δ=[α β γ m n k]T=A-1*B;
所述点集中心坐标的计算公式为:
式中,表示测量点集的中心点坐标,/>表示理论点集的中心点坐标;
所述三轴平移量的求解公式为:
所述矩阵形式二为:
式中,C为所述第三矩阵,D为所述第三矩阵,且分别为:
所述迭代变量为δ=[α β γ m n k]T,所述纠偏变量为δK=[αK βK γK mK nK kK]T
7.如权利要求6所述的基于近似矩阵的火箭级段位姿纠偏方法,其特征在于,将理论点集合记作Qth={Pthi,i=1,2,3,...N},测量点集合记作Qme={Pmei,i=1,2,3,...N},测量点Pmei对应理论点P′thi,纠偏点集合记作Qma={Pmai,i=1,2,3,...N},N为离散点个数;所述贴合精度的计算公式为:
F(δ)=∑(Pmaij-P′thij)2 i=1,2,3,...N,j=x,y,z
式中,F(δ)为所述贴合精度。
8.如权利要求7所述的基于近似矩阵的火箭级段位姿纠偏方法,其特征在于,所述纠偏方法具体包括以下步骤:
步骤1:读取理论点坐标集Qth,并计算测试点坐标集执行步骤2;
步骤2:设定最大迭代次数N,贴合精度F,设定迭代次数K为0,执行步骤3;
步骤3:迭代次数K曾加一次,执行步骤4;
步骤4:求解测试点集对应的理论匹配点集:Q’th;根据所述第三矩阵、所述第四矩阵,先计算出旋转变量:[α β γ]T=C-1*D,再计算出各个平移变量,最后得到迭代变量δK=[αK βKγK mK nK kK]T;计算迭代矩阵TK,执行步骤5;
步骤5:计算测试变换点集:执行步骤6;
步骤6:计算变换后贴合精度F(δK)=∑Δ2K,βK,γK,mK,nK,kK),执行步骤7;
步骤7:判断F(δK)是否小于F,是则执行步骤8,否则执行步骤9;
步骤8:输出所述当前贴合精度和所述当前位姿偏差,并终止纠偏;
步骤9:判断K是否大于N,是则执行步骤8,否则执行步骤3。
9.如权利要求8所述的基于近似矩阵的火箭级段位姿纠偏方法,其特征在于,还计算纠偏补偿后的试验误差,并将所述试验误差与现有误差比对;在所述试验误差小于所述现有误差时,判定补偿有效,否则判定补偿无效。
10.一种基于近似矩阵的火箭级段位姿纠偏装置,其应用于如权利要求1-9中任意一项所述的基于近似矩阵的火箭级段位姿纠偏方法中,其特征在于,其包括:
转换矩阵获取模块,其用于将火箭级段在空间坐标系的旋转矩阵和平移矩阵叠加以获得空间坐标转换矩阵;
测试数据获取模块,其用于先输入所述空间坐标系中三维坐标轴的旋转参数和平移参数至所述空间坐标转换矩阵中以得到不同的多个旋转矩阵以分别作为多个测试矩阵,再利用所述火箭级段的理论数据,通过所述测试矩阵计算出所述火箭级段的测试数据,所述测试数据包括多个纠偏前测量点坐标;
近似矩阵纠偏模块,其用于将所述理论数据与所述测试数据进行纠偏;所述近似矩阵纠偏模块包括转换单元、目标函数计算单元以及判断单元;所述转换单元用于根据所述火箭级段在三维坐标轴的旋转误差近似为零所存在的近似等式,将所述空间坐标转换矩阵转换为近似矩阵;所述目标函数计算单元用于先确定所述近似矩阵的贴合精度表示公式,再对所述贴合精度表示公式进行矩阵变换处理以确定迭代变量,最后将所述迭代变量代入贴合精度表示公式的展开式以计算出目标函数;所述判断单元用于判断所述目标函数是否小于所述贴合精度;在所述目标函数不小于所述贴合精度时,所述判断单元判断迭代次数是否大于一个预设的最大迭代次数;在所述目标函数小于所述贴合精度或所述迭代次数大于所述最大迭代次数时,所述判断单元输出所述贴合精度以及相应的纠偏变量;在所述不小于所述贴合精度且所述迭代次数不大于所述最大迭代次数时,所述判断单元启动所述目标函数计算单元并增加所述迭代次数的次数;
纠偏模块,其用于先根据所述贴合精度和所述纠偏变量计算所述空间坐标转换矩阵以获得纠偏矩阵,再根据待纠偏点坐标以及所述纠偏矩阵,计算出纠偏后的点坐标。
CN202011023706.1A 2020-09-25 2020-09-25 一种基于近似矩阵的火箭级段位姿纠偏方法及装置 Active CN112184562B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202011023706.1A CN112184562B (zh) 2020-09-25 2020-09-25 一种基于近似矩阵的火箭级段位姿纠偏方法及装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202011023706.1A CN112184562B (zh) 2020-09-25 2020-09-25 一种基于近似矩阵的火箭级段位姿纠偏方法及装置

Publications (2)

Publication Number Publication Date
CN112184562A CN112184562A (zh) 2021-01-05
CN112184562B true CN112184562B (zh) 2024-02-23

Family

ID=73945284

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202011023706.1A Active CN112184562B (zh) 2020-09-25 2020-09-25 一种基于近似矩阵的火箭级段位姿纠偏方法及装置

Country Status (1)

Country Link
CN (1) CN112184562B (zh)

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108279643A (zh) * 2018-01-29 2018-07-13 西南交通大学 一种基于测量点与自适应差分进化算法的工件姿态调整方法
CN110058521A (zh) * 2019-04-10 2019-07-26 中国矿业大学(北京) 一种考虑误差影响的悬臂式掘进机行进纠偏方法
CN111243013A (zh) * 2020-01-13 2020-06-05 华南理工大学 基于集成多目标回归链的视觉印刷机纠偏位姿预测方法
CN111546328A (zh) * 2020-04-02 2020-08-18 天津大学 基于三维视觉测量的手眼标定方法

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107685330B (zh) * 2017-10-18 2018-12-18 佛山华数机器人有限公司 一种六自由度手腕偏置串联机器人的运动学逆解求解方法

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108279643A (zh) * 2018-01-29 2018-07-13 西南交通大学 一种基于测量点与自适应差分进化算法的工件姿态调整方法
CN110058521A (zh) * 2019-04-10 2019-07-26 中国矿业大学(北京) 一种考虑误差影响的悬臂式掘进机行进纠偏方法
CN111243013A (zh) * 2020-01-13 2020-06-05 华南理工大学 基于集成多目标回归链的视觉印刷机纠偏位姿预测方法
CN111546328A (zh) * 2020-04-02 2020-08-18 天津大学 基于三维视觉测量的手眼标定方法

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
发射点偏差对火箭垂直起飞横向漂移的影响分析;崔书华;胡绍林;;弹箭与制导学报;20071215(05);全文 *
崔书华 ; 胡绍林 ; .发射点偏差对火箭垂直起飞横向漂移的影响分析.弹箭与制导学报.2007,(05),全文. *

Also Published As

Publication number Publication date
CN112184562A (zh) 2021-01-05

Similar Documents

Publication Publication Date Title
CN110202575B (zh) 一种用于工业测量的机器人目标轨迹精度补偿方法
CN110900610B (zh) 一种基于lm算法和粒子滤波算法优化的工业机器人标定方法
CN109493389B (zh) 一种基于深度学习的相机标定方法及系统
CN113211445B (zh) 一种机器人参数标定方法、装置、设备及存储介质
CN110595479B (zh) 一种基于icp算法的slam轨迹评估方法
CN112767493A (zh) Stewart平台运动学参数的机器视觉标定方法
CN116256536A (zh) 一种数字加速度计的圆周温补标定方法
CN113065259B (zh) 一种壁板组件与骨架位姿协调方法
CN113486591B (zh) 一种卷积神经网络结果的重力多参量数据密度加权反演方法
CN112184562B (zh) 一种基于近似矩阵的火箭级段位姿纠偏方法及装置
CN109827607B (zh) 线结构光焊缝跟踪传感器的标定方法及装置
CN111553954B (zh) 一种基于直接法单目slam的在线光度标定方法
CN112720480B (zh) 一种基于分级误差的机器人轨迹修正方法及系统
CN112184561B (zh) 一种基于多元搜索的火箭级段位姿纠偏方法及其装置
CN107421476A (zh) 一种空间孔位测量基准误差补偿方法
CN114993604B (zh) 一种基于深度学习的风洞天平静态校测方法
CN112987054B (zh) 标定sins/dvl组合导航系统误差的方法和装置
CN115070731A (zh) 一种面向并联机构的几何误差标定方法、系统和电子设备
CN108106634A (zh) 一种直接观星的星敏感器内参数标定方法
CN114046756B (zh) 一种多边测量标定方法、装置、设备及介质
CN114021318B (zh) 一种粒子加速器局部控制网稳定性分析方法、系统和介质
Sirisantisamrid et al. A determination method of initial camera parameters for coplanar calibration
CN113063444B (zh) 亚角秒精度星敏感器光轴测量基准偏差标定方法及系统
CN115017754B (zh) 一种考虑制造误差的有限元模型修正方法
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
GR01 Patent grant