Goertzl Algorithm [Embedded]

Prev: Synchronizing a scuplture
Next: EMBEDDED DESIGN USING MICROCHIP MCU's & DEVELOPMENT TOOLS - ENERGY/POWER METERS

From: karthikbalaguru on 27 Feb 2010 15:10

Hi,

I am looking for an open source implementation
for decoding DTMF signals using Goertzl Algorithm
in C language. I searched the internet, but did not
get an open source implementation in C language.
I searched the internet and landed in the below link,
but the 'Listing 1' as mentioned in the contents of
the below link does not seem to work -
http://www.embedded.com/story/OEG20020819S0057
Any other links/open source implementation ?

Thx in advans,
Karthik Balaguru

From: 2G on 27 Feb 2010 15:39

On Feb 27, 12:10 pm, karthikbalaguru <karthikbalagur...(a)gmail.com>
wrote:
> Hi,
>
> I am looking for an open source implementation
> for decoding DTMF signals using Goertzl Algorithm
> in C language. I searched the internet, but did not
> get an open source implementation in C language.
> I searched the internet and landed in the below link,
> but the 'Listing 1' as mentioned in the contents of
> the below link does not seem to work -http://www.embedded.com/story/OEG20020819S0057
> Any other links/open source implementation ?
>
> Thx in advans,
> Karthik Balaguru

It worked for me. Here is Listing 1:

Listing 1 A Goertzel implementation

#include <stdio.h>
#include <math.h>

#define FLOATING float
#define SAMPLE unsigned char

#define SAMPLING_RATE 8000.0 //8kHz
#define TARGET_FREQUENCY 941.0 //941 Hz
#define N 205 //Block size

FLOATING coeff;
FLOATING Q1;
FLOATING Q2;
FLOATING sine;
FLOATING cosine;

SAMPLE testData[N];

/* Call this routine before every "block" (size=N) of samples. */
void ResetGoertzel(void)
{
Q2 = 0;
Q1 = 0;
}

/* Call this once, to precompute the constants. */
void InitGoertzel(void)
{
int k;
FLOATING floatN;
FLOATING omega;

floatN = (FLOATING) N;
k = (int) (0.5 + ((floatN * TARGET_FREQUENCY) / SAMPLING_RATE));
omega = (2.0 * PI * k) / floatN;
sine = sin(omega);
cosine = cos(omega);
coeff = 2.0 * cosine;

printf("For SAMPLING_RATE = %f", SAMPLING_RATE);
printf(" N = %d", N);
printf(" and FREQUENCY = %f,\n", TARGET_FREQUENCY);
printf("k = %d and coeff = %f\n\n", k, coeff);

ResetGoertzel();
}

/* Call this routine for every sample. */
void ProcessSample(SAMPLE sample)
{
FLOATING Q0;
Q0 = coeff * Q1 - Q2 + (FLOATING) sample;
Q2 = Q1;
Q1 = Q0;
}

/* Basic Goertzel */
/* Call this routine after every block to get the complex result. */
void GetRealImag(FLOATING *realPart, FLOATING *imagPart)
{
*realPart = (Q1 - Q2 * cosine);
*imagPart = (Q2 * sine);
}

/* Optimized Goertzel */
/* Call this after every block to get the RELATIVE magnitude squared.
*/
FLOATING GetMagnitudeSquared(void)
{
FLOATING result;

result = Q1 * Q1 + Q2 * Q2 - Q1 * Q2 * coeff;
return result;
}

/*** End of Goertzel-specific code, the remainder is test code. */

/* Synthesize some test data at a given frequency. */
void Generate(FLOATING frequency)
{
int index;
FLOATING step;

step = frequency * ((2.0 * PI) / SAMPLING_RATE);

/* Generate the test data */
for (index = 0; index < N; index++)
{
testData[index] = (SAMPLE) (100.0 * sin(index * step) + 100.0);
}
}

