Bayley Wang / Mbed 2 deprecated foc-ed_in_the_bot_compact

robot

Dependencies:   FastPWM3 mbed

Diff: Filter/Filter.cpp

Revision:
146:296bcc30e65d
Parent:
145:37ffa3ba3862
Child:
147:c1b2379b8874
--- a/Filter/Filter.cpp	Wed May 03 12:28:05 2017 +0000
+++ b/Filter/Filter.cpp	Wed May 03 12:36:51 2017 +0000
@@ -1,3 +1,21 @@
 #include "mbed.h"
 #include "math.h"
-#include "Filter.h"
\ No newline at end of file
+#include "Filter.h"
+
+MedianFilter::MedianFilter(int length) {
+    buf = new CircularBuffer(length);
+}
+
+float MedianFilter::update(float x) {
+    buf->add(x);
+    return buf->median();
+}
+
+MovingAverageFilter::MovingAverageFilter(int length) {
+    buf = new CircularBuffer(length);
+}
+
+float MovingAverageFilter::update(float x) {
+    buf->add(x);
+    return buf->mean();
+}   
\ No newline at end of file