[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]

高动态姿态测量圆锥误差补偿算法改进及实时性分析

  • 庞珂 1 ,
  • 兀伟 1 ,
  • 刘星 1 ,
  • 刘强 2
展开
  • 1 西安工业大学电子信息工程学院,陕西 西安 710021
  • 2 西北工业集团有限公司,陕西 西安 710043
刘星(1975—),男,研究员级高级工程师,博士,研究方向:目标探测与识别。

庞珂(1997—),女,硕士研究生,研究方向:制导与控制。

收稿日期: 2023-06-08

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

Improved High-dynamic Attitude Measurement Cone Error Compensation Algorithm and Real-time Analysis

  • PANG Ke 1 ,
  • WU Wei 1 ,
  • LIU Xing 1 ,
  • LIU Qiang 2
Expand
  • 1 School of Electronic Information Engineering, Xi’an Technological University, Xi’an 710021, Shaanxi, China
  • 2 Northwest Industrial Group Co., Ltd., Xi’an 710043, Shaanxi, China

Received date: 2023-06-08

  Online published: 2024-12-28

摘要

弹丸圆锥运动会对制导系统产生严重的控制干扰,为了补偿该误差,分析了一种新的圆锥误差补偿算法,以提高弹载姿态控制系统在高动态运动环境下的解算精度和实时性。结合四元数四阶龙格-库塔法和三子样等效旋转矢量法,利用修正型罗德里格斯参数改进基于角增量输出的三子样四元数姿态算法,推导相应的微分方程表达式,建立三子样四元数改进算法姿态求解数学模型。仿真结果表明,与传统圆锥误差补偿算法相比,改进算法能更有效的补偿圆锥误差,平均解算精度提高了约17.32%,减少了高动态环境下的计算量,实时性提升了约22.54%。

本文引用格式

庞珂 , 兀伟 , 刘星 , 刘强 . 高动态姿态测量圆锥误差补偿算法改进及实时性分析[J]. 弹箭与制导学报, 2024 , 44(2) : 57 -63 . DOI: 10.15892/j.cnki.djzdxb.2024.02.009

Abstract

Projectile conical motion causes significant control disturbances in the guidance system. In order to compensate for this error, a new conical error compensation algorithm has been analyzed to improve the accuracy and real-time performance of the bullet attitude control system in a high-dynamic motion environment. Combining the quaternion four-level Runge-Kutta method and the triad equivalent rotation vector method, an improved triad quaternion attitude algorithm based on modified Rodriguez parameters for angle increment output is utilized. Derive the corresponding differential equation expressions to establish the mathematical model for solving the attitude using the improved triad quaternion algorithm. Simulation results demonstrate that compared to traditional conical error compensation algorithms, improved algorithms can more effectively compensate for conical errors, with an average accuracy improvement of approximately 17.32%,reduce computational load in high-dynamic environment and improve real-time performance by approximately 22.54%.

[an error occurred while processing this directive]
[1]
王君, 赵苑辰, 李涛. 一种基于改进旋转矢量的低成本多数据融合姿态更新算法[J]. 电子技术与软件工程, 2021(24): 125-127.

WANG J, ZHAO Y C, LI T. A low-cost multi-sensor fusion attitude update algorithm based on improved rotation vectors[J]. Electronic Technology & Software Engineering, 2021(24): 125-127.

[2]
王小峰, 董正芳. 捷联惯导系统航姿算法的比较及仿真分析[J]. 现代导航, 2016, 7(2): 103-106.

WANG X F, DONG Z F. Comparison and simulation analysis for attitude algorithms of SINS[J]. Modern Navigation, 2016, 7(2): 103-106.

[3]
熊丽娟, 朱洪涛, 王志勇, 等. 圆锥运动下几种姿态算法的比较与误差建模[J]. 弹箭与制导学报, 2020, 40(3): 39-44.

XIONG L J, ZHU H T, WANG Z Y, et al. Comparison and error modeling of several attitude algorithms under coning motion[J]. Journal of Projectiles, Rockets, Missiles and Guidance, 2020, 40(3): 39-44.

