賈新強(qiáng),高關(guān)根,張亞崇
(1 海軍裝備部,西安 710065;2 西安飛行自動(dòng)控制研究所,西安 710065)
機(jī)載地形輔助導(dǎo)航作為強(qiáng)電磁對(duì)抗環(huán)境下一種有效的自主航空導(dǎo)航手段,日益受到國(guó)際導(dǎo)航界的關(guān)注和重視?,F(xiàn)階段,機(jī)載地形輔助導(dǎo)航除了能完成傳統(tǒng)的定位功能之外,還具有地形跟隨/地形回避、合理路由選擇、近地告警、目標(biāo)截獲和精確武器投放、導(dǎo)航系統(tǒng)水平通道/垂直通道完好性監(jiān)控等極具軍事應(yīng)用價(jià)值的多項(xiàng)功能[1]。如英國(guó)BAE公司開發(fā)的地形剖面匹配系統(tǒng)TERPROM?(terrain profile matching,TERPROM)是目前世界上應(yīng)用最廣的一種地形輔助導(dǎo)航系統(tǒng),可提供地形匹配、地形防撞、先進(jìn)地形回避提示、障礙物/電線告警和提示、空地測(cè)距、地形感知顯示等功能,能夠有效增強(qiáng)機(jī)組的態(tài)勢(shì)感知能力、減輕機(jī)組的工作負(fù)擔(dān)及防止可控飛行撞地,其中地形匹配是其核心功能[2]。
地形匹配技術(shù)產(chǎn)生于20世紀(jì)40年代末50年代初,美、英等發(fā)達(dá)國(guó)家相繼提出了多種地形匹配方案,并陸續(xù)付諸實(shí)施。典型應(yīng)用方案包括地形輪廓匹配(terrain contour matching, TERCOM)、桑迪亞慣性地形輔助導(dǎo)航(Sandia terrain aided navigation, SITAN)、TERPROM?和精密地形輔助導(dǎo)航系統(tǒng)(precision terrain aided navigation system, PTAN)等。表1是對(duì)國(guó)外典型地形匹配系統(tǒng)應(yīng)用情況的統(tǒng)計(jì)分析。
表1 國(guó)外典型地形匹配系統(tǒng)對(duì)比
隨著全球?qū)Ш叫l(wèi)星系統(tǒng)(global navigation satellite system, GNSS)的廣泛應(yīng)用,航空領(lǐng)域地形匹配系統(tǒng)的作用在逐漸減弱,例如在戰(zhàn)斧Block IV上已用全球定位系統(tǒng)(global positioning system,GPS)替代了地形匹配系統(tǒng),地形匹配系統(tǒng)僅作為備份系統(tǒng)。然而,由于GNSS信號(hào)的脆弱性,特別是水下載體和山區(qū)機(jī)載導(dǎo)航應(yīng)用時(shí),GNSS信號(hào)存在拒止、有意或無(wú)意的干擾或欺騙,地形匹配依然是可靠的自主定位導(dǎo)航信息源。針對(duì)水下載體自主導(dǎo)航定位需求,已經(jīng)形成了地形輪廓匹配、多波束匹配和三維匹配等水下地形匹配系統(tǒng)和相關(guān)的理論方法[3-5];針對(duì)機(jī)載應(yīng)用,當(dāng)前地形匹配的主要工作聚焦在如何適應(yīng)機(jī)載大范圍機(jī)動(dòng)飛行和系統(tǒng)可靠性方面[6]。隨著機(jī)載激光掃描系統(tǒng)的發(fā)展,通過(guò)激光點(diǎn)云與獲取的影像進(jìn)行匹配,可生成高精度數(shù)字高程數(shù)據(jù),可有效提升地形匹配系統(tǒng)的性能[7]。此外,在GPS拒止環(huán)境下,結(jié)合地形特征的視覺(jué)導(dǎo)航和地磁異常輔助導(dǎo)航等也可為載機(jī)提供有效的定位導(dǎo)航信息[8]。
由于機(jī)載應(yīng)用環(huán)境的復(fù)雜性、不確定性以及機(jī)載任務(wù)自身的復(fù)雜性,有必要對(duì)機(jī)載地形匹配的關(guān)鍵技術(shù)特征及典型應(yīng)用場(chǎng)景進(jìn)行較為全面的辨析,以便于充分理解機(jī)載地形匹配系統(tǒng)的技術(shù)應(yīng)用特征及其適用場(chǎng)景,從而為該技術(shù)后續(xù)的發(fā)展提供必要的參考和借鑒。
地形匹配,是源自合成孔徑雷達(dá)之父Carl Wiley提出的地形匹配導(dǎo)航概念(map matching),在加入古德依爾飛機(jī)公司(Goodyear aircraft Co.)后將概念變?yōu)楝F(xiàn)實(shí),并成為該公司的拳頭產(chǎn)品——自動(dòng)地形識(shí)別和導(dǎo)航地圖匹配雷達(dá)系統(tǒng)(automatic terrain recognition and navigation map-matching radar system,ATRAN)[9]。
利用地形特征進(jìn)行飛機(jī)導(dǎo)航是人們所熟知的古老導(dǎo)航技術(shù)。自從飛機(jī)出現(xiàn),飛行員就通過(guò)目視地形、地物進(jìn)行導(dǎo)航。然而,現(xiàn)代機(jī)載地形匹配與傳統(tǒng)的地形導(dǎo)航技術(shù)截然不同,它是利用飛機(jī)正下方地形高程的起伏特性進(jìn)行定位的一種系統(tǒng),即通過(guò)機(jī)載高度測(cè)量設(shè)備(如無(wú)線電高度表/激光雷達(dá)、大氣數(shù)據(jù)系統(tǒng)等)測(cè)量出飛機(jī)下方地形的一序列高程數(shù)據(jù)(測(cè)量地形剖面),利用模式識(shí)別技術(shù)將測(cè)量的地形剖面與預(yù)先存儲(chǔ)的基準(zhǔn)地形剖面進(jìn)行相關(guān)處理,找出最佳的匹配地形剖面并計(jì)算得到飛機(jī)的位置。本質(zhì)上,機(jī)載地形匹配系統(tǒng)是通過(guò)綜合處理地形特征傳感器(如大氣數(shù)據(jù)系統(tǒng)和無(wú)線電高度表的組合)的測(cè)量數(shù)據(jù)和載機(jī)存儲(chǔ)的數(shù)字地形高程數(shù)據(jù)來(lái)估計(jì)飛機(jī)的精確位置,然后再用這個(gè)精確位置對(duì)機(jī)載慣導(dǎo)進(jìn)行修正,如此不斷循環(huán),就能連續(xù)獲得飛機(jī)的精確位置。圖1是機(jī)械地形,匹配系統(tǒng)工作過(guò)程的簡(jiǎn)要原理示意圖。
圖1 機(jī)載地形匹配系統(tǒng)示意圖
一般情況下,機(jī)載地形匹配系統(tǒng)在地形起伏特征明顯的地區(qū)定位精度很高,而在地形平坦地區(qū)或水面上,僅能提供高度信息。
機(jī)載地形匹配系統(tǒng)是在實(shí)測(cè)地形剖面數(shù)據(jù)和基準(zhǔn)地形高程數(shù)據(jù)兩者均存在一定程度的噪聲條件下尋求最佳導(dǎo)航定位結(jié)果的一種技術(shù),系統(tǒng)組成如圖2所示,主要包括[10]:
1) 地形特征傳感設(shè)備(無(wú)線電高度表/激光雷達(dá)、大氣數(shù)據(jù)系統(tǒng)等);
2) 主導(dǎo)航設(shè)備(慣導(dǎo)或其他推算導(dǎo)航設(shè)備);
3) 匹配處理器(地形高程數(shù)據(jù)庫(kù)、捕獲濾波器、跟蹤濾波器等)。
圖2是從系統(tǒng)軟、硬件及工作邏輯兩方面給出的機(jī)載地形匹配系統(tǒng)組成示意圖。
圖2 機(jī)載地形匹配系統(tǒng)組成示意圖
地形特征傳感設(shè)備包含無(wú)線電高度表/激光雷達(dá)、大氣數(shù)據(jù)系統(tǒng)等。其中大氣數(shù)據(jù)系統(tǒng)通過(guò)對(duì)氣流動(dòng)壓、靜壓和溫度等的測(cè)量,經(jīng)計(jì)算與修正可自主獲得氣壓高度和真空速等參數(shù)[11]。由于機(jī)載地形匹配系統(tǒng)不敏感因大氣數(shù)據(jù)系統(tǒng)工作機(jī)理、季節(jié)、氣候等原因造成的氣壓高度的常值偏差,所以氣壓高度的常值偏差不影響正確匹配概率和定位精度,只有其隨機(jī)誤差會(huì)對(duì)正確匹配概率和定位精度有一定的影響。
無(wú)線電高度表用于自主測(cè)量飛機(jī)與地面的相對(duì)距離,其波束示意圖如圖3所示。目前無(wú)線電高度表的硬件測(cè)量精度很高(一般優(yōu)于1 m),但是飛機(jī)正下方離地高度的測(cè)量精度只有高度值的1%~3%,這主要是由于無(wú)線電高度表有一定的波束角,飛行高度越高,波束覆蓋范圍越大,其波束示意圖如圖3所示。覆蓋范圍內(nèi)的地形變化越復(fù)雜,因此其測(cè)高誤差越大[12]。從原理上分析,無(wú)線電高度表的測(cè)量值對(duì)地形高度有平滑效果。因此,在機(jī)載地形匹配系統(tǒng)實(shí)現(xiàn)中,為了尋求定位精度與數(shù)據(jù)存儲(chǔ)量之間的最佳折衷,數(shù)字地形高程數(shù)據(jù)庫(kù)的分辨率應(yīng)和無(wú)線電高度表的測(cè)量精度相匹配。目前,國(guó)外大多數(shù)軍用地形匹配系統(tǒng)使用的數(shù)字地形高程數(shù)據(jù)庫(kù)的網(wǎng)格間距在100 m左右,能滿足地形匹配要求。
圖3 無(wú)線電高度表波束示意圖
激光雷達(dá)波束覆蓋范圍很小,具有更精確的相對(duì)高度測(cè)量值。但其測(cè)量距離較短、測(cè)量精度受天氣的影響大,且易跟蹤地面樹木、建筑物等獨(dú)物體,上述情況均會(huì)對(duì)匹配性能產(chǎn)生不利影響。
數(shù)字地形高程數(shù)據(jù)庫(kù)是通過(guò)對(duì)地形高程的離散采樣并量化后得到的,其性能一般由地圖大小、水平和垂直參考坐標(biāo)系、格網(wǎng)尺寸、圓誤差(circular error,CEP)和線誤差(linear error,LEP)等指標(biāo)決定[13],圖4是美國(guó)軍用1~5級(jí)數(shù)字地形高程數(shù)據(jù)庫(kù)的具體情況。按照國(guó)內(nèi)制圖規(guī)范或要求,1∶50 000數(shù)字高程模型對(duì)鄰近高程控制點(diǎn)的高程中誤差一般為平地≤3.0 m,丘陵≤4.5 m,山地≤6.0 m,高山地≤10.0 m。
圖4 美國(guó)軍用1~5級(jí)數(shù)字地形高程數(shù)據(jù)庫(kù)示意
由上述分析可見,通過(guò)氣壓高度和無(wú)線電高度可自主測(cè)量地形高程,極少受外界干擾;地表的地形起伏基本不受時(shí)間的影響,人為的地形地貌的改變也不常發(fā)生。因此,機(jī)載地形匹配是一種自主、抗干擾和全天候的理想定位系統(tǒng)。
主導(dǎo)航設(shè)備指慣導(dǎo)或其他推算導(dǎo)航設(shè)備。慣導(dǎo)用于提供一個(gè)粗略的初始位置和誤差范圍,機(jī)載地形匹配系統(tǒng)據(jù)此確定在地形高程數(shù)據(jù)庫(kù)中的搜索范圍。通過(guò)限制搜索范圍一是降低計(jì)算量,二是減少多重匹配情況。此外,僅通過(guò)一個(gè)位置的高程測(cè)量值尚不足以獲得明確的定位結(jié)果,需要通過(guò)慣導(dǎo)的速度信息將多個(gè)位置的測(cè)量參數(shù)結(jié)合形成一個(gè)定位特征(剖面),與數(shù)字地形高程數(shù)據(jù)庫(kù)中的特征進(jìn)行匹配,如圖5所示;同時(shí),慣導(dǎo)的速度用于控制測(cè)量數(shù)據(jù)的采樣,慣導(dǎo)的位置和速度還用于描述地形剖面的走向。在設(shè)計(jì)匹配定位準(zhǔn)則時(shí),需利用慣導(dǎo)短時(shí)精度高、輸出連續(xù)等特點(diǎn),對(duì)最優(yōu)匹配濾波器(與先驗(yàn)垂直通道模型匹配程度最好的子濾波器)是否就是所要尋找的正確濾波器(水平位置估值最接近真實(shí)位置的子濾波器)進(jìn)行判決。因此,慣導(dǎo)性能對(duì)于機(jī)載地形匹配系統(tǒng)的精度和可靠性有著重要的影響。
圖5 采用測(cè)量剖面的模式匹配示意
地形匹配系統(tǒng)的核心基本上是一種算法功能,這個(gè)功能可在飛機(jī)上已有的任何計(jì)算機(jī)上運(yùn)行。而要達(dá)到所預(yù)期的定位精度和正確匹配概率等技術(shù)指標(biāo)要求,主要取決于適度精度的高度傳感器、適度精度的數(shù)字高程模型數(shù)據(jù)以及所采用的地形匹配算法。
目前,典型的地形匹配算法包括序列相關(guān)算法、單點(diǎn)迭代算法以及組合匹配算法。
序列相關(guān)算法是當(dāng)采集到的高程序列長(zhǎng)度達(dá)到設(shè)定的數(shù)量之后,就進(jìn)行一次匹配運(yùn)算,即僅依靠地形高程剖面進(jìn)行相關(guān)處理。匹配完成之后,將修正信息提供給慣導(dǎo)。這類算法主要包括TERCOM算法和等值線匹配(iterative closest contour point,ICCP)算法。
由于需要對(duì)地形高程序列進(jìn)行相關(guān)分析,TERCOM一般僅適用于航跡相對(duì)固定的飛行器。TERCOM常采用交叉相關(guān)(cross correlation,COR)算法和均方差(mean square difference,MSD)算法。MSD和COR都屬于統(tǒng)計(jì)決策法中的最基本匹配算法,其中MSD屬于距離決策,COR算法屬于形狀決策。在具體實(shí)現(xiàn)中可采用改進(jìn)的MSD算法和COR算法消除氣壓高度表和無(wú)線電高度表測(cè)量中的系統(tǒng)偏差,并采用MSD算法和COR算法融合表決機(jī)制以及多數(shù)表決決策機(jī)制作為提高定位概率和匹配概率的技術(shù)措施,詳細(xì)分析參見文獻(xiàn)[10]。
ICCP算法源于圖像配準(zhǔn)問(wèn)題中的ICP(iterative closest point,ICP)算法,采用慣導(dǎo)航跡與高度序列之間的調(diào)優(yōu),即通過(guò)慣導(dǎo)指示航跡進(jìn)行剛性旋轉(zhuǎn)和平移變換來(lái)實(shí)現(xiàn)迭代配準(zhǔn)[14],匹配誤差隨慣導(dǎo)誤差的累積而增加,一般常用于水下地形匹配、水下重力匹配導(dǎo)航和水下地磁匹配等應(yīng)用領(lǐng)域的研究。
單點(diǎn)迭代算法是同時(shí)利用地形高程和從地形高程數(shù)據(jù)導(dǎo)出的地形斜率對(duì)每一個(gè)高程采樣點(diǎn)都進(jìn)行匹配,并將修正信息提供給慣導(dǎo)。由于單點(diǎn)迭代算法不需要事先規(guī)劃航路,可較好滿足機(jī)載實(shí)時(shí)應(yīng)用的需求,SITAN算法為典型代表[15],其主要模塊對(duì)應(yīng)的任務(wù)及核心技術(shù)見表2。
表2 SITAN算法的主要模塊
公開可見的典型應(yīng)用包括F-l6飛機(jī)的地形輔助導(dǎo)航系統(tǒng)和面向直升飛機(jī)應(yīng)用的HELI/SITAN。原理上,單點(diǎn)迭代算法更適合飛行高度高、高度測(cè)量誤差大、慣導(dǎo)初始積累誤差大、飛行方式靈活等機(jī)載應(yīng)用場(chǎng)合。以桑迪亞實(shí)驗(yàn)室為直升機(jī)應(yīng)用而研制的HELI/SITAN為例,在滿足定位準(zhǔn)則時(shí),就能給出離散點(diǎn)上的定位信息,而不需要進(jìn)行事先航路規(guī)劃,解決了機(jī)載環(huán)境適應(yīng)性問(wèn)題,較好地滿足了機(jī)載應(yīng)用需求。
類似其他工程問(wèn)題,機(jī)載地形匹配系統(tǒng)同樣也面臨著存在很大位置不確定性的情況下如何精確捕獲初始位置的困難和復(fù)雜性。在HELI/SITAN中采用基于密集并行濾波器的捕獲模式設(shè)計(jì)技術(shù),以數(shù)字高程地圖的網(wǎng)格間距為子濾波器的搜索間距,在搜索期間濾波器整體上一直保持規(guī)則的網(wǎng)格結(jié)構(gòu)的并行濾波器陣列,對(duì)搜索區(qū)內(nèi)每一個(gè)可能的路徑進(jìn)行遍歷,記錄并跟蹤每一采樣時(shí)刻的最優(yōu)匹配濾波器,同時(shí)利用慣導(dǎo)緩變、連續(xù)的誤差漂移特性建立相應(yīng)的定位準(zhǔn)則,實(shí)時(shí)判斷并找到當(dāng)前的正確濾波器,以正確濾波器的當(dāng)前位置作為飛機(jī)的真實(shí)位置的估值,就能獲得定位誤差小于1個(gè)網(wǎng)格間距的搜索定位精度。獲得精確的初始位置后,在跟蹤模式中通過(guò)相關(guān)處理實(shí)現(xiàn)信噪比估算、匹配性能的實(shí)時(shí)監(jiān)控以及提供定位信息和定位信息品質(zhì)等信息,從而可獲得優(yōu)于2個(gè)網(wǎng)格間距的定位精度。在跟蹤模式中需要重點(diǎn)關(guān)注衡量匹配程度變量的值以及跟蹤濾波器誤差協(xié)方差估算值的精度,這些值不僅代表了匹配的可靠性及跟蹤模式的性能,而且是進(jìn)行模式轉(zhuǎn)換控制邏輯轉(zhuǎn)換的主要依據(jù)。圖6是機(jī)載地形匹配系統(tǒng)工作過(guò)程示意圖。
圖6 系統(tǒng)工作過(guò)程示意圖
具體實(shí)現(xiàn)中,采用變化緩慢的一維垂直通道偏差作為系統(tǒng)狀態(tài),該偏差由氣壓高度表偏差、無(wú)線電高度表偏差以及數(shù)字高程圖偏差引起。在地形匹配系統(tǒng)運(yùn)行過(guò)程中應(yīng)注意:上述各個(gè)偏差沒(méi)有一個(gè)能單獨(dú)觀測(cè)到,但由各個(gè)偏差綜合而成的偏差能夠觀測(cè)到,需要采用綜合處理的方式進(jìn)行垂直通道偏差的衡量。系統(tǒng)處理過(guò)程為:
1)系統(tǒng)狀態(tài)方程為:
xn=xn-1+wn
(1)
2)系統(tǒng)量測(cè)方程為:
zn=zn-1+vn
(2)
3)匹配程度的衡量
當(dāng)某個(gè)濾波器最接近飛機(jī)真實(shí)位置時(shí),根據(jù)該濾波器位置上的地形高程數(shù)據(jù)所計(jì)算出的地形高程值和載機(jī)測(cè)量到的地形高程值之差幾乎等于偏差,因此該濾波器最符合先驗(yàn)偏差模型。
采用平滑加權(quán)殘差平方(smoothed weighted residual squared,SWRS)一方面能夠提供單個(gè)濾波器與先驗(yàn)垂直通道偏差模型匹配程度的量度:SWRS值越小,匹配程度越好;另一方面,SWRS的計(jì)算過(guò)程也容易引入指數(shù)衰減的權(quán),方便計(jì)入慣導(dǎo)的漂移,因此可通過(guò)SWRS來(lái)增強(qiáng)較新匹配信息的作用強(qiáng)度,通過(guò)控制衰減因子適應(yīng)不同精度等級(jí)的慣導(dǎo)應(yīng)用。SWRS的計(jì)算過(guò)程為:
SWRSjn=aWRSjn+(1-a)WRSj(n-1)
(3)