基于最優(yōu)濾波的衛(wèi)星和慣性組合導(dǎo)航方法

丁陽+張書雨

摘 要：針對目前三種主流導(dǎo)航方法各自的不足，提出了一種基于最優(yōu)濾波法的衛(wèi)星、慣性組合導(dǎo)航方法，采集這兩種導(dǎo)航系統(tǒng)實(shí)時(shí)測量得到的偽距、偽距率的差值，通過設(shè)計(jì)合適的最優(yōu)濾波器，以校正系統(tǒng)誤差，獲得高精度位置、速度、姿態(tài)的用戶定位結(jié)果，從而彌補(bǔ)了慣性導(dǎo)航誤差隨時(shí)間離散和衛(wèi)星導(dǎo)航易受外界電磁環(huán)境干擾、無法直接提供用戶姿態(tài)信息的問題。

關(guān)鍵詞：衛(wèi)星導(dǎo)航 最優(yōu)濾波 組合導(dǎo)航

中圖分類號：U666 文獻(xiàn)標(biāo)識碼：A 文章編號：1674-098X（2014）11（c）-0001-02

Abstract：Aiming at the shortages of the current three popular navigation methods，this paper proposed a difference of pseudorange and pseudorange rate based satellite and inertial integrated navigation method.This method uses the pseudorange and pseudorange rate measured by the satellite navigation system and inertial navigation system to do optimal estimation， to correct the system error and obtain high positioning results including location， velocity and attitude.Make it up that system error disperse and being easily disturbed and unable to directly export posture information.

Key Words：Satellite Nnavigation；Optimal Filter；Integrated Navigation

在21世紀(jì)，隨著導(dǎo)航定位系統(tǒng)在軍事、交通、農(nóng)業(yè)、漁業(yè)等重要領(lǐng)域的廣泛應(yīng)用，人們對導(dǎo)航定位系統(tǒng)的精度、可靠性、自主性提出了越來越高的要求。目前比較常用的導(dǎo)航定位技術(shù)中，主要有衛(wèi)星導(dǎo)航、慣性導(dǎo)航、天文導(dǎo)航等。這三種導(dǎo)航技術(shù)種，每一種導(dǎo)航技術(shù)都在其導(dǎo)航性能上體現(xiàn)出其他導(dǎo)航系統(tǒng)不可替代的特征，都有其專屬的應(yīng)用領(lǐng)域。

衛(wèi)星導(dǎo)航是一種能夠全天時(shí)、全天候提供高精度的位置和速度信息的導(dǎo)航技術(shù)，依靠覆蓋本區(qū)域的導(dǎo)航衛(wèi)星和專用的導(dǎo)航定位儀器來完成導(dǎo)航定位，定位精度取決于系統(tǒng)總體指標(biāo)，不受天氣、時(shí)間等環(huán)境因素的影響；缺點(diǎn)是難以直接提供姿態(tài)信息，而且容易受到其他電磁信號干擾。慣性導(dǎo)航是一種完全獨(dú)立自主、能夠提供連續(xù)的全部運(yùn)動(dòng)參數(shù)的導(dǎo)航技術(shù)，在較短的時(shí)間內(nèi)，能夠達(dá)到較高的精度；缺點(diǎn)是其誤差會隨著導(dǎo)航系統(tǒng)運(yùn)行時(shí)間的延長不斷積累，連續(xù)導(dǎo)航時(shí)間越長，各運(yùn)動(dòng)參數(shù)的誤差就越大。天文導(dǎo)航是一種能夠提供位置和姿態(tài)信息且誤差不隨時(shí)間積累的導(dǎo)航技術(shù)，但會極大的受到天氣條件的限制，且其導(dǎo)航精度不高。

因而，目前單一的導(dǎo)航手段并不能滿足當(dāng)今社會對導(dǎo)航系統(tǒng)高精度、高可靠度、高自主性的要求。這里介紹一種衛(wèi)星、慣性組合導(dǎo)航的方法，充分利用衛(wèi)星導(dǎo)航和慣性導(dǎo)航的優(yōu)勢，使兩種導(dǎo)航方法能夠互補(bǔ)優(yōu)缺，達(dá)到較好的導(dǎo)航性能。

