code for basic movement of robot

Dependencies:   MODSERIAL QEI mbed

Revision:
10:2dd707673b3b
Parent:
9:80dad8d81c33
Child:
11:be7660614c5c
--- a/main.cpp	Wed Oct 14 12:03:06 2015 +0000
+++ b/main.cpp	Thu Oct 15 14:12:58 2015 +0000
@@ -42,13 +42,13 @@
         else if(button_toggle1 == 1 && motor1_dir == 0){
                 motor1_dir = 1;
                 }       
-   
    while(button1.read() != motor1_on){// turn on motor 1 when the button is being pressed
        led3.write(1);
        led1.write(0);
        speed1.write(cycle);//write the speed to the motor  
-       pc.printf("%f",speed1.read());//klopt nog niet, maar voorlopig zorgt het uitlezen ervoor dat het werkt.
+      // pc.printf("%f",speed1.read());//klopt nog niet, maar voorlopig zorgt het uitlezen ervoor dat het werkt.
        direction1.write(motor1_dir);//turn motor CCW or CW
+       wait_us(3000);
    //motor CW = 0
    //motor CCW = 1
        }