airplane_tracking.m

来自「对运动声目标进行航迹跟踪」· M 代码 · 共 44 行

%% Target Localization;
%% 2005-11-17;MaDengYong;

function [APr_xy,APi_xy]=airplane_tracking(XY_r,thite11,thite22,IP_id,LP)


id1=IP_id(1);id2=IP_id(2);

x_1=XY_r(id1,1);y_1=XY_r(id1,2);
x_2=XY_r(id2,1);y_2=XY_r(id2,2);

x_t=[];y_t=[];

    for lp1=LP
        
           lp1
  
      thite1=thite11(lp1);
      thite2=thite22(lp1);
  
    if abs(thite1)==90 || abs(thite2)==90
      x=[];y=[];
    else 
     [x y]=f_xy(thite1,thite2,x_1,y_1,x_2,y_2);
    end
      
     x_t=[x_t;x];
     y_t=[y_t;y];

    end


fai=0*pi/180; 
W=[cos(fai) sin(fai);-sin(fai) cos(fai)];

P=[x_t.';y_t.'];
PP=W*P;
xt=PP(1,:).';
yt=PP(2,:).';

APr_xy=[x_t y_t];%% the coordinations after rotation;
APi_xy=[xt yt];%% the coordinations before rotation;