get_out.asv

来自「针对卡尔曼滤波的原创改进算法」· ASV 代码 · 共 9 行

%------------------------------------
%---------重心法得到推理结果值   -----
%------------------------------------
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