Implementação do algoritmo de Goertzel em C
Estou implementando o sistema de comunicação de salto de freqüência BFSK em um processador DSP. Foi sugerido por alguns dos membros do fórum para usar o algoritmo Goertzel para a demodulação de saltos de freqüência em frequências específicas. Eu tentei implementar o algoritmo goertzel em C. o código é o seguinte:
float goertzel(int numSamples,int TARGET_FREQUENCY,int SAMPLING_RATE, float* data)
{
int k,i;
float floatnumSamples;
float omega,sine,cosine,coeff,q0,q1,q2,result,real,imag;
floatnumSamples = (float) numSamples;
k = (int) (0.5 + ((floatnumSamples * TARGET_FREQUENCY) / SAMPLING_RATE));
omega = (2.0 * M_PI * k) / floatnumSamples;
sine = sin(omega);
cosine = cos(omega);
coeff = 2.0 * cosine;
q0=0;
q1=0;
q2=0;
for(i=0; i<numSamples; i++)
{
q0 = coeff * q1 - q2 + data[i];
q2 = q1;
q1 = q0;
}
real = (q1 - q2 * cosine);
imag = (q2 * sine);
result = sqrtf(real*real + imag*imag);
return result;
}
Quando uso a função para calcular o resultado em frequências específicas para um determinado conjunto de dados, não estou obtendo os resultados corretos. No entanto, se eu usar o mesmo conjunto de dados e calcular o resultado do goertzel usando a função MATLAB goertzel (), obtenho os resultados perfeitamente. Eu estou implementado o algoritmo usando C, com a ajuda de alguns tutoriais on-line que eu encontrei na internet. Eu só quero ter a visão de vocês se a função está implementando o algoritmo goertzel corretamente.