Lab3

Dependencies:   mbed MMA7660

Embed: (wiki syntax)

« Back to documentation index

Show/hide line numbers main.cpp Source File

main.cpp

00001 //Useds measured z-acceleration to drive Led 2 and Led 3 on the Mbed//
00002 
00003 #include "mbed.h"
00004 #include "MMA7660.h"
00005 
00006 Serial pc(USBTX, USBRX); //tx rx
00007 MMA7660 MMA(p28, p27);
00008 
00009 float calculateAngle (float x, float y, float z)
00010 {
00011     float angle =0;
00012     
00013     angle = (atan (x/ sqrt((y*y)+(z*z)))*180/3.17);
00014     
00015     return angle;
00016     
00017 } 
00018 
00019 int main ()
00020 {
00021     // if MMA.test connection() ) //
00022     
00023     while (1) 
00024     {
00025         printf("x %f, y %f, z %f ang %f\n", MMA.x(), MMA.y(), MMA.z(), calculateAngle(MMA.x(), MMA.y(), MMA.z()));
00026         wait (1);
00027     }
00028 }