Tj Maher
/
DigitalsensorsandEquationsinC
MMA interface with the on board accelerometer ,prints the X,YandZ vaues every second
Embed:
(wiki syntax)
Show/hide line numbers
main.cpp
00001 #include "mbed.h" 00002 #include "MMA7660.h" 00003 00004 00005 Serial pc(USBTX, USBRX); //tx rx 00006 MMA7660 MMA(p28, p27); 00007 00008 float calculateAngle (float x, float y, float z) 00009 { 00010 float angle =0; 00011 00012 angle = (atan (x/ sqrt((y*y)+(z*z)))*180/3.17); 00013 00014 return angle; 00015 00016 } 00017 00018 int main () 00019 { 00020 // if MMA.test connection() ) // 00021 00022 while (1) { 00023 printf("x %f, y %f, z %f ang %f\n\r", MMA.x(), MMA.y(), MMA.z(), calculateAngle(MMA.x(), MMA.y(), MMA.z())); 00024 wait (1); 00025 } 00026 }
Generated on Wed Aug 10 2022 05:20:58 by 1.7.2