我们写一个主程序，包括两个函数更新函数和预测函数，然后导入一系列测量和运动数据。
如果初始估计是5，非常好，但我们将其设置为mu=0，且不确定性非常高为sig=10000.如
阅读背景：
卡尔曼滤波——19.卡尔曼滤波器代码
来源：互联网
分享到：
