[发明专利]基于PSTCSDREF算法的无人机INS BDS组合导航方法

摘要

本发明公开了一种基于PSTCSDREF算法的无人机INS BDS组合导航方法，旨在解决现有的导航系统滤波精度低，滤波稳定性差的技术问题。本发明首先建立INS/BDS组合导航系统的直接法状态方程和量测方程，然后对组合导航系统方程进行离散化，最后利用PSTCSDREF算法降低测量信息中的偏差对组合导航系统的不利影响；PSRCSDREF首先使用“consider”方法将偏差的统计信息合并到状态估计方程中，同时将自适应渐消因子引入到PSTCSDREF中。本发明的有益技术效果在于：提高导航的精度和稳定性，使得组合导航系统能够高效实时地估计无人机状态。