Diff: main.cpp

Revision:

0:2418caa8b2a4

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp	Mon Sep 22 07:12:23 2014 +0000
@@ -0,0 +1,64 @@
+#include "mbed.h"
+#include "MMA8451Q.h"
+
+Serial pc(USBTX, USBRX);
+float pitch, roll;
+int enter, back;
+#if   defined (TARGET_KL25Z) || defined (TARGET_KL46Z)
+  PinName const SDA = PTE25;
+  PinName const SCL = PTE24;
+#elif defined (TARGET_KL05Z)
+  PinName const SDA = PTB4;
+  PinName const SCL = PTB3;
+#elif defined (TARGET_K20D50M)
+  PinName const SDA = PTB1;
+  PinName const SCL = PTB0;
+#else
+  #error TARGET NOT DEFINED
+#endif
+
+#define MMA8451_I2C_ADDRESS (0x1d<<1)
+
+DigitalIn RIGHT(D8);
+DigitalIn LEFT(D9);
+
+void pc_listen() {
+    if (pc.readable()) {
+        char input = pc.getc();
+        
+        switch(input) {
+            case '1': pc.printf("%1.2f,%1.2f, %d, %d\r\n", roll, pitch, enter, back);
+            break;
+        }    
+    }
+}
+
+int main(void)
+{   
+    float x=0, y=0, z=0;
+    MMA8451Q acc(SDA, SCL, MMA8451_I2C_ADDRESS);
+    PwmOut rled(LED1);
+    PwmOut gled(LED2);
+    PwmOut bled(LED3);
+
+//    printf("MMA8451 ID: %d\n", acc.getWhoAmI());
+
+    while (true) {        
+        x = acc.getAccX();
+        y = acc.getAccY();
+        z = acc.getAccZ();
+        
+        roll = 180*atan(x / sqrt(z*z + y*y))/3.1415;
+        pitch = 180*atan(y / sqrt(x*x + z*z))/3.1415;
+        
+        rled = 1.0f - x;
+        gled = 1.0f - y;
+        bled = 1.0f - z;
+        enter = !RIGHT.read();
+        back = !LEFT.read();
+            
+//        wait(0.1f);
+        pc_listen();
+
+    }
+}