卡爾曼濾波器及多傳感狀態(tài)融合估計算法
加入技術(shù)交流群
Carlson 在1990 年提出了一種最優(yōu)數(shù)據(jù)融合準(zhǔn)則。
設(shè)
分別表示狀態(tài)基于傳感器i 觀測信息的Kalman 濾波估計值和相應(yīng)的估計誤差協(xié)方差陣， 對于i=1 ，2，…，N， 假設(shè)
不相關(guān)， 則最優(yōu)聯(lián)邦濾波器最優(yōu)數(shù)據(jù)融合準(zhǔn)則由下式給出：
其中：
相應(yīng)的估計誤差協(xié)方差矩陣為：
可以證明：
其中P(k|k)表示
的估計誤差協(xié)方差。
基于第i 個傳感器信息的Kalman 濾波估計器如圖1 所示。Carlson 聯(lián)邦融合估計算法流程圖如圖2 所示。
圖1 Kalman 濾波方框圖
評論