locate.asv

genetic遗传算法

function [sol,val] = locate(sol,options)
t=[1364 1204 1368 1156 1200 1302 1112 1286]/1000;
% x=[39487714.54 39487190.16 39486897.50 39486467.13 39485936.18 39486344.51... 
%     39485491.82 39487555.29 39487938.09 39486000.43 39485251.45 39485786.05...
%     39486147.64 39486620.20 39485806.34 39485849.05];
x=[6344.51 6000.43	5251.45	5786.05	6147.64	6620.2	5806.34	5849.05]/1000;
% y=[3939197.67 3939147.28 3938985.83 3939299.85 3939319.40 3938493.23 3939196.54...
%     3938345.63 3937955.98 3937954.13 3938591.75 3937837.04 3937302.06... 
%     3937329.38 3937405.75 3938350.12];
y=[3493.23 4196.54 3345.63 2955.98 2954.13 3591.75 2837.04 2302.06 2329.38 2405.75 3350.12]/1000;
z=[-850.50 -505.00 -850.00 -850.00... 
    -850.00 -505.00 -758.40 -846.50 -850.00 -754.90 -760.60]/1000;
v=3600;
temp=0;
for i=1:16
    if t(i)>0
%         distance=sqrt((sol(1)-x(i)).^2+(sol(2)-y(i)).^2+(sol(3)-z(i)).^2);
%         temp=temp+(t(i)-sol(4)-distance/v).^2;
        distance=sqrt((1000*sol(1)-1000*x(i)).^2+(1000*sol(2)-1000*y(i)).^2+(1000*sol(3)-1000*z(i)).^2);
        temp=temp+(t(i)-sol(4)-distance/v).^2;
    end
end
val=-temp;