CN111504310B - 一种新的弹载ins/cns组合导航系统建模方法 - Google Patents

一种新的弹载ins/cns组合导航系统建模方法 Download PDF

Info

Publication number
CN111504310B
CN111504310B CN202010361402.XA CN202010361402A CN111504310B CN 111504310 B CN111504310 B CN 111504310B CN 202010361402 A CN202010361402 A CN 202010361402A CN 111504310 B CN111504310 B CN 111504310B
Authority
CN
China
Prior art keywords
borne
ins
missile
navigation system
integrated navigation
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
CN202010361402.XA
Other languages
English (en)
Other versions
CN111504310A (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.)
Southeast University
Original Assignee
Southeast University
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 Southeast University filed Critical Southeast University
Priority to CN202010361402.XA priority Critical patent/CN111504310B/zh
Publication of CN111504310A publication Critical patent/CN111504310A/zh
Application granted granted Critical
Publication of CN111504310B publication Critical patent/CN111504310B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12—Navigation; 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/16—Navigation; 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
    • G01C21/165—Navigation; 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 combined with non-inertial navigation instruments
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/02—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by astronomical means
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/20—Instruments for performing navigational calculations

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)
  • Aiming, Guidance, Guns With A Light Source, Armor, Camouflage, And Targets (AREA)
  • Navigation (AREA)

Abstract

本发明公开了一种新的弹载INS/CNS组合导航系统建模方法。本发明针对星敏感器低频误差影响弹载导航系统姿态确定精度的问题，首先将星敏感器低频误差引起的姿态误差建模为一阶高斯‑马尔可夫过程，然后将其扩充为状态量，推导一种新的弹载INS/CNS组合导航系统状态方程和量测方程。本发明的有益效果在于：在本发明提出的弹载INS/CNS组合导航系统建模方法基础上，使用卡尔曼滤波方法可以进一步提高弹载INS/CNS组合导航系统的定姿精度。

Description

