Eleanor Hulm / Mbed 2 deprecated EMB_Lab2

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);
    }
}