一種基于GNSS/INS深組合導航的雙速率卡爾曼濾波方法
本發(fā)明公開了一種基于GNSS/INS深組合導航的雙速率卡爾曼濾波方法,包括以下步驟:
1、根據(jù)載體的初始位置、速率和姿態(tài)信息構建狀態(tài)方程,初始化卡爾曼濾波的參數(shù);
2、進行M步步長的狀態(tài)預測更新,得到先驗狀態(tài)量的預測值。
3、對先驗狀態(tài)量進行修正,得到后驗狀態(tài)量的預測值。
4、對狀態(tài)量的誤差和系統(tǒng)誤差協(xié)方差矩陣進行自適應更新,并用后驗狀態(tài)量預測值對慣性導航結果進行補償,得到載體位置、速度與姿態(tài)信息;
5、補償完成后更新該方法可以在GNSS/INS深組合導航的數(shù)據(jù)融合算法過程中,降低因GNSS衛(wèi)星數(shù)據(jù)更新頻率低或衛(wèi)星數(shù)據(jù)失鎖導致的截斷誤差;同時解決因INS數(shù)據(jù)與GNSS數(shù)據(jù)不同步導致的導航定位誤差。
東南大學
2021-04-11