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

    %function show(ME_final_view_err_x,ME_final_filter_err_x,ME_final_view_err_y,ME_final_filter_err_y,final_filt_k1,final_filt_k2,N,real_data,view_data,filter_data,real_v);
function show(ME_final_view_err_x,ME_final_filter_err_x,ME_final_view_err_y,ME_final_filter_err_y,...
RMSE_final_view_err_x,RMSE_final_filter_err_x,RMSE_final_view_err_y,RMSE_final_filter_err_y,N,real_data,view_data,filter_data,real_v)
M=1:N;
figure('NumberTitle','off','name','x方向均值误差比较图');
plot(M,ME_final_view_err_x,':r'),hold on
plot(M,ME_final_filter_err_x);
grid on;
figure('NumberTitle','off','name','y方向均值误差比较图'); 
plot(M,ME_final_view_err_y,':r'),hold on
plot(M,ME_final_filter_err_y);
grid on;

figure('NumberTitle','off','name','x方向均方误差比较图');
plot(M,RMSE_final_view_err_x,':r'),hold on
plot(M,RMSE_final_filter_err_x);
grid on;
figure('NumberTitle','off','name','y方向均方误差比较图'); 
plot(M,RMSE_final_view_err_y,':r'),hold on
plot(M,RMSE_final_filter_err_y);
grid on;

figure('NumberTitle','off','name','轨迹图');
plot(real_data(1,:),real_data(2,:)),hold on
plot(view_data(1,:),view_data(2,:),':r'),hold on
plot(filter_data(1,:),filter_data(3,:),'-.c')
grid on

figure('NumberTitle','off','name','速度图');
subplot(2,1,1),plot(M,real_v(1,:)),hold on
plot(M,filter_data(2,:),':r');
title('x方向')
grid on;
subplot(2,1,2),plot(M,real_v(2,:)),hold on
plot(M,filter_data(4,:),':r');
title('y方向')
grid on;