[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 ,
  • 冯阳 2 ,
  • 路坦 1
展开
  • 1 南京理工大学机械工程学院,江苏 南京 210094
  • 2 安徽湘凡科技有限公司,安徽 合肥 231200
丁立波(1977—),男,副教授,博士研究生,研究方向:传感与探测技术、常规弹药制导与控制技术等。

任雪佳(1997—),女,硕士研究生,研究方向:机电系统智能检测与控制。

收稿日期: 2022-07-22

  网络出版日期: 2025-02-24

基金资助

国家重点研发: 173计划技术领域基金项目(2021-JCJQ-JJ-0588)

A Two-sample Iteration Coning Algorithm for Angular Rate Inputs

  • REN Xuejia 1 ,
  • DING Libo 1 ,
  • FENG Yang 2 ,
  • LU Tan 1
Expand
  • 1 School of Mechanical Engineering,Nanjing University of Science and Technology,Nanjing 210094,Jiangsu, China
  • 2 Xiangfan Technology Co., Ltd.,Hefei 231200,Anhui, China

Received date: 2022-07-22

  Online published: 2025-02-24

摘要

传统姿态算法中使用角增量信息,针对角速率输入下的捷联惯性导航系统采用传统旋转矢量算法致使计算精度下降,且不能有效补偿圆锥误差的问题,提出一种直接使用角速率进行姿态解算的双子样二次迭代算法,在理论分析中简化了公式并对补偿系数进行了优化。仿真结果表明,在经典圆锥运动环境下,对比传统圆锥补偿算法,该双子样二次迭代优化算法具有更高的计算精度,且叉乘运算量和基于角速率的三子样优化算法相同。

本文引用格式

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

Abstract

The traditional attitude algorithm uses the angular increment information. To address the problem that the use of the traditional rotation vector algorithm for the strapdown inertial navigation system with angular rate input will degrade the computational accuracy and cannot effectively compensate for the cone error, a two-subsample dual-loop algorithm is proposed to directly use the angular rate for attitude solution. In the classical conic motion environment, the simulation results show that, compared with the traditional cone compensation algorithm, the two-subsample dual-loop optimization algorithm has higher computational accuracy, and the fork multiplication operation is the same as the three-subsample optimization algorithm based on angular rate, which has certain engineering application value.

[an error occurred while processing this directive]
[1]
BORTZ J E. A new mathematical formulation for strapdown inertial navigation[J]. IEEE Transactions on Aerospace and Electronic Systems, 1971, 7(1): 61-66.

[2]
MILLER R B. A new strapdown attitude algorithm[J]. Journal of Guidance Control & Dynamics, 1983, 6(4): 287-291.

[3]
YEON F J, YU P L. Improved strapdown coning algorithms[J]. IEEE Transactions on Aerospace and Electronic Systems, 1992, 28(2): 738-743.

[4]
孙丽, 秦永元. 捷联惯导系统姿态算法比较[J]. 中国惯性技术学报, 2006, 14(3): 6-10.

SUN L, QIN Y Y. Comparison of attitude algorithms of SINS[J]. Journal of Chinese Inertial Technology, 2006, 14(3): 6-10.

[5]
王红辉, 杨绍卿, 吴成富, 等. 旋转矢量在高动态全姿态飞行器运动方程中的应用[J]. 兵工学报, 2016, 37(3): 439-446.

DOI

WANG H H, YANG S Q, WU C F, et al. Application of rotating vector in equations of motion for all-attitude aircrafts[J]. Acta Armamentarii, 2016, 37(3): 439-446.

[6]
黄磊, 刘建业, 曾庆化. 基于高阶补偿模型的新圆锥算法[J]. 中国惯性技术学报, 2013, 21(1): 37-41.

HUANG L, LIU J Y, ZENG Q H. New coning algorithm based on high-order error compensation model[J]. Journal of Chinese Inertial Technology, 2013, 21(1): 37-41.

[7]
ZHANG L, ZHANG T, WANG M, et al. A high-order coning error compensation algorithm under high rate maneuvering[J]. IEEE Sensors Journal, 2020, 20(1): 208-218.

[8]
严恭敏, 严卫生, 徐德民. 经典圆锥误差补偿算法中剩余误差估计的局限性研究[J]. 中国惯性技术学报, 2008, 16(4): 379-385.

YAN G M, YAN W S, XU D M. Limitations of error estimation for classic coning compensation algorithm[J]. Journal of Chinese Inertial Technology, 2008, 16(4): 379-385.

[9]
SAVAGE P G. Coning algorithm design by explicit frequency shaping[J]. Journal of Guidance Control & Dynamics, 2010, 33(4): 1123-1132.

[10]
刘危, 解旭辉, 李圣怡. 捷联惯导系统的圆锥误差补偿算法研究[J]. 南京航空航天大学学报, 2004, 36(3): 348-352.

LIU W, XIE X H, LI S Y. Coning algorithm for strapdown inertial navigation system[J]. Journal of Nanjing University of Aeronautics & Astronautics, 2004, 36(3): 348-352.

[11]
黄昊, 邓正隆. 旋转矢量航姿算法的一种新的表达式[J]. 宇航学报, 2001, 22(3): 92-98.

HUANG H, DENG Z L. A new expression for rotation vector attitude algorithm[J]. Journal of Astronautics, 2001, 22(3): 92-98.

[12]
杜烨, 冯顺山, 苑大威, 等. 基于磁强计和MEMS陀螺的弹箭姿态探测系统[J]. 北京理工大学学报, 2014, 34(12): 1267-1271.

DU Y, FENG S S, YUAN D W, et al. An attitude determination system using magnetometers and MEMS gyro[J]. Transactions of Beijing Institute of Technology, 2014, 34(12): 1267-1271.

[13]
曾庆化, 刘建业, 熊智, 等. 一种角速率激光陀螺惯导系统高精度姿态算法[J]. 上海交通大学学报, 2006, 40(12): 2159-2163.

ZENG Q H, LIU J Y, XIONG Z, et al. A high-accuracy attitude algorithm of ring laser gyro strapdown inertial navigation system with pure angle rate output[J]. Journal of Shanghai Jiaotong University, 2006, 40(12): 2159-2163.

[14]
BEN Y Y, SUN F, GAO W, et al. Generalized method for improved coning algorithms using angular rate[J]. IEEE Transactions on Aerospace & Electronic Systems, 2009, 45(4): 1565-1572.

[15]
刘佳乐. 高动态环境下弹体姿态测量技术研究与实现[D]. 南京: 南京理工大学, 2017.

LIU J L. Research and implementation of projectile attitude measurement technology in high dynamic environment[D]. Nanjing: Nanjing University of Science and Technology, 2017.

[16]
汤传业, 陈熙源, 李建利. 一种角速率输入的圆锥算法设计[J]. 中国惯性技术学报, 2013, 21(4): 456-461.

TANG C Y, CHEN X Y, LI J L. Coning algorithm design for angular rate inputs[J]. Journal of Chinese Inertial Technology, 2013, 21(4): 456-461.

[17]
卢世昕, 陈熙源. 一种角速率输入下二次优化的单子样旋转矢量姿态算法[J]. 传感技术学报, 2020, 33(7): 974-980.

LU S X, CHEN X Y. A single-sample rotation vector attitude algorithm with quadratic optimization under angular rate input[J]. Chinese Journal of Sensors and Actuators, 2020, 33(7): 974-980.

[18]
丁鹏, 程向红, 刘文倩. 单轴旋转捷联惯导系统圆锥误差分析与仿真[J]. 中国惯性技术学报, 2021, 29(1): 28-34.

DING P, CHENG X H, LIU W Q. Coning error analysis and simulation of single-axis rotational strapdown inertial navigation systems[J]. Journal of Chinese Inertial Technology, 2021, 29(1): 28-34.

[19]
DING P, CHENG X H, WANG Y N. A high-order enhanced attitude algorithm under angular-Rate input condition[J]. IEEE Sensors Journal, 2021, 21(10): 12119-12129.

[20]
邢丽, 熊智, 刘建业, 等. 基于对偶四元数的圆锥及划船误差补偿改进算法[J]. 兵工学报, 2017, 38(7): 1336-1347.

DOI

XING L, XIONG Z, LIU J Y, et al. Improved coning and sculling error compensation algorithms based dual quaternion for strapdown inertial navigation system[J]. Acta Armamentarii, 2017, 38(7): 1336-1347.

DOI

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

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

[22]
顾冬晴, 张海涛, 秦永元. 捷联惯导姿态更新的双子样二次迭代优化算法研究[J]. 中国惯性技术学报, 2002, 10(3): 9-15.

GU D Q, ZHANG H T, QIN Y Y. Optimal two-sample iteration algorithm for SINS attitude updating[J]. Journal of Chinese Inertial Technology, 2002, 10(3): 9-15.

文章导航

/

[an error occurred while processing this directive]