HAPSRG / MedianFilter

Vector3 Modified

Dependents:   optWingforHAPS_Eigen hexaTest_Eigen

MedianFilter.cpp

Committer:
Generic
Date:
2016-09-26
Revision:
3:ec86928ff12d
Parent:
2:269c66e647f8
Child:
6:50f2909f08fe
Child:
7:148420c0b1e2

File content as of revision 3:ec86928ff12d:

#include "MedianFilter.hpp"

MedianFilter::MedianFilter(int size)
{
  _size = size;  

  for( float i = 0; i < _size; i++)
    _window.push_back(i);
}

float MedianFilter::Process(float val)
{
  _window.pop_front();
  _window.push_back(val);

  deque<float> _temp(_window);

  sort(_temp.begin(), _temp.end());

  return _temp[_size/2];
}