在组合导航中,针对不同姿态表示方法构建的姿态估计算法在计算量和精度等方面存在性能差异较大等问题,分别对四元数无味估计器、基于修正罗德里格斯参数和高阶罗德里格斯参数所构成的姿态估计算法进行理论推导与性能比较分析。在数值实验中,比较了3种姿态估计算法在计算量和精度等方面的优劣性,结果表明四元数无味估计器精度最优,但计算量较大,而基于高阶罗德里格斯参数的姿态估计算法计算量最小,相对精度较高。
In the navigation, according to the different attitude representation method to construct the attitude estimation algorithm performance as the differences in the amount of calculation and accuracy, respectively to four yuan number tasteless estimator, modified Rodrigues parameters and high order parameters of Rodrigues attitude estimation algorithm is deduced and the theory of comparative analysis based on performance in numerical. In the experiment, the advantages and disadvantages of algorithm in the calculation of quantity and accuracy of the comparison of three kinds of attitude estimation, the results show that the four element number estimator accuracy is optimal but tasteless, large amount of calculation, and the high order Rodrigues parameter attitude estimation algorithm based on the minimum amount of computation, relatively high precision.
2018,40(3): 137-141 收稿日期:2016-12-01
DOI:10.3404/j.issn.1672-7649.2018.03.025
分类号:TP391
基金项目:国家自然科学基金资助项目(4150622)
作者简介:鲁鑫(1995-),男,硕士研究生,研究方向为惯性技术及其应用
参考文献:
[1] 李文魁, 高敬东, 陈永冰, 等. 舰船综合导航系统[M]. 武汉:海军工程大学, 2015. 11.
[2] 李增科, 王坚, 高井祥. 精密单点定位在GPS/INS组合导航中的应用[J]. 武汉大学学报:信息科学版, 2013(1):48-51.
[3] MARKLEY F L, CRASSIDIS J L. Fundamentals of spacecraft attitude determination and control[M]. Springer New York, 2014.
[4] 张科, 刘海鹏, 李恒年, 等.SINS/GPS/CNS组合导航联邦滤波算法[J]. 中国惯性技术学报, 2013, 21(2):226-230.
[5] 周琪. 大飞机全球惯性导航算法研究[D]. 西安:西北工业大学, 2013.
[6] CHANG L, HU B, LI Y. Backtracking integration for fast attitude determination-based initial alignment[J]. IEEE Transactions on Instrumentation and Measurement, 2015, 64(3):795-803.
[7] CHANG L, LI J, CHEN S. Initial alignment by attitude estimation for strapdown inertial navigation systems[J]. IEEE Transactions on Instrumentation and Measurement, 2015, 64(3):784-794.
[8] TANG X, LIU Z, ZHANG J. Square-root quaternion cubature Kalman filtering for spacecraft attitude estimation[J]. Acta Astronautica, 2012, 76:84-94.
[9] O'KEEFE S A, SCHAUB H. Shadow set considerations for modified rodrigues parameter attitude filtering[J]. Journal of Guidance, Control, and Dynamics, 2014, 37(6):2030-2035.
[10] BITTANTI S, SAVARESI S M. On the parametrization and design of an extended Kalman filter frequency tracker[J]. IEEE Transactions on Automatic Control, 2000, 45(9):1718-1724.
[11] KIM K H, LEE J G, PARK C G, Adaptive two-stage extended Kalman filter for a fault-tolerant INS-GPS loosely coupled system[J]. IEEE Transactions on Aerospace and Electronic Systems, 2009, 45(1):125-137.
[12] 常路宾. Unscented Kalman滤波及其在捷联惯导中的应用研究[D]. 武汉:海军工程大学, 2014.