%%?==============?%%
%?******?相位法測角?********
%=================%
close?all
clear
clc

%%?能力要求
r_res_req?=?1;?%?距離分辨率
r_max_req?=?50;?%?最大測距
v_res_req?=?2.5;?%?速度分辨率
%%?系統(tǒng)參數(shù)
c?=?3e8;?%?光速
f0?=?24e9;?%?載頻
lamda?=?c/f0;?%?波長
d?=14e-3;?%?天線間距
B?=?250e6;?%?掃頻帶寬
T_fft?=?lamda/（2*v_res_req）;?%?fft?時長
Tm?=?T_fft;?%?調(diào)頻周期，令其和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;?%?頻譜分辨率


%%?回波信號到達(dá)天線1和天線2，經(jīng)混頻后的輸出信號
%?假設(shè)
r_obj?=?20;?%目標(biāo)距離
v_obj?=?5;?%目標(biāo)速度，?靠近為正，遠(yuǎn)離為負(fù)
theta?=?-5*pi/180;?%?目標(biāo)角度
%?有
delta_f?=?k1*r_obj?+?k2*v_obj;?%?頻移
tao?=?d*sin（theta）/c;?%?延時時間

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

%%?添加噪聲
s1?=?noisegen（s1?5）;
s2?=?noisegen（s2?5）;
%?fft
S1?=?fft（s1）;
S2?=?fft（s2）;
%?S?=?S1?.*?conj（S2）?=?S1?.*?conj（S1*exp（1j*delta_w））?=?|S1|*exp（-1j*delta_w）;
%?頻域相乘
S?=?S1?.*?conj（S2）;
%?相位
delta_w_esti?=?-atan（imag（S）./real（S））;?
%?由?w?=?2*pi*d*sin（theta）/lamda?=>?theta?=?asin（lamda*w/（2*pi*d）），?
%?又?w?->?[?-pi?pi?]?有?abs（theta）?%?-asin（lamda/（2*d））?%另外，由于用?atan?反求角度，atan要求相位差范圍為?[-pi/2?pi/2]?所以
%?-asin（lamda/（4*d））?theta_measureRange?=?asin（lamda/（4*d））?*?[?-1?1];


theta_esti?=?asin（lamda*delta_w_esti/（2*pi*d））;?%?回波角度
theta_esti_mean?=?mean（theta_esti）;?%?回波角度均值

figure?plot（theta_esti*180/pi）;?
hold?on;?plot（theta_esti_mean*180/pi*ones（1length（theta_esti））?‘-.‘）
hold?on;?plot（theta*180/pi*ones（1length（theta_esti））?‘-.‘）
hold?on;?plot（theta_measureRange（1）*180/pi*ones（1length（theta_esti））?‘-.‘）
hold?on;?plot（theta_measureRange（2）*180/pi*ones（1length（theta_esti））?‘-.‘）
legend（‘單點(diǎn)測量值‘?‘測量均值‘‘真實(shí)值‘?‘測角下限‘?‘測角上限‘）

?屬性????????????大小?????日期????時間???名稱
-----------?---------??----------?-----??----

?????文件????????365??2018-04-16?16:12??noisegen.m

?????文件???????2307??2018-04-24?15:36??FMCW_Angle_Measurement.m

-----------?---------??----------?-----??----

?????????????????2672????????????????????2