Tristan Vlogman
Defines a second order section of a biquadChain
Diff: biquadFilter.cpp
- Revision:
- 0:5484e3da74be
- Child:
- 1:8589bd80071d
--- /dev/null Thu Jan 01 00:00:00 1970 +0000
+++ b/biquadFilter.cpp Fri Oct 20 12:23:40 2017 +0000
@@ -0,0 +1,23 @@
+#include "biquadFilter.h"
+#include "mbed.h"
+
+// Member function definitions
+biquadFilter::biquadFilter(double B0, double B1, double B2, double A0, double A1, double A2):b0(B0),b1(B1),b2(B2),a0(A0),a1(A1),a2(A2){
+ // Initializing filter coefficients
+
+ v = 0;
+ y = 0;
+ v1 = 0;
+ v2 = 0;
+ }
+
+double biquadFilter :: filterInput(double u){
+ v = u - a1*v1 - a2*v2;
+ y = b0*v + b1*v1 + b2*v2;
+
+ // Prepare for next sample
+ v2 = v1;
+ v1 = v;
+
+ return y;
+ }
\ No newline at end of file