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?
User | Revision | Line number | New 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 | } |