1 基本導(dǎo)航原理

目前國際上，建成的衛(wèi)星導(dǎo)航系統(tǒng)主要有美國的GPS、中國的COMPASS、俄羅斯的GLONASS等，這些系統(tǒng)可統(tǒng)稱為全球?qū)Ш叫l(wèi)星系統(tǒng)（Global Navigation Satellite System，GNSS）。一般主要分為空間衛(wèi)星星座、用戶機(jī)、地面監(jiān)測網(wǎng)三部分。由用戶機(jī)接收和處理衛(wèi)星發(fā)送的導(dǎo)航信號，得到用戶本身的位置、速度等信息。用戶機(jī)解算位置信息的基本原理為利用不同衛(wèi)星的信號時(shí)延進(jìn)行三維定位，由于用戶機(jī)和衛(wèi)星的時(shí)鐘存在誤差，故需要同時(shí)接收到至少四顆衛(wèi)星的信號才能完成定位解算。其原理如圖1、圖2所示。

慣性導(dǎo)航則以牛頓力學(xué)為基礎(chǔ)，用一個(gè)陀螺儀來建立導(dǎo)航坐標(biāo)，利用加速度計(jì)來測量用戶的實(shí)時(shí)加速度，將實(shí)時(shí)加速度轉(zhuǎn)換到導(dǎo)航坐標(biāo)系中，通過一次積分運(yùn)算得出實(shí)時(shí)速度，再一次積分運(yùn)算得出實(shí)時(shí)位置。其原理如圖3、圖4所示。

2 衛(wèi)星、慣性組合導(dǎo)航

衛(wèi)星、慣性組合導(dǎo)航的基本模式為采用衛(wèi)星導(dǎo)航系統(tǒng)測量得到一組用戶當(dāng)前的偽距值和偽距率值，采用慣性導(dǎo)航系統(tǒng)測量用戶的位置和速度，換算得到另一組用戶當(dāng)前的偽距值和偽距率值；將二者的差值作為測量量，通過最優(yōu)濾波器估計(jì)出當(dāng)前組合導(dǎo)航系統(tǒng)的誤差，對當(dāng)前用戶的位置、速度等參數(shù)進(jìn)行校正。

衛(wèi)星、慣性組合導(dǎo)航系統(tǒng)以衛(wèi)星導(dǎo)航系統(tǒng)誤差方程和慣性導(dǎo)航系統(tǒng)誤差方程為狀態(tài)方程，方程的輸入為衛(wèi)星導(dǎo)航系統(tǒng)、慣性導(dǎo)航系統(tǒng)各自輸出的數(shù)據(jù)差值，方程的輸出為經(jīng)過最優(yōu)估計(jì)的系統(tǒng)誤差。

設(shè)計(jì)組合導(dǎo)航系統(tǒng)的最優(yōu)濾波器，應(yīng)建立系統(tǒng)狀態(tài)方程和差分方程，一般采用兩種方法：一種為直接采用各導(dǎo)航系統(tǒng)測量值為估計(jì)對象，以下簡稱為直接法；對于直接法，其狀態(tài)變量具有數(shù)值大、變化快的特點(diǎn)，狀態(tài)方程為非線性，都會造成估計(jì)精度的下降。另一種為采用各導(dǎo)航系統(tǒng)的誤差作為估計(jì)對象，以下簡稱為間接法。間接法的狀態(tài)變量數(shù)值較小，變化緩慢，往往采用非線性方程即可準(zhǔn)確描述（見圖5、圖6）。

最優(yōu)濾波器得出系統(tǒng)誤差的估計(jì)值后，工程上有兩種主流的校正導(dǎo)航參數(shù)的方法：一是利用估計(jì)值直接校正組合導(dǎo)航系統(tǒng)最終輸出的位置、速度，以下簡稱為輸出校正法，這種方法工程上實(shí)現(xiàn)簡單，但不能修正系統(tǒng)內(nèi)部的狀態(tài)誤差，導(dǎo)航時(shí)間足夠長后，系統(tǒng)誤差仍然會不可控的上升。二是利用估計(jì)值校正組合導(dǎo)航系統(tǒng)各子系統(tǒng)的解算流程中，以下簡稱為反饋校正法。這種方法雖然工程上實(shí)現(xiàn)起來比較困難，但能夠隨時(shí)修正系統(tǒng)誤差，所以能保證在長時(shí)段導(dǎo)航中保持較高的精度（見圖7、圖8）。

