Frank Doherty
/
Interrupt
Interrupt Lab
main.cpp@1:82217c93a7dd, 2019-05-24 (annotated)
- 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?
User | Revision | Line number | New 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 | } |