Dependencies: QEI RemoteIR mbed
Fork of encoder by
Diff: PID_control.cpp
- Revision:
- 8:6b2f7886768d
- Parent:
- 7:e10dc3cb9212
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(); }