如圖9所示，慣性導(dǎo)航的測量誤差將隨時(shí)間推移加速上升，原因?yàn)榧铀俣扔?jì)的測量值誤差積累后，會以平方形式反映到定位結(jié)果中。而衛(wèi)星導(dǎo)航的誤差在同等天氣條件下，只取決于導(dǎo)航系統(tǒng)誤差，不隨時(shí)間變化。

通過仿真，可以得到經(jīng)過輸出校正法和反饋校正法后，兩種組合導(dǎo)航方式的誤差-時(shí)間曲線。如圖10所示，深藍(lán)色為輸出校正法曲線，淺藍(lán)色為反饋校正法曲線，可以看出，輸出校正法由于直接出輸出結(jié)果做校正，再后期會越來越多的受到慣性導(dǎo)航誤差的影響；而反饋校正法則通過不斷修正系統(tǒng)內(nèi)部誤差，在誤差發(fā)散的趨勢上要比輸出校正法收斂。

3 結(jié)語

組合導(dǎo)航系統(tǒng)是隨著計(jì)算機(jī)、最優(yōu)濾波原理的發(fā)展而迅速發(fā)展起來的一種多系統(tǒng)、多功能、高可靠性的導(dǎo)航系統(tǒng)。目前組合導(dǎo)航系統(tǒng)已在國內(nèi)外航空、航天、航海和陸地車輛的導(dǎo)航定位中得到廣泛應(yīng)用，它是導(dǎo)航技術(shù)發(fā)展的主要方向之一。每種單一導(dǎo)航系統(tǒng)都有各自的獨(dú)特性能和局限性。把幾種不同的單一系統(tǒng)組合在一起，就能利用多種信息源，互相補(bǔ)充，構(gòu)成一種有多余度和導(dǎo)航準(zhǔn)確度更高的多功能系統(tǒng)。

參考文獻(xiàn)

[1] 秦永元，張洪鉞，江叔華.卡爾曼濾波與組合導(dǎo)航原理[M].西安：西北工業(yè)大學(xué)出版社，1998.

[2] 袁信，俞濟(jì)祥.導(dǎo)航系統(tǒng)[M].沈陽：航空工業(yè)出版社，1993.

[3] Integrated Navigation and Guidance Systems.American Institute of Aeronautics and Astronautics，Inc，Daniel J.Biezad，1999.endprint

摘 要：針對目前三種主流導(dǎo)航方法各自的不足，提出了一種基于最優(yōu)濾波法的衛(wèi)星、慣性組合導(dǎo)航方法，采集這兩種導(dǎo)航系統(tǒng)實(shí)時(shí)測量得到的偽距、偽距率的差值，通過設(shè)計(jì)合適的最優(yōu)濾波器，以校正系統(tǒng)誤差，獲得高精度位置、速度、姿態(tài)的用戶定位結(jié)果，從而彌補(bǔ)了慣性導(dǎo)航誤差隨時(shí)間離散和衛(wèi)星導(dǎo)航易受外界電磁環(huán)境干擾、無法直接提供用戶姿態(tài)信息的問題。

關(guān)鍵詞：衛(wèi)星導(dǎo)航 最優(yōu)濾波 組合導(dǎo)航

中圖分類號：U666 文獻(xiàn)標(biāo)識碼：A 文章編號：1674-098X（2014）11（c）-0001-02

Abstract：Aiming at the shortages of the current three popular navigation methods，this paper proposed a difference of pseudorange and pseudorange rate based satellite and inertial integrated navigation method.This method uses the pseudorange and pseudorange rate measured by the satellite navigation system and inertial navigation system to do optimal estimation， to correct the system error and obtain high positioning results including location， velocity and attitude.Make it up that system error disperse and being easily disturbed and unable to directly export posture information.

