IntroRoboticsLab2/gyro/gyro.ino

30 lines
410 B
C++

#include <MeMCore.h>
#include <Wire.h>
MeGyro gyro(4);
float distance;
float lSpeed;
float rSpeed;
float duration;
int Side;
double angleZ;
double gyroX;
void setup() {
// put your setup code here, to run once:
Serial.begin(9600);
gyro.begin();
}
void loop() {
// put your main code here, to run repeatedly:
gyro.update();
angleZ = gyro.getAngleZ();
Serial.println(gyro.getAngleZ()));
}