不韋 呂
/
UIT2_IIR_1stOrder
IIR filter of 1st order for ST Nucleo F401RE.
Diff: main.cpp
- Revision:
- 0:22eafb1b3124
- Child:
- 2:ed56284ebeb7
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/main.cpp Wed Oct 29 09:46:52 2014 +0000 @@ -0,0 +1,38 @@ +//-------------------------------------------------------------- +// 1次の IIR フィルタ +// Analog Input : A0 +// Analog Output: MCP4922 using SPI +// 2014/10/29, Copyright (c) 2014 MIKAMI, Naoki +//-------------------------------------------------------------- + +#include "mbed.h" + +#include "ADC_Base.hpp" // for ADC not using interrupt +#include "DAC_MCP4922.hpp" // for DAC MCP4922 +#include "ScfClockTim3.hpp" // for clock supplied to SCF + +using namespace Mikami; + +const int FS_ = 12000; // Sampling frequency: 12 kHz +ADC_Base adc_(A0, FS_); // for AD +DAC_MCP4922 myDac_; // for DA + +int main() +{ + ScfClockTim3(500000); // cutoff frequency: 5 kHz + + const float A1 = 0.8f; + const float B0 = 1.0f - A1; + float yn = 0; + + while (true) + { + float xn = adc_.Read(); // Read from A0 + //----------------------------------------------- + + yn = A1*yn + B0*xn; + + //----------------------------------------------- + myDac_.Write(yn); // Write to DAC + } +}