Group19-Biorobotics

Dependencies:   HIDScope MODSERIAL PID QEI SigInterpreternovember2 biquadFilter mbed

Fork of Robot_control_v3 by Fabian van Hummel

Revision:
4:bfdcf3da7cff
Parent:
2:6b913f93bc0b
Child:
6:a4440eec3652
--- a/initialize.h	Wed Oct 26 12:40:26 2016 +0000
+++ b/initialize.h	Fri Oct 28 12:49:02 2016 +0000
@@ -4,11 +4,42 @@
 #include "math.h"
 #include "HIDScope.h"
 #include "QEI.h"
-#include "SigInterpreter.h"
-#include "PulseChecker.h"
 #include <string>
 #include <time.h>
 #include "PID.h"
 
+
+
+const double b0_1 = 0.70711268813;
+const double b1_1 = -1.41363497311;
+const double b2_1 = 0.70711268813;
+const double a1_1 = -1.24805920374;
+const double a2_1 = 0.48711380285;
+
+const double b0_2 = 0.80740871857;
+const double b1_2 = -1.61097022054;
+const double b2_2 = 0.80740871857;
+const double a1_2 = -1.82350353127;
+const double a2_2 = 0.9185193031;
+
+const double b0_3 = 0.21109745634;
+const double b1_3 = 0.39721518527;
+const double b2_3 = 0.21109745634;
+const double a1_3 = -0.92654918100;
+const double a2_3 = 0.27581060293;
+
+const double b0_4 = 0.18082791262;
+const double b1_4 = 0.23319763548;
+const double b2_4 = 0.18082791262;
+const double a1_4 = -0.66923015321;
+const double a2_4 = 0.52307551251;
+
+const double b0_5 = 0.28421571310;
+const double b1_5 = 0.25361917977;
+const double b2_5 = 0.28421571310;
+const double a1_5 = -0.47420826307;
+const double a2_5 = 0.8333973552;
+    
+
 // occupied pins: A0,A1,A2,A3,D2,D4,D5,D6,D7,D2,D12, D13,D14, D15,