Accelerometer & Angles
Dependencies: mbed C12832 MMA7660
EMB_Lab2.cpp
- Committer:
- hulmpants
- Date:
- 2019-08-17
- Revision:
- 0:d59c7b74e6f7
File content as of revision 0:d59c7b74e6f7:
// IT Tralee Mechatronics: Embedded Systems Lab#2 #include "mbed.h" #include "MMA7660.h" #include "C12832_lcd.h" MMA7660 MMA(p28, p27); C12832_LCD lcd; float calculateAngle(float x, float y, float z) { float Angle = 0; float pi = 3.14159265; // declare pi Angle = (atan(y/(sqrt((x*x)+(z*z)))))*(180/pi); return Angle; } int main() { while(1) { float Angle = 0; Angle = (calculateAngle(MMA.x(),MMA.y(),MMA.z())); lcd.cls(); lcd.locate(0,0); lcd.printf("Angles :) \n \r"); lcd.locate(0,8); lcd.printf("Angle = %.2f \n \r", Angle); // print angle reading wait(1); } }