CN101131311B - 一种智能化机载导弹动基座对准及标定方法 - Google Patents
一种智能化机载导弹动基座对准及标定方法 Download PDFInfo
- Publication number
- CN101131311B CN101131311B CN200710175883XA CN200710175883A CN101131311B CN 101131311 B CN101131311 B CN 101131311B CN 200710175883X A CN200710175883X A CN 200710175883XA CN 200710175883 A CN200710175883 A CN 200710175883A CN 101131311 B CN101131311 B CN 101131311B
- Authority
- CN
- China
- Prior art keywords
- inertial navigation
- sub
- omega
- missile
- theta
- 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.)
- Expired - Fee Related
Links
Images
Landscapes
- Navigation (AREA)
Abstract
本发明涉及一种智能化机载导弹动基座对准及标定方法,其特征是针对在动基座条件下捷联惯性导航系统模型的时变性特点,给出了一种适用于动基座对准和标定的神经网络输入输出样本构造方法,同时,为了解决导弹悬挂在机翼下与自由飞行时子惯导系统量测信息不一致问题,通过在神经网络训练前首先进行主子惯导之间误差角的估计及补偿,从而使网络训练样本可真实的模拟导弹实际自由飞行时的状态。本发明具有快速性及智能化的优点,可用于提高机载、舰载及车载导弹武器的导航精度。
Description
技术领域
本发明涉及一种智能化机载导弹动基座对准及标定方法,可用于提高机载、舰载及车载导弹武器的导航精度。
背景技术
初始对准误差是惯性导航系统(INS)的主要误差源之一,初始对准精度和速度直接关系到武器系统的打击命中精度及快速反应能力。通常,卡尔曼滤波用于解决INS的初始对准问题,它可以从被噪声污染的观测值中估计出系统的状态值。然而由于卡尔曼滤波器的运算时间与系统阶次的三次方成正比,所以当系统阶次较高时,滤波器的实时性就很难保证。虽然采用分布式卡尔曼滤波器可以提高滤波的实时性,但其代数结构复杂,且对系统构成有所限制。
考虑到神经网络具有自学习功能和可以逼近任何非线性函数的能力,以及神经网络处理数据的快速性和并行性特点。因此,人们希望利用神经网络代替卡尔曼滤波器的功能,以提高INS对准过程的实时性及智能化。近年来,研究人员在此方面进行了相应的研究工作,利用不同的神经网络算法代替卡尔曼滤波器,以实现INS静基座初始对准的实时性问题。然而,到目前为止,涉及研究如何利用神经网络实现动基座对准问题的文献却极少。这是由于在静基座对准时,INS可以看作为定常系统,而BP等神经网络实际上是静态网络,它所能完成的功能只是从一个空间到另一个空间的映射。因此,神经网络用预先取得的卡尔曼滤波估值及相应的观测值进行训练,当网络输出与样本值间的误差在允许范围之内时,就可以用此神经网络独立对系统进行精确估值并补偿,从而达到INS在静基座条件下的快速对准及标定的目的。但在动基座条件下,由于这时位置、速度、姿态等导航参数都将随时间变化,系统模型是时变的。这时如果直接利用卡尔曼滤波的测量值和滤波结果作为输入输出样本来训练神经网络,由于导弹随载机飞行网络训练所用样本与导弹自由飞行时实际应用样本之间不一致,因此基于静基座对准及标定条件构造及训练的网络将无法应用于动基座情况。
发明内容
本发明的技术解决问题是:克服现有技术的不足,提供一种智能化机载导弹动基座对准及标定方法,该方法提高了机载导弹武器INS动基座初始对准和标定的速度,并具有智能化的特点。
本发明的技术解决方案为:一种智能化机载导弹动基座对准及标定方法,其特点在于包括下列步骤:
(1)根据分析主惯导和子惯导之间的安装误差角、弹性变形角和弹性变形角速率误差特性,建立主惯导和子惯导之间误差的系统状态方程和量测方程;
(2)在构造神经网络输入输出样本时,选择将弹载子惯导陀螺仪和加速度计的输出值作为输入样本,机载主惯导陀螺仪和加速度计的输出值与输入样本之间的差值作为输出样本,训练神经网络;
(3)在导弹的自由飞行阶段,将弹载子惯导的陀螺仪和加速度计的测量值实时输入神经网络滤波器,通过神经网络滤波器进行对准和标定后能够消除陀螺仪和加速度计测量值中由确定性误差和失准角引起的测量误差;
(4)最后将校正后的陀螺仪和加速度计的测量值送入导航计算机,完成导航参数的解算。
所述步骤(1)中建立的主惯导和子惯导之间误差状态方程为
其中,Ψx,Ψy,Ψz、θx,θy,θz和分别为主、子惯导之间安装误差角、弹性变形角和弹性变形角速率的分量。βi=2.146/τi(i=x,y,z),τi为相应轴向的弹性变形相关时间,ρx,ρy,ρz为具有一定方差的白噪声。
上述的建立的主惯导和子惯导之间误差源的量测方程为
Z=HX+V
其中,观测矩阵
V=[v1 v2 v3]T为零均值的白噪声。
所述的步骤(2)构造的神经网络输入输出样本方法为一种适用于动基座对准和标定的神经网络样本构造方法,该方法的具体步骤为:
(4)主惯导和子惯导安装距离r已知,利用主惯导陀螺仪的输出值ωib m,可求出杆臂效应误差fr s;然后,进一步对子惯导加速度计的测量值fb s进行杆臂效应误差补偿,得到补偿后子惯导加速度计的测量值fb tr;
(5)通过对子惯导陀螺仪和加速度计输出值进行补偿,再利用ωib tr,fb tr作为输入样本,主惯导陀螺仪和加速度计的输出值ωib m、fb m与神经网络输入样本ωib tr、fb tr之间的差值δω,δf作为输出样本,对神经网络滤波器进行训练。
本发明的原理是:由于在动基座条件下,这时机载导弹子惯导系统的位置、速度、姿态等参数都将随时间变化,系统模型是时变的。因此,如果使用同静基座对准及标定时神经网络样本对的构造办法,利用预先取得的卡尔曼滤波估值及相应的观测值进行神经网络训练,但当网络训练好后,实际应用时所采集的样本已发生变化,训练的网络将无法应用。因此,在构造动基座对准的神经网络输入输出样本时,需要使用一种不同于静基座的构造办法。
通过分析可以发现,无论导弹随载机飞行还是导弹自由飞行阶段,虽然位置、速度、姿态等导航参数随时间变化,但子惯导陀螺仪和加速度计的特性是不变的。因此,在构造神经网络输入输出样本时,选择将弹载子惯导陀螺仪和加速度计的输出值作为输入样本,机载主惯导陀螺仪和加速度计的输出值与输入样本之间的差值作为输出样本,训练神经网络。而在具体构造输入样本时,考虑到导弹悬挂在载机机翼处时,输入样本中包含着由安装误差、杆臂效应误差和弹性变形误差引起的测量误差,这与导弹自由飞行时子惯导陀螺仪和加速度计的感测量还不一致。为解决这一问题,可根据主-子惯导之间的安装误差角、弹性变形角和弹性变形角速率的误差模型,采用主、子惯导陀螺仪输出值之差作为观测量,由卡尔曼滤波器首先估计出弹载子惯导的安装误差角及弹性变形角速率,并根据杆臂长度和主惯导陀螺仪的输出值计算杆臂效应误差。然后根据主、子惯导陀螺仪和加速度计输出值之间的转换关系,补偿弹载子惯导陀螺仪和加速度计测量值中的相应误差,这时得到的训练输入样本能够真实的模拟导弹自由飞行时的情况。在导弹发射后的自由飞行段,将弹载子惯导的陀螺仪和加速度计的测量值实时输入神经网络滤波器,通过神经网络滤波器进行对准和标定后能够消除陀螺仪和加速度计测量值中由确定性误差(刻度因数、零偏等)和失准角引起的测量误差。最后将校正后的陀螺仪和加速度计的测量值送入导航计算机,完成导航参数的解算。
本发明与现有技术相比的优点在于:本发明利用无论导弹随载机飞行还是导弹自由飞行阶段,虽然位置、速度、姿态等导航参数随时间变化,但子惯导陀螺仪和加速度计的特性不变的特点,作为构造神经网络的出发点;根据主-子惯导之间的误差模型,采用主-子惯导陀螺仪输出值之差作为观测量,由卡尔曼滤波器首先估计出弹载子惯导的安装误差角及弹性变形角速率,并根据杆臂长度和主惯导陀螺仪的输出值计算杆臂效应误差。然后根据主-子惯导陀螺仪和加速度计输出值之间的转换关系,补偿弹载子惯导陀螺仪和加速度计测量值中的相应误差,这时得到的训练输入样本能够真实的模拟导弹自由飞行时的情况;在导弹的自由飞行阶段,将弹载子惯导的陀螺仪和加速度计的测量值实时输入神经网络滤波器,通过神经网络滤波器进行对准和标定后能够消除陀螺仪和加速度计测量值中由确定性误差和失准角所引起的测量误差,从而提高了对陀螺仪和加速度计测量值的补偿的实时性和精确性提高了导航参数的解算精度。
附图说明
图1为本发明的主-子惯导测量的角速度关系示意图;
图2为本发明的卡尔曼滤波基本算法的解算流程图;
图3为本发明的所构造的神经网络输入输出样本原理框图;
图4为本发明的利用神经网络进行智能化初始对准和标定的原理图。
具体实施方式
如图1、2、3、4所示,本发明的具体方法如下:
(1)主、子惯导之间误差源数学模型的建立,包括系统状态方程和量测方程,分别如式1和式4所示。
系统状态方程:
其中,X为系统状态矢量,W为系统噪声矢量,A为系统转移矩阵,
σi 2(i=x,y,z)为子惯导三个方向上弹性变形角的方差。
系统的量测方程
由主、子惯导的陀螺仪输出值的差值构造的观测量为
式中,[ωibx m ωiby m ωibz m]T,[ωibx s ωiby s ωibz s]T分别为主、子惯导陀螺仪测量的三个轴方向的角速度。
如图1所示,子惯导陀螺仪测量的角速度ωib s是由主惯导陀螺仪测量的角速度ωib m旋转一个(Ψ+θ)角得到的,这里假设(Ψ+θ)为小角度,另外,由于机翼的弹性变形,弹载子惯导陀螺仪会测量到附加的角速度有
式中,
则
故滤波器的量测方程为:
Z=HX+V (4)
状态一步预测方程
状态估值计算方程
滤波增量方程
一步预测均方误差方程
估计均方误差方程
(3)神经网络输入输出样本的构造。不同于静基座情况,由于在动基座条件下,这时弹载子惯导系统的位置、速度、姿态等参数都将随时间变化,系统模型是时变的。因此,如果使用同静基座对准及标定时神经网络样本对的构造办法来训练动基座标定网络,当弹载子惯导随载机飞行时网络训练好后,但导弹发射后自由飞行阶段对弹载子惯导进行标定时,网络所采集的输入样本已发生根本变化,这种方法构造和训练的网络将无法应用。因此,在构造适用于动基座标定的神经网络输入输出样本时,需要使用一种不同于静基座对准和标定的构造方法。
通过分析可以发现,无论导弹随载机飞行还是导弹自由飞行阶段,虽然位置、速度、姿态等导航参数随时间变化,但子惯导陀螺仪和加速度计的特性是不变的。因此,在构造神经网络输入输出样本时,选择将弹载子惯导陀螺仪和加速度计的输出值作为输入样本,机载主惯导陀螺仪和加速度计的输出值与输入样本之间的差值作为输出样本,训练神经网络。而在具体构造输入样本时,考虑到导弹悬挂在载机机翼处时,输入样本中包含着由安装误差、杆臂效应误差和弹性变形误差引起的测量误差,这与导弹自由飞行时子惯导陀螺仪和加速度计的感测量还不一致。为解决这一问题,根据主-子惯导之间的安装误差角、弹性变形角和弹性变形角速率的误差模型,采用主、子惯导陀螺仪输出值之差作为观测量,由卡尔曼滤波器首先估计出弹载子惯导的安装误差角及弹性变形角速率,并根据杆臂长度和主惯导陀螺仪的输出值计算杆臂效应误差。然后根据主、子惯导陀螺仪和加速度计输出值之间的转换关系,补偿弹载子惯导陀螺仪和加速度计测量值中的相应误差,这时得到的训练输入样本能够真实的模拟导弹自由飞行时的情况。在导弹发射后的自由飞行段,将弹载子惯导的陀螺仪和加速度计的测量值实时输入神经网络滤波器,通过神经网络滤波器进行标定后能够消除陀螺仪和加速度计测量值中由确定性误差(刻度因数、零偏等)和失准角引起的测量误差。最后将校正后的陀螺仪和加速度计的测量值送入导航计算机,完成导航参数的解算。这样,建立的空射导弹自由飞行阶段自动标定的神经网络输入输出样本对构造原理如图3所示。
具体构造方法如下:
d.主-子惯导之间安装距离r已知,利用主惯导陀螺仪的输出值ωib m,可求出杆臂效应误差fr s
然后,进一步对子惯导加速度计的测量值fb s进行杆臂效应误差补偿,得到补偿后子惯导加速度计的测量值fb tr为
e.通过对子惯导陀螺仪和加速度计输出值进行补偿,再利用ωib tr,fb tr作为输入样本,主惯导陀螺仪和加速度计的输出值ωib m、fb m与神经网络输入样本ωib tr、fb tr之间的差值δω,δf作为输出样本,对神经网络滤波器进行训练。
(4)导弹随载机飞行阶段利用构造的输入输出样本对神经网络进行训练,导弹自由飞行时即可利用训练好的网络完成对弹载子惯导系统的自动标定,工作原理如图4所示。
导弹自由飞行时,将子惯导陀螺仪、加速度计的输出值ωib s、fb s送入训练好的神经网络,这时神经网络的输出为子惯导陀螺仪和加速度计的测量误差δωt、δft,再利用δω′、δf′对子惯导的测量值ωib s、fb s进行修正,即
然后,将ωN,fN送入导航计算机,即可得到补偿后导弹精确的速度、位置和姿态角等导航信息。
Claims (3)
1.一种智能化机载导弹动基座对准及标定方法,其特征在于步骤如下:
(1)根据主惯导和子惯导之间的安装误差角、弹性变形角和弹性变形角速率误差特性,建立主惯导和子惯导之间误差的系统状态方程和量测方程;
(2)在构造神经网络输入输出样本时,选择将弹载子惯导陀螺仪和加速度计的输出值作为输入样本,机载主惯导陀螺仪和加速度计的输出值与输入样本之间的差值作为输出样本,训练神经网络;
(3)在导弹的自由飞行阶段,将弹载子惯导的陀螺仪和加速度计的测量值实时输入神经网络滤波器,通过神经网络滤波器进行对准和标定后能够消除弹载子惯导陀螺仪和加速度计测量值中由确定性误差和失准角引起的测量误差;
(4)最后将校正后的弹载子惯导陀螺仪和加速度计的测量值送入导航计算机,完成导航参数的解算。
2.根据权利要求1所述的智能化机载导弹动基座对准及标定方法,其特征在于:步骤(1)建立主惯导和子惯导之间误差的系统状态方程和量测方程如下:
(1)主惯导和子惯导之间误差状态方程为
其中,Ψx,Ψy,Ψz、θx,θy,θz和分别为主惯导和子惯导之间安装误差角、弹性变形角和弹性变形角速率的分量,和分别为机载主惯导与弹载子惯导之间安装误差角速率和弹性变形角加速度的分量,βi=2.146/τi(i=x,y,z),τi为相应轴向的弹性变形相关时间,ρx,ρy,ρz为具有一定方差的白噪声;
(2)由主惯导和子惯导陀螺仪输出值之差构造的观测量,得到主惯导和子惯导之间误差源的观测模型为
Z=HX+V
其中,观测矩阵
V=[v1 v2 v3]T为零均值的白噪声,v1,v2,v3分别为X、Y和Z三个坐标轴上的零均值白噪声分量;ωibx m,ωiby m,ωibz m分别代表主惯导陀螺仪和加速度计在X、Y和Z三个坐标轴的输出分量。
3.根据权利要求1所述的智能化机载导弹动基座对准及标定方法,其特征在于:所述步骤(2)构造的神经网络输入输出样本方法为一种适用于动基座对准和标定的神经网络样本构造方法,具体步骤为:
(4)主惯导和子惯导安装距离r已知,利用主惯导陀螺仪的输出值ωib m,可求出杆臂效应误差fr s;然后,进一步对子惯导加速度计的测量值fb s进行杆臂效应误差补偿,得到补偿后子惯导加速度计的测量值fb tr;
(5)通过对子惯导陀螺仪和加速度计输出值进行补偿,再利用ωib tr,fb tr作为输入样本,主惯导陀螺仪和加速度计的输出值ωib m、fb m与神经网络输入样本ωib tr、fb tr之间的差值δω,δf作为输出样本,对神经网络滤波器进行训练。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN200710175883XA CN101131311B (zh) | 2007-10-15 | 2007-10-15 | 一种智能化机载导弹动基座对准及标定方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN200710175883XA CN101131311B (zh) | 2007-10-15 | 2007-10-15 | 一种智能化机载导弹动基座对准及标定方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN101131311A CN101131311A (zh) | 2008-02-27 |
CN101131311B true CN101131311B (zh) | 2010-04-21 |
Family
ID=39128665
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN200710175883XA Expired - Fee Related CN101131311B (zh) | 2007-10-15 | 2007-10-15 | 一种智能化机载导弹动基座对准及标定方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN101131311B (zh) |
Families Citing this family (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102060105B (zh) * | 2010-11-23 | 2012-12-26 | 中国兵器工业第二〇五研究所 | 带倾斜补偿的航向校准装置 |
CN103363989B (zh) * | 2012-04-09 | 2017-01-18 | 北京自动化控制设备研究所 | 一种捷联惯导系统内杆臂的估计与误差补偿方法 |
CN103226022B (zh) * | 2013-03-27 | 2015-08-12 | 清华大学 | 用于组合导航系统的动基座对准方法及系统 |
CN105066794B (zh) * | 2015-07-30 | 2016-08-17 | 中国科学院长春光学精密机械与物理研究所 | 一种机载小型导弹导航、制导与控制一体化系统 |
CN106546261B (zh) * | 2016-09-20 | 2019-08-23 | 捷开通讯(深圳)有限公司 | 一种基于虚拟现实设备的角度数据补偿方法及装置 |
CN106379559B (zh) * | 2016-09-29 | 2019-08-20 | 湖北航天技术研究院总体设计所 | 一种适用于导弹机载发射的过渡导航方法 |
CN106767900B (zh) * | 2016-11-23 | 2020-01-03 | 东南大学 | 一种基于组合导航技术的船用光纤捷联惯导系统的在线标定方法 |
CN106979780B (zh) * | 2017-05-22 | 2019-06-14 | 江苏亘德科技有限公司 | 一种无人车实时姿态测量方法 |
CN107703774A (zh) * | 2017-09-12 | 2018-02-16 | 江西洪都航空工业集团有限责任公司 | 一种机载武器动基座传递对准仿真方法 |
CN109460075B (zh) * | 2018-11-01 | 2021-10-01 | 湖北航天技术研究院总体设计所 | 一种快速方位角对准的方法及系统 |
CN110109164B (zh) * | 2019-04-24 | 2020-11-03 | 湖北三江航天万峰科技发展有限公司 | 车载方位角传递对准装置与方法 |
CN111238532B (zh) * | 2019-12-23 | 2022-02-01 | 湖北航天技术研究院总体设计所 | 一种适用于晃动基座环境的惯性测量单元标定方法 |
CN111678538B (zh) * | 2020-07-29 | 2023-06-09 | 中国电子科技集团公司第二十六研究所 | 一种基于速度匹配的动态水平仪误差补偿方法 |
CN114098632B (zh) * | 2022-01-27 | 2022-11-29 | 北京鹰瞳科技发展股份有限公司 | 用于对眼底相机中的马达进行控制的方法及其相关产品 |
Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6215115B1 (en) * | 1998-11-12 | 2001-04-10 | Raytheon Company | Accurate target detection system for compensating detector background levels and changes in signal environments |
-
2007
- 2007-10-15 CN CN200710175883XA patent/CN101131311B/zh not_active Expired - Fee Related
Patent Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6215115B1 (en) * | 1998-11-12 | 2001-04-10 | Raytheon Company | Accurate target detection system for compensating detector background levels and changes in signal environments |
Non-Patent Citations (2)
Title |
---|
王新龙,李志宇.捷联惯导系统在运动基座上的建模及误差传播特性研究.宇航学报第27卷 第6期.2006,第27卷(第6期),第2621,3621,4621,5621页. |
王新龙,李志宇.捷联惯导系统在运动基座上的建模及误差传播特性研究.宇航学报第27卷 第6期.2006,第27卷(第6期),第2621,3621,4621,5621页. * |
Also Published As
Publication number | Publication date |
---|---|
CN101131311A (zh) | 2008-02-27 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN101131311B (zh) | 一种智能化机载导弹动基座对准及标定方法 | |
CN108226980B (zh) | 基于惯性测量单元的差分gnss与ins自适应紧耦合导航方法 | |
CN103913181B (zh) | 一种基于参数辨识的机载分布式pos传递对准方法 | |
CN104344836B (zh) | 一种基于姿态观测的冗余惯导系统光纤陀螺系统级标定方法 | |
CN104344837B (zh) | 一种基于速度观测的冗余惯导系统加速度计系统级标定方法 | |
CN102706366B (zh) | 一种基于地球自转角速率约束的sins初始对准方法 | |
CN107655472B (zh) | 一种基于深度学习的高精度惯性导航设备误差补偿方法 | |
CN201876683U (zh) | 水下航行器组合导航与控制半实物仿真试验系统 | |
CN106772524B (zh) | 一种基于秩滤波的农业机器人组合导航信息融合方法 | |
CN104019828A (zh) | 高动态环境下惯性导航系统杆臂效应误差在线标定方法 | |
CN103808331A (zh) | 一种mems三轴陀螺仪误差标定方法 | |
CN101706284A (zh) | 提高船用光纤陀螺捷联惯导系统定位精度的方法 | |
CN102252677A (zh) | 一种基于时间序列分析的变比例自适应联邦滤波方法 | |
CN102486377A (zh) | 一种光纤陀螺捷联惯导系统初始航向的姿态获取方法 | |
CN107289942B (zh) | 一种用于编队飞行的相对导航系统及方法 | |
CN106940193A (zh) | 一种基于Kalman滤波的船舶自适应摇摆标定方法 | |
CN102162733A (zh) | 一种基于svm的auv舰位推算导航误差实时修正方法 | |
CN103852085A (zh) | 一种基于最小二乘拟合的光纤捷联惯导系统现场标定方法 | |
CN105241456A (zh) | 巡飞弹高精度组合导航方法 | |
CN103674064A (zh) | 捷联惯性导航系统的初始标定方法 | |
CN104050389A (zh) | 一种实时在线评估导航系统精确度和完好性的方法 | |
CN105136166A (zh) | 一种指定惯导位置精度的捷联惯导误差模型仿真方法 | |
CN103438890A (zh) | 基于tds与图像测量的行星动力下降段导航方法 | |
CN107727061A (zh) | 一种自主气象改正的光电测距系统及方法 | |
CN101929862A (zh) | 基于卡尔曼滤波的惯性导航系统初始姿态确定方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
C17 | Cessation of patent right | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20100421 Termination date: 20121015 |