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); 
}