Advertisement
Guest User

Untitled

a guest
Jun 26th, 2016
98
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
C++ 1.76 KB | None | 0 0
  1.  
  2. #include <Wire.h>
  3. #include <troyka-imu.h>
  4.  
  5. Gyroscope gyro;
  6. Accelerometer accel;
  7. Compass compass;
  8. Barometer barometer;
  9.  
  10. void setup() {
  11.   Serial.begin(9600);
  12.  
  13.   /*
  14.   while (!Serial.available()) {
  15.     // ждём
  16.   }
  17. */
  18.   Serial.println("Begin init...");
  19.  
  20.   gyro.begin();
  21.   accel.begin();
  22.   compass.begin();
  23.   barometer.begin();
  24.  
  25.   Serial.println("Init completed");
  26.   Serial.println("Gyroscope\t\t\tAccelerometer\t\t\tBarometer");
  27. }
  28.  
  29. void loop()
  30. {
  31.  
  32.     // вывод угловой скорости относительно оси X
  33.     Serial.print(gyro.readX_DegPerSec());
  34.     Serial.print("\t");
  35.     // вывод угловой скорости относительно оси Y
  36.     Serial.print(gyro.readY_DegPerSec());
  37.     Serial.print("\t");
  38.     // вывод угловой скорости относительно оси Z
  39.     Serial.print(gyro.readZ_DegPerSec());
  40.     Serial.print("\t\t");
  41.    
  42.     // вывод направления и величины ускорения по оси X
  43.     Serial.print(accel.readX_G());
  44.     Serial.print("\t");
  45.     // вывод направления и величины ускорения по оси Y
  46.     Serial.print(accel.readY_G());
  47.     Serial.print("\t");
  48.     // вывод направления и величины ускорения по оси Z
  49.     Serial.print(accel.readZ_G());
  50.     Serial.print("\t\t");
  51.    
  52.     // вывод значения абсолютного давления
  53.     Serial.print(barometer.readPressureMillibars());
  54.     Serial.print("\t");
  55.     // вывод значения температуры окружающей среды
  56.    
  57.     Serial.print(barometer.readTemperatureC());
  58.     Serial.print("\t");
  59.  
  60.     Serial.println("");
  61.     delay(300);
  62. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement