黃曉剛,徐佳龍,韓雪謙
(海軍駐南京地區(qū)航空軍事代表室, 南京 210002)
·數(shù)據(jù)處理·
一種基于TLS-STK方法的單站無源定位算法
黃曉剛,徐佳龍,韓雪謙
(海軍駐南京地區(qū)航空軍事代表室, 南京 210002)
文中研究了在存在有色量測噪聲情況下的純方位角單站無源定位問題,給出了一種新的基于總體最小二乘和強跟蹤濾波器(TLS-STK)方法的無源定位濾波算法。該算法首先利用總體最小二乘算法進行無源定位,得到初步的目標位置和速度信息,再用這些信息來初始化強跟蹤濾波器,最后運用強跟蹤濾波器對后續(xù)測得的帶有色噪聲的方位角度值進行濾波,得到高精度的目標定位結(jié)果。經(jīng)過仿真對比實驗驗證,該算法可較為有效地抑制色噪聲的干擾,并具有定位精度高、收斂速度快的特點,能夠較好地滿足工程實際的應(yīng)用要求。
有色噪聲;無源定位;總體最小二乘;強跟蹤濾波器
無源定位是雷達等傳感器在無法獲得目標的距離、速度等信息的情況下,通過可以測得的目標回波或干擾信號的到達角信息,采用特殊的濾波算法以實現(xiàn)對目標定位的一種技術(shù)。由于其具有電磁隱蔽性好、反電子偵察能力強等特點,這種技術(shù)在電子情報系統(tǒng)和電子戰(zhàn)中,得到了廣泛的應(yīng)用。無源定位系統(tǒng)根據(jù)參與的被動傳感器的數(shù)目,可分為多站無源定位和單站無源定位。本文主要考慮的是單站無源定位問題。
單站無源定位利用機載平臺上的測向系統(tǒng),通過載機平臺自身的高階運動,以及在運動過程中測得的目標的一組方位角測量信息,按照一定的算法進行數(shù)據(jù)處理,最終獲得對目標位置的高精度估值。這里的高階運動指的是滿足系統(tǒng)對輻射源的可觀測條件[1]。機載單站無源定位由于具有靈活性好、對系統(tǒng)要求低等優(yōu)點,受到了各方的特別關(guān)注。
目前,單站無源定位技術(shù)的實現(xiàn)方法主要有批處理和迭代濾波方法。批處理方法具有不能實時在線估計和運算復(fù)雜度高等缺點;而迭代濾波算法對初始值有很強的依賴性,只有當濾波運算的初始估計值在一定的準確度范圍內(nèi)才能有較快的收斂速度。Dogancay[2]提出的基于正交矢量法的總體最小二乘算法(TLS)在系統(tǒng)存在較大的隨機觀察誤差的情況下,也能取得較好的定位精度,但缺點是運算量巨大、實時性差,而且在存在系統(tǒng)誤差的情況下,定位精度下降很多。文獻[3]提出了一種結(jié)合TLS和Kalman濾波的無源定位算法,該算法能比較有效地消除系統(tǒng)誤差的影響,但它僅研究了系統(tǒng)誤差為恒值常數(shù)的情形,而實際中系統(tǒng)誤差往往包含有各種形式的誤差,并且當不存在系統(tǒng)誤差時,該算法性能不如TLS。
針對文獻[3]中算法的不足,本文提出了基于總體最小二乘和強跟蹤濾波器(TLS-STK)方法的單站無源定位跟蹤處理方法。強跟蹤濾波器通過強迫濾波器輸出的殘差序列為近似的不自相關(guān)的高斯白噪聲序列來消除非恒值系統(tǒng)誤差的影響,從而實現(xiàn)目標點的精準定位,可以獲得更優(yōu)的定位效果。
本文首先,介紹了勻速運動目標的基于TLS的純方位角定位方法;然后,介紹了強跟蹤濾波器的實現(xiàn)原理;再次,給出了TLS-STK單站無源定位算法;最后,進行了Monte-Carlo仿真,以驗證該算法的有效性和可行性。
1.1 基于TLS的無源定位算法
圖1 載機與目標之間的幾何關(guān)系圖
由圖1的幾何關(guān)系可知,目標的位置坐標(xT,i,yT,i)滿足如下方程
(1)
(2)
(3)
式中:i=1,2,…,N。為了方便起見,將式(3)轉(zhuǎn)化為矩陣形式
(4)
令
則式(4)可以簡寫為
HX=Z
(5)
由于方位角觀測值βi(i=1,2,…,N),存在著觀測誤差,包括隨機誤差和系統(tǒng)誤差。因此,向量Z和矩陣H都存在著擾動噪聲。為簡化起見,假定向量Z和矩陣H的擾動噪聲都是加性高斯白噪聲,則可以將式(5)重寫成如下形式
(6)
(7)
(8)
(9)
式中:Vi(5)表示向量Vi的第5個元素。
1.2 強跟蹤濾波器
強跟蹤濾波器[6-7]通過引入時變漸消因子,在線調(diào)節(jié)系統(tǒng)增益矩陣,迫使輸出殘差序列相互正交,使得濾波器具有自適應(yīng)跟蹤狀態(tài)變化的能力,消除非恒值系統(tǒng)誤差對系統(tǒng)濾波結(jié)果的影響,從而實現(xiàn)對目標的精準定位。
1.2.1 正交性原理
對于Kalman濾波器(KF)的系統(tǒng)狀態(tài)估計式
X(k|k)=X(k|k-1)+K(k)[Z(k)-Z(k|k-1)]=
X(k|k-1)+K(k)d(k)
(10)
式中:X(k|k)、X(k|k-1)、K(k)、Z(k)和Z(k|k-1)分別為k時刻的狀態(tài)濾波值、狀態(tài)預(yù)測值、增益向量、觀察值和預(yù)測觀察值,為d(k)=Z(k)-Z(k|k-1)觀測值和預(yù)測觀察值之間的殘差。理想情況下,當模型與實際系統(tǒng)模式完全匹配時,KF(EKF)的輸出殘差序列d(k)為不自相關(guān)的高斯白噪聲序列。但在實際濾波過程中,當模型存在較大失配時,輸出殘差序列不再是處處相互正交。因而,可以通過選擇適當?shù)臅r變增益K(k),使下列公式成立
E{[X(k)-X(k|k)][X(k)-X(k|k)]T=min
(11)
E{[d(k+j)dT-(k)]}=0,
k=0,1,2,…,m;j=1,2,…,n
(12)
式中:X(k)為k時刻的真實狀態(tài)向量值;E{}為求期望運算。式(11)是KF(EKF)的性能指標,式(12)要求不同時刻的殘差序列處處保持正交。建立在上述條件上的濾波器稱為強跟蹤濾波器,它通過強迫輸出殘差近似為高斯白噪聲,最大限度地提取輸出殘差中的有效信息。
1.2.2 強跟蹤濾波器的實現(xiàn)
為了實現(xiàn)強跟蹤濾波器的特性,需要將時變漸消因子引入一步預(yù)測協(xié)方差矩陣之中,以削減過去數(shù)據(jù)對當前濾波值的影響,如式(13)所示
P(k|k-1)=λ(k)F(k-1)P(k-1|k-1)
FT(k-1)+Q(k-1)
(13)
式中:P(k|k-1),F(k-1),P(k-1|k-1)和Q(k-1)分別為k-1時刻的預(yù)測協(xié)方差矩陣、狀態(tài)轉(zhuǎn)移矩陣、濾波協(xié)方差矩陣和過程噪聲矩陣;λ(k)為漸消因子。一種次優(yōu)的漸消因子λ算法[6]如下
(14)
其中
η(k)=tr[N(k)]/tr[L(k)]
(15)
N(k)=V0(k)-βR(k)-H(k)Q(k)HT(k)
(16)
L(k)=H(k)F(k)P(k|k)FT(k)HT(k)
(17)
V0(k)=E{[d(k)dT(k)]}=
(18)
式中:0≤ρ≤1為遺忘因子,一般取ρ=0.95;d(1)為初始殘差;H(k)為k時刻的觀測矩陣;R(k)為k時刻的觀測誤差矩陣;β為衰減因子,根據(jù)經(jīng)驗或者仿真設(shè)定。
1.3 TLS-STK單站無源定位處理過程
在無源定位的整個過程中,載機都保持做高階機動,目標機做勻速直線運動。TLS-STK單站無源定位算法的具體實現(xiàn)步驟如下:
步驟2:利用步驟1算出的目標初始位置和速度值,初始化EKF濾波器和強跟蹤濾波器的初始殘差d(1)。其中,EKF的初始化協(xié)方差矩陣P(0|0)可以初始化為對角陣,即
(19)
步驟3:使用目標的角度測量值作為觀測值,使用通過強跟蹤處理的EKF濾波器對目標的位置和速度做實時濾波,輸出濾波結(jié)果。
為驗證TLS-STK算法的性能,本文使用Monte-Carlo方法對該算法作了仿真驗證,并與EKF算法進行了比較。
載機和目標的運動軌跡,如圖2所示。目標機作勻速直線運動,載機作勻速蛇形機動。載機的初始位置在[0km,0km]處,載機的勻速為160m/s,目標相對載機的初始位置為[50km, 55km],速度為200m/s。載機和目標機作相向飛行,觀測周期為1s。
圖2 載機和目標的運動軌跡圖
我們要仿真的是存在系統(tǒng)偏差的情況下,TLS-STK算法的性能。仿真使用的觀測噪聲為階梯高斯白噪聲,標準差為0.3°,均值為階梯函數(shù),如下所示
(20)
經(jīng)過100次Monte-Carlo仿真試驗后,得到TLS-STK和EKF的算法性能對比圖,如圖3所示。
圖3 相對距離誤差對比圖
在TLS-STK算法中,我們使用前20個觀測值進行總體最小二乘運算,所以在前20s沒有濾波結(jié)果輸出,誤差為100%。在20 s之后,TLS算法有了初步結(jié)果,相對誤差值發(fā)生了跳變,變成了18.2%。從圖3可以看出,除了做TLS運算時無結(jié)果輸出這段時間之外,TLS-STK算法的結(jié)果都要明顯優(yōu)于EKF的濾波結(jié)果。
本文考慮了存在有色觀測噪聲情況下的純方位角單站無源定位問題,給出了一種新的基于TLS-STK方法的無源定位濾波算法。該算法首先利用總體最小二乘算法進行無源定位,得到初步的目標位置和速度信息;然后,用這些信息來初始化強跟蹤濾波器;最后,運用強跟蹤濾波器對后續(xù)測得的帶有色噪聲的方位角度值進行濾波,得到高精度的目標定位結(jié)果。仿真結(jié)果表明:在色噪聲背景下,該算法收斂速度和濾波精度都比EKF算法要好很多。因此,該算法具有一定的理論意義和實際工程應(yīng)用價值。
[1] 孫仲康,郭福成,馮道旺, 等. 單站無源定位跟蹤技術(shù)[M]. 北京:國防工業(yè)出版社,2008. SUN Zhongkang, GUO Fucheng, FENG Daowang, et al. Passive location and tracking technology by single observer[M]. Beijing: National Defense Industry Press, 2008.
[2] DOGANCAY K.Bearingsonly target localization using total least squares[J].Signal Process,2005,85(9):1695-1710.
[3] RAO K D,REDDY D C.A new method for finding electromagnetic emitter location[J].IEEE Transactions on AES,1994, 30(4): 1081-1085.
[4] 朱義勇,姚富強,王厚生,等.一種優(yōu)化的自適應(yīng)總體最小二乘系統(tǒng)辨識算法[J].系統(tǒng)仿真學報,2008,20(18):4843-4846. ZHU Yiyong, YAO Fuqiang, WANG Housheng, et al. Novel variable step-size adaptive TLS algorithm[J]. Journal of System Simulation, 2008,20(18):4843-4846.
[5] GOLUB G H, LOAN C F V. An analysis of total least squares problem[J].SIAM Journal on Numerical Analysis, 1980,17(6): 883-893.
[6] 周東華,席裕庚,張鐘俊.一種帶多重次優(yōu)漸消因子的擴展卡爾曼濾波器[J].自動化學報,1991,17(6):689-695. ZHOU Donghua, XI Yugeng, ZHANG Zhongjun. A suboptimal multiple fading extended Kalman filter[J]. Acta Automatica Sinica,1991, 17(6): 689-695.
[7] 霍 光,李冬海,李 晶.基于強跟蹤容積卡爾曼濾波的單站無源跟蹤算法[J].現(xiàn)代雷達,2013,35(11):52-57. HUO Guang, LI Donghai, LI Jing. A single observer passive tracking algorithm based on strong tracking vubature Kalman filter[J]. Modern Radar, 2013, 35(11): 52-57.
黃曉剛 男,1980年生,工程師。研究方向為雷達軍檢驗收和質(zhì)量監(jiān)督。
徐佳龍 男,1969年生,高級工程師。研究方向為航空型號科研、裝備訂貨和管理。
韓雪謙 男,1983年生,工程師。研究方向為雷達軍檢驗收和質(zhì)量監(jiān)督。
A New Single Station Bearings-only Passive Target Location Algorithm Based on TLS-STK Method
HUANG Xiaogang,XU Jialong,HAN Xueqian
(Aviation Military Affairs Deputy Office of PLA Navy in Nanjing Zone, Nanjing 210002, China)
The single station bearings-only passive target location problem is studied in this paper in the case of existing colored observation noise, and a new algorithm based on total least squares and strong tracking filter is presented.The algorithm firstly utilizes the total least squares passive target localization method to estimate the primary position and velocity information, then uses this information to initialize the strong tracking filter, finally through filtering the azimuth angle, which takes colored observation noise, to get high precision location information of the target. Simulation results show that the algorithm can restrain the disturbance of colored noise in a certain extent, it also has fast convergence rate and high location accuracy. It is preferable for practical engineering application.
colored noise; passive location; total least squares; strong tracking filter
10.16592/ j.cnki.1004-7859.2016.04.012
黃曉剛 Email:hxgrj2008@163.com
2015-11-02
2016-01-08
TN971
A
1004-7859(2016)04-0050-04