多频连续波二次相差法测距

多频连续波二次相差法测距。基于双频测距的多频连续滤雷达测距新算法

function [R]=ercixiangcha1（vrs）

F0=1.5e9;
F1=F0+（5^4）*4.8e3;
F2=F0+4.8e3*5^3;
F3=F0+4.8e3*5^2;
F4=F0+4.8e3*5;
F5=F0+4.8e3;

NFFT=1024;
c=3e8;
T=0.3;%每个频率的持续时间
ts=T/NFFT;
fs=1/ts;
 
% Ru4=c/（2*（F4-F5））;Ru3=c/（2*（F3-F4））;Ru2=c/（2*（F2-F3））;Ru1=c/（2*（F1-F2））;Ru=c/（2*（F1-F0））; %最大不模糊距离
  
[phi_5vr5]=xiangwei（F0F5vr0s）;
[phi_4vr4]=xiangwei（F0F4vr1s）;
[phi_3vr3]=xiangwei（F0F3vr2s）;
[phi_2vr2]=xiangwei（F0F2vr3s）;
[phi_1vr1]=xiangwei（F0F1vr4s）;

phi5_real=mod（-4*pi*F0/c*r+4*pi*F5/c*r2*pi）;%相位差daita phi
r=r-v*T;
phi4_real=mod（-4*pi*F0/c*r+4*pi*F4/c*r2*pi）;
r=r-v*T;
phi3_real=mod（-4*pi*F0/c*r+4*pi*F3/c*r2*pi）;
r=r-v*T;
phi2_real=mod（-4*pi*F0/c*r+4*pi*F2/c*r2*pi）;
r=r-v*T;
phi1_real=mod（-4*pi*F0/c*r+4*pi*F1/c*r2*pi）;

% phi_buchang_5_4=-（NFFT-1）*2*pi*（F4-F5）*v*ts/c+（NFFT-1）*pi*（kp4-kp5）/NFFT;
% daita phi bu
% phi_5_4=phi_4-phi_5+2*pi*（F5-F0）*2*vr4*T/c;  daita2 phi
% phi_m_5_4=floor（phi_5_4/（2*pi））;
% phi_5_4=phi_5_4-2*pi*phi_m_5_4;
% 
% % phi_buchang_4_3=-（NFFT-1）*2*pi*（F3-F4）*v*ts/c+（NFFT-1）*pi*（kp3-kp4）/NFFT;
% phi_4_3=phi_3-phi_4+2*pi*（F4-F0）*2*vr3*T/c;    
% phi_m_4_3=floor（phi_4_3/（2*pi））;
% phi_4_3=phi_4_3-2*pi*phi_m_4_3;
% 
% % phi_buchang_3_2=-（NFFT-1）*2*pi*（F2-F3）*v*ts/c+（NFFT-1）*pi*（kp2-kp3）/NFFT;
% phi_3_2=phi_2-phi_3+2*pi*（F3-F0）*2*vr2*T/c;   
% phi_m_3_2=floor（phi_3_2/（2*pi））;
% phi_3_2=phi_3_2-2*pi*phi_m_3_2;
% 
% % phi_buchang_2_1=-（NFFT-1）*2*pi*（F1-F2）*v*ts/c+（NFFT-1）*pi*（kp1-kp2）/NFFT;
% phi_2_1=phi_1-phi_2+2*pi*（F2-F0）*2*vr1*T/c;
% phi_m_2_1=floor（phi_2_1/（2*pi））;
% phi_2_1=phi_2_1-2*pi*phi_m_2_1;
% 
% % phi_buchang_1_0=-（NFFT-1）*2*pi*（F1-F0）*v*ts/c+（NFFT-1）*pi*（kp1-kp0）/NFFT;
% phi_1_0=phi_1;%+2*pi*（F1-F0）*2*vr0*T/c;    
% phi_m_1_0=floor（phi_1_0/（2*pi））;
% phi_1_0=phi_2_1-2*pi*phi_m_1_0;




R15=phi_5*c/（4*pi*（F5-F0））;%距离
R14=phi_4*c/（4*pi*（F4-F0））;
R13=phi_3*c/（4*pi*（F3-F0））;
R12=phi_2*c/（4*pi*（F2-F0））;
R11=phi_1*c/（4*pi*（F1-F0））;

R15_real=phi5_real*c/（4*pi*（F5-F0））;
R14_real=phi4_real*c/（4*pi*（F4-F0））;
R13_real=phi3_real*c/（4*pi*（F3-F0））;
R12_real=phi2_real*c/（4*pi*（F2-F0））;
R11_real=phi1_real*c/（4*pi*（F1-F0））;

R5=R15;
R4=R14;
R3=R13;
R2=R12;
R1=R11;
Ru5=c/（2*（F5-F0））;
Ru4=c/（2*（F4-F0））;
Ru3=c/（2*（F3-F0））;
Ru2=c/（2*（F2-F0））;
Ru1=c/（2*（F1-F0））;

R_buchang4=vr5*T;
m4=fix（（R5-R_buchang4）/Ru4）;
%m4=mod（R5-R_buchang4Ru4）;
R4=R4+m4*Ru4;

R_buchang3=vr4*T;
m3=fix（（R4-R_buchang3）/Ru3）;
R3=R3+m3*Ru3;

R_buchang2=vr3*T;
m2=fix（（R3-R_buchang2）/Ru2）;
R2=R2+m2*Ru2;

R_buchang1=vr2*T;
m1=fix（（R2-R_buchang1）/Ru1）;
R1=R1+m1*Ru1;
R=R1+vr1*4*T;
end

 属性            大小     日期    时间   名称
----------- ---------  ---------- -----  ----

     文件       2650  2014-08-18 10:38  ercixiangcha1.m

----------- ---------  ---------- -----  ----

                 2650                    1