Key Words：Satellite Nnavigation；Optimal Filter；Integrated Navigation

在21世紀(jì)，隨著導(dǎo)航定位系統(tǒng)在軍事、交通、農(nóng)業(yè)、漁業(yè)等重要領(lǐng)域的廣泛應(yīng)用，人們對導(dǎo)航定位系統(tǒng)的精度、可靠性、自主性提出了越來越高的要求。目前比較常用的導(dǎo)航定位技術(shù)中，主要有衛(wèi)星導(dǎo)航、慣性導(dǎo)航、天文導(dǎo)航等。這三種導(dǎo)航技術(shù)種，每一種導(dǎo)航技術(shù)都在其導(dǎo)航性能上體現(xiàn)出其他導(dǎo)航系統(tǒng)不可替代的特征，都有其專屬的應(yīng)用領(lǐng)域。

衛(wèi)星導(dǎo)航是一種能夠全天時(shí)、全天候提供高精度的位置和速度信息的導(dǎo)航技術(shù)，依靠覆蓋本區(qū)域的導(dǎo)航衛(wèi)星和專用的導(dǎo)航定位儀器來完成導(dǎo)航定位，定位精度取決于系統(tǒng)總體指標(biāo)，不受天氣、時(shí)間等環(huán)境因素的影響；缺點(diǎn)是難以直接提供姿態(tài)信息，而且容易受到其他電磁信號干擾。慣性導(dǎo)航是一種完全獨(dú)立自主、能夠提供連續(xù)的全部運(yùn)動(dòng)參數(shù)的導(dǎo)航技術(shù)，在較短的時(shí)間內(nèi)，能夠達(dá)到較高的精度；缺點(diǎn)是其誤差會隨著導(dǎo)航系統(tǒng)運(yùn)行時(shí)間的延長不斷積累，連續(xù)導(dǎo)航時(shí)間越長，各運(yùn)動(dòng)參數(shù)的誤差就越大。天文導(dǎo)航是一種能夠提供位置和姿態(tài)信息且誤差不隨時(shí)間積累的導(dǎo)航技術(shù)，但會極大的受到天氣條件的限制，且其導(dǎo)航精度不高。

因而，目前單一的導(dǎo)航手段并不能滿足當(dāng)今社會對導(dǎo)航系統(tǒng)高精度、高可靠度、高自主性的要求。這里介紹一種衛(wèi)星、慣性組合導(dǎo)航的方法，充分利用衛(wèi)星導(dǎo)航和慣性導(dǎo)航的優(yōu)勢，使兩種導(dǎo)航方法能夠互補(bǔ)優(yōu)缺，達(dá)到較好的導(dǎo)航性能。

1 基本導(dǎo)航原理

目前國際上，建成的衛(wèi)星導(dǎo)航系統(tǒng)主要有美國的GPS、中國的COMPASS、俄羅斯的GLONASS等，這些系統(tǒng)可統(tǒng)稱為全球?qū)Ш叫l(wèi)星系統(tǒng)（Global Navigation Satellite System，GNSS）。一般主要分為空間衛(wèi)星星座、用戶機(jī)、地面監(jiān)測網(wǎng)三部分。由用戶機(jī)接收和處理衛(wèi)星發(fā)送的導(dǎo)航信號，得到用戶本身的位置、速度等信息。用戶機(jī)解算位置信息的基本原理為利用不同衛(wèi)星的信號時(shí)延進(jìn)行三維定位，由于用戶機(jī)和衛(wèi)星的時(shí)鐘存在誤差，故需要同時(shí)接收到至少四顆衛(wèi)星的信號才能完成定位解算。其原理如圖1、圖2所示。

慣性導(dǎo)航則以牛頓力學(xué)為基礎(chǔ)，用一個(gè)陀螺儀來建立導(dǎo)航坐標(biāo)，利用加速度計(jì)來測量用戶的實(shí)時(shí)加速度，將實(shí)時(shí)加速度轉(zhuǎn)換到導(dǎo)航坐標(biāo)系中，通過一次積分運(yùn)算得出實(shí)時(shí)速度，再一次積分運(yùn)算得出實(shí)時(shí)位置。其原理如圖3、圖4所示。

