Embed: (wiki syntax)

« Back to documentation index

Show/hide line numbers AverageFilter.cpp Source File

AverageFilter.cpp

00001 #include "AverageFilter.h"
00002 #include "mbed.h"
00003 
00004 AverageFilter::AverageFilter(int size){
00005     this->speedVector.reserve(size);
00006     this->index = 0;
00007     this->size = size;
00008     for (int i=0; i<size; i++)
00009         this->speedVector[i]=0;
00010 }
00011 
00012 void AverageFilter::insert(int val){
00013     this->speedVector[index++%this->size] = val;
00014 }
00015 
00016 float AverageFilter::compute(){
00017     float speed = 0;
00018     for (int i=0; i<size; i++)
00019         speed += speedVector[i];
00020     speed /= this->size;
00021     return speed;
00022 }