This is some awesome robot code

Dependencies:   mbed-rtos mbed QEI

Fork of ICRSEurobot13 by Thomas Branch

Revision:
60:5058465904e0
Parent:
51:bc261eae004b
Child:
62:78d99b781f02
--- a/main.cpp	Fri Apr 12 22:00:32 2013 +0000
+++ b/main.cpp	Sat Apr 13 22:41:00 2013 +0000
@@ -61,7 +61,6 @@
     
     Serial pc(USBTX, USBRX);
     pc.baud(115200);
-    wait(2);
     InitSerial();
     wait(3);
     Kalman::KalmanInit();
@@ -81,8 +80,12 @@
     motion_timer.start(50);
 
     Thread printingThread(Printing::printingloop, NULL, osPriorityLow, 2048);
+    
+    //while(1){
+    //    printf("r:%f, l:%f, t:%f\r\n", right_encoder.getTicks()*ENCODER_M_PER_TICK, left_encoder.getTicks()*ENCODER_M_PER_TICK, SystemTime.read());
+    //}
 
-    measureCPUidle(); //repurpose thread for idle measurement
+    //measureCPUidle(); //repurpose thread for idle measurement
     Thread::wait(osWaitForever);
    
 }