王 煒李 丹姜禮平金裕紅
①(海軍工程大學(xué)理學(xué)院 武漢 430033)
②(武漢理工大學(xué)理學(xué)院 武漢 430070)
可處理多普勒量測(cè)的最佳線性無(wú)偏估計(jì)算法
王 煒①李 丹*②姜禮平①金裕紅①
①(海軍工程大學(xué)理學(xué)院 武漢 430033)
②(武漢理工大學(xué)理學(xué)院 武漢 430070)
基于目標(biāo)位置量測(cè)的一些量測(cè)轉(zhuǎn)換方法已被廣泛使用在目標(biāo)跟蹤應(yīng)用中,使得卡爾曼濾波器得以在直角坐標(biāo)系中應(yīng)用。但是,這些量測(cè)轉(zhuǎn)換方法有一些會(huì)導(dǎo)致估計(jì)性能惡化的根本缺陷。事實(shí)上,除了位置量測(cè)外,理論計(jì)算和實(shí)踐已經(jīng)證明,包含目標(biāo)速度信息的多普勒量測(cè)具有有效提高目標(biāo)狀態(tài)估計(jì)精度的潛力。該文在直角坐標(biāo)系下提出一種可使用轉(zhuǎn)換多普勒量測(cè)(即距離量測(cè)與多普勒量測(cè)的乘積)的濾波器。從理論上講,它是在最佳線性無(wú)偏估計(jì)準(zhǔn)則下的最優(yōu)線性無(wú)偏濾波器,并且避免了量測(cè)轉(zhuǎn)換方法的根本缺陷。通過(guò)將近似處理后的新型最優(yōu)線性濾波器與目前4種流行的方法進(jìn)行仿真比較,驗(yàn)證了所提出的濾波器的優(yōu)越性。
目標(biāo)跟蹤;多普勒量測(cè);最佳線性無(wú)偏估計(jì);量測(cè)轉(zhuǎn)換
在主動(dòng)雷達(dá)跟蹤系統(tǒng)中,目標(biāo)運(yùn)動(dòng)模型通常在直角坐標(biāo)系中建立,而雷達(dá)量測(cè)一般是在極/球坐標(biāo)系中得到的。這樣,目標(biāo)跟蹤問(wèn)題就成為一個(gè)非線性估計(jì)問(wèn)題。解決該問(wèn)題一般有兩類方法。一類是在混合坐標(biāo)系下跟蹤目標(biāo),主要的方法為擴(kuò)展卡爾曼濾波器(Extented Kalman Filter, EKF)、二階EKF和無(wú)跡卡爾曼濾波器(Unscented Kalman Filter, UKF)等。EKF對(duì)于高非線性問(wèn)題常會(huì)導(dǎo)致濾波結(jié)果發(fā)散。無(wú)跡變換(Unscented Tranform, UT)在雷達(dá)估計(jì)問(wèn)題中本質(zhì)上能捕捉到量測(cè)轉(zhuǎn)換偏差,但是不能去消除偏差,所以導(dǎo)致基于無(wú)偏量測(cè)轉(zhuǎn)換(Unbiased Converted Measurement, UCM)和基于UT的卡爾曼濾波仿真估計(jì)結(jié)果是近乎相同的[1,2]。另一類方法是量測(cè)轉(zhuǎn)換[3]卡爾曼濾波(Converted Measurement Kalman Filter, CMKF)算法。由于極/球坐標(biāo)到直角坐標(biāo)的轉(zhuǎn)換關(guān)系是很明確的,所以這種專門設(shè)計(jì)的濾波方法可能會(huì)在實(shí)際應(yīng)用中完成得更好些?!傲繙y(cè)轉(zhuǎn)換”方法主要包含去偏量測(cè)轉(zhuǎn)換(Debiased Converted Measurement, DCM)[4]和UCM[5]兩類方法。最近,文獻(xiàn)[2]總結(jié)以往提出的量測(cè)轉(zhuǎn)換方法的優(yōu)缺點(diǎn)后,提出了去相關(guān)無(wú)偏量測(cè)轉(zhuǎn)換(Decorrelated Unbiased Converted Measurement, DUCM)方法。DUCM的估計(jì)性能優(yōu)于前面的幾種量測(cè)轉(zhuǎn)換方法,且其性能與一種最佳線性無(wú)偏估計(jì)(Best Linear Unbiased Estimation, BLUE)算法[6]相當(dāng)。然而,量測(cè)轉(zhuǎn)換方法固有的缺陷導(dǎo)致基于量測(cè)轉(zhuǎn)換的卡爾曼濾波估計(jì)無(wú)論如何也不是最優(yōu)的。實(shí)際上,卡爾曼濾波器是基于BLUE準(zhǔn)則提出的。文獻(xiàn)[6]基于BLUE 準(zhǔn)則,提出一種直接使用極/球坐標(biāo)系中的雷達(dá)量測(cè)的近似BLUE濾波器,這種方法直接使用BLUE準(zhǔn)則對(duì)目標(biāo)的運(yùn)動(dòng)狀態(tài)進(jìn)行估計(jì),不僅克服了量測(cè)轉(zhuǎn)換方法的缺陷,而且在估計(jì)誤差和濾波器的可靠性方面都明顯超過(guò)了量測(cè)轉(zhuǎn)換方法。
前面講到的雷達(dá)濾波方法僅使用了雷達(dá)的位置量測(cè)。事實(shí)上,充分利用多普勒量測(cè)可以有效地提高目標(biāo)狀態(tài)的估計(jì)精度[7?9],即使在量測(cè)源不確定條件下亦是如此[10]。早先通常假設(shè)斜距、角度和多普勒量測(cè)的量測(cè)誤差是統(tǒng)計(jì)獨(dú)立的,但最近的研究表明:斜距和多普勒量測(cè)的量測(cè)誤差對(duì)于某些雷達(dá)波形而言是統(tǒng)計(jì)相關(guān)的[7,8]。為減小多普勒量測(cè)模型在直角坐標(biāo)系下的強(qiáng)非線性,學(xué)者們通過(guò)將斜距和多普勒量測(cè)相乘構(gòu)造了偽量測(cè)?;诖?,為了充分利用雷達(dá)的多普勒量測(cè)信息,文獻(xiàn)[11]將DCM卡爾曼濾波算法推廣到包含多普勒量測(cè)且斜距誤差和多普勒誤差相關(guān)的情形。文獻(xiàn)[12]基于修正的無(wú)偏量測(cè)轉(zhuǎn)換(Modified Unbiased Converted Measurement, MUCM)提出了序貫量測(cè)轉(zhuǎn)換卡爾曼濾波方法。文獻(xiàn)[13]沒有使用這一乘積,而是直接基于多普勒量測(cè)方程,使用UT變換進(jìn)行序貫卡爾曼濾波。文獻(xiàn)[14]首先使用極坐標(biāo)位置量測(cè),并經(jīng)過(guò)量測(cè)轉(zhuǎn)換卡爾曼濾波估計(jì)出目標(biāo)位置狀態(tài)估計(jì),然后通過(guò)使用偽量測(cè)(又稱轉(zhuǎn)換多普勒量測(cè)),并經(jīng)過(guò)卡爾曼濾波估計(jì)出轉(zhuǎn)換多普勒偽狀態(tài)估計(jì),最后使用最小方差估計(jì)準(zhǔn)則組合多普勒偽狀態(tài)估計(jì)和目標(biāo)位置狀態(tài)估計(jì),并得出最終估計(jì)結(jié)果。該算法的性能優(yōu)于文獻(xiàn)[3,5, 14,15]所提出的算法。
本文基于BLUE準(zhǔn)則,推導(dǎo)出一種直接使用極坐標(biāo)系中的雷達(dá)位置量測(cè)和多普勒量測(cè)的近似最佳線性無(wú)偏估計(jì)濾波器。該方法可以直接使用極坐標(biāo)下的雷達(dá)量測(cè)對(duì)目標(biāo)的直角坐標(biāo)運(yùn)動(dòng)狀態(tài)進(jìn)行估計(jì),在估計(jì)誤差和濾波器的可靠性方面都明顯超過(guò)了量測(cè)轉(zhuǎn)換方法。
令Zk和Xk是k時(shí)刻的量測(cè)和目標(biāo)狀態(tài),并且令Zk代表到k時(shí)刻為止的所有歷史量測(cè)的集合。對(duì)所有的沒有任何特定假設(shè)的Zk和Xk,無(wú)論Zk和Xk是否是線性或非線性關(guān)系,BLUE濾波器E*[X|Z]總是有準(zhǔn)遞推形式:
考慮包含線性運(yùn)動(dòng)方程和極坐標(biāo)量測(cè)方程的隨機(jī)系統(tǒng)Xk=Fk?1Xk?1+Gk?1wk?1,Zk=h (Xk,vk),其中,{wk}和{vk}是過(guò)程噪聲和量測(cè)噪聲序列,都與初始狀態(tài)x0獨(dú)立。Fk?1是轉(zhuǎn)移矩陣,且h(Xk,vk)是量測(cè)函數(shù)。首先,BLUE狀態(tài)預(yù)測(cè)能夠精確地運(yùn)行如下:
對(duì)于任意時(shí)刻k,相對(duì)于真實(shí)斜距r,方位角θ和多普勒信息r.,極坐標(biāo)系下的斜距量測(cè),方位角量測(cè)和多普勒量測(cè)可記為=r+, k。其中,,和為相應(yīng)的加性量測(cè)噪聲,都是零均值的高斯白噪聲序列,分別具有標(biāo)準(zhǔn)差σr,σθ和σr.。r~k和r~.k分別與θ~k相互獨(dú)立,并且r~k,θ~k和r~.k都獨(dú)立于r,θ和r.。r~k和r~.k是相關(guān)的,相關(guān)系數(shù)為ρ。
首先,將極坐標(biāo)系下的位置量測(cè)轉(zhuǎn)換到直角坐標(biāo)系后產(chǎn)生:
然后,為了減弱多普勒量測(cè)和目標(biāo)運(yùn)動(dòng)之間的強(qiáng)非線性程度,構(gòu)造了偽量測(cè)方程:
這樣,跟蹤系統(tǒng)具有非線性量測(cè)方程:
狀態(tài)預(yù)測(cè)誤差X~k和量測(cè)預(yù)測(cè)誤差Z~k的互協(xié)方差為(推導(dǎo)略)
其中,s13=s31,s23=s32,s12=s21,
有關(guān)s11,s22,s12的計(jì)算公式可參見文獻(xiàn)[6]。由于存在不能精確計(jì)算的條件期望E[?],所以sij(i,j= 1,2,3)不能精確地給出閉式解,但是可以高精度地將它們近似計(jì)算出來(lái)。文獻(xiàn)[6]已經(jīng)給出了近似計(jì)算sij(i,j=1,2)中的期望值E[?]的計(jì)算公式。在下一節(jié)中我們將使用泰勒級(jí)數(shù)展開法將其他的sij中的期望E[?]做出近似分析。
下面總結(jié)出了本文所提新算法(簡(jiǎn)記為BLUEPM)在一個(gè)循環(huán)周期內(nèi)的完整濾波過(guò)程:第1步,使用式(4)~式(6)計(jì)算出狀態(tài)預(yù)測(cè)更新量和,以及預(yù)測(cè)量測(cè)量;第2步,再使用式(4)~式(6),式(7)和式(8)計(jì)算出狀態(tài)量測(cè)更新量k和Pk;第3步,進(jìn)入下一輪循環(huán)。
由于sij(i,j=1,2,3)中涉及的期望E[?]要么沒有解析解,要么表達(dá)復(fù)雜。所以可以先對(duì)需要求期望的函數(shù)進(jìn)行泰勒級(jí)數(shù)展開,并取前若干項(xiàng)去近似該函數(shù),然后再求近似表達(dá)式的期望。關(guān)于sij(i,j=1,2)的近似合理性,在文獻(xiàn)[6]中已經(jīng)分析過(guò)。我們重點(diǎn)來(lái)分析si3(i=1,2,3)的近似計(jì)算。此處si3= s3i。但限于篇幅,此處只給出了si3(i=1,2,3)中期望E[()2|Zk?1]的二階泰勒近似展開式,而省略了期望E[xk/rk|Zk?1]和E[yk/rk|Zk?1]的二階近似展開式。
對(duì)許多目標(biāo)跟蹤應(yīng)用而言,上述對(duì)分量si3(i= 1,2,3)的近似是十分精確的。這一論斷可以由仿真結(jié)果進(jìn)一步驗(yàn)證。我們將看到,在所有仿真結(jié)果中,BLUEPM算法的估計(jì)誤差較其它濾波算法而言總是最小的。
為了保證BLUEPM算法的數(shù)值穩(wěn)定性,在執(zhí)行該算法時(shí),沒有將上述E[()2|Zk?1], E[xk/ rk|Zk?1]和E[yk/rk|Zk?1]的二階泰勒展開公式,進(jìn)一步截?cái)酁橐浑A公式,否則Sk會(huì)失去正定性,從而出現(xiàn)數(shù)值不穩(wěn)定現(xiàn)象(這一結(jié)論在仿真中已經(jīng)得到驗(yàn)證)。盡管BLUEPM算法直接使用了這些看似復(fù)雜的二階泰勒展開公式,但是通過(guò)仿真與其它4個(gè)算法相比較后,發(fā)現(xiàn)BLUEPM算法的時(shí)間復(fù)雜度仍然還是很小的。
本節(jié)將通過(guò)仿真和性能比較來(lái)驗(yàn)證本文算法BLUEPM的有效性。假設(shè)目標(biāo)運(yùn)動(dòng)近似為勻速運(yùn)動(dòng)。目標(biāo)初始位置為(10 km,10 km),運(yùn)動(dòng)速度為20 m/s(x方向和y方向的速度分量為10 m/s和103 m/s)。在對(duì)目標(biāo)運(yùn)動(dòng)的仿真中,使用連續(xù)離散化白噪聲加速度模型(Nearly Constant Velocity, NCV)定義目標(biāo)運(yùn)動(dòng)方程,采樣周期為1 s,過(guò)程噪聲為零均值的高斯白噪聲,且過(guò)程噪聲標(biāo)準(zhǔn)差為0.001 m/s2。采用一部固定雷達(dá)對(duì)目標(biāo)進(jìn)行跟蹤,其直角坐標(biāo)位置為(0 km,0 km),采樣周期為1 s,雷達(dá)的量測(cè)量為斜距、方位角和多普勒量測(cè),量測(cè)噪聲為零均值的高斯白噪聲,斜距、方位角和多普勒量測(cè)的標(biāo)準(zhǔn)差分別記為σr,σθ和σr.。斜距和多普勒量測(cè)之間的相關(guān)系數(shù)記為ρ。
基于引言部分對(duì)不同量測(cè)轉(zhuǎn)換方法的研究結(jié)果,我們選擇了4種常用且跟蹤性能優(yōu)良的量測(cè)轉(zhuǎn)換算法(分別記為MC[5], CPMKF[3], DCMD[13]和SFCMKP[11]),與BLUEPM算法進(jìn)行仿真比較。MC算法和CPMKF算法僅使用了雷達(dá)的距離和方位角量測(cè),而為提高目標(biāo)狀態(tài)估計(jì)精度,DCMD算法,SFCMKP算法和BLUEPM算法還用到了多普勒量測(cè)信息。所有算法在仿真中使用了相同的目標(biāo)初始狀態(tài)估計(jì)及其估計(jì)誤差協(xié)方差矩陣。依照斜距和多普勒量測(cè)之間的相關(guān)系數(shù)的不同取值,仿真實(shí)驗(yàn)共被分為3大類,每一類中又包含3種不同場(chǎng)景,所以總共有9種仿真場(chǎng)景。每種仿真場(chǎng)景的仿真次數(shù)為50次,每次仿真時(shí)長(zhǎng)為200 s。表1給出了所有不同仿真場(chǎng)景的量測(cè)噪聲參數(shù)設(shè)置值。通過(guò)對(duì)量測(cè)噪聲參數(shù)設(shè)置值從大到小取不同值,進(jìn)行不同組合,形成不同仿真場(chǎng)景,以便充分驗(yàn)證BLUEPM算法的有效性和優(yōu)越性。
圖1~圖9分別給出了在不同仿真場(chǎng)景下這5種估計(jì)算法的均方根誤差(Root Mean Square Error, RMSE)比較結(jié)果。圖1~圖3對(duì)應(yīng)相關(guān)系數(shù)ρ=0時(shí)的RMSEs。圖4~圖6對(duì)應(yīng)相關(guān)系數(shù)0.9 ρ=?時(shí)的RMSEs。最后,圖7~圖9對(duì)應(yīng)相關(guān)系數(shù)ρ=0.9時(shí)的RMSEs。為便于顯示,圖中每個(gè)時(shí)間步長(zhǎng)h=4 s。
從仿真結(jié)果圖可以看出,5種算法可以按照估計(jì)性能分為兩類,I類算法為SFCMKP和BLUEPM, II類算法為MC, CPMKF和DCMD。I類算法明顯比II類算法能夠更加快速穩(wěn)定地達(dá)到更精確的穩(wěn)態(tài)估計(jì)值,這說(shuō)明加入多普勒量測(cè)信息確實(shí)能夠提高目標(biāo)狀態(tài)估計(jì)精度。SFCMKP算法和BLUEPM算法的估計(jì)性能差別并不太明顯。從幾乎所有的仿真圖中可看出,自40 s以后,BLUEPM算法的RMSE要低于SFCMKP算法,說(shuō)明BLUEPM算法能夠得到精度更高的目標(biāo)狀態(tài)估計(jì)值。從圖7和圖8可以看到,SFCMKP算法在50 s附近出現(xiàn)了野值,而
BLUEPM算法沒有出現(xiàn)。盡管本文未在仿真中對(duì)文獻(xiàn)[14,15]所提出基于UT變換的算法進(jìn)行比較,但是從文獻(xiàn)[11]已經(jīng)知道,SFCMKP算法的估計(jì)性能要好于文獻(xiàn)[14,15]的算法,所以可以推測(cè):BLUEPM算法的估計(jì)性能也應(yīng)該好于文獻(xiàn)[14,15]的算法??梢钥闯觯琈C算法和CPMKF算法性能相當(dāng),它們的RMSEs也沒有出現(xiàn)大的波動(dòng),而DCMD算法的RMSEs一開始便出現(xiàn)了大的波動(dòng),但隨著時(shí)間的推移逐漸減小,估計(jì)結(jié)果逐漸穩(wěn)定在MC算法和CPMKF算法的狀態(tài)估計(jì)值處。實(shí)際上,可以計(jì)算得到在所有算法的RMSEs時(shí)間平均值中,DCMD算法要比MC算法和CPMKF算法更小。圖10給出仿真中的5種算法的平均單次執(zhí)行時(shí)間。BLUEPM算法的執(zhí)行時(shí)間為0.087 s, SFCMKP算法的執(zhí)行時(shí)間為1.524 s, DCMD算法的執(zhí)行時(shí)間為1.033 s, CPMKF算法的執(zhí)行時(shí)間為0.414 s, MC算法的執(zhí)行時(shí)間為0.761 s??梢钥闯?,BLUEPM算法的執(zhí)行時(shí)間最短,幾乎為SFCMKP算法的1/20。DCMD算法的執(zhí)行時(shí)間幾乎是CPMKF算法的2倍??偠灾珺LUEPM算法是執(zhí)行時(shí)間最短,跟蹤精度最好的算法,SFCMKP算法次之,而MC算法,CPMKF算法和DCMD算法的跟蹤精度相當(dāng),并劣于BLUEPM算法和SFCMKP算法。
表1 仿真中9種不同場(chǎng)景的參數(shù)設(shè)置表
圖1 場(chǎng)景1對(duì)應(yīng)的RMSEs
圖2 場(chǎng)景2對(duì)應(yīng)的RMSEs
圖3 場(chǎng)景3對(duì)應(yīng)的RMSEs
圖4 場(chǎng)景4對(duì)應(yīng)的RMSEs
圖5 場(chǎng)景5對(duì)應(yīng)的RMSEs
圖6 場(chǎng)景6對(duì)應(yīng)的RMSEs
圖7 場(chǎng)景7對(duì)應(yīng) 的RMSEs
圖8 場(chǎng)景8對(duì)應(yīng)的RMSEs
圖9 場(chǎng)景9對(duì)應(yīng)的RMSEs
本文討論了同時(shí)使用位置量測(cè)和多普勒量測(cè)進(jìn)行目標(biāo)跟蹤的問(wèn)題,并且提出一種可使用轉(zhuǎn)換多普勒量測(cè)(即距離量測(cè)與多普勒量測(cè)的乘積)的濾波器。從理論上講,該濾波器是在BLUE準(zhǔn)則下的最優(yōu)線性濾波器,可以完全在直角坐標(biāo)系中運(yùn)行,并且避免了量測(cè)轉(zhuǎn)換方法的根本缺陷。通過(guò)仿真實(shí)驗(yàn),將本文算法與幾種流行方法的跟蹤性能進(jìn)行了比較和驗(yàn)證。仿真實(shí)驗(yàn)使用了具有不同量測(cè)誤差和不同相關(guān)系數(shù)(即距離量測(cè)與多普勒量測(cè)之間的相關(guān)系數(shù))組合的多個(gè)仿真場(chǎng)景。依照估計(jì)誤差和算法執(zhí)行時(shí)間指標(biāo),在所有仿真場(chǎng)景中,新算法明顯優(yōu)于其他幾種流行方法。新算法能夠提供更加精確的估計(jì)結(jié)果,執(zhí)行時(shí)間更短。由于本文算法放棄了卡爾曼濾波器框架,轉(zhuǎn)而直接使用最佳線性無(wú)偏估計(jì)準(zhǔn)則,所以它在沒有增加算法復(fù)雜度的前提下,獲得了更好的性能。
圖10 5種算法的平均單次執(zhí)行時(shí)間比較
[1] Bordonaro S V, Willett P, and Bar-Shalom Y. Performance analysis of the converted range rate and position linear Kalman filter[C]. 2013 Asilomar Conference on Systems and Computers, Signals, California, USA, 2013, 1751-1755.
[2] Bordonaro S V, Willett P, and Bar-Shalom Y. Decorrelated, unbiased converted measurement kalman filter[J]. IEEE Transactions on Aerospace and Electronic Systems, 2014, 50(2): 1431-1442.
[3] Lerro D and Bar-Shalom Y. Tracking with debiased consistent converted measurements vs. EKF[J]. IEEE Transactions on Aerospace and Electronic Systems, 1993, 29(3): 1015-1022.
[4] Mo Long-bin, Song Xiao-quan, and Bar-Shalom Y. Unbiased converted measurements for tracking[J]. IEEE Transactions on Aerospace and Electronic Systems, 1998, 34(3): 1023-1027. [5] Duan Zhan-sheng, Han Chong-zhao, and Li Xiao-rong. Comments on unbiased converted measurements for tracking [J]. IEEE Transactions on Aerospace and Electronic Systems, 2004, 40(4): 1374-1377.
[6] Zhao Zhan-lue, Li Xiao-rong, and Jilkov V P. Best linear unbiased filtering with nonlinear measurements for target tracking[J]. IEEE Transactions on Aerospace and Electronic Systems, 2004, 40(4): 1324-1336.
[7] Bar-Shalom Y. Negative correlation and optimal tracking with Doppler measurements[J]. IEEE Transactions on Aerospace and Electronic Systems, 2001, 37(3): 1117-1120.
[8] Smith M A. On Doppler measurements for tracking[C]. 2008 International Conference on Radar, Australia, 2008: 513-518.
[9] Bar-Shalom Y, Willett P, and Tian X. Tracking and Data Fusion: a Handbook of Algorithms[M]. Storrs, CT: YBS Publishing, 2011: 211-286.
[10] Musicki D, Song T L, and Lee H H. Correlated Dopplerassisted target tracking in clutter[J]. IET Radar, Sonar & Navigation, 2013, 7(1): 94-100.
[11] Duan Zhan-sheng, Li Xiao-rong, and Han Chong-zhao. Sequential nonlinear tracking filter with range-rate measurements in spherical coordinates[C]. 7th International Conference on Information Fusion, Stockholm, Sweden, 2004: 131-138.
[12] Jiao Lian-meng, Pan Quan, and Feng Xiao-xue. A nonlinear tracking algorithm with range-rate measurements based onunbiased measurement conversion[C]. 15th International Conference on Information Fusion, Singapore, 2012: 1400-1405.
[13] Lei Ming and Han Chong-zhao. Sequential nonlinear tracking using UKF and raw range-rate measurements[J]. IEEE Transactions on Aerospace and Electronic Systems, 2007, 43(1): 239-250.
[14] Zhou Gong-jian, Michel P, and Thiagalingan K. Statically fused converted position and Doppler measurement Kalman filters[J]. IEEE Transactions on Aerospace and Electronic Systems, 2014, 50(1): 300-316.
[15] Duan Zhan-sheng, Li Xiao-rong, and Han Chong-zhao. Sequential unscented Kalman filter for radar target tracking with range rate measurements[C]. 8th International Conference on Information Fusion, Philadelphia, PA, USA, 2005, 1: 130-137.
王 煒: 男,1975年生,副教授,研究方向?yàn)樾畔⑷诤稀⑿盘?hào)處理與控制.
李 丹: 女,1980年生,講師,研究方向?yàn)榻y(tǒng)計(jì)學(xué)、信息處理.
姜禮平: 男,1961年生,教授,研究方向?yàn)樾畔⑷诤稀⒆鲬?zhàn)仿真.
金裕紅: 男,1968年生,副教授,研究方向?yàn)樗惴ɡ碚摷捌鋺?yīng)用.
The Best Linear Unbiased Estimation Algorithm with Doppler Measurements
Wang Wei①Li Dan②Jiang Li-ping①Jin Yu-hong①
①(School of Science, Naval University of Engineering, Wuhan 430033, China)
②(School of Science, Wuhan University of Science and Technology, Wuhan 430070, China)
A number of measurement-conversion techniques, which are based on position measurements, are widely used in tracking applications, so that the Kalman filter can be applied to the Cartesian coordinates. However, they have fundamental limitations resulting in filtering performance degradation. In fact, in addition to position measurements, the Doppler measurement containing information of target velocity has the potential capability of improving the tracking performance. A filter is proposed which can use converted Doppler measurements (i.e. the product of the range measurements and Doppler measurements) in the Cartesian coordinates. The novel filter is theoretically optimal in the rule of the best linear unbiased estimation among all linear unbiased filters in the Cartesian coordinates, and it is free from the fundamental limitations of the measurement-conversion approach. Based on simulation experiments, an approximate, recursive implementation of the novel filter is compared with those obtained by four state-of-the-art conversion techniques recently. Simulation results demonstrate the effectiveness of the proposed filter.
Target tracking; Doppler measurement; Best linear unbiased estimation; Converted measurement
TP391
: A
:1009-5896(2015)06-1336-07
10.11999/JEIT141113
2014-08-21收到,2014-12-22改回
國(guó)家自然科學(xué)基金(51307128, 60873032),中央高?;究蒲袠I(yè)務(wù)費(fèi)專項(xiàng)資金(2012-Ia-045),湖北省自然科學(xué)基金(2013CFB437)和海工大基金(HJGSK2014G121)資助課題
*通信作者:李丹 lidan0520@163.com