Operation Mode State Machine plus homing for StateMachinePTR

Dependencies:   MODSERIAL QEI biquadFilter mbed

Fork of Controller by Sven van Wincoop

Revision:
12:cae29e41ac2e
Parent:
11:dcc416dbe3ea
Child:
13:9125d359619c
--- a/OperationMode.cpp	Wed Oct 31 21:12:38 2018 +0000
+++ b/OperationMode.cpp	Wed Oct 31 21:21:13 2018 +0000
@@ -43,9 +43,13 @@
             LedRed = 0; //red
             LedGreen = 1;
             LedBlue = 1;
-            if (button_sw2 == false) {
+            if (BUT1 == false) {
+                CurrentOperationState = OPState1;
+                TimerLoop.reset();
+            }
+            if (button_sw3 == false) {
                 CurrentOperationState = OPSet;
-                TimerLoop.reset();
+                TimreLoop.reset();
             }
             break;