不韋 呂 / Mbed 2 deprecated DSP_Seminar_FunctionGenerator

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

Dependencies:   Array_Matrix mbed SerialTxRxIntr MyTicker7

IIR_Filter/Biquad.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?

UserRevisionLine numberNew contents of line
MikamiUitOpen 0:8c8bc21159d9 1 //--------------------------------------------------------------
MikamiUitOpen 0:8c8bc21159d9 2 // 縦続形 IIR フィルタの構成要素として使う 2 次の IIR フィルタ
MikamiUitOpen 0:8c8bc21159d9 3 // b0 は 1 と仮定している
MikamiUitOpen 0:8c8bc21159d9 4 //
MikamiUitOpen 0:8c8bc21159d9 5 // 2020/11/04, Copyright (c) 2020 MIKAMI, Naoki
MikamiUitOpen 0:8c8bc21159d9 6 //--------------------------------------------------------------
MikamiUitOpen 0:8c8bc21159d9 7
MikamiUitOpen 0:8c8bc21159d9 8 #include "mbed.h"
MikamiUitOpen 0:8c8bc21159d9 9
MikamiUitOpen 0:8c8bc21159d9 10 #ifndef IIR_BIQUAD_HPP
MikamiUitOpen 0:8c8bc21159d9 11 #define IIR_BIQUAD_HPP
MikamiUitOpen 0:8c8bc21159d9 12
MikamiUitOpen 0:8c8bc21159d9 13 class Biquad
MikamiUitOpen 0:8c8bc21159d9 14 {
MikamiUitOpen 0:8c8bc21159d9 15 public:
MikamiUitOpen 0:8c8bc21159d9 16 // フィルタの係数をまとめて扱うための構造体
MikamiUitOpen 0:8c8bc21159d9 17 struct Coefs { float a1, a2, b1, b2; };
MikamiUitOpen 0:8c8bc21159d9 18
MikamiUitOpen 0:8c8bc21159d9 19 // デフォルト･コンストラクタ
MikamiUitOpen 0:8c8bc21159d9 20 // 係数は構造体 Ceofs で与える
MikamiUitOpen 0:8c8bc21159d9 21 Biquad(const Coefs ck = (Coefs){0, 0, 0, 0})
MikamiUitOpen 0:8c8bc21159d9 22 : a1_(ck.a1), a2_(ck.a2), b1_(ck.b1), b2_(ck.b2),
MikamiUitOpen 0:8c8bc21159d9 23 un1_(0), un2_(0) {}
MikamiUitOpen 0:8c8bc21159d9 24
MikamiUitOpen 0:8c8bc21159d9 25 // 係数を個別に与えるコンストラクタ
MikamiUitOpen 0:8c8bc21159d9 26 Biquad(float a1, float a2, float b1, float b2)
MikamiUitOpen 0:8c8bc21159d9 27 : a1_(a1), a2_(a2), b1_(b1), b2_(b2), un1_(0), un2_(0) {}
MikamiUitOpen 0:8c8bc21159d9 28
MikamiUitOpen 0:8c8bc21159d9 29 virtual ~Biquad() {}
MikamiUitOpen 0:8c8bc21159d9 30
MikamiUitOpen 0:8c8bc21159d9 31 // 2 次のフィルタを実行する
MikamiUitOpen 0:8c8bc21159d9 32 float Execute(float xn)
MikamiUitOpen 0:8c8bc21159d9 33 {
MikamiUitOpen 0:8c8bc21159d9 34 float un = xn + a1_*un1_ + a2_*un2_;
MikamiUitOpen 0:8c8bc21159d9 35 float yn = un + b1_*un1_ + b2_*un2_;
MikamiUitOpen 0:8c8bc21159d9 36
MikamiUitOpen 0:8c8bc21159d9 37 un2_ = un1_;
MikamiUitOpen 0:8c8bc21159d9 38 un1_ = un;
MikamiUitOpen 0:8c8bc21159d9 39
MikamiUitOpen 0:8c8bc21159d9 40 return yn;
MikamiUitOpen 0:8c8bc21159d9 41 }
MikamiUitOpen 0:8c8bc21159d9 42
MikamiUitOpen 0:8c8bc21159d9 43 // 係数を設定する
MikamiUitOpen 0:8c8bc21159d9 44 void SetCoefs(const Coefs ck)
MikamiUitOpen 0:8c8bc21159d9 45 {
MikamiUitOpen 0:8c8bc21159d9 46 a1_ = ck.a1;
MikamiUitOpen 0:8c8bc21159d9 47 a2_ = ck.a2;
MikamiUitOpen 0:8c8bc21159d9 48 b1_ = ck.b1;
MikamiUitOpen 0:8c8bc21159d9 49 b2_ = ck.b2;
MikamiUitOpen 0:8c8bc21159d9 50 }
MikamiUitOpen 0:8c8bc21159d9 51
MikamiUitOpen 0:8c8bc21159d9 52 // 内部変数（遅延器）のクリア
MikamiUitOpen 0:8c8bc21159d9 53 void Clear() { un1_ = un2_ = 0; }
MikamiUitOpen 0:8c8bc21159d9 54
MikamiUitOpen 0:8c8bc21159d9 55 private:
MikamiUitOpen 0:8c8bc21159d9 56 float a1_, a2_, b1_, b2_; // フィルタの係数
MikamiUitOpen 0:8c8bc21159d9 57 float un1_, un2_; // 遅延器
MikamiUitOpen 0:8c8bc21159d9 58
MikamiUitOpen 0:8c8bc21159d9 59 // コピー･コンストラクタ禁止
MikamiUitOpen 0:8c8bc21159d9 60 Biquad(const Biquad&);
MikamiUitOpen 0:8c8bc21159d9 61 };
MikamiUitOpen 0:8c8bc21159d9 62 #endif // IIR_BIQUAD_HPP