Script for controlling 2 DC-motors and a gripper-servo using buttons

Dependencies:   MODSERIAL QEI Servo mbed

Revision:
0:6c8444d06e97
Child:
1:0d55a4bf2269
--- /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