2015_robocon_bteam / Mbed 2 deprecated 2015robot_main_zenkoku

Dependencies:   PID QEI mbed

Revision:
32:b8c8ad2eeca7
Parent:
31:897fbd97d264
Child:
33:a4323c20494b
diff -r 897fbd97d264 -r b8c8ad2eeca7 main_ps3.cpp
--- a/main_ps3.cpp	Tue Nov 10 10:27:47 2015 +0000
+++ b/main_ps3.cpp	Wed Nov 11 06:40:39 2015 +0000
@@ -43,7 +43,7 @@
             autoIM920(); /*IM920 button*/
 #ifdef BLUE
             /********************************Own & Middle Mode*********************************/
-            if((step==0)&&((10000.0>x)&&(x>800.0))) {
+            if((step==0)&&((10000.0>x)&&(x>900.0))) {
                 targ_sita=-0.06;
 //                targ_sita=0.0;
                 step=1;
@@ -84,16 +84,18 @@
                 if(!skip) sendData(1,3);
                 CStep=3;
             }
-            if((x<7300.0)&&(CStep==3)) {
-                if(!skip) sendData(1,5); //middle
+            if((x<7000.0)&&(CStep==3)) {
+                if(!skip) sendData(1,4); //over
                 CStep=4;
             }
-            if((x<6650.0)&&(CStep==4)) {
-                if(!skip) sendData(1,4); //over
+            if((x<6920.0)&&(CStep==4)) {
+                if(!skip) sendData(1,5); //middle
+                wait(0.001);
+                if(!skip) sendData(1,6); //front
                 CStep=5;
             }
-            if((x<6200.0)&&(CStep==5)) {
-                if(!skip) sendData(1,6); //front
+            if((x<6850.0)&&(CStep==5)) {
+//                if(!skip) sendData(1,6); //front
                 CStep=6;
             }
             if((x<3000.0)&&(CStep==6)){
@@ -168,7 +170,7 @@
         else if(!autoflag) {
             manualIM920();     /*IM920 button*/
             /********************************Swing Mode*********************************/
-            if((mstep==0)&&((10000.0>x)&&(x>1500.0))) {
+            if((mstep==0)&&((10000.0>x)&&(x>1000.0))) {
                 dpcount=speed;
                 mstep=114;
             }