ave

Dependencies:   QEI TextLCD mbed

Revision:
0:3fd90568b788
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/average/ave.cpp	Thu Oct 17 01:49:27 2013 +0000
@@ -0,0 +1,19 @@
+#include "mbed.h"
+
+#define KAZU 3
+
+double ave(int num, double value)
+{
+    static double sum[KAZU] = {0};
+    static double data[KAZU][5] = {{0}};
+    
+    sum[num] -= data[num][4];
+    sum[num] += value;
+    data[num][4] = data[num][3];
+    data[num][3] = data[num][2];
+    data[num][2] = data[num][1];
+    data[num][1] = data[num][0];
+    data[num][0] = value;
+    
+    return sum[num]/5;
+}
\ No newline at end of file