Interrupt Lab

Dependencies:   mbed

Committer:
FrankDoherty86
Date:
Fri May 24 15:31:59 2019 +0000
Revision:
1:82217c93a7dd
Parent:
0:82470c7cda3a
Lab 2

Who changed what in which revision?

UserRevisionLine numberNew contents of line
FrankDoherty86 1:82217c93a7dd 1 //Using measured acceleration to run Led 2 and Led 3 on the Mbed//
FrankDoherty86 0:82470c7cda3a 2
FrankDoherty86 1:82217c93a7dd 3 #include "mbed.h"
FrankDoherty86 1:82217c93a7dd 4 #include "MMA7660.h"
FrankDoherty86 0:82470c7cda3a 5
FrankDoherty86 1:82217c93a7dd 6 Serial pc(USBTX, USBRX); //tx rx
FrankDoherty86 1:82217c93a7dd 7 MMA7660 MMA(p28, p27);
FrankDoherty86 0:82470c7cda3a 8
FrankDoherty86 1:82217c93a7dd 9 float calculateAngle (float x, float y, float z)
FrankDoherty86 1:82217c93a7dd 10 {
FrankDoherty86 1:82217c93a7dd 11 float angle = 0;
FrankDoherty86 1:82217c93a7dd 12
FrankDoherty86 1:82217c93a7dd 13 angle = (atan (x/ sqrt((y*y)+(z*z))*180/3.17);
FrankDoherty86 1:82217c93a7dd 14
FrankDoherty86 1:82217c93a7dd 15 return angle;
FrankDoherty86 1:82217c93a7dd 16
FrankDoherty86 1:82217c93a7dd 17 }
FrankDoherty86 1:82217c93a7dd 18 int main()
FrankDoherty86 1:82217c93a7dd 19 {
FrankDoherty86 1:82217c93a7dd 20 //if MMA.test connection () )//
FrankDoherty86 1:82217c93a7dd 21
FrankDoherty86 1:82217c93a7dd 22 while (1)
FrankDoherty86 1:82217c93a7dd 23 {
FrankDoherty86 1:82217c93a7dd 24 print.f("x %f, y %f, z %f ang %f\n", MMA.x(), MMA.y(), MMA.z(), calculateAngle(MMA.x(),MMA.y(),MMA.z()));
FrankDoherty86 1:82217c93a7dd 25 wait(1);
FrankDoherty86 1:82217c93a7dd 26 }
FrankDoherty86 1:82217c93a7dd 27 }