get_out.m

针对卡尔曼滤波的原创改进算法

%----------------------------------------------------------------
%-------重心法得到推理结果值  在这里可以实现任何一种反模糊方法------
%----------------------------------------------------------------
function out=get_out(vx,vy,d)
gl=compute_out(vx,vy);
out=0;
for i=1:4
    out=out+gl(i,1)*gl(i,2)*d;
end