Jack Snape / Mbed OS NoiseFilter

v1

Dependencies:   HCSR04

resources/nFilter.cpp@0:9da26936fdc0, 2021-11-29 (annotated)

Committer:
snapo
Date:
Mon Nov 29 13:13:55 2021 +0000
Revision:
0:9da26936fdc0
v1

Who changed what in which revision?

UserRevisionLine numberNew contents of line
snapo 0:9da26936fdc0 1 #include "nFilter.h"
snapo 0:9da26936fdc0 2
snapo 0:9da26936fdc0 3 nFilter::nFilter(float ValsToFilter_[9]){
snapo 0:9da26936fdc0 4 for(int i = 0; i < 9;i++){
snapo 0:9da26936fdc0 5 p_ValsToHold[i] = ValsToFilter_[i];
snapo 0:9da26936fdc0 6 }
snapo 0:9da26936fdc0 7 };
snapo 0:9da26936fdc0 8
snapo 0:9da26936fdc0 9 void nFilter::sortAndFilter(){
snapo 0:9da26936fdc0 10 char count = 9;
snapo 0:9da26936fdc0 11 for (unsigned char i = 0; i < count-1; i++){
snapo 0:9da26936fdc0 12 for (unsigned char j = 0; j < count-1-i; j++){
snapo 0:9da26936fdc0 13 if(p_ValsToHold[j] > p_ValsToHold[j+1]){
snapo 0:9da26936fdc0 14 float temp = p_ValsToHold[j];
snapo 0:9da26936fdc0 15 p_ValsToHold[j] = p_ValsToHold[j+1];
snapo 0:9da26936fdc0 16 p_ValsToHold[j+1] = temp;
snapo 0:9da26936fdc0 17 }
snapo 0:9da26936fdc0 18 }
snapo 0:9da26936fdc0 19 }
snapo 0:9da26936fdc0 20 }
snapo 0:9da26936fdc0 21
snapo 0:9da26936fdc0 22 void nFilter::getAndCalcAvg(){
snapo 0:9da26936fdc0 23 for (int i = 1 ; i < 8;i++){
snapo 0:9da26936fdc0 24 p_ArrAvg += p_ValsToHold[i];
snapo 0:9da26936fdc0 25 }
snapo 0:9da26936fdc0 26 p_ArrAvg /= 7;
snapo 0:9da26936fdc0 27 }
snapo 0:9da26936fdc0 28
snapo 0:9da26936fdc0 29 void nFilter::mid(){
snapo 0:9da26936fdc0 30 p_Mid = p_ValsToHold[4];
snapo 0:9da26936fdc0 31 }
snapo 0:9da26936fdc0 32
snapo 0:9da26936fdc0 33 float nFilter::getMid(){
snapo 0:9da26936fdc0 34 return p_ValsToHold[4];
snapo 0:9da26936fdc0 35 }
snapo 0:9da26936fdc0 36
snapo 0:9da26936fdc0 37 float nFilter::getAvg(){
snapo 0:9da26936fdc0 38 return p_ArrAvg;
snapo 0:9da26936fdc0 39 }
snapo 0:9da26936fdc0 40
snapo 0:9da26936fdc0 41
snapo 0:9da26936fdc0 42 auto nFilter::Avg(int Fixed){
snapo 0:9da26936fdc0 43 auto str = std::to_string(p_ArrAvg);
snapo 0:9da26936fdc0 44 return str.substr(0,str.find(".")+ Fixed +1);
snapo 0:9da26936fdc0 45 }