一种提高惯性制导航天器的落点精度的方法

摘要

本发明涉及一种提高惯性制导航天器的落点精度的方法，属于惯性导航技术领域。本发明给出了结构矩阵列向量强相关时的递推最小二乘法的稳态值的理论计算值，克服了传统的递推最小二乘法在结构矩阵奇异时不能给出精确的理论值的缺点；本发明给出了结构矩阵列向量强相关时的递推最小二乘法的稳态值的理论计算方法，可给出结构矩阵列向量强相关时的具体表达式，有利于实现对参数估计的预测。本发明给出了结构矩阵列向量强相关时的递推最小二乘法的稳态值的理论计算值，有利于在此基础上分析系统的可观性，以及估计轨迹的优化等，具有较好的工程应用价值。

权利要求

1.一种提高惯性制导航天器的落点精度的方法，其特征在于：惯性器件包括陀螺仪和加速度计，该方法的步骤包括：(1)实时计算惯性器件的n组误差量yi；

yi＝x1ui1+x2ui2+…+xmuim＝ciX,i＝1,2,…,n，m为状态变量的个数；

其中，ci＝[ui1 ui2 … uim]， 则惯性器件的结构矩阵Cn为x1,x2,x3,…,xm是惯性器件的误差系数；

结构矩阵Cn中存在l个非零标量满足式中， 分别为相关比例系数；

(3)根据步骤(2)中的相关比例系数 列写出采用递推最小二乘法后对应参数的稳态值为

(4)在结构矩阵Cn中还有一组列向量相关，按照步骤(2)和步骤(3)求得对应参数的稳态值，直至结构矩阵Cn中剩余的各列互不相关；

(5)采用递推最小二乘法计算步骤(1)中X的估计值(6)根据步骤(5)得到的 计算X为其中，U的各元素在i、i1、i2、…、il行为非1的元素，其余各行都为1，在i、i1、i2、…、il行的元素分别为

(7)根据步骤(6)得到的惯性器件误差系数X，对惯性器件的输出量进行误差补偿，并将补偿后的惯性器件的输出量输出给导航系统用于确定航天器的运动状态，从而提高惯性制导航天器的落点精度。

2.根据权利要求1所述的一种提高惯性制导航天器的落点精度的方法，其特征在于：所述的惯性器件为陀螺仪。

3.根据权利要求1所述的一种提高惯性制导航天器的落点精度的方法，其特征在于：所述的惯性器件为加速度计。

4.根据权利要求1所述的一种提高惯性制导航天器的落点精度的方法，其特征在于：所述的步骤(1)中，Ci为结构矩阵Cn的第i列。

5.根据权利要求1所述的一种提高惯性制导航天器的落点精度的方法，其特征在于：所述的步骤(1)中， 分别为结构矩阵Cn的第j1、j2、…、jl列。

6.根据权利要求1所述的一种提高惯性制导航天器的落点精度的方法，其特征在于：所述的步骤(1)中，列向量Ci与结构矩阵Cn中其余各列都不相关。

7.根据权利要求1所述的一种提高惯性制导航天器的落点精度的方法，其特征在于：所述的步骤(5)中，采用递推最小二乘法计算步骤(1)中X的估计值 为：其中，

I为单位矩阵。

8.根据权利要求7所述的一种提高惯性制导航天器的落点精度的方法，其特征在于：Pn+1＝Pn‑Kn+1cn+1Pn。

9.根据权利要求8所述的一种提高惯性制导航天器的落点精度的方法，其特征在于：在n+1次递推计算时，yn+1为yn+1＝cn+1X

设定n＝0时，Pn的初值为P0，P0为一设定值； 的初值 为一设定值。

10.根据权利要求9所述的一种提高惯性制导航天器的落点精度的方法，其特征在于：迭代次数为n次。

说明书

一种提高惯性制导航天器的落点精度的方法

技术领域

[0001] 本发明涉及一种提高惯性制导航天器的落点精度的方法，属于惯性导航技术领域。

背景技术

[0002] 当前航天飞行器的惯性导航主要采用陀螺仪和加速度计构成的捷联系统或平台系统。在实弹飞行前，需要在地面对陀螺仪和加速度计的误差系数进行标定，根据标定的结
果通过误差补偿可有效提高惯性导航的使用精度。目前，经过地面标定的惯性器件，在实际
飞行导航试验中，根据遥测数据计算的速度和位置的理论值仍与外测获得的真实飞行速度
和位置值之间存在较大的偏差，出现所谓的“天地不一致”的情况。经分析，出现“天地不一
致”的原因是地面标定方法和数据处理方法的精度不足，造成实际飞行过程中误差积累，导
致飞行精度变差，因此需要对地面标定时的误差模型和数据处理方法进行修正。

发明内容

[0003] 本发明的技术解决问题：在于克服现有技术的不足，提出一种提高惯性制导航天器的落点精度的方法，该方法能够在给定结构矩阵奇异和非奇异两种情况下非常精确的计
算出各参数的稳态值以及误差值。

