HAPSRG
Vector3 Modified
Dependents: optWingforHAPS_Eigen hexaTest_Eigen
Diff: MedianFilter.cpp
- Revision:
- 1:7e434a01533c
- Parent:
- 0:49e6de85e2fb
- Child:
- 2:269c66e647f8
diff -r 49e6de85e2fb -r 7e434a01533c MedianFilter.cpp
--- a/MedianFilter.cpp Mon Sep 26 17:48:46 2016 +0000
+++ b/MedianFilter.cpp Mon Sep 26 20:45:46 2016 +0200
@@ -0,0 +1,28 @@
+#include "MedianFilter.hpp"
+
+MedianFilter::MedianFilter(int size)
+{
+ _size = size;
+ _n = 0;
+}
+
+float MedianFilter::Process(float val)
+{
+ if( _n < size )
+ {
+ _n++;
+ _window.push_back(val);
+ }
+ else
+ {
+ _window.pop_front();
+ _window.push_back(val);
+ }
+
+ deque<float> _temp(_window);
+
+ sor(_temp.begin(), temp.end());
+
+ return _temp[n/2];
+
+}