Tj Maher
/
DigitalsensorsandEquationsinC
MMA interface with the on board accelerometer ,prints the X,YandZ vaues every second
Diff: main.cpp
- Revision:
- 0:6305a4a6779c
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/main.cpp Wed May 22 10:48:24 2019 +0000 @@ -0,0 +1,26 @@ +#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\r", MMA.x(), MMA.y(), MMA.z(), calculateAngle(MMA.x(), MMA.y(), MMA.z())); + wait (1); + } +} \ No newline at end of file