你的浏览器版本过低,可能导致网站不能正常访问!
为了你能正常使用网站功能,请使用这些浏览器。

【原创】【安富莱——DSP教程】第40章 IIR滤波器的实现

[复制链接]
baiyongbin2009 发布时间:2015-4-28 10:04
特别说明:完整45期数字信号处理教程,原创高性能示波器代码全开源地址:链接8 K6 Y$ M; t! M! G' G
7 u- w8 H5 n/ [
第40章 IIR滤波器的实现

. R: F7 h3 `+ P5 y! C# C$ S
    本章节讲解IIR滤波器直接I型的低通,高通,带通和带阻滤波器的实现。
    40.1 IIR滤波器介绍
    40.2 Matlab工具箱fdatool生成IIR滤波器系数
    40.3 IIR低通滤波器设计
    40.4 IIR高通滤波器设计
    40.5 IIR带通滤波器设计
    40.6 IIR带阻滤波器设计
    40.7 总结
! e4 c- k6 f, Z" L( p6 \2 f
40.1 IIR滤波器介绍
    ARM官方提供的直接I型IIR库支持Q7,Q15,Q31和浮点四种数据类型。其中Q15和Q31提供了基于Cortex-M3和Cortex-M4的快速版本。
    直接I型IIR滤波器是基于二阶Biquad级联的方式来实现的。每个Biquad由一个二阶的滤波器组成:
y[n] = b0 * x[n] + b1 * x[n-1] + b2 * x[n-2] + a1 * y[n-1] + a2 * y[n-2]
    直接I型算法每个阶段需要5个系数和4个状态变量。
40.1.png
    这里有一点要特别的注意,有些滤波器系数生成工具是采用的下面公式实现:
y[n] = b0 * x[n] + b1 * x[n-1] + b2 * x[n-2] - a1 * y[n-1] - a2 * y[n-2]
    比如matlab就是使用上面的公式实现的,所以在使用fdatool工具箱生成的a系数需要取反才能用于直接I型IIR滤波器的函数中。
    高阶IIR滤波器的实现是采用二阶Biquad级联的方式来实现的。其中参数numStages就是用来做指定二阶Biquad的个数。比如8阶IIR滤波器就可以采用numStages=4个二阶Biquad来实现。
40.2.png
如果要实现9阶IIR滤波器就需要将numStages=5,这时就需要其中一个Biquad配置成一阶滤波器(也就是b2=0,a2=0)。

% }: Z; F* B. X7 K/ o, y9 ?& S" K! S( Y2 h- K
赞 收藏 2 评论10 发布时间:2015-4-28 10:04

举报

10个回答
baiyongbin2009 回答时间:2015-4-28 10:13:21
40.2 Matlab工具箱fdatool生成IIR滤波器系数
    前面介绍FIR滤波器的时候,我们讲解了如何使用fdatool生成C头文件,从而获得滤波器系数。这里不能再使用这种方法了,主要是因为通过C头文件获取的滤波器系数需要通过ARM官方的IIR函数调用多次才能获得滤波结果,所以我们这里换另外一种方法。
    下面我们讲解如何通过fdatool工具箱生成滤波器系数。首先在matlab的命令窗口输入fdatool就能打开这个工具箱:
40.3.png
fdatool界面打开效果如下:
40.4.png
IIR滤波器的低通,高通,带通,带阻滤波的设置会在下面一一讲解,这里说一下设置后相应参数后如何生成滤波器系数。参数设置好以后点击如下按钮:
40.5.png
点击Design Filter之后,注意左上角生成的滤波器结构:
40.6.png
默认生成的IIR滤波器类型是Direct-Form II, Second-Order Sections(直接II型,每个Section是一个二阶滤波器)。这里我们需要将其转换成Direct-Form I, Second-Order Sections,因为本章使用的IIR滤波器函数是Direct-Form I的结构。
    转换方法,点击Edit->Convert Structure,界面如下,这里我们选择第一项,并点击OK:
40.7.png
转换好以后再点击File-Export,第一项选择Coefficient File(ASCII):
40.8.png
第一项选择好以后,第二项选择Decimal:
40.9.png
两个选项都选择好以后,点击Export进行导出,导出后保存即可:
40.10.png
保存后Matlab会自动打开untitled.fcf文件,可以看到生成的系数:
  1. %4 Z( w7 S% ?+ b3 Z& A
  2. % Generated by MATLAB(R) 7.14 and the Signal Processing Toolbox 6.17.& H1 s' v  u8 O# u# s' D' @
  3. %
    ( w! A$ N3 F1 b! ?' k
  4. % Generated on: 30-Dec-2014 21:08:50
    / D4 Q6 M& w4 m# Y# K2 N
  5. %
    + A. f) S7 K! p2 N, }+ _5 |

  6. ; @! @( P( N: Q$ ]/ U
  7. % Coefficient Format: Decimal0 u+ Z8 k' ^# R/ \
  8. 2 f. \5 Z; R8 Z1 I' U; ^# ~
  9. % Discrete-Time IIR Filter (real)                            4 x# @! `$ w6 M; n! a
  10. % -------------------------------                            0 N( q! [' b# `) \6 U% z- ?$ @4 E
  11. % Filter Structure    : Direct-Form II, Second-Order Sections" V- O0 K; L3 s7 Q) M' K
  12. % Number of Sections  : 2                                    ; f$ I4 B, M4 I( k8 U
  13. % Stable              : Yes                                 
    * ], X, Q! H0 a0 n: D- U( S8 \
  14. % Linear Phase        : No                                   0 R( y+ t( @& A$ K" C5 ^( e

  15. % o) u# [+ V5 v
  16.                                                             , ^4 o5 y. d9 ]9 i/ e/ X( h! u0 B% _
  17. SOS Matrix:                                                  
    - j9 V; F: V) O* d6 p  z* P
  18. 1  2  1  1  -1.1130298541633479   0.57406191508395477        
    3 F# p( h) M2 y( w; D1 |2 _# [
  19. 1  2  1  1  -0.85539793277517018  0.20971535775655475        
    9 s5 B- x1 H3 a5 i
  20.                                                              0 c6 F7 I2 n" B+ h- z$ Z8 d( u
  21. Scale Values:                                                6 G9 m% N3 c/ q! c: j
  22. 0.11525801523015171                                          ) k& s* [0 E7 h( n* S9 s3 l
  23. 0.08857935624534613
复制代码
由于咱们前面选择的是4阶IIR滤波,生成的结果就是由两组二阶IIR滤波系数组成,系数的对应顺序如下:
  1. SOS Matrix:                                                  + P" B- ^9 ~* E+ @
  2. 1   2   1   1   -1.1130298541633479   0.57406191508395477        9 G* J! M( P2 [* n+ g2 U6 n
  3. b0  b1  b2  a0        a1                      a2
    4 {+ w, h( p: t3 n. |0 _
  4. 1 2   1   1   -0.85539793277517018  0.20971535775655475        7 H* w8 {9 a. a. @) }8 {4 M
  5. b0  b1  b2  a0        a1                      a2
复制代码
注意,实际使用ARM官方的IIR函数调用的时候要将a1和a2取反。另外下面两组是每个二阶滤波器的增益,滤波后的结果要乘以这两个增益数值才是实际结果:
  1. 0.11525801523015171                                          0 K; V: ?8 |$ A& f9 @: k9 V
  2. 0.08857935624534613
复制代码
实际的滤波系数调用方法,看下面的例子即可。

$ ]3 x+ v/ R# I
stary666 回答时间:2015-4-28 10:20:58
沙发,支持原创
baiyongbin2009 回答时间:2015-4-28 10:21:58
40.3 IIR低通滤波器设计
    本章使用的IIR滤波器函数是arm_biquad_cascade_df1_f32。下面使用此函数设计IIR低通,高通,带通和带阻滤波器。
40.3.1 函数arm_biquad_cascade_df1_f32说明
函数定义如下:
    void arm_biquad_cascade_df1_f32(
            const arm_biquad_casd_df1_inst_f32 * S,
            float32_t * pSrc,
            float32_t * pDst,
           uint32_t blockSize)
参数定义:
       [in]  *S         points to an instance of the floating-point Biquad cascade structure.   
       [in]  *pSrc      points to the block of input data.   
      [out] *pDst      points to the block of output data.   
      [in]  blockSize  number of samples to process per call.   
      return     none.   
注意事项:
结构arm_fir_instance_f32的定义如下(在文件arm_math.h文件):
      typedef struct
      {
      /**< number of 2nd order stages in the filter. Overall order is 2*numStages. */
      uint32_t numStages;   
       /**< Points to the array of state coefficients. The array is of length 4*numStages. */
      float32_t *pState;
      /**< Points to the array of coefficients.  The array is of length 5*numStages. */
          float32_t *pCoeffs;
      } arm_biquad_casd_df1_inst_f32;
特别注意,参数pState指向的数组大小要是4倍的numStages,pCoeffs指向的数组大小要是5倍的numStages。
1. 参数pCoeffs指向滤波因数,滤波因数数组长度为numTaps。但要注意pCoeffs指向的滤波因数应该按照如下的顺序进行排列:
       {b10, b11, b12, a11, a12, b20, b21, b22, a21, a22, ...}
    先放第一个二阶Biquad系数,然后放第二个,以此类推。
2. pState指向状态变量数组。
3. blockSize 这个参数的大小没有特殊要求,用户只需保证大于1且小于等于采样点个数即可。
1 o  O- o$ h: l( u. I( G- C
40.3.2 fdatool获取低通滤波器系数
    设计一个如下的例子:
    信号由50Hz正弦波和200Hz正弦波组成,采样率1Kbps,现设计一个巴特沃斯滤波器低通滤波器,采用直接I型,截止频率80Hz,采样400个数据,滤波器阶数设置为4。fadtool的配置如下:
40.11.png
配置好低通滤波器后,具体滤波器系数的生成大家参考本章第二小节的方法即可。

8 U" i* E1 R7 ?: C% o
40.3.3 低通滤波器实现
    通过工具箱fdatool获得低通滤波器系数后在开发板上运行函数arm_biquad_cascade_df1_f32来测试低通滤波器的效果。
  1. #define numStages  2                /* 2阶IIR滤波的个数 */; Z. S' v7 @. u5 n
  2. #define TEST_LENGTH_SAMPLES  400    /* 采样点数 */
    ' e" `: v: r9 a- Q1 a7 l- _
  3. 5 Z% y( x8 ]8 r5 L
  4. static float32_t testInput_f32_50Hz_200Hz[TEST_LENGTH_SAMPLES]; /* 采样点 */+ G: D; h* [0 m) p- g
  5. static float32_t testOutput[TEST_LENGTH_SAMPLES];               /* 滤波后的输出 */2 c* {( H/ c7 I9 A' G
  6. static float32_t IIRStateF32[4*numStages];                      /* 状态缓存,大小numTaps + blockSize - 1*/
    : K1 \* Z7 q' z6 j, g
  7.                                                                              5 y7 m- F0 A% J$ ^
  8. /* 巴特沃斯低通滤波器系数 80Hz*/                                                                                                                                         : ]/ L: Z4 ?/ o
  9. const float32_t IIRCoeffs32LP[5*numStages] = {
    8 h: U, F) G" c9 \
  10. 1.0f,  2.0f,  1.0f, 1.4797988943972167f,  -0.68867695305386178f,        
    0 c. o0 ^4 H8 i, }# s4 N( n  f
  11. 1.0f,  2.0f,  1.0f, 1.2128120926202184f,  -0.38400416228655354f                          
    ( u+ d1 k5 A* g# E0 B8 ^
  12. };" `; w4 S7 ?$ @: I: w! H2 Q
  13. /*) u0 W: i1 ^4 }. R
  14. *********************************************************************************************************5 r. N; K1 z3 L- Q$ K5 o, y8 S
  15. *        函 数 名: arm_iir_f32_lp7 [0 u$ C( ?. K9 ?7 B
  16. *        功能说明: 调用函数arm_iir_f32_lp实现低通滤波器
    , T( r# l7 r0 i, |& o6 E7 I
  17. *        形    参:无! l7 x: J  |5 G# }$ n
  18. *        返 回 值: 无6 K2 \* W5 c) A0 {, i% P
  19. *********************************************************************************************************7 W* t; O# s. H# {+ ~
  20. */
    5 I, Z1 `3 ]# a2 r& l
  21. static void arm_iir_f32_lp(void)
    2 k2 k$ H; ?* @  c4 k9 q  S9 F) ~
  22. {
    $ _0 G5 Z; r& N# e8 n" _
  23. uint32_t i;
    6 j) v$ @' y! P9 K
  24. arm_biquad_casd_df1_inst_f32 S;5 A! |7 p4 j4 `' g
  25. float32_t ScaleValue;" K& q  J6 w/ v) \9 e9 s+ I0 B0 \

  26. ; B( _' T1 U' x) Q
  27. /* 初始化 */
    ' [6 Z% V. f; ^
  28. arm_biquad_cascade_df1_init_f32(&S, numStages, (float32_t *)&IIRCoeffs32LP[0], (float32_t' A9 N6 P$ d1 T2 j8 Z
  29. *)&IIRStateF32[0]);* D: G, P0 K+ Z# G( l
  30. /* IIR滤波 */0 Z8 p* `3 J- ]2 W( V- s) d
  31.         arm_biquad_cascade_df1_f32(&S, testInput_f32_50Hz_200Hz, testOutput, TEST_LENGTH_SAMPLES);! r7 L% F5 L9 ^, i3 B
  32. /*放缩系数 */7 F" A$ G, W0 R8 I
  33. ScaleValue = 0.052219514664161221f * 0.04279801741658381f
    & s+ }/ }1 M; [5 `: c
  34. /* 打印滤波后结果 */
    - c" F1 |7 w3 N1 I
  35. for(i=0; i<TEST_LENGTH_SAMPLES; i++)# {* o7 `& f% _6 u3 _% t
  36. {
    : j8 e, ?$ E. o3 n& |# a" B
  37. printf("%f\r\n", testOutput[i]*ScaleValue);
    * t. G! L/ `) v) k. i- b' B3 p1 @
  38. }
    * k' R5 t0 ^9 z" O' P: ]4 b0 T. N
  39. }
复制代码
运行如上函数可以通过串口打印出函数arm_biquad_cascade_df1_f32滤波后的波形数据,下面通过Matlab绘制波形来对比Matlab计算的结果和ARM官方库计算的结果。
    对比前需要先将串口打印出的一组数据加载到Matlab中, arm_biquad_cascade_df1_f32的计算结果起名sampledata,加载方法在前面的教程中已经讲解过,这里不做赘述了。Matlab中运行的代码如下:
  1. fs=1000;              %设置采样频率 1K4 m( T" q( E2 r; G) S+ U
  2. N=400;               %采样点数      : X2 D' x9 l+ S, H* M
  3. n=0:N-1;
    2 M5 V9 F1 \7 k: Q
  4. t=n/fs;                %时间序列: Z9 \' w% H2 L7 f$ q% R' \5 u: S
  5. f=n*fs/N;              %频率序列$ L0 K0 ^: {0 F4 m$ J
  6. 7 L- f% B4 i9 C& F; U
  7. x1=sin(2*pi*50*t);/ s5 d, M- w# @4 w2 A! l
  8. x2=sin(2*pi*200*t);     %50Hz和200Hz正弦波& Z. }  g# w4 U; }* ^
  9. subplot(211);+ a; z/ t" c; P+ i
  10. plot(t, x1);+ E0 w4 p4 a6 W; q& u: K7 ?8 L
  11. title('滤波后的理想波形');& u2 P1 ~+ F7 K! L3 h# w  w
  12. grid on;
    # ?9 `" a/ `3 A+ x

  13. : j- l! x: y2 }. [
  14. subplot(212);; Z' ]+ G: @( d, o& A
  15. plot(t, sampledata);9 ~8 J. j4 u/ e# A3 x* p2 l
  16. title('ARM官方库滤波后的波形');% M, H! J* f; O4 R# U9 ?8 G: Y  B
  17. grid on;
复制代码
Matlab计算结果如下:
40.12.png
从上面的波形对比来看,matlab和函数arm_biquad_cascade_df1_f32计算的结果基本是一致的。为了更好的说明滤波效果,下面从频域的角度来说明这个问题,Matlab上面运行如下代码:
  1. fs=1000;                %设置采样频率 1K
    - g$ @* m; ?6 t+ g" D
  2. N=400;                 %采样点数      
    ; ^6 y* [* u4 O) @4 F/ S6 H5 i4 C4 B
  3. n=0:N-1;
    0 r/ r& v' _! v0 u
  4. t=n/fs;                  %时间序列8 K  U; g$ E1 B7 o' h7 [- a
  5. f=n*fs/N;                %频率序列
    2 @; k+ p  ~7 p  T+ K

  6. ( D- Q$ T0 q  n0 B. s+ K
  7. x = sin(2*pi*50*t) + sin(2*pi*200*t);      %50Hz和200Hz正弦波合成& `1 x; X% o! P$ c) J' @# K
  8.   
    3 ~" @% g3 @6 l. `$ T
  9. subplot(211);$ G( t+ Y2 q$ v3 f4 U8 ~/ z- i
  10. y=fft(x, N);                %对信号x做FFT   
    ; U; v8 a8 |1 f5 |5 h. w
  11. plot(f,abs(y));* `; a  V; k: E
  12. xlabel('频率/Hz');$ T. Z0 v  A* N% z( F& q/ v" G
  13. ylabel('振幅');
    - k! Q* U: G" w5 n0 W# L0 r, D9 e6 D+ e
  14. title('原始信号FFT');
    5 I2 O' @- X, K( a& X9 W0 s& ?
  15. grid on;1 ^' a: T, g4 B5 ]

  16. " J9 V$ o. i6 J
  17. y3=fft(sampledata, N);    %经过IIR滤波器后得到的信号做FFT* g8 I: U# M' r5 U+ b2 w  Y
  18. subplot(212);                               ) |! j' x6 Q6 ~' D
  19. plot(f,abs(y3));
    9 [1 M- g8 A  U/ d& Q
  20. xlabel('频率/Hz');
    ! i' m% p* \+ |6 R0 Y& c+ v" `: f
  21. ylabel('振幅');
    - c- |0 d* \' P2 C/ g- S+ D
  22. title('IIR滤波后信号FFT');
    4 S7 Z0 E% C2 U7 N9 ?  b
  23. grid on;
复制代码
Matlab计算结果如下:
40.13.png
上面波形变换前的FFT和变换后FFT可以看出,200Hz的正弦波基本被滤除。
9 N0 V; M& @9 r0 u( x
baiyongbin2009 回答时间:2015-4-28 10:27:34
40.4 IIR高通滤波器设计
! B7 m0 b- m/ j$ L) N) U
40.4.1 fdatool获取高通滤波器系数
    设计一个如下的例子:
    信号由50Hz正弦波和200Hz正弦波组成,采样率1Kbps,现设计一个巴特沃斯滤波器高通滤波器,采用直接I型,截止频率140Hz,采样400个数据,滤波器阶数设置为4。fadtool的配置如下:
40.14.png
配置好高通滤波器后,具体滤波器系数的生成大家参考本章第二小节的方法即可。

8 P: Q$ V% ^( F, p* X4 v
40.4.2 高通滤波器实现
    通过工具箱fdatool获得高通滤波器系数后在开发板上运行函数arm_biquad_cascade_df1_f32来测试高通滤波器的效果。
  1. #define numStages  2                /* 2阶IIR滤波的个数 */  Y( j; v3 S6 s/ ~, h, p* ?
  2. #define TEST_LENGTH_SAMPLES  400    /* 采样点数 */8 P7 f3 ?  z% }
  3. . N- k7 \- k; W. g2 w! x* h
  4. static float32_t testInput_f32_50Hz_200Hz[TEST_LENGTH_SAMPLES]; /* 采样点 */# f5 r+ U' `: G
  5. static float32_t testOutput[TEST_LENGTH_SAMPLES];               /* 滤波后的输出 */
    / l0 T: N9 _: g$ S
  6. static float32_t IIRStateF32[4*numStages];                      /* 状态缓存,大小numTaps + blockSize - 1*/
    , O* D6 e: B5 A! U& j8 |
  7.                                                                              - G  ~4 U3 C; P2 a  R; E  l$ R
  8. /* 巴特沃斯高通滤波器系数 140Hz */                                                                                                                                         
    ( {+ n7 ]" m7 Q
  9. const float32_t IIRCoeffs32HP[5*numStages] = {
    5 ~) }# X# z2 B# R9 B9 u" H* |
  10. 1.0f,  -2.0f,  1.0f,  0.9845430147411518f,   -0.54456536085081642f,      $ q7 |. D3 t6 O7 J
  11. 1.0f,  -2.0f,  1.0f,  0.74471447786432121f,  -0.16831887384397309f,                                ; X* G5 n  i# w7 m- y& R$ T+ G
  12. };
    + i' |6 r% }  R0 Y$ G6 i7 {

  13. * z( X6 t4 X) E- k* }
  14. /*
    " H4 i' F5 d" O
  15. *********************************************************************************************************- |! u% I# S+ Q3 Y3 P3 \
  16. *        函 数 名: arm_iir_f32_hp
    ( @$ S$ l5 \2 V
  17. *        功能说明: 调用函数arm_iir_f32_hp实现高通滤波器6 E7 D4 J; p0 F" q0 {
  18. *        形    参:无
    * h  }6 N% |- B& o
  19. *        返 回 值: 无% Y5 ]1 \6 W! O2 W/ _6 P
  20. *********************************************************************************************************; c: L' G6 |  P! C6 a( ?: ~* ^
  21. */) V2 U: B" `* h  i; u  _$ F
  22. static void arm_iir_f32_hp(void)
    1 M! ]  f7 Q& M) J1 c% L: T
  23. {4 [& a- R4 `7 r8 \# S3 d. l
  24. uint32_t i;
      N6 x6 ]+ _2 F6 F- m( ~# b
  25. arm_biquad_casd_df1_inst_f32 S;$ O9 D! P8 v$ @
  26. float32_t ScaleValue;
    % N5 i0 m. G6 U* `3 u6 u
  27. : M6 V* ?6 R7 A5 I) D3 Y) c
  28. /* 初始化 */" O, U5 u) ~3 z' ^
  29. arm_biquad_cascade_df1_init_f32(&S, numStages, (float32_t *)&IIRCoeffs32HP[0], (float32_t
    ; Y+ y8 p# l7 R2 e! D
  30. *)&IIRStateF32[0]);
    , I) q* T5 ^8 j
  31. /* IIR滤波 */
    " M3 S, g4 l1 Z/ `; r" _
  32.         arm_biquad_cascade_df1_f32(&S, testInput_f32_50Hz_200Hz, testOutput, TEST_LENGTH_SAMPLES);6 j9 l2 z7 L, @- n( r) j, z/ ]8 I7 C* n
  33.     # U5 m7 Y& i3 C! W  y8 v
  34. /*放缩系数 */   
    8 j  N9 O/ l, A# O$ k- n; E
  35. ScaleValue = 0.63227709389799203f * 0.47825833792707356f;  
      `1 q6 N5 X3 a& F4 K# m6 h( v
  36. /* 打印滤波后结果 */+ v; u# J! e& p0 r
  37. for(i=0; i<TEST_LENGTH_SAMPLES; i++)7 g" I# v# r& G# m9 \- b0 H' s2 I( d# f
  38. {# o- o' L1 ]) Z/ j& v& V/ p
  39. printf("%f\r\n", testOutput[i]*ScaleValue);
    8 r# |, a9 e' r9 D5 U* K% @6 ^
  40. }
    / y0 {; b2 f" a/ M
  41. }
复制代码
运行如上函数可以通过串口打印出函数arm_biquad_cascade_df1_f32滤波后的波形数据,下面通过Matlab绘制波形来对比Matlab计算的结果和ARM官方库计算的结果。
    对比前需要先将串口打印出的一组数据加载到Matlab中, arm_biquad_cascade_df1_f32的计算结果起名sampledata,加载方法在前面的教程中已经讲解过,这里不做赘述了。Matlab中运行的代码如下:
  1. fs=1000;              %设置采样频率 1K  R; @+ t! \0 ], ]; v
  2. N=400;               %采样点数      7 ]6 d" ^$ r0 w& ^6 O0 g
  3. n=0:N-1;( Y3 n1 I7 r! g/ \! X2 M, U2 r8 K( }
  4. t=n/fs;                %时间序列) l) u! m# J6 ?! s. Q' Z
  5. f=n*fs/N;              %频率序列  x, A  a% t! s+ I/ g% h4 ?, K
  6. 1 B# R% u. l: _: f# B$ H( q- I
  7. x1=sin(2*pi*50*t);- g& l2 T- Y1 u6 Z1 M: s( e
  8. x2=sin(2*pi*200*t);     %50Hz和200Hz正弦波5 J9 l5 E% b5 R3 }" }) D5 Z; }$ C
  9. subplot(211);
    6 ?. ?% f  j: D- G- k0 r
  10. plot(t, x2);
    " z8 _: o) u6 z$ t6 [: j/ P
  11. title('滤波后的理想波形');0 a4 \# C) f- u" t1 I
  12. grid on;3 g" v2 k( X% @3 A# X

  13. ' S8 U# k; b# t) E. E
  14. subplot(212);
    ; `0 \, G  r* h+ v' g7 ~4 U+ Q- Z; g
  15. plot(t, sampledata);% P) O% N2 k  O4 D1 F5 e2 w; `6 U- F
  16. title('ARM官方库滤波后的波形');
    7 K$ W, {. ^! d, Z4 o
  17. grid on;
复制代码
Matlab计算结果如下:
40.15.png
从上面的波形对比来看,matlab和函数arm_biquad_cascade_df1_f32计算的结果基本是一致的。为了更好的说明滤波效果,下面从频域的角度来说明这个问题,Matlab上面运行如下代码:
  1. fs=1000;                %设置采样频率 1K6 f+ |/ v& l5 R1 l
  2. N=400;                 %采样点数      7 p, j. H: c- q3 b
  3. n=0:N-1;8 Q+ t) Q& R3 A2 i2 G
  4. t=n/fs;                  %时间序列# V! m$ ]# w- s' R
  5. f=n*fs/N;                %频率序列
    8 r; x, H& b" T3 F
  6. 0 X% I, }* x3 e
  7. x = sin(2*pi*50*t) + sin(2*pi*200*t);      %50Hz和200Hz正弦波合成
    ; j* V# M, s6 P' d, J
  8.   
    # U2 H2 |" w+ H; f( v
  9. subplot(211);
    1 ~2 J/ M1 G7 d
  10. y=fft(x, N);                %对信号x做FFT   
    ' j) f# h. z" t' O% M2 z: Q
  11. plot(f,abs(y));# G7 m0 s- h1 P( B7 p( u/ b) Z
  12. xlabel('频率/Hz');  X9 S/ V% U0 J
  13. ylabel('振幅');7 N4 ~  M/ T! X( J
  14. title('原始信号FFT');
      |/ h4 @( y( f) Z1 T6 i; ?; v
  15. grid on;
    ! T  M+ D7 G' A9 f. v7 o

  16. 4 H& X; O  `& J$ B$ Y$ L
  17. y3=fft(sampledata, N);    %经过IIR滤波器后得到的信号做FFT- y0 o( Y( ^* g* L+ F
  18. subplot(212);                              
    , \1 J3 Y% _8 t
  19. plot(f,abs(y3));
      W4 K, O$ n) e$ r
  20. xlabel('频率/Hz');5 N' `7 F8 i7 o# A, x# `/ Q9 q
  21. ylabel('振幅');* o. |9 f: K9 F* ]6 G4 u
  22. title('IIR滤波后信号FFT');' h/ t1 d) `# h4 I  O- U
  23. grid on;
复制代码
Matlab计算结果如下:
40.16.png
上面波形变换前的FFT和变换后FFT可以看出,50Hz的正弦波基本被滤除。
. Y/ K, l4 E) D6 y, g* W
baiyongbin2009 回答时间:2015-4-28 10:32:14
40.5 IIR带通滤波器设计
( q+ Y8 k- Z' ^* r0 ?. X. L
40.5.1 fdatool获取低通滤波器系数
    设计一个如下的例子:
    信号由50Hz正弦波和200Hz正弦波组成,采样率1Kbps,现设计一个巴特沃斯滤波器带通滤波器,采用直接I型,截止频率140Hz和,采样400个数据,滤波器阶数设置为4。fadtool的配置如下:
40.17.png
配置好带通滤波器后,具体滤波器系数的生成大家参考本章第二小节的方法即可。

7 ]# j3 O) Q7 P3 C$ z
40.5.2 带通滤波器实现
    通过工具箱fdatool获得带通滤波器系数后在开发板上运行函数arm_biquad_cascade_df1_f32来测试带通滤波器的效果。
  1. #define numStages  2                /* 2阶IIR滤波的个数 */
    # Y2 D" ^( B2 n2 B. }
  2. #define TEST_LENGTH_SAMPLES  400    /* 采样点数 */
    . K) f) c# c- P, j
  3. " t" h% M) h# I, T0 x& D$ l5 N
  4. static float32_t testInput_f32_50Hz_200Hz[TEST_LENGTH_SAMPLES]; /* 采样点 */
    - E; N$ a( _+ \, {+ v  N' I
  5. static float32_t testOutput[TEST_LENGTH_SAMPLES];               /* 滤波后的输出 */
    * w: U$ M( m3 o# [* a: @2 |
  6. static float32_t IIRStateF32[4*numStages];                      /* 状态缓存,大小numTaps + blockSize - 1*/% i1 e) H7 s* m! `1 ~
  7.                                                                              7 Z. \0 |7 n) V1 t$ Y/ o
  8. /* 巴特沃斯带通滤波器系数140Hz 400Hz*/                                                                                                                                         ' q2 s! [+ s9 r- b: z3 S
  9. const float32_t IIRCoeffs32BP[5*numStages] = {
    , _$ R) v6 T# ^: G9 V% u' h" X
  10. 1.0f,  0.0f,  -1.0f,    -1.1276518720541668f,   -0.47001314508753411f,      
    & {5 {( Q- Y& \" ?; X
  11. 1.0f,  0.0f,  -1.0f,    0.77495305804604886f,  -0.36707750055668387f                              
    - W7 r& x/ I+ K( _. T( s1 o
  12. };& K& x0 c( a2 H

  13. , M5 J2 T0 W1 g; p4 o# T1 z' ~
  14. /*
    , ~0 z; z6 L& q) K" A5 A  e
  15. *********************************************************************************************************
    3 J% w. Y, H% d
  16. *        函 数 名: arm_iir_f32_bp3 G* L! S) ?9 R/ ^5 ~
  17. *        功能说明: 调用函数arm_iir_f32_hp实现带通滤波器
    3 e9 [+ I, _& Z
  18. *        形    参:无4 o; e4 @# A* U  V+ V
  19. *        返 回 值: 无: S8 H  E" T# K+ O$ @$ [
  20. *********************************************************************************************************( ?; {6 f4 t$ h( @+ ?* z# }
  21. */: R2 @) D# d3 c6 [6 R
  22. static void arm_iir_f32_bp(void)- r( _4 Z4 J7 y8 J+ {
  23. {' q5 O" l# g6 x5 j) ^" a
  24. uint32_t i;3 |6 w- h6 n5 G: m: ?- [3 \
  25. arm_biquad_casd_df1_inst_f32 S;. T  s( F3 G$ F2 w+ O  O
  26. float32_t ScaleValue;
      y& Z# W. ~! g4 t! Y6 A

  27. 8 z/ x/ P* Q! ?- I/ C, i3 E: K2 [' v
  28. /* 初始化 */
    : H$ I/ X* H& \5 e9 C! \& g+ P
  29. arm_biquad_cascade_df1_init_f32(&S, numStages, (float32_t *)&IIRCoeffs32BP[0], (float32_t
      m( ^* u" p' h$ P- @; L
  30. *)&IIRStateF32[0]);
    / y' d" L8 j" W- x6 u' T9 v; _
  31. /* IIR滤波 */
    . \3 f. P, `+ h& @
  32.         arm_biquad_cascade_df1_f32(&S, testInput_f32_50Hz_200Hz, testOutput, TEST_LENGTH_SAMPLES);0 q6 `" L" g  W* S) L1 d7 G
  33.    
    8 s, k/ [. T+ H7 V9 Q: _) `: Z
  34. /*放缩系数 */    / K1 O  @5 v; ~
  35. ScaleValue = 0.55815658576077365f * 0.55815658576077365f;  - P% t/ k5 E* T: }/ z5 O- N. \+ c
  36. /* 打印滤波后结果 */9 y3 K5 E3 d1 p' T( A; D
  37. for(i=0; i<TEST_LENGTH_SAMPLES; i++)
    # O8 }5 E& ?3 @" M! u1 s6 }
  38. {
    , m9 ]  [4 g/ J
  39. printf("%f\r\n", testOutput[i]*ScaleValue);1 }, G4 s% o- ^& H/ [2 Y- U
  40. }
    & @$ t) `- O; `
  41. }
