一階低通濾波(LPF)的原理及應用(以APM/PX4飛控為例)

引言

對實際的控制系統而言,采集到的原始信號往往是有噪聲的,而噪聲往往會對系統的穩定性能產生隱患;或為瞭提取有用的控制信號,濾除不必要的頻域成分,數字濾波技術必不可少,其中最常用的便是一階低通濾波(LPF)算法。

一階低通濾波器(Low Pass Filter,LPF),顧名思義就是當輸入信號的頻率在LPF設定的頻率(截止頻率)以內時,該信號可以通過(無衰減),而當該信號的頻率高於該頻率時,則會產生衰減。也就是說,LPF算法可濾除(filter-out)不需要的高頻信號,從而保證系統有效的頻率成分。

為使大傢通過該篇能對LPF以及信號處理技術的應用有一個更為深刻的理解,我將從如下5個方面來說明。

————————————————————————

  1. 一階低通濾波器的定義;
  2. 一階低通濾波器的數字實現;
  3. 仿真實例分析;
  4. 應用實例分析—以APM和PX4飛控兩個實例來說明;
  5. 具體應用中應考慮的問題

————————————————————————

一、一階低通濾波器的定義

A Low Pass Filter is a circuit that can be designed to modify, reshape or reject all unwanted high frequencies of an electrical signal and accept or pass only those signals wanted by the circuits designer.

對於一階低通濾波而言,從控制模型上分析就是一個一階慣性環節,其描述形式如式所示。

H(s) = frac{1}{frac{s}{w_c}+1}w_c = 2pi*f_c ,其中 f_c 為LPF的截止頻率。 (1)

Figure 1給出瞭一階低通濾波器在截止頻率 f_c = 20Hz ,即 H(s) = frac{1}{frac{s}{2pi*20}+1} 的Bode圖。由該圖可知,當信號的輸入頻率 f>(f_c = 20Hz) 時,其信號的幅值 Mag<0dB ,即表示信號將會出現衰減,以此達到濾波的目的。

Fig.1 一階低通濾波Bode圖

二、一階低通濾波器的數字實現

學過電路的都知道,RC電路便可組成一個一階低通濾波電路(如Figure 2所示)。

452fce2d18c2fbc26f709b0522d87eaeFigure.2 一階低通濾波原理圖

由電路原理的基本知識可知該一階RC低通濾波電路的輸入輸出關系(傳遞函數)為:

H(jw) = frac{V_{out}}{V_{in}} = frac{frac{1}{jwc}}{R+frac{1}{jwc}} = frac{1}{jwRC + 1}---(2)

s=jw ,則一階RC低通濾波在S域的傳遞函數如式(3)所示。將其與式(1)對比可知,有 RC = frac{1}{2pi*f_c} ,即可知LPF的截止頻率 f_c = frac{1}{2pi*RC} 。當我們知道信號的有用頻率段,即截止頻率f_c 已知時,可設計RC的值。

H(s) = frac{V_{out}(s)}{V_{in}(s)} = frac{1}{RCs+1} s = jw (3)

為設計數字化濾波器,我們還需對上述連續系統進行離散化處理(z變換)。由以前的知識可知,z變換有許多不同的形式,對於LPF而言,主要采用一階後向差分法,其數學表達式如式(4)所示:

s = frac{1-z^{-1}}{T_s} , 其中 T_s 表示采樣周期。 (4)

結合式(3)(4),可知LPF的數字化表達式為:

H(z) = frac{V_{out}(z)}{V_{in}(z)}= frac{1}{RCfrac{1-z^{-1}}{T_s}+1} = frac{T_s}{RC(1-z^{-1})+T_s} (5)

變換後可知:

V_{in}(z) = (1+frac{RC}{T_s})V_{out}(z) - frac{RC}{T}V_{out}(z)z^{-1} (6)

繼續轉化差分方程,則有:

V_{in}(n) = (1+frac{RC}{T_s})V_{out}(n) - frac{RC}{T_s}V_{out}(n-1) (7)

最終我們可知其LPF的差分表達式如下所示:

V_{out}(n) = V_{out}(n-1) + frac{T_s}{T_s + RC}(V_{in}(n) - V_{out}(n-1)) (8)

令濾波系數 alpha = frac{T_s}{T_s + RC} ,且 alphain[0,1] ,則LPF的差分表達式可改寫為:

