劉曉陽，徐煒莉，陳基茗，徐沛然，周祥祥

（1.上海機(jī)電工程研究所，上海 201109；2.上海航天技術(shù)研究院，上海 201109）

0 引言

近年來，反輻射導(dǎo)彈、隱身飛機(jī)和電子對抗等雷達(dá)對抗技術(shù)迅速發(fā)展，以雷達(dá)為代表的有源定位系統(tǒng)受到越來越嚴(yán)重的威脅。而相對于雷達(dá)等有源定位系統(tǒng)，無源定位系統(tǒng)不輻射電磁信號，它只通過測量目標(biāo)可見光或紅外參數(shù)或其發(fā)射的電磁信號參數(shù)來確定目標(biāo)的空間位置，具有隱蔽性好、生存能力強(qiáng)等優(yōu)點［1］。

當(dāng)前，電子干擾機(jī)在朝著多干擾波束方向發(fā)展的同時，干擾機(jī)在作戰(zhàn)過程中對其干擾范圍內(nèi)的雷達(dá)進(jìn)行干擾，使受到干擾的雷達(dá)無法測到回波時間，從而得不到距離信息并且失去對其進(jìn)行定位和跟蹤的能力。然而，被干擾的雷達(dá)仍然可以獲得干擾機(jī)的方位和俯仰信息。基于此，在干擾機(jī)環(huán)境下的目標(biāo)被動跟蹤定位問題也成為了很有吸引力的研究課題［2］。

在上述兩種背景中，對于目標(biāo)定位，使用最多、最廣泛的一種方法是三角定位法。如果將傳感器和目標(biāo)均看作三維（或二維）空間的點，那么由方位角、俯仰角可以確定一條源自傳感器經(jīng)過目標(biāo)的射線。通過多部傳感器的多條關(guān)聯(lián)目標(biāo)信息，利用三角定位法，就可以實現(xiàn)目標(biāo)（含干擾機(jī)）的定位和跟蹤。

影響定位結(jié)果精度的因素有很多，包括定位模型輸入數(shù)據(jù)的精度、傳感器之間的布陣距離、目標(biāo)與傳感器之間的關(guān)系等，而其中影響最大的便是定位模型輸入數(shù)據(jù)的精度。為了提高輸入數(shù)據(jù)的精度，需采用濾波的方式對目標(biāo)跟蹤數(shù)據(jù)進(jìn)行處理。濾波算法有很多種形式，比較典型的有Kalman濾波［3-4］、α-β濾波、α-β-γ濾波［5-8］、平方根中心差分卡爾曼濾波［9］以及交互多模型算法［10］、可變維度算法［11］、輸入估計算法［12］等。這些算法對常規(guī)目標(biāo)都可以取得較好的跟蹤效果，但是它們方法復(fù)雜、計算量大、實時性差，并且當(dāng)傳感器給不出目標(biāo)距離時，沒有目標(biāo)完整的球坐標(biāo)信息就無法轉(zhuǎn)換得到完整的直角坐標(biāo)信息，利用一般的卡爾曼濾波便無法得到較好的跟蹤效果。拋開傳感器自身探測精度的高低，無法對兩個角度濾波降噪以及無法將兩路目標(biāo)信息進(jìn)行時間對齊是影響探測精度的重要原因。極坐標(biāo)下，不能通過簡單的前后角度數(shù)據(jù)相減再除以時間而得到角加速度，因為極坐標(biāo)下的角度變化要考慮偽加速度。

為此，本文引入了偽加速度，提出一種自適應(yīng)修正角度濾波算法，一方面可以對無距離的目標(biāo)信息進(jìn)行濾波降噪；另一方面，可以得到準(zhǔn)確的角加速度，利用外推進(jìn)行時間對齊，為后續(xù)三角定位提供更為準(zhǔn)確的輸入。與此同時，可以為數(shù)據(jù)融合提供相應(yīng)的輔助因素，具有很顯著的工程意義。

1 自適應(yīng)修正角度濾波器

在現(xiàn)代的跟蹤系統(tǒng)中，雷達(dá)給出的距離、方位、俯仰信息這三者是線性無關(guān)的，但轉(zhuǎn)化為直角坐標(biāo)后的三個分量是耦合相關(guān)的，而各種算法的假定測量噪聲都是高斯白噪聲，因此在直角坐標(biāo)下濾波本身就會存在模型誤差。本文引入偽加速度，在球坐標(biāo)系下建立了偽加速度修正的目標(biāo)運(yùn)動模型及外推方程，一方面解決了目標(biāo)二維角度濾波效果差的問題，另一方面克服了以往球坐標(biāo)系下濾波的偽加速度未完全修正的缺陷，避免了耦合誤差，提升了濾波精度。

