%-----------二相相位編碼信號頻率估計子函數---------------%
%二相相位編碼信號頻率估計子函數
%f=BPSK_analysis_function(signal,N,deltt)
%輸入參數：signal 為二相相位編碼信號采樣值
%          N 為采樣點數
%          deltt 為采樣間隔
%          figureon 為是否輸出調頻信號圖，1為輸出，0為不輸出 
%輸出參數：freq_BPSK為信號頻率估計值

%參考資料： 夏陽松 劉渝 ，信號脈沖特征分析，南京航空航天大學碩士論文，1999年
%設計者：CJF
%設計時間：2005年1月19日

function freq_BPSK=BPSK_analysis_function(signal,N,deltt)

fs=1/deltt;
signalBPSK=zeros(1,N);
signalBPSK=signal;
signalN=zeros(1,N);
signalN=signalBPSK.^2;                  %仿真信號經平方運算，變成頻率為2fc的復正弦波
                                             
freq_BPSK=SFMfunction(signalN,N,deltt)/2;       %調用子函數計算頻率為2fc的復正弦波函數頻率,除以2為二項編碼信號載頻估計值

%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
%采用I、Q相位差(PPP算法）的算法計算頻率估計值
signal_angle=angle(signalBPSK)/pi;   %求信號的相位，修正到-1～+1之間
signal_angle_cha=signal_angle(2:length(signal_angle)) -  signal_angle(1:length(signal_angle)-1)   ;     %計算相位差

%將相位差修正到-1～+1之間
signal_angle_cha=signal_angle_cha-(signal_angle_cha>1)*2;
signal_angle_cha=signal_angle_cha+(signal_angle_cha<-1)*2;

f_ppp=mean(signal_angle_cha)*(fs/2) +fs;

%經試驗，PPP算法的精度沒有綜合法高

%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
if abs(f_ppp-freq_BPSK)>fs/4
    freq_BPSK=freq_BPSK+fs/2;
end