V_{out}(n) = V_{out}(n-1) + alpha(V_{in}-V_{out}(n-1)) (9)

對式(9)進行重寫,最後可知一階低通濾波模型為:

V_{out}(n) = (1-alpha)V_{out}(n-1) + alpha*V_{in} (10)

對此,LPF完整的數學分析已經完成。在實際應用中,已知采樣周期,根據實際的系統設計合適的截止頻率 f_c ,即對采集的信號 V_{in}(n) 進行濾波。

三、仿真實例分析

雖然通過前面的分析,知道瞭LPF數學模型的由來,但實際應用中如何濾波,怎麼應用可能不夠直觀。為使大傢有一個更為深刻的理解,特以一個實例來說明。

設一個信號的時域表達式如下所示,即有三個頻率成分: f_1=2Hzf_2=30Hzf_3=40Hz 疊加而成,其幅值分別為 A_1 = 2A_2 = 5A_3 =1 0 ,令采樣周期為 T_s = 0.01s

y(t)=2*sin(2pi*2*t)+5*sin(2pi*30*t)+10*sin(2pi*40*t)

為此,設計一截止頻率 f_c=10Hz 的低通濾波器,由前面的分析可知,該低通濾波器的濾波為:

alpha=frac{T_s}{T_s+RC}=frac{T_s}{T_s+1/(2*pi*f_c)}=0.3859

令濾波後的輸出為 yc(t) ,由式(10)即可求得濾波後的輸出 yc(t) 。圖3為濾波前後時域輸出圖,從該圖雖然能直觀看出信號有所衰減,但不夠直觀,而通過對比濾波前後頻域輸出圖(Fig 4)可知,能非常直觀地看出頻率 f_1=2Hz 的信號幅值沒有變化,而頻率為 f_2=30Hzf_3=40Hz 的信號出現瞭衰減,即當信號的頻率大於 所設定的截止頻率f_c=10Hz 時,信號便會出現衰減。

039569e1d8184a51cfcab9dd038477c1Fig.3 濾波前後時域輸出對比Fig.4 濾波前後頻域輸出對比

四、應用實例分析

LPF的應用場合很多,相信通過前面的分析,對於其原理與應用應該有瞭進一步的瞭解。下面給出無人機飛控中的代碼實例,以便能對其他項目的應用有所參考與借鑒。通過第二部分的分析,相信不難理解其中的實現原理及過程。

4.1 APM飛控LPF實例分析

APM開源飛控代碼中一階低通數字濾波器的實現如下所示,詳細代碼參見LowPassFilter.cpp文件。相信根據上述的分析,不難理解該功能的具體實現。

@inputsample(當前的采樣值)V_in(n) cutoff_freq(截止頻率) dt(采樣周期)
@output_output(V_out(n))
template <class T>
T DigitalLPF<T>::apply(const T &sample, float cutoff_freq, float dt) {
if (cutoff_freq <= 0.0f || dt <= 0.0f) {
_output = sample;
return _output;
}
float rc = 1.0f/(M_2PI*cutoff_freq);
alpha = constrain_float(dt/(dt+rc), 0.0f, 1.0f);
_output += (sample - _output) * alpha;
return _output;
}

发表回复

相关推荐

回憶歷代建國70年

2019年是新中國建國70周年,如果是一個人的話,70歲是古稀老人瞭,應該兒孫滿堂,正式享受天倫之樂的時候,但是對一個國...

· 13分钟前

星燧:驚爆-神秘病毒致美國75000人被封鎖在內華達沙漠

9月4日,根據相關媒體報道,美國內華達州沙漠1日連夜降下暴雨,導致交通中斷,當地正舉行的文化節“火人節”數萬名參與者因此“...

· 17分钟前

Myb介导花青素的生物合成

上期说到花青素的生物合成主要有结构基因和调节基因共同作用,其中调节基因主要是指能够调控基因转录的一些转录因子(transc ...

· 26分钟前

橫截面

不是所有光滑流都有橫截面,一個明顯的必要條件是流不能有奇點。橫截面是由龐加萊 (Poincare,(J.-)H) 引進的。通過橫截面可以...

· 43分钟前

拨开充国古县的历史疑云

充国,乃四川历史上一个较为古老的县,曾与湘西的古充县一同载入《汉书·地理志》,为“汉王王巴蜀汉中四十一县之一”,据《南 ...

· 43分钟前

Copyright 2015-2025 www.icpchaxun.com ©All Rights Reserved.