不韋 呂 / Mbed 2 deprecated F446_DSP_FFT_Analyzer

FFT によるスペクトル解析器

Dependencies:   Array_Matrix mbed SerialTxRxIntr UIT_FFT_Real DSP_ADDA

IIR_Filter/IirCascade.hpp@0:91cc5a03f0ca, 2021-01-08 (annotated)

Committer:
MikamiUitOpen
Date:
Fri Jan 08 02:27:46 2021 +0000
Revision:
0:91cc5a03f0ca
1

Who changed what in which revision?

UserRevisionLine numberNew contents of line
MikamiUitOpen 0:91cc5a03f0ca 1 //---------------------------------------------------
MikamiUitOpen 0:91cc5a03f0ca 2 // 縦続形 IIR フィルタ
MikamiUitOpen 0:91cc5a03f0ca 3 //
MikamiUitOpen 0:91cc5a03f0ca 4 // 2020/11/04, Copyright (c) 2020 MIKAMI, Naoki
MikamiUitOpen 0:91cc5a03f0ca 5 //---------------------------------------------------
MikamiUitOpen 0:91cc5a03f0ca 6
MikamiUitOpen 0:91cc5a03f0ca 7 #include "Biquad.hpp"
MikamiUitOpen 0:91cc5a03f0ca 8 #include "Array.hpp" // Array クラスが定義されている
MikamiUitOpen 0:91cc5a03f0ca 9 using namespace Mikami;
MikamiUitOpen 0:91cc5a03f0ca 10
MikamiUitOpen 0:91cc5a03f0ca 11 #ifndef IIR_CASCADE_HPP
MikamiUitOpen 0:91cc5a03f0ca 12 #define IIR_CASCADE_HPP
MikamiUitOpen 0:91cc5a03f0ca 13
MikamiUitOpen 0:91cc5a03f0ca 14 class IirCascade
MikamiUitOpen 0:91cc5a03f0ca 15 {
MikamiUitOpen 0:91cc5a03f0ca 16 public:
MikamiUitOpen 0:91cc5a03f0ca 17 // コンストラクタ
MikamiUitOpen 0:91cc5a03f0ca 18 IirCascade(int order, const Biquad::Coefs ck[], float g0)
MikamiUitOpen 0:91cc5a03f0ca 19 : order_(order), hn_((order+1)/2)
MikamiUitOpen 0:91cc5a03f0ca 20 { SetCoefs(order, ck, g0); }
MikamiUitOpen 0:91cc5a03f0ca 21
MikamiUitOpen 0:91cc5a03f0ca 22 // コンストラクタ
MikamiUitOpen 0:91cc5a03f0ca 23 IirCascade(int order, const Biquad hk[], float g0)
MikamiUitOpen 0:91cc5a03f0ca 24 : order_(order), hn_((order+1)/2, hk), g0_(g0) {}
MikamiUitOpen 0:91cc5a03f0ca 25
MikamiUitOpen 0:91cc5a03f0ca 26 virtual ~IirCascade() {}
MikamiUitOpen 0:91cc5a03f0ca 27
MikamiUitOpen 0:91cc5a03f0ca 28 // フィルタ処理を実行する
MikamiUitOpen 0:91cc5a03f0ca 29 float Execute(float xn)
MikamiUitOpen 0:91cc5a03f0ca 30 {
MikamiUitOpen 0:91cc5a03f0ca 31 float yn = g0_*xn;
MikamiUitOpen 0:91cc5a03f0ca 32 for (int k=0; k<(order_+1)/2; k++) yn = hn_[k].Execute(yn);
MikamiUitOpen 0:91cc5a03f0ca 33 return yn;
MikamiUitOpen 0:91cc5a03f0ca 34 }
MikamiUitOpen 0:91cc5a03f0ca 35
MikamiUitOpen 0:91cc5a03f0ca 36 // 係数の設定
MikamiUitOpen 0:91cc5a03f0ca 37 void SetCoefs(int order, const Biquad::Coefs ck[], float g0)
MikamiUitOpen 0:91cc5a03f0ca 38 {
MikamiUitOpen 0:91cc5a03f0ca 39 if (order_ != order)
MikamiUitOpen 0:91cc5a03f0ca 40 {
MikamiUitOpen 0:91cc5a03f0ca 41 order_ = order;
MikamiUitOpen 0:91cc5a03f0ca 42 hn_.SetSize((order+1)/2);
MikamiUitOpen 0:91cc5a03f0ca 43 }
MikamiUitOpen 0:91cc5a03f0ca 44 g0_ = g0;
MikamiUitOpen 0:91cc5a03f0ca 45 for (int k=0; k<(order+1)/2; k++) hn_[k].SetCoefs(ck[k]);
MikamiUitOpen 0:91cc5a03f0ca 46 }
MikamiUitOpen 0:91cc5a03f0ca 47
MikamiUitOpen 0:91cc5a03f0ca 48 // 内部変数（遅延器）のクリア
MikamiUitOpen 0:91cc5a03f0ca 49 void Clear()
MikamiUitOpen 0:91cc5a03f0ca 50 { for (int k=0; k<(order_+1)/2; k++) hn_[k].Clear(); }
MikamiUitOpen 0:91cc5a03f0ca 51
MikamiUitOpen 0:91cc5a03f0ca 52 private:
MikamiUitOpen 0:91cc5a03f0ca 53 int order_; // 次数
MikamiUitOpen 0:91cc5a03f0ca 54 Array<Biquad> hn_; // Biquad クラスのオブジェクトの配列
MikamiUitOpen 0:91cc5a03f0ca 55 float g0_; // 利得定数
MikamiUitOpen 0:91cc5a03f0ca 56 };
MikamiUitOpen 0:91cc5a03f0ca 57 #endif // IIR_CASCADE_HPP