diff options
Diffstat (limited to 'src')
-rw-r--r-- | src/gyro.cpp | 92 |
1 files changed, 46 insertions, 46 deletions
diff --git a/src/gyro.cpp b/src/gyro.cpp index 78498bc..668cef1 100644 --- a/src/gyro.cpp +++ b/src/gyro.cpp @@ -1,46 +1,46 @@ -#include "Arduino.h"
-#include "GY521.h"
-
-GY521 sensor(0x68);
-
-void setup()
-{
- Serial.begin(9600);
-
- // Wait for Serial because the Arduino Leonardo is weird
- while (!Serial) {}
-
- Wire.begin();
-
- delay(100);
- while (!sensor.wakeup())
- {
- Serial.print(millis());
- Serial.println("Error: Could not connect to the GY521 sensor. Retrying after 2000 milliseconds...");
- delay(2000);
- }
- sensor.setAccelSensitivity(2); // 8g
- sensor.setGyroSensitivity(1); // 500 degrees/s
-
- sensor.setThrottle();
- Serial.println("start...");
-
- // Calibration values
- sensor.axe = 0.198;
- sensor.aye = -0.018;
- sensor.gxe = 0.780;
- sensor.gye = -1.495;
-}
-
-void loop()
-{
- sensor.read();
- float pitch = sensor.getPitch();
- float roll = sensor.getRoll();
-
- Serial.print("Pitch: ");
- Serial.print(pitch, 3);
- Serial.print(" Roll: ");
- Serial.print(roll, 3);
- Serial.println();
-}
\ No newline at end of file +#include "Arduino.h" +#include "GY521.h" + +GY521 sensor(0x68); + +void setup() +{ + Serial.begin(9600); + + // Wait for Serial because the Arduino Leonardo is weird + while (!Serial) {} + + Wire.begin(); + + delay(100); + while (!sensor.wakeup()) + { + Serial.print(millis()); + Serial.println("Error: Could not connect to the GY521 sensor. Retrying after 2000 milliseconds..."); + delay(2000); + } + sensor.setAccelSensitivity(2); // 8g + sensor.setGyroSensitivity(1); // 500 degrees/s + + sensor.setThrottle(); + Serial.println("start..."); + + // Calibration values + sensor.axe = 0.198; + sensor.aye = -0.018; + sensor.gxe = 0.780; + sensor.gye = -1.495; +} + +void loop() +{ + sensor.read(); + float pitch = sensor.getPitch(); + float roll = sensor.getRoll(); + + Serial.print("Pitch: "); + Serial.print(pitch, 3); + Serial.print(" Roll: "); + Serial.print(roll, 3); + Serial.println(); +} |