Diff: main.cpp

Revision:

6:708e878d4374

Parent:

5:151b0fa1fb44

Child:

7:1a21d8290cf1

--- a/main.cpp	Sun Sep 25 18:59:05 2016 +0000
+++ b/main.cpp	Mon Sep 26 15:17:41 2016 +0000
@@ -1,8 +1,35 @@
 #include "mbed.h"
+#include "uLCD_4DGL.h"
+#include "LSM9DS1.h"
 
-// serial com, print statements sent to pc now
+DigitalOut myled(LED1);
 Serial pc(USBTX, USBRX);
+uLCD_4DGL lcd(p13,p14,p12);
+int main() {
+    //imu9DS1 imu(p9, p10, 0x6B, 0x1E);
+    LSM9DS1 imu(p9, p10, 0xD6, 0x3C);
+    imu.begin();
+    if (!imu.begin()) {
+        lcd.printf("Failed to communicate with imu9DS1.\n");
+    }
+    imu.calibrate();
+    while(1) {
+        imu.readAccel();
+        imu.readMag();
+        imu.readGyro();
+        
+        //lcd.printf("%d %d %d %d %d %d %d %d %d\n\r", imu.calcGyro(imu.gx), imu.calcGyro(imu.gy), imu.calcGyro(imu.gz), imu.ax, imu.ay, imu.az, imu.mx, imu.my, imu.mz);
+        //lcd.printf("%d %d %d\n\r", imu.calcGyro(imu.gx), imu.calcGyro(imu.gy), imu.calcGyro(imu.gz));
+        //lcd.printf("gyro: %d %d %d\n\r", imu.gx, imu.gy, imu.gz);
+        lcd.printf("accel: %d %d %d\n\r", imu.calcAccel(imu.ax), imu.calcAccel(imu.ay), imu.calcAccel(imu.az));
+        //lcd.printf("mag: %d %d %d\n\n\r", imu.mx, imu.my, imu.mz);
+        lcd.circle(64, 64, 10, 0xD3D3D3);
+        lcd.filled_circle(64, 64, 8, WHITE);
+        wait(.05);
+    }
+}
 
+// serial com, print statements sent to lcd now
 /* part 1
 AnalogOut aout(p18);
 AnalogIn ain(p15);
@@ -40,8 +67,6 @@
 microphone mymicrophone(p16);
 */
 
-int main()
-{
     /* part 1
     const double pi = 3.141592653589793238462;
     const double amplitude = 1.0f;
@@ -64,7 +89,7 @@
 //        // analog in
 //        led1 = (ain > 0.2f) ? 1 : 0;
 //        led2 = (ain > 0.4f) ? 1 : 0;
-//        led3 = (ain > 0.6f) ? 1 : 0;
+    //        led3 = (ain > 0.6f) ? 1 : 0;
 //        led4 = (ain > 0.8f) ? 1 : 0;
 //        wait(.01);
 //        */
@@ -75,6 +100,4 @@
 //        //Use an 8kHz audio sample rate (phone quality audio);
 //        wait(1.0/8000.0);
 //        */
-//    }
-    return 0;
-}
+//    }
\ No newline at end of file