Guest User

Untitled

a guest
Mar 7th, 2014
179
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
C++ 0.95 KB | None | 0 0
  1. #include <AcceleroMMA7361.h>
  2.  
  3. AcceleroMMA7361 accelero;
  4. int x;
  5. int y;
  6. int z;
  7.  
  8. void setup()
  9. {
  10.   Serial.begin(9600);
  11.   accelero.begin(13, 12, 11, 10, A0, A1, A2);
  12.   accelero.setARefVoltage(3.3);    //sets the AREF voltage to 3.3V
  13.   accelero.setSensitivity(HIGH);   //sets the sensitivity to +/-6G
  14.   accelero.calibrate();
  15. }
  16.  
  17. void loop()
  18. {
  19.   x = accelero.getXAccel();
  20.   y = accelero.getYAccel();
  21.   z = accelero.getZAccel();
  22.  
  23.   double pitch, roll;
  24.   pitch = atan(x/sqrt(pow(y, 2) + pow(z, 2)));
  25.   roll = atan(y/sqrt(pow(x, 2) + pow(z, 2)));
  26.   pitch = pitch * (180.0 / PI);
  27.   roll = roll * (180.0 / PI);
  28.   Serial.print("\nx: ");
  29.   Serial.print(pitch);
  30.   Serial.print(" \ty: ");
  31.   Serial.print(roll);
  32.   Serial.println();
  33.  
  34. //  Serial.print("\nx: ");
  35. //  Serial.print(x);
  36. //  Serial.print(" \ty: ");
  37. //  Serial.print(y);
  38. //  Serial.print(" \tz: ");
  39. //  Serial.print(z);
  40.   delay(500);                                     //make it readable
  41. }
Advertisement
Add Comment
Please, Sign In to add comment