使用C语言实现Goertzel算法

以下是一个使用C语言实现Goertzel算法的示例代码：

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

#define SAMPLE_RATE 44100 // 采样率
#define TARGET_FREQUENCY 1000 // 目标频率

void goertzel(float* samples, int num_samples, float sample_rate, float target_frequency) {
    int n = num_samples;
    int k = 0.5 + (n * target_frequency) / sample_rate;
    float w = (2.0 * M_PI * k) / n;
    float cosine = cos(w);
    float sine = sin(w);
    float coeff = 2.0 * cosine;

    float q1 = 0, q2 = 0;

    for (int i = 0; i < num_samples; i++) {
        float sample = samples[i];
        float q0 = sample + coeff * q1 - q2;
        q2 = q1;
        q1 = q0;
    }

    float magnitude = sqrt(q1*q1 + q2*q2 - q1*q2*coeff);
    float phase = atan2(q2 - q1 * cosine, q1 * sine);

    printf("Magnitude: %f\n", magnitude);
    printf("Phase: %f\n", phase);
}

int main() {
    // 假设有一段音频采样数据存储在一个数组中
    float samples[] = {0.1, 0.2, 0.3, 0.4, 0.5};
    int num_samples = sizeof(samples) / sizeof(float);

    goertzel(samples, num_samples, SAMPLE_RATE, TARGET_FREQUENCY);

    return 0;
}

上述代码中，我们首先定义了采样率和目标频率。然后，在`goertzel`函数中，我们计算了所需的参数，并使用循环执行Goertzel算法。最后，我们计算了幅度和相位，并使用`printf`函数打印结果。

在`main`函数中，我们假设有一段音频采样数据存储在一个数组中，然后将该数组传递给`goertzel`函数进行处理。

请注意，这只是一个简单的示例，并没有包含完整的错误处理和优化。在实际应用中，你可能需要根据具体需求进行适当的修改和优化。