基于信息预评判及补偿修正的SINS/DVL/ES组合导航方法
摘要:
本发明提供了一种基于信息预评判及导航结果补偿修正的SINS/DVL/ES组合导航方法。本发明在SINS/DVL组合前对DVL的数据有效性进行判断,当DVL数据信息无效时,DVL导航信息不参与组合导航;同时,本发明将残差x2检测法引入,对组合导航结果是否平稳进行评估,并设计了组合导航结果振荡时的补偿修正方法对Kalman输出结果进行实时评判和修正补偿。本发明既能有效抑制SINS/DVL组合导航姿态、速度的发散速度,提高组合系统姿态、速度精度,在一定程度上提高位置精度;又能解决在DVL数据信息质量下降所带来姿态误差的振荡问题。
0/0