%%?==============?%%
%?******?相位法測角?********
%??根據2個接收天線的信號進行角度測量
%=================%
close?all
clear
clc
%%?能力要求
r_res_req?=?1;?%?距離分辨率
r_max_req?=?50;?%?最大測距
v_res_req?=?2.5;?%?速度分辨率
%%?系統參數
c?=?3e8;?%?光速
f0?=?24e9;?%?載頻
lamda?=?c/f0;?%?波長
d?=14e-3;?%?天線間距
B?=?250e6;?%?掃頻帶寬
T_fft?=?lamda/（2*v_res_req）;?%?fft?時長
Tm?=?T_fft;?%?調頻周期，令其和fft時長相等
fs?=?256/T_fft;?%?采樣頻率

t?=?0?:?1/fs?:?T_fft?-?1/fs;?%?時間軸

K?=?B/Tm;?%?掃頻斜率
k1?=?2*K/c;?%?頻差-距離斜率
k2?=?2*f0/c;%?頻差-速度斜率
r_res?=?c/（2*B）;?%?距離分辨力
v_res?=?lamda/（2*T_fft）;?%?速度分辨率
v_max?=?v_res*T_fft*fs/2;?%?最大測速
df?=?1/T_fft;?%?頻譜分辨率


%%?回波信號到達天線1和天線2，經混頻后的輸出信號
%?假設
r_obj?=?20;?%目標距離
v_obj?=?5;?%目標速度，?靠近為正，遠離為負
theta?=?-10*pi/180;?%?目標角度
%?有
delta_f?=?k1*r_obj?+?k2*v_obj;?%?頻移
tao?=?d*sin（theta）/c;?%?延時時間

%混頻后信號
%?相位差?=?2*pi*發射頻率*延時時間?=?2*pi*f0*tao?=?2*pi*d*sin（theta）/lamda
delta_w?=?2*pi*d*sin（theta）/lamda;?%?兩路接收天線之間的相移
%?到達天線1的信號
s1?=?exp（2j*pi*delta_f*t）;?
%?到達天線2的信號
s2?=?s1*exp（-1j*delta_w）;?

%%?添加噪聲
s1?=?awgn（s1?10）;
s2?=?awgn（s2?10）;
%?fft
S1?=?fft（s1）;
S2?=?fft（s2）;
%?S?=?S1?.*?conj（S2）?=?S1?.*?