From ddfb994c78a7b50329d5e0446d1b9ef6ac88c2fa Mon Sep 17 00:00:00 2001 From: Ryan Brott Date: Mon, 20 Nov 2023 20:31:08 -0800 Subject: [PATCH] Localization test degrees heading --- .../ftc/teamcode/{ => messages}/PoseMessage.java | 0 .../firstinspires/ftc/teamcode/tuning/LocalizationTest.java | 4 ++-- 2 files changed, 2 insertions(+), 2 deletions(-) rename TeamCode/src/main/java/org/firstinspires/ftc/teamcode/{ => messages}/PoseMessage.java (100%) diff --git a/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/PoseMessage.java b/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/messages/PoseMessage.java similarity index 100% rename from TeamCode/src/main/java/org/firstinspires/ftc/teamcode/PoseMessage.java rename to TeamCode/src/main/java/org/firstinspires/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 index a5b5bbc5f982..90d4e6ddc37f 100644 --- 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 {