matlab 实现的kalman滤波
最新推荐文章于 2024-04-25 09:43:57 发布
![](https://img-home.csdnimg.cn/images/20240711042549.png)
clearclcclose all%kalmanf_example_2%x列向量% x(k+1)=[1 T; 0 1]x(k)+[T^2/2;T]v(k);% z(k)=[1 0]x(k)+w(k);% v(k)~N(0, 1) Q;% w(k)~N(0, 1) R;% x(0)~N([0; -10], I)T=0.025;F=[1 T; 0 1];TN=[T^2/2;T];G=[0 0; 0 0];u=[0;0];H=[1 0];