2 衛(wèi)星、慣性組合導(dǎo)航

衛(wèi)星、慣性組合導(dǎo)航的基本模式為采用衛(wèi)星導(dǎo)航系統(tǒng)測量得到一組用戶當(dāng)前的偽距值和偽距率值，采用慣性導(dǎo)航系統(tǒng)測量用戶的位置和速度，換算得到另一組用戶當(dāng)前的偽距值和偽距率值；將二者的差值作為測量量，通過最優(yōu)濾波器估計(jì)出當(dāng)前組合導(dǎo)航系統(tǒng)的誤差，對當(dāng)前用戶的位置、速度等參數(shù)進(jìn)行校正。

衛(wèi)星、慣性組合導(dǎo)航系統(tǒng)以衛(wèi)星導(dǎo)航系統(tǒng)誤差方程和慣性導(dǎo)航系統(tǒng)誤差方程為狀態(tài)方程，方程的輸入為衛(wèi)星導(dǎo)航系統(tǒng)、慣性導(dǎo)航系統(tǒng)各自輸出的數(shù)據(jù)差值，方程的輸出為經(jīng)過最優(yōu)估計(jì)的系統(tǒng)誤差。

設(shè)計(jì)組合導(dǎo)航系統(tǒng)的最優(yōu)濾波器，應(yīng)建立系統(tǒng)狀態(tài)方程和差分方程，一般采用兩種方法：一種為直接采用各導(dǎo)航系統(tǒng)測量值為估計(jì)對象，以下簡稱為直接法；對于直接法，其狀態(tài)變量具有數(shù)值大、變化快的特點(diǎn)，狀態(tài)方程為非線性，都會造成估計(jì)精度的下降。另一種為采用各導(dǎo)航系統(tǒng)的誤差作為估計(jì)對象，以下簡稱為間接法。間接法的狀態(tài)變量數(shù)值較小，變化緩慢，往往采用非線性方程即可準(zhǔn)確描述（見圖5、圖6）。

最優(yōu)濾波器得出系統(tǒng)誤差的估計(jì)值后，工程上有兩種主流的校正導(dǎo)航參數(shù)的方法：一是利用估計(jì)值直接校正組合導(dǎo)航系統(tǒng)最終輸出的位置、速度，以下簡稱為輸出校正法，這種方法工程上實(shí)現(xiàn)簡單，但不能修正系統(tǒng)內(nèi)部的狀態(tài)誤差，導(dǎo)航時(shí)間足夠長后，系統(tǒng)誤差仍然會不可控的上升。二是利用估計(jì)值校正組合導(dǎo)航系統(tǒng)各子系統(tǒng)的解算流程中，以下簡稱為反饋校正法。這種方法雖然工程上實(shí)現(xiàn)起來比較困難，但能夠隨時(shí)修正系統(tǒng)誤差，所以能保證在長時(shí)段導(dǎo)航中保持較高的精度（見圖7、圖8）。

如圖9所示，慣性導(dǎo)航的測量誤差將隨時(shí)間推移加速上升，原因?yàn)榧铀俣扔?jì)的測量值誤差積累后，會以平方形式反映到定位結(jié)果中。而衛(wèi)星導(dǎo)航的誤差在同等天氣條件下，只取決于導(dǎo)航系統(tǒng)誤差，不隨時(shí)間變化。

通過仿真，可以得到經(jīng)過輸出校正法和反饋校正法后，兩種組合導(dǎo)航方式的誤差-時(shí)間曲線。如圖10所示，深藍(lán)色為輸出校正法曲線，淺藍(lán)色為反饋校正法曲線，可以看出，輸出校正法由于直接出輸出結(jié)果做校正，再后期會越來越多的受到慣性導(dǎo)航誤差的影響；而反饋校正法則通過不斷修正系統(tǒng)內(nèi)部誤差，在誤差發(fā)散的趨勢上要比輸出校正法收斂。

