摘要
为改善INS/CNS/GPS组合导航系统输出姿态信息的稳定性,解决传统FKF算法非线性条件下姿态精度发散的问题,提出了一种基于UKF的FKF滤波算法;同时为解决各系统间时间信息不同步造成姿态精度下降的问题,提出了一种工程上可用的时间同步方案,同步精度优于0.5 ms。在实验室条件下,利用INS/GPS/CNS样机和高精度三轴转台搭建验证系统进行摇摆试验,试验结果表明,提出的方法可实现姿态误差值变化在5%以内条件下系统稳定工作一天以上。
In order to improve the stability of the output attitude information of INS/CNS/GPS integrated navigation system and solve the problem of divergence of attitude accuracy under the nonlinear condition of traditional FKF algorithm, a data fusion algorithm of federated Kalman filter based on unscented Kalman filter is proposed. Meanwhile, to improve the output frequency of attitude information, a high frequency output scheme is proposed, which can be used in engineering, and the synchronization accuracy is better than0.5 ms. Under laboratory conditions, the INS/GPS/CNS prototype and high-precision three-axis turntable are used to build the verification system for testing the effectiveness of the proposed method. The experimental results show that the proposed method can make the system work continuously for more than one day with attitude stability being less than 5%.
引文
[1]Topakci U.Design of a Remote-controlled and GPS-guided autonomous robot for precision farming[J].International Journal of Advanced Robotic Systems,2015194(12):1-10.
[2]Paul A,Haralambous H,Oikonomou C.Characteristics of post-midnight L band scintillation in the transition region from the equatorial to midlatitudes over the Indian longitude sector using COSMIC,C/NOFS,and GPS measurements[J].Radio Science,2015,50(12):1246-1255.
[3]Hu G,Gao S,Zhong Y,et al.Matrix weighted multisensor data fusion for INS/GNSS/CNS integration[J].Proceedings of the Institution of Mechanical engineers Part G:Journal of Aerospace Engineering,2016,230(6):1011-1026.
[4]Deng H,Liu G,Chen H,et al.The application of federated Kalman filtering in SINS/GPS/CNS integrated navigation system[J].International Journal of Wireless and Microwave Technologies,2012,2(2):12-19.
[5]Xiong Z,Chen J,Wang R,et al.A new dynamic vector formed information sharing algorithm in federated filter[J].Aerospace Science and Technology,2013,29(1):37-46.
[6]赵岩,高社生,冯鹏程.临近空间伪卫星抗风场干扰自主导航[J].中国惯性技术学报,2013,21(3):359-364.Zhao Y,Gao S,Feng P.Autonomous navigation of near space pseudolite under wind field disturbance[J].Journal of Chinese Inertial Technology,2013,21(3):359-364.
[7]Huang J,Yan B.Federated filter based on dynamic information allocation with unscented Kalman filter[C]//International Conference on Electrical,Computer Engineering and Electronics.2015:911-916.
[8]陈帅,蒋长辉,付梦印,等.一种GNSS/SINS容错深组合导航系统设计[J].中国惯性技术学报,2017,25(1):77-80.Chen S,Jiang C,Fu M,et al.Design of fault-tolerant GNSS/SINS deep-integration system[J].Journal of Chinese Inertial Technology,2017,25(1):77-80.
[9]Zhang T,Chen K,Fu W.Optimal two-iteration sculling compensation mathematical framework for SINS velocity updating[J].Journal of Systems Engineering and Electronics,2014,25(6):1065-1071.
[10]Gao S,Zhong Y,Shirinzadeh B.Random weighting estimation for fusion of multi-dimensional position data[J].Information Sciences,2010,180(24):4999-5007.