公式来自:卡尔曼滤波——维基百科
下了好多程序,但是人家的f都是固定的,昨天师兄给了篇论文让参照里面的transitionmatrix,手动算了Jacobians矩阵,写了下面的程序。
论文:Robot Visual Servo through Trajectory Estimation of a Moving Object Using Kalman Filter
仍在修改中。。
公式来自:卡尔曼滤波——维基百科
下了好多程序,但是人家的f都是固定的,昨天师兄给了篇论文让参照里面的transitionmatrix,手动算了Jacobians矩阵,写了下面的程序。
论文:Robot Visual Servo through Trajectory Estimation of a Moving Object Using Kalman Filter
仍在修改中。。