不韋 呂
Nucleo-F446RE 内蔵の AD/DA を使うためのライブラリ．DA からの出力は，標本化周波数の４倍のレートで行う． このライブラリを登録した際のプログラム： Demo_F446_AD_DA_Multirate. Library for built-in ADC and DAC in Nucleo-F446RE. Sampling rate for DAC is four times of that for ADC.
Dependents: F446_UpSampling_GraphicEqualizer F446_UpSampling_ReverbSystem F446_UpSampling_FrqShifter_Weaver Demo_F446_AD_DA_Multirate ... more
Diff: Biquad.hpp
- Revision:
- 0:2447a7d225b1
- Child:
- 7:6275fe158ae8
--- /dev/null Thu Jan 01 00:00:00 1970 +0000
+++ b/Biquad.hpp Wed May 16 01:40:50 2018 +0000
@@ -0,0 +1,65 @@
+//--------------------------------------------------------------
+// 縦続形 IIR フィルタの構成要素として使う 2 次の IIR フィルタ
+// b0 は 1 と仮定している
+//
+// 2018/04/19, Copyright (c) 2017 MIKAMI, Naoki
+//--------------------------------------------------------------
+
+#ifndef IIR_BIQUAD_HPP
+#define IIR_BIQUAD_HPP
+
+#include "mbed.h"
+
+// 2 次の IIR フィルタ
+class Biquad
+{
+public:
+ // フィルタの係数をまとめて扱うための構造体
+ struct Coefs { float a1, a2, b1, b2; };
+
+ // デフォルト･コンストラクタ
+ // 係数は構造体 Ceofs で与える
+ Biquad(const Coefs ck = (Coefs){0, 0, 0, 0})
+ : a1_(ck.a1), a2_(ck.a2), b1_(ck.b1), b2_(ck.b2)
+ { Clear(); }
+
+ // 係数を個別に与えるコンストラクタ
+ Biquad(float a1, float a2, float b1, float b2)
+ : a1_(a1), a2_(a2), b1_(b1), b2_(b2)
+ { Clear(); }
+
+ // 2 次のフィルタを実行する
+ float Execute(float xn)
+ {
+ float un = xn + a1_*un1_ + a2_*un2_;
+ float yn = un + b1_*un1_ + b2_*un2_;
+
+ un2_ = un1_;
+ un1_ = un;
+
+ return yn;
+ }
+
+ // 係数を設定する
+ void SetCoefs(const Coefs ck)
+ {
+ a1_ = ck.a1;
+ a2_ = ck.a2;
+ b1_ = ck.b1;
+ b2_ = ck.b2;
+ }
+
+ // 内部変数（遅延器）のクリア
+ void Clear() { un1_ = un2_ = 0; }
+
+private:
+ float a1_, a2_, b1_, b2_;
+ float un1_, un2_;
+
+ // コピー･コンストラクタ禁止
+ Biquad(const Biquad&);
+ // 代入禁止
+ Biquad& operator=(const Biquad&);
+};
+
+#endif // IIR_BIQUAD_HPP