Interactive Device Design
/
idd_hw2_maruchik_pitch
Pitch code
Revision 0:2418caa8b2a4, committed 2014-09-22
- Comitter:
- maruchik
- Date:
- Mon Sep 22 07:12:23 2014 +0000
- Commit message:
- Pitch Code;
Changed in this revision
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/MMA8451Q.lib Mon Sep 22 07:12:23 2014 +0000 @@ -0,0 +1,1 @@ +http://mbed.org/users/maruchik/code/MMA8451Q/#62d2410ae91d
--- /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(); + + } +}
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/mbed.bld Mon Sep 22 07:12:23 2014 +0000 @@ -0,0 +1,1 @@ +http://mbed.org/users/mbed_official/code/mbed/builds/552587b429a1 \ No newline at end of file