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

基于改进OBA的自适应反馈对准算法

  • 雷小盈 ,
  • 杨鹏翔 ,
  • 李应举 ,
  • 梅春波
展开
  • 西安现代控制技术研究所,陕西 西安 710065
杨鹏翔(1983—),男,研究员,博士,研究方向:惯性导航和组合导航。

雷小盈(1999—),女,硕士,研究方向:惯性导航和组合导航。

收稿日期: 2024-08-05

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

Adaptive Feedback Alignment Algorithm Based on Improved OBA Method

  • LEI Xiaoying ,
  • YANG Pengxiang ,
  • LI Yingju ,
  • MEI Chunbo
Expand
  • Xi’an Mordern Control Technology Research Institute,Xi’an 710065,Shaanxi, China

Received date: 2024-08-05

  Online published: 2024-12-18

摘要

针对无人机的空中对准问题,在有卫星导航的情况下,基于改进OBA(基于优化的对准)对准算法提出了一种统一粗对准和精对准过程的自适应反馈对准算法。在OBA算法后的每一步都进入自适应卡尔曼滤波器进行传感器误差估计和载体系姿态补偿,系统直接输出载体的实时姿态,缩短了对准时间。利用Sage-husa自适应估计器矫正系统的观测噪声协方差矩阵,再构造自适应因子来矫正系统状态量的协方差矩阵,通过KF(卡尔曼滤波器)来估计传感器的误差量,由反馈通道补偿给观测矢量,不断迭代得到姿态角对准结果。设计仿真实验,对卫星导航给出的速度与位置信息存在未知随机误差的情况进行模拟,发现改进后的OBA自适应反馈对准算法有效提高了原OBA算法的对准精度和应用场景,航向角误差由79.45°降低到了-0.032°。文中算法与EKF(扩展卡尔曼滤波)的对比实验,发现文中算法俯仰角与航向角收敛时间较EKF算法缩短了30 s左右,EKF算法收敛后,文中算法误差比EKF算法小2.203°。文中给出算法在量测噪声未知的大失准角初始对准中更有优势,能够应用于大机动飞行器的空中初始对准。

本文引用格式

雷小盈 , 杨鹏翔 , 李应举 , 梅春波 . 基于改进OBA的自适应反馈对准算法[J]. 弹箭与制导学报, 2024 , 44(5) : 96 -103 . DOI: 10.15892/j.cnki.djzdxb.2024.05.012

Abstract

In order to solve the problem of aerial alignment of UAVs under situation of satellite navigation, an adaptive feedback alignment algorithm based on improved OBA(optimization-based alignment) alignment algorithm is proposed to unify the process of coarse alignment and fine alignment. After OBA algorithm, the adaptive Kalman filter is used in each step to estimate the sensor error and compensate the attitude of the carrier. The real-time attitude of the carrier is directly output by the system, and the alignment time is shortened. The Sage-husa adaptive estimator is used to correct the observed noise covariance matrix of the system, and then the adaptive factor is reconstructed to correct the covariance matrix of the system state variables. The sensor error is estimated by KF (Kalman filter), and the observed vector is compensated through the feedback channel and that iterate constantly on the attitude angle alignment results. Simulation experiments are designed and simulate the unknown random errors in the velocity and position information given by satellite navigation, it is found that the improved OBA adaptive feedback alignment algorithm effectively improves the alignment accuracy and application scenarios of the original OBA algorithm, and the heading angle error is reduced from 79.45° to -0.032°. The comparison between the proposed algorithm and EKF (extended Kalman filter) shows that the convergence time of pitch angle and heading angle of the proposed algorithm is about 30 s shorter than that of the EKF algorithm. After the convergence of the EKF algorithm, the error of the proposed algorithm is 2.203° smaller than that of the EKF algorithm. The proposed algorithm has more advantages in the initial alignment for large misalignment angle with unknown measurement noise, and can be applied to the initial alignment of large maneuvering aircraft.

[an error occurred while processing this directive]
[1]
WU M P, WU Y X, HU X P, et al. Optimization-based alignment for inertial navigation systems: theory and algorithm[J]. Aerospace Science and Technology, 2011, 15(1): 1-17.

[2]
严恭敏, 陈若彤, 郭鹍. 多矢量定姿的SVD和QUEST算法等价性分析[J]. 中国惯性技术学报, 2019, 27(5):5.

YAN G M, CHEN R T, GUO G. Equivalence analysis of SVD and QUEST algorithms for multi-vector orientation[J]. Journal of Chinese Inertial Technology, 2019, 27(5):5.

[3]
WU Y X, PAN X F. Velocity/position integration formula part I: application to in-flight coarse alignment[J]. IEEE Transactions on Aerospace and Electronic Systems, 2013, 49(2): 1006-1023.

[4]
ZHANG H. Coarse alignment based on weighted observation vectors in mooring state for surface targets[J]. IEEE Sensors Journal, 2023, 23: 19848-19860.

