three_nodes_localization.asv

目标定位和跟踪的源程序

%% 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='liuyao_197';
name2='zhouyingxue_191';
% name3='zhouyingxue_191';

%% zhouyingxue IP:191;
path1=[sr name1 '\\192.168.0.197-'];
%% madengyong IP:192;
path2=[sr name2 '\\192.168.0.191-'];
%% liya IP:193;
% path3=[sr name3 '\\192.168.0.191-'];

y1 = wavread([path1 num2str(428) '.wav']);
y2 = wavread([path2 num2str(428) '.wav']);
% y1 = wavread([path1 num2str(43) '.wav']);

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=4800;
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=[-100000:10000];
for lp1=220:220
    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
         
     y2_s=y2( sp_t + lp1 * win_l+ 1+sf_n : sp_t + lp1 * win_l + win_l+sf_n , : );
      
     
     y2_mf=conv(y2_s,y1_r);
     
     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]);