2015_robocon_bteam / Mbed 2 deprecated 2015robot_main_zenkoku

Dependencies:   PID QEI mbed

Revision:
35:7b6786193aa2
Parent:
34:aa2a5c888a27
Child:
36:b8954b13a6d5
diff -r aa2a5c888a27 -r 7b6786193aa2 main_ps3.cpp
--- a/main_ps3.cpp	Fri Nov 13 08:51:09 2015 +0000
+++ b/main_ps3.cpp	Sat Nov 14 04:05:13 2015 +0000
@@ -77,7 +77,7 @@
                 if(!skip) sendData(1,1);
                 CStep=1; 
             }
-            if((x>6150.0)&&(CStep==1)) {
+            if((x>6100.0)&&(CStep==1)) {
                 if(!skip) sendData(1,2);
                 CStep=2;
             }
@@ -85,16 +85,16 @@
                 if(!skip) sendData(1,3);
                 CStep=3;
             }
-            if((x<7050.0)&&(CStep==3)) {
+            if((x<7200.0)&&(CStep==3)) {
                 if(!skip) sendData(1,4); //over
                 CStep=4;
             }
             if((x<6950.0)&&(CStep==4)) {
-                if(!skip) sendData(1,5); //middle
+                if(!skip) sendData(1,6); //front
                 CStep=5;
             }
-            if((x<6950.0)&&(CStep==5)) {
-                if(!skip) sendData(1,6); //front
+            if((x<6700.0)&&(CStep==5)) {
+                if(!skip) sendData(1,5); //middle
                 CStep=6;
             }
             if((x<3000.0)&&(CStep==6)){
@@ -103,7 +103,7 @@
             }
             
             /********************************Own & Opponent Mode*********************************/
-            if((step==10)&&((10000.0>x)&&(x>700.0))) {
+            if((step==10)&&((9800.0>x)&&(x>700.0))) {
                 targ_sita=-0.03;
 //                targ_sita=0.0;
                 step=11;
@@ -118,6 +118,7 @@
                 step=13;
                 spcount=0.0;
                 flagf=0;
+//                flagf=3;
 //                targ_sita=0.0;
                 targ_sita=-0.03;
             }
@@ -131,20 +132,33 @@
             }
             
             //Cylinderd
-            if((x>9500.0)&&(CStep==10)) CStep=11;
-            if((x<9400.0)&&(CStep==11)) {
-                if(!skip) sendData(1,4);
+            if((x>3200.0)&&(CStep==10)) {
+                if(!skip) sendData(1,1);
+                CStep=11; 
+            }
+            if((x>6050.0)&&(CStep==11)) {
+                if(!skip) sendData(1,2);
                 CStep=12;
             }
-            if((x<6900.0)&&(CStep==12)) {
-                if(!skip) sendData(1,5);
+            if((x>7700.0)&&(CStep==12)) {
+                if(!skip) sendData(1,3);
                 CStep=13;
             }
-            if((x<5350.0)&&(CStep==13)) {
+            if((x>9500.0)&&(CStep==13)) CStep=14;
+            if((x<9400.0)&&(CStep==14)) {
+                if(!skip) sendData(1,4);
+                CStep=15;
+            }
+            if((x<7250.0)&&(CStep==15)) {
+                if(!skip) sendData(1,5);
+                CStep=16;
+            }
+            if((x<4850.0)&&(CStep==16)) {
+//            if((x<5450.0)&&(CStep==16)) {
                 if(!skip) sendData(1,6);
-                CStep=14;
+                CStep=17;
             }
-            if((x<1000.0)&&(CStep==14)){
+            if((x<1000.0)&&(CStep==17)){
                 sendData(7,0);
                 CStep=114;
             }