趙凱,胡建旺,吉兵
(軍械工程學院,石家莊050003)
基于H∞濾波的無序量測更新算法
趙凱,胡建旺,吉兵
(軍械工程學院,石家莊050003)
在目標跟蹤系統(tǒng)中,傳感器量測因通信延遲無序地到達融合中心,產(chǎn)生無序量測融合問題。針對此問題,將H∞濾波作為基礎濾波算法,提出了一種可處理單步或多步延遲無序量測的新算法。新算法借鑒有序濾波思想,利用等價量測來代替無序量測發(fā)生時刻后的量測序列,然后從該時刻起利用無序量測和等價量測進行有序更新。仿真實驗表明,新算法相比于傳統(tǒng)算法有更高的濾波精度,尤其在系統(tǒng)模型誤差較大時仍有良好的濾波效果。
無序量測,H∞濾波,等價量測,有序濾波
集中式目標跟蹤系統(tǒng)中,各傳感器的通信延遲、預處理時間與采樣速率等存在差別,會有傳感器信息不能同步到達融合中心的現(xiàn)象出現(xiàn),這種現(xiàn)象稱為異步現(xiàn)象[1-3]。在此情形下,對于同一個目標,若有較早時刻產(chǎn)生的量測在較晚產(chǎn)生的量測之后到達融合中心,則稱這些量測為無序量測(Out-of-Sequence Measurement,OOSM)。
對于OOSM問題,Bar-Shalom等人提出了A1、 B1和C1等算法[5-7],解決單步滯后OOSM問題。文獻[6]提出了等效量測的概念,將A1算法的適用范圍擴展到了多步滯后OOSM,并命名其為Al1算法。Thomopoulos算法[8]完全借助了信息濾波器,而后人們又在此基礎上提出了更簡潔有效、穩(wěn)定性更強的OOSM濾波算法,如:AA1算法[11],AAl算法[12]。上述算法都是以Kalman濾波為基礎濾波算法,基于線性最小均方誤差(Linear Minimum Mean Square Error,LMMSE)準則建立,因此,當系統(tǒng)建模誤差較大,即系統(tǒng)模型不精確時,濾波效果下降嚴重。
H∞濾波通過極大極小準則,對過程噪聲和量測噪聲的統(tǒng)計特性作了最壞的假設,增強了穩(wěn)定性和濾波精度。
對此,提出以H∞濾波為基礎的新的OOSM更新算法。通過結合H∞濾波、有序濾波[10]與等價量測方法,算法可有效處理單步延遲和多步延遲無序量測問題,且在系統(tǒng)模型誤差較大情形下有良好的效果。
線性離散系統(tǒng)
式中,F(xiàn)k,k-1為時刻tk-1到tk的狀態(tài)轉移矩陣,Hk為tk時刻量測矩陣;wk,k-1為時刻tk-1到tk的累積過程噪聲,vk是時刻tk的量測噪聲,兩者均為互不相關的高斯白噪聲,方差分別為Qk與Rk。
假設tk時刻,已有狀態(tài)估計
此時,需要用量測zd更新式(3)表示的tk時刻的狀態(tài)估計,即計算
Ravi Banavar在文獻[13]中最先提出了基于博弈論的H∞濾波算法。H∞濾波算法采用極大極小準則,引入了H∞范數(shù),在最大噪聲作用下尋求干擾引起的誤差范數(shù)最小,因而能夠在系統(tǒng)模型不精確條件下,保證濾波精度,具有較強的穩(wěn)定性。
令
推導出H∞濾波方程[14]
上述表明,參數(shù)θ取值對算法性能有重要作用:增大θ,可增強濾波器穩(wěn)定性,但會降低估計精度;減小θ則與之相反。
本文首次將H∞濾波算法應用到處理OOSM問題中。當融合中心收到OOSM后,將濾波過程返回至OOSM發(fā)生時刻,利用無序量測與等價量測按照H∞濾波方程進行有序更新。
3.1 等價量測方法
Bar-Shalom提出等價量測(EQM)方法[6],將多步量測等價為單步進行處理。
由式(14)可知,等價量測
其中
3.2 有序更新方法
過程與第1步類似,不再贅述。其中狀態(tài)轉移矩陣
至此,完成整個OOSM更新過程。
假定目標沿軸做勻速運動,運動方程和量測方程式(1),式(2)。利用5個傳感器對其進行跟蹤。
式(1)中目標狀態(tài)轉移矩陣為
目標狀態(tài)向量為
累積過程噪聲協(xié)方差為
式(2)中目標量測矩陣為
量測噪聲協(xié)方差為Rk=1。
表1 TOOSM中各傳感器觀測時刻
為比較各算法處理無序量測問題性能,在仿真中選擇濾波輸出的位置分量均方根誤差,其定義為
4.1 仿真1
如前文所述,θ的取值極大地影響新算法性能。假設延遲步數(shù)l=3,令θ分別取0.01、0.20、0.40、0.60、0.80、1.00、1.50,輸出結果如表2所示。
表2 不同θ時的位置分量均方根誤差
以上取值中,θ=0.4時位置分量的均方根誤差最小,因此,取θ=0.4。
4.2 仿真2
假設延遲步數(shù)l=1,3,使用新算法、Al1算法、AAl算法及數(shù)據(jù)緩存法分別進行處理,輸出結果如表3所示。括號內數(shù)值為相對數(shù)據(jù)緩存法結果的偏差。
從表3可看到,以最優(yōu)的數(shù)據(jù)緩存法為基準,新算法濾波精度遠高于Al1算法,與AAl算法相似,并且隨著延遲步數(shù)增加,性能下降不明顯。
表3 仿真2中各算法結果比較
4.3 仿真3
假設每個融合周期內融合中心接收到傳感器2的量測都是無序量測。對應于延遲步數(shù)l=1,3,分別使用新算法、Al1算法、AAl算法與數(shù)據(jù)緩存法進行處理,結果如下頁圖1所示。
從圖1多個融合周期的濾波結果看,在單步延遲情形下,新算法濾波精度接近于數(shù)據(jù)緩存法,遠高于Al1算法與AAl算法;但隨著延遲步數(shù)的增加,其濾波精度稍有下降,但仍好于Al1算法與AAl算法。
4.4 仿真4
比較系統(tǒng)模型誤差較大時各算法性能,驗證濾波器穩(wěn)定性。將狀態(tài)轉移矩陣設為
處理結果如圖2所示。從圖2看出,在系統(tǒng)模型有較大誤差的情形下,新算法對單步延遲OOSM的處理有良好的效果,當延遲步數(shù)增加時精度下降,但仍遠高于Al1算法與AAl算法。這是因為新算法基于H∞濾波,穩(wěn)定性較好。
圖1 仿真3中各算法結果比較
圖2 仿真4中各算法結果比較
新算法在有序濾波框架下,結合等價量測方法,使用H∞濾波算法對OOSM進行更新,可處理單步延遲與多步延遲OOSM問題,精度較高。仿真實驗也驗證了算法性能。今后,可以考慮將H∞濾波算法與粒子濾波等算法結合,解決非線性條件下無序量測問題。
[1]韓崇昭,朱紅艷,段戰(zhàn)勝,等.多源信息融合[M].2版.北京:清華大學出版社,2010:368-379.
[2]王洪峰,周磊,單甘霖.國外軍事信息融合理論與應用的研究進展[J].電光與控制,2007,14(4):13-17.
[3]王煒,黃心漢,王敏.無序量測濾波更新算法綜述[J].控制與決策,2012,27(1):1-5.
[4]王煒,黃心漢,徐忠昌,等.一種新的無序量測處理算法[J].電子與信息學報,2009,31(8):1996-2000.
[5]BAR-SHALOM Y,MALLICK M,CHEN H,et al.One-step solution for the general out-of-sequence-measurement problem in tracking[C]//Aerospace Conference Proceedings,2002,IEEE,2002:4-1551-4-1559.
[6]BAR-SHALOM Y,MALLICK M,CHEN H,et al.One-step solution for the general out-of-sequence-measurement problem in tracking[C]//Aerospace Conference Proceedings,2002,IEEE,2002:4-1551-4-1559.
[7]BAR-SHALOM Y.Update with out-of-sequence measurements in tracking:exact solution[J].Aerospace&Electronic Systems IEEE Transactions on,2002,38(3):769-777.
[8]THOMOPOULOS S C A,ZHANG L.Decentralized filtering with random sampling and delay[J].Information Sciences,1994(81):117-131.
[9]ZHOU W H,LIN L I.Optimality analysis of one-step OOSM filtering algorithms in target tracking[J].Science in China,2007,50(2):170-187.
[10]黃細鳳,吳欽章.順序更新式無序量測處理算法[J].傳感技術學報,2012,25(2):224-228.
[11]BANAVAR R N,BANAVAR R N.A game theoretic approach to linear dynamic estimation[J].Thesis Texas Univ,1992(2):42-45.
[12]SHEN X,SONG E,ZHU Y,et al.Globally optimal distributed kalman fusion with local out-of-sequence-measurement updates[J].Automatic Control IEEE Transactions on,2009,54(8):1928-1934.
[13]SHEN X,DENG L.Discrete H∞filter design with application to speech enhancement[C]//IEEE International Conference on Acoustics,Speech,and Signal Processing,1995:1504-1507.
[14]侯代文.基于sigma點H∞濾波的說話人跟蹤方法[J].信號處理,2009,25(3):374-378.
[15]ZHOU W H,LIN L I,GUOHAI C,et al.Optimal update with multistep out-of-sequence measurements in target tracking[C]//Proc of the 8th Int Conf on Signal Processing. Guilin,2006:281-284.
An Out-of-Sequence-Measurement Update Algorithm Based on H∞Filtering
ZHAO Kai,HU Jian-wang,JI Bing
(Ordnance Engineering College,Shijiazhuang 050003,China)
In target tracking systems,sensor measurements may arrive at the fusion center out of sequence because of the communication delays,which results in the Out-of-Sequence Measurement(OOSM)problem.Aiming at the above problem,taking H∞filtering as the basis filtering algorithm,a new algorithm can deal with both 1-step-lag OOSM and multi-step-lag OOSM is proposed.The new algorithm deal with OOSM by combing the framework of in-sequence filtering method the equivalent measurement is used to replace the measurement after the moment when the OOSM measured,and then updates from that moment with the OOSM and the equivalent measurement.Theoretical and simulations show that,compared to the traditional algorithm,the new algorithm has a higher filtering accuracy,especially when the system model error is large.
OOSM,H∞filtering,equivalent measurement,in-sequence filtering
TP391
A
1002-0640(2017)02-0159-04
2016-01-18
2016-03-16
趙凱(1991-),男,山東濟南人,碩士研究生。研究方向:多源信息融合,目標跟蹤。