locate.m

genetic遗传算法

function val= locate(x,x_cor,y_cor,z_cor,t,v)
c=find(t>0);
distance=sqrt((x(1)-x_cor(c)).^2+(x(2)-y_cor(c)).^2+(x(3)-z_cor(c)).^2);
val=sum((t(c)-x(4)-distance/v).^2);