Robust Adaptive Interpolation Particle Filtering and Application in Integrated Navigation System
GAO She-sheng,SONG Fei-biao,XUE Li
DOI: https://doi.org/10.3969/j.issn.1005-6734.2012.02.010
2012-01-01
Abstract:This paper presents a robust adaptive interpolation particle filtering algorithm,which overcomes the drawbacks of particle filtering,such as the particle would produce degradation,and the importance density function is difficult to choose.The algorithm absorbs the advantages of robust adaptive filtering,second-order interpolation filtering and particle filtering.It obtains the importance density function by second-order interpolation filtering,and controls the effects of dynamic model errors and abnormal observation on the navigation solution by robust adaptive factor.The proposed algorithm is applied to SINS/CNS/SAR integrated navigation system,and compared with the classical particle filtering.The simulation results demonstrate that the attitude error,velocity error and position error of the robust adaptive interpolation particle filtering are within [-0.3′,+0.3′],[-0.4 m/s,+0.4 m/s] and [-5 m,+5 m] respectively,and the filtering performance is significantly superior to that of the classical particle filtering.The new filtering algorithm can not only effectively inhibit the particle degradation,but also effectively control the impact of dynamic model error and abnormal observation,thus improving the accuracy of integrated navigation filter.