【MATLAB】Extended Kalman Filter

来源:互联网 发布:js 判断对象是否隐藏 编辑:程序博客网 时间:2024/05/18 14:27

公式来自:卡尔曼滤波——维基百科

下了好多程序,但是人家的f都是固定的,昨天师兄给了篇论文让参照里面的transitionmatrix,手动算了Jacobians矩阵,写了下面的程序。

论文:Robot Visual Servo through Trajectory Estimation of a Moving Object Using Kalman Filter 


仍在修改中。。

红点为给出的轨迹上的点(观测),蓝色为更新后的点。绿点为预测点。


代码见:http://download.csdn.net/detail/apsvvfb/6401983

原创粉丝点击