怎样确定卡尔曼滤波算法的初始值如A,P,Q,R?求救
看了好多资料都没有明确的说明A,P,Q,R怎么去取值,有的有也不说明原因,请教大大们,怎么取啊?
我用了别人的代码,滤波前后如图:
其中设置的A=1,Q=0.001,R=1,
所采集数据为由三维加速度传感器各轴,
怎么过滤后变成零左右了,这应该不对的吧~
真心求教
[解决办法]
肯定是不对,把真实值改变得太大了,你得看AQPR的各参数含义,根据实际值来确定AQPR的调整量,你应该是想让曲线变得平滑些,这伯别有方法也可以做到,看两种曲线,好象你一开始的就把真实数据值大幅降低了.你单步执行看滤波前和滤波后的数据值改变大小就能知道改变哪个参数及找到合适的参数值