-
大小: 1KB文件類型: .m金幣: 1下載: 0 次發(fā)布日期: 2021-06-23
- 語言: Matlab
- 標(biāo)簽: 系統(tǒng)方程??量測(cè)方程??EKF濾波??
資源簡(jiǎn)介
不要寫EKF代碼,只要輸入系統(tǒng)方程和量測(cè)方程即可濾波
代碼片段和文件信息
function?[x_kP_k]=ekf_rn(fxPhzQR)
%?EKF???Extended?Kalman?Filter?for?nonlinear?dynamic?systems
%?[x?P]?=?ekf(fxPhzQR)?returns?state?estimate?x?and?state?covariance?P?
%?for?nonlinear?dynamic?system:
%???????????x_k+1?=?f(x_k)?+?w_k
%???????????z_k???=?h(x_k)?+?v_k
%?where?w?~?N(0Q)?meaning?w?is?gaussian?noise?with?covariance?Q
%???????v?~?N(0R)?meaning?v?is?gaussian?noise?with?covariance?R
%?Inputs:???f:?function?handle?for?f(x)
%???????????x:?“a?priori“?state?estimate
%???????????P:?“a?priori“?estimated?state?covariance
%???????????h:?fanction?handle?for?h(x)
%???????????z:?current?measurement
%?
評(píng)論
共有 條評(píng)論