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("x", drive.pose.position.x);
|
||||||
telemetry.addData("y", drive.pose.position.y);
|
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();
|
telemetry.update();
|
||||||
}
|
}
|
||||||
} else if (TuningOpModes.DRIVE_CLASS.equals(TankDrive.class)) {
|
} 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("x", drive.pose.position.x);
|
||||||
telemetry.addData("y", drive.pose.position.y);
|
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();
|
telemetry.update();
|
||||||
}
|
}
|
||||||
} else {
|
} else {
|
||||||
|
Reference in New Issue
Block a user