Rudolf Rumpler / Mbed 2 deprecated embedded_answ_2_

accelerometer

Dependencies:   mbed MMA7660

main.cpp

Committer:
rudolf5020
Date:
2020-08-19
Revision:
2:b99449535e77
Parent:
1:19c7e004b469

File content as of revision 2:b99449535e77:

#include "mbed.h"//preprosser command
#include "MMA7660.h"//preprocesser command
 
#define PI 3.14159265
 
Serial pc(USBTX,USBRX);//serial transmission 
MMA7660 MMA(p28,p27);//IC2 pins  accelerometer
 
float calculateAngle(float x,float y,float z){
    float angle = 0;
// calculate of angle
 
angle = (y*y) + (z*z);//bottom of the division line
angle = sqrt (angle);//square root
angle = x/angle;
angle = atan (angle);//arctan of angle
angle = angle *180/PI; //radians to degrees!
return angle;
}
 
int main(){//main program
    while (1){
        pc.printf("    X%f     Y%f      Z%f     angle%.2f degrees\r", MMA.x(), 
        MMA.y(), MMA.z(), calculateAngle(MMA.x(), MMA.y(), MMA.z()));
        wait(1);//wait 1 second
    }
}