-
Notifications
You must be signed in to change notification settings - Fork 1
Expand file tree
/
Copy pathLowPassFilter.cpp
More file actions
53 lines (43 loc) · 1.21 KB
/
Copy pathLowPassFilter.cpp
File metadata and controls
53 lines (43 loc) · 1.21 KB
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
#include "LowPassFilter.hpp"
LowPassFilter::LowPassFilter():
output(0),
cutOffFrequency(0){}
LowPassFilter::LowPassFilter(float iCutOffFrequency):
output(0),
cutOffFrequency(iCutOffFrequency),
ePow(0){}
LowPassFilter::LowPassFilter(float iCutOffFrequency, float iDeltaTime):
output(0),
cutOffFrequency(iCutOffFrequency),
ePow(1-exp(-iDeltaTime * iCutOffFrequency)){}
float LowPassFilter::update(float input){
return output += (input - output) * ePow;
}
float LowPassFilter::update(float input, float deltaTime){
setDeltaTime(deltaTime); //Changes ePow accordingly.
return output += (input - output) * ePow;
}
float LowPassFilter::getOutput(){
return output;
}
float LowPassFilter::getCutOffFrequency(){
return cutOffFrequency;
}
void LowPassFilter::setCutOffFrequency(float input){
if (input >= 0){
cutOffFrequency = input;
}
else{
cutOffFrequency = 0;
std::cout << "Warning: A LowPassFilter instance has been configured with 0 Hz as cut-off frequency.";
}
}
void LowPassFilter::setDeltaTime(float deltaTime){
if (deltaTime >= 0){
ePow = 1-exp(-deltaTime * cutOffFrequency);
}
else{
ePow = 0;
std::cout << "Warning: A LowPassFilter instance has been configured with 0 s as delta time.";
}
}