3 結(jié)語

組合導(dǎo)航系統(tǒng)是隨著計(jì)算機(jī)、最優(yōu)濾波原理的發(fā)展而迅速發(fā)展起來的一種多系統(tǒng)、多功能、高可靠性的導(dǎo)航系統(tǒng)。目前組合導(dǎo)航系統(tǒng)已在國內(nèi)外航空、航天、航海和陸地車輛的導(dǎo)航定位中得到廣泛應(yīng)用，它是導(dǎo)航技術(shù)發(fā)展的主要方向之一。每種單一導(dǎo)航系統(tǒng)都有各自的獨(dú)特性能和局限性。把幾種不同的單一系統(tǒng)組合在一起，就能利用多種信息源，互相補(bǔ)充，構(gòu)成一種有多余度和導(dǎo)航準(zhǔn)確度更高的多功能系統(tǒng)。

參考文獻(xiàn)

[1] 秦永元，張洪鉞，江叔華.卡爾曼濾波與組合導(dǎo)航原理[M].西安：西北工業(yè)大學(xué)出版社，1998.

[2] 袁信，俞濟(jì)祥.導(dǎo)航系統(tǒng)[M].沈陽：航空工業(yè)出版社，1993.

[3] Integrated Navigation and Guidance Systems.American Institute of Aeronautics and Astronautics，Inc，Daniel J.Biezad，1999.endprint

摘 要：針對目前三種主流導(dǎo)航方法各自的不足，提出了一種基于最優(yōu)濾波法的衛(wèi)星、慣性組合導(dǎo)航方法，采集這兩種導(dǎo)航系統(tǒng)實(shí)時(shí)測量得到的偽距、偽距率的差值，通過設(shè)計(jì)合適的最優(yōu)濾波器，以校正系統(tǒng)誤差，獲得高精度位置、速度、姿態(tài)的用戶定位結(jié)果，從而彌補(bǔ)了慣性導(dǎo)航誤差隨時(shí)間離散和衛(wèi)星導(dǎo)航易受外界電磁環(huán)境干擾、無法直接提供用戶姿態(tài)信息的問題。

關(guān)鍵詞：衛(wèi)星導(dǎo)航 最優(yōu)濾波 組合導(dǎo)航

中圖分類號：U666 文獻(xiàn)標(biāo)識碼：A 文章編號：1674-098X（2014）11（c）-0001-02

Abstract：Aiming at the shortages of the current three popular navigation methods，this paper proposed a difference of pseudorange and pseudorange rate based satellite and inertial integrated navigation method.This method uses the pseudorange and pseudorange rate measured by the satellite navigation system and inertial navigation system to do optimal estimation， to correct the system error and obtain high positioning results including location， velocity and attitude.Make it up that system error disperse and being easily disturbed and unable to directly export posture information.

Key Words：Satellite Nnavigation；Optimal Filter；Integrated Navigation

在21世紀(jì)，隨著導(dǎo)航定位系統(tǒng)在軍事、交通、農(nóng)業(yè)、漁業(yè)等重要領(lǐng)域的廣泛應(yīng)用，人們對導(dǎo)航定位系統(tǒng)的精度、可靠性、自主性提出了越來越高的要求。目前比較常用的導(dǎo)航定位技術(shù)中，主要有衛(wèi)星導(dǎo)航、慣性導(dǎo)航、天文導(dǎo)航等。這三種導(dǎo)航技術(shù)種，每一種導(dǎo)航技術(shù)都在其導(dǎo)航性能上體現(xiàn)出其他導(dǎo)航系統(tǒng)不可替代的特征，都有其專屬的應(yīng)用領(lǐng)域。

