han seungchun / Mbed OS 0820_3

33

Dependencies:   DISCO_L475VG_IOT01A_wifi

Diff: MotorControl.cpp

Revision:
3:32b328935a54
Parent:
2:a460007a35c7
--- a/MotorControl.cpp	Wed Aug 21 07:25:27 2019 +0000
+++ b/MotorControl.cpp	Wed Aug 21 08:45:28 2019 +0000
@@ -35,8 +35,9 @@
 M1_a=1;
 M1_b=0;
 M1_en.write((speed/100));
-M2_en.period(1.0f);
-wait(1);
+
+int i ;
+for(i=0; i<20000000;i++){ }
 motor1Stop();
 }
 
@@ -47,8 +48,9 @@
 M1_a=0;
 M1_b=1;
 M1_en.write((speed/100));
-M2_en.period(1.0f);
-wait(1);
+
+int i ;
+for(i=0; i<20000000;i++){ }
 motor1Stop();
 }
 
@@ -65,9 +67,11 @@
 M2_a=1;
 M2_b=0;
 M2_en.write((speed/100));
-M2_en.period(1.0f);
-//wait(1);
-//motorStop();
+
+
+int i ;
+for(i=0; i<20000000;i++){ }
+motor1Stop();
 }
 
 void motor2CCW(float speed)
@@ -76,7 +80,9 @@
 blind_state=0;
 M2_a=0;
 M2_b=1;
-M2_en.write((speed/100));
+int i ;
+for(i=0; i<20000000;i++){ }
+motor1Stop();
 
 }