Joshua Cheung / Mbed 2 deprecated encoder_v2

Dependencies:   QEI RemoteIR mbed

Fork of encoder by Micromouse 18

Diff: PID_control.cpp

Revision:
8:6b2f7886768d
Parent:
7:e10dc3cb9212
--- a/PID_control.cpp	Wed Nov 29 02:48:57 2017 +0000
+++ b/PID_control.cpp	Wed Nov 29 02:51:31 2017 +0000
@@ -198,6 +198,8 @@
     
     backUp();
     
+    LS_IRE.write(1);
+    RS_IRE.write(1);  
     if (LS_IRR.read() > turnThreshold)
         if (RS_IRR.read() < turnThreshold)
             turnRight();
@@ -210,6 +212,8 @@
             turnAround();
     else
         turnAround();
+    LS_IRE.write(0);
+    RS_IRE.write(0); 
 }
     stop();
 }