[4]
BORTZ J E. A new mathematical formulation for strapdown inertial navigation[J]. IEEE Transactions on Aerospace and Electronic Systems, 1971, 7(1): 61-66.

[5]
周召发, 胡文, 张志利, 等. 一种新的捷联惯性导航系统姿态四元数方程求解方法[J]. 兵工学报, 2018, 39(3): 511-518.

DOI

ZHOU Z F, HU W, ZHANG Z L, et all. A new calculation method of quaternion differential equation for attitude of strapdown inertial navigation system[J]. Acta Armamentarii, 2018, 39(3): 511-518.

[6]
YU J, GAO S. Application of modified rodrigues parameters for spinning projectiles[J]. Chinese Journal of Sensors and Actuators, 2012, 25(12): 1766-1772.

[7]
王真, 高凤歧, 高敏, 等. 高动态捷联姿态测量的改进型圆锥误差补偿算法研究[J]. 科学技术与工程, 2015, 15(22): 204-206.

WANG Z, GAO F Q, GAO M, et al. Research on coning error compensation improved algorithm of high dynamic strapdown attitude & heading measurement[J]. Science Technology and Engineering, 2015, 15(22): 204-206.

[8]
陆彬. 弹载捷联惯导系统圆锥误差和尺寸效应误差研究[D]. 南京: 南京理工大学, 2018.

LU B. Research on coning error and size effect error of missile borne strapdown inertial navigation system[D]. Nanjing: Nanjing University of Science & Technology, 2018.

[9]
严恭敏, 翁浚, 杨小康, 等. 基于毕卡迭代的捷联姿态更新精确数值解法[J]. 宇航学报, 2017, 38(12): 1307-1313.

YAN G M, WENG J, YANG X K, et al. An accurate numerical solution for strapdown attitude algorithm based on picard iteration[J]. Journal of Astronautics, 2017, 38(12): 1307-1313.

[10]
任雪佳, 丁立波, 冯阳, 等. 角速率输入下的双子样二次迭代圆锥补偿算法[J]. 弹箭与制导学报, 2023, 43(2): 26-31.

REN X J, DING L B, FENG Y, et al. A two-sample iteration coning algorithm for angular rate inputs[J]. Journal of Projectiles, Rockets, Missiles and Guidance, 2023, 43(2): 26-31.

[11]
ZHANG Z G, GENG L J, FAN Y F. Performance analysis of three attitude algorithms for SINS[J]. Academic Journal of Computing & Information Science, 2022, 5(12): 1-5.

[12]
樊子艳. 基于多尺度和自适应梯度下降的姿态估计方法研究[D]. 兰州: 兰州交通大学, 2021.

FAN Z Y. Research on attitude estimation of methods based on multi-scale and adaptive gradient descent[D]. Lanzhou: Lanzhou Jiaotong University, 2021.

[13]
程承, 潘泉, 李汉舟. 一种新的捷联惯导系统圆锥误差补偿算法研究[J]. 弹箭与制导学报, 2014, 34(1): 1-4.

CHENG C, PAN Q, LI H Z. The research on new coning error compensation algorithm for strapdown inertial navigation system[J]. Journal of Projectiles, Rockets, Missiles and Guidance, 2014, 34(1): 1-4.

[14]
秦永元. 惯性导航[M]. 北京: 科学出版社, 2006: 267-284.

QIN Y Y. Inertial navigation[M]. Beijing: Science Press, 2006: 267-284.

[15]
赵长山, 秦永元, 贾继超, 等. 修正型罗德里格参数姿态算法研究[J]. 测控技术, 2009, 28(9): 91-94.

ZHAO C S, QIN Y Y, JIA J C, et al. Research on the modified rodrigues parameters based attitude algorithm[J]. Measurement & Control Technology, 2009, 28(9): 91-94.

[16]
田鑫, 戈新生. 基于修正型罗德里格斯参数的三维刚体摆姿态控制[J]. 力学与实践, 2015, 37 (3): 361-366.

TIAN X, GE X S. Attitude control of 3D rigid pendulum based on modified rodrigues parameters[J]. Mechanics in Engineering, 2015, 37(3): 361-366.

文章导航

/

[an error occurred while processing this directive]