diff --git a/FTC2024WeRobotControl.java b/FTC2024WeRobotControl.java index 8dbb470..fae7b90 100644 --- a/FTC2024WeRobotControl.java +++ b/FTC2024WeRobotControl.java @@ -148,6 +148,9 @@ public class FTC2024WeRobotControl { double left_multiplier = -((double) Math.signum(angle)); double right_multiplier = ((double) Math.signum(angle)); double m_power = motor_speed; + if(Math.abs(angle)===180){ + angle = (double) ( ( (double) Math.signum(angle) ) * 179.9 ); + } while(Parent.opModeIsActive() && (Math.abs(robotOrientation.getYaw(AngleUnit.DEGREES) - start_yaw) < Math.abs(angle))){ robotOrientation = Parent.imu.getRobotYawPitchRollAngles(); double yaw = robotOrientation.getYaw(AngleUnit.DEGREES);