柏猛, 赵晓光, 侯增广. 一种序贯Unscented卡尔曼滤波在微小型无人直升机导航系统中的应用[J]. 机器人, 2008, 30(3): 205-209..
BAI Meng, ZHAO Xiao-guang, HOU Zeng-guang. Application of a Sequential Unscented Kalman Filter to the Navigation System of Small Unmanned Helicopters. ROBOT, 2008, 30(3): 205-209..
Abstract:For the low-cost SINS/GPS integrated navigation system used in small unmanned helicopters,the Ψ angle model of SINS is not competent for SINS error estimation due to the neglected error terms when describing low precision inertial sensor errors.To overcome the disadvantages of Ψ angle model,a nonlinear error model of SINS based on quaternion is presented in this paper.Small misalignment angle assumption is not required in the error model.To estimate SINS errors of integrated navigation system,a sequential Unscented Kalman filtering approach is proposed.Computational complexity of the algorithm is reduced by sequentially processing measurement vectors.Simulation results reveal that the filtering approach can improve the performance of low-cost SINS/GPS integrated navigation system effectively.
[1] 邓寅喆,黄圣财,刘亮,等.超小型无人驾驶直升机研究现状[J].机电一体化,2004,10(1):18-21.
[2] Grewal M S,Weill L R,Andrews A P.Global Positioning systems.Inertial Navigation,and Integration[M].Hoboken,NJ,USA:John Wiley and Sons,lnc.,2000.
[3] Julier S J,Uhlmann J K.Unscented filtering and nonlinear estimation[J].Proceedings of the IEEE,2004,92(3):401-422.
[4] Wan E A,Van Der Merwe R.The unscented Kalman filter for nonlinear estimation[A].Proceedings of the IEEE Symposium on Adaptive Systems for Signal Processing,Communication and Control[C].Piscataway,NJ,USA:IEEE,2000.153-158.
[5] Julier S,Uhlmann J,Durrant-Whyte H F.A new method for the nonlinear transformation of means and covariances in filters and estimators[J].IEEE Transactions on Automatic Control,2000,45(3):477-482.
[6] Yu M J,Lee J G.Park H W.Comparison of SDINS in-flight alignment using equivalent error models[J].IEEE Transactions on Aerospace and Electronic systems,1999,35(3):1046-1054.
[7] Gul F,Fang J c,Gaho A A.GPS/SINS navigation data fusion using quaternion model and unscented Kalman filter[A].Proceedings of the IEEE International Conference on Mechatronics and Automation[C].Piscataway,NJ,USA:IEEE,2006.1854-1859.
[8] Kong x Y.INS algorithm using quaternion model for low cost IMU[J].Robotics and Autonomous Systems,2004,46(4):221-246.
[9] 沈忠,俞文伯,房建成.基于UKF的低成本SINS/GPS组合导航统滤波算法[J].系统工程与电子技术,2007,29(3):408-411.
[10] 秦永元.惯性导航[M].北京:科学出版社,2006.