srsLTE/matlab/sync/sfo_estimate.m

function [ sfo sfo_v ] = sfo_estimate( fs, T )


nanfs=fs(~isnan(fs));
idx=find(~isnan(fs));
sfo_v = zeros(length(nanfs)-1,1);
for i=2:length(nanfs)
    if (abs(nanfs(i)-nanfs(i-1))<9000)
        sfo_v(i-1)=(nanfs(i)-nanfs(i-1))/T/(idx(i)-idx(i-1));
    else
        sfo_v(i-1)=sfo_v(i-2);
    end
end

sfo = mean(sfo_v);