Localization test degrees heading

wheelerrobotics · Nov 21, 2023 · ddfb994 · ddfb994
1 parent df17f93
commit ddfb994
Show file tree

Hide file tree

Showing 2 changed files with 2 additions and 2 deletions.
diff --git a/...rstinspires/ftc/teamcode/PoseMessage.java → ...es/ftc/teamcode/messages/PoseMessage.java b/...rstinspires/ftc/teamcode/PoseMessage.java → ...es/ftc/teamcode/messages/PoseMessage.java
diff --git a/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/tuning/LocalizationTest.java b/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/tuning/LocalizationTest.java
@@ -30,7 +30,7 @@ public void runOpMode() throws InterruptedException {
 
                 telemetry.addData("x", drive.pose.position.x);
                 telemetry.addData("y", drive.pose.position.y);
-                telemetry.addData("heading", drive.pose.heading);
+                telemetry.addData("heading (deg)", Math.toDegrees(drive.pose.heading.log()));
                 telemetry.update();
             }
         } else if (TuningOpModes.DRIVE_CLASS.equals(TankDrive.class)) {
@@ -51,7 +51,7 @@ public void runOpMode() throws InterruptedException {
 
                 telemetry.addData("x", drive.pose.position.x);
                 telemetry.addData("y", drive.pose.position.y);
-                telemetry.addData("heading", drive.pose.heading);
+                telemetry.addData("heading (deg)", Math.toDegrees(drive.pose.heading.log()));
                 telemetry.update();
             }
         } else {