Diff: main.cpp

Revision:

2:a4d5e7f96e87

Parent:

0:f43994f44684

Child:

3:461a9012682d

--- a/main.cpp	Sat Nov 10 00:23:07 2018 +0000
+++ b/main.cpp	Thu Nov 15 01:36:16 2018 +0000
@@ -1,12 +1,20 @@
-#include "mbed.h"
+#include "sensor_fusion.h"
 
-DigitalOut myled(LED1);
+MPU6050 mpu(SDA,SCL);
 
 int main() {
+    mpu.start();
+    
     while(1) {
-        myled = 1; // LED is ON
-        wait(0.2); // 200 ms
-        myled = 0; // LED is OFF
-        wait(1.0); // 1 sec
+        if (!mpu.data_ready()) {
+            continue;
+        }
+        
+        float accel_x, accel_y, accel_z, gyro_x, gyro_y, gyro_z;
+        mpu.read_raw(&gyro_x, &gyro_y, &gyro_z, &accel_x, &accel_y, &accel_z);
+        
+        printf("ax:%f\n ay: %f\n az: %f\n gx: %f\n gy: %f\n gz: %f\r\n", accel_x, accel_y, accel_z, gyro_x, gyro_y, gyro_z);
+        printf("____________________\n");
+        wait(1);
     }
-}
+}
\ No newline at end of file