CN111637883B - 基于速度和位置误差闭环反馈的提高惯性制导精度的方法 - Google Patents

基于速度和位置误差闭环反馈的提高惯性制导精度的方法 Download PDF

Info

Publication number
CN111637883B
CN111637883B CN202010351867.7A CN202010351867A CN111637883B CN 111637883 B CN111637883 B CN 111637883B CN 202010351867 A CN202010351867 A CN 202010351867A CN 111637883 B CN111637883 B CN 111637883B
Authority
CN
China
Prior art keywords
error
representing
guidance
speed
velocity
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
CN202010351867.7A
Other languages
English (en)
Other versions
CN111637883A (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 CN202010351867.7A priority Critical patent/CN111637883B/zh
Publication of CN111637883A publication Critical patent/CN111637883A/zh
Application granted granted Critical
Publication of CN111637883B publication Critical patent/CN111637883B/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
    • 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/24Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for cosmonautical navigation

Landscapes

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

Abstract

本发明公开了一种基于速度和位置误差闭环反馈的提高惯性制导精度的方法,包括:对速度环境函数进行闭环反馈;获取惯性制导遥外测速度误差;根据飞行环境函数关系,构建制导工具误差模型;根据速度环境函数,采用最小二乘法求解出制导工具误差的值;根据求解出的制导工具误差的值,对惯性制导遥外测观测量进行补偿,以提高惯性制导精度。本发明克服了现有方案忽略速度反馈、位置反馈时近似线性化引起速度环境函数与遥外测速度误差不匹配,进而导致不能精确求解惯性制导工具误差系数的不足的问题。

Description

基于速度和位置误差闭环反馈的提高惯性制导精度的方法
技术领域
本发明属于惯性导航与惯性制导技术领域,尤其涉及一种基于速度和位置误差闭环反馈的提高惯性制导精度的方法。
背景技术
当前航天飞行器的惯性导航主要采用陀螺仪和加速度计构成的惯性测量系统(捷联系统或平台系统)作为运动信息测量部件,其精度直接决定了航天飞行器的制导精度,因此,把惯性测量系统的误差一般称作惯性制导工具误差。由于惯性测量系统的误差不可直接观测,而须通过外部测量的速度、姿态等信息来补偿或修正惯性测量系统的误差以提高制导精度,这就牵涉到如何分离出惯性测量系统的误差系数,或惯性制导工具误差系数。
在利用弹道导弹遥外测数据分离惯性测量系统误差系数时,可采用遥外测速度误差误差作为观测量,其优点是速度误差反映了加速度计组合和陀螺仪组合的测量误差,另外一个优点是建立速度环境函数矩阵后可直接通过解方程求解误差系数,过程中没有微分解算。
建立速度环境函数主要基于惯性导航误差传播方程,由于存在着速度误差、位置误差和姿态角误差反馈,为一个非线性多变量交链方程,因此,难以建立所需的线性方程从而求解工具误差。
目前,在工程实际中主要采用了简化的方案,忽略了姿态角误差对姿态角速度的反馈作用,也忽略了速度误差和位置误差对加速度误差的反馈作用。该简化方案适宜于飞行时间较短的弹道导弹主动段应用场景,在关机点时刻可认为速度误差和位置误差引起的反馈作用非常小,从而影响落点精度的主要因素是惯性器件的误差。
但随着全程制导飞行时间的量级增加,该简化方案已显露出不足,表现为长时间飞行时舒拉周期的影响、地球几何模型的影响、重力异常的影响等都会导致分离的误差系数偏离真值较大,从而导致制导精度下降。
为此,如何在反映惯性导航误差传播客观存在反馈的约束条件下,实现基于弹道导弹遥外测数据的惯性测量系统误差系数精确分离是一个难题。需要寻找一种精确的基于遥外测数据估计制导工具误差系数分离方法,以提高惯性制导的精度。
发明内容
本发明的技术解决问题:克服现有技术的不足,提供一种基于速度和位置误差闭环反馈的提高惯性制导精度的方法,克服了现有方案忽略速度反馈、位置反馈时近似线性化引起速度环境函数与遥外测速度误差不匹配,进而导致不能精确求解惯性制导工具误差系数的不足的问题。
为了解决上述技术问题,本发明公开了一种基于速度和位置误差闭环反馈的提高惯性制导精度的方法,包括:
对速度环境函数进行闭环反馈;
获取惯性制导遥外测速度误差;
根据飞行环境函数关系,构建制导工具误差模型;其中,所述制导工具误差模型满足线性关系;
根据速度环境函数,采用最小二乘法求解出制导工具误差的值;
根据求解出的制导工具误差的值,对惯性制导遥外测观测量进行补偿,以提高惯性制导精度。
在上述基于速度和位置误差闭环反馈的提高惯性制导精度的方法中,获取惯性制导遥外测速度误差,包括:
获取导弹相对发射点地球坐标系的遥外测速度误差
Figure BDA0002472189160000021
Figure BDA0002472189160000022
其中,δvx、δvy和δvz分别表示导弹在发射点地球坐标系O-XYZ的三个轴上的速度分量;
确定遥外测速度误差
Figure BDA0002472189160000031
的序列值
Figure BDA0002472189160000032
Figure BDA0002472189160000033
其中,i=1,2,…N,采样间隔周期为ΔT,对应的时间ti=ΔT,2ΔT,…NΔT。
在上述基于速度和位置误差闭环反馈的提高惯性制导精度的方法中,根据飞行环境函数关系,构建制导工具误差模型,包括:
根据遥外测速度误差
Figure BDA0002472189160000034
的序列值
Figure BDA0002472189160000035
确定惯性制导遥外测观测量的序列值Y:
Figure BDA0002472189160000036
确定环境函数矩阵C:
Figure BDA0002472189160000037
Figure BDA0002472189160000038
其中,xaj表示与加速度计相关的误差系数,j=1,2,…p;xgk表示陀螺仪有关的误差系数,k=1,2,…q;
确定制导工具误差系数X:
Figure BDA0002472189160000039
构建制导工具误差模型:Y=CX。
在上述基于速度和位置误差闭环反馈的提高惯性制导精度的方法中,
Figure BDA0002472189160000041
其中,
Figure BDA0002472189160000042
表示从安装三个加速度计的本体坐标系至发射点地球坐标系的坐标变换矩阵,
Figure BDA0002472189160000043
表示三个加速度计的测量输出误差矢量,ωie,x、ωie,y和ωie,z分别表示ωie在发射点地球坐标系O-XYZ的三个轴上的分量,Ne表示重力加速度误差矩阵;
Figure BDA0002472189160000044
其中,
Figure BDA0002472189160000045
表示三个陀螺仪的测量输出误差矢量,Aφ表示姿态角误差至速度误差的环境函数矩阵,Aε表示陀螺仪误差系数至姿态角误差的环境函数矩阵。
在上述基于速度和位置误差闭环反馈的提高惯性制导精度的方法中,
Figure BDA0002472189160000046
Figure BDA0002472189160000047
Figure BDA0002472189160000048
在上述基于速度和位置误差闭环反馈的提高惯性制导精度的方法中,
Figure BDA0002472189160000049
其中,φx、φy和φz分别表示弹体相对于发射点地球坐标系的三个方向的姿态角分量;
Aφ=[Aφ1 Aφ2 Aφ3]
Figure BDA0002472189160000051
Figure BDA0002472189160000052
Figure BDA0002472189160000053
其中,ax、ay和az分别表示加速度计组合测量的三个方向的视加速度分量。
在上述基于速度和位置误差闭环反馈的提高惯性制导精度的方法中,
Figure BDA0002472189160000054
其中,
Figure BDA0002472189160000055
表示地心地球直角坐标系至发射点地球坐标系的变换矩阵,fM表示万有引力常数与地球质量乘积,ωie表示地球自转角速度,r=(x,y,z)表示弹体相对地心地球直角坐标系。
在上述基于速度和位置误差闭环反馈的提高惯性制导精度的方法中,
Figure BDA0002472189160000056
其中,
Figure BDA0002472189160000057
表示地球自转角速度相对发射点地球坐标系的矢量,ωie表示地球自转角速度,γ0表示发射点方位角,
Figure BDA0002472189160000058
表示发射点的纬度。
在上述基于速度和位置误差闭环反馈的提高惯性制导精度的方法中,根据速度环境函数,采用最小二乘法求解出制导工具误差的值,包括:
根据速度环境函数,采用最小二乘法,对X=(CTC)-1CTY进行求解,得到制导工具误差的值;其中,在对X=(CTC)-1CTY的求解过程中采用显著性检验,将不显著的状态变量直接置为零。
在上述基于速度和位置误差闭环反馈的提高惯性制导精度的方法中,根据求解出的制导工具误差的值,对惯性制导遥外测观测量进行补偿,包括:
采用求解出的制导工具误差的值,直接对惯性制导遥外测速度观测量进行补偿:ΔY=Y-CX;其中,ΔY表示补偿后的残差。
本发明具有以下优点:
本发明公开了一种基于速度和位置误差闭环反馈的提高惯性制导精度的方法,通过在速度环境函数中引进闭环反馈,使得修正后的速度环境函数构成的结构矩阵与遥外测速度误差相互匹配,克服了原简化方法存在不匹配而导致分离的误差系数与真值之间存在偏差的问题;原方法由于速度误差与速度环境函数不匹配,从而需要迭代多次才能求解出系数,而采用本发明所述的方法一次就能分离出制导工具误差,效率较高,具有简单快捷、容易实现的优点;采用本发明所述的方法分离系数准确,补偿惯性制导工具误差精度高,大幅提高了制导精度。
附图说明
图1是一种现有的惯性导航误差传播流程图;
图2是一种现有的简化流程方案的速度开环误差传播流程图;
图3是本发明实施例中一种基于速度和位置误差闭环反馈的提高惯性制导精度的方法的步骤流程图;
图4是本发明实施例中一种遥外测速度误差发射点地球坐标系X、Y、Z轴的分量示意图;
图5是本发明实施例中一种采用原遥外测速度误差分离后的补偿效果示意图;
图6是本发明实施例中一种采用修正后的遥外测速度误差分离后的补偿效果示意图。
具体实施方式
为使本发明的目的、技术方案和优点更加清楚,下面将结合附图对本发明公开的实施方式作进一步详细描述。
实施例1
设惯性导航解算是基于发射点地球坐标系,解算方程为:
Figure BDA0002472189160000071
其中,Xe表示导航解算是状态变量,re表示导航解算的位置矢量,Ve表示导航解算的速度矢量,
Figure BDA0002472189160000072
表示导航解算的本体坐标系至发射点地球坐标系的坐标变换矩阵,
Figure BDA0002472189160000073
表示加速度计组合测量的视加速度,
Figure BDA0002472189160000074
表示地球自转角速度的反对称矩阵,
Figure BDA0002472189160000075
表示重力加速度相对发射点地球坐标系的矢量,
Figure BDA0002472189160000076
表示陀螺仪测量的角速度的反对称矩阵,
Figure BDA0002472189160000077
表示地球自转角速度相对本体坐标系的反对称矩阵。
由于发射点地球坐标系e与地球表面固连,相对地固直角坐标系e0无旋转。设发射点方位角为γ0,发射点的纬度为
Figure BDA0002472189160000078
发射点的经度为λ0,则有:
Figure BDA0002472189160000079
其中,
Figure BDA00024721891600000710
表示地球自转角速度相对发射点地球坐标系的矢量,ωie表示地球自转角速度,ωie,x、ωie,y和ωie,z分别表示ωie在发射点地球坐标系O-XYZ的三个轴上的分量;
Figure BDA00024721891600000711
表示地心直角坐标系相对惯性坐标系的旋转角速度在发射点地球坐标系中的矢量;
Figure BDA00024721891600000712
表示发射点地球坐标系相对地心直角坐标系的旋转角速度在发射点地球坐标系中的矢量。
定义从发射点地球坐标系e至惯性平台台体坐标系p的坐标变换矩阵Re p为:
Figure BDA0002472189160000081
其中,φx、φy和φz分别表示弹体相对于发射点地球坐标系的三个方向的姿态角分量。
则姿态微分方程可写为:
Figure BDA0002472189160000082
其中,
Figure BDA0002472189160000083
表示陀螺仪测量的角速度矢量,
Figure BDA0002472189160000084
表示地球自转角速度在本体坐标系中的矢量。
依据导航解算方程,求得的导航误差方程包括:
1)位置误差微分方程:
Figure BDA0002472189160000085
2)速度误差微分方程:
Figure BDA0002472189160000086
其中,δre表示相对发射点地球坐标系导航解算的位置误差矢量,δVe表示相对发射点地球坐标系导航解算的速度误差矢量,δfp表示加速度计测量误差,δφx表示导航解算的X轴姿态角误差,δφy表示导航解算的Y轴姿态角误差,δφz表示导航解算的Z轴姿态角误差,Bv表示速度反馈矩阵,Br表示位置反馈矩阵,ax、ay和az分别表示加速度计组合测量的三个方向的视加速度分量。
在上式中,速度反馈矩阵Bv为:
Figure BDA0002472189160000091
在东北天地理坐标系中,位置反馈矩阵Br表示为:
Figure BDA0002472189160000092
其中,
Figure BDA0002472189160000093
g表示高度为h时的重力加速度,g0表示地球表面重力加速度,h表示海拔高度,R表示地球半径,ωs表示舒拉角频率;
Figure BDA0002472189160000094
表示地心地球直角坐标系至发射点地球坐标系的变换矩阵;
Figure BDA0002472189160000095
表示东北天地理坐标系至地心地球直角坐标系的变换矩阵;
Figure BDA0002472189160000096
表示地心地球直角坐标系至东北天地理坐标系的变换矩阵;
Figure BDA0002472189160000097
表示发射点地球坐标系至地心地球直角坐标系的变换矩阵。
在发射点地球坐标系中,位置反馈矩阵Br表示为:
Figure BDA0002472189160000098
其中,fM表示万有引力常数与地球质量乘积;r=(x,y,z)表示弹体相对地心的位置坐标。
3)姿态误差微分方程:
Figure BDA0002472189160000101
其中,
Figure BDA0002472189160000102
表示三个陀螺仪的测量输出误差矢量,
Figure BDA0002472189160000103
表示本体相对惯性坐标系的角速度在X轴的分量,
Figure BDA0002472189160000104
表示本体相对惯性坐标系的角速度在Y轴的分量,
Figure BDA0002472189160000105
表示本体相对惯性坐标系的角速度在Z轴的分量。
由姿态误差、速度误差和位置误差微分方程构成的惯性导航误差传播流程如图1所示,工作时间较短时的简化流程如图2所示。目前,在工程实际中主要采用了简化流程方案,忽略了姿态角误差对姿态角速度的反馈作用,也忽略了速度误差和位置误差对加速度误差的反馈作用。
例如:
加速度计误差系数的环境函数简化为:
Figure BDA0002472189160000106
其中,xaj表示与加速度计有关的误差系数,j=1,2…p;
Figure BDA0002472189160000107
表示三个加速度计的测量输出误差矢量;ΔT表示采样间隔周期,对应的时间ti=ΔT,2ΔT,…NΔT,i=1,2,…N。
陀螺仪误差系数的环境函数简化为:
Figure BDA0002472189160000108
其中,xgk表示与陀螺仪有关的误差系数,k=1,2…q;姿态误差至速度误差的环境韩淑矩阵;Aε表示陀螺仪误差系数至姿态误差的环境函数矩阵。
可见,现有的简化流程方案适用于飞行时间较短的弹道导弹主动段应用场景,在关机点时刻可认为速度误差和位置误差引起的反馈作用非常小,从而影响落点精度的主要因素是惯性器件的误差。
但随着全程制导飞行时间的量级增加,现有的简化流程方案已显露出不足,表现为长时间飞行时舒拉周期的影响、地球几何模型的影响、重力异常的影响等都会导致分离的误差系数偏离真值较大,从而导致制导精度下降。
考虑到弹道导弹相对于飞机、潜艇等工作时间相对较短,可认为姿态误差相对较小,在惯性导航误差传播过程中可忽略姿态误差的反馈作用,本发明公开了一种基于速度误差开环修正的提高惯性制导精度的方法。
如图3,在本实施例中,该基于速度和位置误差闭环反馈的提高惯性制导精度的方法,包括:
步骤101,对速度环境函数进行闭环反馈。
步骤102,获取惯性制导遥外测速度误差。
在本实施例中,获取导弹相对发射点地球坐标系的遥外测速度误差
Figure BDA0002472189160000117
Figure BDA0002472189160000111
其中,δvx、δvy和δvz分别表示导弹在发射点地球坐标系O-XYZ的三个轴上的速度分量。
确定遥外测速度误差
Figure BDA0002472189160000112
的序列值
Figure BDA0002472189160000113
Figure BDA0002472189160000114
步骤103,根据飞行环境函数关系,构建制导工具误差模型。
在本实施例中,制导工具误差模型满足线性关系。
根据遥外测速度误差
Figure BDA0002472189160000115
的序列值
Figure BDA0002472189160000116
确定惯性制导遥外测观测量的序列值Y:
Figure BDA0002472189160000121
确定环境函数矩阵C:
Figure BDA0002472189160000122
Figure BDA0002472189160000123
确定制导工具误差系数X:
Figure BDA0002472189160000124
构建制导工具误差模型:Y=CX。
优选的,在本实施例中有:
Figure BDA0002472189160000125
Figure BDA0002472189160000126
其中,Ne表示发射点地球坐标系中的重力加速度误差矩阵。
Figure BDA0002472189160000131
优选的,在本实施例中有:
Figure BDA0002472189160000132
Figure BDA0002472189160000133
Figure BDA0002472189160000134
优选的,在本实施例中有:
Figure BDA0002472189160000135
Aφ=[Aφ1 Aφ2 Aφ3]
Figure BDA0002472189160000136
Figure BDA0002472189160000137
Figure BDA0002472189160000138
步骤104,根据速度环境函数,采用最小二乘法求解出制导工具误差的值。
在本实施例中,根据速度环境函数,采用最小二乘法,对X=(CTC)-1CTY进行求解,得到制导工具误差的值;其中,在对X=(CTC)-1CTY的求解过程中采用显著性检验,将不显著的状态变量直接置为零。
步骤105,根据求解出的制导工具误差的值,对惯性制导遥外测观测量进行补偿,以提高惯性制导精度。
在本实施例中,采用求解出的制导工具误差的值,直接对惯性制导遥外测速度观测量进行补偿:ΔY=Y-CX;其中,ΔY表示补偿后的残差。
实施例2
在上述实施例的基础上,下面结合一个具体实例进行说明。
惯性制导导弹的落点精度主要取决于制导工具误差,在飞行过程中,遥测导航速度包含陀螺仪、加速度计等惯性器件引起的制导工具误差,外测实时测量出弹体的运动速度并作为基准信息。通过对飞行遥外测数据求差,可估计出各项工具误差系数的值。
(1)构建制导工具误差模型
加速度计组合误差模型为:
Figure BDA0002472189160000141
其中,δfx、δfy、δfz表示X、Y和Z轴对应的三个加速度计测量误差;k0x、k0y和k0z分别表示X、Y和Z加表零偏;δkx、δky和δkz分别表示X、Y和Z加表线性度;δKax、δKay和δKaz分别表示X、Y和Z加表不对称性;kxy表示Y加速度计相对X轴的安装误差角,kzy表示Y加速度计相对Z轴的安装误差角,kyx表示X加速度计相对Y轴的安装误差角,kzx表示X加速度计相对Z轴的安装误差角,kxz表示Z加速度计相对X轴的安装误差角,kyz表示Z加速度计相对Y轴的安装误差角;K2x表示X加表二次项,K2y表示Y加表二次项,K2z表示Z加表二次项;δK2x表示X加表奇二次项,δK2y表示Y加表奇二次项,δK2z表示Z加表奇二次项;Kxxy表示X加速度计与X、Y相关的交叉耦合项,Kxxz表示X加速度计与X、Z相关的交叉耦合项,Kxyz表示X加速度计与Y、Z相关的交叉耦合项,Kyxy表示Y加速度计与X、Y相关的交叉耦合项,Kyxz表示Y加速度计与X、Z相关的交叉耦合项,Kyyz表示Y加速度计与Y、Z相关的交叉耦合项,Kzxy表示Z加速度计与X、Y相关的交叉耦合项,Kzxz表示Z加速度计与X、Z相关的交叉耦合项,Kzyz表示Z加速度计与Y、Z相关的交叉耦合项;K3x表示X加表三次项,K3y表示Y加表三次项,K3z表示Z加表三次项。
陀螺仪组合误差模型为:
Figure BDA0002472189160000151
其中,εx、εy、εz表示X、Y和Z轴对应的三个陀螺仪的测量误差,DFx表示X陀螺仪常值漂移,DFy表示Y陀螺仪常值漂移,DFz表示Z陀螺仪常值漂移,D1x表示X陀螺仪与ax相关的一次项系数、D2x表示X陀螺仪与ay相关的一次项系数、D3x表示X陀螺仪与az相关的一次项系数,D4x表示X陀螺仪与
Figure BDA0002472189160000152
相关的二次项系数、D5x表示X陀螺仪与
Figure BDA0002472189160000153
相关的二次项系数、D6x表示X陀螺仪与
Figure BDA0002472189160000154
相关的二次项系数,D7x表示X陀螺仪与axay相关的交叉耦合项系数、D8x表示X陀螺仪与ayaz相关的交叉耦合项系数、D9x表示X陀螺仪与axaz相关的交叉耦合项系数,D1y表示Y陀螺仪与ax相关的一次项系数、D2y表示Y陀螺仪与ay相关的一次项系数、D3y表示Y陀螺仪与az相关的一次项系数,D4y表示Y陀螺仪与
Figure BDA0002472189160000155
相关的二次项系数、D5y表示Y陀螺仪与
Figure BDA0002472189160000156
相关的二次项系数、D6y表示Y陀螺仪与
Figure BDA0002472189160000157
相关的二次项系数,D7y表示Y陀螺仪与axay相关的交叉耦合项系数、D8y表示Y陀螺仪与ayaz相关的交叉耦合项系数、D9y表示Y陀螺仪与axaz相关的交叉耦合项系数,D1z表示Z陀螺仪与ax相关的一次项系数、D2z表示Z陀螺仪与ay相关的一次项系数、D3z表示Z陀螺仪与az相关的一次项系数,D4z表示Z陀螺仪与
Figure BDA0002472189160000161
相关的二次项系数、D5z表示Z陀螺仪与
Figure BDA0002472189160000162
相关的二次项系数、D6z表示Z陀螺仪与
Figure BDA0002472189160000163
相关的二次项系数,D7z表示Z陀螺仪与axay相关的交叉耦合项系数、D8z表示Z陀螺仪与ayaz相关的交叉耦合项系数、D9z表示Z陀螺仪与axaz相关的交叉耦合项系数。
将以上64项误差系数表示为
Figure BDA0002472189160000164
其中,m=64。
遥外测观测量序列值为弹体运动时的遥外测速度差,
Figure BDA0002472189160000165
n=36000。
速度环境函数矩阵为C=[C1 C2 … Cm]。
则制导工具误差模型为:
Y=CX
遥外测速度误差
Figure BDA0002472189160000166
如图4中虚线所示。
(2)根据遥外测速度误差
Figure BDA0002472189160000167
求解误差系数
加速度计误差系数的环境函数简化为:
Figure BDA0002472189160000168
陀螺仪误差系数的环境函数简化为:
Figure BDA0002472189160000169
采用最小二乘法,经过相关性和显著性检验后的误差模型为:
Figure BDA0002472189160000171
其中,K3x=1.8×10-6g/g3、k0y=2.6×10-4g、δK2y=2.99×10-5g/g2、Kyxz=-9.7×10-5g/g2、DFx=-0.40°/h、DFy=-0.42°/h、DFz=-0.14°/h;其余各项误差系数为零。
把上述各项误差系数代入导航算法,与外测数据求差,得到遥外测速度误差见图5,可以看出,其速度误差不为零,且有较大偏差。
(3)采用新结构矩阵后,求解新的制导工具误差系数
采用本发明给出的闭环反馈环境函数为:
Figure BDA0002472189160000172
Figure BDA0002472189160000173
构成的结构矩阵为:
Figure BDA0002472189160000174
经过相关性和显著性检验后采用最小二乘法,求得新的误差模型为:
Figure BDA0002472189160000175
其中,k′0x=3.24×10-5g、K′xxy=2.80×10-5g/g2、k′0y=1.21×10-4g、δK′2y=1.1×10-4g/g2、K′3y=-1.50×10-5g/g3、D′Fx=-0.40°/h、D′Fy=-0.42°/h、D′1z=-3.60°/h/g、D′4z=-11.24°/h/g。
(4)误差补偿
把上述各项误差系数进行补偿,并代入导航算法,与外测数据求差,得到遥外测速度误差见图6,可以看出,补偿效果较好,均值为零,提高了制导精度。
本发明虽然已以较佳实施例公开如上,但其并不是用来限定本发明,任何本领域技术人员在不脱离本发明的精神和范围内,都可以利用上述揭示的方法和技术内容对本发明技术方案做出可能的变动和修改,因此,凡是未脱离本发明技术方案的内容,依据本发明的技术实质对以上实施例所作的任何简单修改、等同变化及修饰,均属于本发明技术方案的保护范围。
本发明说明书中未作详细描述的内容属于本领域技术人员的公知技术。

