Script for controlling 2 DC-motors and a gripper-servo using buttons
Dependencies: MODSERIAL QEI Servo mbed
main.cpp
- Committer:
- huismaja
- Date:
- 2016-10-07
- Revision:
- 0:6c8444d06e97
- Child:
- 1:0d55a4bf2269
File content as of revision 0:6c8444d06e97:
#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); }