[發(fā)明專利]一種自適應(yīng)交互式多模型的機(jī)動目標(biāo)跟蹤方法

有效

• 申請?zhí)枺?/td>: 201210514479.1
• 申請日: 2012-12-04
• 公開（公告）號: CN103853908B
• 公開（公告）日: 2017-11-14
• 發(fā)明（設(shè)計）人: 杜勁松;畢欣;高潔;田星
• 申請（專利權(quán)）人: 中國科學(xué)院沈陽自動化研究所
• 主分類號: G06F19/00
• 分類號: G06F19/00;G01C23/00
• 代理公司: 沈陽科苑專利商標(biāo)代理有限公司21002
• 代理人: 周秀梅,許宗富

技術(shù)領(lǐng)域

本發(fā)明屬于機(jī)動目標(biāo)跟蹤領(lǐng)域，具體涉及在交通運輸領(lǐng)域中，當(dāng)行駛中的汽車出現(xiàn)突然轉(zhuǎn)彎、加速、減速等運動時，提出一種自適應(yīng)交互式多模型的機(jī)動目標(biāo)跟蹤方法。

背景技術(shù)

目標(biāo)跟蹤是將探測傳感器收到的目標(biāo)移動數(shù)據(jù)結(jié)合各種不確定信息源所產(chǎn)生的不同觀測集合進(jìn)行濾波，并估計出運動目標(biāo)的狀態(tài)參數(shù)，比如目標(biāo)的距離、方位、速度、加速度等。

單模型機(jī)動目標(biāo)跟蹤算法，只對非機(jī)動目標(biāo)跟蹤性能良好。當(dāng)目標(biāo)機(jī)動時，系統(tǒng)的跟蹤性能下降，甚至導(dǎo)致目標(biāo)丟失。為了實現(xiàn)對機(jī)動目標(biāo)跟蹤，需要針對機(jī)動目標(biāo)的運動特點建立合理的運動模型。典型的運動模型有Singer模型、“當(dāng)前”統(tǒng)計模型、交互式多模型（interacting multiple model,IMM）等。在傳統(tǒng)的IMM模型中，假設(shè)目標(biāo)在不同的運動模型之間的轉(zhuǎn)移概率是固定的，這種假設(shè)并沒有充分的考慮到運動模型的選擇性，而是利用類似“硬判決”的思想將模型之間的轉(zhuǎn)移概率固定在某個數(shù)值。事實上，當(dāng)目標(biāo)的運動模型具有某種趨向性，傳統(tǒng)的IMM算法只是通過調(diào)解不同觀測向量條件下運動模型的后驗概率加權(quán)實現(xiàn)對運動模型之間的“綜合”，而并沒有考慮到馬爾可夫轉(zhuǎn)移概率矩陣設(shè)計的不合理性。

交通運輸領(lǐng)域中，當(dāng)行駛中的汽車出現(xiàn)突然轉(zhuǎn)彎、加速、減速等運動也屬于目標(biāo)的機(jī)動，尤其當(dāng)車輛目標(biāo)突然進(jìn)入彎道時，車輛運動狀態(tài)較之前勻速或勻加速直線運動將發(fā)生較大的變化，如果不能有效的適應(yīng)目標(biāo)的機(jī)動狀態(tài)，很容易造成目標(biāo)的丟失，而當(dāng)目標(biāo)發(fā)生機(jī)動時，恰是最容易發(fā)生交通事故的時刻。交通運輸領(lǐng)域車輛機(jī)動目標(biāo)跟蹤方法的主要目的是滿足汽車運行中能可靠而精確地跟蹤并判定目標(biāo)，增強(qiáng)防撞探測系統(tǒng)運行的穩(wěn)定性和可靠性，有效提高駕駛員的行車安全，保障生命財產(chǎn)安全。

因此，針對傳統(tǒng)IMM跟蹤算法中采用固定馬爾可夫矩陣的缺點，本發(fā)明提出一種交通運輸領(lǐng)域自適應(yīng)交互式多模型的機(jī)動目標(biāo)跟蹤方法，提高復(fù)雜環(huán)境性下車輛機(jī)動目標(biāo)跟蹤系統(tǒng)的性能，具有重大理論意義及工程應(yīng)用價值。

發(fā)明內(nèi)容

針對現(xiàn)有技術(shù)中存在的上述不足之處，本發(fā)明要解決的技術(shù)問題是提供一種穩(wěn)定、可靠、環(huán)境適應(yīng)性強(qiáng)、算法實時性高的車輛機(jī)動目標(biāo)跟蹤方法，提高復(fù)雜環(huán)境性下車輛機(jī)動目標(biāo)跟蹤系統(tǒng)的性能。

本發(fā)明為實現(xiàn)上述目的所采用的技術(shù)方案是：一種自適應(yīng)交互式多模型的機(jī)動目標(biāo)跟蹤方法，包括以下步驟：

步驟1：建立IMM跟蹤模型中的各種模型混合初始化輸入，包括各模型的混合初始條件和混合初始狀態(tài)的協(xié)方差矩陣；

步驟2：利用每個模型的混合輸入，分別計算勻速運動模型和勻加速運動模型初始值

步驟3：根據(jù)Kalman濾波方程計算誤差的協(xié)方差矩陣和新息計算估計更新；

步驟4：利用基于新息的運動模型似然比函數(shù)，建立馬爾可夫狀態(tài)轉(zhuǎn)移概率矩陣；

步驟5：利用當(dāng)前時刻獲得的狀態(tài)狀態(tài)轉(zhuǎn)移矩陣對模型條件估計進(jìn)行融合，計算總體狀態(tài)估計輸出。

所述勻速運動模型為：

狀態(tài)矢量表示為：

X=[x(k) v_x(k) y(k) v_y(k)]^T

式中，x(k)、y(k)分別表示k時刻目標(biāo)在x、y方向上的位移，v_x(k)、v_y(k)分別表示k時刻目標(biāo)在x、y方向上的速度；

狀態(tài)轉(zhuǎn)移矩陣表示為：

式中，T為相鄰兩個時刻的時間間隔；

系統(tǒng)控制量表示為：

系統(tǒng)過程噪聲表示為：

式中，u_x(k)、u_y(k)描述了x、y方向上的過程噪聲，假設(shè)為相互獨立的、零均值、高斯白噪聲，方差分別為和

系統(tǒng)觀測矩陣為：

觀測噪聲為：

其中，v_x(k)、v_y(k)為x、y方向上的觀測噪聲，假設(shè)為相互獨立的、零均值、高斯白噪聲，方差為σ²。

所述勻加速運動模型為：

狀態(tài)矢量表示為：

X=[x(k) v_x(k) a_x(k) y(k) v_y(k) a_y(k)]^T