motioncomp.m

来自「rang doppler imaging and motion compensa」· M 代码 · 共 32 行

function matcomp = motioncomp(data,parameter,tt,bc)
%
% Motion compensation algorithm using given data and
% motion parameter estimates. Returns motion compensated 
% matrix.
%
   parasize=length(parameter);

   if parasize == 1
   v=parameter(1);
   a=0;
   jerk=0;
   elseif parasize == 2
   v=parameter(1);
   a=parameter(2);
   jerk=0;
   elseif parasize == 3
   v=parameter(1);
   a=parameter(2);
   jerk=parameter(3);
   end

   hjerk=(1/6)*jerk;
   ha=0.5*a;
   tta=tt.^2;
   ttj=tt.^3;

   rangemat=v*tt+ha*tta+hjerk*ttj;
   rangefreq=rangemat.*bc;                
   compmatrange=exp(rangefreq);
   matcomp=data.*compmatrange;