function fdet_eval(f_true, phi_true, knoise_dB, p) % % Example: fdet_eval(1200, pi/4, -10, [1100 1350 1]) fs = 48000; N = 1024; K = 40; f_min = p(1); f_max = p(2); f_step = p(3); % Generate signal x_true = exp(j*(2*pi*f_true/fs*(0:K*N-1)'+phi_true)) + sqrt(10^(knoise_dB/10))*randn(K*N,1); % Initial guess f_coarse = fdet_coarse(x_true, N, fs, f_min, f_step, f_max) phi_est = 0; f_est = f_coarse; for k=1:K f(k) = f_est; xp = x_true((k-1)*N+1:k*N); x_est = exp(-j*(2*pi*f_est/fs*(0:N-1)' + phi_est)); dmod(k) = sum(xp.*x_est); f_f = angle(dmod(k))/N*fs/(2*pi); err(k) = f_f; f_est = f_est + f_f; dphi_est = 2*pi*mod(f_est/fs*N, 1); phi_est = mod(phi_est + dphi_est, 2*pi); end; f_est = f_est error_ppm = 1E6*(1-f_est/f_true) close all; subplot(4,1,1) plot(1:lge(f), real(dmod)/N, 1:lge(f), imag(dmod)/N, 1:lge(f), abs(dmod)/N); grid; legend('Re', 'Im', 'abs()'); subplot(4,1,2) plot(1:lge(f), err, '-'); grid; legend('error'); subplot(4,1,3) plot(1:lge(f), f); grid; legend('f'); subplot(4,1,4) plot(1:lge(f), angle(dmod), '-*', 1:lge(f), diff(angle([0 dmod])), 'r-*'); grid; legend('phi', 'dphi');