fitness_2genetic.asv

改进的基于遗传算法的被动声目标定位

function fitness=fitness_2genetic(angle)
%产生两个信号,并且确定两个角度
signal_number=2;
n1=1:0.1:1024;
signal_1=100*cos(2*pi*200/4000*n1);
signal_2=100*cos(2*pi*200/4000*n1+pi/2);
angle_1=pi*45/180;
angle_2=pi*225/180;

%采样
sample_number=1024;%采样点数 
n2=1:sample_number; 
signal_1=signal_1(n2);
signal_2=signal_2(n2);
S=[signal_1;signal_2];

%确定导向矢量以及接收信号
array_number=4;
t=0.34;%距离除以波长
i=sqrt(-1); 
j=i;
delay_1=[j*2*pi*t*cos(angle_1);
       j*2*pi*t*cos(angle_1-pi/2);
       j*2*pi*t*cos(angle_1-pi);
       j*2*pi*t*cos(angle_1-3*pi/2)];
   
delay_2=[j*2*pi*t*cos(angle_2);
        j*2*pi*t*cos(angle_2-pi/2);
        j*2*pi*t*cos(angle_2-pi);
        j*2*pi*t*cos(angle_2-3*pi/2)]; 

delay=[delay_1,delay_2];   
A=exp(delay); %导向矢量
X=A*S; %接收信号 

%确定协方差矩阵以及对协方差矩阵进行分解 
cov=X*X'/sample_number;%协方差矩阵 
[V,D]=eig(cov); 
signal_space=V(:,array_number-signal_number+1:array_number);%确定信号子空间

%设置最后要求的方向矢量函数
A_value=[j*2*pi*t*cos(angle*pi/180);
       j*2*pi*t*cos(angle*pi/180-pi/2);
       j*2*pi*t*cos(angle*pi/180-pi);
       j*2*pi*t*cos(angle*pi/180-3*pi/2)];
A_value=exp(A_value);  

%确定适应度函数
PA=A_value*inv(A_value'*A_value)*A_value';
tr_matrix=PA*signal_space*signal_space';
[M N]=size(tr_matrix);
fitness=0;
for n3=1:M
    fitness=fitness+tr_matrix(n3,n3);
end
fitness=abs(fitness);