function plot_Estimate(Estimate_bestparticle,Estimate_weightedmean,Estimate_robustmean) data; figure; title('X-estimate') plot(xm,'c') hold on; plot(Estimate_bestparticle(1,:),'bo'); plot(Estimate_weightedmean(1,:),'r*'); plot(Estimate_robustmean(1,:),'ms'); legend('Real','Best particle','Weigthed mean','Robust mean') figure; title('Y-estimate') plot(ym,'c') hold on; plot(Estimate_bestparticle(2,:),'bo'); plot(Estimate_weightedmean(2,:),'r*'); plot(Estimate_robustmean(2,:),'ms'); legend('Real','Best particle','Weigthed mean','Robust mean') figure; title('Theta-estimate') plot(thetam,'c') hold on; plot(Estimate_bestparticle(3,:),'bo'); plot(Estimate_weightedmean(3,:),'r*'); plot(Estimate_robustmean(3,:),'ms'); legend('Real','Best particle','Weigthed mean','Robust mean')