gusucode.com > 扩展卡尔曼滤波,粒子滤波,去偏卡尔曼滤波和循环增益尔曼滤波的源程序 > 粒子滤波/filt_count.m

    function [final_filt_k1,final_filt_k2]=filt_count(filt_k1,filt_k2,N1)
sum_filt_k1=zeros(4,200);
sum_filt_k2=zeros(4,200);
for i=1:N1
    for j=1:200
       A(j,1:4)=filt_k1(i,:,j);
       B(j,1:4)=filt_k2(i,:,j);
   end
   A=A';
   B=B';
   sum_filt_k1=sum_filt_k1+A;
   sum_filt_k2=sum_filt_k2+B;
   A=zeros(200,4);
   B=zeros(200,4);
end
final_filt_k1=sum_filt_k1/N1;
final_filt_k2=sum_filt_k2/N1;