Dependencies:   QEI RemoteIR mbed

Fork of encoder by Micromouse 18

Files at this revision

API Documentation at this revision

Comitter:
Joshua_Cheung
Date:
Wed Nov 29 02:51:31 2017 +0000
Parent:
7:e10dc3cb9212
Commit message:
what we finished 11/28;

Changed in this revision

PID_control.cpp Show annotated file Show diff for this revision Revisions of this file
diff -r e10dc3cb9212 -r 6b2f7886768d PID_control.cpp
--- 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();
 }