機載光電探測設(shè)備對地定位算法及其仿真分析*

史光普，李明月

（1.中國空空導(dǎo)彈研究院，河南 洛陽471009；2.中國航空工業(yè)集團光電所，河南 洛陽471009）

0 引言

隨著新一代戰(zhàn)斗機在世界軍事強國的武器庫中逐漸充實，先進的光電探測設(shè)備越來越多地裝備在飛機平臺上，與機載火控系統(tǒng)一起共同完成了武器平臺所必需的目標(biāo)探測、武器制導(dǎo)功能，大大提高了新一代戰(zhàn)斗機的精確打擊能力，提高了作戰(zhàn)效能［1-2］。機載光電探測設(shè)備一般包含紅外/電視傳感器和激光測距機，前者用于在晝夜條件下完成對地面目標(biāo)的搜索、發(fā)現(xiàn)和識別，后者為火控系統(tǒng)提供目標(biāo)距離信息［3］。

利用機載光電探測設(shè)備實時地定位地面目標(biāo)是引導(dǎo)精確制導(dǎo)炸彈精確打擊目標(biāo)的重要手段［4］。對于平坦地形上的目標(biāo)，可以根據(jù)高度傳感器測得的載體高程信息和電視/紅外傳感器測得的目標(biāo)方位、俯仰角等參數(shù)求得，然而，實際戰(zhàn)場地形起伏可能很大，該方案會帶來較大誤差［5］。為解決上述問題，可以采用基于航空視頻圖像的直接地理注冊方法、基于數(shù)字高程模型（DEM）的參考影像配準(zhǔn)處理方法［6］，但其存在精度低、依賴數(shù)字高程模型（DEM）、和DEM迭代定位算法容易發(fā)散等缺點［5，7］。文獻［8-9］提出一種基于航姿和激光測距數(shù)據(jù)的對地定位方法，該方法對地形魯棒性較強、可靠性高、實時性好，比較適合于復(fù)雜的戰(zhàn)場環(huán)境。本文在該方法的基礎(chǔ)上作了深入研究，進一步推導(dǎo)了目標(biāo)的經(jīng)度、緯度和高度等地理坐標(biāo)信息，用于裝定或引導(dǎo)精確制導(dǎo)炸彈打擊目標(biāo)。并引入蒙特卡羅方法對各誤差源進行了仿真分析，指出各測量組件誤差對定位精度影響的大小，為各測量組件的誤差分配和系統(tǒng)的整體設(shè)計提供了理論指導(dǎo)。

1 坐標(biāo)系的定義

建模中涉及到的坐標(biāo)系有地球坐標(biāo)系、地理坐標(biāo)系、機體坐標(biāo)系和光電平臺坐標(biāo)系。

1.1 地球坐標(biāo)系

該坐標(biāo)系與地球固聯(lián)，坐標(biāo)系原點為地球中心Oe，Ze軸指向地球北極。Xe軸與Ye軸在地球赤道平面內(nèi)，Xe軸指向零子午線，Ye軸指向東經(jīng)90°方向。該坐標(biāo)系相對慣性空間以地球自轉(zhuǎn)角速度旋轉(zhuǎn)。

1.2 地理坐標(biāo)系

地理坐標(biāo)系的原點Og取在飛機上光電探測設(shè)備平臺的方位/俯仰回轉(zhuǎn)中心，Xg軸在當(dāng)?shù)厮矫鎯?nèi)指向北，Yg軸在當(dāng)?shù)厮矫鎯?nèi)指向東，Zg軸沿當(dāng)?shù)氐卮咕€方向并且指向地心，3個軸向符合右手坐標(biāo)系法則。

1.3 機體坐標(biāo)系

建立“前右下”機體坐標(biāo)系ObXbYbZb，其中，坐標(biāo)原點Ob位于機載光電探測設(shè)備平臺的方位/俯仰回轉(zhuǎn)中心；Xb軸平行于飛機縱軸，向前為正；Yb軸在飛機水平面內(nèi)且垂直于Xb軸，向右為正；Zb軸平行于飛機立軸，向下為正。

