AverageFilter.cpp@0:3d9c4345f686, 2012-03-21 (annotated)
- Committer:
- group9
- Date:
- Wed Mar 21 08:30:04 2012 +0000
- Revision:
- 0:3d9c4345f686
Who changed what in which revision?
| User | Revision | Line number | New contents of line |
|---|---|---|---|
| group9 | 0:3d9c4345f686 | 1 | #include "AverageFilter.h" |
| group9 | 0:3d9c4345f686 | 2 | #include "mbed.h" |
| group9 | 0:3d9c4345f686 | 3 | |
| group9 | 0:3d9c4345f686 | 4 | AverageFilter::AverageFilter(int size){ |
| group9 | 0:3d9c4345f686 | 5 | this->speedVector.reserve(size); |
| group9 | 0:3d9c4345f686 | 6 | this->index = 0; |
| group9 | 0:3d9c4345f686 | 7 | this->size = size; |
| group9 | 0:3d9c4345f686 | 8 | for (int i=0; i<size; i++) |
| group9 | 0:3d9c4345f686 | 9 | this->speedVector[i]=0; |
| group9 | 0:3d9c4345f686 | 10 | } |
| group9 | 0:3d9c4345f686 | 11 | |
| group9 | 0:3d9c4345f686 | 12 | void AverageFilter::insert(int val){ |
| group9 | 0:3d9c4345f686 | 13 | this->speedVector[index++%this->size] = val; |
| group9 | 0:3d9c4345f686 | 14 | } |
| group9 | 0:3d9c4345f686 | 15 | |
| group9 | 0:3d9c4345f686 | 16 | float AverageFilter::compute(){ |
| group9 | 0:3d9c4345f686 | 17 | float speed = 0; |
| group9 | 0:3d9c4345f686 | 18 | for (int i=0; i<size; i++) |
| group9 | 0:3d9c4345f686 | 19 | speed += speedVector[i]; |
| group9 | 0:3d9c4345f686 | 20 | speed /= this->size; |
| group9 | 0:3d9c4345f686 | 21 | return speed; |
| group9 | 0:3d9c4345f686 | 22 | } |