2015_robocon_bteam / Mbed 2 deprecated 2015robot_main

Important changes to repositories hosted on mbed.com

Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.

To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.

It is also possible to export all your personal repositories from the account settings page.

Dependencies:   PID QEI mbed

Fork of 2015robot_main by Naoto Deguchi

Diff: main_ps3.cpp

Revision:
51:cb430192b28b
Parent:
50:8ea4714316ce
Child:
52:d9e1629da852
--- a/main_ps3.cpp	Sat Sep 26 08:43:21 2015 +0000
+++ b/main_ps3.cpp	Sun Sep 27 05:02:15 2015 +0000
@@ -18,7 +18,8 @@
 
 int main()
 {
-    initializeSBDBT();
+//    initializeSBDBT();
+    initializeIM920();
     initializeMotors();
     initializeControllers();
     initializeSwing();
@@ -80,10 +81,12 @@
             time+=0.01;*/
         }
         /***update state***/
+        readIM920();
         mesure_state();
         mesureSwing();
         wait(RATE);
         
-        pc.printf("%f %f\r\n",cont,swingRadVelocity);
+        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);
     }
 }
\ No newline at end of file