Two-antenna GNSS Aided-INS Alignment Using Adaptive Control of Filter Noise Covariance

doi:10.11947/j.AGCS.2018.20170316

Abstract

Abstract: This paper developed a theory of INS fine alignment in order to restrain the divergence of yaw angle,two antennas GNSS aided-INS integrated alignment algorithm was utilized.An attitude error measurement equation was conducted based on the relationship between baseline vectors calculated by two sensors and attitude error.The algorithm was executed by EKF using adaptive control of filter noise covariance.The experimental results showed that stability of the integrated system was improved under the system noise covariance adaptive control mechanism;The measurement noise covariance adaptive control mechanism can reduce the influence of measurement noise and improve the alignment absolute accuracy;Further improvement was achieved under the condition of minim bias of baseline length.The accuracy of roll and pitch was 0.02°,the accuracy of yaw was 0.04°.

Key words: two-antenna GNSS-SINS alignment, adaptive control of system noise, adaptive control of measurement noise, difference of baseline vector, attitude error

CLC Number:

P228

HAO Yushi, XU Aigong, SUI Xin, WANG Changqiang. Two-antenna GNSS Aided-INS Alignment Using Adaptive Control of Filter Noise Covariance[J]. Acta Geodaetica et Cartographica Sinica, 2018, 47(4): 473-479.

References

