CQエレクトロニクス・セミナで使用するファンクション・ジェネレータの プログラム
Dependencies: Array_Matrix mbed SerialTxRxIntr MyTicker7
IIR_Filter/IirCascade.hpp@0:8c8bc21159d9, 2022-02-25 (annotated)
- Committer:
- MikamiUitOpen
- Date:
- Fri Feb 25 02:36:55 2022 +0000
- Revision:
- 0:8c8bc21159d9
1
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
MikamiUitOpen | 0:8c8bc21159d9 | 1 | //--------------------------------------------------- |
MikamiUitOpen | 0:8c8bc21159d9 | 2 | // 縦続形 IIR フィルタ |
MikamiUitOpen | 0:8c8bc21159d9 | 3 | // |
MikamiUitOpen | 0:8c8bc21159d9 | 4 | // 2020/11/04, Copyright (c) 2020 MIKAMI, Naoki |
MikamiUitOpen | 0:8c8bc21159d9 | 5 | //--------------------------------------------------- |
MikamiUitOpen | 0:8c8bc21159d9 | 6 | |
MikamiUitOpen | 0:8c8bc21159d9 | 7 | #include "Biquad.hpp" |
MikamiUitOpen | 0:8c8bc21159d9 | 8 | #include "Array.hpp" // Array クラスが定義されている |
MikamiUitOpen | 0:8c8bc21159d9 | 9 | using namespace Mikami; |
MikamiUitOpen | 0:8c8bc21159d9 | 10 | |
MikamiUitOpen | 0:8c8bc21159d9 | 11 | #ifndef IIR_CASCADE_HPP |
MikamiUitOpen | 0:8c8bc21159d9 | 12 | #define IIR_CASCADE_HPP |
MikamiUitOpen | 0:8c8bc21159d9 | 13 | |
MikamiUitOpen | 0:8c8bc21159d9 | 14 | class IirCascade |
MikamiUitOpen | 0:8c8bc21159d9 | 15 | { |
MikamiUitOpen | 0:8c8bc21159d9 | 16 | public: |
MikamiUitOpen | 0:8c8bc21159d9 | 17 | // コンストラクタ |
MikamiUitOpen | 0:8c8bc21159d9 | 18 | IirCascade(int order, const Biquad::Coefs ck[], float g0) |
MikamiUitOpen | 0:8c8bc21159d9 | 19 | : order_(order), hn_((order+1)/2) |
MikamiUitOpen | 0:8c8bc21159d9 | 20 | { SetCoefs(order, ck, g0); } |
MikamiUitOpen | 0:8c8bc21159d9 | 21 | |
MikamiUitOpen | 0:8c8bc21159d9 | 22 | // コンストラクタ |
MikamiUitOpen | 0:8c8bc21159d9 | 23 | IirCascade(int order, const Biquad hk[], float g0) |
MikamiUitOpen | 0:8c8bc21159d9 | 24 | : order_(order), hn_((order+1)/2, hk), g0_(g0) {} |
MikamiUitOpen | 0:8c8bc21159d9 | 25 | |
MikamiUitOpen | 0:8c8bc21159d9 | 26 | virtual ~IirCascade() {} |
MikamiUitOpen | 0:8c8bc21159d9 | 27 | |
MikamiUitOpen | 0:8c8bc21159d9 | 28 | // フィルタ処理を実行する |
MikamiUitOpen | 0:8c8bc21159d9 | 29 | float Execute(float xn) |
MikamiUitOpen | 0:8c8bc21159d9 | 30 | { |
MikamiUitOpen | 0:8c8bc21159d9 | 31 | float yn = g0_*xn; |
MikamiUitOpen | 0:8c8bc21159d9 | 32 | for (int k=0; k<(order_+1)/2; k++) yn = hn_[k].Execute(yn); |
MikamiUitOpen | 0:8c8bc21159d9 | 33 | return yn; |
MikamiUitOpen | 0:8c8bc21159d9 | 34 | } |
MikamiUitOpen | 0:8c8bc21159d9 | 35 | |
MikamiUitOpen | 0:8c8bc21159d9 | 36 | // 係数の設定 |
MikamiUitOpen | 0:8c8bc21159d9 | 37 | void SetCoefs(int order, const Biquad::Coefs ck[], float g0) |
MikamiUitOpen | 0:8c8bc21159d9 | 38 | { |
MikamiUitOpen | 0:8c8bc21159d9 | 39 | if (order_ != order) |
MikamiUitOpen | 0:8c8bc21159d9 | 40 | { |
MikamiUitOpen | 0:8c8bc21159d9 | 41 | order_ = order; |
MikamiUitOpen | 0:8c8bc21159d9 | 42 | hn_.SetSize((order+1)/2); |
MikamiUitOpen | 0:8c8bc21159d9 | 43 | } |
MikamiUitOpen | 0:8c8bc21159d9 | 44 | g0_ = g0; |
MikamiUitOpen | 0:8c8bc21159d9 | 45 | for (int k=0; k<(order+1)/2; k++) hn_[k].SetCoefs(ck[k]); |
MikamiUitOpen | 0:8c8bc21159d9 | 46 | } |
MikamiUitOpen | 0:8c8bc21159d9 | 47 | |
MikamiUitOpen | 0:8c8bc21159d9 | 48 | // 内部変数(遅延器)のクリア |
MikamiUitOpen | 0:8c8bc21159d9 | 49 | void Clear() |
MikamiUitOpen | 0:8c8bc21159d9 | 50 | { for (int k=0; k<(order_+1)/2; k++) hn_[k].Clear(); } |
MikamiUitOpen | 0:8c8bc21159d9 | 51 | |
MikamiUitOpen | 0:8c8bc21159d9 | 52 | private: |
MikamiUitOpen | 0:8c8bc21159d9 | 53 | int order_; // 次数 |
MikamiUitOpen | 0:8c8bc21159d9 | 54 | Array<Biquad> hn_; // Biquad クラスのオブジェクトの配列 |
MikamiUitOpen | 0:8c8bc21159d9 | 55 | float g0_; // 利得定数 |
MikamiUitOpen | 0:8c8bc21159d9 | 56 | }; |
MikamiUitOpen | 0:8c8bc21159d9 | 57 | #endif // IIR_CASCADE_HPP |