HAPSRG / MedianFilter

Vector3 Modified

Dependents:   optWingforHAPS_Eigen hexaTest_Eigen

MedianFilter.cpp@7:148420c0b1e2, 2022-03-02 (annotated)

Committer:
NaotoMorita
Date:
Wed Mar 02 15:06:54 2022 +0000
Revision:
7:148420c0b1e2
Parent:
3:ec86928ff12d 
vector3 to float

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++)
Kerneels Bezuidenhout 2:269c66e647f8 8 _window.push_back(i);
Kerneels Bezuidenhout 1:7e434a01533c 9 }
Kerneels Bezuidenhout 1:7e434a01533c 10
Kerneels Bezuidenhout 1:7e434a01533c 11 float MedianFilter::Process(float val)
Kerneels Bezuidenhout 1:7e434a01533c 12 {
Kerneels Bezuidenhout 2:269c66e647f8 13 _window.pop_front();
Kerneels Bezuidenhout 2:269c66e647f8 14 _window.push_back(val);
Kerneels Bezuidenhout 1:7e434a01533c 15
Kerneels Bezuidenhout 1:7e434a01533c 16 deque<float> _temp(_window);
Kerneels Bezuidenhout 1:7e434a01533c 17
Generic 3:ec86928ff12d 18 sort(_temp.begin(), _temp.end());
Kerneels Bezuidenhout 1:7e434a01533c 19
Generic 3:ec86928ff12d 20 return _temp[_size/2];
Kerneels Bezuidenhout 1:7e434a01533c 21 }
NaotoMorita 7:148420c0b1e2 22
NaotoMorita 7:148420c0b1e2 23 /*
NaotoMorita 7:148420c0b1e2 24 #include "MedianFilter.hpp"
NaotoMorita 7:148420c0b1e2 25
NaotoMorita 7:148420c0b1e2 26 MedianFilter::MedianFilter(int size)
NaotoMorita 7:148420c0b1e2 27 {
NaotoMorita 7:148420c0b1e2 28 _size = size;
NaotoMorita 7:148420c0b1e2 29
NaotoMorita 7:148420c0b1e2 30 for( float i = 0; i < _size; i++)
NaotoMorita 7:148420c0b1e2 31 {
NaotoMorita 7:148420c0b1e2 32 _windowx.push_back(i);
NaotoMorita 7:148420c0b1e2 33 _windowy.push_back(i);
NaotoMorita 7:148420c0b1e2 34 _windowz.push_back(i);
NaotoMorita 7:148420c0b1e2 35 }
NaotoMorita 7:148420c0b1e2 36 }
NaotoMorita 7:148420c0b1e2 37
NaotoMorita 7:148420c0b1e2 38 Vector3 MedianFilter::Process(Vector3 val)
NaotoMorita 7:148420c0b1e2 39 {
NaotoMorita 7:148420c0b1e2 40 Vector3 out;
NaotoMorita 7:148420c0b1e2 41
NaotoMorita 7:148420c0b1e2 42 _windowx.pop_front();
NaotoMorita 7:148420c0b1e2 43 _windowx.push_back(val.x);
NaotoMorita 7:148420c0b1e2 44 deque<float> _tempx(_windowx);
NaotoMorita 7:148420c0b1e2 45 sort(_tempx.begin(), _tempx.end());
NaotoMorita 7:148420c0b1e2 46 out.x = _tempx[_size/2];
NaotoMorita 7:148420c0b1e2 47
NaotoMorita 7:148420c0b1e2 48 _windowy.pop_front();
NaotoMorita 7:148420c0b1e2 49 _windowy.push_back(val.y);
NaotoMorita 7:148420c0b1e2 50 deque<float> _tempy(_windowy);
NaotoMorita 7:148420c0b1e2 51 sort(_tempy.begin(), _tempy.end());
NaotoMorita 7:148420c0b1e2 52 out.y = _tempy[_size/2];
NaotoMorita 7:148420c0b1e2 53
NaotoMorita 7:148420c0b1e2 54 _windowz.pop_front();
NaotoMorita 7:148420c0b1e2 55 _windowz.push_back(val.z);
NaotoMorita 7:148420c0b1e2 56 deque<float> _tempz(_windowz);
NaotoMorita 7:148420c0b1e2 57 sort(_tempz.begin(), _tempz.end());
NaotoMorita 7:148420c0b1e2 58 out.z = _tempz[_size/2];
NaotoMorita 7:148420c0b1e2 59 return out;
NaotoMorita 7:148420c0b1e2 60 }
NaotoMorita 7:148420c0b1e2 61
NaotoMorita 7:148420c0b1e2 62
NaotoMorita 7:148420c0b1e2 63 */