forward

Dependencies:   VNH5019

Fork of AigamozuControlPackets by aigamozu

Revision:
15:ac839aff80bc
Parent:
14:e441331aa4a1
Child:
16:0e815cca2cc7
diff -r e441331aa4a1 -r ac839aff80bc AigamozuControlPackets.cpp
--- a/AigamozuControlPackets.cpp	Sat Apr 25 01:05:51 2015 +0000
+++ b/AigamozuControlPackets.cpp	Mon Apr 27 12:07:42 2015 +0000
@@ -196,11 +196,11 @@
         out_count_flag = true;
     }
     if(out_flag){
-        if(Automove_Timer.read_ms() < 1000){
-            _agzSheild.changeSpeed(1,64,2,64);//turn
-        }else if(Automove_Timer.read_ms() < 5000){
-            _agzSheild.changeSpeed(1,64,1,64);//straight
-        }else if(Automove_Timer.read_ms() >= 5000){
+        if(Automove_Timer.read_ms() < 5000){
+            _agzSheild.changeSpeed(2,64,2,64);//back
+        }else if(Automove_Timer.read_ms() < 6000){
+            _agzSheild.changeSpeed(1,64,2,64);//straight
+        }else if(Automove_Timer.read_ms() >= 6000){
             out_count_flag=false;
             out_flag=false;
         }