Boid集群运动（无捕食者、有捕食者俩种代码）Matlab

pos=cell(1,100); for i=1:100 pos{i}=[rand(1,1)*5,rand(1,1)*5,rand(1,1)*5]; end dolpos=[rand(1,1)*5,rand(1,1)*5,rand(1,1)*5]; directdol=pos{1}-dolpos; for i=2:100 if norm(pos{i}-dolpos)<norm(directdol) directdol=pos{i}-dolpos; end end x=zeros(1,100); y=zeros(1,100); z=zeros(1,100); v=0.1; direct1=cell(1,100); direct2=cell(1,100); direct3=cell(1,100); direct4=cell(1,100); direct5=cell(1,100); direct6=cell(1,100); direct7=cell(1,100); direct8=cell(1,100); cons=ones(1,100); for (i=1:100) direct1{i}=[rand(1,1)*5,rand(1,1)*5,rand(1,1)*5]-pos{i}; direct2{i}=zeros(1,3); direct3{i}=zeros(1,3); direct4{i}=zeros(1,3); direct7{i}=zeros(1,3); direct8{i}=zeros(1,3); end for t=1:2000 dolpos=dolpos+directdol/norm(directdol)*1.1*v/10; for i=1:100 m=0; n=0; k=0; l=[0,0,0]; direct5{i}=zeros(1,3); direct6{i}=zeros(1,3); for j=1:100 if j==i continue else direct7{i}=(direct7{i}+pos{j}-pos{i})./j; direct8{i}=(direct8{i}+direct1{j})./j; if (norm(pos{i}-pos{j})<=5)&&(norm(pos{i}-pos{j})>=0.1) m=m+1; k=k+norm(direct1{j}); l=l+direct1{j}; direct2{i}=(direct2{i}+(pos{j}-pos{i}))./m; direct3{i}=(direct3{i}+direct1{j})./m; cons(i)=norm(l)/k; elseif norm(pos{i}-pos{j})<0.1; n=n+1; direct4{i}=(direct2{i}+(pos{i}-pos{j}))./n; end end end if norm(pos{i}-dolpos)<=1%dangerous area direct5{i}=pos{i}-dolpos; direct6{i}=(-1)*directdol; direct1{i}=direct5{i}+direct6{i}; pos{i}=pos{i}+(0.5*(direct5{i}+direct6{i}))*v; if norm(pos{i}-dolpos)<=0.1 pos{i}=[-111,-11,-11]; directdol=[rand(1,1)*10,rand(1,1)*10,rand(1,1)*10]; end for r=1:30 if norm(pos{r}-dolpos)<norm(directdol) directdol=pos{r}-dolpos; end end else if (pos{i}(1)>=5)||(pos{i}(2)>=5)||(pos{i}(1)<=0)||(pos{i}(2)<=0)||(pos{i}(3)>=5)||(pos{i}(3)<=0) direct1{i}=direct1{i}*(-1); pos{i}=pos{i}+direct1{i}/norm(direct1{i})*v; else if norm(pos{i}-dolpos)<=2.5%feeling area direct5{i}=pos{i}-dolpos; direct6{i}=(-1)*directdol; direct1{i}=0.1*direct2{i}+0.1*direct3{i}+0.1*direct4{i}+0.25*direct5{i}+0.25*direct6{i}+0.1*direct7{i}+0.1*direct8{i}; pos{i}=pos{i}+direct1{i}/norm(direct1{i})*v; else direct1{i}=0.1*direct1{i}+0.1*direct2{i}+0.1*direct3{i}+0.1*direct4{i}+0.3*direct7{i}+0.3*direct8{i}; pos{i}=pos{i}+direct1{i}/norm(direct1{i})*v*exp(5*(cons(i)-1)); end end end end if (dolpos(1)>=5||dolpos(2)>=5||dolpos(1)<=0||dolpos(2)<=0||dolpos(3)>=5||dolpos(3)<=0) directdol=(-1)*directdol; end dolpos=dolpos+directdol/norm(directdol)*1.1*v/10; for i=1:100 x(i)=pos{i}(1); y(i)=pos{i}(2); z(i)=pos{i}(3); end plot3(x,y,z,'^',dolpos(1),dolpos(2),dolpos(3),'*') axis([0 5 0 5 0 5],'square','manual'); grid on; pause(0.1); end