HAPSRG / MedianFilter

Vector3 Modified

Dependents:   optWingforHAPS_Eigen hexaTest_Eigen

MedianFilter.cpp

Committer:
Kerneels Bezuidenhout
Date:
2016-09-26
Revision:
2:269c66e647f8
Parent:
1:7e434a01533c
Child:
3:ec86928ff12d

File content as of revision 2:269c66e647f8:

#include "MedianFilter.hpp"

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

  for( float i = 0; i < _n; 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[n/2];
}