衛(wèi)星導(dǎo)航是一種能夠全天時(shí)、全天候提供高精度的位置和速度信息的導(dǎo)航技術(shù)，依靠覆蓋本區(qū)域的導(dǎo)航衛(wèi)星和專用的導(dǎo)航定位儀器來完成導(dǎo)航定位，定位精度取決于系統(tǒng)總體指標(biāo)，不受天氣、時(shí)間等環(huán)境因素的影響；缺點(diǎn)是難以直接提供姿態(tài)信息，而且容易受到其他電磁信號干擾。慣性導(dǎo)航是一種完全獨(dú)立自主、能夠提供連續(xù)的全部運(yùn)動(dòng)參數(shù)的導(dǎo)航技術(shù)，在較短的時(shí)間內(nèi)，能夠達(dá)到較高的精度；缺點(diǎn)是其誤差會隨著導(dǎo)航系統(tǒng)運(yùn)行時(shí)間的延長不斷積累，連續(xù)導(dǎo)航時(shí)間越長，各運(yùn)動(dòng)參數(shù)的誤差就越大。天文導(dǎo)航是一種能夠提供位置和姿態(tài)信息且誤差不隨時(shí)間積累的導(dǎo)航技術(shù)，但會極大的受到天氣條件的限制，且其導(dǎo)航精度不高。

因而，目前單一的導(dǎo)航手段并不能滿足當(dāng)今社會對導(dǎo)航系統(tǒng)高精度、高可靠度、高自主性的要求。這里介紹一種衛(wèi)星、慣性組合導(dǎo)航的方法，充分利用衛(wèi)星導(dǎo)航和慣性導(dǎo)航的優(yōu)勢，使兩種導(dǎo)航方法能夠互補(bǔ)優(yōu)缺，達(dá)到較好的導(dǎo)航性能。

1 基本導(dǎo)航原理

目前國際上，建成的衛(wèi)星導(dǎo)航系統(tǒng)主要有美國的GPS、中國的COMPASS、俄羅斯的GLONASS等，這些系統(tǒng)可統(tǒng)稱為全球?qū)Ш叫l(wèi)星系統(tǒng)（Global Navigation Satellite System，GNSS）。一般主要分為空間衛(wèi)星星座、用戶機(jī)、地面監(jiān)測網(wǎng)三部分。由用戶機(jī)接收和處理衛(wèi)星發(fā)送的導(dǎo)航信號，得到用戶本身的位置、速度等信息。用戶機(jī)解算位置信息的基本原理為利用不同衛(wèi)星的信號時(shí)延進(jìn)行三維定位，由于用戶機(jī)和衛(wèi)星的時(shí)鐘存在誤差，故需要同時(shí)接收到至少四顆衛(wèi)星的信號才能完成定位解算。其原理如圖1、圖2所示。

慣性導(dǎo)航則以牛頓力學(xué)為基礎(chǔ)，用一個(gè)陀螺儀來建立導(dǎo)航坐標(biāo)，利用加速度計(jì)來測量用戶的實(shí)時(shí)加速度，將實(shí)時(shí)加速度轉(zhuǎn)換到導(dǎo)航坐標(biāo)系中，通過一次積分運(yùn)算得出實(shí)時(shí)速度，再一次積分運(yùn)算得出實(shí)時(shí)位置。其原理如圖3、圖4所示。

2 衛(wèi)星、慣性組合導(dǎo)航

衛(wèi)星、慣性組合導(dǎo)航的基本模式為采用衛(wèi)星導(dǎo)航系統(tǒng)測量得到一組用戶當(dāng)前的偽距值和偽距率值，采用慣性導(dǎo)航系統(tǒng)測量用戶的位置和速度，換算得到另一組用戶當(dāng)前的偽距值和偽距率值；將二者的差值作為測量量，通過最優(yōu)濾波器估計(jì)出當(dāng)前組合導(dǎo)航系統(tǒng)的誤差，對當(dāng)前用戶的位置、速度等參數(shù)進(jìn)行校正。

衛(wèi)星、慣性組合導(dǎo)航系統(tǒng)以衛(wèi)星導(dǎo)航系統(tǒng)誤差方程和慣性導(dǎo)航系統(tǒng)誤差方程為狀態(tài)方程，方程的輸入為衛(wèi)星導(dǎo)航系統(tǒng)、慣性導(dǎo)航系統(tǒng)各自輸出的數(shù)據(jù)差值，方程的輸出為經(jīng)過最優(yōu)估計(jì)的系統(tǒng)誤差。