[1] 曹娟娟, 房建成, 盛蔚, 等. 低成本多传感器组合导航系统在小型无人机自主飞行中的研究与应用[J]. 航空学报, 2009, 30(10):1923-1929. CAO Juanjuan, FANG Jiancheng, SHENG Wei, et al. Study and Application of Low-cost Multi-sensor Integrated Navigation for Small UAV Autonomous Flight[J]. Acta Aeronautica et Astronautica Sinica, 2009, 30(10):1923-1929.
[2] ZHANG Yufeng, GAO Yang. A Method to Improve the Alignment Performance for GPS-IMU System[J]. GPS Solutions, 2007, 11(2):129-137.
[3] HONG S, CHANG Y S, HA S K, et al. Estimation of Alignment Errors in GPS/INS Integration[C]//Proceedings of the 15th International Technical Meeting of the Satellite Division of the Institute of Navigation. Portland, OR:Oregon Convention Center, 2002:24-27.
[4] 庞春雷, 赵修斌, 余永林, 等. 低精度SINS初始对准/GPS双天线测向互辅算法[J]. 西安电子科技大学学报, 2014, 41(6):167-173. PANG Chunlei, ZHAO Xiubin, YU Yonglin, et al. Interact Arithmetic of Low-accuracy SINS' Initial Alignment and GPS Orientation Measurement with Two Antennas[J]. Journal of Xidian University, 2014, 41(6):167-173.
[5] 何正斌. GPS/INS组合导航数据处理算法拓展研究[D]. 西安:长安大学, 2012. HE Zhengbin. Study on Algorithms Extension in GPS/INS Integrated Navigation[D]. Xi'an:Chang'an University, 2012.
[6] NARASIMHAPPA M, RANGABABU P, SABAT S L, et al. A Modified Sage-Husa Adaptive Kalman Filter for Denoising Fiber Optic Gyroscope Signal[C]//Proceedings of 2012 Annual IEEE India Conference. Kochi, India:IEEE, 2012:1266-1271.
[7] MOHAMED A H, SCHWARZ K P. Adaptive Kalman Filtering for INS/GPS[J]. Journal of Geodesy, 1999, 73(4):193-203.
[8] 杨元喜, 何海波, 徐天河. 论动态自适应滤波[J]. 测绘学报, 2001, 30(4):293-298. YANG Yuanxi, HE Haibo, XU Tianhe. Adaptive Robust Filtering for Kinematic GPS Positioning[J]. Acta Geodaetica et Cartographica Sinica, 2001, 30(4):293-298.
[9] 杨元喜, 徐天河. 基于移动开窗法协方差估计和方差分量估计的自适应滤波[J]. 武汉大学学报(信息科学版), 2003, 28(6):714-718. YANG Yuanxi, XU Tianhe. An Adaptive Kalman Filter Combining Variance Component Estimation with Covariance Matrix Estimation Based on Moving Window[J]. Geomatics and Information Science of Wuhan University, 2003, 28(6):714-718.
[10] 张双成, 杨元喜, 张勤. 一种基于抗差自校正Kalman滤波的GPS导航算法[J]. 武汉大学学报(信息科学版), 2005, 30(10):881-884. ZHANG Shuangcheng, YANG Yuanxi, ZHANG Qin. An Algorithm of GPS Navigation Based on Robust Self-tuning Kalman Filtering[J]. Geomatics and Information Science of Wuhan University, 2005, 30(10):881-884.
[11] 杨元喜. 动态系统的抗差Kalman滤波[J]. 解放军测绘学院学报, 1997, 14(2):79-84. YANG Yuanxi. Robust Kalman Filter for Dynamic Systems[J]. Journal of the PLA Institute of Surveying and Mapping, 1997, 14(2):79-84.
[12] 胡国荣, 欧吉坤. 改进的高动态GPS定位自适应卡尔曼滤波方法[J]. 测绘学报, 1999, 28(4):290-294. HU Guorong, OU Jikun. The Improved Method of Adaptive Kalman Filtering for GPS High Kinematic Positioning[J]. Acta Geodaetica et Cartographica Sinica, 1999, 28(4):290-294.
[13] 胡丛玮, 刘大杰. 基于方差分量估计原理的自适应卡尔曼滤波及其应用[J]. 测绘学院学报, 2002, 19(1):15-18. HU Congwei, LIU Dajie. Adaptive Kalman Filtering and Its Application Based on Variance Component Estimation[J]. Journal of Institute of Surveying and Mapping, 2002, 19(1):15-18.
[14] YANG Yuanxi, SONG Lijie, XU Tianhe. Robust Estimator for Correlated Observations Based on Bifactor Equivalent Weights[J]. Journal of Geodesy, 2002, 76(6-7):353-358.
[15] YANG Yuanxi, XU Tianhe. An Adaptive Kalman Filter Based on Sage Windowing Weights and Variance Components[J]. The Journal of Navigation, 2003, 56(2):231-240.
[16] YANG Yuanxi, GAO Weiguang. A New Learning Statistic for Adaptive Filter Based on Predicted Residuals[J]. Progress in Natural Science, 2006, 16(8):833-837.
[17] 高钟毓. 惯性导航系统技术[M]. 北京:清华大学出版社, 2012. GAO Zhongyu. Inertial Navigation System Technology[M]. Beijing:Tsinghua University Press, 2012.
[18] YANG Yunchun, FARRELL J A. Two Antennas GPS-aided INS for Attitude Determination[J]. IEEE Transactions on Control Systems Technology, 2003, 11(6):905-918.
[19] GREWAL M S, ANDREWS A P, BARTONE C G. Global Navigation Satellite Systems, Inertial Navigation, and Integration[M]. 3rd ed. Hoboken, New Jersey:John Wiley & Sons, 2013.
[20] KIM J, LEE S. A Vehicular Positioning with GPS/IMU Using Adaptive Control of Filter Noise Covariance[J]. ICT Express, 2016, 2(1):41-46.
[21] 甘雨, 隋立芬, 刘长建, 等. 自适应抗差Kalman滤波在多天线原始观测值瞬时姿态确定中的应用[J]. 测绘学报, 2015, 44(9):945-951. DOI:10.11947/j.AGCS.2015.20140492. GAN Yu, SUI Lifen, LIU Changjian, et al. Instantaneous Attitude Determination Based on Original Multi-antenna Obser-vations Using Adaptively Robust Kalman Filtering[J]. Acta Geodaetica et Cartographica Sinica, 2015, 44(9):945-951. DOI:10.11947/j.AGCS.2015.20140492.
[22] ROSS T J. Fuzzy Logic with Engineering Applications[M]. Hoboken, NJ:John Wiley & Sons, 2004.
[23] CHUI C K, CHEN Guanrong. Kalman Filtering with Real-time Applications[M]. Berlin:Springer, 1987.
[24] YANG Yuanxi, CUI Xianqiang. Adaptively Robust Filter with Multi Adaptive Factors[J]. Survey Review, 2008, 40(309):260-270.
[25] GROVES P D. Principles of GNSS, Inertial, and Multisensor Integrated Navigation Systems[M]. Boston:Artech House, 2008.