main.m

粒子滤波算法在机器人定位中的应用

%main function
num=100;
error1=7.5;
Robottest(1:12)=[random('normal',2.5,0.21),random('normal',3,0.21),360*rand(1),0, 0, 0, 0, 0, 0, 0, 0, 0];
Robot(1:12)=[0];
p(1:num,1:12)=[0];
% lastx=Robottest(1);
% lasty=Robottest(2);
% lastTh=Robottest(3);

save('error1','error1');
% save('lastx','lastx');
% save('lasty','lasty');
% save('lastTh','lastTh');
save('num','num');
save('p','p');
save('Robottest','Robottest');
save('Robot','Robot');
Orientat;  
save('p','p');
save('Robot','Robot');
save('Robottest','Robottest');