three_nodes_localization_array.m

目标定位和跟踪的源程序

%% microphone array signal processing to tracking target moving track.
%% 2005-8-27; MaDengYong;
clc;
clear all;
close all;

fs=48e3;
Ts=1/fs;

cp='third airplane\';

sr=['F:\2005_10_24\2005-10-24\' cp];

name1='zhouyingxue_191';
name2='liuyao_197';

%% liuyao IP:197;
path7=[sr name2 '\\192.168.0.197-'];

y1 = wavread([path7 num2str(228) '.wav']);
y2 = wavread([path7 num2str(328) '.wav']);
y3 = wavread([path7 num2str(428) '.wav']);
y4 = wavread([path7 num2str(528) '.wav']);
y5 = wavread([path7 num2str(628) '.wav']);
y6 = wavread([path7 num2str(728) '.wav']);

X=[y1 y2 y3 y4];

% X7=[y5 y6];
clear y1 y2 y3 y4 y5 y6;

%% zhouyingxue IP:191;
path1=[sr name1 '\\192.168.0.191-'];

% y1 = wavread([path1 num2str(228) '.wav']);
% y2 = wavread([path1 num2str(328) '.wav']);
y1 = wavread([path1 num2str(428) '.wav']);
% y4 = wavread([path1 num2str(528) '.wav']);
% y5 = wavread([path1 num2str(628) '.wav']);
% y6 = wavread([path1 num2str(728) '.wav']);
% 
% X1=[y1 y2 y3 y4 y5 y6];
% 
% clear y1 y2 y3 y4 y5 y6;

% y1_l=length(y1);y2_l=length(y2);
% % y3_l=length(y3);
% % y_l=min([y1_l;y2_l;y3_l]);
% y_l=min([y1_l;y2_l]);

num_s=1/Ts;%% How many ponits every second samples?

win_l=4096;
% lp_n=fix(y_l/win_l);

sp_t=0;
% sf_n=1000;%% shift this squence to find the optimum matched time; 
max_v=[];
du_l=[-win_l*150:25:win_l*150];
for lp1=280:280
    lp1
    
%      nTs=[nTs;lp1*win_l*Ts+Ts];
%        nn=[nn;lp1*win_l+1];
     y1_s = y1( sp_t + lp1 * win_l+ 1 : sp_t + lp1 * win_l + win_l , : );
     
     y1_r=y1_s(length(y1_s):-1:1,:);
    
     
     for lp2=du_l
     
         sf_n=lp2
         
     X_s=X( sp_t + lp1 * win_l+ 1+sf_n : sp_t + lp1 * win_l + win_l+sf_n , : );
      
     
     Px_s=X_s*inv(X_s'*X_s)*X_s'*y1_r;
     
     y2_mf=Px_s'*Px_s;
     
     max_v=[max_v;max(y2_mf)];
      
%      y3_s=y3( sp_t + lp1 * win_l+ 1 : sp_t + lp1 * win_l + win_l , : );    
%      y3_mf=conv(y3_s,y1_r);
     
     end
     
end

% figure(1);
% plot(y1_mf);
% grid;
% figure(2);
% plot(y2_mf);
% grid;
figure(3);
plot(du_l,max_v);
grid;
% figure(3);
% plot(y3_mf);
% grid;
%           ph=['F:\2005_10_24\AoA_tracking\' cp 'AoA_tracking_values\'];
%           p_h=['F:\2005_10_24\AoA_tracking\' cp 'AoA_tracking_figures\'];
%          
%      save([ph name '_thita'],'thita') ;
%          
%      figure(1);
% %       plot(nTs,thita,'r- .','linewidth',2,'markersize',15);
%      plot(x_v,thita,'r- .','linewidth',2,'markersize',15);
%      grid;
% %       set(gca,'xlim',[0,8],'ylim',[-90 90],'linewidth',2,'fontsize',12,'fontweight','bold');
%       xlabel('Time Axis (Ts)','FontSize',12,'FontWeight','bold');
%       ylabel('Angle-of-Arrival','FontSize',12,'FontWeight','bold');
%       title(['Angle-of-Arrival tracking curve-' name],'FontSize',12,'FontWeight','bold');
%       saveas(gcf,[p_h name]);