一种新的弹载INS/CNS组合导航系统建模方法
技术领域
本发明涉及一种系统建模方法，具体涉及一种新的弹载INS/CNS组合导航系统建模方法。
背景技术
在导弹的INS/CNS组合导航系统中，星敏感器是CNS的重要组成部分。近年来，随着星敏感器制造工艺的不断提升，其精度也不断提升。但实际运行结果与地面测试结果有较大出入，这主要是由于星敏感器热结构形变相关的低频误差造成的，低频误差目前已经成为制约星敏感器数据精度的重要误差之一，尤其是导弹等高空飞行器的导航系统对星敏感器的低频误差要求越来越严格。弹载INS/CNS组合导航系统的姿态精度主要依赖于星敏感器的精度。传统的弹载INS/CNS组合导航系统模型未考虑星敏感器低频误差的影响，很难直接利用卡尔曼滤波消除星敏感器低频误差。在存在星敏感器低频误差的情况下，将会导致弹载INS/CNS组合导航系统导航精度降低。
所以，为了减小星敏感器低频误差对弹载INS/CNS组合导航系统导航精度的影响，我们将星敏感器低频误差引起的姿态误差建模为一阶高斯-马尔可夫过程并引入到系统模型状态量中，提出了一种新的弹载INS/CNS组合导航系统建模方法来解决上述问题。
发明内容
发明目的：为了克服现有技术中存在的在星敏感器含有低频误差情况下弹载INS/CNS组合导航系统定姿精度差的不足，提供一种新的弹载INS/CNS组合导航系统建模方法，其实现在星敏感器含有低频误差情况下弹载INS/CNS组合导航系统通过卡尔曼滤波对星敏感器输出的姿态校正后可获得较高的定姿态精度。
技术方案：本发明提供一种新的弹载INS/CNS组合导航系统建模方法，包括以下步骤：
(1)将星敏感器低频误差引起的姿态误差θ建模为一阶高斯-马尔可夫过程。
(2)将星敏感器低频误差引起的姿态误差θ扩充为状态量，推导出新的弹载 INS/CNS组合导航系统状态方程和量测方程。
进一步的，所述步骤(1)中星敏感器低频误差引起的姿态误差θ建模为一阶高斯-马尔可夫过程的具体步骤如下：
θ满足下列方程：
Figure BDA0002475193780000011
其中，β＝1/τ表示逆马尔可夫时间常数，u(t)表示高斯白噪声。
将上式进行离散化，可得：
θi+1＝ψiθi+ui
Figure BDA0002475193780000021
E[u(t1)uT(t2)]＝q(t1)δ(t1-t2)
其中，
Figure BDA0002475193780000022
ti＝ti+1-ti，I表示3×3的单位矩阵，E(·)表示求均值运算，δ(·)表示狄拉克函数。
假定光谱密度q(t)为常数。令p为θ(t)的方差，取p为常数且满足p＝σ2 corrI，σ2 corr表示星敏感器噪声方差项。当方差恒定不变时，存在q＝2βp。因此，qi的表达式可重写为：
Figure BDA0002475193780000023
进一步的，所述步骤(2)推导新的弹载INS/CNS组合导航系统状态方程和量测方程的具体过程如下：
传统的弹载INS/CNS组合导航系统的系统模型如下：
xi+1＝Φixi+wi
zi+1＝Hi+1xi+1+vi+1
其中，xi表示15维的状态量且xi＝[φ δV δr Ξ Θ]；φ＝[φx φy φz]表示失准角；δV＝[δvx δvy δvz]表示速度误差；δr＝[δx δy δz]表示位置误差；Ξ＝[Ξx Ξy Ξz] 和Θ＝[Θx Θy Θz]分别表示陀螺常值漂移和加速度计常值偏置，wi和vi+1分别表示系统噪声和量测噪声，Hi+1表示系统的观测矩阵。
传统的弹载INS/CNS组合导航系统的系统模型的协方差传递方程为：
Figure BDA0002475193780000024
其中，Qi表示系统噪声方差阵。
将星敏感器低频误差引起的姿态误差θ扩充为系统模型的状态量，则扩维后的系统状态量为：
Figure BDA0002475193780000025
则扩维后的系统状态方程及其协方差可表示为：
Figure BDA0002475193780000031
Figure BDA0002475193780000032
其中，
Figure BDA0002475193780000033
基于扩维后的系统状态量，相应的弹载INS/CNS组合导航系统的量测方程可写为：
Figure BDA0002475193780000034
有益效果：本发明与现有技术相比，本发明将星敏感器低频误差引起的姿态误差建模为一阶高斯-马尔可夫过程，然后将其引入到弹载INS/CNS组合导航系统模型的状态量中，提出一种新的弹载INS/CNS组合导航系统建模方法，在此基础上通过卡尔曼滤波，可直接消除星敏感器低频误差对弹载INS/CNS组合导航系统定姿精度的影响。
附图说明
图1为本发明方法的流程图。
具体实施方式
下面结合附图和具体实施例，进一步阐明本发明。
如图1所示，本发明提供一种新的弹载INS/CNS组合导航系统建模方法，包括以下步骤：
(1)将星敏感器低频误差引起的姿态误差θ建模为一阶高斯-马尔可夫过程。
θ满足下列方程：
Figure BDA0002475193780000035
其中，β＝1/τ表示逆马尔可夫时间常数，u(t)表示高斯白噪声。
将公式(1)进行离散化，可得：
θi+1＝ψiθi+ui (2)
Figure BDA0002475193780000036
E[u(t1)uT(t2)]＝q(t1)δ(t1-t2) (4)
其中，
Figure BDA0002475193780000037
ti＝ti+1-ti，I表示3×3的单位矩阵，E(·)表示求均值运算，δ(·)表示狄拉克函数。
假定光谱密度q(t)为常数。令p为θ(t)的方差，取p为常数且满足p＝σ2 corrI，σ2 corr表示星敏感器噪声方差项。当方差恒定不变时，存在q＝2βp。因此，公式(3)可重写为：
Figure BDA0002475193780000041
(2)将星敏感器低频误差引起的姿态误差θ扩充为状态量，推导出新的弹载 INS/CNS组合导航系统状态方程和量测方程。
传统的弹载INS/CNS组合导航系统的系统模型如下：
xi+1＝Φixi+wi (6)
zi+1＝Hi+1xi+1+vi+1 (7)
其中，xi表示15维的状态量且xi＝[φ δV δr Ξ Θ]；φ＝[φx φy φz]表示失准角；δV＝[δvx δvy δvz]表示速度误差；δr＝[δx δy δz]表示位置误差；Ξ＝[Ξx Ξy Ξz] 和Θ＝[Θx Θy Θz]分别表示陀螺常值漂移和加速度计常值偏置，wi和vi+1分别表示系统噪声和量测噪声，Hi+1表示系统的观测矩阵。
传统的弹载INS/CNS组合导航系统的系统模型的协方差传递方程为：
Figure BDA0002475193780000042
其中，Qi表示系统噪声方差阵。
将星敏感器低频误差引起的姿态误差θ扩充为系统模型的状态量，则扩维后的系统状态量为：
Figure BDA0002475193780000043
则扩维后的系统状态方程及其协方差可表示为：
Figure BDA0002475193780000044
Figure BDA0002475193780000045
其中，
Figure BDA0002475193780000046
基于扩维后的系统状态量，相应的弹载INS/CNS组合导航系统的量测方程可写为：
Figure BDA0002475193780000051
。