[0004] 本发明的技术解决方案是：

[0005] 一种提高惯性制导航天器的落点精度的方法，惯性器件包括陀螺仪和加速度计，该方法的步骤包括：

[0006] (1)实时计算惯性器件的n组误差量yi；

[0007] yi＝x1ui1+x2ui2+…+xmuim＝ciX,i＝1,2,…,n，m为状态变量的个数；

[0008] 其中，ci＝[ui1 ui2 … uim]， 则惯性器件的结构矩阵Cn为

[0009]

[0010] x1,x2,x3,…,xm是惯性器件的误差系数；

[0011] 结构矩阵Cn中存在l个非零标量满足

[0012]

[0013] 式中， 分别为相关比例系数，Ci为结构矩阵Cn的第i列，分别为结构矩阵Cn的第j1、j2、…、jl列。除满足式(1)以外，列向量Ci与结
构矩阵Cn中其余各列都不相关。

[0014] (3)根据步骤(2)中的相关比例系数 可列写出采用递推最小二乘法后对应参数的稳态值为

[0015]

[0016] (4)如果在结构矩阵Cn中还有一组列向量相关即多相关惯性器件误差系数的确定方法中多相关的含义，则按照步骤(2)和步骤(3)求得对应参数的稳态值，直至结构矩阵Cn
中剩余的各列互不相关。

[0017] (5)采用递推最小二乘法计算步骤(1)中X的估计值

[0018] (6)根据步骤(5)得到的 计算X为

[0019]

[0020] (7)根据步骤(6)得到的惯性器件误差系数X，对惯性器件的输出量进行误差补偿，并将补偿后的惯性器件的输出量输出给导航系统用于确定航天器的运动状态，从而提高惯
性制导航天器的落点精度。

[0021] 所述的步骤(5)中，采用递推最小二乘法计算步骤(1)中X的估计值 为：

[0022]

[0023] 其中，

[0024] I为单位矩阵；

[0025] Pn+1＝Pn‑Kn+1cn+1Pn

[0026] 在n+1次递推计算时，yn+1为

[0027] yn+1＝cn+1X

[0028] 设定n＝0时，Pn的初值为P0，P0为一设定值；的初值 为一设定值；迭代次数为n次。

[0029] 本发明与现有技术相比具有如下有益效果：

[0030] (1)本发明给出了结构矩阵列向量强相关时的递推最小二乘法的稳态值的理论计算值，克服了传统的递推最小二乘法在结构矩阵奇异时不能给出精确的理论值的缺点；

[0031] (2)本发明给出了结构矩阵列向量强相关时的递推最小二乘法的稳态值的理论计算方法，可给出结构矩阵列向量强相关时的具体表达式，有利于实现对参数估计的预测。

[0032] (3)本发明给出了结构矩阵列向量强相关时的递推最小二乘法的稳态值的理论计算值，有利于在此基础上分析系统的可观性，以及估计轨迹的优化等，具有较好的工程应用
价值。

附图说明

[0033] 图1为实施例中根据系数真值给出的加速度计输出误差序列值；

[0034] 图2为实施例中采用递推最小二乘法给出的迭代计算过程。

具体实施方式

[0035] 下面结合附图和具体实施例对本发明作进一步详细的描述：

[0036] (1)设n次采集数据构成的n×m维结构矩阵为Cn,其中，m为状态变量的个数；

[0037] (2)在结构矩阵Cn中存在一组列向量相关是由强相关引起的，即存在l个非零标量满足

[0038]

[0039] 式中， 分别为相关比例系数，Ci为结构矩阵Cn的第i列，分别为结构矩阵Cn的第j1、j2、…、jl列。除满足式(1)以外，列向量Ci与结
构矩阵Cn中其余各列都不相关。

[0040] (3)根据步骤(2)中的相关比例系数 可列写出采用递推最小二乘法后对应参数的稳态值为

[0041]

[0042] (4)如果在结构矩阵Cn中还有一组列向量相关是由强相关引起的，则按照步骤(2)和步骤(3)求得对应参数的稳态值，直至结构矩阵Cn中剩余的各列互不相关。

[0043] (5)步骤(4)中结构矩阵Cn剩余的各列对应参数的估计值与真值相同。

[0044] 所述结构矩阵列向量强相关时的递推最小二乘稳态值计算方法，在步骤(1)中描述的结构矩阵Cn为

[0045]

[0046] 式中，每一行代表了第i次观测量表示的线性方程固有特性，满足

[0047] yi＝x1ui1+x2ui2+…+xmuim＝ciX, i＝1,2,…,n                  (4)

[0048] 其中，x1,x2,x3,…,xm是与u1,u2,…,um无关的未知参数，

[0049] ci＝[ui1 ui2 … uim]                            (5)

[0050]

