Diff: LOCOMOTION.cpp

Revision:

24:fb1f083ebd62

Parent:

23:455f7da3dd7a

Child:

25:f3bf8351bbd4

--- a/LOCOMOTION.cpp	Sun Apr 03 07:08:18 2016 +0000
+++ b/LOCOMOTION.cpp	Sun Apr 03 07:25:07 2016 +0000
@@ -1,13 +1,16 @@
 #include "LOCOMOTION.h"
 
-LOCOMOTION::LOCOMOTION (PinName en, PinName motor1F, PinName motor1B, PinName motor2F, PinName motor2B, PinName forward1, PinName forward2):
-    _en(en), _m1f(motor1F), _m1b(motor1B), _m2f(motor2F), _m2b(motor2B), _m1dir(forward1), _m2dir(forward2)
+LOCOMOTION::LOCOMOTION (PinName en, PinName motor1F, PinName motor1B, PinName motor2F, PinName motor2B, PinName forward1, PinName forward2, DigitalOut& led1, DigitalOut& led2, DigitalOut& led3, DigitalOut& led4):
+    _en(en), _m1f(motor1F), _m1b(motor1B), _m2f(motor2F), _m2b(motor2B), _m1dir(forward1), _m2dir(forward2), _led1(led1), _led2(led2), _led3(led3), _led4(led4)
 {
     s=0;
     stopMotors();
     _m1dir=0;
     _m2dir=0;
     _en=1;
+    _led1=1;
+    wait(0.01);
+    _led1=0;
 }
 
 inline void LOCOMOTION::stopMotors(void)