[5]
LUO L, HUANG Y L, ZHANG Z, et al. A position loci-based in-motion initial alignment method for low-cost attitude and heading reference system[J]. IEEE Transactions on Instrumentation and Measurement, 2021, 70:1-18.

[6]
WEI X K, LI J, FENG K Q, et al. An improved in-flight alignment method based on backtracking navigation for GPS-aided low cost SINS with short endurance[J]. IEEE Robotics and Automation Letters, 2022, 7: 634-641.

[7]
CHANG L B, HU B Q, LI Y. Backtracking integration for fast attitude determination-based initial alignment[J]. IEEE Transactions on Instrumentation and Measurement, 2015, 64(3): 795-803.

[8]
单斌, 侯梦婷, 王雪梅, 等. GNSS辅助车载MIMU动基座初始对准方法[J]. 中国惯性技术学报, 2023, 31(10):967-975

SHAN B, HOU M T, WANG X M, et al. Initial alignment method of GNSS assisted vehicle MIMU moving base[J]. Chinese Journal of Inertia Technology, 2019, 31(10): 967-975

[9]
HUANG Y L, ZHANG Y G, CHANG L B. a new fast in-motion coarse alignment method for GPS-aided low-cost SINS[J]. IEEEASME Transactions on Mechatronics, 2018, 23(3): 1303-1313.

[10]
CHANG L B, LI J S, CHEN S Y. Initial alignment by attitude estimation for strapdown inertial navigation systems[J]. IEEE Transactions on Instrumentation and Measurement, 2015, 64(3): 784-794.

[11]
HUANG Y L, ZHANG Z, DU S Y, et al. A high-accuracy GPS-aided coarse alignment method for MEMS-Based SINS[J]. IEEE Transactions on Instrumentation and Measurement, 2020, 69(10): 7914-7932.

[12]
孙梦勃, 唐诗华, 李灏杨, 等. GNSS/SINS组合导航的动基座初始对准[J]. 测绘通报, 2024(4):69-75.

DOI

SUN M B, TANG S H, LI H Y, et al. Moving base initial alignment of GNSS/SINS integrated navigation[J]. Bulletin of surveying and mapping, 2024 (4) : 69-75.

[13]
王伟, 刘萌, 薛冰. GPS辅助的SINS系统快速动基座初始对准[J]. 哈尔滨工业大学学报, 2020, 52(12):49-57.

WANG W, LIU M, XUE B. GPS aided initial alignment of SINS fast moving pedestal[J]. Journal of Harbin Institute of Technology, 2019, 52(12):49-57.

[14]
XU X, SUN Y F, YAO Y Q, et al. A robust in-motion optimization-based alignment for SINS/GPS integration[J]. IEEE Transactions on Intelligent Transportation Systems, 2022, 23(5): 4362-4372.

[15]
秦永元. 惯性导航[M]. 北京: 科学出版社, 2014.

QIN Y Y. Inertial navigation[M]. Beijing: Science Press, 2014.

[16]
张常云. 自适应滤波方法研究[J]. 航空学报, 1998(增刊1): 97-100.

ZHANG C Y. Research on adaptive filtering method[J]. Acta Aeronautica Sinica, 1998(S1):97-100.

[17]
卞鸿巍, 金志华, 王俊璞, 等. 组合导航系统新息自适应卡尔曼滤波算法[J]. 上海交通大学学报, 2006(6):1000-1003.

BIAN H W, JIN Z H, WANG J P, et al. Integrated navigation system's innovation adaptive kalman filtering algorithm[J]. Journal of Shanghai Jiaotong University, 2006(6) : 1000-1003.

[18]
鲁平, 赵龙, 陈哲. 改进的Sage-Husa自适应滤波及其应用[J]. 系统仿真学报, 2007(15):3503-3505.

LU P, ZHAO L, CHEN Z. Improved Sage-Husa adaptive filtering and its application[J]. Journal of System Simulation, 2007(15):3503-3505.

[19]
LIU W Q, CHEN X H, DING P, et al. An optimal indirect in-motion coarse alignment method for GNSS-aided SINS[J]. IEEE Sensors Journal, 2022, 22: 7608-7618.

[20]
魏伟, 秦永元, 张晓冬, 等. 对Sage-Husa算法的改进[J]. 中国惯性技术学报, 2012, 20(6):678-686.

WEI W, QIN Y Y, ZHANG X D, et al. The Sage-Husa algorithm improved[J]. Journal of Chinese inertial technology, 2012, 20 (6) : 678-686.

[21]
YAN G M, WANG J L, ZHOU X Y. High-precision simulator for strap-down inertial navigation systems based on real dynamics from GNSS and IMU integration[C]// CSNC. Proceedings of the China Satellite Navigation Conference 2015 Proceedings: Volume III. Berlin:Springer, 2015: 789-799.

[22]
TANG Y, WU Y, WU M, et al. INS/GPS integration: global observability analysis[J]. IEEE Transactions on Vehicular Technology, 2009, 58(3): 1129-1142.

文章导航

/

[an error occurred while processing this directive]