ficp.m

对低频段的带通信号进行高精度的时延估计

%期刊文章中的快速FICP算法
function Rn = FICP(X1k,X2k,N2)  
%1 要完成从两个信号的谱得到补零之后的2*N点的相关序列
%FICP最基本的思想是对两信号的互谱补零从而提高相关函数的分辨率
%N2表示补零之后的点数，Rn表示2*N的相关函数输出序列。

%  1--根据相关定理计算两信号N点的互谱R1k
R1k=X2k.*conj(X1k);
%plot(abs(R1k));
%  2--通过谱的共扼对称性，可以获得R3k
N=length(R1k);
Nn=2:N;
R3k(1)=0;
R3k(Nn)=conj(R1k(N+2-Nn));
%  3--以下是计算n=(0-(N-1))的相关函数值
n=0:N-1;
Pn=exp(-j*2*pi*n*N/N2);
An=conj(MCZT(conj(R1k),N,N2))/N2;
Bn=conj(MCZT(conj(R3k),N,N2))/N2;
Bn=Pn.*Bn;
R1n=An+Bn;
%  以下是计算n=（-N：-1）的自相关函数
Hk=R1k.*Pn;
En=conj(MCZT(conj(Hk),N,N2))/N2;
Mk=R3k.*Pn;
Mn=conj(MCZT(conj(Mk),N,N2))/N2;
Qn=exp(j*2*pi*N*(N-n)/N2);
Fn=Qn.*Mn;
R2n=En+Fn;
Rn=real([R2n,R1n]);