Localization test degrees heading

This commit is contained in:
Ryan Brott
2023-11-20 20:31:08 -08:00
parent df17f93fd3
commit ddfb994c78
2 changed files with 2 additions and 2 deletions

View File

@ -30,7 +30,7 @@ public class LocalizationTest extends LinearOpMode {
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 class LocalizationTest extends LinearOpMode {
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 {