当Q=1.5,R=0.5时波形如下:
[attach]49380[/attach]
,做到这一步后我又去看了一下原理
Q/(Q+R)的值就是卡尔曼增益的收敛值,比如其值为0.2,那么卡尔曼增益会向0.2收敛(对于0.2的含义解释一下,比如预测角度值是5度,角度测量值是10度,那么最优化角度为:5+0.2*(10-5)=6。从这里可以看出,卡尔曼增益越小,说明预测值越可靠,最优化角度越接近预测值;相反的,卡尔曼增益越大,说明测量值越可靠,最优化角度越接近测量值)。
总结一下:
两个疑问;第一由上面的三个波形是否可以说明我的预测值没有更新??第二:当Q=1.5,R=0.5时此时滤波器设置是否合理??