CN111623769B - 一种结合相关性和显著性检验的提高惯性制导精度的方法 - Google Patents

一种结合相关性和显著性检验的提高惯性制导精度的方法 Download PDF

Info

Publication number
CN111623769B
CN111623769B CN202010334359.8A CN202010334359A CN111623769B CN 111623769 B CN111623769 B CN 111623769B CN 202010334359 A CN202010334359 A CN 202010334359A CN 111623769 B CN111623769 B CN 111623769B
Authority
CN
China
Prior art keywords
matrix
error
vector
column
base
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
CN202010334359.8A
Other languages
English (en)
Other versions
CN111623769A (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.)
Beijign Institute of Aerospace Control Devices
Original Assignee
Beijign Institute of Aerospace Control Devices
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 Beijign Institute of Aerospace Control Devices filed Critical Beijign Institute of Aerospace Control Devices
Priority to CN202010334359.8A priority Critical patent/CN111623769B/zh
Publication of CN111623769A publication Critical patent/CN111623769A/zh
Application granted granted Critical
Publication of CN111623769B publication Critical patent/CN111623769B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/10Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
    • G01C21/16Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/20Instruments for performing navigational calculations

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Automation & Control Theory (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Navigation (AREA)

Abstract

本发明涉及一种结合相关性和显著性检验的提高惯性制导精度的方法,属于惯性导航技术领域;步骤一、根据遥外测误差矩阵、环境函数矩阵和制导工具误差系数,建立制导工具误差模型;步骤二、确定环境函数矩阵的全部基向量,并构成基矩阵;步骤三、用基矩阵表示非基向量矩阵,计算各参数列矩阵的值,构成参数矩阵;步骤四、通过原有制导工具误差系数和参数矩阵建立新制导工具误差系数的方程;步骤五、通过基矩阵和新制导工具误差系数建立遥外测误差矩阵的方程,计算新制导工具误差系数;步骤六、对遥外测误差矩阵进行补偿,计算残差;本发明克服了现有方法不能精确求解惯性制导工具误差系数的不足,提高了惯性制导的精度。

Description

一种结合相关性和显著性检验的提高惯性制导精度的方法
技术领域
本发明属于惯性导航技术领域,涉及一种结合相关性和显著性检验的提高惯性制导精度的方法。
背景技术
当前航天飞行器的惯性导航主要采用陀螺仪和加速度计构成的捷联系统或平台系统。
在利用弹道导弹遥外测数据分离惯性测量系统误差系数时,可采用遥外测速度误差误差作为观测量,其优点是速度误差反映了加速度计组合和陀螺仪组合的测量误差,另外一个优点是建立速度环境函数矩阵后可直接通过解方程求解误差系数,过程中没有微分解算。
基于速度环境函数的遥外测误差分离时,首先要确定误差模型的结构。弹道导弹飞行轨迹的特点是只能在主动段的轨迹曲线段有大过载,而不能全姿态任意方位都存在大过载或大机动,这就决定了选择的误差模型结构矩阵部分系数之间具有相关性,而最小二乘法对于强相关结构矩阵有较低的适应能力,会导致分离的误差系数偏离真值较大。
为此,如何在强相关条件的约束下,实现基于弹道导弹遥外测数据的惯性测量系统误差系数精确分离是一个难题。
目前常用的处理方式为主成分估计、有偏最小二乘估计、岭估计等方法进行参数辨识,但核心的问题是估计结果与真实值有较大偏差。
发明内容
本发明解决的技术问题是:克服现有技术的不足,提出一种结合相关性和显著性检验的提高惯性制导精度的方法,克服了现有主成分估计、有偏最小二乘估计、岭估计等方法不能精确求解惯性制导工具误差系数的不足,提高了惯性制导的精度。
本发明解决技术的方案是:
一种结合相关性和显著性检验的提高惯性制导精度的方法,包括如下步骤:
步骤一、根据遥外测误差矩阵Y、环境函数矩阵C和制导工具误差系数X,建立制导工具误差模型;制导工具误差模型为线性关系;
步骤二、确定环境函数矩阵C的全部基向量,并将全部基向量构成基矩阵D;
步骤三、确定环境函数矩阵C的全部非基向量,并将全部非基向量构成非基向量矩阵C″;用基矩阵D表示非基向量矩阵C″,计算各参数列矩阵的值,将各参数列矩阵构成参数矩阵R;
步骤四、设定新制导工具误差系数
Figure BDA0002466073130000021
新制导工具误差系数包括rA个行向量;通过原有制导工具误差系数
Figure BDA0002466073130000022
和参数矩阵R建立新制导工具误差系数
Figure BDA0002466073130000023
的方程;
步骤五、通过基矩阵D和新制导工具误差系数X′建立遥外测误差矩阵Y的方程,计算新制导工具误差系数X′;
步骤六、根据新制导工具误差系数X′和基矩阵D对遥外测误差矩阵Y进行补偿,并计算补偿后的残差ΔY;实现提高惯性制导精度。
在上述的一种结合相关性和显著性检验的提高惯性制导精度的方法,所述步骤一中,制导工具误差模型为:
Y=CX
式中,Y为遥外测误差矩阵,
Figure BDA0002466073130000031
y1,y2,……,yn为按时间序列1×Δt、2×Δt、……,n×Δt给定的遥测值与外测值之差,其中Δt为采样时间;n为正整数,且n>10000;
X为制导工具误差系数;
Figure BDA0002466073130000032
x1,x2,……,xn与惯性器件相关的误差系数;m为正整数,且m>20;
C为环境函数矩阵,C=[C1 C2 … Cm];C1,C2,……,Cm为在1×Δt、2×Δt、……,n×Δt时刻制导工具误差x1,x2,……,xm对应遥外测观测量y1,y2,……,yn的环境函数的值。
在上述的一种结合相关性和显著性检验的提高惯性制导精度的方法,所述步骤二中,环境函数矩阵C基向量的计算方法为:
计算矩阵CTC的秩rA;rA=rank(CTC);对rA的值进行判断;当rA=m时,则环境函数矩阵C为列满秩,环境函数矩阵C所有的列向量均为基向量;当rA<m时,则环境函数矩阵C不为列满秩,从环境函数矩阵C中选择rA个列向量作为基向量。
在上述的一种结合相关性和显著性检验的提高惯性制导精度的方法,从环境函数矩阵C中选择rA个列向量作为基向量的具体步骤包括:
S1、建立矩阵D=C;设循环次数l为1;
S2、矩阵D的列向量数为p,p为正整数,且p<m,矩阵D的p个列向量记为D1,D2,……,Dp;根据p个列向量建立p个矩阵,分别为:[D2 … Dp]T[D2 … Dp]、……[D1 … Di-1 Di+1 …Dp]T[D1 … Di-1 Di+1 … Dp]、……[D1 … Dp-1];式中,i=2,…,p-1;计算上述各矩阵的秩rj和条件数dj;其中,j=1,……,p;从矩阵D找到1个列向量Dk,满足该列向量Dk的秩rk=rA且条件数dk最大;则Dk为非基列向量;
S3、去除非基列向量Dk,建立新矩阵D,D′=[D1 … Dk-1 Dk+1 … Dp];列向量数为p-1;
S4、重复S2-S3,每重复一次,循环次数l的值加1;直至循环次数l=m-rA,停止循环;得到去除全部非基列向量的矩阵D,即为基向量矩阵D;对基向量矩阵D中的各基列向量重新编号,记为:
Figure BDA0002466073130000041
在上述的一种结合相关性和显著性检验的提高惯性制导精度的方法,所述步骤三中,非基向量矩阵C″的确定方法为:将步骤二中全部非基列向量集合,组成环境函数C的非基向量矩阵C″,并对非基向量矩阵C″中的各非基列向量重新编号,记为:
Figure BDA0002466073130000042
在上述的一种结合相关性和显著性检验的提高惯性制导精度的方法,所述步骤三中,通过基矩阵D表示非基向量矩阵C″的方程组包括m-rA个方程,分别为:
Figure BDA0002466073130000043
对每个方程采用最小二乘法求解,计算出各参数列矩阵
Figure BDA0002466073130000051
Figure BDA0002466073130000052
的值,将各列矩阵组成得到参数矩阵R,
Figure BDA0002466073130000053
在上述的一种结合相关性和显著性检验的提高惯性制导精度的方法,所述步骤四中,原有制导工具误差系数
Figure BDA0002466073130000054
中有m个向量分别为x1,x2,……,xm;m个向量中包括rA个基向量和m-rA个非基向量;将rA个基向量编号组成矩阵
Figure BDA0002466073130000055
将m-rA个非基向量编号组成矩阵
Figure BDA0002466073130000056
则新制导工具误差系数
Figure BDA0002466073130000057
的表示方法为:
Figure BDA0002466073130000058
在上述的一种结合相关性和显著性检验的提高惯性制导精度的方法,所述步骤五中,遥外测误差矩阵Y的方程为:
Figure BDA0002466073130000061
通过最小二乘法求解上述公式,即可得到新制导工具误差系数X′的具体值。
在上述的一种结合相关性和显著性检验的提高惯性制导精度的方法,所述步骤六中,补偿后残差ΔY的计算方法为:
Figure BDA0002466073130000062
本发明与现有技术相比的有益效果是:
(1)本发明通过引进环境函数矩阵相关检验中把相互之间关联的制导工具误差系数进行整合,整合后的新系数对应的环境函数矩阵为列满秩,从而可精确求解,克服了主成分估计、岭估计不能精确求解的缺点;
(2)本发明把显著性检验引入制导工具误差系数分离过程中,有利于简化模型,也有利于分析各制导工具误差系数与测量值之间的本质特性,并且能够大幅降低模型的维数,克服了结构矩阵维数过多的问题,有利于实时在线计算制导工具误差系数,具有简单快捷、容易实现的优点。
附图说明
图1为本发明提高惯性制导精度流程图。
图2为实施例中的遥外测速度误差;
图3为实施例中考虑到相关性后的基于遥外测速度差的因果关系;
图4为实施例中基于新的制导工具误差系数的遥外测速度差因果关系;
图5为实施例中保留显著项后的遥外测速度差因果关系;
图6为实施例中遥外测速度误差补偿值;
图7为实施例中遥外测速度误差补偿残差。
具体实施方式
下面结合实施例对本发明作进一步阐述。
本发明提供一种结合相关性和显著性检验的提高惯性制导精度的方法,克服现有主成分估计、有偏最小二乘估计、岭估计等方法不能精确求解惯性制导工具误差系数的不足,提出了一种把相关性检验和显著性检验结合起来的提高惯性制导精度方法。
提高惯性制导精度的方法,如图1所示,具体包括如下步骤:
步骤一、根据遥外测误差矩阵Y、环境函数矩阵C和制导工具误差系数X,建立制导工具误差模型;制导工具误差模型为线性关系;制导工具误差模型为:
Y=CX
式中,Y为遥外测误差矩阵,
Figure BDA0002466073130000071
y1,y2,……,yn为按时间序列1×Δt、2×Δt、……,n×Δt给定的遥测值与外测值之差,其中Δt为采样时间;n为正整数,且n>10000;
X为制导工具误差系数;
Figure BDA0002466073130000072
x1,x2,……,xn与惯性器件相关的误差系数;m为正整数,且m>20;
C为环境函数矩阵,C=[C1 C2 … Cm];C1,C2,……,Cm为在1×Δt、2×Δt、……,n×Δt时刻制导工具误差x1,x2,……,xm对应遥外测观测量y1,y2,……,yn的环境函数的值。
步骤二、确定环境函数矩阵C的全部基向量,并将全部基向量构成基矩阵D;环境函数矩阵C基向量的计算方法为:
计算矩阵CTC的秩rA;rA=rank(CTC);对rA的值进行判断;当rA=m时,则环境函数矩阵C为列满秩,环境函数矩阵C所有的列向量均为基向量;当rA<m时,则环境函数矩阵C不为列满秩,从环境函数矩阵C中选择rA个列向量作为基向量。从环境函数矩阵C中选择rA个列向量作为基向量的具体步骤包括:
S1、建立矩阵D=C;设循环次数l为1;
S2、矩阵D的列向量数为p,p为正整数,且p<m,矩阵D的p个列向量记为D1,D2,……,Dp;根据p个列向量建立p个矩阵,分别为:[D2 … Dp]T[D2 … Dp]、……[D1 … Di-1 Di+1 …Dp]T[D1 … Di-1 Di+1 … Dp]、……[D1 … Dp-1];式中,i=2,…,p-1;计算上述各矩阵的秩rj和条件数dj;其中,j=1,……,p;从矩阵D找到1个列向量Dk,满足该列向量Dk的秩rk=rA且条件数dk最大;则Dk为非基列向量;
S3、去除非基列向量Dk,建立新矩阵D,D′=[D1 … Dk-1 Dk+1 … Dp];列向量数为p-1;
S4、重复S2-S3,每重复一次,循环次数l的值加1;直至循环次数l=m-rA,停止循环;得到去除全部非基列向量的矩阵D,即为基向量矩阵D;对基向量矩阵D中的各基列向量重新编号,记为:
Figure BDA0002466073130000081
步骤三、确定环境函数矩阵C的全部非基向量,并将全部非基向量构成非基向量矩阵C″;非基向量矩阵C″的确定方法为:将步骤二中全部非基列向量集合,组成环境函数C的非基向量矩阵C″,并对非基向量矩阵C″中的各非基列向量重新编号,记为:
Figure BDA0002466073130000082
用基矩阵D表示非基向量矩阵C″,计算各参数列矩阵的值,将各参数列矩阵构成参数矩阵R;通过基矩阵D表示非基向量矩阵C″的方程组包括m-rA个方程,分别为:
Figure BDA0002466073130000091
对每个方程采用最小二乘法求解,计算出各参数列矩阵
Figure BDA0002466073130000092
Figure BDA0002466073130000093
的值,将各列矩阵组成得到参数矩阵R,
Figure BDA0002466073130000094
步骤四、设定新制导工具误差系数
Figure BDA0002466073130000095
新制导工具误差系数包括rA个行向量;通过原有制导工具误差系数
Figure BDA0002466073130000101
和参数矩阵R建立新制导工具误差系数
Figure BDA0002466073130000102
的方程;
步骤五、通过基矩阵D和新制导工具误差系数X′建立遥外测误差矩阵Y的方程的方法为;原有制导工具误差系数
Figure BDA0002466073130000103
中有m个向量分别为x1,x2,……,xm;m个向量中包括rA个基向量和m-rA个非基向量;将rA个基向量编号组成矩阵
Figure BDA0002466073130000104
将m-rA个非基向量编号组成矩阵
Figure BDA0002466073130000105
则新制导工具误差系数
Figure BDA0002466073130000106
的表示方法为:
Figure BDA0002466073130000107
遥外测误差矩阵Y的方程为:
Figure BDA0002466073130000108
新制导工具误差系数X′的计算方法为:通过最小二乘法求解上述公式,即可得到新制导工具误差系数X′的具体值。
步骤六、根据新制导工具误差系数X′和基矩阵D对遥外测误差矩阵Y进行补偿,并计算补偿后的残差ΔY;实现提高惯性制导精度。补偿后残差ΔY的计算方法为:
Figure BDA0002466073130000111
实施例
惯性制导导弹的落点精度主要取决于制导工具误差,在飞行过程中,遥测导航速度包含陀螺仪、加速度计等惯性器件引起的制导工具误差,外测实时测量出弹体的运动速度并作为基准信息。通过对飞行遥外测数据求差,可估计出各项工具误差系数的值。
(1)构建制导工具误差模型
加速度计组合误差模型为
Figure BDA0002466073130000112
陀螺仪组合误差模型为
Figure BDA0002466073130000113
以上两式中各项误差系数的含义见表1中的第2至64项,第一项误差系数为时间不同步误差。
表1误差系数
Figure BDA0002466073130000121
Figure BDA0002466073130000131
把以上64项误差系数表示为
Figure BDA0002466073130000132
其中,m=64。遥外测观测量序列值为弹体运动时的遥外测速度差,
Figure BDA0002466073130000133
n=35703;速度环境函数矩阵为C=[C1 C2 … Cm],则制导工具误差模型为Y=CX
如图2为遥外测速度误差曲线。
(2)求出结构矩阵的基向量
在环境函数矩阵C中选取46个列作为基,这46个列对应的误差系数分别为ΔT、k0x、δKax、kyx、Kxxy、Kxyz、K3x、k0y、δKay、kxy、kzy、δK2y、Kyxy、Kyyz、K3y、k0z、δkz、δKaz、kyz、Kzxy、Kzyz、DFx、DFy、DFz、D1x、D1y、D1z、D2x、D2y、D2z、D3y、D3z、D4x、D4z、D5x、D5y、D5z、D6x、D6z、D7x、D7y、D7z、D8x、D8y、D8z、D9z,由这46个基构成基矩阵D。另外18个系数δkx、kzx、K2x、δK2x、Kxxz、δky、K2y、Kyxz、kxz、K2z、δK2z、Kzxz、K3z、D3x、D4y、D6y、D9x、D9y对应的列向量都可表示为基的线性组合,这些列向量构成矩阵C″。
(3)求参数矩阵R
非基向量矩阵C″由基矩阵D表示的参数矩阵R采用最小二乘法求解,分别对下列m-rA个方程求解
Figure BDA0002466073130000141
式中,p1=3、p2=6、p3=7、p4=8、p5=10、p6=14、p7=18、p8=21、p9=27、p10=29、p11=30、p12=32、p13=34、p14=44、p15=48、p16=54、p17=62、p18=63;q1=1、q2=2、q3=4、q4=5、q5=9、q6=11、q7=12、q8=13、q9=15、q10=16、q11=17、q12=19、q13=20、q14=22、q15=23、q16=24、q17=25、q18=26、q19=28、q20=31、q21=33、q22=35、q23=36、q24=37、q25=38、q26=39、q27=40、q28=41、q29=42、q30=43、q31=45、q32=46、q33=47、q34=49、q35=50、q36=51、q37=52、q38=53、q39=55、q40=56、q41=57、q42=58、q43=59、q44=60、q45=61、q46=64。
在求解过程中采用显著性检验,把不显著的参数直接置为零。比如,δkx对应的列向量C3(其中,p1=3)具体表达式为
C″1=C3=r3,4C4+r3,5C5+r3,9C9+r3,16C16+r3,23C23+r3,37C37+r3,43C43+r3,49C49
+r3,52C52+r3,58C58+r3,59C59+r3,60C60
式中,r3,4=0.87、r3,5=-0.08、r3,9=0.021、r3,16=0.93、r3,23=-6.7×10-5、r3,37=-7.3×10-4、r3,43=5.5×10-4、r3,49=-0.012、r3,52=-4.0×10-4、r3,58=4.3×10-3、r3,59=7.9×10-4、r3,60=4.6×10-3
在求解出矩阵R中的各元素后,考虑到相关性后的基于遥外测速度差的因果关系见图3所示。
(4)新的制导工具误差系数
新的制导工具误差系数为
Figure BDA0002466073130000151
基于新的制导工具误差系数的遥外测速度差因果关系见图4所示,其结构矩阵为列满秩,用线性函数进行描述为
δV=x′1C1+x′2C2+x′4C4+x′5C5+x′9C9+x′11C11+x′12C12+x′13C13+x′15C15+x′16C16+x′17C17+x′19C19+x′20C20+x′22C22+x′23C23+x′24C24+x′25C25+x′26C26+x′28C28+x′31C31+x′33C33+x′35C35+x′36C36+x′37C37+x′38C38+x′39C39+x′40C40+x′41C41+x′42C42+x′43C43+x′45C45+x′46C46+x′47C47+x′49C49+x′50C50+x′51C51+x′52C52+x′53C53+x′55C55+x′56C56+x′57C57+x′58C58+x′59C59+x′60C60+x′64C64
(5)求解工具误差系数的值
再采用最小二乘法并经显著性检验后,保留显著项后的遥外测速度差因果关系见图5所示,表达式为
δV=x′9C9+x′13C13+x′20C20+x′35C35+x′58C58
其中,
x′9=x9+x3 r3,9+x6 r6,9+x8 r8,9+x10 r10,9+x27 r27,9+x44 r44,9
x′13=x13+x6 r6,13+x14 r14,13+x18 r18,13+x21 r21,13
x′20=x20+x6 r6,20+x21 r21,20+x27 r27,20+x44 r44,20+x62 r62,20
x′35=x35+x6 r6,35+x27 r27,35+x44 r44,35+x48 r48,35+x62 r62,35+x63 r63,35
x′58=x58+x3 r3,58+x6 r6,58+x7 r7,58+x10 r10,58+x27 r27,58+x32 r32,58+x44 r44,58+x48r48,58+x54 r54,58+x62 r62,58+x63 r63,58
用表1的符号进行表示,最终得到显著的惯性器件误差模型为
Figure BDA0002466073130000152
其中,
K′xxy=Kxxy+0.021δkx-0.019kzx+0.061δK2x+0.021Kxxz-0.019kxz+0.32D3x
=6.1×10-4g/g2
k′0y=k0y+2.6×10-3kzx-0.014δky+5.2×10-3K2y+6.0×10-3Kyxz
=-2.1×10-4g
K′yxy=Kyxy+4.8×10-3kzx-0.02kyxz+5.5×10-3kxz-0.034D3x+1.5×10-3D9x
=-6.8×10-5g/g2
D′Fx=DFx-3.1×10-3kzx-3.0×10-3kxz+0.089D3x+0.013D4y
-0.027D9x+2.4×10-3D9y
=-0.05°/h
D′7z=D7z+4.3×10-3δkx+3.1×10-3kzx-9.1×10-4K2x-1.5×10-3Kxxz
+2.8×10-3kxz+1.1×10-4kzxz+0.043D3x-0.012D4y
+6.0×10-3D6y+0.015D9x-7.2×10-4D9y
=0.18°/h/g2
(6)补偿效果
把上述误差系数代入遥外测速度误差模型
Figure BDA0002466073130000161
进行补偿,结果见图6。补偿残差为
Figure BDA0002466073130000162
结果见图7,从图中可以看出,补偿效果较好,提高了制导精度。
本发明给出了一种结合相关性检验和显著性检验的提高惯性制导精度的方法,通过引进环境函数矩阵相关检验中把相互之间关联的制导工具误差系数进行整合,整合后的新系数对应的环境函数矩阵为列满秩,从而可精确求解,克服了主成分估计、岭估计不能精确求解的缺点;把显著性检验引入制导工具误差系数分离过程中,有利于简化模型,也有利于分析各制导工具误差系数与测量值之间的本质特性,并且能够大幅降低模型的维数,克服了结构矩阵维数过多的问题,有利于实时在线计算制导工具误差系数,具有简单快捷、容易实现的优点。
本发明虽然已以较佳实施例公开如上,但其并不是用来限定本发明,任何本领域技术人员在不脱离本发明的精神和范围内,都可以利用上述揭示的方法和技术内容对本发明技术方案做出可能的变动和修改,因此,凡是未脱离本发明技术方案的内容,依据本发明的技术实质对以上实施例所作的任何简单修改、等同变化及修饰,均属于本发明技术方案的保护范围。

Claims (2)

1.一种结合相关性和显著性检验的提高惯性制导精度的方法,其特征在于:包括如下步骤:
步骤一、根据遥外测误差矩阵Y、环境函数矩阵C和制导工具误差系数X,建立制导工具误差模型;制导工具误差模型为线性关系;制导工具误差模型为:
Y=CX
式中,Y为遥外测误差矩阵,
Figure FDA0003448266890000011
y1,y2,……,yn为按时间序列1×Δt、2×Δt、……,n×Δt给定的遥测值与外测值之差,其中Δt为采样时间;n为正整数,且n>10000;
X为制导工具误差系数;
Figure FDA0003448266890000012
x1,x2,……,xm 为 与惯性器件相关的误差系数;m为正整数,且m>20;
C为环境函数矩阵,C=[C1 C2…Cm];C1,C2,……,Cm为在1×Δt、2×Δt、……,n×Δt时刻制导工具误差系数 x1,x2,……,xm对应遥外测观测量y1,y2,……,yn的环境函数的值;
步骤二、确定环境函数矩阵C的全部基向量,并将全部基向量构成基矩阵D;环境函数矩阵C基向量的计算方法为:
计算矩阵CTC的秩rA;rA=rank(CTC);对rA的值进行判断;当rA=m时,则环境函数矩阵C为列满秩,环境函数矩阵C所有的列向量均为基向量;当rA<m时,则环境函数矩阵C不为列满秩,从环境函数矩阵C中选择rA个列向量作为基向量;
从环境函数矩阵C中选择rA个列向量作为基向量的具体步骤包括:
S1、建立矩阵D=C;设循环次数l为1;
S2、矩阵D的列向量数为p,p为正整数,且p<m,矩阵D的p个列向量记为D1,D2,……,Dp;根据p个列向量建立p个矩阵,分别为:[D2...Dp]T[D2...Dp]、……[D1...Di-1 Di+1...Dp]T[D1...Di-1 Di+1...Dp]、……[D1...Dp-1]T[D1...Dp-1];式中,i=2,…,p-1;计算上述各矩阵的秩rj和条件数dj;其中,j=1,……,p;从矩阵D找到1个列向量Dk,满足该列向量Dk的秩rk=rA且条件数dk最大;则Dk为非基列向量;
S3、去除非基列向量Dk,建立新矩阵D′ ,D′=[D1...Dk-1 Dk+1...Dp];列向量数为p-1;
S4、重复S2-S3,每重复一次,循环次数l的值加1;直至循环次数l=m-rA,停止循环;得到去除全部非基列向量的矩阵D,即为基向量矩阵D;对基向量矩阵D中的各基列向量重新编号,记为:
Figure FDA0003448266890000021
步骤三、确定环境函数矩阵C的全部非基向量,并将全部非基向量构成非基向量矩阵C″;用基矩阵D表示非基向量矩阵C″,计算各参数列矩阵的值,将各参数列矩阵构成参数矩阵R;非基向量矩阵C″的确定方法为:将步骤二中全部非基列向量集合,组成环境函数C的非基向量矩阵C″,并对非基向量矩阵C″中的各非基列向量重新编号,记为:
Figure FDA0003448266890000022
通过基矩阵D表示非基向量矩阵C″的方程组包括m-rA个方程,分别为:
Figure FDA0003448266890000031
对每个方程采用最小二乘法求解,计算出各参数列矩阵
Figure FDA0003448266890000032
Figure FDA0003448266890000033
的值,将各列矩阵组成得到参数矩阵R,
Figure FDA0003448266890000034
步骤四、设定新制导工具误差系数
Figure FDA0003448266890000035
新制导工具误差系数包括rA个行向量;通过原有制导工具误差系数
Figure FDA0003448266890000041
和参数矩阵R建立新制导工具误差系数
Figure FDA0003448266890000042
的方程;原有制导工具误差系数
Figure FDA0003448266890000043
中有m个向量分别为x1,x2,……,xm;m个向量中包括rA个基向量和m-rA个非基向量;将rA个基向量编号组成矩阵
Figure FDA0003448266890000044
将m-rA个非基向量编号组成矩阵
Figure FDA0003448266890000045
则新制导工具误差系数
Figure FDA0003448266890000046
的表示方法为:
Figure FDA0003448266890000047
步骤五、通过基矩阵D和新制导工具误差系数X′建立遥外测误差矩阵Y的方程,计算新制导工具误差系数X′;遥外测误差矩阵Y的方程为:
Figure FDA0003448266890000048
通过最小二乘法求解上述公式,即可得到新制导工具误差系数X′的具体值;
步骤六、根据新制导工具误差系数X′和基矩阵D对遥外测误差矩阵Y进行补偿,并计算补偿后的残差ΔY;实现提高惯性制导精度。
2.根据权利要求1所述的一种结合相关性和显著性检验的提高惯性制导精度的方法,其特征在于:所述步骤六中,补偿后残差ΔY的计算方法为:
Figure FDA0003448266890000051
CN202010334359.8A 2020-04-24 2020-04-24 一种结合相关性和显著性检验的提高惯性制导精度的方法 Active CN111623769B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202010334359.8A CN111623769B (zh) 2020-04-24 2020-04-24 一种结合相关性和显著性检验的提高惯性制导精度的方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202010334359.8A CN111623769B (zh) 2020-04-24 2020-04-24 一种结合相关性和显著性检验的提高惯性制导精度的方法

Publications (2)

Publication Number Publication Date
CN111623769A CN111623769A (zh) 2020-09-04
CN111623769B true CN111623769B (zh) 2022-06-03

Family

ID=72257880

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202010334359.8A Active CN111623769B (zh) 2020-04-24 2020-04-24 一种结合相关性和显著性检验的提高惯性制导精度的方法

Country Status (1)

Country Link
CN (1) CN111623769B (zh)

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6356815B1 (en) * 2000-08-25 2002-03-12 Hughes Electronics Corporation Stellar attitude-control systems and methods with weighted measurement-noise covariance matrices
JP2016071421A (ja) * 2014-09-26 2016-05-09 株式会社東芝 計算誤差推定装置および計算誤差推定方法
CN110186480A (zh) * 2019-05-30 2019-08-30 北京航天控制仪器研究所 一种惯性器件线性系统误差系数确定方法
CN110553642A (zh) * 2019-07-26 2019-12-10 北京航天控制仪器研究所 一种提高惯性制导精度的方法
CN110553641A (zh) * 2019-07-25 2019-12-10 北京航天控制仪器研究所 一种基于相关系数的提高惯性制导精度的方法

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US9448072B2 (en) * 2007-05-31 2016-09-20 Trx Systems, Inc. System and method for locating, tracking, and/or monitoring the status of personnel and/or assets both indoors and outdoors
GB2565264B (en) * 2017-05-23 2022-03-09 Atlantic Inertial Systems Ltd Inertial navigation system

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6356815B1 (en) * 2000-08-25 2002-03-12 Hughes Electronics Corporation Stellar attitude-control systems and methods with weighted measurement-noise covariance matrices
JP2016071421A (ja) * 2014-09-26 2016-05-09 株式会社東芝 計算誤差推定装置および計算誤差推定方法
CN110186480A (zh) * 2019-05-30 2019-08-30 北京航天控制仪器研究所 一种惯性器件线性系统误差系数确定方法
CN110553641A (zh) * 2019-07-25 2019-12-10 北京航天控制仪器研究所 一种基于相关系数的提高惯性制导精度的方法
CN110553642A (zh) * 2019-07-26 2019-12-10 北京航天控制仪器研究所 一种提高惯性制导精度的方法

Non-Patent Citations (3)

* Cited by examiner, † Cited by third party
Title
SINS误差参数辨识中环境函数矩阵计算的一种新方法;温永智等;《弹箭与制导学报》;20071231;第27卷(第3期);全文 *
制导误差分离中环境函数矩阵的精确计算方法;杨华波等;《飞行器测控学报》;20080630;第27卷(第3期);全文 *
基于环境函数矩阵法的惯导精度快速评估;温永智等;《弹箭与制导学报》;20110630;第31卷(第3期);全文 *

Also Published As

Publication number Publication date
CN111623769A (zh) 2020-09-04

Similar Documents

Publication Publication Date Title
CN110553641B (zh) 一种基于相关系数的提高惯性制导精度的方法
CN108827299B (zh) 一种基于改进四元数二阶互补滤波的飞行器姿态解算方法
CN109827571B (zh) 一种无转台条件下的双加速度计标定方法
CN103954304B (zh) 一种应用于mems惯组的零偏长短期变化值测试方法
CN110879302B (zh) 一种石英谐振差动式加速度计温度补偿方法
CN109188026B (zh) 适用于mems加速度计的自动标定的深度学习方法
CN110553642B (zh) 一种提高惯性制导精度的方法
CN109902408B (zh) 一种基于数值运算和改进的正则化算法的载荷识别方法
CN112762962B (zh) 基于温度滞后模型的微机电系统加速度计零偏补偿方法
CN113091768B (zh) 一种mimu整体动态智能标定补偿方法
CN114280332B (zh) 一种三轴加速度传感器校正方法
CN111623779A (zh) 一种适用于噪声特性未知的时变系统自适应级联滤波方法
CN111623769B (zh) 一种结合相关性和显著性检验的提高惯性制导精度的方法
CN110186482B (zh) 一种提高惯性制导航天器的落点精度的方法
CN110186483B (zh) 提高惯性制导航天器落点精度的方法
CN103884356A (zh) 一种标定捷联惯性组合陀螺仪组合的方法
CN115655272B (zh) Mems加速度计零偏和标度因数的温度补偿方法及系统
CN115455347A (zh) 一种mems加速度计混合误差建模补偿方法
CN112747773B (zh) 基于Allan方差和随机多项式提高陀螺仪精度的方法
Zhong et al. A calibration method of UAV accelerometer based on Levenberg-Marquardt iteration algorithm
CN105069288B (zh) 一种探测器结构高过载加严试验设计与评估方法
CN110186484B (zh) 一种提高惯性制导航天器落点精度的方法
CN111637894A (zh) 一种定常系数陆标图像导航滤波方法
CN112097667B (zh) 一种用于压差形变测量的纳米级干涉测量方法
EP2221623A1 (en) Method for estimating the angular acceleration and related inertial measurement unit

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