卡爾曼濾波器的實(shí)現(xiàn)方法、裝置、存儲(chǔ)介質(zhì)和設(shè)備

基本信息

申請(qǐng)?zhí)?/td> CN202111183665.7 申請(qǐng)日 -
公開(公告)號(hào) CN114124033A 公開(公告)日 2022-03-01
申請(qǐng)公布號(hào) CN114124033A 申請(qǐng)公布日 2022-03-01
分類號(hào) H03H17/02(2006.01)I 分類 基本電子電路;
發(fā)明人 焦敬恩;王東峰;華斌;殷宏杰 申請(qǐng)(專利權(quán))人 嘉興聚速電子技術(shù)有限公司
代理機(jī)構(gòu) 北京科家知識(shí)產(chǎn)權(quán)代理事務(wù)所(普通合伙) 代理人 周瑜
地址 100080北京市海淀區(qū)蘇州街26號(hào)805室、808室
法律狀態(tài) -

摘要

摘要 本發(fā)明實(shí)施例提供一種卡爾曼濾波器實(shí)現(xiàn)的方法、存儲(chǔ)介質(zhì)和電子裝置,所述方法包括:獲取并初始化系統(tǒng)參數(shù),獲取量測(cè)信息,根據(jù)量測(cè)信息和后驗(yàn)觀測(cè)噪聲統(tǒng)計(jì)量計(jì)算有效卡爾曼增益,根據(jù)線性觀測(cè)模型和多元高斯分布的線性性質(zhì)得到量測(cè)的概率密度函數(shù),根據(jù)概率密度函數(shù)計(jì)算通過(guò)重要性采樣獲得的采樣點(diǎn)的后驗(yàn)觀測(cè)噪聲分布的期望,對(duì)后驗(yàn)觀測(cè)噪聲統(tǒng)計(jì)量進(jìn)行更新,根據(jù)所述有效卡爾曼增益以及更新后的后驗(yàn)觀測(cè)噪聲統(tǒng)計(jì)量對(duì)狀態(tài)協(xié)方差矩陣進(jìn)行更新,根據(jù)更新后的狀態(tài)協(xié)方差矩陣對(duì)狀態(tài)進(jìn)行更新,重復(fù)執(zhí)行獲取量測(cè)信息至對(duì)狀態(tài)協(xié)方差矩陣進(jìn)行更新的步驟,直至狀態(tài)實(shí)現(xiàn)收斂。本發(fā)明能夠提高卡爾曼濾波器的計(jì)算速度和估計(jì)精度。