/* Demo 1 */
void GenerateAndTest(FLOATING frequency)
{
int index;

FLOATING magnitudeSquared;
FLOATING magnitude;
FLOATING real;
FLOATING imag;

printf("For test frequency %f:\n", frequency);
Generate(frequency);

/* Process the samples */
for (index = 0; index < N; index++)
{
ProcessSample(testData[index]);
}

/* Do the "basic Goertzel" processing. */
GetRealImag(&real, &imag);

printf("real = %f imag = %f\n", real, imag);

magnitudeSquared = real*real + imag*imag;
printf("Relative magnitude squared = %f\n", magnitudeSquared);
magnitude = sqrt(magnitudeSquared);
printf("Relative magnitude = %f\n", magnitude);

/* Do the "optimized Goertzel" processing */
magnitudeSquared = GetMagnitudeSquared();
printf("Relative magnitude squared = %f\n", magnitudeSquared);
magnitude = sqrt(magnitudeSquared);
printf("Relative magnitude = %f\n\n", magnitude);

ResetGoertzel();
}

/* Demo 2 */
void GenerateAndTest2(FLOATING frequency)
{
int index;

FLOATING magnitudeSquared;
FLOATING magnitude;
FLOATING real;
FLOATING imag;

printf("Freq=%7.1f ", frequency);
Generate(frequency);

/* Process the samples. */
for (index = 0; index < N; index++)
{
ProcessSample(testData[index]);
}

/* Do the "standard Goertzel" processing. */
GetRealImag(&real, &imag);

magnitudeSquared = real*real + imag*imag;
printf("rel mag^2=%16.5f ", magnitudeSquared);
magnitude = sqrt(magnitudeSquared);
printf("rel mag=%12.5f\n", magnitude);

ResetGoertzel();
}

int main(void)
{
FLOATING freq;

InitGoertzel();

/* Demo 1 */
GenerateAndTest(TARGET_FREQUENCY - 250);
GenerateAndTest(TARGET_FREQUENCY);
GenerateAndTest(TARGET_FREQUENCY + 250);

/* Demo 2 */
for (freq = TARGET_FREQUENCY - 300; freq <= TARGET_FREQUENCY + 300;
freq += 15)
{
GenerateAndTest2(freq);
}

return 0;
}

-----------------
Tom

From: karthikbalaguru on 27 Feb 2010 20:37