复制代码
运行如上函数可以通过串口打印出函数arm_biquad_cascade_df1_f32滤波后的波形数据,下面通过Matlab绘制波形来对比Matlab计算的结果和ARM官方库计算的结果。
    对比前需要先将串口打印出的一组数据加载到Matlab中, arm_biquad_cascade_df1_f32的计算结果起名sampledata,加载方法在前面的教程中已经讲解过,这里不做赘述了。Matlab中运行的代码如下:
  1. fs=1000;              %设置采样频率 1K
    * ~; T' z& |6 I4 i( b" E) n- q
  2. N=400;               %采样点数      
    ! u9 `/ y6 q! p1 Z* ~
  3. n=0:N-1;  U$ E" s# k: g4 v8 @, O
  4. t=n/fs;                %时间序列/ {& ?# v/ b  k, d  V$ Z) L
  5. f=n*fs/N;              %频率序列
    0 `' q- u: e7 R# n0 j" x% T  T
  6. $ a: J, o8 o! ]7 U" p; b
  7. x1=sin(2*pi*50*t);
    5 @( V8 f$ u, f  o; q4 O* ^
  8. x2=sin(2*pi*200*t);     %50Hz和200Hz正弦波
    7 j+ Z1 e; C; }  k+ p& Y
  9. subplot(211);
    ) }% V& P- g6 Y5 P+ W2 W7 e1 j
  10. plot(t, x1);
    ( K4 o0 }, |; Y9 |% c
  11. title('滤波后的理想波形');
    0 S# d3 j0 B: Y! y" k7 d: R: b# C
  12. grid on;
    1 W6 |* h" k+ g5 w. q
  13. * p$ w$ ]/ E  A) U' b! h* B8 `
  14. subplot(212);
    4 i, s. h7 a& p! g
  15. plot(t, sampledata);
    $ C) k4 E& x' h
  16. title('ARM官方库滤波后的波形');, p* v* X; w% h4 B  k
  17. grid on;
