Script for controlling 2 DC-motors and a gripper-servo using buttons
Dependencies: MODSERIAL QEI Servo mbed
Diff: main.cpp
- Revision:
- 0:6c8444d06e97
- Child:
- 1:0d55a4bf2269
diff -r 000000000000 -r 6c8444d06e97 main.cpp --- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/main.cpp Fri Oct 07 16:55:36 2016 +0000 @@ -0,0 +1,19 @@ +#include "mbed.h" +#include "MODSERIAL.h' + +DigitalIn Direcion_M1 = 4; +DigitalIn Speed_M1 = 5; +DigitalIn Speed_M2 = 6; +DigitalIn Direction_M2 = 7; + +MODSERIAL pc(USBTX, USBRX); + +int main(){ + pc.baud(115200); + pc.printf("RESET \n"); + digitalWrite(Direction_M1, 1); //Direction Control of Motor 1 (1 or 0) + digitalWrite(Direction_M2, 1); //Direction Control of Motor 1 (1 or 0) + analogWrite(Speed_M1, 120); //Speed Control of Motor 1 (0<speed<255) + analogWrite(Speed_M2, 200); //Speed Control of Motor 2 (0<speed<255) + wait(2.0f); +} \ No newline at end of file