diff --git a/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/drive/SampleMecanumDrive.java b/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/drive/SampleMecanumDrive.java index 12d4a68005af..f9fad087f728 100644 --- a/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/drive/SampleMecanumDrive.java +++ b/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/drive/SampleMecanumDrive.java @@ -298,12 +298,7 @@ public double getRawExternalHeading() { @Override public Double getExternalHeadingVelocity() { - // To work around an SDK bug, use -zRotationRate in place of xRotationRate - // and -xRotationRate in place of zRotationRate (yRotationRate behaves as - // expected). This bug does NOT affect orientation. - // - // See https://github.com/FIRST-Tech-Challenge/FtcRobotController/issues/251 for details. - return (double) -imu.getAngularVelocity().xRotationRate; + return (double) imu.getAngularVelocity().zRotationRate; } public static TrajectoryVelocityConstraint getVelocityConstraint(double maxVel, double maxAngularVel, double trackWidth) { diff --git a/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/drive/SampleTankDrive.java b/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/drive/SampleTankDrive.java index 188aa3a111e3..3ff79f1af799 100644 --- a/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/drive/SampleTankDrive.java +++ b/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/drive/SampleTankDrive.java @@ -302,12 +302,7 @@ public double getRawExternalHeading() { @Override public Double getExternalHeadingVelocity() { - // To work around an SDK bug, use -zRotationRate in place of xRotationRate - // and -xRotationRate in place of zRotationRate (yRotationRate behaves as - // expected). This bug does NOT affect orientation. - // - // See https://github.com/FIRST-Tech-Challenge/FtcRobotController/issues/251 for details. - return (double) -imu.getAngularVelocity().xRotationRate; + return (double) imu.getAngularVelocity().zRotationRate; } public static TrajectoryVelocityConstraint getVelocityConstraint(double maxVel, double maxAngularVel, double trackWidth) {