Sensor/Sensor.cpp at master · ratatatatat/Sensor · GitHub

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
#include "Sensor.h"
#include <iostream>
using namespace std;

template<class T>
Sensor<T>::Sensor(){
}

template<class T>
void Sensor<T>::initVar(T thresh){
    var = 0.0;
    var_ = 0.0;
    mean = 0.0;
    mean_ = 0.0;
    n = 1.0;
    n_ = 0.0;
    setThresh(thresh);
}

template<class T>
void Sensor<T>::runningSum(){
    mean = ((mean_ * n_) + meas)/n;
}

template<class T>
void Sensor<T>::calcStat(T newMeas){
	//Calculates the first and second order statistics of the sensor measurement.
    //Initialize the variables to a value
    cout << "Inside calcStat" << endl;
    T threshdiff;
	setMeas(newMeas);
	runningSum();
	if(n>1){
        runningVar();
        threshdiff = var - var_;
    	if(threshdiff<threshold){
    		//This step should break the calcLoop.
    		statReady = true;
    	}
	}
    n_=n;
    n = n+1.0;
    mean_ = mean;
    var_ = var;
    cout << var << endl;
    cout << mean << endl;

}

template<class T>
void Sensor<T>::runningVar(){
	var  = ((n_ * var_)/n) + (1.0/n_)*(meas - mean_)*(meas - mean_);

}

template<class T>
T Sensor<T>::getMean(){
	return this->mean;
}

template<class T>
T Sensor<T>::getVar(){
	return this->var;
}

template<class T>
void Sensor<T>::setMeas(T newMeas){
	//Set the New Measurement internally.
	meas = newMeas;
}

// template<class T>
// void Sensor<T>::popDummyArray(int n){
// 	int j;
// 	int mod;
// 	for(j=0;j<n;j=j+1){
// 		mod = j % 2;
// 		if(mod==1){
// 			this->measArray[j]=1.0;
// 		}
// 		else{
// 			this->measArray[j]=-1.0;
// 		}
// 	}
// }

template<class T>
void Sensor<T>::setThresh(T thresh){
	//Set the threshold variable for class.
	threshold = thresh;
}