1.4 光電平臺坐標(biāo)系

建立“前右下”機載光電探測設(shè)備的平臺坐標(biāo)系OaXaYaZa，其中，坐標(biāo)原點Oa位于機載光電探測設(shè)備平臺的方位/俯仰回轉(zhuǎn)中心；Xa軸沿著視軸方向，指向目標(biāo)為正；Ya軸平行于平臺俯仰軸系，向右為正；Za軸與XaOaYa構(gòu)成右手坐標(biāo)系，向下為正。

2 對地定位數(shù)學(xué)模型

圖1所示的對地定位模型中，地球模型采用WGS-84旋轉(zhuǎn)橢球體模型。圖中O'g表示地理坐標(biāo)系OgXgYgZg的原點Og和地球坐標(biāo)系OeXeYeZe的原點Oe之間連線在地球表面的交點，、L分別表示地面目標(biāo)T的經(jīng)度和緯度。

由于紅外/電視傳感器安裝在機載光電探測設(shè)備內(nèi)平臺上，并且通過裝調(diào)保證了其視軸方向與Xa軸正向一致，所以吊艙視頻中心的瞄準(zhǔn)線方向即為Xa軸正向。設(shè)載機與地面目標(biāo)之間的距離為ldet，由激光測距機測量得到。將從光電平臺坐標(biāo)系原點Oa指向地面目標(biāo)的矢量記為Va。當(dāng)目標(biāo)處于瞄準(zhǔn)線十字中心位置時，矢量Va指示了目標(biāo)在光電平臺坐標(biāo)系OaXaYaZa中的位置矢量，可得：

考慮到光電平臺的結(jié)構(gòu)特點，可以將Va經(jīng)過兩次角度旋轉(zhuǎn)變換到機體坐標(biāo)系ObXbYbZb中?？傻茫?/p>

其中，θp、θa分別為從機體坐標(biāo)系ObXbYbZb到光電平臺坐標(biāo)系OaXaYaZa的俯仰角和方位角，直接由吊艙內(nèi)測量組件直接測量得到，Cba為從光電平臺坐標(biāo)系OaXaYaZa到機體坐標(biāo)系ObXbYbZb的坐標(biāo)轉(zhuǎn)換矩陣。

然后，將矢量Vb經(jīng)過3次角度旋轉(zhuǎn)變換到地理坐標(biāo)系OgXgYgZg中，

其中，α、β、γ分別為從地理坐標(biāo)系OgXgYgZg到機體坐標(biāo)系ObXbYbZb的飛機航向角、俯仰角和橫滾角，由飛機慣導(dǎo)組件得到。Cgb為從機體坐標(biāo)系ObXbYbZb到地理坐標(biāo)系OgXgYgZg的坐標(biāo)轉(zhuǎn)換矩陣。

最后，將矢量Vg經(jīng)過3次角度旋轉(zhuǎn)變換到地球坐標(biāo)系OeXeYeZe中，

聯(lián)立式（2）～式（4），最終可得矢量Va轉(zhuǎn)換到地球坐標(biāo)系OeXeYeZe的表示式：

若已知當(dāng)前飛機在地球坐標(biāo)系OeXeYeZe中的坐標(biāo)矢量Vep（通常由機載INS/GPS設(shè)備得到），可得目標(biāo)在地球坐標(biāo)系中的坐標(biāo)矢量：

將式（6）重寫為：

緯度Lt使用迭代收斂的方法求得：

其中，Re為地球橢球長半軸，取值6 378 137 m；e為地球橢球的第一偏心率，取值e2=0.006 694 379 901 3；RN為Og點處的卯酉圈曲率半徑；H為Og點的飛行高度；式中下標(biāo)i表示第i次迭代，迭代開始時的參數(shù)L0從下式求得：

迭代k次基本穩(wěn)定后，有：