Claims (7)

1.一种基于速度和位置误差闭环反馈的提高惯性制导精度的方法,其特征在于,包括:
对速度环境函数进行闭环反馈;
获取惯性制导遥外测速度误差;包括:获取导弹相对发射点地球坐标系的遥外测速度误差
Figure FDA0003455560360000011
确定遥外测速度误差
Figure FDA0003455560360000012
的序列值
Figure FDA0003455560360000013
根据飞行环境函数关系,构建制导工具误差模型;包括:根据遥外测速度误差
Figure FDA0003455560360000014
的序列值
Figure FDA0003455560360000015
确定惯性制导遥外测观测量的序列值Y;确定环境函数矩阵C;确定制导工具误差系数X;构建制导工具误差模型:Y=CX;
其中,所述制导工具误差模型满足线性关系;
根据速度环境函数,采用最小二乘法求解出制导工具误差的值;
根据求解出的制导工具误差的值,对惯性制导遥外测观测量进行补偿,以提高惯性制导精度;
其中:
Figure FDA0003455560360000016
Figure FDA0003455560360000017
Figure FDA0003455560360000018
Figure FDA0003455560360000021
其中,δvx、δvy和δvz分别表示导弹在发射点地球坐标系O-XYZ的三个轴上的速度分量;i=1,2,…N,采样间隔周期为ΔT,对应的时间ti=ΔT,2ΔT,…NΔT;xaj表示与加速度计相关的误差系数,j=1,2,…p;xgk表示陀螺仪有关的误差系数,k=1,2,…q;
Figure FDA0003455560360000022
表示从安装三个加速度计的本体坐标系至发射点地球坐标系的坐标变换矩阵,
Figure FDA0003455560360000023
表示三个加速度计的测量输出误差矢量,ωie,x、ωie,y和ωie,z分别表示ωie在发射点地球坐标系O-XYZ的三个轴上的分量,Ne表示重力加速度误差矩阵;
Figure FDA0003455560360000024
表示三个陀螺仪的测量输出误差矢量,Aφ表示姿态角误差至速度误差的环境函数矩阵,Aε表示陀螺仪误差系数至姿态角误差的环境函数矩阵;φx、φy和φz分别表示弹体相对于发射点地球坐标系的三个方向的姿态角分量。
2.根据权利要求1所述的基于速度和位置误差闭环反馈的提高惯性制导精度的方法,其特征在于,
Figure FDA0003455560360000025
Figure FDA0003455560360000026
Figure FDA0003455560360000027
3.根据权利要求1所述的基于速度和位置误差闭环反馈的提高惯性制导精度的方法,其特征在于,
Figure FDA0003455560360000028
Aφ=[Aφ1 Aφ2 Aφ3]
Figure FDA0003455560360000031
Figure FDA0003455560360000032
Figure FDA0003455560360000033
其中,ax、ay和az分别表示加速度计组合测量的三个方向的视加速度分量。
4.根据权利要求1所述的基于速度和位置误差闭环反馈的提高惯性制导精度的方法,其特征在于,
Figure FDA0003455560360000034
其中,
Figure FDA0003455560360000035
表示地心地球直角坐标系至发射点地球坐标系的变换矩阵,fM表示万有引力常数与地球质量乘积,ωie表示地球自转角速度。
5.根据权利要求1所述的基于速度和位置误差闭环反馈的提高惯性制导精度的方法,其特征在于,
Figure FDA0003455560360000036
其中,
Figure FDA0003455560360000037
表示地球自转角速度相对发射点地球坐标系的矢量,ωie表示地球自转角速度,γ0表示发射点方位角,
Figure FDA0003455560360000038
表示发射点的纬度。
6.根据权利要求1所述的基于速度和位置误差闭环反馈的提高惯性制导精度的方法,其特征在于,根据速度环境函数,采用最小二乘法求解出制导工具误差的值,包括:
根据速度环境函数,采用最小二乘法,对X=(CTC)-1CTY进行求解,得到制导工具误差的值;其中,在对X=(CTC)-1CTY的求解过程中采用显著性检验,将不显著的状态变量直接置为零。
7.根据权利要求6所述的基于速度和位置误差闭环反馈的提高惯性制导精度的方法,其特征在于,根据求解出的制导工具误差的值,对惯性制导遥外测观测量进行补偿,包括:
采用求解出的制导工具误差的值,直接对惯性制导遥外测速度观测量进行补偿:ΔY=Y-CX;其中,ΔY表示补偿后的残差。
CN202010351867.7A 2020-04-28 2020-04-28 基于速度和位置误差闭环反馈的提高惯性制导精度的方法 Active CN111637883B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202010351867.7A CN111637883B (zh) 2020-04-28 2020-04-28 基于速度和位置误差闭环反馈的提高惯性制导精度的方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202010351867.7A CN111637883B (zh) 2020-04-28 2020-04-28 基于速度和位置误差闭环反馈的提高惯性制导精度的方法

