一種多衛(wèi)星系統(tǒng)與捷聯(lián)慣性導(dǎo)航系統(tǒng)緊組合導(dǎo)航方法
【專利摘要】本發(fā)明公開了一種多衛(wèi)星系統(tǒng)與捷聯(lián)慣性導(dǎo)航系統(tǒng)緊組合導(dǎo)航方法,首先對IMU輸出數(shù)據(jù)捷聯(lián)解算獲得SINS當(dāng)前姿態(tài)、速度、位置信息。對衛(wèi)星星歷報文進行星歷解算得到各衛(wèi)星位置、速度,各衛(wèi)星系統(tǒng)時空統(tǒng)一,進行衛(wèi)星選星。其次,利用選取的衛(wèi)星位置、速度信息與捷聯(lián)解算得到的SINS位置、速度信息計算得到SINS偽距、偽距率。再次,利用GNSS輸出的原始測量數(shù)據(jù),即測碼偽距和多普勒頻移,與SINS偽距、偽距率進行比較,將差值作為濾波器的觀測量,經(jīng)過濾波器的最優(yōu)估計,給出校正SINS的補償量,閉環(huán)校正,得到SINS姿態(tài)、速度、位置最優(yōu)解。本發(fā)明解決了慣導(dǎo)與單衛(wèi)星組合導(dǎo)航在高樓遮擋、樹木掩蓋等復(fù)雜環(huán)境下衛(wèi)星數(shù)目過少影響緊組合導(dǎo)航精度的問題。
【專利說明】一種多衛(wèi)星系統(tǒng)與捷聯(lián)慣性導(dǎo)航系統(tǒng)緊組合導(dǎo)航方法
【技術(shù)領(lǐng)域】
[0001]本發(fā)明屬于導(dǎo)航【技術(shù)領(lǐng)域】,具體涉及一種多衛(wèi)星系統(tǒng)與捷聯(lián)慣性導(dǎo)航系統(tǒng)緊組合導(dǎo)航方法,特別適用于高樓遮擋、樹木掩蓋等復(fù)雜環(huán)境下衛(wèi)星數(shù)目過少的情況下的組合解
笪
【背景技術(shù)】
[0002]慣性導(dǎo)航以牛頓經(jīng)典運動力學(xué)定律為基礎(chǔ),是一種利用慣性測量元件測量載體的角運動和線運動參數(shù)、在初始狀態(tài)基礎(chǔ)上進行遞推來確定運載體姿態(tài)、速度和位置的自主式推算導(dǎo)航方法。目前,慣性導(dǎo)航技術(shù)已發(fā)展較為成熟,但在遠程、長時間航行及武器發(fā)射等高精度導(dǎo)航時還不能完全滿足要求,其主要缺點是導(dǎo)航定位誤差隨時間積累。導(dǎo)航誤差主要由初始對準的精度、慣性傳感器的誤差以及載體運動軌跡的動態(tài)特性決定,長時間獨立工作后誤差會發(fā)散很快。組合導(dǎo)航技術(shù)的出現(xiàn)為這一問題的解決提供了一種有效途徑,衛(wèi)星導(dǎo)航能夠?qū)崟r的測定載體速度和位置,與慣性導(dǎo)航系統(tǒng)組合在一起,通過信息融合技術(shù)可進一步提高導(dǎo)航系統(tǒng)的精度。目前,組合導(dǎo)航技術(shù)已成為導(dǎo)航技術(shù)發(fā)展的重要方向之一。但是在高樓遮擋、數(shù)目掩蓋等復(fù)雜環(huán)境下衛(wèi)星數(shù)目過少的情況下,單一的衛(wèi)星與捷聯(lián)慣性導(dǎo)航系統(tǒng)組合導(dǎo)航解算精度下降。
【發(fā)明內(nèi)容】
[0003]針對慣導(dǎo)與單衛(wèi)星組合導(dǎo)航在高樓遮擋、樹木掩蓋等復(fù)雜環(huán)境下衛(wèi)星數(shù)目過少影響緊組合導(dǎo)航精度的問題,本發(fā)明提出一種多衛(wèi)星系統(tǒng)與慣性導(dǎo)航系統(tǒng)緊合導(dǎo)航的方法。
[0004]一種多衛(wèi)星系統(tǒng)與捷聯(lián)慣性導(dǎo)航系統(tǒng)緊組合導(dǎo)航方法,包括以下步驟:
[0005](I)對慣性測量元件(MU)輸出數(shù)據(jù)通過捷聯(lián)解算獲得捷聯(lián)慣導(dǎo)當(dāng)前姿態(tài)、速度、位置,對衛(wèi)星系統(tǒng)接收機輸出的星歷報文進行衛(wèi)星數(shù)據(jù)處理,獲得衛(wèi)星的速度、位置信息;
[0006](2)利用衛(wèi)星速度、位置與SINS位置、速度信息通過SINS偽距、偽距率計算得到SINS偽距、偽距率;
[0007](3)從衛(wèi)星系統(tǒng)接收機輸出的偽距報文獲得測碼偽距和多普勒頻移,與SINS偽距、偽距率進行比較,將差值作為濾波器的觀測量,建立緊組合狀態(tài)模型及量測模型,經(jīng)過最優(yōu)估計與濾波,輸出系統(tǒng)的誤差校正量;對系統(tǒng)誤差進行校正,輸出SINS姿態(tài)、速度、位置的最優(yōu)組合解。
[0008]所述的捷聯(lián)解算算法是利用IMU測量載體的角運動和線運動參數(shù),在初始狀態(tài)基礎(chǔ)上進行遞推來確定安裝了 SINS的運載體姿態(tài)、速度和位置的自主式推斷導(dǎo)航。
[0009]所述的衛(wèi)星數(shù)據(jù)處理包括衛(wèi)星選星、衛(wèi)星星歷解算及衛(wèi)星系統(tǒng)數(shù)據(jù)融合。
[0010]所述的SINS偽距、偽距率計算過程是由SINS的位置,衛(wèi)星的位置計算得到相應(yīng)于SINS所在位置處的偽距;由SINS的速度、衛(wèi)星的速度,獲得SINS相對于衛(wèi)星相對運動即SINS的偽距變化率。
[0011]所述的最優(yōu)估計與濾波采用的是卡爾曼濾波器。[0012]所述的緊組合狀態(tài)模型及量測模型的建立方法如下:
[0013](I)多系統(tǒng)緊組合狀態(tài)方程建立
[0014]將捷聯(lián)誤差方程和衛(wèi)星系統(tǒng)建模轉(zhuǎn)為狀態(tài)方程描述
[0015]
【權(quán)利要求】
1.一種多衛(wèi)星系統(tǒng)與捷聯(lián)慣性導(dǎo)航系統(tǒng)緊組合導(dǎo)航方法,其特征在于,包括以下步驟: (1)對慣性測量元件aMU)輸出數(shù)據(jù)通過捷聯(lián)解算獲得捷聯(lián)慣導(dǎo)當(dāng)前姿態(tài)、速度、位置,對衛(wèi)星系統(tǒng)接收機輸出的星歷報文進行衛(wèi)星數(shù)據(jù)處理,獲得衛(wèi)星的速度、位置信息; (2)利用衛(wèi)星速度、位置與SINS位置、速度信息通過SINS偽距、偽距率計算得到SINS偽距、偽距率; (3)從衛(wèi)星系統(tǒng)接收機輸出的偽距報文獲得測碼偽距和多普勒頻移,與SINS偽距、偽距率進行比較,將差值作為濾波器的觀測量,建立緊組合狀態(tài)模型及量測模型,經(jīng)過最優(yōu)估計與濾波,輸出系統(tǒng)的誤差校正量;對系統(tǒng)誤差進行校正,輸出SINS姿態(tài)、速度、位置的最優(yōu)組合解。
2.根據(jù)權(quán)利要求1所述的多衛(wèi)星系統(tǒng)與捷聯(lián)慣性導(dǎo)航系統(tǒng)緊組合導(dǎo)航方法,其特征是:所述的捷聯(lián)解算算法是利用MU測量載體的角運動和線運動參數(shù),在初始狀態(tài)基礎(chǔ)上進行遞推來確定安裝了 SINS的運載體姿態(tài)、速度和位置的自主式推斷導(dǎo)航。
3.根據(jù)權(quán)利要求1所述的多衛(wèi)星系統(tǒng)與捷聯(lián)慣性導(dǎo)航系統(tǒng)緊組合導(dǎo)航方法,其特征是:所述的衛(wèi)星數(shù)據(jù)處理包括衛(wèi)星選星、衛(wèi)星星歷解算及衛(wèi)星系統(tǒng)數(shù)據(jù)融合。
4.根據(jù)權(quán)利要求 1所述的一種多衛(wèi)星系統(tǒng)與捷聯(lián)慣性導(dǎo)航系統(tǒng)緊組合導(dǎo)航方法,其特征是:所述的SINS偽距、偽距率計算過程是由SINS的位置,衛(wèi)星的位置計算得到相應(yīng)于SINS所在位置處的偽距;由SINS的速度、衛(wèi)星的速度,獲得SINS相對于衛(wèi)星相對運動即SINS的偽距變化率。
5.根據(jù)權(quán)利要求1所述的一種多衛(wèi)星系統(tǒng)與捷聯(lián)慣性導(dǎo)航系統(tǒng)緊組合導(dǎo)航方法,其特征是:所述的最優(yōu)估計與濾波采用的是卡爾曼濾波器。
6.根據(jù)權(quán)利要求1所述的一種多衛(wèi)星系統(tǒng)與捷聯(lián)慣性導(dǎo)航系統(tǒng)緊組合導(dǎo)航方法,其特征是:所述的緊組合狀態(tài)模型及量測模型的建立方法如下: (I)多系統(tǒng)緊組合狀態(tài)方程建立 將捷聯(lián)誤差方程和衛(wèi)星系統(tǒng)建模轉(zhuǎn)為狀態(tài)方程描述
7.根據(jù)權(quán)利要求3所述的多衛(wèi)星系統(tǒng)與捷聯(lián)慣性導(dǎo)航系統(tǒng)緊組合導(dǎo)航方法,其特征是:所述的衛(wèi)星選星即選擇合適的衛(wèi)星進行導(dǎo)航解算,具體過程為:首先,判斷各衛(wèi)星系統(tǒng)衛(wèi)星數(shù)目;若某衛(wèi)星系統(tǒng)衛(wèi)星數(shù)目小于兩顆,則將該系統(tǒng)排除;其次,若采用單獨衛(wèi)星與SINS組合導(dǎo)航,選取4星組合;若采用雙星座系統(tǒng)與SINS組合,增加衛(wèi)星系統(tǒng)的同步誤差未知數(shù),至少需要5顆星進行導(dǎo)航解算即3+2模式;若采用三個衛(wèi)星系統(tǒng)與SINS組合時需要6顆星進行定位解算即2+2+2模式;若采用四個衛(wèi)星系統(tǒng)組合時需要8顆星進行定位解算即2+2+2+2模式;最后,在選取衛(wèi)星總數(shù)目及各個衛(wèi)星系統(tǒng)數(shù)目滿足的前提下按照最大矢端多面體體積法或最小二乘法的選星算法進行選星。
8.根據(jù)權(quán)利要求3所述的一種多衛(wèi)星系統(tǒng)與捷聯(lián)慣性導(dǎo)航系統(tǒng)緊組合導(dǎo)航方法,其特征是:所述的衛(wèi)星星歷解算算法是指判斷衛(wèi)星系統(tǒng)輸出的星歷報文的格式,根據(jù)不同衛(wèi)星系統(tǒng)星歷報文的格式進行星歷解析;衛(wèi)星系統(tǒng)星歷按照格式分為兩種:類GPS的廣播星歷參數(shù)格式及類GLONASS的廣播星歷參數(shù)格式;類GPS的廣播星歷參數(shù)格式的報文解析采用衛(wèi)星位置算法;類GLONASS的廣播星歷參數(shù)格式的報文解析采用推導(dǎo)運動方程積分運算方法。
9.根據(jù)權(quán)利要求3所述的一種多衛(wèi)星系統(tǒng)與捷聯(lián)慣性導(dǎo)航系統(tǒng)緊組合導(dǎo)航方法,其特征是:所述的衛(wèi)星系統(tǒng)數(shù)據(jù)融合具體為選擇主衛(wèi)星系統(tǒng),其它輔助衛(wèi)星系統(tǒng)按照主衛(wèi)星系統(tǒng)的參考時間、坐標系進行時間、坐標的轉(zhuǎn)換。
10.根據(jù)權(quán)利要求7所述的一種多衛(wèi)星系統(tǒng)與捷聯(lián)慣性導(dǎo)航系統(tǒng)緊組合導(dǎo)航方法,其特征是:所述的3+2模式即雙星座與SINS組合時,一個衛(wèi)星系統(tǒng)選取3顆衛(wèi)星另一個系統(tǒng)選取2顆衛(wèi)星;所述的2+2+2模式指三個衛(wèi)星系統(tǒng)分別選取兩顆衛(wèi)星;所述的2+2+2+2模式為四個衛(wèi)星系統(tǒng)分別選取兩顆衛(wèi)星。
【文檔編號】G01S19/49GK103969672SQ201410204477
【公開日】2014年8月6日 申請日期:2014年5月14日 優(yōu)先權(quán)日:2014年5月14日
【發(fā)明者】張濤, 宮淑萍, 徐曉蘇, 王立輝, 李瑤, 李佩娟 申請人:東南大學(xué)