不韋 呂 / F746_SD_GraphicEqualizer

Output the audio signal with filtering by graphic equalizer in the *.wav file on the SD card using onboard CODEC. SD カードの *.wav ファイルのオーディオ信号をグラフィック･イコライザを通して，ボードに搭載されているCODEC で出力する．

Dependencies:   F746_GUI F746_SAI_IO SD_PlayerSkeleton FrequencyResponseDrawer

MyGraphicEqualizer/BiquadGrEq.hpp@15:ef0acc9fe111, 2016-08-15 (annotated)

Committer:
MikamiUitOpen
Date:
Mon Aug 15 06:37:47 2016 +0000
Revision:
15:ef0acc9fe111
Child:
23:878419f8638b
16

Who changed what in which revision?

UserRevisionLine numberNew contents of line
MikamiUitOpen 15:ef0acc9fe111 1 //--------------------------------------------------------------
MikamiUitOpen 15:ef0acc9fe111 2 // グラフィックイコライザで使う 1D タイプの 2 次のフィルタ
MikamiUitOpen 15:ef0acc9fe111 3 // Biquad filter of 1D type for graphic equalizer
MikamiUitOpen 15:ef0acc9fe111 4 // このクラスでは，係数は実行中に書き換えられることを想定している
MikamiUitOpen 15:ef0acc9fe111 5 //
MikamiUitOpen 15:ef0acc9fe111 6 // u[n] = x[n] + a1*u[n-1] + a2*u[n-2]
MikamiUitOpen 15:ef0acc9fe111 7 // y[n] = b0*u[n] + b1*u[n-1] + b2*u[n-2]
MikamiUitOpen 15:ef0acc9fe111 8 // x[n] : input signal
MikamiUitOpen 15:ef0acc9fe111 9 // y[n] : output signal
MikamiUitOpen 15:ef0acc9fe111 10 //
MikamiUitOpen 15:ef0acc9fe111 11 // 2016/08/10, Copyright (c) 2016 MIKAMI, Naoki
MikamiUitOpen 15:ef0acc9fe111 12 //--------------------------------------------------------------
MikamiUitOpen 15:ef0acc9fe111 13
MikamiUitOpen 15:ef0acc9fe111 14 #ifndef IIR_BIQUAD_GREQ_HPP
MikamiUitOpen 15:ef0acc9fe111 15 #define IIR_BIQUAD_GREQ_HPP
MikamiUitOpen 15:ef0acc9fe111 16
MikamiUitOpen 15:ef0acc9fe111 17 #include "mbed.h"
MikamiUitOpen 15:ef0acc9fe111 18
MikamiUitOpen 15:ef0acc9fe111 19 // 2nd order IIR filter
MikamiUitOpen 15:ef0acc9fe111 20 namespace Mikami
MikamiUitOpen 15:ef0acc9fe111 21 {
MikamiUitOpen 15:ef0acc9fe111 22 class BiquadGrEq
MikamiUitOpen 15:ef0acc9fe111 23 {
MikamiUitOpen 15:ef0acc9fe111 24 public:
MikamiUitOpen 15:ef0acc9fe111 25 struct Coefs { float a1, a2, b0, b1, b2; };
MikamiUitOpen 15:ef0acc9fe111 26
MikamiUitOpen 15:ef0acc9fe111 27 BiquadGrEq() {} // Default constructore
MikamiUitOpen 15:ef0acc9fe111 28
MikamiUitOpen 15:ef0acc9fe111 29 BiquadGrEq(const Coefs ck)
MikamiUitOpen 15:ef0acc9fe111 30 {
MikamiUitOpen 15:ef0acc9fe111 31 SetCoefficients(ck);
MikamiUitOpen 15:ef0acc9fe111 32 Clear();
MikamiUitOpen 15:ef0acc9fe111 33 }
MikamiUitOpen 15:ef0acc9fe111 34
MikamiUitOpen 15:ef0acc9fe111 35 void SetCoefficients(const Coefs ck)
MikamiUitOpen 15:ef0acc9fe111 36 {
MikamiUitOpen 15:ef0acc9fe111 37 a1_ = ck.a1;
MikamiUitOpen 15:ef0acc9fe111 38 a2_ = ck.a2;
MikamiUitOpen 15:ef0acc9fe111 39 b0_ = ck.b0;
MikamiUitOpen 15:ef0acc9fe111 40 b1_ = ck.b1;
MikamiUitOpen 15:ef0acc9fe111 41 b2_ = ck.b2;
MikamiUitOpen 15:ef0acc9fe111 42 }
MikamiUitOpen 15:ef0acc9fe111 43
MikamiUitOpen 15:ef0acc9fe111 44 float Execute(float xn)
MikamiUitOpen 15:ef0acc9fe111 45 {
MikamiUitOpen 15:ef0acc9fe111 46 float un = xn + a1_*un1_ + a2_*un2_;
MikamiUitOpen 15:ef0acc9fe111 47 float yn = b0_*un + b1_*un1_ + b2_*un2_;
MikamiUitOpen 15:ef0acc9fe111 48
MikamiUitOpen 15:ef0acc9fe111 49 un2_ = un1_;
MikamiUitOpen 15:ef0acc9fe111 50 un1_ = un;
MikamiUitOpen 15:ef0acc9fe111 51
MikamiUitOpen 15:ef0acc9fe111 52 return yn;
MikamiUitOpen 15:ef0acc9fe111 53 }
MikamiUitOpen 15:ef0acc9fe111 54
MikamiUitOpen 15:ef0acc9fe111 55 void Clear() { un1_ = un2_ = 0; }
MikamiUitOpen 15:ef0acc9fe111 56
MikamiUitOpen 15:ef0acc9fe111 57 private:
MikamiUitOpen 15:ef0acc9fe111 58 float a1_, a2_, b0_, b1_, b2_;
MikamiUitOpen 15:ef0acc9fe111 59 float un1_, un2_;
MikamiUitOpen 15:ef0acc9fe111 60
MikamiUitOpen 15:ef0acc9fe111 61 // disallow copy constructor
MikamiUitOpen 15:ef0acc9fe111 62 BiquadGrEq(const BiquadGrEq&);
MikamiUitOpen 15:ef0acc9fe111 63 };
MikamiUitOpen 15:ef0acc9fe111 64 }
MikamiUitOpen 15:ef0acc9fe111 65 #endif // IIR_BIQUAD_GREQ_HPP