2015_robocon_bteam / Mbed 2 deprecated 2015robot_main

Dependencies:   PID QEI mbed

Fork of 2015robot_main by Naoto Deguchi

Revision:
56:ac01d6b46291
Parent:
55:db1797ac6cb1
Child:
57:3fbd487e055e
diff -r db1797ac6cb1 -r ac01d6b46291 main_ps3.cpp
--- a/main_ps3.cpp	Mon Sep 28 07:53:39 2015 +0000
+++ b/main_ps3.cpp	Tue Sep 29 03:46:22 2015 +0000
@@ -65,7 +65,6 @@
             if((x>7885.0)&&(CStep==3)) CStep=4,sendData(1,2);
             if((x<6700.0)&&(CStep==4)) CStep=5,sendData(1,4);
             if((x<6300.0)&&(CStep==5)) CStep=6,sendData(1,5);
-//            pc.printf("sita:%f, x:%f, y:%f ,x1:%f, x2:%f ,velocity:%f\r\n",sita,x,y,x1,x2,velocity);
 #endif            
             move_following();
         }
@@ -87,6 +86,7 @@
         mesureSwing();
         wait(RATE);
 
+//        pc.printf("sita:%f, x:%f, y:%f ,x1:%f, x2:%f ,velocity:%f\r\n",sita,x,y,x1,x2,velocity);
 //        pc.printf("A2 = %d, X = %d, Y = %d, B = %d, dead = %d\r\n", a2, X, Y, b, deadflag);
         pc.printf("%f %f\r\n",cont,swingRadVelocity);
     }