設(shè)無(wú)源傳感器位于點(diǎn)B(l,0),將雷達(dá)單次量測(cè)點(diǎn)C轉(zhuǎn)換到傳感器B 的局地極坐標(biāo)系,可得到相應(yīng)的距離rb和方位角b′:
由于傳感器B 只能測(cè)得目標(biāo)的方位信息,無(wú)法直接跟位于異地的雷達(dá)量測(cè)結(jié)果進(jìn)行融合處理,故需要人為地構(gòu)造一個(gè)假的二維量測(cè)點(diǎn)。令參數(shù)
則計(jì)算得雷達(dá)量測(cè)轉(zhuǎn)換到位置B 的方位角方差為
設(shè)無(wú)源傳感器B 測(cè)得目標(biāo)C 的方位角為b(0
如果兩個(gè)觀測(cè)站重合,即傳感器位于同一平臺(tái)上,則有b′=a 和rb=ra,由公式(7)計(jì)算得σ′2b=σ2a,故我們的新方法對(duì)同一平臺(tái)差異維度傳感器數(shù)據(jù)融合是完全兼容的。
定義假量測(cè)點(diǎn)H(xH,yH):
令參數(shù)
則參照公式(2),H 點(diǎn)的協(xié)方差R 可寫為
忽略協(xié)方差矩陣P 和R 之間的相關(guān)性,采用簡(jiǎn)單凸組合方法對(duì)雷達(dá)量測(cè)與假量測(cè)結(jié)果進(jìn)行融合[6],得出最終的目標(biāo)位置估計(jì)X:
X=R[P+R]-1XC+P[ P+R]-1XH(13)
圖2 雷達(dá)與激光傳感器量測(cè)示意圖Fig.2 Illustration of measurements obtained from radar and laser sensors
上面詳細(xì)介紹了雷達(dá)傳感器與異域無(wú)源傳感器的數(shù)據(jù)融合方法,下面介紹雷達(dá)傳感器如何與異域激光傳感器進(jìn)行數(shù)據(jù)融合,它對(duì)應(yīng)了三維量測(cè)與一維距離量測(cè)的融合情形。如圖2 所示,即將圖1 中位于B 點(diǎn)的無(wú)源傳感器換成激光傳感器。設(shè)激光傳感器測(cè)得目標(biāo)C 的距離為r′b,標(biāo)準(zhǔn)偏差為σ′rb,此時(shí)可僅對(duì)距離rb與r′b進(jìn)行協(xié)方差加權(quán)融合,具體形式如下:
類似地定義假量測(cè)點(diǎn)H(xH,yH):
令參數(shù)
參照公式(2),H 點(diǎn)的協(xié)方差R 可寫為
其中,σ′2b由公式(7)給出,再依據(jù)公式(13)計(jì)算最終結(jié)果。
為了比較融合前后目標(biāo)位置精度, 我們引入GDOP(Geometric Dilution of Positioning Accuracy)參量,具體定義式為
3 仿真分析
針對(duì)有源和無(wú)源傳感器數(shù)據(jù)融合方法,本文設(shè)計(jì)場(chǎng)景一的參數(shù)分別為:l=80 km;σr=100 m;σa=7 mrad(約0.40°);σb =4 mrad(約0.23°,如紅外傳感器);目標(biāo)位于ra=100 km;a =15°,具體情形如圖3(a)所示。由雷達(dá)和無(wú)源傳感器同時(shí)且相互獨(dú)立地對(duì)目標(biāo)按前面所設(shè)的參數(shù)各量測(cè)1 000次,然后統(tǒng)計(jì)雷達(dá)量測(cè)點(diǎn)集、無(wú)源傳感器假量測(cè)點(diǎn)集以及最終融合后點(diǎn)集的分布特征,檢查精度改善情況。
圖3 雷達(dá)與無(wú)源傳感器組合量測(cè)仿真用例Fig.3 The simulative example of the coordinated measurements with radar and passive sensors
圖3(b)中的黑加號(hào)標(biāo)出了雷達(dá)仿真量測(cè)1 000次的點(diǎn)集,其勾畫出的橢圓形狀由目標(biāo)雷達(dá)相對(duì)位置、雷達(dá)量測(cè)精度所決定,可通過(guò)協(xié)方差矩陣P 計(jì)算得出?;疑颂?hào)則表示傳感器B 依據(jù)公式(9)得到的假量測(cè)點(diǎn)集,其分布是協(xié)方差矩陣P、目標(biāo)相對(duì)傳感器B 的位置以及傳感器B 量測(cè)角度的精度共同作用的結(jié)果。圖4 給出的是組合量測(cè)每次融合后的目標(biāo)位置估計(jì),可見分散程度改善了很多。依據(jù)公式(18)計(jì)算GDOP 的結(jié)果,對(duì)于單雷達(dá)量測(cè)其GDOP 值為707.1 m, 對(duì)于組合量測(cè)GDOP 為221.5 m,可見精度提高了3 倍多。
圖4 雷達(dá)與無(wú)源傳感器仿真1000 次量測(cè)的最終融合點(diǎn)集Fig.4 The 1000 estimated target positions based on radar and passive sensors′measurements
圖5 雷達(dá)與激光傳感器組合量測(cè)仿真用例Fig.5 The simulative example of the coordinated measurements with radar and laser sensors
針對(duì)雷達(dá)和激光傳感器數(shù)據(jù)融合方法,我們選擇場(chǎng)景二的參數(shù)分別為:l =40 km;σr=60 m;σa=5 mrad(約0.29°);σ′rb =10 m;目標(biāo)位于ra =80 km;a=45°,具體情形如圖5(a)所示。同樣由雷達(dá)和激光傳感器同時(shí)且相互獨(dú)立地各量測(cè)1 000次,然后統(tǒng)計(jì)雷達(dá)量測(cè)點(diǎn)集、激光傳感器假量測(cè)點(diǎn)集以及最終融合后點(diǎn)集的分布特征,比較它們的定位精度。圖5(b)中的黑加號(hào)標(biāo)出了雷達(dá)仿真量測(cè)1 000次的點(diǎn)集,灰色乘號(hào)表示得到的假量測(cè)點(diǎn)集,因距離量測(cè)精度高,故顯得十分細(xì)長(zhǎng)。圖6 給出的是將雷達(dá)量測(cè)與假量測(cè)結(jié)果融合后的最終目標(biāo)位置估計(jì),可見密集了許多。同樣依據(jù)公式(18)計(jì)算GDOP 的結(jié)果,對(duì)于單雷達(dá)量測(cè)GDOP 值為395.1 m,對(duì)于組合量測(cè)GDOP 值變?yōu)?19.5 m,精度也提高到原來(lái)的3 倍多。
圖6 雷達(dá)與激光傳感器仿真1 000 次量測(cè)最終融合點(diǎn)集Fig.6 The 1 000 estimated target position based on radar and laser sensors′measurements
4 結(jié) 論
本文研究了差異維度傳感器數(shù)據(jù)融合的問(wèn)題,首先通過(guò)一定的轉(zhuǎn)換規(guī)則將雷達(dá)量測(cè)的三維協(xié)方差矩陣轉(zhuǎn)到缺維傳感器所在平臺(tái)的極坐標(biāo)系下,先進(jìn)行一維或二維的加權(quán)融合,得出假量測(cè)點(diǎn)及其協(xié)方差矩陣,再通過(guò)凸組合融合方法得出目標(biāo)最終的位置估計(jì)。本文的新算法主要有以下4 個(gè)優(yōu)點(diǎn):一是既適用于同平臺(tái)傳感器,又適用于異平臺(tái)傳感器;二是對(duì)于異平臺(tái)情形,相對(duì)于傳統(tǒng)方法,不需要聯(lián)立方程求解,從而簡(jiǎn)化了求解過(guò)程,尤其是聯(lián)立方程后協(xié)方差的計(jì)算是相當(dāng)復(fù)雜棘手的(如計(jì)算雅可比矩陣);三是具有通用性,無(wú)論第二個(gè)傳感器是不是只有方位角量測(cè)或俯仰角量測(cè)或距離量測(cè),或同時(shí)擁有兩個(gè)角度的量測(cè),或距離加任意一個(gè)角度的量測(cè)等,本方法均采用相同流程處理;四是合理利用了所有有用的量測(cè)信息,不存在特定情形下需要人為選擇信息的問(wèn)題,同時(shí)精度改善程度高于傳統(tǒng)方法。當(dāng)然,在這一點(diǎn)上精度具體的改善程度跟場(chǎng)景和傳感器量測(cè)精度有很大關(guān)系,主要取決于雷達(dá)量測(cè)誤差橢球與假量測(cè)點(diǎn)的誤差橢球的形狀和空間方位。這里設(shè)計(jì)了兩個(gè)二維仿真場(chǎng)景,一個(gè)是雷達(dá)與無(wú)源測(cè)向傳感器進(jìn)行數(shù)據(jù)融合,另一個(gè)是雷達(dá)與激光測(cè)距傳感器進(jìn)行數(shù)據(jù)融合,仿真結(jié)果表明組合量測(cè)精度是單雷達(dá)量測(cè)精度的3 倍以上。相信該新方法在多傳感器協(xié)同探測(cè)領(lǐng)域?qū)⒕哂邢喈?dāng)?shù)膽?yīng)用價(jià)值。
[ 1] Saha R K.Track-to-track fusion with dissimilar sensors[ J] .IEEE Transactions on Aerospace and Electronic Systems,1996,32(3):1021-1029.
[ 2] Saha R K, Chang K C, Kokar M M.Fusion of synchronous[ J] .SPIE,1997,3068:206-217.
[ 3] 朱志宇.基于紅外和雷達(dá)數(shù)據(jù)融合的機(jī)動(dòng)目標(biāo)跟蹤方法[ J] .激光與紅外, 2007(2):170-174.
ZHU Zhi-yu.Maneuver target tracking based on infrared sensor and radar data fusion[J] .Laser &Infrared,2007(2):170-174.(in Chinese)
[ 4] 王毅.一種新的雷達(dá)與紅外傳感器異平臺(tái)數(shù)據(jù)融合方法[ J] .激光與紅外, 2010(3):325-329.
WANG Yi.New data-fusion algorithm for radar and IR sensors at different sites[ J] .Laser &Infrared,2010(3):325-329.(in Chinese)
[5] 車志宇, 熊偉,何友, 等.雷達(dá)-紅外異地配置下的數(shù)據(jù)融合算法[J] .彈箭與制導(dǎo)學(xué)報(bào),2005(1):385-387.
CHE Zhi-Yu, XIONG Wei, HE You, et al.Data-fusion algorithm for radar and IR sensors at different sites[ J] .Journal of Projectiles Rockets Missiles and Guidance,2005(1):385-387.(in Chinese)
[6] 韓崇昭, 朱洪艷, 段戰(zhàn)勝.多源信息融合[M] .2 版.北京:清華大學(xué)出版社,2010.
HAN Chong-zhao,ZHU Hong-yan,DUAN Zhan-sheng.Multisource information fusion[M] .2nd ed.Beijing:Tsinghua University Press,2010.(in Chinese)