一阶低通滤波器

小螺号.

于 2024-07-19 11:15:29 发布

阅读量262

点赞数 4

文章标签：算法

本文链接：https://blog.csdn.net/qq_41374743/article/details/140544059

版权

#include <stdio.h>
#include <math.h>
#define PI 3.141592653

typedef struct LPF_define {
    float Yt_Out;
    float Yt_Sample_frequency;     //采样频率
    float Yt_Cut_off_frequency;    //截至频率
    float Yt_alpha;
}Yt_LPF_handle;

void Yt_LPF_Init(Yt_LPF_handle * pLPF ,float  Sample_frequency/*采样频率*/, float Cut_off_frequency/*截至频率*/)
{
    pLPF->Yt_Sample_frequency = Sample_frequency;
    pLPF->Yt_Cut_off_frequency = Cut_off_frequency;

    //计算Yt_alpha
    pLPF->Yt_alpha = (pLPF->Yt_Cut_off_frequency - pLPF->Yt_Cut_off_frequency / pLPF->Yt_Sample_frequency) * \
        cos(2 * PI * pLPF->Yt_Cut_off_frequency / pLPF->Yt_Sample_frequency) + pLPF->Yt_Cut_off_frequency / pLPF->Yt_Sample_frequency;
    pLPF->Yt_alpha = (0.5 * (1 + pLPF->Yt_alpha) - 0.5) / (0.5 * (1 - pLPF->Yt_alpha) - 0.5); // 标准化alpha
    pLPF->Yt_Out = 0;
}

float Yt_LPF_Calc(Yt_LPF_handle* pLPF, float input_value/*采样值*/)
{
   // *state = alpha * *state + (1 - alpha) * input;
    pLPF->Yt_Out = pLPF->Yt_alpha * pLPF->Yt_Out + (1 - pLPF->Yt_alpha) * input_value;//更新滤波器
    return pLPF->Yt_Out;
}

int main() {
  
    // 假设有一个输入信号序列 { 0 ~10} ，对其滤波
    Yt_LPF_handle lpf;
    Yt_LPF_Init(&lpf, 10.0, 1.0);

    for (size_t i = 0; i < 10; i++)
    {
        Yt_LPF_Calc(&lpf, i);
        printf("YT Lowpass Filter Output: %f\n", lpf.Yt_Out);
    }
    return 0;
}