Publications (2)

Publication Number Publication Date
CN111637883A CN111637883A (zh) 2020-09-08
CN111637883B true CN111637883B (zh) 2022-04-12

Family

ID=72331925

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202010351867.7A Active CN111637883B (zh) 2020-04-28 2020-04-28 基于速度和位置误差闭环反馈的提高惯性制导精度的方法

Country Status (1)

Country Link
CN (1) CN111637883B (zh)

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113916219A (zh) * 2021-07-20 2022-01-11 北京航天控制仪器研究所 一种基于离心机激励的惯性测量系统误差分离方法
CN113865585B (zh) * 2021-09-07 2023-08-29 北京航天控制仪器研究所 一种陀螺仪组合高阶误差系数分离与补偿方法和系统

Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101033973A (zh) * 2007-04-10 2007-09-12 南京航空航天大学 微小型飞行器微惯性组合导航系统的姿态确定方法
CN101413800A (zh) * 2008-01-18 2009-04-22 南京航空航天大学 导航/稳瞄一体化系统的导航、稳瞄方法
CN103557876A (zh) * 2013-11-15 2014-02-05 山东理工大学 一种用于天线跟踪稳定平台的捷联惯导初始对准方法
CN104111663A (zh) * 2014-07-04 2014-10-22 北京航天发射技术研究所 火箭惯组目标棱镜自动准直的三维闭环反馈控制方法
CN108982918A (zh) * 2018-07-27 2018-12-11 北京航天控制仪器研究所 基准不确定情况下加速度计组合误差系数分离与标定方法
CN110186482A (zh) * 2019-06-25 2019-08-30 北京航天控制仪器研究所 一种提高惯性制导航天器的落点精度的方法
CN110186483A (zh) * 2019-06-25 2019-08-30 北京航天控制仪器研究所 提高惯性制导航天器落点精度的方法
CN110553641A (zh) * 2019-07-25 2019-12-10 北京航天控制仪器研究所 一种基于相关系数的提高惯性制导精度的方法
CN110553642A (zh) * 2019-07-26 2019-12-10 北京航天控制仪器研究所 一种提高惯性制导精度的方法

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6904377B2 (en) * 2003-03-17 2005-06-07 Northrop Grumman Corporation Method for measuring force-dependent gyroscope sensitivity
FR2866423B1 (fr) * 2004-02-13 2006-05-05 Thales Sa Dispositif de surveillance de l'integrite des informations delivrees par un systeme hybride ins/gnss

