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