3 蒙特卡羅仿真分析

蒙特卡羅方法又稱隨機模擬方法，是一種利用隨機數(shù)進行模擬的方法，屬于計算數(shù)學(xué)的一個分支，它是在20世紀(jì)40年代中期為適應(yīng)當(dāng)時原子能事業(yè)的發(fā)展而建立起來的［10］。蒙特卡羅方法的基本思想為，當(dāng)所求問題的解是某個事件的概率，或者是某個隨機變量的數(shù)學(xué)期望，或者是與之有關(guān)的量時，通過某種試驗的方法，得出該事件發(fā)生的頻率，再通過它得到問題的解。這種思想早已被人提出，只是在高性能計算機能夠模擬巨大數(shù)目的隨機試驗過程后才得到實際應(yīng)用［11］。

本系統(tǒng)中利用蒙特卡羅方法模擬一套目標(biāo)定位誤差源的樣本值，充分考慮樣本的數(shù)量和計算時間，計算結(jié)果具有很高的可信度。實際實現(xiàn)中各誤差源的隨機均方差可以依據(jù)不同的飛機慣導(dǎo)和光電載荷相關(guān)參數(shù)方便輸入和定義，輸出結(jié)果以圖表形式顯示，直觀且易于理解。

表1 仿真參數(shù)設(shè)置

表1為根據(jù)真實情況設(shè)置的5組不同的均方誤差分配方案。其中，參數(shù)Ⅰ組中的均方誤差相對較小，其相應(yīng)的目標(biāo)位置估計誤差也最??；參數(shù)Ⅱ、Ⅲ、Ⅳ和Ⅴ組的均方誤差中分別加大了紅外/電視觀瞄誤差、激光測距機誤差、慣性組件誤差和載機的GPS地理位置誤差。根據(jù)上述參數(shù)設(shè)置，利用蒙特卡羅方法分別計算不同目標(biāo)徑向距離（在5 km～50 km區(qū)間）時的目標(biāo)位置估計誤差，得到圖2所示的誤差曲線。

圖2 蒙特卡羅仿真圖

圖2所示的仿真結(jié)果表明，目標(biāo)定位誤差會隨目標(biāo)徑向距離的增大而增大。其中，慣性組件測量誤差對最終定位精度的影響最為強烈，因此，在系統(tǒng)論證階段應(yīng)該嚴(yán)格控制其誤差分配；紅外/電視觀瞄誤差對最終定位精度的影響次之，其引入的誤差會隨著探測距離的增大而增大，因而也需要格外關(guān)注；而激光測距機的誤差影響相對較小，載機的GPS地理位置誤差近似是一種線性的加性誤差。

設(shè)計中根據(jù)以上模擬結(jié)果提出對各誤差影響因素的測量精度進行合理的要求，實際飛行試驗也驗證了這種誤差分配的有效性。對分組件的測量精度要求直接與價格相關(guān)，利用蒙特卡羅分析方法的結(jié)果進行合理的精度分配，既為系統(tǒng)設(shè)計提供了理論依據(jù)，同時也節(jié)省了系統(tǒng)設(shè)計費用。

4 結(jié)論

本文進一步發(fā)展了基于載機航姿信息和激光測距數(shù)據(jù)的對地定位方法，建立了對地面目標(biāo)定位的數(shù)學(xué)模型，并引入蒙特卡羅模擬計算方法對目標(biāo)定位精度進行了仿真分析。通過仿真分析，確定了影響定位精度的重要誤差因素，并對各測量組件的誤差分配和系統(tǒng)的整體設(shè)計提供了理論指導(dǎo)，此方法對同類系統(tǒng)設(shè)計的精度分析具有一定的借鑒意義。

從定位方案和仿真結(jié)果可以看出，該方法具有對地形魯棒性較強、實時性好和計算穩(wěn)定性高等優(yōu)點，適合于復(fù)雜的戰(zhàn)場環(huán)境。