2015_robocon_bteam / Mbed 2 deprecated 2015robot_main_zenkoku

Dependencies:   PID QEI mbed

Revision:
17:726b6f53a457
Parent:
13:57d8e360e9aa
Child:
21:bdf8ac5c200c
--- a/autoMode.h	Tue Nov 03 04:33:08 2015 +0000
+++ b/autoMode.h	Thu Nov 05 07:43:37 2015 +0000
@@ -30,6 +30,7 @@
             flaga=0;
             Move_l(0.0);
             Move_r(0.0);
+            wait(0.1);
         }
     }
     else if((b==6)&&(!flaga)){ /*start*/
@@ -41,17 +42,19 @@
             direction_controller.setBias(0.0);
 //            targ_velocity=speed;
 #ifdef BLUE
-//            sendData(5,69); //right
-//            sendData(5,70); //right
-            sendData(5,71); //right
+            sendData(5,69); //right
             wait(0.05);
             sendData(4,69); //left
+            wait(0.05);
+            sendData(6,59); //middle
             stateR = 69;
             stateL = 69;
 #else       
             sendData(5,69); //right
             wait(0.05);
             sendData(4,69); //left
+            wait(0.05);
+            sendData(6,59); //middle
             stateR = 69;
             stateL = 69;
 #endif
@@ -73,12 +76,16 @@
             sendData(5,60); //right
             wait(0.05);
             sendData(4,60); //left
+            wait(0.05);
+            sendData(6,49); //middle
             stateR = 60;
             stateL = 61;
 #else
             sendData(5,59); //right
             wait(0.05);
             sendData(4,59); //left
+            wait(0.05);
+            sendData(6,49); //middle
             stateR = 59;
             stateL = 59;
 #endif
@@ -98,19 +105,16 @@
             sendData(5,69); //right
             wait(0.05);
             sendData(4,69); //left
+            wait(0.05);
+            sendData(6,69); //middle
             stateR = 71;
             stateL = 71;
 #else
-            /*sendData(5,66); //right
-            wait(0.05);
-            sendData(4,66); //left*/
-            /*sendData(4,71); //left
-            wait(0.05);
-            sendData(5,71); //right*/
             sendData(4,73); //left
             wait(0.05);
             sendData(5,73); //right
-            
+            wait(0.05);
+            sendData(6,69); //middle
             stateR = 71;
             stateL = 72;
 #endif