Mekatronics Team G
Dependencies: BNO055_fusion PowerControl mbed BMP280
Fork of DEMO3 by
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)