[an error occurred while processing this directive] [an error occurred while processing this directive] [an error occurred while processing this directive]
[an error occurred while processing this directive]

基于抗差平方根容积卡尔曼滤波的惯导姿态空中修正算法

  • 朱勋磊 ,
  • 谢文龙 ,
  • 李庆波 ,
  • 李芳
展开
  • 上海机电工程研究所,上海 201109

朱勋磊(2000—),男,硕士研究生,研究方向:导弹制导控制系统设计。

收稿日期: 2024-05-19

  网络出版日期: 2024-12-18

An In-flight INS-attitude-correction Algorithm Based on Robust SRCKF

  • ZHU Xunlei ,
  • XIE Wenlong ,
  • LI Qingbo ,
  • LI Fang
Expand
  • Shanghai Electromechanical Engineering Institute, Shanghai 201109, China

Received date: 2024-05-19

  Online published: 2024-12-18

摘要

MEMS加速度计和陀螺仪在近程末端战术导弹中已大量使用,受其精度限制,导弹的惯导解算误差不可忽略,对复合制导体制的制导模式空中交班可能存在较大影响。为实现导弹飞行过程中惯导姿态误差的有效修正,提升导弹中末制导交班概率,文中提出一种基于抗差平方根容积卡尔曼滤波的惯导姿态空中修正算法,建立适用近程末端战术导弹的惯导姿态误差空中估计模型,利用地面跟踪雷达对导弹位置的观测信息,结合SRCKF滤波与抗差算法,对惯导姿态误差角进行估计与修正,降低导弹飞行过程中的姿态误差。仿真结果表明,基于抗差SRCKF的惯导姿态空中修正算法可显著降低导弹飞行过程中的姿态解算误差,且能够大幅抑制地面雷达观测粗差对修正效果的影响,验证了算法的有效性和鲁棒性。

本文引用格式

朱勋磊 , 谢文龙 , 李庆波 , 李芳 . 基于抗差平方根容积卡尔曼滤波的惯导姿态空中修正算法[J]. 弹箭与制导学报, 2024 , 44(5) : 75 -81 . DOI: 10.15892/j.cnki.djzdxb.2024.05.009

Abstract

MEMS inertial measurement units are commonly used in short-range and terminal phase of tactical missiles. Due to their accuracy constraints, the inertial navigation resolving error of the missile cannot be neglected, it may have a significant impact on the guidance mode switching of a compound guidance system of missile in flight. In order to realize effective correction to the inertial navigation attitude error of the missile inflight and enhance the middle-terminal phase switching probability of the missile, this paper proposes an inertial navigation inflight attitude correction algorithm based on the robust square root cubature Kalman filter (SRCKF) and establish an inertial navigation inflight attitude error estimation mode suitable for short-range and terminal phase of the tactical missile, it uses the observation information of the missile location obtained by a ground tracking radar, alongwith the SRCKF filtering and robust algorithm, to perform estimate and correction to the inertial navigation attitude error angle and to reduce the attitude error of the missile inflight. Simulation results show that the algorithm can significantly correct the attitude resolving error for the missile inflight and greatly restrain the influence of the ground radar observing gross error to the correction effect, and verify the effectiveness and the robustness of the algorithm.

[an error occurred while processing this directive]
[1]
刘海军, 王丽娜. 复合制导防空导弹中末制导交班问题研究[J]. 现代防御技术, 2006, 34(2):29-33.

LIU H J, WANG L N. Study on handover problem of compound guidance missile weapon[J]. Modern Defence Technology, 2006, 34(2):29-33.

[2]
王波兰, 李克勇, 杨永强. 近程/末端防御旋转导弹发展及关键技术综述[J]. 上海航天, 2017, 34(增刊1):1-6.

WANG B L, LI K Y, YANG Y Q. Review of development and key techniques of rolling airframe missiles[J]. Aerospace Shanghai, 2017, 34(S1):1-6.

[3]
史冉东, 郭正勇, 高文. 单通道旋转导弹惯导红外空中交班技术研究[J]. 上海航天, 2017, 34(增刊1):88-94.

SHI R D, GUO Z Y, GAO W. Study on infrared handoff technology in air by inertial navigation for rolling airframe missile with single channel[J]. Aerospace Shanghai, 2017, 34(S1):88-94.

[4]
姚艳生, 吴向东. 战术导弹初始对准误差的一种空中估测方法[J]. 现代防御技术, 2007, 35(5):67-70.

YAO Y S, WU X D. A method of flight separation for initial alignment error of tactical missile[J]. Modern Defence Technology, 2007, 35(5):67-70.

[5]
刘伟鹏, 袁杰波, 秦峰, 等. 地空导弹垂直发射高精度初始姿态获取技术研究[J]. 空天防御, 2018, 1(4):24-28.

LIU W P, YUAN J B, QING F, et al. Study on obtainment of high accuracy initial attitude for vertical launching of ground-to-air missile[J]. Air & Space Defence, 2018, 1(4):24-28.

