tiaow.m

从事多机器人探测控制的朋友可以参考我写的源程序

for k=1:20
     for j=1:50
     if lovelist(k,j)==0
         plot(k,j,'s');hold on
     elseif lovelist(k,j)==-1
         plot(k,j,'m*');hold on
     elseif lovelist(k,j)==1
         plot(k,j,'p');hold on
     elseif lovelist(k,j)==2
         plot(k,j,'<');hold on
     elseif lovelist(k,j)==3
         plot(k,j,'m>');hold on
     elseif lovelist(k,j)==4
         plot(k,j,'v');hold on
     elseif lovelist(k,j)==51
         plot(k,j,'r-x');hold on   
     elseif lovelist(k,j)==52
         plot(k,j,'go');hold on
     elseif lovelist(k,j)==53
         plot(k,j,'bD');hold on   
     end
     end
 end
 
     for  i=1:runi
     cn=guiji(i,1); cm=guiji(i,2);cnn=guiji(i,3); cmm=guiji(i,4);cnnn=guiji(i,5);cmmm=guiji(i,6);
     plot(cn,cm,'rx');hold on
     plot(cnn,cmm,'go');hold on
     plot(cnnn,cmmm,'bD');hold on
     end
     for j=2:runi
         cn=guiji(j-1,1); cm=guiji(j-1,2);cnn=guiji(j,1); cmm=guiji(j,2);
         bn=guiji(j-1,3); bm=guiji(j-1,4);bnn=guiji(j,3); bmm=guiji(j,4);
         an=guiji(j-1,5); am=guiji(j-1,6);ann=guiji(j,5); amm=guiji(j,6);
         for k=1:50
             a=cn+(cnn-cn)*k/50;b=cm+(cmm-cm)*k/50;
             plot(a,b,'r-');hold on
             aa=bn+(bnn-bn)*k/50;bb=bm+(bmm-bm)*k/50;
             plot(aa,bb,'g-');hold on
             aaa=an+(ann-an)*k/50;bbb=am+(amm-am)*k/50;
             plot(aaa,bbb,'b-');hold on
         end
     end