mirror of
https://github.com/RobTillaart/Arduino.git
synced 2024-10-03 18:09:02 -04:00
75 lines
1.2 KiB
Arduino
75 lines
1.2 KiB
Arduino
|
//
|
||
|
// FILE: GY521_angle.ino
|
||
|
// AUTHOR: Rob Tillaart
|
||
|
// PURPOSE: demo pitch roll yaw
|
||
|
// DATE: 2022-06-06
|
||
|
|
||
|
|
||
|
#include "GY521.h"
|
||
|
|
||
|
GY521 sensor(0x68);
|
||
|
|
||
|
uint32_t counter = 0;
|
||
|
|
||
|
|
||
|
void setup()
|
||
|
{
|
||
|
Serial.begin(115200);
|
||
|
Serial.println();
|
||
|
Serial.println(__FILE__);
|
||
|
Serial.print("GY521_LIB_VERSION: ");
|
||
|
Serial.println(GY521_LIB_VERSION);
|
||
|
|
||
|
Wire.begin();
|
||
|
|
||
|
delay(100);
|
||
|
while (sensor.wakeup() == false)
|
||
|
{
|
||
|
Serial.print(millis());
|
||
|
Serial.println("\tCould not connect to GY521");
|
||
|
delay(1000);
|
||
|
}
|
||
|
sensor.setAccelSensitivity(2); // 8g
|
||
|
sensor.setGyroSensitivity(1); // 500 degrees/s
|
||
|
|
||
|
sensor.setThrottle();
|
||
|
Serial.println("start...");
|
||
|
|
||
|
// set calibration values from calibration sketch.
|
||
|
sensor.axe = 0.574;
|
||
|
sensor.aye = -0.002;
|
||
|
sensor.aze = -1.043;
|
||
|
sensor.gxe = 10.702;
|
||
|
sensor.gye = -6.436;
|
||
|
sensor.gze = -0.676;
|
||
|
}
|
||
|
|
||
|
|
||
|
void loop()
|
||
|
{
|
||
|
sensor.read();
|
||
|
float x = sensor.getAngleX();
|
||
|
float y = sensor.getAngleY();
|
||
|
float z = sensor.getAngleZ();
|
||
|
|
||
|
if (counter % 10 == 0)
|
||
|
{
|
||
|
// Serial.println("\nCNT\tX\tY\tZ");
|
||
|
}
|
||
|
|
||
|
//Serial.print(counter);
|
||
|
//Serial.print('\t');
|
||
|
Serial.print(x, 1);
|
||
|
Serial.print('\t');
|
||
|
Serial.print(y, 1);
|
||
|
Serial.print('\t');
|
||
|
Serial.print(z, 1);
|
||
|
Serial.println();
|
||
|
|
||
|
counter++;
|
||
|
}
|
||
|
|
||
|
|
||
|
// -- END OF FILE --
|
||
|
|