惯性与卫星组合导航系统渐变型故障回溯容错方法

摘要

本发明提供的是一种惯性与卫星组合导航系统渐变型故障回溯容错方法。进行惯导系统初始对准；采集并滑动存储传感器数据；利用状态卡方和残差卡方混合检测方法对卫星导航位置信息进行渐变型故障检测和辨识，当卫星导航无故障时，切入惯性/卫星组合导航模式，对卫星导航输出信息进行融合；当卫星导航处于渐变型故障时，进行惯导回溯算法和卡尔曼回溯算法，得未融合第k‑1时刻卫星渐变型故障信息的姿态矩阵、速度和位置；回溯到卫星导航故障点，进行纯惯导追溯解算，递推到第k采样时刻，输出隔离卫星历史故障信息后的姿态、速度和位置信息。本发明能够有效判断卫星导航渐变型故障，并进行惯导和卡尔曼回溯算法对故障进行容错处理，避免历史故障信息污染。