maedalab / Mbed 2 deprecated MPU9250_AHRS

Dependencies:   MPU9250_SPI mbed

Revision:
23:2e1ee10d4ee0
Parent:
22:10de7ce8fee3
Child:
25:f8fd336981cb
--- a/main.cpp	Wed Jun 29 04:35:10 2016 +0000
+++ b/main.cpp	Wed Jul 06 04:01:42 2016 +0000
@@ -45,6 +45,7 @@
 
 float putg[3] = {0};
 float putq[4] = {0};
+int waittime = 80;
 
 void init(void)
 {
@@ -89,7 +90,7 @@
         #ifdef DEBUG_putc
         pc.putc(tmp);
         #endif      
-        wait_us(150);
+        wait_us(waittime);
     }        
 }//float2byte
 
@@ -120,7 +121,7 @@
     #ifdef DEBUG_putc
     pc.putc(0x34);  //STX
     #endif
-    wait_us(150);
+    wait_us(waittime);
     for(int i=0; i<2; i++) {
             putg[0] = imu[i]->gyroscope_data[0];
             putg[1] = imu[i]->gyroscope_data[1];
@@ -164,7 +165,7 @@
     #ifdef DEBUG_putc
     pc.putc(0x12);  //ETX
     #endif    
-    printf("\n");
+    //printf("\n");
 }
 
 int main()