On Feb 28, 1:39 am, 2G <soar2mor...(a)yahoo.com> wrote:
> On Feb 27, 12:10 pm, karthikbalaguru <karthikbalagur...(a)gmail.com>
> wrote:
>
> > Hi,
>
> > I am looking for an open source implementation
> > for decoding DTMF signals using Goertzl Algorithm
> > in C language. I searched the internet, but did not
> > get an open source implementation in C language.
> > I searched the internet and landed in the below link,
> > but the 'Listing 1' as mentioned in the contents of
> > the below link does not seem to work -http://www.embedded.com/story/OEG20020819S0057
> > Any other links/open source implementation ?
>
> > Thx in advans,
> > Karthik Balaguru
>
> It worked for me. Here is Listing 1:
>
> Listing 1 A Goertzel implementation
>
> #include <stdio.h>
> #include <math.h>
>
> #define FLOATING float
> #define SAMPLE unsigned char
>
> #define SAMPLING_RATE 8000.0 //8kHz
> #define TARGET_FREQUENCY 941.0 //941 Hz
> #define N 205 //Block size
>
> FLOATING coeff;
> FLOATING Q1;
> FLOATING Q2;
> FLOATING sine;
> FLOATING cosine;
>
> SAMPLE testData[N];
>
> /* Call this routine before every "block" (size=N) of samples. */
> void ResetGoertzel(void)
> {
> Q2 = 0;
> Q1 = 0;
>
> }
>
> /* Call this once, to precompute the constants. */
> void InitGoertzel(void)
> {
> int k;
> FLOATING floatN;
> FLOATING omega;
>
> floatN = (FLOATING) N;
> k = (int) (0.5 + ((floatN * TARGET_FREQUENCY) / SAMPLING_RATE));
> omega = (2.0 * PI * k) / floatN;
> sine = sin(omega);
> cosine = cos(omega);
> coeff = 2.0 * cosine;
>
> printf("For SAMPLING_RATE = %f", SAMPLING_RATE);
> printf(" N = %d", N);
> printf(" and FREQUENCY = %f,\n", TARGET_FREQUENCY);
> printf("k = %d and coeff = %f\n\n", k, coeff);
>
> ResetGoertzel();
>
> }
>
> /* Call this routine for every sample. */
> void ProcessSample(SAMPLE sample)
> {
> FLOATING Q0;
> Q0 = coeff * Q1 - Q2 + (FLOATING) sample;
> Q2 = Q1;
> Q1 = Q0;
>
> }
>
> /* Basic Goertzel */
> /* Call this routine after every block to get the complex result. */
> void GetRealImag(FLOATING *realPart, FLOATING *imagPart)
> {
> *realPart = (Q1 - Q2 * cosine);
> *imagPart = (Q2 * sine);
>
> }
>
> /* Optimized Goertzel */
> /* Call this after every block to get the RELATIVE magnitude squared.
> */
> FLOATING GetMagnitudeSquared(void)
> {
> FLOATING result;
>
> result = Q1 * Q1 + Q2 * Q2 - Q1 * Q2 * coeff;
> return result;
>
> }
>
> /*** End of Goertzel-specific code, the remainder is test code. */
>
> /* Synthesize some test data at a given frequency. */
> void Generate(FLOATING frequency)
> {
> int index;
> FLOATING step;
>
> step = frequency * ((2.0 * PI) / SAMPLING_RATE);
>
> /* Generate the test data */
> for (index = 0; index < N; index++)
> {
> testData[index] = (SAMPLE) (100.0 * sin(index * step) + 100.0);
> }
>
> }
>
> /* Demo 1 */
> void GenerateAndTest(FLOATING frequency)
> {
> int index;
>
> FLOATING magnitudeSquared;
> FLOATING magnitude;
> FLOATING real;
> FLOATING imag;
>
> printf("For test frequency %f:\n", frequency);
> Generate(frequency);
>
> /* Process the samples */
> for (index = 0; index < N; index++)
> {
> ProcessSample(testData[index]);
> }
>
> /* Do the "basic Goertzel" processing. */
> GetRealImag(&real, &imag);
>
> printf("real = %f imag = %f\n", real, imag);
>
> magnitudeSquared = real*real + imag*imag;
> printf("Relative magnitude squared = %f\n", magnitudeSquared);
> magnitude = sqrt(magnitudeSquared);
> printf("Relative magnitude = %f\n", magnitude);
>
> /* Do the "optimized Goertzel" processing */
> magnitudeSquared = GetMagnitudeSquared();
> printf("Relative magnitude squared = %f\n", magnitudeSquared);
> magnitude = sqrt(magnitudeSquared);
> printf("Relative magnitude = %f\n\n", magnitude);
>
> ResetGoertzel();
>
> }
>
> /* Demo 2 */
> void GenerateAndTest2(FLOATING frequency)
> {
> int index;
>
> FLOATING magnitudeSquared;
> FLOATING magnitude;
> FLOATING real;
> FLOATING imag;
>
> printf("Freq=%7.1f ", frequency);
> Generate(frequency);
>
> /* Process the samples. */
> for (index = 0; index < N; index++)
> {
> ProcessSample(testData[index]);
> }
>
> /* Do the "standard Goertzel" processing. */
> GetRealImag(&real, &imag);
>
> magnitudeSquared = real*real + imag*imag;
> printf("rel mag^2=%16.5f ", magnitudeSquared);
> magnitude = sqrt(magnitudeSquared);
> printf("rel mag=%12.5f\n", magnitude);
>
> ResetGoertzel();
>
> }
>
> int main(void)
> {
> FLOATING freq;
>
> InitGoertzel();
>
> /* Demo 1 */
> GenerateAndTest(TARGET_FREQUENCY - 250);
> GenerateAndTest(TARGET_FREQUENCY);
> GenerateAndTest(TARGET_FREQUENCY + 250);
>
> /* Demo 2 */
> for (freq = TARGET_FREQUENCY - 300; freq <= TARGET_FREQUENCY + 300;
> freq += 15)
> {
> GenerateAndTest2(freq);
> }
>
> return 0;
>
> }
>

I think, the server would have been down
or some other problem.

Thx,
Karthik Balaguru

From: bigbrownbeastie on 28 Feb 2010 13:37

>>>#define FLOATING float

Why for the love of god would you do that!

From: Jerry Avins on 28 Feb 2010 15:35

bigbrownbeastie wrote:
>>>> #define FLOATING float
>
> Why for the love of god would you do that!

There's no accounting for style.

Jerry
--
Leopold Kronecker on mathematics:
God created the integers, all else is the work of man.
��

| Next | Last
Pages: 1 2 3 4
Prev: Synchronizing a scuplture
Next: EMBEDDED DESIGN USING MICROCHIP MCU's & DEVELOPMENT TOOLS - ENERGY/POWER METERS