2015_robocon_bteam / Mbed 2 deprecated 2015robot_main

Dependencies:   PID QEI mbed

Fork of 2015robot_main by Naoto Deguchi

Revision:
85:dd18a2d79956
Parent:
84:919a335ac81e
Child:
86:5f0b065cb4d3
--- a/autoMode.h	Mon Oct 12 07:42:49 2015 +0000
+++ b/autoMode.h	Tue Oct 13 07:27:26 2015 +0000
@@ -24,12 +24,12 @@
             resetState();
             flagf=1;
             targ_velocity=speed;
-//            sendData(7,defoR);
-            sendData(4,defoR);
+//            sendData(7,70);
+            sendData(5,69);
             wait(0.1);
-            sendData(5,defoL);
-            stateR = defoR;
-            stateL = defoL;
+            sendData(4,69);
+            stateR = 69;
+            stateL = 69;
             step   = 0;
             CStep  = 1;
         }
@@ -41,8 +41,11 @@
             flagf = 1;
             targ_velocity=speed;
             sendData(7,61);
-            stateR = 17;
-            stateL = 17;
+            /*sendData(4,61);
+            wait(0.1);
+            sendData(5,58);*/
+            stateR = 61;
+            stateL = 61;
             step   = 5;
             CStep  = 6;
         }
@@ -53,9 +56,9 @@
             resetState();
             flagf = 1;
             targ_velocity = speed;
-            sendData(7,60);
-            stateR = 17;
-            stateL = 17;
+            sendData(7,70);
+            stateR = 70;
+            stateL = 70;
             step   = 15;
             CStep  = 15;
         }
@@ -131,12 +134,12 @@
             resetState();
             flagf=1;
             targ_velocity=speed;
-//            sendData(7,defoR);
-            sendData(4,defoR);
+//            sendData(7,70);
+            sendData(5,69);
             wait(0.1);
-            sendData(5,defoL);
-            stateR = defoR;
-            stateL = defoL;
+            sendData(4,69);
+            stateR = 69;
+            stateL = 69;
             step   = 0;
             CStep  = 1;
         }
@@ -148,6 +151,9 @@
             flagf = 1;
             targ_velocity=speed;
             sendData(7,61);
+            /*sendData(4,61);
+            wait(0.1);
+            sendData(5,58);*/
             stateR = 61;
             stateL = 61;
             step   = 5;
@@ -160,9 +166,9 @@
             resetState();
             flagf = 1;
             targ_velocity = speed;
-            sendData(7,60);
-            stateR = 60;
-            stateL = 60;
+            sendData(7,70);
+            stateR = 70;
+            stateL = 70;
             step   = 15;
             CStep  = 15;
         }