kalmann.m

此为频偏校正程序,通过TD_GG算法得到的频偏值还存在几赫兹的残余频偏

function [kal_f,Pp,Xp]=kalmann(d_fre,Pp,Xp,R,S)

for k = 1 : 20
    Xn=R*Xp/(Pp+S+R)+(Pp+S)*d_fre/(Pp+S+R);
    Pn=(Pp+S)*R/(Pp+S+R);
    kal_f=Xn;
    Pp=Pn;
    Xp=Xn;
    d_fre = Xn;
end
return