Localization test degrees heading
This commit is contained in:
@ -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 {
|
||||
|
Reference in New Issue
Block a user