日志
無人機(jī)尋找污染源matlab代碼
熱度 1
P=5.5;
a=80;%無人機(jī)橫坐標(biāo)
b=80;%無人機(jī)縱坐標(biāo)
L=1;%無人機(jī)起始搜索步長
Y=[0,0];%污染源坐標(biāo)
Q=25;%氣體源強(qiáng)
k=0.08;%氣體擴(kuò)散系數(shù)
distance=0;%初始化總路程為0
xa=-100:0.1:100;
ya=xa;
[x,y] = meshgrid(xa,ya);
d=sqrt(x.^2+y.^2);
z=4*pi*k*d*(1/Q);
contour(x,y,z,20,'LineWidth',3) %創(chuàng)建原始空氣污染物狀態(tài)情況
hold on
for h=1:1:20
A=[a,b];
plot(a,b,'rs');
B=[a+L*cos(pi/6),b-L*sin(pi/6)];
plot([a;a+L*cos(pi/6)],[b;b-L*sin(pi/6)],'r');%直線AB
C=[a+L*cos(pi/6),b-L*sin(pi/6)-L];
plot([a+L*cos(pi/6);a+L*cos(pi/6)],[b-L*sin(pi/6);b-L*sin(pi/6)-L],'r');%直線BC
D=[a,b-2*L*sin(pi/6)-L];
plot([a+L*cos(pi/6);a],[b-L*sin(pi/6)-L;b-2*L*sin(pi/6)-L],'r');%直線CD
E=[a-L*cos(pi/6),b-L*sin(pi/6)-L];
plot([a;a-L*cos(pi/6)],[b-2*L*sin(pi/6)-L;b-L*sin(pi/6)-L],'r');%直線DE
F=[a-L*cos(pi/6),b-L*sin(pi/6)];
plot([a-L*cos(pi/6);a-L*cos(pi/6)],[b-L*sin(pi/6)-L;b-L*sin(pi/6)],'r');%直線EF
plot([a-L*cos(pi/6);a],[b-L*sin(pi/6);b],'r');%直線FA
%每個(gè)點(diǎn)的空氣清潔指數(shù)
AirA=4*pi*k*norm(Y-A)*(1/Q);
AirB=4*pi*k*norm(Y-B)*(1/Q);
AirC=4*pi*k*norm(Y-C)*(1/Q);
AirD=4*pi*k*norm(Y-D)*(1/Q);
AirE=4*pi*k*norm(Y-E)*(1/Q);
AirF=4*pi*k*norm(Y-F)*(1/Q);
%尋找最小值作為新的起始點(diǎn)
Air=[AirA,AirB,AirC,AirD,AirE,AirF];
[m,n]=min(Air);
switch n
case 1
A=[a,b];
S=A;
case 2
A=[a+L*cos(pi/6),b-L*sin(pi/6)];
S=B;
case 3
A=[a+L*cos(pi/6),b-L*sin(pi/6)-L];
S=C;
case 4
A=[a,b-2*L*sin(pi/6)-L];
S=D;
case 5
A=[a-L*cos(pi/6),b-L*sin(pi/6)-L];
S=E;
case 6
A=[a-L*cos(pi/6),b-L*sin(pi/6)];
S=F;
end
a=A(1);
b=A(2);
distance=distance+6*norm(Y-A)+norm(A-S);
if AirA==m;
fprintf('迭代次數(shù)為%d次\n',h)
fprintf('總路程為：%d\n',distance)
fprintf('到污染源的距離為：%d\n',norm(Y-AirA))
if norm(Y-AirA)>=1
fprintf('到污染源的距離過遠(yuǎn)！\n')
end
break
else
L=P*(1/(AirA-m));
end
end
hold off
format long g
distance %#ok<NOPTS>
