Vector3 Modified
Dependents: optWingforHAPS_Eigen hexaTest_Eigen
Diff: MedianFilter.cpp
- Revision:
- 1:7e434a01533c
- Parent:
- 0:49e6de85e2fb
- Child:
- 2:269c66e647f8
--- 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]; + +}