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?
User | Revision | Line number | New 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 |