Lab3

Dependencies:   mbed MMA7660

main.cpp

Committer:
GerRoche
Date:
2019-05-24
Revision:
0:654d905694c3

File content as of revision 0:654d905694c3:

//Useds measured z-acceleration to drive Led 2 and Led 3 on the Mbed//

#include "mbed.h"
#include "MMA7660.h"

Serial pc(USBTX, USBRX); //tx rx
MMA7660 MMA(p28, p27);

float calculateAngle (float x, float y, float z)
{
    float angle =0;
    
    angle = (atan (x/ sqrt((y*y)+(z*z)))*180/3.17);
    
    return angle;
    
} 

int main ()
{
    // if MMA.test connection() ) //
    
    while (1) 
    {
        printf("x %f, y %f, z %f ang %f\n", MMA.x(), MMA.y(), MMA.z(), calculateAngle(MMA.x(), MMA.y(), MMA.z()));
        wait (1);
    }
}