【正文】
)()k k kk k kx f x wz h x v???? ???模型推廣 擴展 kalman濾波核心思想:非線性問題線性化 ?0kkkkxxkwfAx ?????為 f對 xk1求偏導(dǎo)的雅可比矩陣 為 f對 wk1求偏導(dǎo)的雅可比矩陣 ?0kkkkxxkwfWw ????? ? ?1 ? ?( , 0)k k k k k k k kx A x f x A x W w? ? ? ? ?狀態(tài)方程 ? ?? ?( , 0)k k k k k k k kz H x h x H x V v??? ? ? ?觀測方程 為 h對 xk求偏導(dǎo)的雅可比矩陣 為 h對 vk求偏導(dǎo)的雅可比矩陣 其中 1? ?( , 0)kkx f x? ?? ?0kkkkxxkvhHx ?????? ?0kkkkxxkvhVv ??????總體流程 ? ,kkxP11? ,kk????xP 擴展 Kalman濾波原理 3 Greg Welch, Gary Bishop. An Introduction to the Kalman Filter 簡單實例 4 測量任務(wù) 1: +1 si nc osk k kk k k