diff --git a/TeamCode/src/main/java/org/timecrafters/testing/states/PrototypeTeleOPState.java b/TeamCode/src/main/java/org/timecrafters/testing/states/PrototypeTeleOPState.java index c7a3801..8fb0de3 100644 --- a/TeamCode/src/main/java/org/timecrafters/testing/states/PrototypeTeleOPState.java +++ b/TeamCode/src/main/java/org/timecrafters/testing/states/PrototypeTeleOPState.java @@ -45,10 +45,10 @@ public class PrototypeTeleOPState extends CyberarmState { DeltaRotation = Math.abs(RotationTarget - RobotRotation); } else if (RotationTarget >= 0 && RobotRotation <= 0) { - DeltaRotation = Math.abs(RotationTarget - RobotRotation); + DeltaRotation = Math.abs(RotationTarget + RobotRotation); } else if (RotationTarget <=0 && RobotRotation >= 0) { - DeltaRotation = Math.abs(RobotRotation - RotationTarget); + DeltaRotation = Math.abs(RobotRotation + RotationTarget); } }