北斗拒止条件下捷联惯导系统鲁棒自适应动态对准方法

摘要

本发明属于自适应滤波技术领域，公开了一种北斗拒止条件下捷联惯导系统鲁棒自适应动态对准方法，初始对准滤波模型的构建；进行卡尔曼滤波时间更新；计算观测量与观测新息之间的马氏距离，进行观测新息权值计算；基于Sage‑Husa滤波方法重新定义R阵自适应估计方程使其具有鲁棒性，并对R阵进行鲁棒自适应估计；通过引入膨胀因子，修正估计出的R阵；利用修正后的R阵进行KF的量测更新。本发明既能够保证R阵的鲁棒自适应性，也能保证整个滤波器的鲁棒性，即能在对R阵进行自适应估计的同时，实现鲁棒滤波。本发明的鲁棒自适应KF算法能够在复杂环境下实现对R阵的实时估计，有效克服观测异常值的不良影响。