[0051] 所述结构矩阵列向量强相关时的递推最小二乘稳态值计算方法，在步骤(3)中描述的递推最小二乘法计算公式为

[0052] (1)给出n＝0时的递推初值，包括：m×m维信息逆矩阵初值Pn＝P0和m×1维参数的初值

[0053] (2)在n+1次递推计算时，一维观测量yn+1为

[0054] yn+1＝cn+1X

[0055] 式中，ci+1为1×m维矩阵。

[0056] (3)采用以下递推公式计算新的Pn和

[0057]

[0058]

[0059] Pn+1＝Pn‑Kn+1cn+1Pn

[0060] (4)令n＝n+1，返回步骤(2)直至递推结束。

[0061] 实施例

[0062] 以加速度计误差标定为例，设加速度计输出误差方程为

[0063] y＝k0x+δkxax+kyxay+kzxaz+kpfax+kqqay                    (7)

[0064] 采用六位置分离误差系数，6个位置如表1所示。

[0065] 表1六位置编排

[0066] 序号 x、y、z ax ay az1 天南东 1 0 0
2 南东天 0 0 1
3 东天南 0 1 0
4 北地西 0 ‑1 0
5 西北地 0 0 ‑1
6 地西北 ‑1 0 0

[0067] 设加速度计输出误差方程为：

[0068]

[0069] 设在每个位置的测试数据取平均值，6个位置共计6个测试数据y1、y2、…、y6。

[0070] 取状态变量为

[0071]

[0072] 结构矩阵为

[0073]

[0074] 在第一个位置，有

[0075] c1＝[1 1 0 0 f 0]

[0076] 在第二个位置，有

[0077] c2＝[1 0 0 1 0 0]

[0078] 在第三个位置，有

[0079] c3＝[1 0 1 0 0 q]

[0080] 在第四个位置，有

[0081] c4＝[1 0 ‑1 0 0 ‑q]

[0082] 在第五个位置，有

[0083] c5＝[1 0 0 ‑1 0 0]

[0084] 在第六个位置，有

[0085] c6＝[1 ‑1 0 0 ‑f 0]

[0086] 在进行仿真时，设加速度计误差系数的真值为k0x＝1.0×10‑4、δkx＝‑1.0×10‑4、‑4 ‑4 ‑4 ‑4
kyx＝1.0×10 、kzx＝‑1.0×10 、kp＝‑1.0×10 、kq＝‑1.0×10 ，以及f＝‑4、q＝2，代入加
速度计误差模型后计算的加速度计输出误差值如图1所示。
7

[0087] 给定初值 P0＝10 ，采用递推最小二乘法估计出各项误差系数，如图2所示。图中，虚线为各参数的真值，实线为各参数的估计值。左上角图中的“k0x”代表本发明专利中
的“k0x”，右上角图中的“dkx”代表本发明专利中的“δkx”，左中图中的“kyx”代表本发明专利
中的“kyx”，右中图中的“kzx”代表本发明专利中的“kzx”，左下角图中的“kp”代表本发明专
利中的“kp”，右下角图中的“kq”代表本发明专利中的“kq”。

[0088] 从图2中可以看出，只有三个误差系数k0x和kzx收敛到真值，而其余四项误差系数δkx、kyx、kp、kq收敛到各自的稳态值，但与真值有较大的差距。后者之所以没有收敛到真值的
原因就是存在强相关，使得结构矩阵为奇异矩阵。收敛后的稳态值为

[0089] k0x＝1.00000000×10‑4、δkx＝1.76470588×10‑5、kyx＝‑2.0000000×10‑5、kzx＝‑‑4 ‑5 ‑5
1.0000000×10 、kp＝‑7.05882352×10 、kq＝‑4.0000000×10 。

[0090] 由于递推过程相对复杂，可采用本发明的算法求解出参数的理论计算值，具体过程为

[0091] (1)结构矩阵为

[0092]

[0093] (2)求出结构矩阵C6中两组强相关列的比例系数

[0094]

[0095] 其中，i＝2，j1＝5，j2＝6，以及r5,2＝‑4、r6,3＝2。

[0096] (3)根据步骤(1)中的相关比例系数r5,2＝‑4、r6,3＝2，可列写出3×1维列向量

[0097]

[0098]

[0099] 以及

[0100]

[0101] 根据设定值，求出稳态值的理论计算值为

[0102]

[0103] (4)根据步骤(3)得到的惯性器件误差系数X，对惯性器件的输出量进行误差补偿，并将补偿后的惯性器件的输出量输出给导航系统用于确定航天器的运动状态，从而提高惯
性制导航天器的落点精度。

[0104] 以上所述，仅为本发明一个具体实施方式，但本发明的保护范围并不局限于此，任何熟悉本技术领域的技术人员在本发明揭露的技术范围内，可轻易想到的变化或替换，都
应涵盖在本发明的保护范围之内。

[0105] 本发明未详细说明部分属于本领域技术人员公知常识。