[6]
ZHAO X, ZHONG M, GUO D, et al. Error estimation of INS/GPS integrated system based on PMI extended Kalman Filter[C]// IEEE. Proceedings of the 2016 IEEE Chinese Guidance, Navigation and Control Conference. New York: IEEE, 2016: 318-323.

[7]
顾元鑫, 吴文启, 王茂松. 基于MEMS-IMU的动态大失准角STUKF算法[J]. 中国惯性技术学报, 2023, 31(9):861-869.

GU Y X, WU W Q, WANG M S. STUKF algorithm for MEMS-IMU with large misalignment in dynamic[J]. Journal of Chinese Inertial Technology, 2023, 31(9):861-869.

[8]
牟宏伟, 韩磊, 李昂阳. 自适应抗差CKF在SINS大方位失准角初始对准中的应用[J]. 舰船电子工程, 2022, 42(1):44-47.

MU H W, HAN L, LI A Y. Adaptive robust CKF applied in SINS large azimuth initial alignment[J]. Ship Electronic Engineering, 2022, 42(1):44-47.

[9]
崔明. 基于CQKF的大方位失准角初始对准方法研究[D]. 哈尔滨: 哈尔滨工程大学, 2018.

CUI M. Research on CQKF in sins initial alignment for large misalignment angles[D]. Harbin:Harbin Engineering University, 2018.

[10]
崔乃刚, 蔡李根, 荣思远. 基于有向图切换IMM-CKF高速滑翔目标跟踪算法[J]. 空天防御, 2020, 3(3):1-8.

CUI N G, CAI L G, RONG S Y. High-speed gliding target tracking algorithm based on digraph switching IMM-CKF[J]. Air & Space Defence, 2020, 3(3):1-8.

[11]
贵彦乔, 吴彦鸿, 俞道滨. 跟踪雷达干扰技术综述[J]. 兵器装备工程学报, 2017, 38(4):141-147.

GUI Y Q, WU Y H, YU D B. Review of jamming techniques to tracker radar[J]. Journal of Ordnance Equipment Engineering, 2017, 38(4):141-147.

[12]
王科宇, 王俊雄. 基于SRUKF的模型辅助AUV惯性导航系统[J]. 舰船科学技术, 2021, 43(13):153-157.

WANG K Y, WANG J X. A model-aided inertial navigation system for miniature AUV exploiting SRUKF[J]. Ship Science And Technology, 2021, 43(13):153-157.

[13]
张群, 洪志强. 抗差自适应无迹Kalman滤波在 GPS/INS组合导航中的应用[J]. 北京测绘, 2021, 35(11):1440-1446.

ZHANG Q, HONG Z Q. A robust and adaptive unscented kalman filtering method and its application in GPS/INS integrated navigation[J]. Beijing Surveying and Mapping, 2021, 35(11):1440-1446.

[14]
李伟忠, 孙鹏. 战术导弹用MEMS陀螺仪研制进展及关键技术[J]. 导航与控制, 2017, 16(3):97-104.

DOI

LI W Z, SUN P. Research on progress and the key technology of MEMS gyroscope in tactical mission[J]. Navigation and Control, 2017, 16(3):97-104.

[15]
袁晓波, 张超, 詹银虎. 强跟踪自适应SRCKF的卫星姿态确定算法[J]. 测绘科学, 2018, 43(3):6-12.

YUAN X B, ZHANG C, ZHAN Y H. Strong tracking SRCKF algorithm based-on satellite attitude determination system[J]. Science of Surveying and Mapping, 2018, 43(3):6-12.

[16]
ZHANG Q, LI S S, XU Z P, et al. Cooperative localization in harsh underwater environment based on the MC-ANFIS[J]. IEEE Access, 2019(7):55407-55421.

[17]
王旭刚. 抗差平方根UKF在SINS/GPS中的应用研究[D]. 哈尔滨: 哈尔滨工程大学, 2019.

WANG X G. Application of robust square root UKF in SINS/GPS[D]. Harbin:Harbin Engineering University, 2019.

[18]
何劢航, 孙付平, 肖凯, 等. 抗差EKF滤波在GNSS/INS组合导航中的应用[J]. 测绘与空间地理信息, 2021, 44(2):33-37.

HE M H, SUN F P, XIAO K, et al. Application of robust EKF in GNSS/INS integrated navigation[J]. Geomatics & Spatial Information Technology, 2021, 44 (2):33-37.

[19]
CHANG G B. Kalman filter with both adaptivity and robustness[J]. Journal of Process Control, 2014, 24 (3):81-87.

[20]
徐晓苏, 仲灵通. 一种基于M估计的抗差自适应多模型组合导航算法[J]. 中国惯性技术学报, 2021, 29(4):482-490.

XU X S, ZHONG L T. Robust adaptive multiple model integrated navigation algorithm based on M-estimation[J]. Journal of Chinese Inertial Technology, 2021, 29(4):482-490.

文章导航

/

[an error occurred while processing this directive]