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

162 阅读 0 评论 107 点赞

我是靠谱客的博主落寞心情，这篇文章主要介绍一阶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可以得到传递函数的波特图：

复制代码

1
2
3
4
5
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

复制代码

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
/**
  * @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;		
}

调用例子：

复制代码

1
2
3
4
5

float b_ADCLoad1Volt, b_ADCLoad1VoltFltr, b_ADCLoad1VoltFltrPrv;


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

C语言实现2：

复制代码

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42

//*********** 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;

调用方式：

复制代码

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
...
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绘制波特图：

复制代码

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

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

2.3 用C语言实现

C语言的实现1：

复制代码

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
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;		
}

调用例子：

复制代码

1
2
3
4
5

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：

复制代码

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45

#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;

调用例子：

复制代码

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
...
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存放滤波结果  
        }
    }
}