Patent Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101033973A (zh) * 2007-04-10 2007-09-12 南京航空航天大学 微小型飞行器微惯性组合导航系统的姿态确定方法
CN101413800A (zh) * 2008-01-18 2009-04-22 南京航空航天大学 导航/稳瞄一体化系统的导航、稳瞄方法
CN103557876A (zh) * 2013-11-15 2014-02-05 山东理工大学 一种用于天线跟踪稳定平台的捷联惯导初始对准方法
CN104111663A (zh) * 2014-07-04 2014-10-22 北京航天发射技术研究所 火箭惯组目标棱镜自动准直的三维闭环反馈控制方法
CN108982918A (zh) * 2018-07-27 2018-12-11 北京航天控制仪器研究所 基准不确定情况下加速度计组合误差系数分离与标定方法
CN110186482A (zh) * 2019-06-25 2019-08-30 北京航天控制仪器研究所 一种提高惯性制导航天器的落点精度的方法
CN110186483A (zh) * 2019-06-25 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
A robust data driven error damping method for inertial navigation system based on unfalsified adaptive control;Han Yongqiang 等;《2015 34th Chinese Control Conference (CCC)》;20150914;第5455-5460页 *
基于速度误差的加速度计闭环标定方法;赵桂玲 等;《测绘科学》;20161231;第41卷(第12期);第65-69页 *
种惯性测量装置火箭橇试验误差分离方法;刘璠 等;《中国惯性技术学报》;20140228;第22卷(第01期);第131-134页 *