Claims (1)

1.一种新的弹载INS/CNS组合导航系统建模方法，其特征在于，包括下列步骤：
(1)将星敏感器低频误差引起的姿态误差θ建模为一阶高斯-马尔可夫过程；
(2)将星敏感器低频误差引起的姿态误差θ扩充为状态量，推导出新的弹载INS/CNS组合导航系统状态方程和量测方程；
步骤(1)包括：
θ满足下列方程：
Figure FDA0003922307290000011
其中，β＝1/τ表示逆马尔可夫时间常数，u(t)表示高斯白噪声；
将上式进行离散化，得：
θi+1＝ψiθi+ui
Figure FDA0003922307290000012
E[u(t1)uT(t2)]＝q(t1)δ(t1-t2)
其中，
Figure FDA0003922307290000013
Vti＝ti+1-ti，I表示3×3的单位矩阵，E(·)表示求均值运算，δ(·)表示狄拉克函数；
假定光谱密度q(t)为常数；令p为θ(t)的方差，取p为常数且满足p＝σ2 corrI，σ2 corr表示星敏感器噪声方差项；当方差恒定不变时，存在q＝2βp；因此，qi的表达式重写为：
Figure FDA0003922307290000014
步骤(2)包括：
传统的弹载INS/CNS组合导航系统的系统模型如下：
xi+1＝Φixi+wi
zi+1＝Hi+1xi+1+vi+1
其中，xi表示15维的状态量且xi＝[φ δV δr Ξ Θ]；φ＝[φx φy φz]表示失准角；δV＝[δvx δvy δvz]表示速度误差；δr＝[δx δy δz]表示位置误差；Ξ＝[Ξx Ξy Ξz]和Θ＝[ΘxΘy Θz]分别表示陀螺常值漂移和加速度计常值偏置，wi和vi+1分别表示系统噪声和量测噪声，Hi+1表示系统的观测矩阵；
传统的弹载INS/CNS组合导航系统的系统模型的协方差传递方程为：
Figure FDA0003922307290000021
其中，Qi表示系统噪声方差阵；
将星敏感器低频误差引起的姿态误差θ扩充为系统模型的状态量，则扩维后的系统状态量为：
Figure FDA0003922307290000022
则扩维后的系统状态方程及其协方差表示为：
Figure FDA0003922307290000023
Figure FDA0003922307290000024
其中，
Figure FDA0003922307290000025
基于扩维后的系统状态量，新的弹载INS/CNS组合导航系统的量测方程为：
Figure FDA0003922307290000026
CN202010361402.XA 2020-04-30 2020-04-30 一种新的弹载ins/cns组合导航系统建模方法 Active CN111504310B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202010361402.XA CN111504310B (zh) 2020-04-30 2020-04-30 一种新的弹载ins/cns组合导航系统建模方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202010361402.XA CN111504310B (zh) 2020-04-30 2020-04-30 一种新的弹载ins/cns组合导航系统建模方法

Publications (2)

Publication Number Publication Date
CN111504310A CN111504310A (zh) 2020-08-07
CN111504310B true CN111504310B (zh) 2022-12-27