复制代码
Matlab计算结果如下:
40.18.png
从上面的波形对比来看,matlab和函数arm_biquad_cascade_df1_f32计算的结果基本是一致的。为了更好的说明滤波效果,下面从频域的角度来说明这个问题,Matlab上面运行如下代码:
  1. fs=1000;                %设置采样频率 1K, p7 ?) I5 D6 ?- O; p1 {5 |
  2. N=400;                 %采样点数      
    ( [5 H# Y6 |9 k6 F* S/ O
  3. n=0:N-1;; n3 G* L/ J7 {6 z
  4. t=n/fs;                  %时间序列, J6 Q2 I0 o( G" k3 M
  5. f=n*fs/N;                %频率序列
    . I# O7 R/ Z8 U! i# u" O) D
  6. 5 [1 |$ H" A/ j% f% s
  7. x = sin(2*pi*50*t) + sin(2*pi*200*t);      %50Hz和200Hz正弦波合成. e/ b. C/ [4 ~9 x" B* r6 ]
  8.   
    ; Y4 |% _' _/ \+ \4 h( J& e
  9. subplot(211);
    / A; O9 c- d8 a# Q2 P: N0 G
  10. y=fft(x, N);                %对信号x做FFT   + o5 _" k/ u' ]8 _; D
  11. plot(f,abs(y));+ X2 X! k6 T' C" |
  12. xlabel('频率/Hz');! p7 w/ o6 x( y7 b
  13. ylabel('振幅');1 n' J* V. {# s/ f. z7 }1 |3 v( d
  14. title('原始信号FFT');
    ! Q& X; [8 j; t) o7 h% X  B  r
  15. grid on;+ H5 l& Z* _+ ~5 f# c( w8 o+ z! [
  16. 6 a  p: \" u3 j/ @3 m5 Q2 k
  17. y3=fft(sampledata, N);    %经过IIR滤波器后得到的信号做FFT( f( Q! y+ Y2 s$ p! q
  18. subplot(212);                               5 _- f! W8 b/ R9 ]' M+ E
  19. plot(f,abs(y3));9 b0 y# p( D- K/ v: u
  20. xlabel('频率/Hz');
    5 `4 K+ @7 R- K) a
  21. ylabel('振幅');
    / w9 b" Y3 }0 Q8 v: K# z
  22. title('IIR滤波后信号FFT');
    # r3 J3 D! y/ k: _! _& y/ B
  23. grid on;
复制代码
Matlab计算结果如下:
40.19.png
上面波形变换前的FFT和变换后FFT可以看出,50Hz的正弦波基本被滤除。
7 |* f4 k. t/ B4 P* O! M
wamcncn 回答时间:2015-4-28 11:14:32
标记学习
baiyongbin2009 回答时间:2015-4-28 12:45:41
40.6 IIR带阻滤波器设计
- K$ Z7 D4 v9 m4 b/ @! t; o/ V: x! d
40.6.1 fdatool获取带阻滤波器系数
    设计一个如下的例子:
    信号由50Hz正弦波和200Hz正弦波组成,采样率1Kbps,现设计一个巴特沃斯滤波器带阻滤波器,采用直接I型,截止频率100Hz和325Hz,采样400个数据,滤波器阶数设置为4。fadtool的配置如下:
40.20.png
配置好带阻滤波器后,具体滤波器系数的生成大家参考本章第二小节的方法即可。
0 c) R/ ]. y3 n. T
40.6.2 带阻滤波器实现
    通过工具箱fdatool获得带阻滤波器系数后在开发板上运行函数arm_biquad_cascade_df1_f32来测试带阻滤波器的效果。
  1. #define numStages  2                /* 2阶IIR滤波的个数 */, T, \  b" o/ z2 H( v! }: T0 B
  2. #define TEST_LENGTH_SAMPLES  400    /* 采样点数 */
      u3 P* z* `2 l- C) @
  3. * n2 D2 S9 ]8 M! O7 Y
  4. static float32_t testInput_f32_50Hz_200Hz[TEST_LENGTH_SAMPLES]; /* 采样点 */8 n& G, ]5 T: i0 {/ Z8 H7 Z
  5. static float32_t testOutput[TEST_LENGTH_SAMPLES];               /* 滤波后的输出 */2 M" u( ~% s$ g" A
  6. static float32_t IIRStateF32[4*numStages];                      /* 状态缓存,大小numTaps + blockSize - 1*/
    . ]/ P7 z: ~$ G4 @& G
  7.                                                                              
    1 m0 w) l7 I, z+ p2 s! ~
  8. /* 巴特沃斯带阻滤波器系数100Hz 325Hz*/                                                                                                                                         1 P3 c# s' g) B9 o
  9. const float32_t IIRCoeffs32BS[5*numStages] = {
    ! x( w, n) Y% `+ I& C' T! I- s
  10. 1.0f,  -0.61400192638335005f,  1.0f,  1.1451427879497746f,   -0.50298007146721391f,4 b& J5 D; Z, |- i1 c
  11. 1.0f,  -0.61400192638335005f,  1.0f,  -0.47458704658841883f, -0.35305199748708849f                        
    : g8 W+ k$ O4 |7 _- c" T  v
  12. };
    ' S* Z  g9 p( x- R( F
  13. ) T4 |2 i) M8 I: G" |6 t
  14. /*
    ' t# `$ S* G. Q9 T- R) i
  15. *********************************************************************************************************/ \7 T5 J2 k$ Y; N1 q. s5 c
  16. *        函 数 名: arm_iir_f32_bs5 B. |5 \6 ]3 m! J, k1 z
  17. *        功能说明: 调用函数arm_iir_f32_bs实现带阻滤波器# B# ~2 t& w  a: f; P+ V$ I
  18. *        形    参:无
    2 x0 x. e/ c/ Y8 ~2 m! G
  19. *        返 回 值: 无- t% j( e$ B% z+ S; C; v7 Q1 n1 w
  20. *********************************************************************************************************, [) y% b* t; z3 h! A9 p6 }
  21. */
    6 ]% j- J, w. l( a& T5 w4 k
  22. static void arm_iir_f32_bs(void)3 n2 }& A1 @# F; O. V! u" R
  23. {
    ! s% B& o, S" |+ o% J
  24. uint32_t i;# X% i" i7 ?8 A# \$ i
  25. arm_biquad_casd_df1_inst_f32 S;8 M! D! ]1 u5 d" w3 u! {% t
  26. float32_t ScaleValue;' X' K5 ?- C/ f

  27. + X4 A, G2 r" D/ G
  28. /* 初始化 */$ \5 L) U% ], |+ M( t0 C0 B$ K
  29. arm_biquad_cascade_df1_init_f32(&S, numStages, (float32_t *)&IIRCoeffs32BS[0], (float32_t0 k5 M  w! H6 ~1 l! D, l# a
  30. *)&IIRStateF32[0]);
    . P. ^2 `7 y: b+ T' B# W
  31. /* IIR滤波 */' ?. W/ M, A6 U8 q1 L; U& V: h
  32.         arm_biquad_cascade_df1_f32(&S, testInput_f32_50Hz_200Hz, testOutput, TEST_LENGTH_SAMPLES);9 P4 U" Y. F. N# n4 p# G/ p
  33.    
    ! M3 a7 a& o0 {0 Q! ^, g
  34. /*放缩系数 */    5 ~! K# w: d, y# D: I
  35. ScaleValue = 0.58347920314378698f * 0.58347920314378698f;  - y5 M' F7 a% z/ \1 m
  36. /* 打印滤波后结果 */" D6 N  K. [* K7 a4 A, F- B$ }
  37. for(i=0; i<TEST_LENGTH_SAMPLES; i++)8 [- q1 i% e/ t& l7 _0 z9 ~2 G
  38. {9 @4 D. l8 x: G, S! B$ `1 K" j" H8 [
  39. printf("%f\r\n", testOutput[i]*ScaleValue);
    ( B: ^: t- P+ c" u7 S
  40. }
    ! A5 [" c4 U2 p' l  }
  41. }
复制代码
运行如上函数可以通过串口打印出函数arm_biquad_cascade_df1_f32滤波后的波形数据,下面通过Matlab绘制波形来对比Matlab计算的结果和ARM官方库计算的结果。
    对比前需要先将串口打印出的一组数据加载到Matlab中, arm_biquad_cascade_df1_f32的计算结果起名sampledata,加载方法在前面的教程中已经讲解过,这里不做赘述了。Matlab中运行的代码如下:
  1. fs=1000;              %设置采样频率 1K& e( N. }7 [. F/ V8 h. U, G
  2. N=400;               %采样点数      
    / o9 j6 W( t3 x9 a$ r1 i
  3. n=0:N-1;! ~: ^$ k$ F1 p" S& C! w- a
  4. t=n/fs;                %时间序列
    3 y) k& ^$ o/ X! q$ k
  5. f=n*fs/N;              %频率序列
    ( O$ g3 y) W( f
  6. 3 u8 Q( r9 S( ~1 v
  7. x1=sin(2*pi*50*t);9 H5 A5 q. p! U  X- c1 q. G) R8 q. m+ [- m
  8. x2=sin(2*pi*200*t);     %50Hz和200Hz正弦波# i3 J8 l6 F( A. M7 O9 c
  9. subplot(211);
    : ~+ Z+ x: }, {, h4 T$ F3 D
  10. plot(t, x1);3 W* Q. X, m: B1 j9 T2 C7 `
  11. title('滤波后的理想波形');# I) P$ p. J& F- z: M% s
  12. grid on;
    ' s2 i/ q6 `  P. h; [

  13. + r! U& x  D3 `) ~+ ^
  14. subplot(212);
      e+ w8 B& |1 i+ A; E
  15. plot(t, sampledata);5 t. x' ]/ T/ i4 A
  16. title('ARM官方库滤波后的波形');
    : J# k6 L; a, y9 W! [6 d9 _
  17. grid on;
复制代码
Matlab计算结果如下:
40.21.png
从上面的波形对比来看,matlab和函数arm_biquad_cascade_df1_f32计算的结果基本是一致的。为了更好的说明滤波效果,下面从频域的角度来说明这个问题,Matlab上面运行如下代码:
  1. fs=1000;                %设置采样频率 1K' @4 l. E  I" W6 Q; ^: i6 K. j
  2. N=400;                 %采样点数      # y" z5 j! c2 Q5 z0 N( U
  3. n=0:N-1;
    8 \" Q9 b) R1 q5 [$ B1 `
  4. t=n/fs;                  %时间序列+ r, D: B# n2 ]$ [6 k' K2 ^  J* X$ n
  5. f=n*fs/N;                %频率序列
    , S" {# V! G4 m' K' M

  6. ' j+ S, x. A6 c& g1 X0 O8 \2 C1 j
  7. x = sin(2*pi*50*t) + sin(2*pi*200*t);      %50Hz和200Hz正弦波合成  R- Y1 j5 U) l2 O# Q
  8.   
    ! H( Z# K: M! J. {5 }2 D
  9. subplot(211);
    8 K9 W6 R  \5 ~/ r# u
  10. y=fft(x, N);                %对信号x做FFT   
    ; Y3 \- Q* s1 f1 ?9 F
  11. plot(f,abs(y));9 ~) Q& C. V7 N. V
  12. xlabel('频率/Hz');
    ) Z% L; o0 I5 e" G" v
  13. ylabel('振幅');" N7 t; q% y  p
  14. title('原始信号FFT');
    : h6 p: ?4 }+ _# Q$ Z. C
  15. grid on;
    ! G9 n) z! u7 Z' F& \
  16. 1 N4 S4 K; i& B( W- A
  17. y3=fft(sampledata, N);    %经过IIR滤波器后得到的信号做FFT8 H/ |7 R/ v8 e- Z1 ]8 P
  18. subplot(212);                               , S: i$ o- x( d) g$ e
  19. plot(f,abs(y3));
    + d4 a( f0 |% P6 X) {# `* f
  20. xlabel('频率/Hz');' y2 J5 N+ E7 U% z, O$ n
  21. ylabel('振幅');
      H- |) _4 m( {1 E3 S8 j4 a
  22. title('IIR滤波后信号FFT');& I6 i7 H9 Y. h/ T" M
  23. grid on;
复制代码
Matlab计算结果如下:
40.22.png
上面波形变换前的FFT和变换后FFT可以看出,200Hz的正弦波基本被滤除。

$ r' g+ h4 y' Q5 W
baiyongbin2009 回答时间:2015-4-28 12:46:42
40.7 总结
    本章节主要讲解了巴特沃斯低通,高通,带通和带阻滤波器的实现,有兴趣的可以使用同样的方法实现切比雪夫滤波器的设计。
" }! v! [: `+ Q- M& o  A
XDLH 回答时间:2015-11-15 13:40:28
不错挺好的!受教了!
zhh 回答时间:2020-12-1 15:57:50
输入信号是连续的,每调用一次arm_biquad_cascade_df1_f32函数,开始几个点都会有畸变,如何做到输出信号连续无畸变呢?
关于
我们是谁
投资者关系
意法半导体可持续发展举措
创新与技术
意法半导体官网
联系我们
联系ST分支机构
寻找销售人员和分销渠道
社区
媒体中心
活动与培训
隐私策略
隐私策略
Cookies管理
行使您的权利
官方最新发布
人形机器人运动控制、感知与智能配电
半导体创新技术与应用方向
EE架构与软件定义汽车
12V/48V 汽车智能配电(SPD)
区域控制单元(ZCU)与分区架构
关注我们
st-img 微信公众号
st-img 手机版