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

Dependencies:   MODSERIAL QEI Servo mbed

Committer:
huismaja
Date:
Fri Oct 07 16:55:36 2016 +0000
Revision:
0:6c8444d06e97
Child:
1:0d55a4bf2269
Basic script to turn on 2 DC-motors at different speeds

Who changed what in which revision?

UserRevisionLine numberNew contents of line
huismaja 0:6c8444d06e97 1 #include "mbed.h"
huismaja 0:6c8444d06e97 2 #include "MODSERIAL.h'
huismaja 0:6c8444d06e97 3
huismaja 0:6c8444d06e97 4 DigitalIn Direcion_M1 = 4;
huismaja 0:6c8444d06e97 5 DigitalIn Speed_M1 = 5;
huismaja 0:6c8444d06e97 6 DigitalIn Speed_M2 = 6;
huismaja 0:6c8444d06e97 7 DigitalIn Direction_M2 = 7;
huismaja 0:6c8444d06e97 8
huismaja 0:6c8444d06e97 9 MODSERIAL pc(USBTX, USBRX);
huismaja 0:6c8444d06e97 10
huismaja 0:6c8444d06e97 11 int main(){
huismaja 0:6c8444d06e97 12 pc.baud(115200);
huismaja 0:6c8444d06e97 13 pc.printf("RESET \n");
huismaja 0:6c8444d06e97 14 digitalWrite(Direction_M1, 1); //Direction Control of Motor 1 (1 or 0)
huismaja 0:6c8444d06e97 15 digitalWrite(Direction_M2, 1); //Direction Control of Motor 1 (1 or 0)
huismaja 0:6c8444d06e97 16 analogWrite(Speed_M1, 120); //Speed Control of Motor 1 (0<speed<255)
huismaja 0:6c8444d06e97 17 analogWrite(Speed_M2, 200); //Speed Control of Motor 2 (0<speed<255)
huismaja 0:6c8444d06e97 18 wait(2.0f);
huismaja 0:6c8444d06e97 19 }