Family

ID=71875092

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202010361402.XA Active CN111504310B (zh) 2020-04-30 2020-04-30 一种新的弹载ins/cns组合导航系统建模方法

Country Status (1)

Country Link
CN (1) CN111504310B (zh)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113432608B (zh) * 2021-02-03 2024-06-07 东南大学 用于ins/cns组合导航系统的基于最大相关熵的广义高阶ckf方法

Family Cites Families (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS6027870A (ja) * 1983-07-26 1985-02-12 Nec Corp スタ−センサにおけるデ−タ処理装置
US20090177398A1 (en) * 2008-01-08 2009-07-09 Trex Enterprises Corp. Angles only navigation system
CN100476360C (zh) * 2006-12-27 2009-04-08 北京航空航天大学 一种基于星敏感器标定的深综合组合导航方法
DE102013108711B4 (de) * 2013-08-12 2016-07-14 Jena-Optronik Gmbh Verfahren zum Betrieb eines Lage- und Orbit-Steuersystems und Lage- und Orbit-Steuersystem
CN104280049B (zh) * 2014-10-20 2017-04-05 北京控制工程研究所 一种高精度星敏感器外场精度测试方法
CN106289238B (zh) * 2016-08-02 2019-02-26 哈尔滨工业大学 一种星敏感器数据优化处理方法
CN108332775A (zh) * 2017-12-26 2018-07-27 中国人民解放军国防科技大学 提高星敏感器姿态测量精度的方法
CN108827310B (zh) * 2018-07-12 2021-07-23 哈尔滨工程大学 一种船用星敏感器辅助陀螺仪在线标定方法
CN111060097B (zh) * 2020-01-15 2022-03-11 东南大学 一种提高位置误差估计精度的惯性/天文组合导航方法

Also Published As

Publication number Publication date
CN111504310A (zh) 2020-08-07

Similar Documents

Publication Publication Date Title
JP3947531B2 (ja) 加速度誤差の補正方法及び装置、並びにそれを利用した慣性航法システム
CN110398257A (zh) Gps辅助的sins系统快速动基座初始对准方法
CN112050809B (zh) 轮式里程计与陀螺仪信息融合的无人车定向定位方法
CN105300381B (zh) 一种基于改进互补滤波的自平衡移动机器人姿态快速收敛方法
CN104034329B (zh) 采用发射惯性系下的多组合导航处理装置的导航方法
CN106767900A (zh) 一种基于组合导航技术的船用光纤捷联惯导系统的在线标定方法
CN108196532A (zh) 一种基于非线性自适应观测器的无人机纵向飞行控制系统故障检测与分离方法
CN109612460B (zh) 一种基于静止修正的垂线偏差测量方法
WO2020233290A1 (zh) 一种动态变形下基于双重滤波器的传递对准方法
CN111238535A (zh) 一种基于因子图的imu误差在线标定方法
CN111504310B (zh) 一种新的弹载ins/cns组合导航系统建模方法
CN108332756B (zh) 一种基于拓扑信息的水下航行器协同定位方法
CN104359496A (zh) 基于垂线偏差补偿的高精度姿态修正方法
CN111750865A (zh) 一种用于双功能深海无人潜器导航系统的自适应滤波导航方法
CN108871379B (zh) 一种dvl测速误差在线标定方法
CN117053782A (zh) 一种水陆两栖机器人组合导航方法
CN116007620A (zh) 一种组合导航滤波方法、系统、电子设备及存储介质
CN112378401B (zh) 一种惯导系统运动加速度估计方法
CN116164773A (zh) 一种基于载体系四元数姿态误差的李群捷联惯导误差模型
CN106595705B (zh) 一种基于gps的飞行中惯性初始基准偏差估计方法
CN116594000A (zh) 基于位置观测的激光多普勒测速仪在线标定方法和装置
CN103411627A (zh) 火星动力下降段非线性三步滤波方法
CN107144276A (zh) 基于h∞次优滤波的角速度匹配传递对准方法
CN113720354A (zh) 一种基于fbg应变花的递推式传递对准方法
CN115164886B (zh) 车载gnss/ins组合导航系统比例因子误差补偿方法

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