卡爾曼濾波器的應(yīng)用-資料下載頁
2025-05-13 18:14本頁面
【正文】 布 , 在 范圍內(nèi) , 其概率密度函數(shù) 因此 , 加速度方差 由于 。 ,于是可求得 ， u ()n?()n? M?1()2f u M?2213u M? ?1 ( ) ( )u n T n?? 2 ( ) ( )u n T n??2 2 21 uT??? 2 2 22 1 0? ? ??2222100 0 0 00 0 0()0 0 0 00 0 0uTn ???????? ??????Q 設(shè) km, 雷達天線旋轉(zhuǎn)同期 s,目標(biāo)最大加速度 雷達測距誤差均方根值等于 1 km, ? =10m。 雷達方位角測量誤差均 方根值等于 或 . 由 和 可算出矩陣 。 由 可算出 : ， 一 .迭代計算 , 和 : （ 1）求得 的初始值 : （ 2）由 計算 : 1600 ?? 15?T ?M?12??2?? 2?? R 0, ?TM33021 ?? 822 ????)(n? )(nP 4G)(n???????????????????????????65544446)2(?)2(? )3(P （ 3）由 計算 : （ 4）由 和 計算 : 再返回步驟 (2),確良迭代計算下一時刻的 , ? 二 .迭代計算 : ?????????????????????????????65543556T00102105)2()3( QAAP ?)3(P 3G????????????????????221TT3])3([)3( RCCPCPG)3(P 3G )3(?)3(][)3( 3 PCGI ???)4(P 4G)|(? nns 如圖 , 當(dāng)給定 的初始值后 , 根據(jù)不斷測得的觀 測數(shù)據(jù) ,利用上面迭代計算得到的 , 迭代計算 : C)(nxnG)|(? nns )|(? nnsA圖 根據(jù)測量值 x(n) 迭代計算 )(nx nG )|(? nns)]1|1(?)([)1|1(?)|(? ??????? nnnnnnn n sACxGsAs)1|1(? ?? nns
環(huán)評公示相關(guān)推薦
鄂ICP備17016276號-1