一阶RC滤波器的算法实现（低通和高通）

178 阅读 0 评论 118 点赞

我是靠谱客的博主爱撒娇宝马，这篇文章主要介绍一阶RC滤波器的算法实现（低通和高通），现在分享给大家，希望可以做个参考。

目前，项目需要处理信号。目标信号是特定频率范围内的信号。高频视为干扰。而一阶RC滤波器容易实现。但是网上资料往往没有详细的推导。因此在这里把笔记记下。本文的优势是比较详细，参数配置都有公式依据。

1、一阶RC低通滤波器的算法实现

1.1 算法推导

1.2 波特图

1.3 用C语言实现

2、一阶RC高通滤波器的原理以及实现

2.1 原理推导

2.2 波特图

2.3 用C语言实现

3 上机测试

1、一阶RC低通滤波器的算法实现

1.1 算法推导

一阶RC滤波器的硬件电路如图：

图中输入电压是Vi，电阻R，电容C，输出电压为Vo。

假设电路的输出阻抗很大（即不带任何负载），输入阻抗很小（理想情况）。可以得到以下公式：

$V_o = frac{1}{1+jomega RC}V_i$

电容的阻抗是 $Z_C = frac{1}{jomega C}$ 。

而 $omega = 2pi f$

截止频率 $f_{cut} = frac{1}{2pi RC}$ ，此频率下的信号，通过这个电路，输出电压和输入电压的关系式是 $V_o = frac{1}{1+j}V_i$

或者时域上的表达式：

$V_o = V_i - RCfrac{dV_o}{dt}$

上式离散后，可以得到：

$V_oleft ( k right )=frac{V_ileft ( k right )+frac{RC}{T_s}V_oleft ( k-1 right )}{1+frac{RC}{T_s}}$

假如要过滤掉10KHz以上的频率，可以选择fcut = 1K，并计算RC的值，代入上式。

1.2 波特图

用Octave或者Matlab可以得到传递函数的波特图：

fcut =1000;
RC=1/2/pi/fcut;
%pkg load control %Octave用的读取control包
y1 = tf(1,[RC,1])
bode(y1)

以上波特图可见，在截止频率处（ $omega =2pi f$ ，代入f=1k，可得截至角频率是6283 rad/s），信号会衰减到原来的0.707。这电路对频率大于截止频率的高频信号，具有比较强的衰减作用，同时对该信号有比较大的相位移动。

1.3 用C语言实现

C语言的实现1

/**
* @brief implement 1 order RC low pass filter
* raw data filtered by a simple RC low pass filter@cufoff=5Hz
* @param Vi : Vi(k)
* @param Vi_p : Vi(k-1)
* @param Vo : Vo(k)
* @param Vo_p : Vo(k-1)
* @note This example shows a simple way to report end of conversion
* and get conversion result. You can add your own implementation.
* @retval None
*/
void LowPassFilter_RC_1order(float *Vi, float *Vo, float *Vo_p, float sampleFrq )
{
float CutFrq, RC, Cof1, Cof2;
//low pass filter @cutoff frequency = 5 Hz
CutFrq = 5;
RC = (float)1.0/2.0/PI/CutFrq;
Cof1 = 1/(1+RC*sampleFrq);
Cof2 = RC*sampleFrq/(1+RC*sampleFrq);
*Vo = Cof1 * (*Vi) + Cof2 * (*Vo_p);
//update
*Vo_p = *Vo;
}

调用例子：

float b_ADCLoad1Volt, b_ADCLoad1VoltFltr, b_ADCLoad1VoltFltrPrv;
LowPassFilter_RC_1order(&b_ADCLoad1Volt, &b_ADCLoad1VoltFltr, &b_ADCLoad1VoltFltrPrv, 1000.0);

C语言实现2：

//*********** Structure Definition ********//
typedef struct {
float Vi;
float Vo_prev;
float Vo;
float Fcutoff;
float Fs;
} LPF_1orderRC_F;
//*********** Structure Init Function ****//
void LPF_1orderRC_F_init(LPF_1orderRC_F *v)
{
v->Vi=0;
v->Vo_prev=0;
v->Vo=0;
//low pass filter @cutoff frequency = 5 Hz
v->Fcutoff=5;
// execute 1000 every second
v->Fs=1000;
}
//*********** Function Definition ********//
float LPF_1orderRC_F_FUNC(LPF_1orderRC_F *v)
{
float RC, Cof1, Cof2;
RC = (float)1.0/2.0/PI/v->Fcutoff;
Cof1 = 1/(1+RC*v->Fs);
Cof2 = RC*v->Fs/(1+RC*v->Fs);
v->Vo = Cof1 * v->Vi + Cof2 * v->Vo_prev;
v->Vo_prev = v->Vo;
return v->Vo;
}
LPF_1orderRC_F lpf_1orderrc_handle;

