Ger Roche
/
Float
Lab3
Embed:
(wiki syntax)
Show/hide line numbers
main.cpp
00001 //Useds measured z-acceleration to drive Led 2 and Led 3 on the Mbed// 00002 00003 #include "mbed.h" 00004 #include "MMA7660.h" 00005 00006 Serial pc(USBTX, USBRX); //tx rx 00007 MMA7660 MMA(p28, p27); 00008 00009 float calculateAngle (float x, float y, float z) 00010 { 00011 float angle =0; 00012 00013 angle = (atan (x/ sqrt((y*y)+(z*z)))*180/3.17); 00014 00015 return angle; 00016 00017 } 00018 00019 int main () 00020 { 00021 // if MMA.test connection() ) // 00022 00023 while (1) 00024 { 00025 printf("x %f, y %f, z %f ang %f\n", MMA.x(), MMA.y(), MMA.z(), calculateAngle(MMA.x(), MMA.y(), MMA.z())); 00026 wait (1); 00027 } 00028 }
Generated on Fri Jul 29 2022 10:12:46 by 1.7.2