Group19-Biorobotics
Dependencies: HIDScope MODSERIAL PID QEI SigInterpreternovember2 biquadFilter mbed
Fork of Robot_control_v3 by
Diff: initialize.h
- 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,