Diff: main.cpp

Revision:

3:39f5e2c1af36

Parent:

0:e1b8c014805d

--- a/main.cpp	Fri Jan 10 05:53:34 2014 +0000
+++ b/main.cpp	Thu Mar 29 22:35:55 2018 +0000
@@ -18,7 +18,7 @@
 
 void getIMUdata(void const *n){
     i++;
-    if (i%10==0){
+    if (i%20==0){
         float *q = (float *)imu_queue.alloc();
         t.reset();
         t.start();
@@ -34,11 +34,16 @@
 }
 
 int main() {
+    pc.baud(115200);
     imu.init(true);
-    pc.baud(115200);
     RtosTimer IMUTimer(getIMUdata, osTimerPeriodic, (void *)0);
     IMUTimer.start(2);
     t2.start();
+    int16_t raw_values[9];
+    
+    Thread::wait(10);
+    
+    pc.printf("Init\r\n");
     
     while (true) {
         t2.reset();
@@ -47,7 +52,6 @@
             imu_t *obj = (imu_t*)evt.value.p;
             pc.printf("Y: %f, P: %f, R: %f, Alt: %f, Temp: %fC\r\n", obj->ypr[0], obj->ypr[1], obj->ypr[2], obj->alt, obj->temp);
             imu_queue.free(obj);
-            pc.printf("\r\n");
         }
     }
 }