設(shè)計(jì)組合導(dǎo)航系統(tǒng)的最優(yōu)濾波器，應(yīng)建立系統(tǒng)狀態(tài)方程和差分方程，一般采用兩種方法：一種為直接采用各導(dǎo)航系統(tǒng)測量值為估計(jì)對象，以下簡稱為直接法；對于直接法，其狀態(tài)變量具有數(shù)值大、變化快的特點(diǎn)，狀態(tài)方程為非線性，都會造成估計(jì)精度的下降。另一種為采用各導(dǎo)航系統(tǒng)的誤差作為估計(jì)對象，以下簡稱為間接法。間接法的狀態(tài)變量數(shù)值較小，變化緩慢，往往采用非線性方程即可準(zhǔn)確描述（見圖5、圖6）。

最優(yōu)濾波器得出系統(tǒng)誤差的估計(jì)值后，工程上有兩種主流的校正導(dǎo)航參數(shù)的方法：一是利用估計(jì)值直接校正組合導(dǎo)航系統(tǒng)最終輸出的位置、速度，以下簡稱為輸出校正法，這種方法工程上實(shí)現(xiàn)簡單，但不能修正系統(tǒng)內(nèi)部的狀態(tài)誤差，導(dǎo)航時(shí)間足夠長后，系統(tǒng)誤差仍然會不可控的上升。二是利用估計(jì)值校正組合導(dǎo)航系統(tǒng)各子系統(tǒng)的解算流程中，以下簡稱為反饋校正法。這種方法雖然工程上實(shí)現(xiàn)起來比較困難，但能夠隨時(shí)修正系統(tǒng)誤差，所以能保證在長時(shí)段導(dǎo)航中保持較高的精度（見圖7、圖8）。

如圖9所示，慣性導(dǎo)航的測量誤差將隨時(shí)間推移加速上升，原因?yàn)榧铀俣扔?jì)的測量值誤差積累后，會以平方形式反映到定位結(jié)果中。而衛(wèi)星導(dǎo)航的誤差在同等天氣條件下，只取決于導(dǎo)航系統(tǒng)誤差，不隨時(shí)間變化。

通過仿真，可以得到經(jīng)過輸出校正法和反饋校正法后，兩種組合導(dǎo)航方式的誤差-時(shí)間曲線。如圖10所示，深藍(lán)色為輸出校正法曲線，淺藍(lán)色為反饋校正法曲線，可以看出，輸出校正法由于直接出輸出結(jié)果做校正，再后期會越來越多的受到慣性導(dǎo)航誤差的影響；而反饋校正法則通過不斷修正系統(tǒng)內(nèi)部誤差，在誤差發(fā)散的趨勢上要比輸出校正法收斂。

3 結(jié)語

組合導(dǎo)航系統(tǒng)是隨著計(jì)算機(jī)、最優(yōu)濾波原理的發(fā)展而迅速發(fā)展起來的一種多系統(tǒng)、多功能、高可靠性的導(dǎo)航系統(tǒng)。目前組合導(dǎo)航系統(tǒng)已在國內(nèi)外航空、航天、航海和陸地車輛的導(dǎo)航定位中得到廣泛應(yīng)用，它是導(dǎo)航技術(shù)發(fā)展的主要方向之一。每種單一導(dǎo)航系統(tǒng)都有各自的獨(dú)特性能和局限性。把幾種不同的單一系統(tǒng)組合在一起，就能利用多種信息源，互相補(bǔ)充，構(gòu)成一種有多余度和導(dǎo)航準(zhǔn)確度更高的多功能系統(tǒng)。

參考文獻(xiàn)

[1] 秦永元，張洪鉞，江叔華.卡爾曼濾波與組合導(dǎo)航原理[M].西安：西北工業(yè)大學(xué)出版社，1998.

[2] 袁信，俞濟(jì)祥.導(dǎo)航系統(tǒng)[M].沈陽：航空工業(yè)出版社，1993.

[3] Integrated Navigation and Guidance Systems.American Institute of Aeronautics and Astronautics，Inc，Daniel J.Biezad，1999.endprint