Sample program for lab 4

Revision:
0:a1caba5c4e48
Child:
2:fcf30b3e1c14
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp	Wed Feb 08 19:25:08 2017 +0000
@@ -0,0 +1,32 @@
+#include "mbed.h"
+#include "rtos.h"
+#include "MMA8451Q.h"
+
+  PinName const SDA = PTE25;
+  PinName const SCL = PTE24;
+
+#define MMA8451_I2C_ADDRESS (0x1d<<1)
+
+int main(void)
+{
+    MMA8451Q acc(SDA, SCL, MMA8451_I2C_ADDRESS);
+    PwmOut rled(LED1);
+    PwmOut gled(LED2);
+    PwmOut bled(LED3);
+    Serial pc(USBTX, USBRX); // tx, rx
+
+
+    pc.printf("MMA8451 ID: %d\n", acc.getWhoAmI());
+
+    while (true) {
+        float x, y, z;
+        x = acc.getAccX();
+        y = acc.getAccY();
+        z = acc.getAccZ();
+        rled = 1.0f - abs(x);
+        gled = 1.0f - abs(y);
+        bled = 1.0f - abs(z);
+        Thread::wait(300);
+        pc.printf("X: %1.2f, Y: %1.2f, Z: %1.2f\n", x, y, z);
+    }
+}