视觉/惯性导航抗有色噪声滤波算法设计与仿真

实际视觉/惯性组合导航中存在的噪声往往是相关的,必须考虑有色噪声影响,有色噪声的存在易导致视觉/惯性组合导航滤波算法的性能下降甚至发散。在分析视觉/惯性组合导航的结构组成和建立起系统状态方程的基础上,分别针对过程有色噪声和量测有色噪声情形,提出采用状态扩展法和量测状态扩展法对导航系统方程中的有色噪声进行处理,并以选定的优化准则进行滤波算法设计来解决有色噪声干扰问题。数值仿真实验证实所设计的抗有色噪声滤波方法性能稳定有效。