2.1 濾波方程

在方位和俯仰方向上分別進(jìn)行濾波，通過將上一點計算得到的外推值與當(dāng)前點的測量值加權(quán)相加，得到當(dāng)前點的濾波值，具體濾波方程為

式中：n為雷達(dá)觀測次數(shù)；S(n)代表的參數(shù)具體為Al(n)、El(n)，分別表示方位角、俯仰角的濾波值；P(n)代表的參數(shù)具體為Aw(n)、Ew(n)，分別表示方位角、俯仰角的外推值；Z(n)代表的參數(shù)具體為AZ(n)、EZ(n)，分別表示方位角、俯仰角的測量值；為S(n)的一階導(dǎo)數(shù)；為P(n)的一階導(dǎo)數(shù)；α(n)代表的參數(shù)具體為αA(n)、αE(n)，分別表示n時刻方位角A、俯仰角E的濾波器增益；β(n)代表的參數(shù)具體為βA(n)、βE(n)，分別表示n時刻方位角A、俯仰角E變化量對應(yīng)的濾波器增益；Δt(n)為n和n-1次觀測時刻的時間差，即雷達(dá)采樣間隔。

2.2 參數(shù)計算

增益的計算式為

信噪比參數(shù)r的計算式［13］為

測量誤差通?？扇√綔y裝置的精度指標(biāo)，機(jī)動方差可由以下方式獲得。

令殘差V(n)為

設(shè)有N個殘差，則其方差為

2.3 數(shù)據(jù)剔點

數(shù)據(jù)剔點方法如下：

1） 若 |Az(n)-Aw(n)|≤ΔA且 |Ez(n)-Ew(n)|≤ΔE，則接受本次角度的測量值A(chǔ)z(n)、Ez(n)；否則，用外推值A(chǔ)w(n)、Ew(n)代替測量值A(chǔ)z(n)、Ez(n)。

2）若t(n)-t(n-1)≤0（其中t(n-1)為上一拍濾波值所對應(yīng)的輸入數(shù)據(jù)時間），則直接剔除該點數(shù)據(jù)，不調(diào)用濾波器。

3）當(dāng)連續(xù)剔除m（該值可根據(jù)目標(biāo)信息的數(shù)據(jù)率來做調(diào)整設(shè)置）個點時，濾波器需要重啟，采信當(dāng)前測量值，保證濾波器不會一直處于剔點狀態(tài)。

2.4 數(shù)據(jù)外推

數(shù)據(jù)外推的表達(dá)式為

由于目標(biāo)信息中無距離信息，所以不能將位置轉(zhuǎn)到直角坐標(biāo)系中進(jìn)行外推計算。而在極坐標(biāo)系中，角度的變化可能是非均勻的，所以引入偽加速度，其計算式為

式中：Q為一已知常數(shù)，針對不同速度、不同距離的目標(biāo)，可通過仿真適應(yīng)性選取該常數(shù)值。

方位角角速度和俯仰角角速度則為

2 算法流程圖

在接收目標(biāo)信息后，對目標(biāo)的初始速度和最大速度一般會做限幅處理，針對機(jī)動目標(biāo)，也可以適當(dāng)增大剔點門限或者對目標(biāo)速度做平滑處理，這里不再詳細(xì)展開敘述。算法的具體流程參見圖1。

圖1 算法流程Fig.1 Algorithm flowchart

3 數(shù)值仿真驗證

3.1 直線運(yùn)動目標(biāo)

利用MATLAB 工具仿真一條目標(biāo)航跡（帶均勻的高斯白噪聲），目標(biāo)進(jìn)入的X向距離為60 km 左右，高度5 km，航路捷徑2 km，目標(biāo)速度200 m/s，做勻速直線平飛運(yùn)動。得到理論真值后，構(gòu)造高斯白噪聲，加載到真值上，便可模擬出實際的測量數(shù)據(jù)。距離上加載的噪聲均值為10 m，標(biāo)準(zhǔn)差為10 m；角度上加載的噪聲均值為0.3°，標(biāo)準(zhǔn)差為0.3°；常數(shù)Q=0.01。

生成目標(biāo)測量直角坐標(biāo)系下的目標(biāo)信息后，將目標(biāo)位置由直角坐標(biāo)轉(zhuǎn)成球坐標(biāo)，將目標(biāo)的方位角和俯仰角整理成濾波輸入文件，發(fā)送到濾波器中進(jìn)行濾波計算，得到角度濾波結(jié)果。

