2015_robocon_bteam / Mbed 2 deprecated 2015robot_main

Dependencies:   PID QEI mbed

Fork of 2015robot_main by Naoto Deguchi

Revision:
75:4cdcd50ee666
Parent:
73:86b7b82ba997
Child:
76:f9bcb7ac438f
--- a/main_ps3.cpp	Sat Oct 10 02:04:14 2015 +0000
+++ b/main_ps3.cpp	Sat Oct 10 02:40:41 2015 +0000
@@ -148,11 +148,26 @@
                 autoflag=0;
             }
             
-            if((x>2900.0)&&(CStep==1)&&(!skip)) CStep=2,sendData(1,1);
-            if((x>5850.0)&&(CStep==2)&&(!skip)) CStep=3,sendData(1,3);
-            if((x>7600.0)&&(CStep==3)&&(!skip)) CStep=4,sendData(1,2);
-            if((x<6600.0)&&(CStep==4)&&(!skip)) CStep=5,sendData(1,4);
-            if((x<6100.0)&&(CStep==5)&&(!skip)) CStep=6,sendData(1,5);
+            if((x>2900.0)&&(CStep==1)) {
+                if(!skip) sendData(1,1);
+                CStep=2;
+            }
+            if((x>5850.0)&&(CStep==2)) {
+                if(!skip) sendData(1,3);
+                CStep=3;
+            }
+            if((x>7600.0)&&(CStep==3)) {
+                if(!skip) sendData(1,2);
+                CStep=6;
+            }
+            if((x<6600.0)&&(CStep==4)) {
+                if(!skip) sendData(1,4);
+                CStep=5;
+            }
+            if((x<6100.0)&&(CStep==5)) {
+                if(!skip) sendData(1,5);
+                CStep=6;
+            }
 #endif
             mesure_state();   /*位置測定*/
             move_following(); /*位置移動*/