基于UPF的GPS/SINS组合导航系统设计
The Design of GPS/SINS Integrated Navigation System Based on UPF
-
摘要: 建立了GPS/INS非线性误差模型,利用UPF滤波算法实现了该组合系统定位功能,一方面针对UKF估计误差协方差极易非正定的问题进行了正定化处理;另一方面在粒子滤波环节针对重采样导致的粒子多样性降低的问题,增加了MCMC移动步骤.实验结果表明:应用UPF实现的组合导航系统定位精度明显优于EKF和UKF,且定位误差波动幅度较小,既能够满足非线性系统的导航精度要求,又能够满足定位系统对滤波稳定性的要求.Abstract: The un-linear error model with GPS/INS has been built,and the UPF has used to make the function of position of integrated navigation realized.In order to solve the problem of the non-positive definite of estimation error covariance in UKF,the positive processing has been adopted.In additional,MCMC has been adopted to decrease the particles impoverishment.The experiment results show that:UPF has better accuracy than UKF and EKF,and the fluctuation of the error is rather small,which make the accuracy and robust requirements of the navigation system on satisfied.