Moving average for ST Nucleo F401RE. The number of average is controled by sw.

Dependencies:   UIT_ADDA mbed

Revision:
0:2e17a28353a0
Child:
1:2b1ce47a1fd7
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp	Wed Oct 29 13:16:24 2014 +0000
@@ -0,0 +1,54 @@
+//--------------------------------------------------------------
+// 移動平均, 平均数:1, 2, 4, 8, 16, 32, 64:スイッチで選択
+//      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
+
+DigitalIn sw1_(D2, PullDown);
+DigitalIn sw2_(D3, PullDown);
+DigitalIn sw4_(D4, PullDown);
+DigitalIn sw8_(D5, PullDown);
+
+int main()
+{
+    ScfClockTim3(500000);       // cutoff frequency: 5 kHz
+
+    const int M = 64;
+    
+    float xn[M];
+    for (int n=0; n<M; n++) xn[n] = 0;
+    
+    while (true)
+    {
+        int sw = (sw4_ << 3) | (sw4_ << 2) | (sw2_ << 1) | sw1_;
+        int nAv = 1 << sw;
+        if (nAv > 64) nAv = 64;
+        
+        xn[0] = adc_.Read();    // Read from A0
+        //-----------------------------------------------
+
+        float yn = 0;
+        for (int k=0; k<nAv; k++) yn = yn + xn[k];
+        yn = yn/(float)nAv;     // yn: average
+        
+        // Update input buffer
+        for (int k = nAv-1; k>0; k--)
+            xn[k] = xn[k-1];
+
+        //-----------------------------------------------
+            myDac_.Write(yn);   // Write to DAC
+    }
+}