下面截取了一段目標(biāo)信息濾波結(jié)果，展示了濾波前后的目標(biāo)角度信息對比，詳見圖2～3，驗證了本文提出的自適應(yīng)修正角度濾波算法的確能夠在很大程度上減少測量值的噪聲。

圖2 濾波前后方位角信息對比Fig.2 Azimuth information comparison before and after filtering

圖3 濾波前后俯仰角信息對比Fig.3 Pitch angle information comparison before and after filtering

圖4～5 分別對方位角和俯仰角的一次差作曲線圖像，對目標(biāo)整個航跡的濾波結(jié)果也做了一個精度統(tǒng)計，詳見表1。由表1 的精度統(tǒng)計結(jié)果可以得到結(jié)論：對于系統(tǒng)誤差，一般通過濾波是無法減小的（這與已有認(rèn)知是一致的），但是角度的起伏誤差卻得到了很大幅度的降低，驗證了本文算法的優(yōu)越性。

圖4 方位角濾波前后結(jié)果與真值的一次差對比圖Fig.4 The first difference comparison between the truth value and the results before and after azimuth filtering

圖5 俯仰角濾波前后結(jié)果與真值的一次差對比圖Fig.5 The first difference comparison between the truth value and the results before and after the pitching angle filtering

表1 目標(biāo)數(shù)據(jù)濾波結(jié)果精度統(tǒng)計Tab.1 Accuracy statistics of target data filtering result

3.2 機(jī)動目標(biāo)

目標(biāo)在水平方向上（X向和Z向）做機(jī)動運(yùn)動，運(yùn)動航跡見圖6。

圖6 機(jī)動目標(biāo)水平航跡圖Fig.6 The track of horizontal movement of maneuvering target

用一般卡爾曼濾波模型對測量數(shù)據(jù)進(jìn)行濾波，再用本文提出的自適應(yīng)修正角度濾波模型進(jìn)行濾波，得到兩種濾波方式下的方位角濾波值，再與目標(biāo)真實方位角值進(jìn)行對比，詳見圖7。再計算兩種濾波方式得到的方位角一次差和俯仰角一次差對比情況，詳見圖8～9。

圖7 兩種濾波得到的方位角與真值對比圖Fig.7 The comparison between the true value and azimuth angles obtained by two kinds of filtering

圖8 兩種濾波得到的方位角值與真值的一次差對比圖Fig.8 The first difference comparison between the truth value and the azimuth values obtained by two kinds of filtering

圖9 兩種濾波得到的俯仰角值與真值的一次差對比圖Fig.9 The first difference comparison between truth value and the pitch angle values obtained by two kinds of filtering

從以上對比情況可以看出，一般卡爾曼濾波方法在針對二維數(shù)據(jù)濾波時，發(fā)散情況高于本文提出方法的發(fā)散情況，尤其是在濾波起始的一段時間內(nèi)，發(fā)散程度尤為明顯；在針對機(jī)動目標(biāo)濾波時，本文提出方法表現(xiàn)出了更好的降噪特性，且在機(jī)動后的一段時間，本文方法能夠更快地收斂。

綜上所述，本文提出的自適應(yīng)修正角度濾波算法，不但可以表現(xiàn)出極好的降噪特性，同時相較于一般的卡爾曼濾波，表現(xiàn)出更好的穩(wěn)定性和更快的收斂性。

4 結(jié)束語

本文針對被動跟蹤和干擾情況下（無法測得目標(biāo)距離）的目標(biāo)跟蹤數(shù)據(jù)如何更好地進(jìn)行濾波降噪進(jìn)行了分析，提出了一種自適應(yīng)修正角度濾波算法。該算法考慮了球坐標(biāo)系下角度偽加速度的影響，建立了偽加速度修正的目標(biāo)運(yùn)動外推方程，將機(jī)動檢測和濾波增益的獲取相結(jié)合，給出了利用累積殘差值來達(dá)到自適應(yīng)獲取增益的濾波算法。

通過常規(guī)目標(biāo)數(shù)據(jù)與機(jī)動目標(biāo)數(shù)據(jù)、一般卡爾曼濾波算法與自適應(yīng)修正角度濾波算法的數(shù)值仿真對比，驗證了該算法的正確性和優(yōu)越性，解決了只有目標(biāo)二維數(shù)據(jù)的情況下濾波效果較差的難題。該算法不但提升了定位模型輸入數(shù)據(jù)的精度，還可以通過偽加速度來求得目標(biāo)的角速度。一方面為數(shù)據(jù)融合提供輔助因素，另一方面為多傳感器情況下的目標(biāo)三角定位提供了時間對齊的方法，為提升定位精度奠定了基礎(chǔ)。

該算法運(yùn)算量小，容易滿足實時性的要求，具有重要的工程應(yīng)用價值。