CQエレクトロニクス・セミナで使用するファンクション・ジェネレータの プログラム

Dependencies:   Array_Matrix mbed SerialTxRxIntr MyTicker7

Committer:
MikamiUitOpen
Date:
Fri Feb 25 02:36:55 2022 +0000
Revision:
0:8c8bc21159d9
1

Who changed what in which revision?

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