HAPSRG / MedianFilter

Vector3 Modified

Dependents:   optWingforHAPS_Eigen hexaTest_Eigen

MedianFilter.cpp@6:50f2909f08fe, 2021-06-29 (annotated)

Committer:
NaotoMorita
Date:
Tue Jun 29 08:07:47 2021 +0000
Revision:
6:50f2909f08fe
Parent:
3:ec86928ff12d 
commit

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Kerneels Bezuidenhout 1:7e434a01533c 1 #include "MedianFilter.hpp"
Kerneels Bezuidenhout 1:7e434a01533c 2
Kerneels Bezuidenhout 1:7e434a01533c 3 MedianFilter::MedianFilter(int size)
Kerneels Bezuidenhout 1:7e434a01533c 4 {
Generic 3:ec86928ff12d 5 _size = size;
Kerneels Bezuidenhout 2:269c66e647f8 6
Generic 3:ec86928ff12d 7 for( float i = 0; i < _size; i++)
NaotoMorita 6:50f2909f08fe 8 {
NaotoMorita 6:50f2909f08fe 9 _windowx.push_back(i);
NaotoMorita 6:50f2909f08fe 10 _windowy.push_back(i);
NaotoMorita 6:50f2909f08fe 11 _windowz.push_back(i);
NaotoMorita 6:50f2909f08fe 12 }
Kerneels Bezuidenhout 1:7e434a01533c 13 }
Kerneels Bezuidenhout 1:7e434a01533c 14
NaotoMorita 6:50f2909f08fe 15 Vector3 MedianFilter::Process(Vector3 val)
Kerneels Bezuidenhout 1:7e434a01533c 16 {
NaotoMorita 6:50f2909f08fe 17 Vector3 out;
NaotoMorita 6:50f2909f08fe 18
NaotoMorita 6:50f2909f08fe 19 _windowx.pop_front();
NaotoMorita 6:50f2909f08fe 20 _windowx.push_back(val.x);
NaotoMorita 6:50f2909f08fe 21 deque<float> _tempx(_windowx);
NaotoMorita 6:50f2909f08fe 22 sort(_tempx.begin(), _tempx.end());
NaotoMorita 6:50f2909f08fe 23 out.x = _tempx[_size/2];
NaotoMorita 6:50f2909f08fe 24
NaotoMorita 6:50f2909f08fe 25 _windowy.pop_front();
NaotoMorita 6:50f2909f08fe 26 _windowy.push_back(val.y);
NaotoMorita 6:50f2909f08fe 27 deque<float> _tempy(_windowy);
NaotoMorita 6:50f2909f08fe 28 sort(_tempy.begin(), _tempy.end());
NaotoMorita 6:50f2909f08fe 29 out.y = _tempy[_size/2];
NaotoMorita 6:50f2909f08fe 30
NaotoMorita 6:50f2909f08fe 31 _windowz.pop_front();
NaotoMorita 6:50f2909f08fe 32 _windowz.push_back(val.z);
NaotoMorita 6:50f2909f08fe 33 deque<float> _tempz(_windowz);
NaotoMorita 6:50f2909f08fe 34 sort(_tempz.begin(), _tempz.end());
NaotoMorita 6:50f2909f08fe 35 out.z = _tempz[_size/2];
NaotoMorita 6:50f2909f08fe 36 return out;
Kerneels Bezuidenhout 1:7e434a01533c 37 }