CQエレクトロニクス・セミナで使用する遮断周波数可変の LPF/HPF のプログラム

Dependencies:   mbed SerialTxRxIntr DSP_MultirateLinearphase

Committer:
MikamiUitOpen
Date:
Wed Mar 30 05:00:14 2022 +0000
Revision:
2:3955cb401851
Parent:
0:f1e2a221b526
3

Who changed what in which revision?

UserRevisionLine numberNew 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