Vector3 Modified
Dependents: optWingforHAPS_Eigen hexaTest_Eigen
MedianFilter.cpp
- Committer:
- NaotoMorita
- Date:
- 2021-06-29
- Revision:
- 6:50f2909f08fe
- Parent:
- 3:ec86928ff12d
File content as of revision 6:50f2909f08fe:
#include "MedianFilter.hpp" MedianFilter::MedianFilter(int size) { _size = size; for( float i = 0; i < _size; i++) { _windowx.push_back(i); _windowy.push_back(i); _windowz.push_back(i); } } Vector3 MedianFilter::Process(Vector3 val) { Vector3 out; _windowx.pop_front(); _windowx.push_back(val.x); deque<float> _tempx(_windowx); sort(_tempx.begin(), _tempx.end()); out.x = _tempx[_size/2]; _windowy.pop_front(); _windowy.push_back(val.y); deque<float> _tempy(_windowy); sort(_tempy.begin(), _tempy.end()); out.y = _tempy[_size/2]; _windowz.pop_front(); _windowz.push_back(val.z); deque<float> _tempz(_windowz); sort(_tempz.begin(), _tempz.end()); out.z = _tempz[_size/2]; return out; }