Bayley Wang
/
foc-ed_in_the_bot_compact
robot
Filter/Filter.cpp@146:296bcc30e65d, 2017-05-03 (annotated)
- Committer:
- bwang
- Date:
- Wed May 03 12:36:51 2017 +0000
- Revision:
- 146:296bcc30e65d
- Parent:
- 145:37ffa3ba3862
- Child:
- 147:c1b2379b8874
05/03/2017 08:36 - added median and moving average filters
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
bwang | 144:a9e7fa1c98d7 | 1 | #include "mbed.h" |
bwang | 144:a9e7fa1c98d7 | 2 | #include "math.h" |
bwang | 146:296bcc30e65d | 3 | #include "Filter.h" |
bwang | 146:296bcc30e65d | 4 | |
bwang | 146:296bcc30e65d | 5 | MedianFilter::MedianFilter(int length) { |
bwang | 146:296bcc30e65d | 6 | buf = new CircularBuffer(length); |
bwang | 146:296bcc30e65d | 7 | } |
bwang | 146:296bcc30e65d | 8 | |
bwang | 146:296bcc30e65d | 9 | float MedianFilter::update(float x) { |
bwang | 146:296bcc30e65d | 10 | buf->add(x); |
bwang | 146:296bcc30e65d | 11 | return buf->median(); |
bwang | 146:296bcc30e65d | 12 | } |
bwang | 146:296bcc30e65d | 13 | |
bwang | 146:296bcc30e65d | 14 | MovingAverageFilter::MovingAverageFilter(int length) { |
bwang | 146:296bcc30e65d | 15 | buf = new CircularBuffer(length); |
bwang | 146:296bcc30e65d | 16 | } |
bwang | 146:296bcc30e65d | 17 | |
bwang | 146:296bcc30e65d | 18 | float MovingAverageFilter::update(float x) { |
bwang | 146:296bcc30e65d | 19 | buf->add(x); |
bwang | 146:296bcc30e65d | 20 | return buf->mean(); |
bwang | 146:296bcc30e65d | 21 | } |