调用方式：

...
int main(void)
{
...
LPF_1orderRC_F_init(&lpf_1orderrc_handle); //初始化
while(1)
{
...
if(flag_1ms==1)
{
lpf_1orderrc_handle.Vi = ADCresult; //假设ADCresult是ADC采样结果
LPF_1orderRC_F_FUNC(&lpf_1orderrc_handle); //usage
FilteredResult = lpf_1orderrc_handle.Vo; //FilteredResult存放滤波结果
}
}
}

2、一阶RC高通滤波器的原理以及实现

2.1 原理推导

这是一节RC高通滤波器的原理图：

$V_o = frac{1}{1+frac{1}{jomega RC}}V_i$

截止频率 $f_{cut} = frac{1}{2pi RC}$

写成时域上的表达式：

$V_o = Cfrac{dleft ( V_i - V_o right )}{dt}R$

离散化后得到：

$V_oleft ( k right )=left ( V_ileft ( k right )-V_ileft ( k-1 right )+V_oleft ( k-1 right ) right )frac{RC}{RC+T_s}$

根据设定的截止频率，假如目标频率是50Hz，截止频率可以整定为0.5Hz，过滤低频分量，而不影响目标信号的采集。

$RC = frac{1}{2pi f_{cut}}$

2.2 波特图

传递函数可又频域函数转换得到，将 $s=jomega$ 带入频域公式。得到：

$V_o = frac{RCs}{RCs+1}V_i$

Octave绘制波特图：

fcut =0.5;
RC=1/2/pi/fcut;
pkg load control
y1 = tf([RC,0],[RC,1])
bode(y1)

高通滤波器对截至频率以上的信号无大影响，信号能正常经过滤波器。但是该滤波器对截至频率以下的信号，具有较大的影响。和截至频率相比，频率越小，衰减作用越明显。同时在相位图中可见，对频率越低的信号，相位移动也越大。

2.3 用C语言实现

C语言的实现1：

void HighPassFilter_RC_1order(float *Vi, float *Vi_p, float *Vo, float *Vo_p, float sampleFrq )
{
float CutFrq, RC, Coff;
//high pass filter @cutoff frequency = 0.5 Hz
CutFrq = 0.5;
RC = (float)1.0/2.0/PI/CutFrq;
Coff = RC/(RC + 1/sampleFrq);
*Vo = ((*Vi) - (*Vi_p) +(*Vo_p) )*Coff ;
//update
*Vo_p = *Vo;
*Vi_p = *Vi;
}

调用例子：

float b_ADCLoad1Volt, b_ADCLoad1VoltPrv, b_ADCLoad1VoltFltr, b_ADCLoad1VoltFltrPrv;
HighPassFilter_RC_1order(&b_ADCLoad1Volt, &b_ADCLoad1VoltPrv, &b_ADCLoad1VoltFltr, &b_ADCLoad1VoltFltrPrv, 1000.0);

调用时，1000是指每秒需要执行这个函数1000次。

C语言实现2：

#define PI 3.1415
//*********** Structure Definition ********//
typedef struct {
float Vi;
float Vi_prev;
float Vo_prev;
float Vo;
float Fcutoff;
float Fs;
} HPF_1orderRC_F;
//*********** Structure Init Function ****//
void HPF_1orderRC_F_init(HPF_1orderRC_F *v)
{
v->Vi=0;
v->Vi_prev=0;
v->Vo_prev=0;
v->Vo=0;
//high pass filter @cutoff frequency = 0.05 Hz
v->Fcutoff=0.05;
// execute 1000 every second
v->Fs=1000;
}
//*********** Function Definition ********//
float HPF_1orderRC_F_FUNC(HPF_1orderRC_F *v)
{
float RC, Coff;
RC = (float)1.0/2.0/PI/v->Fcutoff;
Coff = RC/(RC + 1/v->Fs);
v->Vo = (v->Vi - v->Vi_prev + v->Vo_prev ) * Coff;
//update
v->Vo_prev = v->Vo;
v->Vi_prev = v->Vi;
return v->Vo;
}
HPF_1orderRC_F hpf_1orderrc_handle;

调用例子：

...
int main(void)
{
...
HPF_1orderRC_F_init(&hpf_1orderrc_handle); //初始化
while(1)
{
...
if(flag_1ms==1)
{
hpf_1orderrc_handle.Vi = ADCresult; //假设ADCresult是ADC采样结果
FilteredResult = HPF_1orderRC_F_FUNC(&hpf_1orderrc_handle);//FilteredResult存放滤波结果
}
}
}