aigamozu / AigamozuControlPackets_2016

2016_05_19ver Auto mode 10sec forward, 2sec stop, 2sec right turn Please change test_mode's right turn ppm

Dependencies:   VNH5019 AigamozuControlPackets_2016

Dependents:   Aigamozu_Robot_2016_ver1 GPSLOG_program AigamozuControlPackets_2016

Fork of AigamozuControlPackets by aigamozu

Diff: AigamozuControlPackets.cpp

Revision:
15:ac839aff80bc
Parent:
14:e441331aa4a1
Child:
16:0e815cca2cc7
--- 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;
         }