![](/media/cache/img/default_profile.jpg.50x50_q85.jpg)
Chapter003_TRobot
Dependencies: F746_GUI Array_Matrix TS_DISCO_F746NG mbed LCD_DISCO_F746NG BSP_DISCO_F746NG SDFileSystem_Warning_Fixed FrequencyResponseDrawer F746_SAI_IO
MyClasses_Functions/Biquad.hpp
- Committer:
- SanYune
- Date:
- 2019-04-01
- Revision:
- 12:fde5056cec5c
- Parent:
- 0:04b43b777fae
File content as of revision 12:fde5056cec5c:
//-------------------------------------------------------------- // 縦続形 IIR フィルタで使う 1D タイプの 2 次のフィルタ // Biquad filter of 1D type for IIR filter of cascade structure // このクラスでは,係数は実行中に書き換えられることを想定している // // u[n] = x[n] + a1*u[n-1] + a2*u[n-2] // y[n] = u[n] + b1*u[n-1] + b2*u[n-2] // x[n] : input signal // y[n] : output signal // b0 = 1 // // 2016/03/25, Copyright (c) 2016 MIKAMI, Naoki //-------------------------------------------------------------- #ifndef IIR_BIQUAD_HPP #define IIR_BIQUAD_HPP #include "mbed.h" // 2nd order IIR filter namespace Mikami { class Biquad { public: struct Coefs { float a1, a2, b1, b2; }; Biquad() {} // Default constructore Biquad(const Coefs ck) { SetCoefficients(ck); Clear(); } void SetCoefficients(const Coefs ck) { a1_ = ck.a1; a2_ = ck.a2; b1_ = ck.b1; b2_ = ck.b2; } 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 Clear() { un1_ = un2_ = 0; } private: float a1_, a2_, b1_, b2_; float un1_, un2_; // disallow copy constructor Biquad(const Biquad&); }; } #endif // IIR_BIQUAD_HPP