Also Published As

Publication number Publication date
CN111637883A (zh) 2020-09-08

Similar Documents

Publication Publication Date Title
CN111623770B (zh) 一种基于速度误差开环修正的提高惯性制导精度的方法
CN113029199B (zh) 一种激光陀螺惯导系统的系统级温度误差补偿方法
Merhav Aerospace sensor systems and applications
CN109596018B (zh) 基于磁测滚转角速率信息的旋转弹飞行姿态高精度估计方法
CN111780752B (zh) 一种姿态误差可观测的提高惯性制导精度方法
KR101739390B1 (ko) 중력오차보상을 통한 관성항법장치의 자체정렬 정확도 향상기법
Chang et al. Gravity disturbance compensation for inertial navigation system
CN111780753B (zh) 一种姿态误差反馈修正的提高惯性制导精度的方法
CN103076026B (zh) 一种捷联惯导系统中确定多普勒计程仪测速误差的方法
CN111637883B (zh) 基于速度和位置误差闭环反馈的提高惯性制导精度的方法
CN109141418B (zh) 过载环境下捷联惯导数据处理装置及其多源误差建模方法
CN108592943B (zh) 一种基于opreq方法的惯性系粗对准计算方法
Xue et al. In-motion alignment algorithm for vehicle carried SINS based on odometer aiding
CN106895853B (zh) 一种电磁计程仪辅助船用陀螺罗经行进间对准方法
Yang et al. In-flight calibration of gyros and star sensor with observability analysis for SINS/CNS integration
CN114877915B (zh) 一种激光陀螺惯性测量组件g敏感性误差标定装置及方法
de Celis et al. Attitude determination algorithms through accelerometers, GNSS sensors, and gravity vector estimator
CN112284379B (zh) 一种基于非线性积分补偿的组合运动测量系统的惯性预积分方法
CN111780751A (zh) 一种信息冗余的提高惯性制导精度方法
CN110940357B (zh) 一种用于旋转惯导单轴自对准的内杆臂标定方法
Sushchenko Mathematical model of triaxial multimode attitude and heading reference system
Zhang et al. Research on auto compensation technique of strap-down inertial navigation systems
Barantsev et al. Elastic dynamic torsion of a ring laser gyroscope mechanical dither and its effect on the accuracy of attitude determination
Jiang et al. Online calibration method of gyro constant drift for low-cost integrated navigator
Chen et al. SINS/BDS Integrated Navigation for Hypersonic Boost‐Glide Vehicles in the Launch‐Centered Inertial Frame

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